2010
年
9
月
第
17
卷第
5
期
控制工程
Control
Engineering
of
China
Sep.
20
1 0
Vol. 17 ,No. 5
文章编号:
1671-7848
(2010)
05
-0
669
-0
5
机械臂三维避障算法研究
李东沽,邱江艳,尤
波,王焕灵
(哈尔滨理工大学自动化学院,黑龙江哈尔滨
15
∞
80)
摘
要:为解决现有机械臂遥障算法计算量大且难以实现非结构环珑下三维避障问题,
对分解运动速度控制算法
(RMRC)
进行了改进,并将其应用到
Motoman
机械臂三维避障中。通
过对
Motoman
机械臂机构的合理简化和
RMRC
算法的进一步改进,利用
Maùab
搭建的
Motoman
机械臂仿真模型,在具有静态和动态障碍物的三维环境中对连续轨迹
(CP)
和点到点(凹凹的
运动控制进行了仿真,最后利用所搭建的遥操作系统对改进后的算法进行验证。仿真和实验
结采证明了算法的有效性和实用性。
重盖平
关键词:机械臂;三维避障;分解运动速度控制
中图分类号:
TP27
文献标识码
A
Three-dimensional Obstacle Avoidance Algorithm for Manipulator
LI
Dong-jie
,
QIU
liang-yan ,
YOU
Bo
,
WANG
Hi
削阶
ling
(
College
of
Automation
,
Harbin
Unive
四
ity
of
Science
and
Technology
,
Harbin
150080
, China)
Abstract:
To
the problems of the large amount calculation of existing obstacle avoidance algorithm and the difficulty
to
avoid obstacles
in three-dimensional
(3
D) space of unstructured environments, an improved resolved motion rate control ( RMRC) method is proposed ,
which is applied to the 3D obstacle avoidance of the Motoman manipulator.
By
reasonable simplification of the robot structure and further
improvement of RMRC
, the motion controls of CP and PTP are simulated in 3 D environment with static and dynamic obstacles using the
simulation model built with Matlab.
Th
e improved algorithm is
tested
、世
th
the established teleoperation system. Simulation and experi-
mental results indicate that the algorithm is effective and feasible.
Key
words:
manipulator; 3D obstacle avoidance;
RMRC
1
引言
随着人类发展空间的不断扩展,遥操作系统得
到了广泛的应用并发挥着越来越重要的作用
[IJ
。由
于作业环境的复杂性和不可预测的动态特性,使遥
操作的许多工作具有不可预测性。传统的基于结构
化环境的定量、精确的感知、规划和避障方法已不
能满足实际应用的需要
[2-3J
。因此,设计一种能够
使机械臂在未知、动态环境中自主避开障碍物、顺
利完成作业任务的避障算法已成为目前遥操作机器
人系统的关键问题之一。
对移动机器人的避障,相关学者进行了大量的
研究,使其动态避障得到了很好的解决
[4J
。而对于
机械臂的避障,由于其受本身结构和关节间藕合关
系的限制,其轨迹规划和避障算法跟移动机器人相
比要复杂的多,目前主要的避障方法包括
ι
空间
法
[5J
、人工势场法
[6J
和智能控制法
[7J
等。这些方
法都是在已知机械臂的工作环境几何参数的前提下
进行仿真的,且计算量比较大。对于非结构环境的
收稿日期:
2
∞
9
心
4
-0
2;
收修定稿日期:
2
∞
9
-0
5
-D6
几何参数是不可能事先知道的,因此这些方法不再
适用。目前对非结构环境下机械臂避障的研究相对
较少,
Hasegawa
T
等问]提出了基于扫描远端机械臂
作业空间的方法来实现非结构环境下机械臂在关节
空间的无碰撞路径规划,但系统精度受体素划分的
影响过大。分解运动速度控制
(RMRC)
算法
[9J
在很
大程度上解决了上述问题,但其研究仿真拘泥于平
面机械臂,目前尚未有人提出该算法在三维实时避
障中的应用。基于以上问题,本文在深人研究
RM
RC
算法的基础上对其进行了改进,并将其应用到
Motoman
机械臂的三维避障中。
2
RMRC
算法研究及改进
1)
RMRC
算法研究
对于多自由度机械臂,
其关节空间位姿和操作空间位姿的关系一般是非常
复杂的非线性关系,而直接在关节空间规划机械臂
的运动显然是很不直观的。因此需要一种将笛卡尔
坐标空间的运动分解为每个关节运动的方法,这就
是所谓的分解运动速度控制方法
(RMRC)
。
基金项目:教育部博士点基金资助项目
(2
∞
80214α
阳)
;黑龙江省自然科学基金资助项目(F2∞
808)
作者简介:李东洁(1
981-)
,女,山东海坊人,讲师,博士,主要从事机器人控制技术等方面的教学与科研工作。