智能车制作

 找回密码
 注册

扫一扫,访问微社区

查看: 918|回复: 2
打印 上一主题 下一主题

急急 !!小车在设定的平衡位置不能停住(附注电机控制的代码求指导 )

[复制链接]

18

主题

104

帖子

0

精华

金牌会员

Rank: 6Rank: 6

积分
1046
威望
524
贡献
266
兑换币
315
注册时间
2014-11-21
在线时间
128 小时
跳转到指定楼层
1#
发表于 2015-3-10 21:05:26 | 只看该作者 回帖奖励 |正序浏览 |阅读模式
void MotorControl(int Angleout)
{

   Leftcontrol=Angleout;//-Speed_control_out_l;  //+Speed_control_out_l;
   
   Rightcontrol=Angleout;//-Speed_control_out_r;   //+Speed_control_out_r;
   /*
   if(Leftcontrol >= 0)
      Leftcontrol += 600;
   else
      Leftcontrol -= 600;
   
   if(Rightcontrol >= 0)
      Rightcontrol += 690;
   else
      Rightcontrol -= 690;
   */
  

if(Leftcontrol > control_max)
    Leftcontrol = control_max;

if(Leftcontrol < control_min)
    Leftcontrol = control_min;

if(Rightcontrol > control_max)
    Rightcontrol = control_max;

if(Rightcontrol < control_min)
    Rightcontrol = control_min;


if(Leftcontrol > 0)
{
  
  FTM_PWM_Duty(FTM0,FTM_CH7,2000+Leftcontrol);//ch7
  FTM_PWM_Duty(FTM0,FTM_CH6,0);  //ch6
  
}
else if(Leftcontrol < 0)
{
   Leftcontrol=-Leftcontrol;
   FTM_PWM_Duty(FTM0,FTM_CH6,2000+Leftcontrol);  //ch6
   FTM_PWM_Duty(FTM0,FTM_CH7,0);    //ch7
}

else
{

   FTM_PWM_Duty(FTM0,FTM_CH6,2000);  
   FTM_PWM_Duty(FTM0,FTM_CH7,2000);

}

if(Rightcontrol > 0)            
{

  FTM_PWM_Duty(FTM0,FTM_CH5,2000+Rightcontrol);   //ch5
  FTM_PWM_Duty(FTM0,FTM_CH4,0);   //ch4

}
else if(Rightcontrol < 0)
{
  
   Rightcontrol=-Rightcontrol;
   FTM_PWM_Duty(FTM0,FTM_CH4,2000+Rightcontrol);//ch4
   FTM_PWM_Duty(FTM0,FTM_CH5,0);   //ch5

}
else
{

   FTM_PWM_Duty(FTM0,FTM_CH4,2000);
   FTM_PWM_Duty(FTM0,FTM_CH5,2000);
}

if(Angle_car > 34 || Angle_car< -25)
{  


   FTM_PWM_Duty(FTM0,FTM_CH4,2000);
   FTM_PWM_Duty(FTM0,FTM_CH5,2000);   
  
   FTM_PWM_Duty(FTM0,FTM_CH6,2000);  
   FTM_PWM_Duty(FTM0,FTM_CH7,2000);  
  
}
  
回复

使用道具 举报

1

主题

392

帖子

0

精华

常驻嘉宾

软件的辅助造就机械的完美。

Rank: 8Rank: 8

积分
4078
QQ
威望
2364
贡献
1062
兑换币
979
注册时间
2014-3-15
在线时间
326 小时
3#
发表于 2015-3-11 12:07:19 | 只看该作者
粘贴代码没用的。
回复 支持 反对

使用道具 举报

8

主题

54

帖子

0

精华

金牌会员

Rank: 6Rank: 6

积分
2383
QQ
威望
1143
贡献
716
兑换币
729
注册时间
2013-10-6
在线时间
262 小时
2#
发表于 2015-3-11 11:45:41 | 只看该作者
个人感觉原因如,平衡位置选取不当,或角度融合不好,小幅震动可能车调的过硬或死区电压不合适
回复 支持 反对

使用道具 举报

您需要登录后才可以回帖 登录 | 注册

本版积分规则

关于我们|联系我们|小黑屋|智能车制作 ( 黑ICP备2022002344号

GMT+8, 2024-11-6 16:34 , Processed in 0.040491 second(s), 27 queries , Gzip On.

Powered by Discuz! X3.2

© 2001-2013 Comsenz Inc.

快速回复 返回顶部 返回列表