金牌会员
- 积分
- 1436
- 威望
- 775
- 贡献
- 323
- 兑换币
- 455
- 注册时间
- 2012-12-26
- 在线时间
- 169 小时
- 毕业学校
- njyddx
|
1贡献
void duojimotor()
{ unsigned char car_position[]={-6,-5,-4,-3,-2,-1,0,1,2,3,4,5,6}; //相当于13个激光传感器 */
if(car_position[i]>=3) //车的位置与中心的偏差
{
//delay();
angle_date =angle_center+(100+(absolute(car_position[i])-1)*9)*absolute(car_position[i]);
}
else
if (car_position[i]<=-3)
{ // delay();
angle_date =angle_center-(100+(absolute(car_position[i])-1)*9)*absolute(car_position[i]);
}
else
if(car_position[i]>-3&&car_position[i]<3) angle_date=1500; //就是不用太对劲
i++;
if(i==13) i=0;
//delay();
//delay();
//delay();
if(angle_date>=2388) angle_date=2388; //控制转角的大小
else if(angle_date<=610) angle_date=610;
//PWMDTY67=angle_date;
PWMDTY67=2500;
}
|
|