-
公开(公告)号:CN105929824B
公开(公告)日:2018-10-26
申请号:CN201610312431.0
申请日:2016-05-12
Applicant: 哈尔滨工程大学
IPC: G05D1/02
Abstract: 本发明提供的是一种基于几何绕行原理的UUV二维航路规划方法。一:从使命文本读取航路起点Ob、航路终点Oe和各障碍物的参数;二:对障碍物进行膨胀处理,计算膨胀后的各障碍物的参数;三:建立绕行点集合S;四:如果规划当前点Oc是航路终点Oe,或者规划当前点Oc和航路终点Oe可视,转步骤六,否则执行步骤五;五:搜索距规划当前点Oc最近的障碍物,根据障碍物的形状对障碍物进行绕行,得到绕行点并放入绕行点集合S中,更新规划当前点Oc,转步骤四;六:将航路终点Oe放入绕行点集合S中;七:对绕行点集合S进行消减,规划结束。本发明通过简单的几何原理实现对障碍物的绕行,可以使UUV在复杂障碍环境中快速、高效的获得一条安全无碰的二维航路。
-
公开(公告)号:CN106020213B
公开(公告)日:2018-12-11
申请号:CN201610312413.2
申请日:2016-05-12
Applicant: 哈尔滨工程大学
IPC: G05D1/06
Abstract: 本发明提供的是一种UUV对矩形障碍物几何绕行的二维航路规划方法。一:从使命文本读取航路起点Ob、航路终点Oe和各矩形障碍物的参数;二:对矩形障碍物进行膨胀处理,计算膨胀后的各矩形障碍物的参数;三:建立绕行点集合S,令规划当前点Oc为起点Ob,并放入绕行点集合S中;四:如果规划当前点Oc是航路终点Oe,或者规划当前点Oc和航路终点Oe可视,转步骤六,否则执行步骤五;五:对距规划当前点Oc最近的矩形障碍物进行几何绕行,得到绕行点并放入绕行点集合S中,更新规划当前点Oc,转步骤四;六:将航路终点Oe放入绕行点集合S中,规划结束。本发明通过简单的几何原理实现对矩形障碍物的绕行,可以使UUV在复杂多矩形障碍环境中快速、高效的获得一条安全无碰的二维航路。
-
公开(公告)号:CN105929824A
公开(公告)日:2016-09-07
申请号:CN201610312431.0
申请日:2016-05-12
Applicant: 哈尔滨工程大学
IPC: G05D1/02
CPC classification number: G05D1/0206
Abstract: 本发明提供的是一种基于几何绕行原理的UUV二维航路规划方法。一:从使命文本读取航路起点Ob、航路终点Oe和各障碍物的参数;二:对障碍物进行膨胀处理,计算膨胀后的各障碍物的参数;三:建立绕行点集合S;四:如果规划当前点Oc是航路终点Oe,或者规划当前点Oc和航路终点Oe可视,转步骤六,否则执行步骤五;五:搜索距规划当前点Oc最近的障碍物,根据障碍物的形状对障碍物进行绕行,得到绕行点并放入绕行点集合S中,更新规划当前点Oc,转步骤四;六:将航路终点Oe放入绕行点集合S中;七:对绕行点集合S进行消减,规划结束。本发明通过简单的几何原理实现对障碍物的绕行,可以使UUV在复杂障碍环境中快速、高效的获得一条安全无碰的二维航路。
-
公开(公告)号:CN106020213A
公开(公告)日:2016-10-12
申请号:CN201610312413.2
申请日:2016-05-12
Applicant: 哈尔滨工程大学
IPC: G05D1/06
CPC classification number: G05D1/0692
Abstract: 本发明提供的是一种UUV对矩形障碍物几何绕行的二维航路规划方法。一:从使命文本读取航路起点Ob、航路终点Oe和各矩形障碍物的参数;二:对矩形障碍物进行膨胀处理,计算膨胀后的各矩形障碍物的参数;三:建立绕行点集合S,令规划当前点Oc为起点Ob,并放入绕行点集合S中;四:如果规划当前点Oc是航路终点Oe,或者规划当前点Oc和航路终点Oe可视,转步骤六,否则执行步骤五;五:对距规划当前点Oc最近的矩形障碍物进行几何绕行,得到绕行点并放入绕行点集合S中,更新规划当前点Oc,转步骤四;六:将航路终点Oe放入绕行点集合S中,规划结束。本发明通过简单的几何原理实现对矩形障碍物的绕行,可以使UUV在复杂多矩形障碍环境中快速、高效的获得一条安全无碰的二维航路。
-
-
-