摘要
针对核反应堆检修用机械手在末端任务给定的无碰撞路径规划问题进行研究。提出一种将雅可比转秩控制算法与快速搜索随机树法相结合的混合算法,通过选择距目标点工作空间距离最近的位姿点作为树的扩充节点,避免对逆运动学进行求解。利用雅可比转秩控制算法计算出最优扩充方向,采用二分梯度下降扩充方法对末端工具速度加以限制,避免关节速度发生突变。仿真结果表明该混合算法的快速性和有效性。
The problem of collision-free path planning for nuclear reactor repairing manipulator with the given end path is considered. A hybrid algorithm of combining the transpose of Jacobian control algorithm with rapidly-exploring random tree method is presented. The nearest configuration point to the workspace with goal point is taken as the expanded node of the tree to avoid the solving of inverse kinematics. The best expanding direction is calculated with the jacobian transpose control algorithm. And the velocity of the end tool of the manipulator is restricted by using the bisection gradient-decent extend algorithm to avoid the occurrence of joint velocity mutation. The simulation results show the rapidity and validity of the proposed hybrid algorithm.
出处
《控制工程》
CSCD
北大核心
2009年第6期756-759,共4页
Control Engineering of China
基金
省级自然科学基金资助项目(60875025)
哈尔滨工程大学校基金资助项目(002040260746)
关键词
冗余机械手
快速搜索随机树
路径规划
工作空间
雅可比转秩
逆运动学
redundant manipulator
rapidly-exploring random tree
path planning
workspace
the transpose of Jacobian
inverse kinematics
