板簧搬運機械手軌跡規(guī)劃研究

姜倩倩，李素玲，陳大偉

（山東理工大學電氣與電子工程學院，山東淄博255091）

汽車板簧一般質量都比較大，國內用于汽車板簧搬運的多是人工搬運或者是橫梁式的平面搬運機械手．人工搬運勞動強度大，效率低；而平面機械手在一定程度上又顯得不夠靈活，作業(yè)精確度與作業(yè)效率較低，為此設計了一種五軸驅動的關節(jié)型機械手，能夠準確、快速地完成板簧搬運．

機械手軌跡規(guī)劃是機械手運動控制中的一項核心工作，它直接影響著控制的準確性和快速性．為了保證機械手能夠高速、平穩(wěn)的到達指定位置，提高整個機械手系統(tǒng)的穩(wěn)定性和可靠性，在操作機械手之前對其進行軌跡規(guī)劃，就會避免機械手位置、速度、加速度實變等不良現(xiàn)象發(fā)生．

1 機械手的系統(tǒng)組成

機械手的自由度數(shù)目應與所要完成的任務相匹配，本系統(tǒng)中，為了使板簧搬運機械手能在空間中完成搬運任務，將其自由度數(shù)目定為5個，即此搬運機械手有五個關節(jié)：腰部、肩關節(jié)、肘關節(jié)上分別有一個轉動關節(jié)，可實現(xiàn)機械手的旋轉、升降、擺動；末端上的自由度數(shù)目為2，有兩個轉動關節(jié)分別可以使腕部俯仰、手爪旋轉．此板簧搬運機械手系統(tǒng)由機械本體（執(zhí)行機構）、控制系統(tǒng)、伺服驅動系統(tǒng)和檢測傳感裝置等構成，是一種仿人操作、自動控制、可重復編程、能在三維空間完成各種作業(yè)的機電一體化自動生產(chǎn)設備．其中，執(zhí)行機構即為串聯(lián)型五關節(jié)的機械手本體，包括腰部、肩關節(jié)、肘關節(jié)、腕關節(jié)、大臂、小臂和平行氣控手抓（安裝在腕關節(jié)上）．由于機械手持重比較大，在升降軸和擺動軸之間安裝了平衡氣缸，同時，根據(jù)每個關節(jié)的速度要求，計算出合適的減速比，選擇合適的減速裝置和傳動裝置．機械手的機構簡圖如圖1所示．驅動系統(tǒng)采用伺服電機；盡管氣壓驅動系統(tǒng)具有結構簡單、無污染的特點，但其輸出力矩較?。欢簤候寗酉到y(tǒng)可獲得大的輸出力，但是油液易產(chǎn)生泄露而影響運動精度．傳感檢測系統(tǒng)選用絕對式編碼器檢測每個關節(jié)的轉動角度．控制系統(tǒng)采用以PC機為核心的集中控制方式，選用眾為興數(shù)控技術有限公司研制的基于PCI總線的高性能ADT－856運動控制卡．其中，PC機主要完成人機交互界面的管理和控制系統(tǒng)的實時監(jiān)控，運動控制卡利用脈沖與方向信號的輸出控制機械手各運動模塊的伺服驅動器．機械手的系統(tǒng)控制、軌跡規(guī)劃的工作原理如圖2所示．

圖1 機械手機構簡圖

圖2 機械手工作原理圖

2 機械手運動學模型的建立

機械手運動學問題的主要研究內容是機械手各連桿間的位置關系、速度關系和加速度關系，分為運動學正分析（正運動學問題）和運動學逆分析（逆運動學問題）兩部分．它們?yōu)檠芯寇壽E規(guī)劃問題提供了理論基礎．正運動學問題是在已知機械手桿件的DH參數(shù)和關節(jié)角θ（t）的情況下，求解末端執(zhí)行器相對于參考坐標系的位姿，其解是唯一的、確定的．而逆運動學問題，是在已知手部末端空間位姿的情況下，求解出關節(jié)變量，其解是不唯一的［1]，主要用于機械手的控制及軌跡規(guī)劃．

機械手的軌跡規(guī)劃是在機械臂運動學和動力學的基礎上，研究關節(jié)空間和笛卡兒空間中機械手運動的軌跡生成方法．無論是在哪種空間中規(guī)劃，分析運動學正逆解問題和軌跡規(guī)劃都需要先建立坐標系，確定D－H參數(shù)，才能建立運動學模型．利用D－H參數(shù)建模法建立其運動學坐標系（參考坐標系）如圖3所示，坐標系的建立方法見參考文獻［2] ．5個旋轉關節(jié)的角度：θ1，θ2，θ3，θ4，θ5為關節(jié)變量，當確定了機械手各連桿坐標系后，便可以列出各連桿參數(shù)，見表1，連桿參數(shù)的具體定義見參考文獻［3] ．連桿參數(shù)確定后，直接寫出相鄰兩坐標系間的變換矩陣為

圖3 機械手坐標系示意圖

表1 板簧搬運機械手的D－H參數(shù)_

在此基礎上，給出的機械臂運動方程為

其中，矢量n，o，a為含有未知數(shù)θi的表達式，表示末端執(zhí)行器相對于基坐標的姿態(tài)；矢量p表示坐標系｛5｝的原點在坐標系｛0｝中的位置矢量［4]．公式（2）所示運動方程表示末端連桿坐標系｛5｝相對于基坐標系｛0｝的位姿．

3 機械手的軌跡規(guī)劃

工業(yè)機器人最常用的兩種軌跡規(guī)劃方法是關節(jié)空間規(guī)劃法和笛卡爾空間規(guī)劃法［5]．不論是在關節(jié)坐標系下規(guī)劃，還是在直角坐標系下進行規(guī)劃，都必須滿足所規(guī)劃的軌跡是連續(xù)和平滑的，從而使機械臂運動平穩(wěn)．

本文采用關節(jié)空間五次多項式插補算法．考慮到實際應用中板簧的質量一般在100～150kg，搬運機械手運動過程中速度不能太快，所以本文不考慮時間最優(yōu)的問題，只要保證運動過程安全、平穩(wěn)．當滿足一定約束條件（只考慮運動學約束，不考慮力學），搬運機械手在路徑無障礙下PTP運動時，需要給出機械手起始點、終止點手爪的位姿．在整個時間［t0，tf] 內，五次多項式插補算法，不僅可以保持位置和速度同時連續(xù)，還可以保證加速度不發(fā)生突變［6]．取θ（t）在t＝0時刻的值是起始關節(jié)角度θ0，在終端時刻tf的值是終止關節(jié)角度θf．為實現(xiàn)關節(jié)的平穩(wěn)運動，軌跡函數(shù)θ（t）滿足如下約束條件：

取五次多項式為

由約束條件得

根據(jù)公式（7）～（9）可以解出a0，a1，a2，a3，a4，a5五個未知數(shù)，帶入公式（6），便可得到一個兩端端點速度不為零的軌跡的插補五次多項式為

公式（10）是對單個關節(jié)的軌跡插值計算，對于五個關節(jié)的機械手，有5個不同的tif時間，需要考慮5個關節(jié)運動的協(xié)調，主要是通過同時啟動、同時停止的控制思想來保證．所以整體的插補時間tf＝max（tif），為機械手從起始點A點運動到終止點B點的時間．起始處A點的五個關節(jié)角已知為JA＝［θ10θ20θ30θ40θ50] ，B點的五個關節(jié)角由所給的末端執(zhí)行器位姿，通過運動學逆解來求得JB＝［θ1fθ2fθ3fθ4fθ5f] ，由A點到B點之間持續(xù)的時間為tif＝｜θif－θi0｜／ωimax（i＝1，2，3，4，5）．

4 仿真結果及分析

以MATLAB軟件的robot工具箱作為仿真平臺，利用表1所給出的機械手連桿參數(shù)，建立機械手運動學仿真模型．Link（）函數(shù)的前4個元素依次為α，h，θ，d，最后一個為0（轉動關節(jié)），構建機械手模型的主要命令如下：

r．name＝＇五軸板簧搬運機械手＇；

drivebot（r）

由此可得到機械手的三維圖如圖4所示．

圖4 機械手的三維建模圖（起始位置）

圖5 機械手運動過程示意圖

分別求出插值多項式θ（t）后，利用MATLAB仿真得到機械手五個關節(jié)的角度曲線、角速度曲線、角加速度曲線分別如圖6、圖7、圖8所示，圖中曲線光滑且連續(xù)．這說明采用5次多項式插補生成軌跡的方法，位移和速度曲線連續(xù)，即可實現(xiàn)實際中平滑的軌跡；而加速度曲線的連續(xù)，則說明機械手末端不會產(chǎn)生振動，保證了機械手工作的平穩(wěn)性．

圖6 五個關節(jié)的角度位置曲線

圖7 五個關節(jié)的角速度曲線

圖8 五個關節(jié)的角加速度曲線

機械手將汽車板簧從一處搬到另一處時，除了要給定起始點和終止點外，還應給出幾個中間的經(jīng)過點，如圖9所示．與教學實驗所用機器人相比，板簧搬運機械手所搬質量一般比較大，通常實際應用中，機械手的運動要經(jīng)過如圖9所示幾點，所以可以將整個運動過程的軌跡分成幾段，而每一段則直接采用上述的五次多項式插值的方法連接相鄰的兩個點，為了不使中間點產(chǎn)生停頓，還可以在中點上制定期望的速度．

圖9 機械手搬運過程示意圖

5 結束語

采用D－H參數(shù)法推導出五自由度關節(jié)型板簧搬運機械手的運動學模型，利用MATLAB軟件和robot工具箱進行機械手建模與仿真，可以清晰看出機械手軌跡規(guī)劃運動的仿真結果，能夠較好地反映出機械手的實際運行情況．五次多項式插值函數(shù)進行規(guī)劃可以使板簧搬運機械手的五個運動關節(jié)角速度時間曲線、角加速度時間曲線變化都是連續(xù)平滑的．保證機器人在運動過程中運行平穩(wěn)，沒有沖擊現(xiàn)象．

［1] 梅鐵洲．IRB1400型機器人的運動分析及運動控制［D] ．上海：海事大學，2005．

［2] 朱世強，王宣銀．機器人技術及其應用［M] ．杭州：浙江大學出版社，2007．

［3] 李玲．六自由度機器人運動學三維圖形仿真研究［D] ．大連：大連海事大學．2008．

［4] 姜明軍．六自由度機器人運動軌跡優(yōu)化控制［D] ．大慶：大慶石油學院．2009．

［5] 顏世周．一種六自由度機器人的開發(fā)與軌跡規(guī)劃算法研究［D] ．淄博：山東理工大學，2004．

［6] 韓軍，郝立．機器人關節(jié)空間的軌跡規(guī)劃及仿真［J] ．南京理工大學學報．2000，24（6）：540－543．