[资料]

形象解释PID算法+PID算法源代码

2014-1-14 19:47:49 5861 源代码

小明接到这样一个任务：
有一个水缸点漏水(而且漏水的速度还不一定固定不变)，
要求水面高度维持在某个位置，
一旦发现水面高度低于要求位置，就要往水缸里加水。

小明接到任务后就一直守在水缸旁边，
时间长就觉得无聊，就跑到房里看小说了，
每30分钟来检查一次水面高度。水漏得太快，
每次小明来检查时，水都快漏完了，离要求的高度相差很远
，小明改为每3分钟来检查一次，结果每次来水都没怎么漏
，不需要加水，来得太频繁做的是无用功。几次试验后，
确定每10分钟来检查一次。这个检查时间就称为采样周期。

开始小明用瓢加水，水龙头离水缸有十几米的距离，
经常要跑好几趟才加够水，于是小明又改为用桶加，
一加就是一桶，跑的次数少了，加水的速度也快了，
但好几次将缸给加溢出了，不小心弄湿了几次鞋，小明又动脑筋，
我不用瓢也不用桶，老子用盆，几次下来，发现刚刚好，不用跑太多次，
也不会让水溢出。这个加水工具的大小就称为比例系数。

小明又发现水虽然不会加过量溢出了，有时会高过要求位置比较多
，还是有打湿鞋的危险。他又想了个办法，在水缸上装一个漏斗，
每次加水不直接倒进水缸，而是倒进漏斗让它慢慢加。这样溢出的问题解决了，
但加水的速度又慢了，有时还赶不上漏水的速度。
于是他试着变换不同大小口径的漏斗来控制加水的速度
，最后终于找到了满意的漏斗。漏斗的时间就称为积分时间。

小明终于喘了一口，但任务的要求突然严了，
水位控制的及时性要求大大提高，一旦水位过低，
必须立即将水加到要求位置，而且不能高出太多，否则不给工钱。
小明又为难了！于是他又开努脑筋，终于让它想到一个办法，常放一盆备用水在旁边，
一发现水位低了，不经过漏斗就是一盆水下去，这样及时性是保证了，但水位有时会高多了。
他又在要求水面位置上面一点将水凿一孔，再接一根管子到下面的备用桶里这样多出的水会从上面的孔里漏出来。
这个水漏出的快慢就称为微分时间。

大学时代做机器人时用的PID算法源代码：
#define PID_Uint struct pid_uint
PID_Uint
{
      int U_kk;
      int ekk;
      int ekkk;
      int Ur;                               //限幅输出值,需初始化
      int Un;                               //不灵敏区
      //int multiple;             //PID系数的放大倍数，用整形数据的情况下，提高PID参数的设置精度       固定为256
      int Kp;                               //比例，从小往大调
      int Ti;                               //积分，从大往小调
      int Td;                               //微分，用巡线板时设为0
      int k1;                               //
      int k2;
      int k3;
};

/********************************************************************
函数名：void Init_PID_uint(PID_uint *p)
功能：初始化PID参数
说明：调用本函数之前，应该先对Kp,Ti,Td做设置       ,简化了公式
入口参数：PID单元的参数结构体地址
返回值：无
***********************************************************************/
void Init_PID_uint(PID_Uint *p)
{
      p->k1=(p->Kp)+(p->Kp)*1024/(p->Ti)+(p->Kp)*(p->Td)/1024;
      p->k2=(p->Kp)+2*(p->Kp)*(p->Td)/1024;
      p->k3=(p->Kp)*(p->Td)/1024;
}
/********************************************************************
函数名：void reset_Uk(PID_Uint *p)
功能：初始化U_kk,ekk,ekkk
说明：在初始化时调用，改变PID参数时有可能需要调用
入口参数：PID单元的参数结构体地址
返回值：无
***********************************************************************/
void reset_Uk(PID_Uint *p)
{
      p->U_kk=0;
      p->ekk=0;
      p->ekkk=0;
}
/********************************************************************
函数名：int PID_commen(int set,int jiance,PID_Uint *p)
功能：通用PID函数
说明：求任意单个PID的控制量
入口参数：期望值，实测值，PID单元结构体
返回值：PID控制量
***********************************************************************/
int PID_common(int set,int jiance,PID_Uint *p)
{
      int ek,U_k=0;
      ek=jiance-set;
      if((ek>(p->Un))||(ek<-(p->Un)))             //积分不灵敏区
            U_k=(p->U_kk)+(p->k1)*ek-(p->k2)*(p->ekk)+(p->k3)*(p->ekkk);
      p->U_kk=U_k;
         p->ekkk=p->ekk;
      p->ekk=ek;
      if(U_k>(p->Ur))                                     //限制最大输出量，
            U_k=p->Ur;
      if(U_k<-(p->Ur))
            U_k=-(p->Ur);
      return U_k/1024;
}

举报 淘帖0 只看该作者

相关推荐

13条评论 发表评论只看该作者

1058459755 · 2014-1-14 19:48:31 沙发自己顶一下！感觉不错~

赞回复举报

1058459755 · 2014-1-15 16:25:51 板凳通过审核，那就自己顶一下！

赞回复举报

曾幼涵 · 2014-1-15 22:40:07 4^# dddddddddddddddddddddddddddddddddd

赞回复举报

耿冬冬 · 2014-7-21 00:41:41 5^# 挺不错的比喻。。。很好！

赞回复举报

晋阳之甲 · 2014-7-21 14:38:29 6^# .........................................

赞回复举报

budongdewen · 2014-7-22 17:19:50 7^# 很好，很形象！

赞回复举报

牛明强 · 2014-7-25 11:37:56 8^# 真的很形象。

赞回复举报

丘德升 · 2014-9-2 13:04:58 9^# 程序那块看得不是很懂。。。。

赞回复举报

周先生 · 2014-9-2 21:30:04 10^# 非常形象谢谢！！

赞回复举报

zqw1688 · 2020-4-6 19:55:22 11^# 非常形象谢谢！！

赞回复举报

huangyun4444 · 2020-7-25 15:29:41 12^# 比喻到位啊！！！！

赞回复举报

xyxyl2007 · 2021-1-15 15:05:55 13^# 非常形象谢谢！！非常形象谢谢！！

赞回复举报

电气南楠 · 2024-6-23 15:28:58 14^# 确实挺不错的生动形象

赞回复举报

声明：本文内容及配图由入驻作者撰写或者入驻合作网站授权转载。文章观点仅代表作者本人，不代表电子发烧友网立场。文章及其配图仅供工程师学习之用，如有内容图片侵权或者其他问题，请联系本站作侵删。侵权投诉

发资料

精选推荐

记录我的stm32开发学习过程

1049 浏览 0 评论
AD7686芯片不传输数据给STM32，但是手按住就会有数据。

1017 浏览 2 评论
有什么比较热门的嵌入式项目？

2123 浏览 0 评论
如何解决MPU-9250与STM32通讯时,出现HAL_ERROR = 0x01U

1219 浏览 1 评论
hal库中i2c卡死在HAL_I2C_Master_Transmit

1639 浏览 1 评论

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

关注微信公众号

电子发烧友网

电子发烧友论坛

社区合作: 刘勇; 联系电话：15994832713; 邮箱地址：liuyong@huaqiu.com

社区管理: elecfans短短; 微信：elecfans_666; 邮箱：users@huaqiu.com

返回 STM32/STM8技术论坛

搜索历史

形象解释PID算法+PID算法源代码

评论

精选推荐

站长推荐 /6