机器臂运动路径设计问题之算法分析
2016-8-31 来源：长安大学工程机械学院 作者： 张旭 任国涛 宁鹏
摘要：机械臂运动路径设计问题备受机器人领域的关注，本文对该问题进行了分析，把具体地现实问题用数学语言进行描述，将问题抽象化后设计了一个通用的数学算法去解决。
关键词：机器臂指令序列算法
1、问题概述
根据市场需求，机械臂制造厂打算为产品研发一个软件系统，能够直接将用户的运动命令自动转换成机器指令序列。即设计一个通用的算法，用来计算执行下面指定动作所要求的指令序列：
(1)已知初始姿态Φ0和一个可达 目标点的空间位置(Ox，Oy，)，计算指尖到达目标点的指令序列。
(2)要求指尖沿着预先指定的一条空间曲线X=X(S)，y=y(s)，Z=z(s)，a≤s≤b移动，计算满足要求的指令序列。
(3)在第(1)个问题中，假设在初始位置与目标位置之间的区域中有若干个已知大小、形状、方向和位置的障碍物，要求机械臂在运动中始终不能与障碍物相碰，否则会损坏机器。这个问题称机械臂避碰问题，要求机械臂末端在误差范围内到达目标点并且整个机械臂不碰到障碍物(机械臂连杆的粗细自己设定)。
2、解题分析
(1)首先，题中初始位置(0，-90，0，0，-90，0)的角度存在正负，故对角度的正负做出如下规定：关节转角顺时针旋转为负，反之为正。并假设机械臂各个关节的运动是匀速的，不考虑加速度对连杆运动轨迹的影响。
Φ(@1，，@2 ，@3 ，@4 ，@ 5，06 )形式，使所有离散点满足每相邻两点之间的I口@_l满足精度要求，这类问题称为cP问题。直接让指尖沿着曲线移动比较困难，可将曲线离散化，将CP问题转化为PTP问题，仍旧把初始姿态定义为 0，各离散点为末端位置，采用PTP问题方法求得各离散点的姿态。为了避免组合带来的误差，保证机械臂指尖轨迹的精度，必须保证任意相邻离散点的指令序列不超过2，若不满足，则在此离散点间进行插值，重复以上动作，直至所有的都满足指令系列小于等于2。
(4)对于问题(3)，已知初始位置和末位置，求一条空间曲线要求不经过若干个已知点，即避开障碍物的运动，称这类为HP问题。即在PTP问题中增加障碍物，使得指尖必须避开障碍物运动的路径规划问题。考虑先让指尖沿着起点和终点的连线轨迹运动，当它遇到障碍物时，设法让其避让然后从新的起点再径直向目标点前进，不断重复上述过程，直至达到目标点。可以看出，从每个新的起点径直向目标点前进，这样走距离最短，当然这指从每个新起点到终点间的距离最短。实际过程中，障碍物的形状可能会各种各样，过于复杂会提高算法的复杂性，采用最小包容长方体对障碍物进行简化。具体算法及实现过程许多论文中均有提到，这里不再累赘。
3、结语
在机器臂的运动问题中，机器人要执行的动作都可以抽象为点到点的运动的PTP问题，已知曲线找点的CP问题及点到点的避障问题fl~HP问题。在解实际问题时首先对问题加以定性，然后用对应的算法进行解决。
投稿箱：
如果您有机床行业、企业相关新闻稿件发表，或进行资讯合作，欢迎联系本网编辑部， 邮箱：skjcsc@vip.sina.com
如果您有机床行业、企业相关新闻稿件发表，或进行资讯合作，欢迎联系本网编辑部， 邮箱：skjcsc@vip.sina.com
更多相关信息
