新手入门
- 积分
- 10
- 金钱
- 10
- 注册时间
- 2018-11-8
- 在线时间
- 10 小时
|
20金钱
我想输出两路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("\r\nL1=%lf\r\n",L1);
printf("\r\nL2=%lf\r\n",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("\r\nsuduR=%lf\r\n",suduR);
printf("\r\nsuduL=%lf\r\n",suduL);
printf("\r\ndir1=%d\r\n",dir1);
printf("\r\ndir2=%d\r\n",dir2);
// Locate_Rle(L1*457,suduR,dir1);
// Locate_Rle1(L2*457,suduL,dir2);
Locate_Rle(6400,500,dir1);
Locate_Rle1(12800,1000,dir2);
}
|
|