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)的角度存在正负，故对角度的正负做出如下规定：关节转角顺时针旋转为负，反之为正。并假设机械臂各个关节的运动是匀速的，不考虑加速度对连杆运动轨迹的影响。

　　(4)对于问题(3)，已知初始位置和末位置，求一条空间曲线要求不经过若干个已知点，即避开障碍物的运动，称这类为HP问题。即在PTP问题中增加障碍物，使得指尖必须避开障碍物运动的路径规划问题。考虑先让指尖沿着起点和终点的连线轨迹运动，当它遇到障碍物时，设法让其避让然后从新的起点再径直向目标点前进，不断重复上述过程，直至达到目标点。可以看出，从每个新的起点径直向目标点前进，这样走距离最短，当然这指从每个新起点到终点间的距离最短。实际过程中，障碍物的形状可能会各种各样，过于复杂会提高算法的复杂性，采用最小包容长方体对障碍物进行简化。具体算法及实现过程许多论文中均有提到，这里不再累赘。

　　3、结语

　　在机器臂的运动问题中，机器人要执行的动作都可以抽象为点到点的运动的PTP问题，已知曲线找点的CP问题及点到点的避障问题fl~HP问题。在解实际问题时首先对问题加以定性，然后用对应的算法进行解决。