机械臂运动路径设计问题 (B题).docVIP

全国第四届研究生数学建模竞赛 一、问题描述 机器人通常分为关节式机械臂（或称机械臂、机械手、机器人操作臂、工业机器人等）和移动式机器人。一般来说，前者具有更多的自由度，而后者的作业范围则更大一些。 以某型号机器人为例，其示意图见原题图1。这种机器人一共有6个自由度，分别由六个旋转轴（关节）实现，使机器人的末端可以灵活地在三维空间中运动。为了便于分析和计算，我们对机器人结构进行简化，简化后的数据见原题图2和参数表1。 机器人关于六个自由度的每一个组合，表示机械臂的一个姿态，显然每个姿态确定顶端指尖的空间位置X：。假定机器人控制系统只能够接收改变各个关节的姿态的关于连杆角度的增量指令（机器指令），使得指尖（指尖———图2中的E点，具有夹工具、焊接、拧螺丝等多种功能，不过在这里不要求考虑这方面的控制细节）移动到空间点X′，其中各个增量只能取到-2, -1.9, -1.8, ┅，1.8, 1.9, 2这41个离散值（即精度为0.1°，绝对值不超过2°）。通过一系列的指令序列可以将指尖依次到达位置X0，X1，┅，Xn，则称X0，X1，┅，Xn为从指尖初始位置X0到达目标位置Xn的一条路径（运动轨迹）。根据具体的目标和约束条件计算出合理、便捷、有效的指令序列是机器人控制中的一个重要问题。我们约定直角坐标系的原点设在图2的A点，z轴取为AB方向，x轴垂直纸面而y轴则在基座所固定的水平台面上。 1．根据市场需求，机械臂制造厂打算为他们的产品研发一个软件系统，能够直接将用户的运动命令自动转换成机器指令序列。即为这类机器人设计一个通用的算法，用来计算执行下面指定动作所要求的指令序列，并要求对你们算法的适用范围、计算效率以及你们的近似算法所造成的误差和增量离散取值所造成的误差大小进行讨论（不考虑其他原因造成的误差）： ①．已知初始姿态Φ0和一个可达目标点的空间位置（Ox, Oy, Oz），计算指尖到达目标点的指令序列； ②．要求指尖沿着预先指定的一条空间曲线x = x(s), y = y(s), z = z(s), a ≦ s ≦b 移动，计算满足要求的指令序列； ③．在第①个问题中，假设在初始位置与目标位置之间的区域中有若干个已知大小、形状、方向和位置的障碍物，要求机械臂在运动中始终不能与障碍物相碰，否则会损坏机器。这个问题称机械臂避碰问题，要求机械臂末端在误差范围内到达目标点并且整个机械臂不碰到障碍物（机械臂连杆的粗细自己设定）。 2. 应用你的算法就下面具体的数据给出计算结果，并将计算结果以三组六维的指令序列（每行6个数据）形式存放在Excel文件里，文件名定为answer1.xls，answer2.xls和answer3.xls。 假设在机械臂的旁边有一个待加工的中空圆台形工件，上部开口。工件高180mm，下底外半径168mm，上底外半径96mm，壁厚8mm。竖立地固定在xy－平面的操作台上，底部的中心在 (210, 0, 0)。 ①．要求机械臂（指尖）从初始位置移动到工具箱所在位置的 (20,－200, 120) 处，以夹取要用的工具； ②．如果圆台形工件外表面与平面 x = 2 z 的交线是一条裂纹需要焊接，请你给出机械臂指尖绕这条曲线一周的指令序列； ③．有一项任务是在工件内壁点焊四个小零件，它们在内表面上的位置到xy平面的投影为（320,-104）、（120,106）、（190,-125）和（255,88）。要求机械臂从圆台的上部开口处伸进去到达这些点进行加工，为简捷起见，不妨不计焊条等的长度，只考虑指尖的轨迹。 3．制造厂家希望通过修改各条连杆的相对长度以及各关节最大旋转角度等设计参数提高机械臂的灵活性和适用范围。请根据你们的计算模型给他们提供合理的建议。 二、问题分析 机械臂运动路径规划的目的是根据要完成的动作，位置姿态以及周围障碍物信息，控制机械臂在避开障碍物的条件下到达指定位置和姿态。对于6自由度机械臂，主要由前3个关节控制末端工作点的位置，后3个关节实现工作点的姿态调整。 众所周知，在空间中要确定一个物体的几何状态需要确定其3个位移坐标(或称位置自由度)和3个旋转坐标(或称姿态自由度)。在机器人学术语中，将一个空间物体的上述6个自由度称为该物体的位姿，即位置和姿态。 本题中问题1要求给出通用的算法，使指尖分别完成到达指定目标点、按指定曲线轨迹移动等动作，并考虑机械臂避碰的问题。所设计的算法应该能给出合理、便捷、有效的指令序列，即改变各个关节的姿态角度的增量指令（机器指令）。问题2主要是依据问题1中的算法模型，进行具体计算，并把计算出的增量指令序列以三组六维的形式存放。问题3是在问题1、2的基础上，对机械臂相关参数的设计提出合理的建议。 解决这些问题有两个关键部分要处理：1、机械臂的位姿逆运算问题，即就是当