标题: STM32智能小车编码器源码 [打印本页]
作者: Ivy_Lee    时间: 2018-6-11 19:12
标题: STM32智能小车编码器源码
小车电池被拆了没法调试，有错请指正！
待修好再上传更完善的，求大佬点评指正！

单片机源程序如下:
  1. #include "contral.h"
  2. #include "stm32f10x.h"
  3. #include "motor.h"

  5. int Target_velocity=50;                                                                   //设定速度控制的目标速度为50个脉冲每10ms

  7. /**************************************************************************
  8. 函数功能：TIM3中断
  9. 入口参数：无
  10. 返回  值：无
  11. **************************************************************************/
  12. void TIM3_IRQHandler(void)
  13. {                
  14.         static int time=0;
  15.         time ++;
  16.         if(time==10)
  17.         {
  18.                 if (TIM_GetITStatus(TIM3, TIM_IT_Update)!= RESET)  //检查指定的TIM中断发生与否:TIM 中断源
  19.                         {
  20.                         Encoder=transfer(encoder);
  21.                         Led_Flash(100);                                //LED闪烁;指示单片机正常运行       
  22.                                
  23.                         Moto=Incremental_PI(Encoder,Target_velocity);  //===速度PI控制器
  24.                         Xianfu_Pwm();                                  //===PWM限幅
  25.                         Set_Pwm(Moto);
  26.                                
  27.                         TIM_ClearITPendingBit(TIM3, TIM_IT_Update  );  //清除TIMx的中断待处理位:TIM 中断源
  28.                         }
  29.                 time=0;
  30.         }
  31. }
  32. /**************************************************************************
  33. 函数功能：增量PI控制器
  34. 入口参数：编码器测量值，目标速度
  35. 返回  值：电机PWM
  36. 根据增量式离散PID公式
  37. pwm+=Kp[e（k）-e(k-1)]+Ki*e(k)+Kd[e(k)-2e(k-1)+e(k-2)]
  38. e(k)代表本次偏差
  39. e(k-1)代表上一次的偏差  以此类推
  40. pwm代表增量输出
  41. 在我们的速度控制闭环系统里面，只使用PI控制
  42. pwm+=Kp[e（k）-e(k-1)]+Ki*e(k)
  43. **************************************************************************/
  44. int Incremental_PI (int Encoder,int Target)                //Target是目标值
  45. {        
  46.          float Kp=20,Ki=30;       
  47.          static int Bias,Pwm,Last_bias;
  48.          Bias=Encoder-Target;                //计算偏差
  49.          Pwm+=Kp*(Bias-Last_bias)+Ki*Bias;   //增量式PI控制器
  50.          Last_bias=Bias;                           //保存上一次偏差
  51.          return Pwm;                         //增量输出
  52. }

  54. /**************************************************************************
  55. 函数功能：限制PWM赋值
  56. 入口参数：无
  57. 返回  值：无
  58. **************************************************************************/
  59. void Xianfu_Pwm(void)
  60. {       
  61.         int Amplitude=7100;    /*PWM满幅是7200 限制在7100*/
  62.     if(Moto<-Amplitude) Moto=-Amplitude;       
  63.         if(Moto>Amplitude)  Moto=Amplitude;       
  64. }

  66. /**************************************************************************
  67. 函数功能：绝对值函数
  68. 入口参数：int
  69. 返回  值：unsigned int
  70. **************************************************************************/
  71. int myabs(int a)
  72. {                   
  73.           int temp;
  74.                 if(a<0)  temp=-a;  
  75.           else temp=a;
  76.           return temp;
  77. }

  79. /**************************************************************************
  80. 函数功能：赋值给PWM寄存器
  81. 入口参数：PWM
  82. 返回  值：无
  83. **************************************************************************/
  84. void Set_Pwm(int moto)
  85. {
  86.                         if(moto>0)                AIN2=1,                        AIN1=0;
  87.                         else                 AIN2=0,                        AIN1=1;
  88.                         PWM1=myabs(moto);
  89. }

复制代码

所有资料51hei提供下载:
小车.rar (406.8 KB, 下载次数: 54)



作者: 啊杰啊啊啊    时间: 2018-11-24 22:46
谢谢楼主分享



欢迎光临 (http://www.51hei.com/bbs/) Powered by Discuz! X3.1