文档介绍:Ξ
1 1
1
应用数学和力学第卷第期年月
, 21 1 (2000 1 ) 应用数学和力学编委会编
Applied Mathematics and Mechanics 重庆出版社出版
文章编号:1000-0887(2000) 01-0099-07
用旋量方法规划机器人运动轨迹
林瑞麟
(华侨大学机电工程系,福建泉州 362011)
(汤任基推荐)
Ξ
摘要: 以姿态旋量描述机器人的位置姿态,在对偶空间中通过姿态旋量映射的点规划机器人的
终端轨迹,具有直观、简便的独特优点· 规划中直接根据跟踪误差进行收敛,提高了轨迹运行的动
态精度,并适合于冗余自由度操作器·
关键词: 旋量方法; 机器人; 规划; 运动轨迹
中图分类号: O221 1 ;O183 1 ;TH112 文献标识码: A
引言
轨迹规划是机器人控制问题的重要方面,根据作业要求通地轨迹序列控制点控制机器人
位姿轨迹· Paul [1 ]首先利用齐次变换矩阵将手部在直角坐标下的位置、速度和加速度变换成
各关节的位移、速度和加速度,然后规划成二次平滑函数· Paul 方法的计算量非常大,Taylor[2 ]
采用四元数表示法改进了 Paul 方法· 后来 Lin 和 Luh[3 ,4 ]提出规划轨迹的 3 次样条函数方法,
可得到优化的关节运动规律,但当轨迹中间路径点个数 n 较多时, 此法所需计算量也较大,而
且缺乏时姿态插补的考虑· 在许多高精度应用场合,如切割、弧焊等不仅要求机器人位置精
确,还需要在该位置具有任意确定的姿态,对外部品质的要求是很高的· 因此,必须解决机器
人姿态在插补结点处相应的空间坐标,以寻求更具一般意义的位姿轨迹生成的通用算法·
本文运用旋量法来描述机器人末端夹持器在直角坐标空间中的位置和姿态对时间函数所
显示的运动轨迹,由于姿态旋量的直观和简便对描述瞬时姿态有独特的优点,且计算量也小·
文中还利用速度矢量是雅可比矩阵列向量的线性组合关系,对广义坐标的速度量进行线性规
划,免去了求解运动学方程,并适合于具有冗余自由度的操作器·
1 机器人位姿轨迹
1 1 姿态旋量
机器人的位姿就是终端夹持器的位置和姿态· 我们可以用角位移矢量Ω来描述机器人
的姿态,设ψ为基坐标系中绕瞬时轴加转的等效旋转角, K 表示基系中瞬时转轴的单位向量,
则角位移矢量:
Ω= ψK·
收稿日期: 1998-02-05 ; 修订日期: 1999-10-30
基金项目: 福建省自然科学基金资助项目
99
© 1995-2004 Tsinghua Tongfang Optical Disc Co., Ltd. All rights reserved.
1
001 林瑞麟
根据旋量定义,可以证明等效角位移矢量的姿态矢量是旋量,表示为
Ω^ = Ω+εOP × Ω= Ω+εOD × Ω,
式中, OP 为用位移矢量上给定的初始点位置,基系原点 O 为旋量参考点·
由对偶数理论可知:三维欧氏空间中直线与三维对偶
空间中的点是一一对应,于此可将直角坐标空间中的姿态
旋量Ω^ i 映射到对偶空间, 得到对应点^bi , 位姿轨迹的规划
问题便转化为对