1 六连杆机器狗机构运动学方程的建立
机器狗机构是由一系列关节连接起来的连杆机构所组成,为机械手的每一连杆建 立一个坐标 系, 描述一个连杆和下一个连杆间相对关系的齐次变换叫做A矩阵.
0
1 1
瑶
n
璃
TfTJ t 33
0
0
0
0
L 1
(?*
p.
七
°j ay
当
Ot J
>
0
0 0
1
(4
(3 )
)
(2 )
n. = S] + 5耍)■+ Cl (叱c,-史易)'
(七41 —新曲)一。](它中 + E^-Cj ) &5 56 S
(\ = C](02 s^ 十 S2 ) &3 + Cl(血钮 -
%也)(宾^5案 + S4C3)+ (c4c^ 一
S^C5 &6 ) ,
』= S1S4SJ + C] ( C2C3 - 8^83 ) C4S5 十 C] (■电 十
钮勺〉4 »
PK = CLa| + C] ( C^Ci — S3 电)&g + C](C2&3 + ^2 Cj ) (I4 *
ny - 8( (c^Cj 一 fi2SJ)(C4C5C6 一 B4s^)-
凯(02啊+钮与)尊电-。1(々56 +点%%),
% = 电+览%)亏W +如(电电-
cjcj ) (04053^ + S^Ce) 一 ct ( c4<^ — 钮C5况)>
孔=Si(C2®3 + S2C5)C5 + S:(C2C3 一 母可)%& —
C]曲钮5
Py = si]旬+ s( a3 + S] (c^c^ -布约)心 + (02Si + &2己3)d〈尊
□h =(%珂 一 S2S3 ) + (C2&J + Ssc3 ) ( c4c5c^ —
耕%),
6 -(宅为 一 - (& 电 + +
az -(仑力 + S2C3R4S5 + (%翱 - 而此】口5,
Ph = 如% +(Q2SS + 圣为)电 + (圣* - CiCj )d4-
3六连杆机器人运动学方程的逆解
逆解是已知满足某作业要求时,末端执行器的空间位置和姿态以及各杆的结 构参数,求关节变量,,是机器人应用中极
为重要的问题, 得关节变量值进行移动或转动,才能使末端执行器达到作业所要求的位置和姿
A矩阵的逆矩阵公式
由式(3 )按逆矩阵求法可得A的逆矩阵公式
六连杆机器人运动学方程的逆解公式
cosdn
0
-七
-sinfincosa±t
cos^^coso,.
sinan
— cos flnsinc n
-dneosan
0
0
0
1
1
0
-口1
0
0
1
0
-1
0
0
0
0
0
1
c2
电
0
一 U-2
-为
ca
0
0
0
机器狗运动分析 来自淘豆网www.taodocs.com转载请标明出处.