標題: 飛控開發(fā)基礎-[10] STM32 PID基礎原理 [打印本頁]
作者: 設計開發(fā)工程 時間: 2020-3-27 10:48
標題: 飛控開發(fā)基礎-[10] STM32 PID基礎原理
圖片16.png (290.14 KB, 下載次數(shù): 61)
下載附件
2020-3-27 10:40 上傳
PID基礎一、PID簡介PID控制是自動控制系統(tǒng)中最常用的一種控制手段,它的誕生主要是為了解決自動控制系統(tǒng)的快、穩(wěn)、準的問題。
PID控制中的P指的是Proportion(比例),即對輸入的偏差乘以一個系數(shù);I指的是Integral(積分),即對輸入偏差進行積分運算;而D指的是Derivative(微分),即對輸入偏差進行微分運算。通過比例、積分、微分結合適當?shù)姆答伨涂梢孕纬梢惶追(wěn)定的閉環(huán)調節(jié)系統(tǒng)。如下圖所示為COCOFLY的PID控制器的結構圖。
圖片17.png (29.37 KB, 下載次數(shù): 55)
下載附件
2020-3-27 10:40 上傳
其中期望角度(高度)由遙控器提供,角度環(huán)(高度環(huán))以及角速度環(huán)(高速度環(huán))由PID代碼處理,STM32輸出四路PWM到無人機的電機控制端口,IMU(慣性測量單元)以及飛行姿態(tài)提供反饋值。
二、PID控制原理PID控制的過程,其實是不斷糾正偏差的過程,其中的偏差=當前被控對象的反饋值-設定的期望值。
這里舉一個比較簡單又經(jīng)典的PID控制的例子,比如需要控制一個機器人以PID的方式向前行走110步,然后停下來。此時這個110步則是設定的期望值。
如果按照P比例控制,也就是控制機器人按照一定的比例走,然后停下。比如比例系數(shù)為108,則走一次就走了108步,再走一次的話就超過110步了,所以就不走了。從這里可得知P比例控制是一種最簡單的控制方式,控制器的輸出與輸入誤差信號成比例關系。但是僅有比例控制時系統(tǒng)輸出存在穩(wěn)態(tài)誤差。比如上面的只能走到108,或者超過108步,無論怎樣都走不到110。
為了消除穩(wěn)態(tài)誤差,在控制器中必須引入“積分項I”。積分項對誤差的影響取決于時間的積分,隨著時間的增加,積分項會增大。這樣,即便誤差很小,積分項也會隨著時間的增加而加大,它推動控制器的輸出增大,從而使穩(wěn)態(tài)誤差進一步減小,直到等于0。即在“積分項I”控制中,控制器的輸出與輸入誤差信號成正比關系,且比例+積分(PI)控制器可以使系統(tǒng)在進入穩(wěn)態(tài)后無穩(wěn)態(tài)誤差。
也就是說,如果按照PI(比例、積分)控制的方式,則是控制機器人按照一定的步伐走到112步然后回頭接著走,走到108步位置時,然后又回頭向110步位置走。在110位置處來回晃蕩幾次,最后停在110步的位置。
微分項,主要用于預判誤差變化的趨勢從而作出對應的改變。在自動控制系統(tǒng)在克服誤差的調節(jié)過程中可能會出現(xiàn)振蕩甚至失穩(wěn),原因是存在較大慣性組件(環(huán)節(jié))或滯后組件,具有抑制誤差的作用,其變化總是落后于誤差的變化。解決的辦法是使抑制誤差作用的變化“超前”,即在誤差接近于零時,抑制誤差的作用就應該是零。這就是說,在控制器中僅引入“比例P”項往往是不夠的,比例項的作用僅是放大誤差的幅值,而目前需要增加的是“微分項”,它能預測誤差變化的趨勢。這樣,具有比例+微分的控制器就能夠提前使抑制誤差的控制作用等于零,甚至為負值,從而避免了被控量的嚴重超調。所以對有較大慣性或滯后的被控對象,比例P+微分D(PD)控制器能改善系統(tǒng)在調節(jié)過程中的動態(tài)特性。
也就是說,如果按照PD比例、微分控制的方式,則為控制機器人按照一定的步伐走到一百零幾步后,再慢慢地走向110步的位置靠近,如果最后能精確停在110步的位置,就是無靜差控制;如果停在110步附近(如109步或111步位置),就是有靜差控制。由此得知在微分控制D中,控制器的輸出與輸入誤差信號的微分(即誤差的變化率)成正比關系。
前面說到PID是為了解決自動控制系統(tǒng)中的快、穩(wěn)、準的問題的。其中那么他們之間的關系以及對應調節(jié)參數(shù)是什么呢?如下表所示。
特性 | | |
| 系統(tǒng)對動態(tài)響應的要求,由響應時間的長短來衡量。 | |
| 在平衡狀態(tài)下,系統(tǒng)受到某個干擾后,經(jīng)過一段時間其被控量可以達到某一穩(wěn)定狀態(tài)。 | P和I降低系統(tǒng)穩(wěn)定性,D提高系統(tǒng)穩(wěn)定性。 |
| 系統(tǒng)處于穩(wěn)態(tài)時,其穩(wěn)態(tài)誤差。 | |
三、PID代碼結構在飛控系統(tǒng)中PID是極為重要的一環(huán),在COCOFLY飛控系統(tǒng)中也多處應用到了PID主要集中在AltCtrl.c、Ctrl.c中。如下圖所示為高度環(huán)PID控制源碼。
圖片18.png (56.42 KB, 下載次數(shù): 61)
下載附件
2020-3-27 10:41 上傳
圖片19.png (101.64 KB, 下載次數(shù): 55)
下載附件
2020-3-27 10:42 上傳
如下圖所示為高度速度環(huán)PID控制源碼。
圖片20.png (136.73 KB, 下載次數(shù): 59)
下載附件
2020-3-27 10:43 上傳
如下圖所示為角度環(huán)PID控制源碼。
圖片21.png (252.46 KB, 下載次數(shù): 57)
下載附件
2020-3-27 10:43 上傳
如下圖所示為角速率環(huán)PID控制源碼。
圖片22.png (90.86 KB, 下載次數(shù): 49)
下載附件
2020-3-27 10:48 上傳
以上的pdf格式文檔51黑下載地址:
2.飛控開發(fā)基礎-【10】PID基礎原理.pdf
(793.7 KB, 下載次數(shù): 28)
2020-3-27 10:48 上傳
點擊文件名下載附件
下載積分: 黑幣 -5
歡迎光臨 (http://www.zg4o1577.cn/bbs/) |
Powered by Discuz! X3.1 |
主站蜘蛛池模板:
亚洲精品国产成人
|
国产精品欧美精品日韩精品
|
www.av在线
|
国产一区二区免费在线
|
99精品国自产在线
|
伦理二区|
欧美亚洲国产一区二区三区
|
亚洲欧美日韩电影
|
99在线播放
|
国产精品视频久久
|
亚洲天堂影院
|
亚洲精品福利视频
|
av在线视
|
亚洲日韩中文字幕一区
|
日韩电影免费在线观看中文字幕
|
91免费观看视频
|
日韩乱码在线
|
在线观看免费福利
|
美国十次成人欧美色导视频
|
男人天堂视频在线观看
|
午夜日韩精品
|
国产欧美精品一区二区三区
|
国产丝袜一区二区三区免费视频
|
免费视频二区
|
天天操天天干天天透
|
中文日韩在线视频
|
欧美日韩国产一区二区三区
|
国产1区2区
|
91不卡|
av中文在线
|
国产91在线播放
|
国产大学生情侣呻吟视频
|
欧美在线视频免费
|
给我免费的视频在线观看
|
一级黄色片美国
|
亚洲欧美日韩网站
|
欧美日韩成人一区二区
|
久久久久久久久久久久91
|
97色在线视频
|
亚洲综合一区二区三区
|
一区二区三区免费
|