目前用於噴漆、搬運、點焊等操作的工業機械人只具有簡單的軌跡控制。軌跡控制適用於
機械人的末端執行器在空間沿某一規定的路徑運動,在運動過程中末端執行器不與任何外界
物體接觸。對於執行擦玻璃、轉動曲柄、擰螺絲、研磨、打毛刺、裝配零件等作業的機械人,其末
端執行器與環境之間存在力的作用,且環境中的各種因素不確定,此時僅使用軌跡控制就不能
滿足要求。執行這些任務時必須讓機械人末端執行器沿著預定的軌跡運動,同時提供必要的力
使它能克服環境中的阻力或符合工作環境的要求。
以擦玻璃為例,如果機械人手爪抓著一塊很大很軟的海綿,並且知道玻璃的精確位置,那
麼通過控制手爪相對於玻璃的位置可以完成擦玻璃作業;但如果作業是用刮刀刮去玻璃表面
上的油漆,而且玻璃表面空間位置不準確,或者手爪的位置誤差比較大,由於存在沿垂直玻璃
表面的誤差,作業執行的結果不是刮刀接觸不到玻璃就是刮刀把玻璃打碎。因此,根據玻璃位
置來控制擦玻璃機械人是行不通的。比較好的方法是控制工具與玻璃之間的接觸力,這樣即便是工作環境(如玻璃)位置不準確時也能保持工具與玻璃正確接觸。相應地,機械人不但要有
軌跡控制的功能,而且要有力控制的功能。
下面是乙個機械人開門的例子。如圖所示,門把手的運動軌跡受到自然約束(機械人手爪與環境接觸時,環境的幾何特性構成對作業的約束),被限制在以轉軸為圓心半徑為r的圓弧上。傳統的軌跡控制下為了保證機械人不把門或門把手扯掉,需要機械人沿著準確的軌跡運動,否則徑向上很小的誤差都會產生很大的力。
如果只考慮靜態,力和位置關係可用剛性矩陣來描述。如果考慮力和速度之間的關係,可用粘滯阻力矩陣來描述。通常對於需要進行位置控制的自由度,則要求在該方向上有很大的剛性,即表現出很硬的特性;對於需要力控制的自由度,則要求在該方向上有較小的剛性,即表現出較軟的特性。
對上面的問題,可以在徑向賦予機械人較小的剛性(較大的柔性)。新增虛擬彈簧,將其剛度係數$k_x$設的很小,則當實際軌跡與期望軌跡不一致時彈簧產生的回覆力也很小,不至於將門破壞掉。機械人末端與環境間的剛度矩陣可以定義為:$$\mathbf=\begink_x & 0\\ 0 & k_y\end;k_x\ll 1,k_y\gg 1$$
通過雅可比矩陣可以將機械人末端剛度轉換到關節空間中。設雅可比矩陣$\pmb$將關節空間的速度$\dot}$對映到操作空間$\dot}$。末端剛度矩陣為$\pmb_p$,$\delta\pmb$為末端位移變化量,$\pmb$為末端位移變化引起的力。則有:$\pmb=\pmb_p\delta\pmb$
關節空間剛度矩陣$\mathbf_q$可以根據雅可比矩陣計算出:$$\mathbf_q=\mathbf^t\mathbf_p\mathbf$$
簡單推理過程為:$\pmb=\pmb^t\pmb=\pmb^t\pmb_p\delta\pmb=\pmb^t\pmb_p\pmb\delta\pmb$,根據$\pmb=\pmb_q\delta\pmb$,即可以推導出上面關係式。
柔順性分為主動柔順性和被動柔順性兩類。機械人憑藉一些輔助的柔順機構,使其在與
環境接觸時能夠對外部作用力產生自然順從,稱為被動柔順性。所謂被動柔順機構,即利用一些可以使機械人在與環境作用時能夠吸收或儲存能量的
機構器件如彈簧、阻尼等構成的機構。
機械人利用力的反饋資訊採
用一定的控制策略去主動控制作用力,稱為主動柔順性。
機械人的阻抗控制(impedance control)或導納控制(admittance control)是通過調節機械人末端位置與力之間的動態特性來實現柔順性。機械人與外界環境之間的互動可以由質量-彈簧-阻尼系統來描述,如下圖所示,系統動力學方程為:$$m\ddot+b\dot+kx=f$$
其中$x$為位移,$m$為質量,$b$為阻尼,$k$為剛度,$f$為作用力
對上面的動力學方程進行拉普拉斯變換,可以得到:$$(ms^2+bs+k)x(s)=f(s)$$
阻抗定義為$z(s)=f(s)/x(s)$,導納定義為阻抗的倒數:$y(s)=z^(s)=x(s)/f(s)$.由於$\delta x=y\delta f$,如果導納很小,那麼力的變化$\delta f$將產生很小的位移變化$\delta x$。
阻抗控制是一種建立在力與速度或位置之間的動態關係上的控制方法。通過建立機械人運動和外部作用力之間的動態關係,對機械人運動進行調節,從而實現機械人與環境的動態調整。$$m\ddot+b\dot+kx=f_$$
對上面的方程有兩種解讀角度:
低阻尼引數可以提高機械人對操作者互動力的跟隨能力,使得操作者可以通過較小的作用力就能使機械人跟隨其做柔順移動。但較低的阻尼引數卻限制了拖動至目標點時互動的穩定性,機械人的位置會出現過衝
通過調整 k,d 引數,可以改變實驗特性,增加 k 時,單位作用力上產生的位移就變小,即需要用更大的力才能拉動關節;反之,減少 k 時,單位作用力上產生的位移就變大,用很小的力就能使關節產生較大的位移。增加 d 時,相當於增加系統的阻尼特性,可以進一步的提高系統運動時的平穩性,但如果 d 很大,可能出現系統響應很慢的情況,不能很好的跟隨所施加的外力資訊;另一方面,減少 d 時,可以適當的提高系統的快速性,但是過小的d 會引起系統的不穩定現象。
參考:阻抗與導納
機械人的力控制
機械人的柔順控制
二連桿機械臂阻抗控制模擬
force and compliance controls
robot manipulator control theory and practice
impedance and interaction control - summer school on impedance
機械人控制相關術語
位置控制 使機械人的手 臂等到達目標位置的控制成為位置控制。過調節 停止 時如果急劇減速,由於慣性會發生超調。機械人組成 機械人由檢測部分 控制部分 驅動部分 動力源 電機 等構成。從感測器 檢測部分 獲取位置 速度 滑動等資訊,送到作為頭腦的計算機 控制部分 計算出手臂的移動速度 作用於手臂的力,...
機械人視覺跟蹤與控制研究 一
研究背景 機械人視覺,通過影象獲得外界資訊,用於機械人對環境的感知。提高機械人智慧型性 環境適應性 自主行為的重要途徑。近年來機械人領域的研究熱點之一。研究內容 視覺系統標定 目標分割與影象處理 視覺測量與視覺控制 視覺系統標定 1基於環境資訊的自標定 利用環境中的正交平行線獲得消失點,標定攝像機的...
機械人仿生控制方法研究
選擇了在某條路上開始,便意味著回頭也會很難,既然選擇了,那就奮不顧身,正如一句話所說的,前半生擇其所愛,後半生愛其所擇 其他事也大都如此。因為最近接觸的知識較多,因此想在這裡進行總結分享,作為記錄。最近在看 機械人運動控制 仿生機器魚多模態運動cpg控制及優化 電子工業出版社 2017年5月 作者是...