找回密码
 立即注册

QQ登录

只需一步,快速开始

搜索
查看: 2364|回复: 4
打印 上一主题 下一主题
收起左侧

单片机+电机PID控制之参数确定问题

[复制链接]
跳转到指定楼层
楼主
ID:587051 发表于 2019-7-24 16:00 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
这个是在论坛里找到的一个比较简单且经典的pid控制算法,但是我很想知道三个参数是什么确定的,我认为这才是问题的关键所在啊。
求大神教一下选定参数的方法,就如果给你们做,代码已经写好,现在就是要确定pid的三个参数,你们通过什么方法找到一个比较好的参数?

单片机源程序如下:
  1. #include<reg51.h>
  2. #include "intrins.h"
  3. #include <lcd.H>
  4. #define uchar unsigned char
  5. #define uint unsigned int
  6. #define GPIO_KEY P2
  7. sbit PWM=P1^4;                  
  8. sbit P10=P1^0;
  9. sbit P12=P1^2;
  10. uchar speed1[4]={"0000"};//设定转速
  11. uchar speed2[3]={"000"};//占空比       
  12. uchar speed[]={"0000"};//当前转速
  13. uchar KeyValue=0;
  14. uint AA,count=0,flag;

  15. float pid_p=0.003,pid_i=0.003,pid_d=0.002;        //PID三个参数 初值
  16. uint SpeedSet=3000,CurrentSpeed;//设定转速 当前转速
  17. unsigned char pid_val_mid;//pid_val_mid脉冲宽度
  18. unsigned int lastError=0;
  19. long int sumError=0;//sum偏差和
  20.        
  21.        
  22. void delay1(unsigned int i)
  23. {
  24.    unsigned int j;
  25.          for(;i>0;i--)
  26.          for(j=0;j<333;j++)
  27.          {;}
  28. }       


  29. /********************* 键盘扫描*************/
  30. void KeyDown(void)               
  31. {
  32.         GPIO_KEY=0x0f;
  33.                 delay1(10);
  34.         if(GPIO_KEY!=0x0f)
  35.         {
  36.                 delay1(10);
  37.                 if(GPIO_KEY!=0x0f)
  38.                 {
  39.                                 //测试列
  40.                         GPIO_KEY=0X0F;
  41.                         delay1(10);
  42.                         switch(GPIO_KEY)
  43.                         {
  44.                                 case(0X07):        KeyValue=0;break;
  45.                                 case(0X0b):        KeyValue=1;break;
  46.                                 case(0X0d): KeyValue=2;break;
  47.                                 case(0X0e):        KeyValue=3;break;
  48.                         }
  49.                         //测试行
  50.                         GPIO_KEY=0XF0;
  51.                         delay1(10);
  52.                         switch(GPIO_KEY)
  53.                         {
  54.                                 case(0X70):        KeyValue=KeyValue;break;
  55.                                 case(0Xb0):        KeyValue=KeyValue+4;break;
  56.                                 case(0Xd0): KeyValue=KeyValue+8;break;
  57.                                 case(0Xe0):        KeyValue=KeyValue+12;break;
  58.                         }
  59.                        
  60.                 }

  61.         }
  62. }

  63. void timer()
  64. {
  65.   
  66.          TMOD=0x11;//定时器0工作方式1.16位,定时器1工作方式1,16位定时;
  67.          TH0=0x4b;//50ms初值
  68.          TL0=0xfe;
  69.          
  70.          TH1=0xfc;//1msPWM控制
  71.          TL1=0x66;
  72.          
  73.          TR1=1;          //启动定时器1
  74.          ET1=1;           //定时器1中断使能
  75.          IT0=1;//外部中断下降沿触发
  76.          TR0=1;        //定时器启动标志
  77.          ET0=1;        //定时器中断使能
  78.          EX0=1;        //外部中断使能
  79.          EA=1;        //全局中断
  80. }


  81. /***********************lcd显示*************/
  82. void  display()
  83. {   
  84.    
  85.           speed[0]=CurrentSpeed/1000+0x30; //当前转速
  86.                 speed[1]=CurrentSpeed/100%10+0x30;
  87.                 speed[2]=CurrentSpeed/10%10+0x30;
  88.                 speed[3]=CurrentSpeed%10+0x30;  
  89.                
  90.                
  91.                 speed1[0]=SpeedSet/1000+0x30;//设定转速
  92.                 speed1[1]=SpeedSet/100%10+0x30;
  93.                 speed1[2]=SpeedSet/10%10+0x30;
  94.                 speed1[3]=SpeedSet%10+0x30;  
  95.                
  96.                 speed2[0]=pid_val_mid/100+0x30;
  97.           speed2[1]=pid_val_mid/10%10+0x30;//占空比
  98.                 speed2[2]=pid_val_mid%10+0x30;
  99.                
  100.        
  101.           DispHanzi(0,0,5,"当前转速:");
  102.                 DispZimu(0,5,4,speed);       
  103.                 DispHanzi(1,0,5,"设定转速:");
  104.                 DispZimu(1,5,4,speed1);

  105.                 DispHanzi(3,0,4,"占空比:");//占空比       
  106.                 DispZimu(3,4,3,speed2);
  107.                 DispHanzi(3,6,1,"%");//占空比       
  108.                
  109. }



  110. /************************电机控制*************/
  111. void keyKZ()
  112. {
  113.                          if(KeyValue==4)//正转
  114.                          {
  115.                           P10=1;
  116.                     P12=0;
  117.                                 }
  118.                          if(KeyValue==5)//反转
  119.                          {
  120.                           P10=0;
  121.                     P12=1;
  122.                                 }
  123.                                 if(KeyValue==6)//停车
  124.                          {
  125.                           P10=0;
  126.                     P12=0;
  127.                                 }
  128.                        
  129.                         if(KeyValue==12)//设定速度加50
  130.                           SpeedSet+=50;
  131.                         if(KeyValue==13)//设定速度减50
  132.                                 SpeedSet-=50;
  133.                         if(KeyValue==14)//设定速度加1
  134.                           SpeedSet+=1;
  135.                         if(KeyValue==15)//设定速度减1
  136.                                 SpeedSet-=1;
  137.         KeyValue=0;
  138.                                
  139. }


  140. /************************PID控制算法*************/
  141. unsigned int PID()
  142. {  

  143.   int dError=0,Error=0,B;
  144.        
  145.         Error=SpeedSet-CurrentSpeed;//当前误差
  146.    sumError=Error+sumError;//误差和
  147.    dError=Error-lastError;//误差偏差
  148.    lastError=Error;
  149.   B=pid_p*Error+pid_i*sumError+pid_d*dError;
  150.        
  151.         if(B>100) pid_val_mid=100;
  152.    if(B<0) pid_val_mid=0;
  153.         if(B>=0&&B<=100)
  154.    pid_val_mid=B;
  155.          return(0);
  156. }


  157. void Timer0_isr() interrupt 1  //定时器0中断
  158. {
  159.          AA++;
  160.          TH0=0x4b;
  161.          TL0=0xfe;
  162.          if(AA==20)
  163.          {               
  164.            CurrentSpeed=count*3;//一分钟的转速
  165.                                 count=0;
  166.                                 AA=0;
  167.                                 PID();
  168.          }

  169. }


  170. void key_int() interrupt 0         //外部中断P32口
  171. {
  172.         count++;
  173. }

  174. void Timer1() interrupt 3
  175. {
  176.    static int c=0;
  177.                  TH1=0xfc;
  178.                   TL1=0x66;
  179.                  c++;    //每次定时器溢出加1                  
  180.          
  181.           if(c<=pid_val_mid) PWM=1;
  182.              
  183.           if(c>pid_val_mid)  PWM=0;
  184.             
  185.                 if(c>=100)         c=0;
  186. }
  187.        
  188. void main()
  189. {
  190.                 timer();//定时器初始化
  191.                 InitLCD();//LCD初始化
  192.                 while(1)
  193.                 {
  194.                    KeyDown();        //键盘扫描
  195.                          keyKZ();//键盘控制
  196.                          display();//显示LCD
  197.                 }
  198. }       
复制代码

所有资料51hei提供下载:
PID控制电机.zip (41.03 KB, 下载次数: 24)





分享到:  QQ好友和群QQ好友和群 QQ空间QQ空间 腾讯微博腾讯微博 腾讯朋友腾讯朋友
收藏收藏1 分享淘帖 顶 踩
回复

使用道具 举报

沙发
ID:405033 发表于 2019-7-24 18:23 | 只看该作者
matlab仿真一下吧,上位机看波形也ok,或者先把ID定为0,然后调整P,等调到差不多的时候,在去调整I(D为0),最后调D,PID有很多方法调整,看你喜欢哪种咯
回复

使用道具 举报

板凳
ID:147266 发表于 2019-7-24 22:00 | 只看该作者
如果没学过自控原理,可以搜一下“PID口诀”……
回复

使用道具 举报

地板
ID:388197 发表于 2019-7-24 22:41 | 只看该作者
PID的公式你别看它又有积分又有微分,真正的难点还是三个项前面的系数,这3个系数取值需要根据你实际的系统,电机我不太懂,我就拿简单的可控硅延时导通来控制加热来举例子,这三个系数跟你的加热棒功率,加热棒与被加热物体直接的接触,被加热物体质量,材料等温度传感器安装的位置都有关,需要反复调试,观察其响应曲线,才能找出三个系数最佳的取值.
回复

使用道具 举报

5#
ID:123289 发表于 2019-7-25 12:02 | 只看该作者
你问的问题,与单片机及程序无关,与控制理论相关,你需要补自动化控制理论方面的课。
否则你只能用实验方式去试出一组或N组不太保险的经验值。
回复

使用道具 举报

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

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

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