七自由度机器人运动学分析

－ ｓ３４ｓ５ ｃ５
% ｓ３ａ３ %
ｄ３
% %%
#０
０
０
１&
（４）
ａ３ $
%
０ ０
% %
（５）
%%
１&
（６）
!ｃ２３４ｃ５ｃ６－ ｓ２３４ｓ６ － ｃ２３４ｃ５ｓ６－ ｓ２３４ｃ６ － ｃ２３４ｓ５ ａ３ｃ２３＋ｃ２ａ２ $
"
１Ｔ６
＝
１Ｔ２２Ｔ６
＝
" ｓ５ｃ６ """－ ｓ２３４ｃ５ｃ６－ ｃ２３４ｓ６
－ ｓ２３ａ３－ ｓ２ａ２
%%
#
０
０
０
１
&
由 可得出：
!ｎｘ ｏｘ ａｘ
"
"ｎｙ ｏｙ ａｙ
０Ｔ６
＝
" ""ｎｚ
ｏｚ
ａｚ
"
#０ ０ ０
ｐｘ $
%
ｐｙ % %
ｐｚ
% %
%
１&
’ｎｘ＝ｃ１（ｃ２３４ｃ５ｃ６－ ｓ２３４ｓ６）－ ｓ１ｓ５ｃ６ )ｎｙ＝ｓ１（ｃ２３４ｃ５ｓ６－ ｓ２３４ｃ６）＋ｃ１ｓ５ｃ６ )ｎｚ＝－ ｓ２３４ｃ５ｃ６－ ｃ２３４ｓ６
１Ｔ６
＝
０Ｔ１１Ｔ６
＝
""ｓ１（ｃ２３４ｃ５ｃ６－ ｓ２３４ｓ６）＋ｃ１ｓ５ｃ６ "" － ｓ２３４ｃ５ｃ６－ ｃ２３４ｓ６
ｓ１（－ ｃ２３４ｃ５ｓ６－ ｓ２３４ｃ６）－ ｃ１ｓ５ｓ６ ｓ２３４ｃ５ｓ６－ ｃ２３４ｃ６
－ ｓ１ｃ２３４ｓ５＋ｓ１ｃ５ ｓ２３４ｓ５
ｓ１（ａ３ｃ２３＋ｃ２ａ２）＋ｃ１（ｄ３＋ｄ２）%%（８）
（参照图 １）。
矩阵）描述，即：
ｄ３
小臂 ａ３
θ４
θ３
ｄ２
θ２
θ５ θ６
立 柱
θ１
末端执行 器（铲子）
图 １ 浮渣铲除机器人结构简图
!ｃθｉ
ｉ－
１Ａｉ
＝
""ｓθｉ ""０
#０
－ ｓθｉｃαｉ－１ ｃθｉｃαｉ－ １ ｓαｉ－ １
０
ｓθｉ ｓαｉ－ １ － ｃθｉ ｓαｉ－１
ｃαｉ－ １ ０
ａｉ－ １ｃθｉ $
ＬＩ Ｇｕｏ－ ｙｉｎｇ， ＬＩＵ Ｘｉａｏ－ ｓｈｅｎｇ
（Ｊｉａｎｇｘｉ Ｕｎｉｖｅｒｓｉｔｙ ｏｆ Ｓｃｉｅｎｃｅ ａｎｄ Ｔｅｃｈｎｏｌｏｇｙ， Ｇａｎｚｈｏｕ ３４１０００， Ｊｉａｎｇｘｉ， Ｃｈｉｎａ）
Ａｂｓｔｒ ａｃｔ：．Ｎｅｔ － ｂａｓｅｄ ｃｉｔｙ ｐｌａｎｎｉｎｇ ａｎｄ ｍａｎａｇｅｍｅｎｔ ｉｎｆｏｒｍａｔｉｏｎ ｓｙｓｔｅｍ ｉｓ ｐｒｏｇｒａｍｍｅｄ ｂｙ ｕｓｉｎｇ Ｍｉｃｒｏｓｏｆｔ．ｎｅｔ，
（２）可以把人从恶劣的工作环境中解脱出来，既 解决了劳动力保护问题，又为提高生产效率创造了 条件，具有显著的经济效益和社会效益。
第 ２１ 卷
参考文献：
［１］ Ｓａｅｅｄ Ｂ Ｎｉｋｕ．机器人学导论—— —分析、系统及应用［Ｍ］．孙富 春，朱纪洪，刘国栋，等，译，孙增圻，审校．北京：电子工业出版 社，２００４．
在实际的计算过程中，无论关节是高一点还是低一
ｃｉｊ ＝ｃｏｓ（θｉ＋θｊ）＝ｃｉｃｊ－ ｓｉｓｊ
（３）
点，机器人的运动并不会有任何差异。因此坐标系原
ｓｉｊ ＝ｓｉｎ（θｉ＋θｊ）＝ｃｉｓｊ＋ｓｉｃｊ
点选择在大臂和立柱的交点处。连杆的 Ｄ－ Ｈ 参数列 式中：ｃｉ 、 ｃｊ 为 ｃｏｓθｉ 和 ｃｏｓθｊ 的缩写，ｓｉ 、 ｓｊ 为 ｓｉｎθｉ
Ｏｎ ｔｈｅ Ｄｅｓｉｇｎ ｏｆ Ｄｒ ｏｓｓ Ｅｒ ａｄｉｃａｔｉｏｎ Ｒｏｂｏｔ Ｃｏｎｔｒ ｏｌ Ｓｙｓｔｅｍ
ＷＵ Ｆｕ－ ｊｉ
（Ｇａｎｚｈｏｕ Ｎｏｎｆｅｒｒｏｕｓ Ｍｅｔａｌｌｕｒｇｙ Ｒｅｓｅａｒｃｈ Ｉｎｓｔｉｔｕｔｅ， Ｇａｎｚｈｏｕ ３４１０００， Ｊｉａｎｇｘｉ， Ｃｈｉｎａ）
Ａｂｓｔｒ ａｃｔ：Ｔｈｅ ｄｒｏｓｓ ｅｒａｄｉｃａｔｉｏｎ ｒｏｂｏｔ ｉｓ ａ ｋｉｎｄ ｏｆ ｉｎｄｕｓｔｒｙ ｒｏｂｏｔ ｗｈｉｃｈ ｈａｓ ７ ｄｅｇｒｅｅｓ ｏｆ ｆｒｅｅｄｏｍ ｔｏ ｅｘｔｅｎｄ ａｎｄ
第 ２１ 卷第 ４ 期 ２００７ 年 １２ 月
Ｊｉａｎｇｘｉ Ｎｏｎｆｅｒｒｏｕｓ Ｍｅｔａｌｓ
文章编号： １００５－ ２７１２（２００７）０４－ ００４４－ ０３
七自由度机器人运动学分析
Ｖｏｌ．２１，Ｎｏ．４ Ｄｅｃ． ２００７
吴富姬
（赣州有色冶金研究所，江西 赣州 ３４１０００）
摘 要： 浮渣铲除机器人是一种为了代替在高温、高粉尘环境下工作的人工劳动而设计的七自由度串联关节型机
ｍｏｖｅｍｅｎｔｓ ｃａｎ ｐｒｏｖｉｄｅ ｔｈｅｏｒｅｔｉｃａｌ ａｎｄ ｐｒａｃｔｉｃａｌ ｆｏｕｎｄａｔｉｏｎ ｆｏｒ ｔｈｅ ｃｏｎｔｒｏｌ ｏｆ ｒｏｂｏｔ＇ ｓ ａｃｔｉｏｎｓ， ｗｈｉｃｈ ｗｏｕｌｄ ｂｅ ａｎ
ｅｆｆｉｃｉｅｎｔ ｍｅｔｈｏｄ ｔｏ ｓｔｕｄｙ ｔｈｅ ｍｏｖｉｎｇ ｃｈａｒａｃｔｅｒｉｓｔｉｃｓ ｏｆ ｓｉｍｕｌａｔｉｏｎ ａｒｍｓ ａｎｄ ｃｏｎｔｒｏｌｌｅｒｓ．
" ""
ｓ５ｃ６
#０
－ ｃ５ｓ６－ ｓ４ｃ６ － ｃ４ｓ５
－ ｓ４ｃ５ｓ６＋ｃ４ｃ６ － ｓ４ｓ５
－ ｓ５ｓ６
ｃ５
０
０
!ｃ３４ｃ５ｃ６－ ｓ３４ｓ６ － ｃ３４ｃ５ｓ６－ ｓ３４ｃ６ － ｃ３４ｓ５ ａ３ｃ３＋ａ２ $
"
２Ｔ６
＝
２Ｔ３３Ｔ６
＝
"ｓ３４ｃ５ｃ６＋ｃ３４ｓ６
" ""
ｓ５ｃ６
－ ｓ３４ｃ５ｓ６＋ｃ３４ｃ６ － ｓ５ｓ６
Ｋｅｙ ｗｏｒ ｄｓ： ｒｏｂｏｔｓ； ｍｏｖｅｍｅｎｔ； ｄｅｓｉｇｎ； ｆｒｅｅ ｄｅｇｒｅｅ
（ 编辑： 刘忠洪）
!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!! （ 上接第 ４３ 页）
Ｄｅｓｉｇｎ ａｎｄ Ｉｍｐｌｅｍｅｎｔａｔｉｏｎ ｏｆ ．Ｎｅｔ－ ｂａｓｅｄ Ｃｉｔｙ Ｐｌａｎｎｉｎｇ ａｎｄ Ｍａｎａｇｅｍｅｎｔ Ｉｎｆｏｒ ｍａｔｉｏｎ Ｓｙｓｔｅｍ
根据式（１）、（２）得到浮渣铲除机器人的末端执
座的直线运动可以单独来控制，因此在运动学分析 行器（铲子）的变化矩阵 ０Ｔ６ ，０Ｔ６ 即为关节变量 θ１，
时属于冗余自由度，不予考虑，只分析其他 ６ 个自由 θ２，…θ６ 的函数。在求解运动方程过程中，其简写形
度。其二，腰部回转关节的原点并不在实际位置，但 式如下：
于表 １ 中。
和 ｓｉｎθｊ 的缩写。
表 １ 连杆的 Ｄ－ Ｈ 参数表
从（３）式可算出各个连杆的变换矩阵：
序号
１ ２ ３ ４
θｉ ／（°）
θ１ θ２ θ３ θ４
ｄｉ ／ｍｍ
０ ｄ２ ｄ３ ０
ａｉ－ １／ｍｍ
０ ０ ａ２ ａ３
αｉ－ １／（°）
０ － ９０
０ ０
!ｃ５ｃ６ － ｃ５ｓ６ － ｓ５
"
４Ｔ６
４６
由上述 ０Ｔ６ 的矩阵，描述了机器人末端连杆坐 标系相对基坐标系的位置。
４结 语
（１）研究机器人机构运动学的目的就是要建立 机器人各运动构件与末端执行器在空间的位置、姿 态之间的关系，建立机器人手臂运动的数学模型，为 控制机器人的运动提供分析的方法和手段，为仿真 研究手臂的运动特性和设计控制器实现预定的功能 提供一种高效、方便的方法。
())))))))ｏｏｏａａａｐｐｘｙｚｘｙｚｘｙ＝＝＝＝＝＝＝＝ｓｓｃｓ－－ｃｓ２２１１１１ｃｓ３３（（（（４４－１ａ１－ａｃｓｃｃ３ｃ５３５ｃ２ｃ２ｃｓ３２３２２４３６２４３３ｓ４３－ｓ４＋ｃ＋ｃ５５ｃ＋－５ｃ５ｃｓ２ｓｓ２ｓ３２６６ａ４ａ１－１－ｃｃｃ２２ｓ）６）ｓ５５＋－２２３３ｃ４ｓ４ｃｃ１１（（６６ｄｄ））－＋３３＋＋ｃｓ１ｄｄ１ｓｓ２２５５））ｓｓ６６ *ｐｚ＝－ ｓ２３ａ３－ ｓ２ａ２
浮渣铲除机器人的设计是仿造人工铲除过程的 手臂运动方式，它的运动是由底座的直线运动，腰部 （立柱）回转运动，大臂的仰俯运动，小臂的仰俯运
器人坐标系统如图 ２，相邻杆件间位置和姿态可用
Ｚ２
Ｚ５
Ｚ３
Ｚ４
ａ２
Ｚ１
Ｚ０
Ｘ２
ａ３
Ｘ３
Ｘ４Ｘ５Ｘ６
Ｘ１Ｘ０
Ｘ６
图 ２ 浮渣铲除机器人杆件坐标系
动、腕部的回转、仰俯、左右摆动这七个自由度组成 ４ ×４ 的齐次变换矩阵（称为 Ａ 矩阵，也叫关节变换
ｒｅｔｒａｃｔ ｔｈｅ ｊｏｉｎｔ ｃｏｎｔａｃｔｓ． Ｉｔ ｃａｎ ｒｅｐｌａｃｅ ｈｕｍａｎ ｆｏｒｃｅ ｉｎ ｔｈｅ ｈｉｇｈ ｔｅｍｐｅｒａｔｕｒｅ ａｎｄ ｈｉｇｈ ｄｕｓｔ ｅｎｖｉｒｏｎｍｅｎｔ． Ｔｈｅ
ｒｅｓｅａｒｃｈ ｏｆ ｉｔｓ ｓｔｒｕｃｔｕｒｅ ｋｉｎｅｍａｔｉｃｓ ａｎｄ ｔｈｅ ｅｓｔａｂｌｉｓｈｍｅｎｔ ｏｆ ｔｈｅ ｍａｔｈｅｍａｔｉｃａｌ ｍｏｄｅｌ ｏｎ ｔｈｅ ｒｏｂｏｔ ＇ ｓ ａｒｍ
置参数。
０Ｔｎ ＝ ０Ｔ１１Ｔ２…ｎ－ １Ｔｎ
（２）
将各个连杆变换 ｉ－１Ｔｉ（ｉ＝１，２，…ｎ，为关节号数）顺 序相乘，得到末端执行器的坐标系｛ｎ｝ 相对于基坐标 系 ｛０｝的总的矩阵变换通式：０Ｔｎ ＝ ０Ｔ１１Ｔ２…ｎ－１Ｔｎ 。
３ 运用 Ｄ－ Ｈ 表示方法求解机器人运 动学正解
图 ２ 和图 １ 比较起来会发现有所不同，其一，底
［２］ 蔡自兴．机器人学［Ｍ］．北京：清华大学出版社，２０００． ［３］ 余达太，马香峰，郗安民，等．工业机器人应用工程［Ｍ］．北京：冶