廣東工業(yè)大學(xué)自動(dòng)化學(xué)院 陳 才

基于Ma t l a b的MOT OMA N-MH 1 2機(jī)器人正運(yùn)動(dòng)學(xué)仿真

廣東工業(yè)大學(xué)自動(dòng)化學(xué)院 陳 才

通過研究安川公司的MOTOMAN-MH12機(jī)器人，對(duì)機(jī)器人的各項(xiàng)關(guān)節(jié)運(yùn)動(dòng)參數(shù)分析解讀，然后通過DH坐標(biāo)系的建立和使用齊次變換矩陣建立機(jī)器人正運(yùn)動(dòng)模型。最后，使用MATLAB軟件進(jìn)行仿真，與廠商給出的機(jī)器人運(yùn)動(dòng)范圍做對(duì)比，從而驗(yàn)證所建坐標(biāo)系和正運(yùn)動(dòng)模型的準(zhǔn)確性和正確性。

MOTOMAN-MH12機(jī)器人；正運(yùn)動(dòng)學(xué)；MATLAB；DH參數(shù)表

0 引言

本款機(jī)器人MOTOMAN-MH12采用流線型手臂構(gòu)造，最大可以搬運(yùn)重量12kg，是同級(jí)別中最快的工業(yè)機(jī)器人，大大提高了生產(chǎn)力。

本文以MOTOMAN-MH12機(jī)器人為研究對(duì)象。首先通過分析工作范圍和尺寸，建立空間坐標(biāo)系，以及DH參數(shù)表，最后建立數(shù)學(xué)模型，利用Matlab對(duì)其工作空間，正運(yùn)動(dòng)學(xué)進(jìn)行模擬仿真。

1 機(jī)器人的結(jié)構(gòu)參數(shù)

MOTOMAN-MH12機(jī)器人有6個(gè)關(guān)節(jié)，每個(gè)關(guān)節(jié)的運(yùn)動(dòng)范圍如下圖表所示。S軸是固定底座旋轉(zhuǎn)，L軸和U軸是沿著垂直方向旋轉(zhuǎn)，軸R,B,T是固定在手腕上旋轉(zhuǎn)擺動(dòng)。

表1 MOTOMAN-MH12機(jī)器人關(guān)節(jié)運(yùn)動(dòng)范圍

圖1 MOTOMAN-MH12機(jī)器人

圖2 MOTOMAN-MH12 DH坐標(biāo)系

根據(jù)每個(gè)關(guān)節(jié)的運(yùn)動(dòng)狀態(tài)，以及模型圖可建立MOTOMANMH12的空間坐標(biāo)系（見圖2）。

根據(jù)建立的坐標(biāo)系可以寫出其對(duì)應(yīng)的DH參數(shù)表：

表2 MOTOMAN-MH12機(jī)器DH參數(shù)表

2 機(jī)器人正運(yùn)動(dòng)學(xué)分析

運(yùn)動(dòng)學(xué)正解是通過給定機(jī)器人的各個(gè)連桿的幾何參數(shù)和關(guān)節(jié)變量，從而求得尾端連桿坐標(biāo)系相對(duì)于基坐標(biāo)系的位姿。我們用齊次變換矩陣表示連桿n坐標(biāo)系在連桿n+1坐標(biāo)系下的位姿。因此可得：

由DH參數(shù)表可得各連桿變換矩陣如下：

再由MOTOMAN-MH12機(jī)器人的正運(yùn)動(dòng)學(xué)方程，機(jī)器人末端連桿相對(duì)于固定坐標(biāo)系的變換可表示為：

得到：

3 MOTOMAN-MH12機(jī)器人仿真

機(jī)器人的工作空間表示了機(jī)器人的各個(gè)關(guān)節(jié)的活動(dòng)范圍，同時(shí)它也是衡量機(jī)器人工作能力的一個(gè)重要指標(biāo)。本文運(yùn)用matlab對(duì)其工作空間進(jìn)行模擬仿真效果圖如圖3所示。

圖3 模擬仿真效果圖

正運(yùn)動(dòng)學(xué)仿真效果圖如圖4所示。

圖4 正運(yùn)動(dòng)學(xué)仿真效果圖

4 結(jié)論

本文通過MATLAB對(duì)安川公司的MOTOMAN-MH12機(jī)器人進(jìn)行數(shù)學(xué)建模，正運(yùn)動(dòng)學(xué)分析，仿真得到該款機(jī)器人的工作空間和關(guān)節(jié)運(yùn)動(dòng)與官方給出的工作空間和參數(shù)基本一致，驗(yàn)證了所建立的機(jī)器人數(shù)學(xué)模型，正運(yùn)動(dòng)學(xué)分析的正確性。從而對(duì)機(jī)器人的運(yùn)動(dòng)學(xué)研究更為直觀，方便。

[1]王庭樹．機(jī)器人運(yùn)動(dòng)學(xué)及動(dòng)力學(xué)[M]．西安電子科技大學(xué)出版社,1990,1:24-26．

[2]郭洪紅．工業(yè)機(jī)器人技術(shù)(第三版)西安電子科技大學(xué)出版社,2016,6:978-7-5606-4106-5．

[3]艾青林,計(jì)時(shí)明,金明生,等．一種六自由度鋼帶并聯(lián)機(jī)器人機(jī)構(gòu)[P]．中國(guó),ZL 200610049643．0．2008-01-09．

[4]張憲民,楊麗新,黃沿江．工業(yè)機(jī)器人應(yīng)用基礎(chǔ)[J]．機(jī)械工業(yè)出版社,2015,1(10):9787111510598．

[5]蘇先義．六自由度鋼帶并聯(lián)機(jī)器人失穩(wěn)有限元分析[D]．杭州:浙江工業(yè)大學(xué),2009．

[6]滕宏春．工業(yè)機(jī)器人與機(jī)械手[J]．電子工業(yè)出版社,2015,1(2): 9787121251559．

[7]葉暉,等．工業(yè)機(jī)器人實(shí)操與應(yīng)用技巧[J]．機(jī)械工業(yè)出版社,2010,1(10): 9787111317425．

陳才（1994—），江蘇泰興人，碩士，主要研究方向：ARM嵌入式系統(tǒng)。

陳才（1994—），江蘇泰興人，大學(xué)碩士，現(xiàn)就讀于廣東工業(yè)大學(xué)自動(dòng)化學(xué)院。