段文杰，武穎，劉大亮

（1.山西農(nóng)業(yè)大學(xué) 工學(xué)院，山西 太谷030801；2.太原理工大學(xué) 機(jī)械工程學(xué)院，山西 太原030013；3.首都航天機(jī)械公司，北京100076）

球形機(jī)器人［1］、獨(dú)輪機(jī)器人［2］以及雙輪機(jī)器人［3］的運(yùn)動(dòng)控制問(wèn)題一直是該研究領(lǐng)域的重要內(nèi)容［4］。多數(shù)情況下，在平面內(nèi)，這3類(lèi)機(jī)器人的運(yùn)動(dòng)可以簡(jiǎn)化為一均質(zhì)圓盤(pán)的垂直滾動(dòng)。本文首先利用拉格朗日方法［5］建立均質(zhì)圓盤(pán)垂直滾動(dòng)的一階鏈?zhǔn)椒峭暾到y(tǒng)模型；其次利用反步法［6～8］設(shè)計(jì)系統(tǒng)的穩(wěn)定運(yùn)動(dòng)控制算法，并證明了算法是漸進(jìn)穩(wěn)定的。狀態(tài)鎮(zhèn)定和路徑跟蹤仿真實(shí)驗(yàn)結(jié)果表明該算法是有效的、可行的。

1 系統(tǒng)建模

如圖1所示，圓盤(pán)的位形由坐標(biāo)平面上的位置x和y，進(jìn)動(dòng)角θ和圓盤(pán)的自轉(zhuǎn)角ψ確定，記為q＝（x，y，ψ，θ）。圓盤(pán)的半徑為r。對(duì)圓盤(pán)施加的力矩分別為繞鉛垂軸的轉(zhuǎn)向力矩τ1和自轉(zhuǎn)動(dòng)力矩τ2。圓盤(pán)作無(wú)滑動(dòng)的純滾動(dòng)，該速度約束可以表示為

圖1 系統(tǒng)坐標(biāo)系與運(yùn)動(dòng)模型Fig.1 Coordinate system and motion mode

記m為圓盤(pán)的質(zhì)量，J1，J2分別為關(guān)于鉛垂軸和水平滾動(dòng)軸的轉(zhuǎn)動(dòng)慣量，則系統(tǒng)的拉格朗日函數(shù)［9，10］為

其中，常值慣性矩陣 M ＝diag（m，m，J1，J2）。經(jīng)計(jì)算得到系統(tǒng)的動(dòng)力學(xué)方程為

其中ui＝τi／Ji，i＝1，2。如果系統(tǒng)的輸入控制表示為˙ψ＝ω1和˙θ＝ω2，通過(guò)對(duì)半徑r的單位正則化處理后，運(yùn)動(dòng)學(xué)形式的模型可以表示為

在θ∈（－π／2，π／2）上，應(yīng)用坐標(biāo)和輸入控制變換

可以得到一個(gè)一階鏈?zhǔn)椒峭暾到y(tǒng)

2 運(yùn)動(dòng)控制算法

定理：存在時(shí)不變且有界的狀態(tài)反饋

在

上，當(dāng)t＞0時(shí)，系統(tǒng)（5）的狀態(tài)x指數(shù)收斂至零。其中k1，k2和k3為正數(shù)，且k3＞k1。

證明：應(yīng)用線性狀態(tài)反饋

使x1指數(shù)穩(wěn)定，其中k1為正常數(shù)。系統(tǒng)（5）變?yōu)?/p>

考慮x3子系統(tǒng)，將x2看成是Ω上的輸入控制，設(shè)計(jì)反饋控制

3）資源豐富，情境真實(shí)。微課的核心就是視頻的展現(xiàn)和多媒體課件，里面包含專(zhuān)家的點(diǎn)評(píng)和教學(xué)反思，還有練習(xí)和測(cè)驗(yàn)，可以給學(xué)生創(chuàng)設(shè)一個(gè)具象化的情境。微課的這一特點(diǎn)在國(guó)內(nèi)外的微課交流平臺(tái)上都展現(xiàn)出來(lái)。當(dāng)前微課不應(yīng)只是視頻資源，還要將微課平臺(tái)發(fā)展成一個(gè)互動(dòng)性教學(xué)平臺(tái)，不光有練習(xí)和測(cè)驗(yàn)，還要有知識(shí)講解、學(xué)習(xí)反饋等資源，這些配套的資源能對(duì)學(xué)生自主學(xué)習(xí)發(fā)揮重要作用[4]。

以穩(wěn)定原點(diǎn)x3＝0，其中x1不為零。取Lyapunov函數(shù)V1為

上式對(duì)時(shí)間的導(dǎo)數(shù)得

因此，˙x3＝－k3x3的原點(diǎn)是漸近穩(wěn)定的。應(yīng)用微分同胚變量代換

對(duì)（11）求導(dǎo)得

則x2和x3子系統(tǒng)變換為

取Lyaponov函數(shù)V2為

取

從而得

則x3和ξ是有界的，且當(dāng)t→0時(shí)趨近于零。因此，x2收斂于ψ1。

為了保證x2的有界性和關(guān)于零的收斂性，當(dāng)t→0時(shí)必須保證x1和x3的有界性和關(guān)于零的收斂性。因?yàn)?/p>

可知當(dāng)t→∞時(shí)，V1以解e－2k3t收斂到零，x3以解e－k3t收斂到零。又因?yàn)閤1以解e－k1t收斂到零，可知當(dāng)k3＞k1時(shí)，且x1（0）≠0時(shí)，x3／x1是有界的，以解e－（k3－k1）t收斂到零。

當(dāng)初始條件始于Ω，狀態(tài)反饋（6）不僅保證了系統(tǒng)狀態(tài)的有界性，而且原點(diǎn)是指數(shù)收斂。如果系統(tǒng)始于Ω的外部時(shí)，可以在任意小的時(shí)間內(nèi)應(yīng)用開(kāi)環(huán)控制驅(qū)動(dòng)系統(tǒng)從x1＝0點(diǎn)進(jìn)入Ω內(nèi)，再切換至狀態(tài)反饋（6）。

3 仿真實(shí)驗(yàn)

圖2和圖3為在控制率（6）的作用下，系統(tǒng)（5）狀態(tài)的收斂特性。系統(tǒng)初始狀態(tài)為x（0）＝（x10，x20，x30）＝（0.5，－1，1），位于集合 Ω內(nèi)?？刂坡实目刂茀?shù)為k1＝5，k2＝5和k3＝10。如圖所示，系統(tǒng)在控制率（6）的控制作用下，狀態(tài)能夠漸近收斂到零，因此控制算法是有效的。

圖2 狀態(tài)響應(yīng)曲線Fig.2 Response curve of state

圖3 運(yùn)動(dòng)軌跡響應(yīng)曲線Fig.3 Response curve of motion trace

圖4 圓周曲線跟蹤曲線Fig.4 Tracking curve of circular curve

狀態(tài)反饋控制率（6）可以應(yīng)用于垂直圓盤(pán)的軌跡跟蹤控制，即使?fàn)顟B(tài)（x1，x3）收斂到期望的狀態(tài)（x1d，x3d）。一個(gè)期望的圓周曲線滿足方程

其中期望軌跡的線速度和角速度分別為ur＝0.5m·s－1，rr＝0.5rad·s－1。系統(tǒng)初始狀態(tài)為x（0）＝（x10，x20，x30）＝（0.5，－1，1），位于集合Ω內(nèi)。期望軌跡的初始狀態(tài)為 （x1d，ψd，x3d）＝（1，π／4，1）?？刂坡实目刂茀?shù)為k1＝5，k2＝5和k3＝10。系統(tǒng)軌跡跟蹤特性如圖4所示，控制算法（6）能夠?qū)崿F(xiàn)對(duì)期望軌跡的跟蹤。

4 結(jié)論

本文將球形機(jī)器人、獨(dú)輪機(jī)器人和雙輪機(jī)器人的一種運(yùn)動(dòng)方式簡(jiǎn)化為均質(zhì)圓盤(pán)在平面內(nèi)的垂直滾動(dòng)，首先建立了系統(tǒng)的鏈?zhǔn)椒峭暾Ｐ停浯卫梅床椒ㄔO(shè)計(jì)運(yùn)行控制算法，并證明了反饋控制系統(tǒng)的原點(diǎn)是漸進(jìn)穩(wěn)定的。仿真結(jié)果表明控制算法是可行、有效的。

［1］劉大亮，孫漢旭，賈慶軒.一種球形移動(dòng)機(jī)器人的非線性滑模運(yùn)動(dòng)控制［J］.機(jī)器人，2008，30（6）：498－502.

［2］Shao Zhiyu，Liu Daliang.Balancing Control of a Unicycle Riding［C］.In：CCC10，29th Chinese Control Conference，Beijing，China，2010：3250－3254.

［3］劉大亮，孫漢旭.一種可載人行走的雙輪機(jī)器人［J］.機(jī)器人，2009，31（5）：416－420.

［4］許國(guó)保，尹怡欣，周美娟.智能移動(dòng)機(jī)器人技術(shù)現(xiàn)狀及展望［J］.機(jī)器人技術(shù)及應(yīng)用，2007，3月31日：29－34.

［5］Murray R M，Li Zexiang，Sastry S S.機(jī)器人操作的數(shù)學(xué)導(dǎo)論［M］.北京：機(jī)械工業(yè)出版社，1998：56－78.

［6］Riccardo Marino，Patrizio Tomei，著，姚郁，賀風(fēng)華，譯.非線性系統(tǒng)設(shè)計(jì)——微分幾何、自適應(yīng)及魯棒控制［M］.北京：電子工業(yè)出版社，2006：121－143.

［7］焦曉紅，關(guān)新平.非線性系統(tǒng)分析與設(shè)計(jì)［M］.北京：電子工業(yè)出版社，2008：132－136.

［8］方勇純，盧桂章.非線性系統(tǒng)理論［M］.北京：清華大學(xué)出版社，2009：101－124.

［9］葉敏，肖龍翔.分析力學(xué)［M］.天津：天津大學(xué)出版社，2001：65－67.

［10］王振發(fā).分析力學(xué)［M］.北京：科學(xué)出版社，2011：78－82.