- 专利标题: 一种UUV对圆形障碍物几何绕行的二维航路规划方法
-
申请号: CN201610312415.1申请日: 2016-05-12
-
公开(公告)号: CN105843234B公开(公告)日: 2018-08-31
- 发明人: 陈涛 , 徐达 , 张伟 , 张宏瀚 , 张勋 , 周佳加
- 申请人: 哈尔滨工程大学
- 申请人地址: 黑龙江省哈尔滨市南岗区南通大街145号哈尔滨工程大学科技处知识产权办公室
- 专利权人: 哈尔滨工程大学
- 当前专利权人: 哈尔滨工程大学
- 当前专利权人地址: 黑龙江省哈尔滨市南岗区南通大街145号哈尔滨工程大学科技处知识产权办公室
- 主分类号: G05D1/06
- IPC分类号: G05D1/06
摘要:
本发明提供的是一种UUV对圆形障碍物几何绕行的二维航路规划方法。一:从使命文本读取航路起点Ob、航路终点Oe和各圆形障碍物的参数;二:对各圆形障碍物进行膨胀处理,计算膨胀后的各圆形障碍物的参数;三:建立绕行点集合S,令规划当前点Oc为起点Ob,并放入绕行点集合S中;四:如果规划当前点Oc是航路终点Oe,或者规划当前点Oc和航路终点Oe可视,转步骤六,否则执行步骤五;五:对距规划当前点Oc最近的圆形障碍物进行几何绕行,得到绕行点并放入绕行点集合S中,更新规划当前点Oc,转步骤四;六:将航路终点Oe放入绕行点集合S中,规划结束。本发明通过简单的几何原理实现对圆形障碍物的绕行,可以使UUV在复杂多圆形障碍环境中快速、高效的获得一条安全无碰的二维航路。
公开/授权文献
- CN105843234A 一种UUV对圆形障碍物几何绕行的二维航路规划方法 公开/授权日:2016-08-10