文档下载 文档下载导航
设为首页 | 加入收藏
搜索 请输入内容:  
 导航当前位置: 文档下载 > 所有分类 > 高等教育 > 工学 > 基于多波束前视声纳的AUV实时避障方法研究
侵权投诉

基于多波束前视声纳的AUV实时避障方法研究

在未知海洋环境下的远程航海过程中,基于前视声纳的避障能力是AUV(自治式水下机器人)的一个基本要求.提出了一种基于多波束前视声纳的实时避障专家系统.介绍了声纳特性以及障碍物描述方法,给出了避障专家系统的结构,说明了避障专家系统的决策过程.结合当前任务执行信息设计了专家系统知识库,针对声纳图像设计并实现了一种可以给出避障和重规划指令的推理机.最后,通过湖试对AUV避障专家系统进行了验证.

资料整理自互联网,版权归原作者! 欢迎访问 doc.guandang.net 新势力单片机、嵌入式  

84     机 器 人2007年1月

基于多波束前视声纳的AUV实时避障方法研究

   

  避障专家系统的结构如图5所示.图中前视声

纳数据经过了滤波,网络数据指动态控制机传送的传感器信息,任务执行信息是AUV在遇到障碍物前所执行的任务,综合数据库存放全局路径规划、重规划结果和推理过程的中间信息,路径重规划模块由推理机触发,推理机根据知识库的专家知识结合传感器信息、综合数据库信息、任务状态信息等进行推理、决策得出控制指令,通过网络发送给动态控制机

基于多波束前视声纳的AUV实时避障方法研究

.

段任务是航渡任务,则以当前点为起点、下一目标点为终点重规划路径.如果下一段任务是精确航迹任务,则将当前点在航迹线上的投影作为起点,每隔50m设定一个航程点,将航迹n等分,航程点编号为Wpi,其中i=1,2,3,…,n,以当前点为起点、Wp1为终点重新规划一条新的路径.

,35m时减,航向.

,则与障碍物距离小于35m时,减速至018节,深度不变,搜索最优航向,用垂直舵调整航向;与障碍物距离小于15m时减速至0节,深度不变,搜索最优航向,用辅助推进器调整航向;大于35m时,维持原来的速度、深度和航向.

⑤如果障碍物全部占据声纳视区,则与障碍物距离小于35m时,减速至0节,深度不变,搜索最优航向,采用辅助推进器调整航向;大于35m时,维持原来的速度、深度和航向.

⑥如果声纳视区有障碍物,主航线不在声纳视区内,则在声纳视区方向沿障碍物表面运动.如果AUV持续很长时间(20min)仍然远离目标点,则认为该路径不能到达目标点,重新规划至上一个目标点,上浮至水面,打开应急灯等待回收.3.3 推理机设计

推理机的结构包括一个解释程序和一个调度程序.调度程序用来决定知识库中知识的使用次序.解释程序用来决定如何使用知识库中的知识.推理机的运行采用正向推理.每一条规则赋予一个权重,当许多规则同时存在时,首先执行权重最大的规则.这6条规则的权重大小为:②>⑥>⑤>④>③>①.为了说明解释程序的功能,以搜索最优航向以及路径重规划为例进行阐述.

搜索最优航向是指在前视声纳探测到障碍物时,根据传感器信息以及安全半径,计算出AUV躲避障碍物的优化航向,分为两种情况,一种是障碍物部分占据声纳视区,另一种是障碍物全部占据声纳视区.首先建立如图6所示的直角坐标系,由3条直线组成了安全区域,中间的一条为AUV避障航线,安全半径为d,安全区域与障碍物边缘切点坐标为(x,y),避障航线与Y轴夹角为α,根据前视声纳数据的投影可知,当前时刻右侧的障碍物多于左侧的障碍物,所以AUV应该向左搜索最优航向,当前传感器反馈的AUV航向为β,则当前搜索到的最优航向角φ为:

图5 避障专家系统结构图

Fig.5 Structureoftheobstacleavoidanceexpertsystem

3.2 知识库设计

(1)知识的获取

地形勘查使命包括航渡任务和精确航迹任务等.航渡任务只要求到达指定的航程点,以节省能源为标准,采用航向控制达到航程点.精确航迹任务要求AUV在航迹线上航行,需要进行航迹控制.知识库是根据从专家获得的专业知识,结合AUV在完成地形勘查使命中需要执行的航渡任务、精确航迹任务等,综合得出的避碰策略知识.

(2)知识的表达

本文设计的专家系统是一个基于规则的产生式系统,由如下规则组成:

①如果声纳视区内没有障碍物,则沿主航线直线航行.如果上一节拍声纳数据含有障碍物信息,并且当前执行的任务是航渡任务,则以当前点为起点、航渡目标点为终点重新规划一条新的路径.如果是精确航迹任务,则将当前点在航迹线上的投影作为起点,每隔50m设定一个航程点,将航迹n等分,航程点编号为Wpi,其中i=1,2,3,…,n,以当前点为起点、Wp1为终点重新规划一条新的路径.

②如果AUV在以航程点为圆心、半径40m的范围内发现障碍物,则AUV放弃当前目标点.如果下一

上一页第3页

你可能喜欢

热门文档

相关文档

站点地图 | 文档上传 | 侵权投诉 | 手机版
本站所有资源均来自互联网,本站只负责收集和整理,均不承担任何法律责任,如有侵权等其它行为请联系我们.
文档下载 Copyright 2013 doc.guandang.net All Rights Reserved.  -  email