久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

專注電子技術學習與研究
當前位置:單片機教程網 >> MCU設計實例 >> 瀏覽文章

形象解釋PID算法+PID算法源代碼

作者:佚名   來源:本站原創   點擊數:  更新時間:2014年02月14日   【字體:

小明接到這樣一個任務:
有一個水缸點漏水(而且漏水的速度還不一定固定不變),
要求水面高度維持在某個位置,
一旦發現水面高度低于要求位置,就要往水缸里加水。

小明接到任務后就一直守在水缸旁邊,
時間長就覺得無聊,就跑到房里看小說了,
每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))||(ekUn)))                //積分不靈敏區
                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_kUr))
                U_k=-(p->Ur);       
        return U_k/1024;
}

關閉窗口

相關文章

主站蜘蛛池模板: 色视频欧美 | 欧美一级特黄aaa大片在线观看 | 亚洲国产高清高潮精品美女 | 国产精品久久久久久婷婷天堂 | 久久中文字幕一区 | 亚洲电影免费 | 欧美中文在线 | 欧美一级片久久 | 国产ts人妖系列高潮 | 精品国产欧美一区二区 | 亚洲精品久久久久久一区二区 | 久久成人一区 | 国产欧美精品区一区二区三区 | www.亚洲精品 | 亚洲高清在线 | 国产成人精品一区二区在线 | 一区二区三区四区不卡 | 午夜激情影院 | 这里精品| 在线电影日韩 | 精品无码久久久久久国产 | 欧美一级淫片免费视频黄 | 亚洲视频免费在线观看 | 亚洲天堂av网 | 国产av毛片 | 美女视频网站久久 | 久久九| 一区二区视频在线观看 | 国产精品久久精品 | 免费永久av | h片在线免费看 | 国产在线aa | 国产精品一区二区日韩 | 中文字幕第一页在线 | 99热在线观看精品 | 国产色网 | 精品在线一区二区 | 亚洲视频在线观看免费 | 国产精品99久久久久久久久久久久 | 日韩欧美1区2区 | 日韩在线播放av |