文档介绍：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