一种基于双向RRT*算法的机械臂实时感知规划方法及系统
摘要:
本发明公开了一种基于双向RRT*算法的机械臂实时感知规划方法及系统,其技术方案为:获取机械臂的初始位姿、点云数据和目标部件位姿;根据目标部件周围区域的点云数据产生octomap地图,获得空间环境信息;设定机械臂的目标位姿,对机械臂姿态进行逆运动学计算;根据逆运动学计算结果构建两个扩展树,两个扩展树在设定阈值下相遇时完成避障运动规划。本发明能够根据深度相机提供的点云数据对周围环境进行实时感知,并准确规划出能够绕过周围障碍物的无碰路径,使机器人可以从初始位姿到达目标位姿,从而实现带电作业液压机械臂的自主运动规划。
0/0