柔順控制旨在實(shí)現(xiàn)機(jī)器人與環(huán)境進(jìn)行物理交互時(shí) (Physical Robot- Environment Interactions)，體現(xiàn)出 期望的柔順行為，這一柔順行為主要使用交互力-交互位移/ 速度之間的動(dòng)態(tài)關(guān)系——導(dǎo)納/阻抗來描述。如軸孔裝配過 程中，由于末端位姿誤差、零部件放置精度等，不可避免 地會(huì)存在約束/接觸/碰撞，此時(shí)重要的是實(shí)現(xiàn)對裝配過程中 未預(yù)見(未知)約束/接觸的順應(yīng)性—— 即可以根據(jù)接觸力 信息(大小、方向)調(diào)整末端位姿(或者相反)，以實(shí)現(xiàn) 對裝配零件之間未知相對位移的補(bǔ)償或者容忍。不同于力 控制任務(wù)(如打磨、拋光等)中會(huì)為為機(jī)器人規(guī)劃出明確 的力控制參考信號，柔順控制強(qiáng)調(diào)的是對未知約束的適應(yīng) (Accomodation)。

　　因此，在機(jī)器人柔順控制系統(tǒng)建模、分析、設(shè)計(jì)、調(diào)試 的過程中，必須將接觸/交互特性放在中心位置，這一過程至 少應(yīng)該包括以下幾個(gè)環(huán)節(jié)：環(huán)境接觸特性(幾何、介質(zhì)力學(xué) 特性);期望交互特性(Target Impedance);實(shí)現(xiàn)方案; 接觸穩(wěn)定性分析(Coupled Stability， Contact Transient Stability)、柔順控制算法設(shè)計(jì)、系統(tǒng)調(diào)試及交互性能評估 等。這幾個(gè)環(huán)節(jié)對應(yīng)著以下重要的實(shí)際實(shí)施問題：

　　? 接觸環(huán)境如何影響機(jī)器人-環(huán)境的交互任務(wù)?

　　? 是否不同的阻抗參數(shù)組合都能被給定的機(jī)器人系統(tǒng)實(shí)現(xiàn) (可實(shí)現(xiàn)性以及實(shí)現(xiàn)程度)?

　　? 機(jī)器人與環(huán)境是否可以建立接觸并保持穩(wěn)定?

　　? 為保證接觸穩(wěn)定性，如何設(shè)計(jì)柔順控制算法?

　　? 如何評價(jià)機(jī)器人系統(tǒng)的交互性能?

　　為保證機(jī)器人-環(huán)境交互任務(wù)的順利實(shí)施，上述問題必須 得到界定和分析。系統(tǒng)介紹和分析清楚這些問題實(shí)在是一項(xiàng) 復(fù)雜的工作，而且為方便理解，也將會(huì)盡量避免復(fù)雜的數(shù)學(xué) 推導(dǎo)(這也是專欄文章一以貫之的原則)。本文算是在這個(gè) 想法上的初步嘗試，后續(xù)將通過系列文章逐步展開介紹。

　　1 環(huán)境接觸特性

　　柔順控制系統(tǒng)包括機(jī)器人自身動(dòng)力學(xué)子系統(tǒng)和接觸/交 互過程動(dòng)態(tài)子系統(tǒng)，因此在被控系統(tǒng)描述過程中除去機(jī)器臂

　　自身動(dòng)力學(xué)特性還必須包含環(huán)境接觸特性—交互位移/速度- 交互力之間關(guān)系(對于自由空間運(yùn)動(dòng)的機(jī)器人，機(jī)器臂自身 的動(dòng)態(tài)對其性能有決定性影響，無須考慮以上因素)。如圖 1(a)所示末端與環(huán)境接觸的機(jī)器人系統(tǒng)，假設(shè)為x0末端 期望位移，x為末端實(shí)際位移， xe為末端與環(huán)境的平衡接觸 點(diǎn)，p=x-xe即為交互位移，通常使用透入深度描述(End- effector Penetration Into The Environment);假設(shè)圍繞 平衡接觸點(diǎn)的發(fā)生微小位移，且接觸環(huán)境可以使用線性阻抗 模型GE描述，則環(huán)境接觸特性-交互位移/速度-交互力可以描 述為：

圖 1(a) 機(jī)器人柔順控制系統(tǒng)單自由度簡化示意圖(與純剛度環(huán)境接觸)

圖 1(b) 機(jī)器人位置控制系統(tǒng)單自由度簡化示意圖(與純剛度環(huán)境接觸)

       2 參考目標(biāo)阻抗

　　與一般控制系統(tǒng)不同，阻抗控制的目標(biāo)并不是實(shí)現(xiàn) 對 特 定 參 考 輸 入 信 號 的 跟 蹤， 而 在 于 實(shí) 現(xiàn) 參 考 目 標(biāo) 阻 抗 (Reference Target Model)，該模型(參數(shù)：Mt, Bt, Kt) 定量描述了順應(yīng)性，即位置誤差e=x-x0與交互力F之間的關(guān) 系:

       實(shí)際中應(yīng)用，目標(biāo)阻抗可以為剛度控制(Mt =0, Bt=0)、阻尼控制(Mt=0, Kt=0)或者其他形式(更高 階或者非線性、時(shí)變)。結(jié)合圖1(a~b)，通過可以編程 調(diào)整阻抗參數(shù)(Mt, Bt, Kt)，替代了傳統(tǒng)高剛度位置控制 系統(tǒng)(慣量矩陣∧，位置增益Kp , 阻尼增益Kv和系統(tǒng)阻尼 Bv)，是對機(jī)器臂原有的交互特性的整形/重塑(如慣量減輕

　　Inertial Shaping/Reduction)，實(shí)現(xiàn)了整個(gè)機(jī)器臂末端或 者關(guān)節(jié)的交互特性調(diào)節(jié)，即F, e, p之間的關(guān)系。例如在手動(dòng)拖 動(dòng)示教或者重載機(jī)器臂輔助裝配過程中，盡管機(jī)械臂實(shí)際的 剛度/慣量/阻尼較大，但在柔順控制中通過選擇較小的(Mt, Bt, Kt)并輔助重力+摩擦力補(bǔ)償，可以使得末端拖動(dòng)示教所 需作用力/力矩較小，省時(shí)省力。

　　3 導(dǎo)納VS阻抗控制方式實(shí)現(xiàn)柔順

　　具體到導(dǎo)納或者阻抗控制等不同的柔順控制方案時(shí)，實(shí) 現(xiàn)約束順應(yīng)的方式是不同的。對于阻抗控制來說(如圖2所 示) ，給定參考目標(biāo)阻抗和位置誤差e， 參考交互力Fc則可 以由式(3)計(jì)算，然后送入力控制系統(tǒng)。該力控制系統(tǒng)接 收交互力反饋信號，使得實(shí)際交互力F跟蹤由目標(biāo)阻抗得到 的 Fc，因此，阻抗控制本質(zhì)是基于力控制的(基于動(dòng)力學(xué)模型)。

圖 2 阻抗控制系統(tǒng)框圖

圖 3 導(dǎo)納控制系統(tǒng)框圖

       對于導(dǎo)納控制來說(如圖3，其中Gr和Gs分別為位置控 制傳遞函數(shù)和機(jī)器人自身系統(tǒng)傳遞函數(shù))，給定某一交互力 F(可以通過測試或者估計(jì)得到)，根據(jù)導(dǎo)納控制器可以計(jì) 算得到位置修正量deta_x(位置修正量deta_x大，順應(yīng)性越 大)，此時(shí)參考位置指令變?yōu)閤r=x0-deta_x，送入位置控制 環(huán)后，保證實(shí)際位移x跟隨xr，交互位移/透入深度p也隨之變 化，從這點(diǎn)來說，導(dǎo)納控制本質(zhì)是基于位置閉環(huán)控制(位置 環(huán)為內(nèi)環(huán))，其中期望阻抗、交互力、位移修正之間滿足以

　　下關(guān)系：

       從圖2和圖3可以清楚表明：

　　? 環(huán)境接觸特性、機(jī)器人本身動(dòng)力學(xué)系統(tǒng)、導(dǎo)納/阻抗控 制器，以及相應(yīng)的接觸力信號質(zhì)量共同決定了整體控制系統(tǒng) 的動(dòng)力學(xué)特性，這是在柔順控制系統(tǒng)的分析和設(shè)計(jì)中首先需 要注意的問題;

　　? 值得注意的是， 在實(shí)際阻抗/導(dǎo)納控制系統(tǒng)中， 阻抗 /導(dǎo)納控制器GF不一定等于目標(biāo)參考阻抗Zt, 這是由于機(jī)器 人復(fù)雜的動(dòng)力學(xué)特性，使得實(shí)際實(shí)現(xiàn)的阻抗特性Zt并不等于 Zt，而是體現(xiàn)出一定的濾波特性(如對于導(dǎo)納控制來說，受 限于內(nèi)環(huán)-位置環(huán)帶寬，實(shí)際能夠達(dá)到的阻抗特征頻率要小于 位置環(huán)帶寬)。為盡量減小兩者之間的差距，實(shí)際柔順控制 器的設(shè)計(jì)需要考慮更多因素。

　　4 總結(jié)

　　機(jī)器人柔順控制系統(tǒng)中，由于機(jī)器人-環(huán)境交互動(dòng)態(tài)特性 的引入，使得整體系統(tǒng)的動(dòng)力學(xué)行為相比傳統(tǒng)位置控制系統(tǒng) 更為復(fù)雜。因此，在柔順控制系統(tǒng)的分析和設(shè)計(jì)過程中，勢 必要關(guān)注實(shí)際交互特性的描述、建模和性能調(diào)控，這也是機(jī) 器人柔順控制的題中之義，后續(xù)文章將繼續(xù)展開這方面的介紹。

聲明：本文為轉(zhuǎn)載類文章，如涉及版權(quán)問題，請及時(shí)聯(lián)系我們刪除（QQ: 2737591964），不便之處，敬請諒解！