-
公开(公告)号:CN113858205A
公开(公告)日:2021-12-31
申请号:CN202111240136.6
申请日:2021-10-25
Applicant: 东南大学
IPC: B25J9/16
Abstract: 本发明公开了一种基于改进RRT*的七轴冗余机械臂避障算法,包括以下步骤:S1、确定机械臂DH模型,定义机械臂2,4,6轴组成的臂平面与参考面间的夹角为臂角;S2、根据DH模型矩阵表达式求解,期望位姿矩阵和臂角共七个约束条件,结合机械臂几何构型,解得七个关节角;S3、根据启发式偏向采样策略,获得随机树采样点;S4、结合启发式偏向采样策略,利用RRT*算法搜索出一条起始与期望位置间的无碰渐进最优路径,机械臂沿其运动过程中检测是否发生碰撞。发生碰撞则改变臂角,利用零空间自运动来避开障碍物。本申请使用改进的RRT*避障算法属于智能优化算法的一种,在RRT*算法的基础上结合启发式偏向采样策略与零空间自运动进行改进,提高了算法的规划速度与效率。