陶春　孫乾政

摘要：本文以5R機(jī)器人5自由度機(jī)械臂為例，對機(jī)械臂各組成部分坐標(biāo)系的修改方法D—H進(jìn)行了探討，構(gòu)建了5自由度機(jī)械臂工作運(yùn)動的數(shù)學(xué)模型，講解了機(jī)械臂正逆工作方程的數(shù)學(xué)函數(shù)公式和運(yùn)算求解的過程。通過 MATLAB軟件中的 RoboticsToolbox，分別運(yùn)算了機(jī)械臂的正、逆工作方程，開展了仿真可視化模擬實(shí)驗(yàn)，結(jié)果表明，函數(shù)測算結(jié)果與公式推導(dǎo)的數(shù)值完全一致，證實(shí)了模型結(jié)構(gòu)和預(yù)算方法的一致性，為研究掌握類似機(jī)器人機(jī)械臂的運(yùn)動軌道和控制系統(tǒng)提供有意的借鑒和參考。

關(guān)鍵詞：五自由度;機(jī)械臂;D—H;方程求解;函數(shù)運(yùn)算;運(yùn)動軌道;控制系統(tǒng)

0 ?引言

本文以5R機(jī)器人機(jī)械臂為實(shí)例，對其采用改進(jìn)的模型D—H，細(xì)致分析運(yùn)動學(xué)原理，準(zhǔn)確求解運(yùn)動學(xué)參數(shù)，在此過程中，采取MATLAB方式全程透明仿真，目的在于為研究設(shè)計(jì)機(jī)器人機(jī)械臂運(yùn)動軌跡和機(jī)械臂的控制系統(tǒng)提供參考和借鑒。

1 ?為機(jī)器人機(jī)械臂控制運(yùn)動系統(tǒng)設(shè)計(jì)建立模型

1.1 5R機(jī)器人機(jī)械臂簡介

5R機(jī)器人機(jī)械臂的機(jī)構(gòu)采用關(guān)節(jié)型設(shè)計(jì)，裝配空間結(jié)構(gòu)。該機(jī)械臂全身共計(jì)有5個活動環(huán)節(jié)，全部以模仿人類身體對應(yīng)的關(guān)節(jié)部位命名，從下到上它們分別是：腰、肩、臂、肘、腕。因?yàn)樗茉?個節(jié)點(diǎn)實(shí)現(xiàn)自由轉(zhuǎn)動和工作，所以它也被稱為5自由度機(jī)械臂。其中，機(jī)械臂的腰部位，可以完成機(jī)械臂全身的靈活扭轉(zhuǎn)，肩、臂、肘三個部位，能夠完成空間定位，腕部位能夠完成手腕角度和姿勢的調(diào)整，便于抓取物體。詳情見圖1。

如圖所示，這種結(jié)構(gòu)的機(jī)器人機(jī)械臂是固定結(jié)構(gòu)和與其相連的結(jié)構(gòu)組合而成的，它采用封閉法能夠得到唯一的計(jì)算結(jié)果。固定結(jié)構(gòu)外形相對簡單，相互連接的部位可以扭轉(zhuǎn)零度或九十度，連接的各部分長短各不相同，但連接部位的轉(zhuǎn)角都是零度，這種設(shè)計(jì)結(jié)構(gòu)使計(jì)算起來相對簡單方便。

1.2 各連接部分的狀態(tài)數(shù)據(jù)

從圖1可以看出，機(jī)器人的機(jī)械臂，實(shí)際就是一個多部分組合結(jié)構(gòu)。組合而成的各部分都是關(guān)節(jié)。所以，在了解掌握機(jī)器人的機(jī)械臂時，必須要把各組成部分編號，并注明坐標(biāo)系。而在了解掌握機(jī)器人的機(jī)械臂各組成部分的坐標(biāo)系時，同樣需要為各部分注明一個固定的坐標(biāo)系，用于顯示機(jī)械臂各組成部分之間的位置和關(guān)系。因此，在先給各個組成部分和各個連接部位注明序號后，再自下至上逐個編號，最后形成機(jī)械臂的整個坐標(biāo)系。

為了能夠清楚的學(xué)習(xí)掌握各連接部分的狀態(tài)數(shù)據(jù)，有必要對相關(guān)情況予以解釋說明：

①i-1坐標(biāo)系中的z軸即zi-1和i-1關(guān)節(jié)軸合用一條線，線的方向?yàn)槿我夥较?

②i-1坐標(biāo)系中的X軸即Xi-1和i-1連接部分的垂線重合，方向是由i-1關(guān)節(jié)到i關(guān)節(jié)，當(dāng) Ai-1=0時，Xi-1=zi-1* Zi;

③i-1坐標(biāo)系中的Y軸 yi-1=zi-1*Xi-1。

依據(jù)編號的各連接部分的坐標(biāo)系，對應(yīng)的連接部分的狀態(tài)參數(shù)如下：

1）ai-1是Xi-1自zi-1至zi的測算的距離;

2）？琢i-1是Xi-1自zi-1至zi的旋轉(zhuǎn)的角度;

3）di是zi自Xi-1到Xi的測算的距離;

4）⊙i是zi自Xi-1到Xi的旋轉(zhuǎn)的角度。

各個連接部分是四個參數(shù)合成的，對旋轉(zhuǎn)關(guān)節(jié)來說，這只是關(guān)節(jié)本身的變量，而其他三個數(shù)據(jù)是不發(fā)生變化的。因此這種模式就被叫做D—H。綜上，就能夠計(jì)算出機(jī)器人機(jī)械臂各連接部分的信息和數(shù)據(jù)。詳情見表1。

1.3 建立D—H法各連接部分的坐標(biāo)

要了解掌握機(jī)械臂，就必須建立起機(jī)械臂的坐標(biāo)系。參照上述各連接部分的信息和數(shù)據(jù)，能夠制作出其坐標(biāo)系。詳情見圖2。

各連接部分的坐標(biāo)系建立之后，采取矩陣運(yùn)算方法，能夠測算出各連接部分之間各個坐標(biāo)換算的形式，即連接換算。由此，可以測算出，機(jī)械臂各連接部分的坐標(biāo)。所謂機(jī)械臂工作工程的運(yùn)算求解，就是在知道各個連接部位的角度的基礎(chǔ)上，如何計(jì)算出機(jī)械臂最后一個連接部分的形態(tài)和數(shù)據(jù)。在圖2可以看到，處于中間位置的三個連接部分的旋轉(zhuǎn)軸的方向都是平行關(guān)系，所以把3個矩陣相乘之后，不難算出連接部位5的換算矩陣為5T，則工具相對于基礎(chǔ)坐標(biāo)系0的位置姿態(tài)是0T=5T6T。

? ? ? ? ? ? ? ? ? ? ? 1 0 0 55

? ? ? ? ? ? ? ? 0 1 0 0

這個機(jī)器人的5T= ? ? ? ? ? ，所以能夠求出最終的解。

? ? ? ? ? ? ? ? ? ? ? 0 0 1 125

? ? ? ? ? ? ? ? ? ? ? 0 0 0 1

1.4 機(jī)械臂工作方程逆運(yùn)算求解

所謂機(jī)械臂工作方程逆運(yùn)算求解，就是在已經(jīng)知道機(jī)械臂最后一部分的姿態(tài)數(shù)據(jù)的情況下，如何計(jì)算出各個連接部位的角度。對于方程逆運(yùn)算求解，可以采用方程的方式進(jìn)行。

綜上所述，機(jī)械臂的五個組成部分的信息和參數(shù)都已經(jīng)計(jì)算得出。需要值得注意的是，在計(jì)算過程中，機(jī)械臂完成實(shí)現(xiàn)最后狀態(tài)位置姿態(tài)的途徑和方法不只一條，也就是說，機(jī)器人完成一個動作可能有多種運(yùn)動軌跡，所以可能最后結(jié)果會出現(xiàn)多個解的情況。當(dāng)然， 由于機(jī)械臂本身的問題，在多個解中有的解對機(jī)械臂來說是不合常理，屬于方程運(yùn)算中雖正常運(yùn)算得的結(jié)果、但必須要舍去的解。

2 ?機(jī)械臂運(yùn)動學(xué)系統(tǒng)的仿真研究

實(shí)踐中，對機(jī)械臂的運(yùn)行學(xué)系統(tǒng)相關(guān)仿真問題的測算和研究，通常借助 MATIAB軟件里的Robotics Toolbox進(jìn)行和開展。一般情況下，大多數(shù)科研工作者都是通過先在MATLAB軟件里建筑一個采用修改D—H方法的模型系統(tǒng)，再把Robotics Toolbox測算得到的各項(xiàng)數(shù)據(jù)匯總分析后，按照既定要求編寫操控機(jī)械臂的程序。因此，有人說是Robotics Toolbox為機(jī)器人及其手臂即機(jī)械臂插上飛翔的翅膀，用這句話形容Robotics Toolbox對機(jī)器人及其機(jī)械臂的作用一點(diǎn)也不夸張。這里的“飛翔的翅膀”，就是指其測算得出的各項(xiàng)運(yùn)行系統(tǒng)的函數(shù)。Robotics Toolbox還能夠開展數(shù)據(jù)信息換算函數(shù)和功能的運(yùn)行。所以說，Robotics Toolbox對機(jī)器人及其機(jī)械臂可謂舉足輕重、缺一不可。

3 ?結(jié)論

本文以5R機(jī)器人為例子，剖析其組成部分和設(shè)計(jì)理念，對建筑機(jī)器人機(jī)械臂各組成部分坐標(biāo)系的修改方法D—H進(jìn)行了研究探討。在論述中，中間講解了機(jī)械臂正逆工作方程運(yùn)算求解。通過MATLAB軟件中的Robotics Toolbox，分別運(yùn)算了機(jī)械臂的正、逆工作方程，還開展了仿真可視化模擬實(shí)驗(yàn)，結(jié)果證明，測算與推導(dǎo)的數(shù)值完全一致，說明了模型結(jié)構(gòu)和預(yù)算方法的一致性。

參考文獻(xiàn)：

[1]陳孟元.四自由度采摘靈巧臂的結(jié)構(gòu)設(shè)計(jì)及運(yùn)動學(xué)分析[J]. 陜西理工大學(xué)學(xué)報(bào)（自然科學(xué)版），2017，33（1）：21-26.

[2]孟欣，秦濤，涂福泉.自由度手臂康復(fù)機(jī)器人運(yùn)動學(xué)及動力學(xué)分析[J].機(jī)械傳動，2019（8）：59-63.

[3]段玥晨，章定國，朱健.大范圍運(yùn)動柔性機(jī)械臂斜碰撞動力學(xué)分析[J].動力學(xué)與控制學(xué)報(bào)，2017，15（5）：439-445.

[4]張洪，曾裕民，王通德.全向移動操作臂動力學(xué)建模與實(shí)驗(yàn)分析[J].機(jī)械傳動，2019（6）：64-69.

[5]程堂燦，張鳳生，王浩.基于MATLAB的采摘機(jī)器人運(yùn)動特性分析與仿真研究[J].機(jī)床與液壓，2019（11）：29-34.