侵權投訴

通過串級PID算法對直立車的平衡及運動的控制方案

電子設計 2021-01-18 16:10 次閲讀

作者:徐厚華 何哲嘉 向穎鋒

直立平衡車因其動力學系統同時具有多變量,非線性,不穩定,強耦合等特性,傳統的單環PID控制平衡已經略顯吃力。本文將採用內環角速度PI控制、外環角度PD控制及最外環速度PI控制組成的串級 PID算法來控制直立車的平衡及運動,串級PID控制器比常規PID控制系統具有較強的穩定性、抗干擾性。

o4YBAGAFQM-ADtG3AAcRnrI04o0052.png

▲ 製作的節能直立組車模

■ 前言

智能車是現代汽車工業和電子計算機等科技成果相結合的產物, 具有自動識別道路的功能從而實現自動駕駛。兩輪直立小車廣泛的應用於倉庫物流運輸以及巡邏的代步工具等方面[1]。兩輪直立智能車賽題在大學生智能車競賽中已經出現快十年,直立車的控制算法也日趨多樣,兩輪直立智能車在賽道中,需同時兼顧速度、平衡與循跡,姿態與循跡控制效果的優劣直接決定行駛平均速度的高低[2]。直立車模本身只具有一個執行機構,即兩個主控馬達。對於傳統PID控制,涉及到平衡角度環和速度環控制輸出複用一個執行機構問題,為提升在較高速度下的運行性能,對傳統算法進行了一定程度的改進,提出一種基於串級PID的直立車姿態控制算法。

01串激PID控制

直立車由雙電機驅動,左右電機為控制對象,控制器需具有直立、行駛同時兼顧轉向的功能。傳統直立車控制算法,大多采用角度環輸出與速度環輸出線性疊加,在高速行駛狀態時姿態的跟隨能力欠佳,在此在傳統算法基礎上將速度-角度進行了串聯,並增加了角速度為最內環迴路。串級PID 控制器輸出後經過處理換算為PWM,輸入驅動板後可使直立車行駛。

o4YBAGAFQRGAVwk7AAHGgqAz9B0666.png

▲ 系統總體框圖

1.1傳統直立車PID控制系統

直立車傳統控制系統如圖1所示。為使其具有速度控制與姿態平衡能力,利用2個單獨的閉環分別進行控制,輸出電機控制信號為各環輸出的疊加。該控制方案雖簡單但存在一定問題,如:僅單獨施加直立控制,其車身平衡效果雖能滿足要求,但此時如果在該基礎上額外施加速度控制,速度控制勢必會打破直立車的平衡姿態,使得速度與直立控制互相耦合,此時如果再施加轉向控制,就會導致高速時轉向控制實時性和姿態的平衡性欠佳。

o4YBAGAFQR-ASpz3AAEsah5Vq3A507.png

▲ 圖1 直立車傳統控制框圖

傳統位置式PID控制算法公式[3]:

pIYBAGAFQS2AFkeTAABe5X0Se9I295.png

其中P(k)為調節器輸出,e(t)是當前角度誤差,Kp比例係數,Ki積分系數,Kd微分系數。

1.2直立車串級PID 控制

串級PID控制系統結構如圖2所示。

o4YBAGAFQUCAIatdAACHV_o285Q375.png

▲ 圖2 直立車串級控制系統框圖

串級PID外環控制算法如公式2:

pIYBAGAFQUyAZ6kZAABnLq7slaU627.png

式中ω ( k ) \omega \left( k \right)ω(k)為外環調節器輸出,θ ( k ) \theta \left( k \right)θ(k)是當前角度誤差。

內環PID控制算法公式:

o4YBAGAFQVqAR_QpAACGf-F3y1E969.png

式中p(k)為內環調節器輸出,e(k)是當前角速度誤差,ω ( t ) \omega \left( t \right)ω(t)為當前角速度。

如圖2所示,行駛閉環控制車模的行駛姿態和運行速度。在行駛速度閉環中,速度PID 計算輸出的值為直立車在機械零點角需要前傾或者後仰的角度,該輸出值需與機械零點角相加才能將速度控制轉化為角度控制,而角度的變化是要由角速度產生的俯仰角度PID 計算輸出值為直立車需要保持的角速度,俯仰角速度PID 計算結果即為串級行駛閉環的輸出值

直立車平衡控制使用串級PID,外環角度,內環角速度,最外環速度,只需要通過姿態傳感器採集一個軸的數據即可。速度環100ms環控制一次,角度環10ms進行一次控制,角速度環2ms控制一次,外環輸出先加一個限幅才傳給內環,實測效果非常穩定,不會震盪,也不會出現明顯的反應滯後。速度控制和平衡控制,轉化為角度和角速度的控制,整個控制系統中僅僅有角速度環的輸出給電機控制,原理上可以有效地消除傳統速度PID 與直立平衡PID 並聯所產生的耦合。

1.3算法實現

串級PID算法的實現在於角速度環、角度環和速度環控制的不同週期。初始化程序完成之後,啓動週期為2 ms的定時中斷。PIT 中斷要為循環中的算法提供程序執行的時序標誌位控制,根據標誌位實現不同週期執行不同控制環節,這種程序結構有助於提高算法的執行效率以及實時性。中斷服務函數中具體控制的算法流程[4]如圖3所示。

pIYBAGAFQW2AeDMeAADRuiQdpZw482.png

▲ 圖3 中斷程序框圖

1.4串級PID參數整定

由於串級控制,速度環、角度環和角速度環會互相影響,所以調節參數時應該從內環開始整定。先令外環(角度環、速度環)調節器目標值為零,然後開始整定內環(角速度)PID參數,因為陀螺儀測量角速度過程中會不斷積累誤差以及各種噪聲的干擾,最終造成系統的穩態誤差,所以角速度環採用PI控制來降低系統的穩態誤差,調整參數至直立車能夠做緩慢的自由落體運動,此時內環參數整定完成。

調整好角速度環後就可以開始整定角度環PID參數了,角度環採用PD控制,調節到直立車能夠快速響應在機械零點保持平衡,給一個干擾後能快速回到平衡位置且不發生震盪就算調節好外環參數。

速度環採用PID調節,速度環的參數整定最後來完成,先應該通過設定目標值為零來確定參數的極性,然後通過觀察車模實際運行狀態,通過上位機觀察各數據來給定參數。

02方案對比分析

當系統受到多級噪聲時,內環會先進行調整,再由外環進行調整,所以控制的精度和穩定性都優於單極PID控制[5]。通過實際小車運行狀態來看,如圖4所示。傳統算法圍繞中線產生了較大過調;串級PID算法過調明顯較小,且跟隨能力遠強於傳統算法,可以看出常規PID 的穩定時間比串級控制短。串級PID控制器比常規PID 控制系統具響應迅速,穩定性高等優點[6]。

pIYBAGAFQX-ADzMgAAD-Ds6_UXc041.png

▲ 圖4實驗數據圖

03結論

串級 PID 相比典型的 PID 算法控制更精準、穩定,系統內環為角速度環,外環為角度環,經過系統測試,能夠實現良好的平衡控制效果。由於串級算法實現簡單且實用,對傳統方案進行改進不需要額外的硬件要求,在直立車控制上具有一定的工程推廣和參考價值。

參考文獻:

[1]潘飛。基於KEA128芯片的直立電磁小車設計[J]。電子技術與軟件工程,2019(10):98-99.

[2]王英傑,孟威李靈恩,姚曉晨,張寧博。改進的兩輪直立車多回路控制[J]。自動化與儀表,2019,34(12):39-44.

[3]徐溳基,肖城鋼,李婷,龔明,陳芳。串級PID算法在滾球控制系統中的應用[J]。現代電子技術,2020,43(09):122-125.

[4]謝丹妮。 直立智能車運動控制設計與實現[D]。湖南大學,2017.

[5]喬緯國。 一種採用雙PID串級控制的雙輪自平衡車的研製[D]。吉林大學,2017.

[6]周瓚,徐海榮。基於串級PID閉環控制的飛行控制原理仿真實驗[J]。電子製作,2019(21):52-54.
編輯:hfy

收藏 人收藏
分享:

評論

相關推薦

詳解DSP的機載伺服控制系統設計

伺服系統本質上就是一種隨動系統,本文介紹的伺服系統為一維伺服轉枱,用於控制一種機載天線實時跟隨另一種....
的頭像 hk4pxcom網工程師 發表於 04-08 16:29 110次 閲讀
詳解DSP的機載伺服控制系統設計

深度解讀自動封裝系統中運動控制的設計與實現

針對現代化工業加工和自動化生產線上廣泛採用的3軸運動控制系統的控制要求及特點,詳細介紹ACR1505....
的頭像 hk4pxcom網工程師 發表於 04-08 12:00 115次 閲讀
深度解讀自動封裝系統中運動控制的設計與實現

System Generator中的PID控制器是如何設計的?

FPGA中的數字控制器是什麼? System Generator中的PID控制器是如何設計的? ...
發表於 04-08 06:51 0次 閲讀
System Generator中的PID控制器是如何設計的?

超清晰詳解PID控制算法!!!電賽,智能車,電機控制等必備‘倚天劍’!

發表於 04-07 16:51 191次 閲讀
超清晰詳解PID控制算法!!!電賽,智能車,電機控制等必備‘倚天劍’!

PID各參數對運算輸出的影響

PID各參數對PID運算輸出的影響。進而分析各參數影響的曲線形狀。通過相關的曲線形狀,瞭解PID參數....
發表於 04-07 15:29 17次 閲讀
PID各參數對運算輸出的影響

高級PID控制算法

在本節中,我們將討論如何使用最常用的控件算法(PID)以及一些改善性能,調整和查找循環的技巧費率等。
發表於 04-06 15:32 10次 閲讀
高級PID控制算法

簡述LIN協議驅動器的關鍵技術及設計原理

引言:LIN總線做為CAN總線的有效補充,在低端車身電子領域替代CAN總線,既能滿足功能要求,又能節....
的頭像 hk4pxcom網工程師 發表於 04-06 10:53 143次 閲讀
簡述LIN協議驅動器的關鍵技術及設計原理

一文詳細解析到底什麼是積分飽和

理想的PID算法往往不能滿足實際使用中的很多場景,比如積分飽和的問題,因此需要在此基礎上對積分器做抗....
的頭像 hk4pxcom網工程師 發表於 04-05 05:38 216次 閲讀
一文詳細解析到底什麼是積分飽和

PID參數的設定調節

閉環控制系統(closed-loop control system)的特點是系統被控對象的輸出(被控....
發表於 04-04 17:06 39次 閲讀
PID參數的設定調節

西門子S7-300PLC的PID功能塊的應用經驗

同時也明白了PID功能塊有時間動作正常,有時間動作不正常的原因:有時在灌入程序後保持繼電器處於動作的....
發表於 04-04 08:58 62次 閲讀
西門子S7-300PLC的PID功能塊的應用經驗

基於PLC實現PID控制器的改進設計

在工業生產中,常需要採用閉環控制方式來控制温度、壓力、流量等連續變化的模擬量。無論是使用模擬控制器的....
的頭像 電子設計 發表於 03-28 09:56 220次 閲讀
基於PLC實現PID控制器的改進設計

改進的足球機器人PID調節器設計

一種改進的足球機器人PID調節器設計説明。
發表於 03-26 11:07 29次 閲讀
改進的足球機器人PID調節器設計

基於Nios的直流電機PID調速控制系統

一種基於Nios:軟核的直流電機PID控制系統。採用PWM直流電機調速方案,利用Altera公司推出....
發表於 03-26 09:59 36次 閲讀
基於Nios的直流電機PID調速控制系統

基於PID技術實現數據採集模塊中OPC接口的設計

OPC接口的設計包括OPC服務器端和客户端兩個部分,其實質就是連接數據源和數據使 用者之間的通道。目....
的頭像 電子設計 發表於 03-26 09:02 319次 閲讀
基於PID技術實現數據採集模塊中OPC接口的設計

三菱PLC實現温度PID閉環控制系統

在温度控制系統中,電加熱器加熱,温度用熱電耦檢測,與熱電耦型温度傳感器匹配的模擬量輸入模塊fx2n-....
發表於 03-25 09:48 50次 閲讀
三菱PLC實現温度PID閉環控制系統

機器人PID控制概述

為應各種要求,使機器人可完成各種任務和動作。作為計算機系統中的關鍵技術,計算機控制技術包括範圍十分廣....
發表於 03-24 15:49 179次 閲讀
機器人PID控制概述

PID調節設置規律

比如説負反饋控制的P放大的倍數太大了的話就會超調振盪。另一個問題,負反饋出來的值和跟設定的信號值,這....
發表於 03-24 11:45 142次 閲讀
PID調節設置規律

使用PID設計兩輪智能平衡小車的資料合集

本文檔的主要內容詳細介紹的是使用PID設計兩輪智能平衡小車的資料合集包括了:原理圖PCB程序源碼BO....
發表於 03-24 09:12 47次 閲讀
使用PID設計兩輪智能平衡小車的資料合集

PID控制器參數整定的方法

一是理論計算整定法。它主要是依據系統的數學模型,經過理論計算確定控制器參數。這種方法所得到的計算數據....
發表於 03-23 14:18 1571次 閲讀
PID控制器參數整定的方法

到底什麼是串級PID

什麼是串級PID?顧名思義就是兩個串起來的PID,下面是一個雙閉環的例子,外環是位置環,內環是速度環....
發表於 03-17 19:14 63次 閲讀
到底什麼是串級PID

基於布穀鳥搜索算法的PID擁塞控制模型

無線傳感器網絡內多個移動節點在採集、接收和發送數據時,數據來源的不規律性會造成節點瞬間接收大量數據,....
發表於 03-17 10:43 24次 閲讀
基於布穀鳥搜索算法的PID擁塞控制模型

PID算法及其FPGA實現的詳細資料説明

PID 控制器結構清晰,參數可調,適用於各種控制對象, PID 控制器的核心思想是針對控制對象的控制....
發表於 03-12 17:40 64次 閲讀
PID算法及其FPGA實現的詳細資料説明

什麼是串級PID?

什麼是串級PID? 單環PID的偽算法
發表於 03-07 08:11 0次 閲讀
什麼是串級PID?

角度單環PID/串級PID的原理圖

角度單環PID的原理圖 串級PID的原理圖
發表於 03-07 06:42 0次 閲讀
角度單環PID/串級PID的原理圖

電動不鏽鋼法蘭球閥設定的要求都有哪些

電動不鏽鋼法蘭球閥的佈局標準 電動不鏽鋼法蘭球閥應依據管路及儀表盤流程表(PID)上所顯示種類及總數....
發表於 03-05 14:14 50次 閲讀
電動不鏽鋼法蘭球閥設定的要求都有哪些

實例分析:簡單PID和串級PID的優劣

什麼是串級PID? 什麼是串級PID?顧名思義就是兩個串起來的PID,下面是一個雙閉環的例子,外環是位置環,內環是速度環,...
發表於 02-27 07:00 843次 閲讀
實例分析:簡單PID和串級PID的優劣

PID的詳細調試資料免費下載

沒有一種控制算法比PID 調節規律更有效、更方便的了。現在一些時髦點的調節器基本源自PID 。甚至可....
發表於 02-26 10:04 44次 閲讀
PID的詳細調試資料免費下載

PID運算程序初始化程序的編寫思路及程序的實現

PID運算程序初始化程序等的編寫思路和具體的程序實現...
發表於 02-26 08:27 606次 閲讀
PID運算程序初始化程序的編寫思路及程序的實現

基於DSP芯片TMS320F2812實現感應加熱電源的設計

目前,感應加熱電源已廣泛用於金屬熔鍊、透熱、焊接、彎管、表面淬火等熱加工和熱處理行業。然而傳統感應加....
發表於 02-25 10:19 1437次 閲讀
基於DSP芯片TMS320F2812實現感應加熱電源的設計

PID温度控制裝置的電路設計資料詳細説明

本文介紹了過程温度控制 PID 電路和可控硅觸發電路的設計及其工作原理 , 作者在設計電路的基礎上開....
發表於 02-23 08:00 113次 閲讀
PID温度控制裝置的電路設計資料詳細説明

變頻恆壓供水控制器的維修保養及疑難問題的講解

1,線性高:軟啓動器的嵌入PID控制器,及時監管工作壓力實際值,(變頻恆壓供水控制器)隨資金分配數量....
發表於 02-22 14:05 214次 閲讀
變頻恆壓供水控制器的維修保養及疑難問題的講解

採用PID控制算法實現無刷直流電機的速度控制方案

  對無刷直流電機轉速的控制即可採用開環控制,也可採用閉環控制。與開環控制相比,,速度控制閉環系統的機械特性有以下優越性...
發表於 02-20 16:22 2940次 閲讀
採用PID控制算法實現無刷直流電機的速度控制方案

電熱恆温油浴鍋DU-20產品的技術參數説明

電熱恆温油浴鍋DU-20產品特點: ● 微電腦PID温度控制器,控温精確可靠,帶定時。 ● 內膽和外....
發表於 02-19 10:29 44次 閲讀
電熱恆温油浴鍋DU-20產品的技術參數説明

PID控制器的參數整定

它主要依賴工程經驗,直接在控制系統的試驗中進行,且方法簡單、易於掌握,在工程實際中被廣泛採用。PID....
發表於 02-09 17:22 256次 閲讀
PID控制器的參數整定

PID控制器各校正環節

綜上所述,P—比例控制系統的響應快速性,快速作用於輸出,好比“現在”(現在就起作用,快),I—積分控....
發表於 02-09 17:19 206次 閲讀
PID控制器各校正環節

軟件的PID程序資料合集免費下載

本文檔的主要內容詳細介紹的是軟件的PID程序資料合集免費下載。
發表於 02-01 11:08 70次 閲讀
軟件的PID程序資料合集免費下載

PID控制詳解,硬件實現PID和軟件實現PID控制的講解

PID控制詳解 PID控制簡介 PID( Proportional Integral Derivative)控制是最早發展起來的控制策略之一,由於其算...
發表於 01-25 17:19 799次 閲讀
PID控制詳解,硬件實現PID和軟件實現PID控制的講解

PID控制的詳細資料説明

PID(比例,積分,微分)控制沒有看起來那麼複雜,閲讀下面簡單的實現步驟,效果立竿見影。在工作中,我....
發表於 01-21 15:06 128次 閲讀
PID控制的詳細資料説明

PID的調試方法詳細介紹

衰減曲線法是在總結臨界比例帶法基礎上發展起來的, 它是利用比例作用下產生的 4:1 衰減振盪 (ψ=....
發表於 01-20 10:18 151次 閲讀
PID的調試方法詳細介紹

【hk4pxcom】2020年度top10榜單——電機控制經驗

本榜單彙總了2020年閲讀量最多的經驗帖,都是深受各位電機控制愛好者喜歡的電機控制經驗,相信你也能從中找到適合自己的知識,快...
發表於 01-19 14:02 1122次 閲讀
【hk4pxcom】2020年度top10榜單——電機控制經驗

一個DSP的PID控制算法實現的例程實例説明

 一下是我附上的一個pid 控制程序例程(2407 的) ,請教高手,這裏邊ki 是Q31 格式的,....
發表於 01-15 16:55 134次 閲讀
一個DSP的PID控制算法實現的例程實例説明

CC3D的兩大飛行模式的原理詳細介紹

本文主要介紹一下 CC3D 的兩大飛行模式的原理:1. Rate 2. Attitude. 以及 P....
發表於 01-14 08:00 212次 閲讀
CC3D的兩大飛行模式的原理詳細介紹

振盪水槽的具體工作原理是怎樣的

產品特點: ● 採用不鏽鋼內膽、頂蓋,防腐蝕、易清潔。 ● 微電腦PID温度控制器,控温精確可靠,帶....
發表於 01-11 16:18 110次 閲讀
振盪水槽的具體工作原理是怎樣的

黴菌培養箱BPMJ-70F產品技術參數的介紹

黴菌培養箱BPMJ-70F產品簡述: 新一代培養箱,集公司十多年在設計和製造方面經驗,順應世界環保潮....
發表於 01-11 15:36 151次 閲讀
黴菌培養箱BPMJ-70F產品技術參數的介紹

什麼是加熱循環槽,它的特點是什麼

新一代恆温水浴系統,集公司多年設計和生產經驗,引進消化德國技術,主要零部件均採用進口產品,具有高質、....
發表於 01-11 13:22 87次 閲讀
什麼是加熱循環槽,它的特點是什麼

數字PID控制算法的學習筆記免費下載

①位置式算法每次輸出與整個過去狀態有關,計算式中要用到過去偏差的累加值,容易產生較大的累計誤差。而增....
發表於 01-11 08:00 99次 閲讀
數字PID控制算法的學習筆記免費下載

電機綜合測試系統的技術參數和應用特點分析

電機綜合測試系統採用智能的PID控制架構,系統由加載台、加載電機、傳感器、控制器、電參數測試儀器、自....
的頭像 牽手一起夢 發表於 01-09 09:40 495次 閲讀
電機綜合測試系統的技術參數和應用特點分析

集成式磁力攪拌水/油浴鍋技術特徵的介紹

恆温磁力攪拌水/油浴鍋DU-3GO產品簡述: 新一代油浴鍋是抗腐蝕不鏽鋼與微電腦的完美結合,提供給您....
發表於 01-07 09:59 88次 閲讀
集成式磁力攪拌水/油浴鍋技術特徵的介紹

微孔板孵育器是什麼,它都適用於哪些試驗

產品簡述: BK100-4A微孔板恆温孵育器採用微處理技術結合PID控制方式而形成的微孔板恆温孵育器....
發表於 01-06 11:17 143次 閲讀
微孔板孵育器是什麼,它都適用於哪些試驗

PID控制中P、I、D參數分別有什麼作用

  PID控制中有P、I、D三個參數,只有明白這三個參數的含義和作用才能完成控制器PID參數整定,讓....
的頭像 工業機器人前沿 發表於 12-25 17:24 1237次 閲讀
PID控制中P、I、D參數分別有什麼作用

伺服電機抖動原因分析與伺服電機抖動怎麼調分解

在哪幾種情況下會造成伺服電機抖動?怎樣才能解決這些伺服電機抖動帶來的問題?分別是怎麼解決的? 例如:....
發表於 12-22 11:54 1048次 閲讀
伺服電機抖動原因分析與伺服電機抖動怎麼調分解

CC3D的兩大飛行模式的原理詳細説明

 本文主要介紹一下CC3D的兩大飛行模式的原理:1. Rate 2. Attitude. 以及PID....
發表於 12-18 08:00 215次 閲讀
CC3D的兩大飛行模式的原理詳細説明

如何使用歐姆龍PLC實現PID調節

PLC 控制模擬量時,PID 調節是較好的方法之一。本文以歐姆龍 PLC 為代表,詳細闡述了用算術運....
發表於 12-17 08:00 403次 閲讀
如何使用歐姆龍PLC實現PID調節

基於AI808和MCGS5.5組態軟件實現串聯雙容水箱系統的設計

串聯雙容水箱在工業過程控制中應用非常廣泛。在串聯雙容水箱水位的控制中,進水首先進人第一個水箱,然後通....
的頭像 電子設計 發表於 12-15 18:13 834次 閲讀
基於AI808和MCGS5.5組態軟件實現串聯雙容水箱系統的設計

PID到底是個啥?

所以,在大多數場合中,用“開關量”來控制一個物理量,就顯得比較簡單粗暴了。有時候,是無法保持穩定的。....
的頭像 旺材芯片 發表於 12-11 10:11 670次 閲讀
PID到底是個啥?

CH402和CH902智能型數字顯示温度控制器的使用説明書

本文檔的主要內容詳細介紹的是CH402和CH902智能型數字顯示温度控制器的使用説明書。
發表於 12-08 08:00 296次 閲讀
CH402和CH902智能型數字顯示温度控制器的使用説明書

FC5A系列PID模塊的使用説明書

FC5A系列PLC配套PID模塊 用於設備的PID控制
發表於 12-08 08:00 126次 閲讀
FC5A系列PID模塊的使用説明書

2200系列PID調節器的安裝及操作手冊免費下載

本文檔的主要內容詳細介紹的是2200系列PID調節器的安裝及操作手冊免費下載。
發表於 12-08 08:00 74次 閲讀
2200系列PID調節器的安裝及操作手冊免費下載

EV系列PID温度控制器操作手冊免費下載

本文檔的主要內容詳細介紹的是EV系列PID温度控制器操作手冊免費下載。
發表於 12-07 08:00 109次 閲讀
EV系列PID温度控制器操作手冊免費下載