主動(dòng)剛性控制

圖5-15示出一個(gè)主動(dòng)剛性控制(active stiffness control)系統框圖。圖中，J 為機械手末端執行裝置的雅可比矩陣；K, 為定義于末端笛卡兒坐標系的剛性對角矩陣，其元素由人為確定。如果希望在某個(gè)方向上遇到實(shí)際約束，那么這個(gè)方向的剛性應當降低，以保證有較低的結構應力；反之，在某些不希望碰到實(shí)際約束的方向上，則應加大剛性，這樣可 使機械手緊緊跟隨期望軌跡。于是，就能夠通過(guò)改變剛性來(lái)適應變化的作業(yè)要求。

雷伯特-克雷格位置/力混合控制器

雷伯特(M·H·Raibert) 和克雷格(J·J·Craig) 于1981年進(jìn)行了機器人機械手位置 和力混合控制的重要實(shí)驗，并取得良好結果。后來(lái)，就稱(chēng)這種控制器為R-C 控制器。

圖5-16表示R-C 控制器的結構。圖中，S 和S 為適從選擇矩陣；xa 和Fa 為定義于笛 卡兒坐標系的期望位置和力的軌跡；P(q) 為機械手運動(dòng)學(xué)方程；T 為力變換矩陣。

這種R-C 控制器沒(méi)有考慮機械手動(dòng)態(tài)耦合的影響，這就會(huì )導致機械手在工作空間某些 非奇異位置上出現不穩定。在深入分析 R-C 系統所存在的問(wèn)題之后，可對之進(jìn)行如下 改進(jìn)： 

1)在混合控制器中考慮機械手的動(dòng)態(tài)影響，并對機械手所受重力及哥氏力和向心力進(jìn) 行補償。

2)考慮力控制系統的欠阻尼特性，在力控制回路中，加入阻尼反饋，以削弱振蕩 因素。

改進(jìn)后的R-C 力/位置混合控制系統結構圖如圖5-17所示。圖中，M(q) 為機械手的 慣量矩陣模型。

 操作空間力和位置混合控制系統

由于機器人機械手是通過(guò)工具進(jìn)行操作作業(yè)的，所以其末端工具的動(dòng)態(tài)性能將直接影響操作質(zhì)量。又因末端的運動(dòng)是所有關(guān)節運動(dòng)的復雜函數，因此，即使每個(gè)關(guān)節的動(dòng)態(tài)性 能可行，而末端的動(dòng)態(tài)性能則未必能滿(mǎn)足要求。當動(dòng)態(tài)摩擦和連桿撓性特別顯著(zhù)時(shí)，使用 傳統的伺服控制技術(shù)將無(wú)法保證作業(yè)要求。因此，有必要在{C} 坐標系中直接建立控制 算法，以滿(mǎn)足作業(yè)性能要求。圖5-18就是卡蒂布(O ·Khatib) 設計的操作空間力和位置混合控制系統的結構圖。

圖中，A(x)=J-TM(q)J⁻¹ 為機械手末端的動(dòng)能矩陣； C(q,q)= C(q,q) 一JTA(x)Jq;K,K,K 及 K,K. 和K 為 PID 常增益對角矩陣。

此外，還有阻力控制和速度/力混合控制等。