原创转载PID讲解

 2014-1-22 15:19  1056 15 16 分类: 工业电子

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

小明接到任务后就一直守在水缸旁边，
时间长就觉得无聊，就跑到房里看小说了，
每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;
}

要求控制 in 参数 a

写原创有奖励！2024面包板原创奖励正在进行中

IIC Shenzhen - 2024国际集成电路展览会暨研讨会（深圳，11.5-6）

2024 AI& Connect 是德创新技术峰会（深圳，10.22）

第六届意法半导体工业峰会2024（深圳，10.29）

2024 Arm Tech Symposia 年度大会（上海/深圳，11月19/21日）

文章评论（1条评论）

登录后参与讨论

用户1735495 2014-1-27 16:27

天才！！！

回复

查看更多评论

相关推荐阅读

用户833911 2014-02-25 08:59: Modbus协议; Modbus协议最初由Modicon公司开发出来，在1979年末该公司成为施耐德自动化(Schneider Automation)部门的一部分，现在Modbus已经是工业领域全球最流行的协议。此协...

用户833911 2013-08-03 09:31: 经验谈; 第一：不要认为停留在心灵的舒适区域内是可以原谅的。每个人都有一个舒适区域，在这个区域内是很自我的，不愿意被打扰，不愿意被push，不愿意和陌生的面孔交谈，不愿意被人指责，不愿意按...

用户833911 2012-04-16 21:01: STM32(Cortex-M3)中有两个优先级的概念; STM32(Cortex-M3)中有两个优先级的概念——抢占式优先级和响应优先级，有人把响应优先级称作'亚优先级'或'副优先级'，每个中断源都需要被指定这两种优先级。具有高抢占式优先级的中断可...

用户833911 2012-03-07 09:34: 常见存储器概念辨析：RAM、SRAM、SDRAM、ROM、EPROM; 常见存储器概念辨析：RAM、SRAM、SDRAM、ROM、EPROM 常见存储器概念辨析：RAM、SRAM、SDRAM、ROM、EPROM、EEPROM、Flash存储器可以分为很多种...