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