上假肢運動學逆解可視化研究

劉小羊， 林大鈞， 鄭鵬飛， 吳志庭

?

上假肢運動學逆解可視化研究

劉小羊， 林大鈞， 鄭鵬飛， 吳志庭

（華東理工大學機械與動力工程學院，上海200237）

針對上假肢的結(jié)構(gòu)特點，提出用機構(gòu)運動等同性條件和代數(shù)法相結(jié)合的方法來解決上假肢運動關(guān)節(jié)變量的逆解問題，以避免多次逆矩陣相乘。利用VB對CATIA進行二次開發(fā)，在CATIA軟件中實現(xiàn)上假肢關(guān)節(jié)各個解所對應(yīng)的空間位置姿態(tài)圖形顯示，可直觀地判斷解的有效性，為上假肢運動控制研究奠定基礎(chǔ)。

計算機應(yīng)用；上假肢；可視化；CATIA二次開發(fā)；運動學逆解

上假肢運動學逆解是根據(jù)手掌末端位置計算出上假肢各個關(guān)節(jié)的旋轉(zhuǎn)角度。在逆解求解過程中，對應(yīng)同一末端位姿可有多個解，其結(jié)果很抽象。應(yīng)用計算機圖形技術(shù)，可用圖形來顯示計算結(jié)果，以便直觀地理解解的有效性。

1 上假肢運動建模[1-4]

表1 坐標系說明

圖1 上假肢的機構(gòu)簡圖及坐標系

得到上假肢末端即手掌中心的位置和姿態(tài)。上假肢的D-H參數(shù)列于表2中。

表2 D-H參數(shù)表

其中

2 逆運動學新的分析方法及求解[5-6]

上假肢逆向求解目前尚無通用的算法。根據(jù)其結(jié)構(gòu)特點，本文利用機構(gòu)運動等同性條件和代數(shù)法相結(jié)合來求解。如圖1所示，在固定參考坐標系中，已知手掌中心點的坐標為(,,)。末端姿態(tài)向量,和的方向余弦分別為，和。求解上假肢五個轉(zhuǎn)動副中的位置控制參數(shù)、、、、。

由圖1可知：向量總是垂直于坐標軸，所以該兩矢量的標量積等于零，即他們在坐標軸上同名投影的乘積的代數(shù)和為零。于是可以利用已知點得到如下關(guān)系式

（2）

（3）

將式(3)代入式(2)，得到

最后求得

在圖1中，有

（5）

2.4 逆解算法推導(dǎo)驗證

逆運動學的算法驗證可先假定5個關(guān)節(jié)角度的取值，由正運動學公式計算出機器人位姿矩陣，然后根據(jù)運動學逆解公式，求解各個關(guān)節(jié)角度。先假定上假肢各關(guān)節(jié)角度分別為：=45°,=30°,=45°,=60°,=30°,桿件長度=15,=30,=23,=20將它們代入運動學正解公式(1)，得到位姿矩陣

將此位姿矩陣中的各數(shù)據(jù)分別代入逆解計算公式，編程計算可得到與假定角度對應(yīng)的解：=45.00°,=30.00°,=45.00°,=60.00°,=29.97°。由此可見計算結(jié)果是準確有效的。

3 運動學逆解的可視化[7-8]

3.1 逆解可視化程序的實現(xiàn)

在上假肢的運動學分析中，一般不考慮上假肢關(guān)節(jié)的形狀、尺寸等物理約束，其形狀可用圓柱體替代。當上假肢末端位姿確定時，各關(guān)節(jié)可有多種位姿。本文采用VB程序語言對CATIA進行二次開發(fā)，在CATIA軟件中實現(xiàn)上假肢各個解所對應(yīng)的空間位置姿態(tài)顯示，可以直觀地判斷解的有效性。

本程序通過VB調(diào)用EXCLE格式的文件來讀取位姿矩陣中的各個數(shù)據(jù)，可方便快速地實現(xiàn)相關(guān)數(shù)據(jù)輸入和修改。程序流程如圖2所示，程序輸入界面如圖3所示。在圖3中，程序運行時，打開EXCEL格式的位姿文件將所需的數(shù)據(jù)讀入程序界面，求解出各控制角度。也可在程序界面上直接輸入和修改數(shù)據(jù)，以滿足不同的參數(shù)需求。角度確定后，點擊逆解圖形顯示按鈕，程序自動打開CATIA軟件并生成相對應(yīng)的圖形。

圖2 程序流程圖

3.2 應(yīng)用舉例

在上假肢的操作控制中，要解決如何使手部實現(xiàn)預(yù)定路線的運動，需求解各運動副中運動參數(shù)的所有可能解，從而根據(jù)實際情況選擇最優(yōu)解。在圖1所示的固定參考坐標系中，設(shè)手掌中心點的坐標為(2.662, 2.662, -5.953)，末端姿態(tài)向量,和的方向余弦分別為(0.268, -0.793, -0.548), (0.195, -0.512, 0.836)和(-0.510, -0.023, 0.017)，手臂基本長度=15，=30,=23,=20, 求解各關(guān)節(jié)處的轉(zhuǎn)角。

當輸入給定的位姿參數(shù)，程序運行后得到圖4所示的八種關(guān)節(jié)位置形態(tài)，其對應(yīng)的角度如表3所示。在圖4中，達到預(yù)定的位置可有八種控制方案。每個三維圖形與其序號相同的關(guān)節(jié)形態(tài)相對應(yīng)，結(jié)果直觀。在選擇控制方案時可參照圖形在空間所對應(yīng)的狀態(tài)，根據(jù)結(jié)構(gòu)和工作條件選擇最優(yōu)方案，避免運動過程中的部件碰撞干涉等情況發(fā)生。

圖3 程序輸入界面圖

圖4 逆解圖形顯示

表3 上假肢逆解

4 結(jié)論與展望

本文所提出的通過機構(gòu)等同性條件和代數(shù)法相結(jié)合實現(xiàn)上假肢逆運動學的求解方法是可行的，并且具有計算量小，結(jié)果直觀的優(yōu)點，所應(yīng)用的VB對CATIA進行二次開發(fā)的技術(shù)可適用于仿人機器人的運動設(shè)計。所提出的方法雖然通過應(yīng)用舉例已經(jīng)得到了驗證，但在上假肢的操作控制中，要使手部實現(xiàn)預(yù)定姿態(tài)的活動的特定功能，需設(shè)計多組參數(shù)，應(yīng)用文中所介紹的方法設(shè)計遍歷式的正解和逆解計算算法，以確定優(yōu)化的參數(shù)組，此項工作還有待于進一步研究。

[1] 李蔓華. 人體上肢仿生機構(gòu)的運動建模及研究[D].天津: 天津輕工業(yè)學院, 2000.

[2] 張愛麗. 基于MATLAB的人體上肢仿真及分析[D]. 天津: 天津科技大學, 2000.

[3] 林良明. 仿生機械學[M]. 上海: 上海交通大學出版社, 1988. 17-20.

[4] 楊東超, 等. 擬人機器人運動學分析[J]. 機械工程學報, 2003, 39(9): 71-72.

[5] 王雪松, 等. MOTOMAN機械手逆運動方程新的推導(dǎo)方法及求解[J]. 中國礦業(yè)大學學報, 2001, 30(1): 73-75.

[6] 張啟先. 空間機構(gòu)的分析與綜合[M]. 北京: 機械工業(yè)出版社, 1984. 131-142.

[7] 鄭海春, 謝維成. Visual Basic編程及實例分析教程[M]. 北京: 清華大學出版社, 2007. 66-80.

[8] 胡 挺, 吳立軍. CATIA二次開發(fā)技術(shù)基礎(chǔ)[M]. 北京: 電子工業(yè)出版社, 2006. 26-73.

The Visualization Research of Artificial Upper Limbs Inverse Kinematics Resolution

LIU Xiao-yang, LIN Da-jun, ZHENG Peng-fei, WU Zhi-ting

( School of Mechanical Power and Engineering, East China University of Science and Technology, Shanghai 200237, China )

A method based on algebraic and identity conditions for mechanism is presented to solve artificial upper limbs inverse kinematics problems. The method can avoid multi-times inverse matrics mutiplication in the course of deduction. The spatial positions of each joint angel are shown in CATIA by secondary development of CATIA with VB. It can determine the solutions directly and lay the foundation for movement research of artificial upper limbs.

computer application; artificial upper limbs; visualization; secondary development of CATIA; inverse kinematics resolution

TP 391

A

1003-0158(2011)01-0119-05

2009-05-01

劉小羊（1982-），男，江西新干人，碩士研究生，主要研究方向為計算機圖形學，逆向工程。