基于快速扩展随机树的机械臂避障路径规划方法及系统
基本信息
申请号 | CN202011183918.6 | 申请日 | - |
公开(公告)号 | CN112338916A | 公开(公告)日 | 2021-02-09 |
申请公布号 | CN112338916A | 申请公布日 | 2021-02-09 |
分类号 | B25J9/16(2006.01)I | 分类 | 手动工具;轻便机动工具;手动器械的手柄;车间设备;机械手; |
发明人 | 阳涵疆;伍祁林;宋君毅 | 申请(专利权)人 | 深圳市大象机器人科技有限公司 |
代理机构 | 西安恒泰知识产权代理事务所 | 代理人 | 王芳 |
地址 | 518055广东省深圳市南山区桃源街道留仙大道南山云谷创新产业园二期7栋2楼208 | ||
法律状态 | - |
摘要
摘要 | 本发明属于机械臂避障路径规划技术领域,公开了一种基于快速扩展随机树的机械臂避障路径规划方法及系统。轮流在两棵随机树上加入采样点,当某个随机点加入到其中一颗随机树上之后,下一次生成采样点就激活另外一棵树,把随机点加入到随机树上时要在树上新增节点,需要先在路径搜索的空间中随机生成一个随机节点,然后找到树上距离这个随机节点最近的节点,然后判断采样点与最近节点的连线是不是与障碍物发生碰撞,如果不发生碰撞就可以把这个采样点加到树上。本发明把寻找成本最低父节点的RRT*算法和双向RRT算法融合起来,使得机械臂在进行路径规划时获得保证成本最优且搜寻速度的路径。 |
