标题: 单片机PID循迹小车代码 [打印本页]
作者: buhouhui    时间: 2019-1-2 18:36
标题: 单片机PID循迹小车代码
就是比较简单的循迹小车，可以循黑线的那种，因为在学PID，所以给它加了个PD控制，不过效果不太好这是实现PID控制的主要代码

  1. #include"PID.h"
  2. #include"Trace.h"

  4. extern  int flag;
  5. int    RK=6;   //固定基准，不能变得               


  8. int    KP=4;     //比例调节参数
  9. int    out;      //最后输出结果
  10. //int   out0=40; //初始偏移分量
  11. int    Td=7;     //微分时间常数
  12. int    Ti=1;     //积分时间常数
  13. int    T =1;     //采样周期
  14. int    Sk;       //积分，微分
  15. int    Dk;

  17. int  Ek[]={0,0,0,0,0};

  19. /*================================================================
  20. 将flag的值与RK=5相减，当右边的红外对管检测到黑线时
  21. ，即flag为7  8  9  10 11  12时小车发生了左偏，增加左轮转速，减小右轮

  23. 将flag的值与RK=5相减，当左边的红外对管检测到黑线时
  24. ，即flag为5  4  3  2  1   0 时小车发生了右偏，增加右轮转速，减小左轮
  25. //================================================================*/

  27. void  PID (int flag)
  28. {
  29.           Ek[4]=Ek[3];
  30.           Ek[3]=Ek[2];
  31.           Ek[2]=Ek[1];
  32.           Ek[1]=Ek[0];
  33.           Ek[0]=RK-flag;

  35. //Sk = (T/Ti)*(Ek[0]+Ek[1]+Ek[2]+Ek[3]+Ek[4]);
  36.      Dk = (Td/T)*(Ek[0]-Ek[1]);
  37.            out = KP*Ek[0]+Sk+Dk;
  38.            turn(25+out,25-out);
  39.        
  40.        

  42.                
  43. }
  44.        
复制代码


extern  int flag;
int    RK=6;   

int    KP=4;  
int    out;   
//int   out0=40;
int    Td=7;   
int    Ti=1;  
int    T =1;  
int    Sk;      
int    Dk;

int  Ek[]={0,0,0,0,0};


void  PID (int flag)
{
          Ek[4]=Ek[3];
          Ek[3]=Ek[2];
          Ek[2]=Ek[1];
          Ek[1]=Ek[0];
          Ek[0]=RK-flag;

//Sk = (T/Ti)*(Ek[0]+Ek[1]+Ek[2]+Ek[3]+Ek[4]);
     Dk = (Td/T)*(Ek[0]-Ek[1]);
           out = KP*Ek[0]+Sk+Dk;
           turn(25+out,25-out);
        }




void xunji (void)
{
if(count ==200)//采样周期
{
           if(input==0x77)//0111 0 111
        flag=6;

      else if(input==0x7b)//0111 0 01
        flag=7;
                  else if(input==0x7b)//0111 1 011
        flag=8;
                        else if(input==0x75)//0111 1 001
        flag=9;
      else if(input==0x7d)//0111 1 101
        flag=10;
                        else if(input==0x7c)//0111 1 100
        flag=11;
                  else if(input==0x7e)//0111 1 110
        flag=12;
                        else if(input==0x6d)//0110 0 111
        flag=5;
      else if(input==0x6f)//0110 1 111
        flag=4;
                        else if(input==0x4f)//0100 1 111                  
        flag=3;
                        else if(input==0x5f)//0101 1 111                  
        flag=2;
                        else if(input==0x1f)//0001 1 111                 
        flag=1;
                        else if(input==0x10)//0011 1 111         
        flag=0;


   count=0;
}

PID (flag);


}

全部资料51hei下载地址：
循迹小车PID算法.rar (42.84 KB, 下载次数: 133)

作者: katv0718    时间: 2021-1-30 12:13
非常感觉，刚好在学习做智能车底盘
作者: anton0921    时间: 2021-4-21 17:48
请问程序中定义input为P0系列口的目的是啥
作者: gegregeg    时间: 2021-4-25 18:57
刚好可以借鉴做小车



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