结 论
本课题来源于“921”空间站项目。本文首先研究了一种冗余机械臂逆运动学求解方法,然后分析了七自由度冗余机械臂的奇异性,最后提出了一种改进的 bi-RRT*避障路径规划算法,并通过仿真和实验验证了冗余机械臂逆运动学和避障路径规划算法的有效性。本文的具体工作总结如下:
(1)研究了一种基于奇异鲁棒性逆的梯度投影法。该方法能够有效解决基于伪逆法的冗余机械臂逆运动学在奇异构形附近关节速度超限问题,同时保留了梯度投影法具有的优化性能指标的能力。同时,基于反馈思想,将位姿误差引入逆运动学方程中,有效减小了计算误差。利用 Matlab 的 Sim Mechanics 工具箱进行了仿真,在七自由度冗余机械臂上验证了算法的有效性。
(2)分析了七自由度冗余机械臂的奇异性。采用相关旋量抑制方法对七自由度机械臂进行了奇异性分析,推导出机械臂出现奇异的五种条件。为使对七自由度冗余机械臂奇异构形的理解不仅局限在公式层面,文中详细分析了每种条件,获得了每种条件对应的奇异构形几何特征,从构形的几何特征就可以直接判断出机械臂是否处于奇异构形,并用图解形式给出了每种条件对应的一种奇异构形。
(3)提出了一种改进的 bi-RRT*避障路径规划算法和基于平滑样条的路径平滑算法。这种改进的 RRT*算法,在 RRT*算法的基础上引入了双向搜索策略和基于三角不等式的路径优化算法,能够有效解决 RRT*算法规划成功率低、收敛速度慢的问题。针对规划路径不光滑问题,提出了基于平滑样条的路径平滑算法。仿真结果表明,无论在低维空间还是高维空间,在相同的规划时间内,改进的 bi-RRT*算法具有更高的规划成功率,能够更快收敛于最优路径代价;经基于平滑样条的路径平滑算法处理的路径,不仅能保证机械臂与障碍物无碰撞,而且能使路径更平滑,机械臂的运动更平稳。 由于时间和客观条件的限制,本文研究的冗余机械臂运动学及避障路径规划尚有不完善的地方,以后的研究工作可以从如下几点展开:
(1)基于奇异鲁棒性逆的梯度投影法中,如何选取合适的最小奇异值的边界值、优化系数等,如何优化多个性能指标;
(2)如何将 RRT*算法用于机械臂的在线避障规划,并在规划时考虑关节角速度、加速度的约束。