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