1移動機器人運動控制技術(shù)

　　移動機器系統(tǒng)是復(fù)雜的動力學(xué)系統(tǒng)，具有高度非線性和強耦合的特點。由于測量和建模不精確，加上負(fù)載的變化和外界干擾，很難獲得精確的系統(tǒng)模型，因此，精確模型的反饋控制率在對移動機器人的實際應(yīng)用中存在局限性，常用的控制方法主要有自適應(yīng)控制、滑?？刂?、魯棒控制、預(yù)測控制、最優(yōu)控制、智能控制等。

　　履帶式移動機器人是一種具有典型的非完整約束的移動機器人平臺，相比于輪式移動機器人平臺來說，受到更多不確定因素的影響。其行走機構(gòu)的機械誤差、自身質(zhì)量和轉(zhuǎn)動慣量、路面材質(zhì)和姿態(tài)情況、履帶與路面打滑情況等諸多因素都會對機器人的動力學(xué)特性產(chǎn)生影響。這些都為移動機器人的控制帶來了困難。

　　這種驅(qū)動方式?jīng)Q定了在建立機器人的運動學(xué)和動力學(xué)模型時，必須對履帶與地面的相對滑動建模。在機器人定位時要結(jié)合車輪轉(zhuǎn)速與其它傳感器所測量得到的如角速度、加速度等信息，通過多傳感器數(shù)據(jù)融合方法來進(jìn)行組合定位。在進(jìn)行運動控制時，要分析車輪打滑造成的對機器人動力學(xué)模型的影響。輪式滑動轉(zhuǎn)向移動機器人可以通過特技運動控制實現(xiàn)高速精確轉(zhuǎn)向。輪式滑動轉(zhuǎn)向移動機器的四輪驅(qū)動模式可以使得通過運動控制實現(xiàn)特技動作，完成一些利用常規(guī)技術(shù)很難實現(xiàn)的運動軌跡。

　　DEEC履帶式井下搜救機器人工作的環(huán)境位于煤礦井下，工作環(huán)境十分惡劣，具有高度的復(fù)雜性和不確定性，機器人行走的路面材質(zhì)、井下的道路狀況都有高度的復(fù)雜多變性，

　　2自抗擾控制技術(shù)

　　自抗擾控制器的發(fā)展始于一篇討論如何統(tǒng)一處理線性系統(tǒng)的結(jié)構(gòu)和反饋系統(tǒng)計算問題的論文中的一個重要結(jié)論：一個系統(tǒng)的積分器串聯(lián)型結(jié)構(gòu)不僅是線性系統(tǒng)在線性反饋變換下的標(biāo)準(zhǔn)結(jié)構(gòu)，也是一類非線性系統(tǒng)在非線性反饋變換下的標(biāo)準(zhǔn)結(jié)構(gòu)。

　　七十年代以來，中科院系統(tǒng)所的韓京清研究員經(jīng)過對線性系統(tǒng)理論的深入研究，發(fā)現(xiàn)一個系統(tǒng)的積分串聯(lián)型結(jié)構(gòu)不僅是線性系統(tǒng)在線性反饋變換下的標(biāo)準(zhǔn)結(jié)構(gòu)，也是一類非線性系統(tǒng)在非線性反饋變換下的標(biāo)準(zhǔn)結(jié)構(gòu)。同樣，對一類自由非線性系統(tǒng)，也可以設(shè)計其觀測器，使其在非線性觀測變換下的標(biāo)準(zhǔn)形為積分串聯(lián)型。

　　八十年代后期，韓京清研究員進(jìn)一步探討了線性系統(tǒng)與非線性系統(tǒng)的關(guān)系。他指出人們頭腦中的線性和非線性的概念大都來自于沒有控制輸入的經(jīng)典力學(xué)系統(tǒng)。在經(jīng)典力學(xué)系統(tǒng)中，人們關(guān)心的是描述和解釋軌線分布的拓?fù)浣Y(jié)構(gòu)，對沒有輸入、輸出的封閉系統(tǒng)來說，線性系統(tǒng)和非線性系統(tǒng)具有完全不同的拓?fù)浣Y(jié)構(gòu)，兩者不能任意轉(zhuǎn)化。然而控制系統(tǒng)具有經(jīng)典力學(xué)系統(tǒng)所沒有的新結(jié)構(gòu)—控制輸入和反饋，是一個開放系統(tǒng)?？刂葡到y(tǒng)中的反饋作用能夠破壞原系統(tǒng)中的大部分拓?fù)浣Y(jié)構(gòu)，又能建立起全新的拓?fù)浣Y(jié)構(gòu)。在狀態(tài)反饋作用之下，控制系統(tǒng)中不變的性質(zhì)幾乎只剩下幾個積分器和聯(lián)結(jié)它們的信息通道，此外的其他性質(zhì)幾乎可以隨意設(shè)置。因此，控制系統(tǒng)中的反饋作用打破了經(jīng)典動力系統(tǒng)意義下的線性和非線性的界限，反饋能夠把線性轉(zhuǎn)化為非線性，也可以把許多非線性轉(zhuǎn)化為線性。從反饋控制的角度看，不應(yīng)該再按經(jīng)典意義把控制系統(tǒng)分成線性和非線性系統(tǒng)，對能控的線性系統(tǒng)可以用狀態(tài)反饋設(shè)置一些非線性特性。以此為基礎(chǔ)，韓京清研究員提出了控制理論中更為基本的問題，即控制理論的發(fā)展到底是走模型論還是控制論的道路。他指出現(xiàn)代控制理論時期是控制理論發(fā)展史中的“模型論”時期，無論是線性系統(tǒng)還是非線性系統(tǒng)，無論是狀態(tài)空間法還是頻域法，系統(tǒng)的數(shù)學(xué)模型已成為分析與設(shè)計的出發(fā)點或建模與辨識的歸宿。然而依靠模型建立控制律的方法，在控制工程中遇到了很大的挑戰(zhàn)，魯棒性是首當(dāng)其沖的大問題。而經(jīng)典調(diào)節(jié)理論中的基本思想是不完全依靠系統(tǒng)的數(shù)學(xué)模型，而是靠期望軌跡與實際軌跡的誤差的大小和方向來實施，是一種基于過程誤差來抑制或消除誤差的方法來實現(xiàn)對系統(tǒng)的控制。他還指出尋求和利用某些具有典型特性的非線性環(huán)節(jié)是值得重視的問題，這正是自抗擾控制器產(chǎn)生的思想來源。

　　九十年代初期，韓京清研究員致力于一些特殊的非線性功能單元的開發(fā)，成功研究開發(fā)出非線性跟蹤微分器。他認(rèn)為不管對象是否線性，控制系統(tǒng)的設(shè)計思想應(yīng)該從極點配置等線性配置觀念轉(zhuǎn)移到非線性配置上，因為適當(dāng)?shù)姆蔷€性配置能顯著改善系統(tǒng)的品質(zhì)。據(jù)此，對模型已知的對象，用反饋效應(yīng)的觀點，給出了建立非線性狀態(tài)觀測器的方法，并用這種狀態(tài)觀測器和非線性配置方法實現(xiàn)了非線性系統(tǒng)的狀態(tài)反饋控制。數(shù)值仿真表明，這種非線性狀態(tài)觀測器跟蹤能力很強，控制系統(tǒng)的非線性配置明顯改善閉環(huán)品質(zhì)。這種思想亦可推廣到對象模型未知或者結(jié)構(gòu)已知、參數(shù)未知的系統(tǒng)。

　　通過對傳統(tǒng)PID調(diào)節(jié)器結(jié)構(gòu)及原理的分析，韓京清研究員發(fā)現(xiàn)其存在的一些問題。據(jù)此，韓京清研究員提出利用跟蹤微分器安排過渡過程，采用適當(dāng)?shù)姆蔷€性組合以及反饋律等相應(yīng)的改進(jìn)措施，提出新型的非線性PID控制算法，并驗證了這種新型算法有很好的魯棒性和適應(yīng)性。90年代中期，對觀測器形式的跟蹤微分器進(jìn)行改造而獲得了一類不確定對象的擴張狀態(tài)觀測器(ExtendedStateObserver,ESO)。ESO不僅能得到不確定對象的狀態(tài)，還能獲得對象模型中的內(nèi)擾和外擾的時實作用量，如果將這個時實作用量補償?shù)娇刂破髦校敲捶蔷€性PID中的積分作用就可以取消，再進(jìn)一步將控制器用于高階對象的控制時，一種新的控制律—線性狀態(tài)誤差反饋律(NonlinearStateErrorFeedback,NLSEF)產(chǎn)生了。通過對現(xiàn)代控制理論和PID優(yōu)缺點的分析，將現(xiàn)代控制理論對控制系統(tǒng)的認(rèn)識和現(xiàn)代的信號處理技術(shù)相結(jié)合，汲取經(jīng)典PID的思想精華，就形成了一種新型實用控制器—自抗擾控制器(AutoDisturbanceRejectionController,ADRC)。

　　如今，自抗擾控制器已經(jīng)經(jīng)歷了30多年的發(fā)展歷程。由于該控制器算法簡單，參數(shù)適應(yīng)性廣，是解決非線性、不確定性、強干擾、強耦合、大時滯等控制問題的一種有效方法，具有較強的適應(yīng)性、魯棒性和可操作性，越來越多的科研工作者加入到自抗擾控制算法的研究行列中。目前，自抗擾控制器已經(jīng)在電機控制、過熱汽溫控制、動力調(diào)諧陀螺儀、單級旋轉(zhuǎn)倒立擺、機器人控制、大射電望遠(yuǎn)鏡艙位姿態(tài)控制、飛行器姿態(tài)控制、船舶減搖鰭等諸多領(lǐng)域得到應(yīng)用，并取得了良好的控制效果。

　　研究自抗擾控制器在船舶航向控制系統(tǒng)中的應(yīng)用，不僅可以拓展自抗擾控制器的應(yīng)用領(lǐng)域，而且可以有效的提高船舶的控制品質(zhì)，具有很好的研究意義。

　　3DEEC機器人橫向運動自抗擾控制器設(shè)計

　　3.1二階系統(tǒng)自抗擾控制器的一般形式

　　很多被控對象可以簡化成如下形式：

其中，w為對象外部擾動，u為控制量，b(t)為控制量放大系數(shù)，y為輸出， f（x，w，t）是對象“總擾動”。對于該一階對象，其ADRC控制器的標(biāo)準(zhǔn)結(jié)構(gòu)一般如圖1所示。

圖1 ADRC控制器的標(biāo)準(zhǔn)結(jié)構(gòu)

      由圖1可見，ADRC由三部分組成：“安排過渡過程”，“非線性反饋(NF)”和“擴張狀態(tài)觀測器(ESO)”。圖中，v0為控制目標(biāo)，v1是v0的跟蹤信號；z1是系統(tǒng)輸出y的估計，z2是對象總擾動f(x,w,t)的估計；e是誤差，u0是NF的輸出，b0是b(t)的估計。

   安排過渡過程：

      在一般的控制系統(tǒng)中,誤差直接取成:

      e = v - y

      式中, v 為設(shè)定值; y 為系統(tǒng)輸出。

      誤差的這種取法使初始誤差很大,易引起“超調(diào)”,很不合理。根據(jù)對象承受的能力,我們先安排合理的過渡過程v1 ( t ) , 然后誤差取成e =v1(t)-y，這是解決PID 的“快速性”和“超調(diào)”之間矛盾的有效辦法, 也是提高調(diào)節(jié)器“魯棒性”的一種辦法。

      在實際工程問題中，常存在由不連續(xù)或帶隨機噪聲的量測信號合理地提取連續(xù)信號及微分信號的問題。過去采取的是線性微分器及線性濾波手段，但是仍不能滿意解決問題，跟蹤微分器就是利用非線性函數(shù)來實現(xiàn)對輸入信號廣義導(dǎo)數(shù)的一種光滑逼近。

　　跟蹤微分器就是一個信號處理環(huán)節(jié)，自抗擾控制器主要是充分利用了它的跟蹤特性和提取微分信號的特點，實現(xiàn)了對輸入信號過渡過程的安排及微分信號的提取。特別地，當(dāng)輸入信號發(fā)生突變時，跟蹤微分器可以為控制器提供光滑的輸出信號作為輸入，使控制量輸出連續(xù)地變化，不會因為輸入的突變而產(chǎn)生超調(diào)，增強了系統(tǒng)的穩(wěn)定性。跟蹤微分器給出了閉環(huán)系統(tǒng)的一種可以實現(xiàn)的動態(tài)性能指標(biāo)，這種給定對于被控對象來說不再是一種穩(wěn)態(tài)的期望值，而是一種可實時跟蹤的曲線。同時，在輸入信號存在外界擾動時，跟蹤微分器還可以實現(xiàn)濾波的作用。

　　擴張狀態(tài)觀測器

　　擴張狀態(tài)觀測器是韓京清于1995年提出的一種新型狀態(tài)觀測器，它能跟蹤系統(tǒng)的各階狀態(tài)變量，估計系統(tǒng)未建模動態(tài)和系統(tǒng)外擾的總作用量，同時對系統(tǒng)的未建模動態(tài)和外擾進(jìn)行補償，利用非線性環(huán)節(jié)實現(xiàn)了對非線性系統(tǒng)的動態(tài)反饋線性化，是自抗擾控制器的核心。

　　對于系統(tǒng)方程

　　以看到，式（3-19）形式相同，即擴張狀態(tài)的前饋補償將非線性不確定系統(tǒng)轉(zhuǎn)化為線性系統(tǒng)標(biāo)準(zhǔn)型：積分串聯(lián)型。

　　可見，擴張狀態(tài)觀測器將被控系統(tǒng)中含有的非線性動態(tài)、模型不確定性及外部擾動等都視為擴張狀態(tài)加以實時觀測、估計，利用前饋環(huán)節(jié)對擴張狀態(tài)觀測值進(jìn)行補償，實現(xiàn)了非線性系統(tǒng)的反饋線性化。

　　對于二階系統(tǒng)

　　非線性誤差反饋

　　首先介紹一下非線性函數(shù)fal。在實際控制工程界，常用到經(jīng)驗知識：“大誤差，小增益；小誤差，大增益”。而非線性函數(shù)函數(shù)

圖3 非線性函數(shù)fal示意圖

圖4 自抗擾控制器的結(jié)構(gòu)圖

　　由此，得到了自抗擾控制器的三個組成部件：跟蹤微分器(TrackingDifferentiator,TD)，擴張狀態(tài)觀測器(ExtendedStateObserver,ESO)和非線性誤差反饋(NonlinearStateErrorFeedback,NLSEF)。其中，跟蹤微分器TD的作用是安排過渡過程，實現(xiàn)對系統(tǒng)輸入信號的快速無超調(diào)跟蹤，并給出良好的微分信號。擴張狀態(tài)觀測器ESO用來估計系統(tǒng)狀態(tài)、模型和外擾，是自抗擾控制器的核心部分。擴張狀態(tài)觀測器把有未知外擾的非線性不確定對象反饋化為“積分器串聯(lián)型”以后，就可以設(shè)計出理想的基于“狀態(tài)誤差反饋”控制器。對“狀態(tài)誤差反饋”采用合適的合適的“非線性配置”，就實現(xiàn)了非線性狀態(tài)誤差反饋控制律。其中擾動的自動估計與補償正是最為關(guān)鍵的一環(huán)，“自抗擾控制器”也因此而得名。

　　ADRC的離散算法

　　將上述理論進(jìn)行離散化后可得ADRC各環(huán)節(jié)的離散化公式如下：

　　安排過渡過程

　　3.2DEEC機器人橫向運動控制器設(shè)計

　　DEEC機器人運動學(xué)方程

　　DEEC機器人采用3臺Maxthon大功率直流有刷電機，一臺用于驅(qū)動履帶臂，兩臺驅(qū)動左右履帶輪。機器人的最大移動速度為1m/s，最大回轉(zhuǎn)速度為60°/s，可以實現(xiàn)零半徑轉(zhuǎn)彎，也可以按制定半徑轉(zhuǎn)彎。由于本節(jié)主要分析車體的橫向運動，所以不考慮履帶臂的影響，建立的模型只考慮左右兩履帶輪。為了使機器人有更大的智能性，我們對其進(jìn)行建模。為進(jìn)行橫向控制，我們模型基礎(chǔ)上開發(fā)相應(yīng)的控制算法。

　　機器人模型運動曲線如圖5所示。圖5中，XOY為地球固連參考坐標(biāo)系，為右手坐標(biāo)系；坐標(biāo)O為機器人的運動起點；機器人經(jīng)過時間t，從O點運動到M點（機器人的幾何中心的移動）。由此可以推導(dǎo)出如下關(guān)系式：

　　結(jié)束語

　　ADRC技術(shù)在DEEC機器人運動控制器設(shè)計中發(fā)揮了重要作用，本文在此基礎(chǔ)上詳細(xì)闡述了DEEC機器人橫向控制器的設(shè)計，并對運行參數(shù)進(jìn)行了整定，得到了較好的控制效果。