增量式PID算法C++源码

1. #include <iostream>
   
2. #include <stdio.h>
   
3. #include <math.h>
   
4. #include <Windows.h>
   
5. 
   
6. //定义PID变量的结构体
   
7. struct _pid
   
8. {
   
9.         float SetSpeed;
   
10.         float ActualSpeed;
    
11.         float err;
    
12.         float err_last;        //定义上上个偏差
    
13.         float err_next;       //定义上一个偏差值
    
14.         float Kp,Ki,Kd;
    
15.       
    
16. }pid;
    
17. 
    
18. //初始化变量
    
19. void PID_init(void)
    
20. {
    
21.         printf ("pid_value_init_begin\n");
    
22. 
    
23.         pid.ActualSpeed = 0.0;
    
24.         pid.SetSpeed = 0.0;
    
25. 
    
26.         pid.err = 0.0;
    
27.         pid.err_last = 0.0;
    
28.         pid. err_next = 0.0;
    
29.       
    
30.       
    
31.         pid.Kp = 0.2;
    
32.         pid.Ki = 0.015;
    
33.         pid.Kd = 0.2;
    
34. 
    
35.         printf("pid_init end \n");
    
36. }
    
37. 
    
38. //增量式算法
    
39. float PID_calculate(float speed)
    
40. {
    
41. 
    
42.         pid.SetSpeed = speed;
    
43.         pid.err = pid.SetSpeed - pid.ActualSpeed;
    
44.       
    
45.         float incrementSpeed = pid.Kp * (pid.err - pid.err_next) + pid.Ki * pid.err + pid.Kd * (pid.err - 2 * pid.err_next + pid.err_last);
    
46. 
    
47.         pid.ActualSpeed += incrementSpeed;
    
48. 
    
49.         pid.err_last = pid.err_next;     //定义上一个偏差值
    
50.         pid.err_next = pid.err;
    
51. 
    
52.         return pid.ActualSpeed;
    
53. 
    
54. }
    
55. 
    
56. 
    
57. 
    
58. 
    
59. int main(void)
    
60. {
    
61.         int setcount = 0;
    
62.         printf ("Please begin \n");
    
63.         PID_init();
    
64. 
    
65.         while (setcount < 100)
    
66.         {
    
67.                 float speed = PID_calculate(250.0);
    
68.                 printf ("value is %f\n",speed);
    
69.                 setcount++;
    
70.                 Sleep(300);
    
71.         }
    
72.         system("pause");
    
73.         return 0;
    
74. }
    

复制代码

【必读】版权免责声明

1、本主题所有言论和内容纯属会员个人意见，与本论坛立场无关。2、本站对所发内容真实性、客观性、可用性不做任何保证也不负任何责任，网友之间仅出于学习目的进行交流。3、对提供的数字内容不拥有任何权利，其版权归原著者拥有。请勿将该数字内容进行商业交易、转载等行为，该内容只为学习所提供，使用后发生的一切问题与本站无关。 4、本网站不保证本站提供的下载资源的准确性、安全性和完整性;同时本网站也不承担用户因使用这些下载资源对自己和他人造成任何形式的损失或伤害。 5、本网站所有软件和资料均为网友推荐收集整理而来，仅供学习用途使用，请务必下载后两小时内删除，禁止商用。6、如有侵犯你版权的，请及时联系我们（电子邮箱1370723259@qq.com）指出，本站将立即改正。