我想输出两路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);
}
一周热门 更多>