输出两路pwm波来控制步进电机,同时控制时脉冲数不精确

2019-07-21 07:06发布

我想输出两路pwm波来分别控制两个步进电机画圆,但是在  Locate_Rle(6400,500,dir1);
        Locate_Rle1(12800,1000,dir2);这地方 我单独控制一个步进电机可以精确的运动一圈,单独控制的时候6400是一圈,
但是两个一起的时候却不能精确地运动一圈,希望有大佬出来解释一下,感激不尽。程序源码已贴出

void Draw_Line(float x1,float y1,float x2,float y2)
{
        float L1,L2;
        float sulv;
  DIR_Type dir1,dir2;
        float suduL,suduR;
       
        L1=sqrt((x1)*(x1)+(66-y1)*(66-y1))-sqrt((x2)*(x2)+(66-y2)*(66-y2));
        L2=sqrt((56-x1)*(56-x1)+(66-y1)*(66-y1))-sqrt((56-x2)*(56-x2)+(66-y2)*(66-y2));   
        printf(" L1=%lf ",L1);
        printf(" L2=%lf ",L2);
       
       
        if(L1>0) dir1=CCW;//Äæ×a
        else     dir1=CW;//Ë3×a
       
        if(L2>0) dir2=CW;
        else     dir2=CCW;
       
        L1=fabs(L1);
        L2=fabs(L2);
       
        suduL=1000;
        sulv=(L1*1000/L2);
        suduR=sulv;
       

        printf(" suduR=%lf ",suduR);
        printf(" suduL=%lf ",suduL);
       
        printf(" dir1=%d ",dir1);
        printf(" dir2=%d ",dir2);
       
//        Locate_Rle(L1*457,suduR,dir1);
//        Locate_Rle1(L2*457,suduL,dir2);

        Locate_Rle(6400,500,dir1);
        Locate_Rle1(12800,1000,dir2);
}


友情提示: 此问题已得到解决,问题已经关闭,关闭后问题禁止继续编辑,回答。