CN110608744A - 一种具有动态避障功能的水质采样无人艇路径规划方法 - Google Patents
一种具有动态避障功能的水质采样无人艇路径规划方法 Download PDFInfo
- Publication number
- CN110608744A CN110608744A CN201911043014.0A CN201911043014A CN110608744A CN 110608744 A CN110608744 A CN 110608744A CN 201911043014 A CN201911043014 A CN 201911043014A CN 110608744 A CN110608744 A CN 110608744A
- Authority
- CN
- China
- Prior art keywords
- unmanned ship
- route
- artificial fish
- map
- path planning
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 title claims abstract description 61
- 238000005070 sampling Methods 0.000 title claims abstract description 37
- 238000000034 method Methods 0.000 title claims abstract description 35
- 241000251468 Actinopterygii Species 0.000 claims abstract description 77
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 15
- 230000004888 barrier function Effects 0.000 claims abstract description 10
- 238000012545 processing Methods 0.000 claims abstract description 5
- 230000006399 behavior Effects 0.000 claims description 48
- 230000000007 visual effect Effects 0.000 claims description 18
- 238000004364 calculation method Methods 0.000 claims description 12
- 238000007726 management method Methods 0.000 claims description 11
- 230000008569 process Effects 0.000 claims description 11
- 230000000694 effects Effects 0.000 claims description 9
- 230000009471 action Effects 0.000 claims description 5
- 230000001133 acceleration Effects 0.000 claims description 4
- 238000013459 approach Methods 0.000 claims description 3
- 238000010252 digital analysis Methods 0.000 claims description 3
- 230000019637 foraging behavior Effects 0.000 claims description 3
- 230000002431 foraging effect Effects 0.000 claims description 3
- 238000009434 installation Methods 0.000 claims description 3
- 230000006698 induction Effects 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 3
- 238000012544 monitoring process Methods 0.000 description 3
- 241000282414 Homo sapiens Species 0.000 description 2
- 230000033228 biological regulation Effects 0.000 description 2
- 238000004891 communication Methods 0.000 description 2
- 238000010276 construction Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000007613 environmental effect Effects 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 206010063385 Intellectualisation Diseases 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000004904 shortening Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/005—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 with correlation of navigation data from several sources, e.g. map or contour matching
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/203—Specially adapted for sailing ships
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明涉及一种具有动态避障功能的水质采样无人艇路径规划方法,包括以下步骤:步骤S1:无人艇启动并自检,开启接收航行所需各项传感器,获取实时地图数据,摘取地图的基本重要信息,并输入无人艇核心处理器中进行处理;步骤S2:开始路径规划前录入水质采样点坐标;步骤S3:利用人工鱼群算法对无人艇航行路线作全局或局部路径规划;步骤S4:由无人艇核心处理器规划生成路线后,参照导航系统和电子罗盘采集的信息,控制船体动力推进系统按照预定路线航行,如果遇到动态障碍物或其他紧急情况,再次返回步骤S3,通过局部路径规划对路线进行修正,重新规划路线。本发明优化生成路线、能够使无人艇对动态障碍物具备一定的躲避能力。
Description
技术领域
本发明涉及路径规划领域,特别是一种具有动态避障功能的水质采样无人艇路径规划方法。
背景技术
当今世界,不论是科学技术领域还是人文领域,人类都取得了非同凡响的进步与成绩。在陆上资源已经被相对充分地开发利用的大背景下,人类开始把目标转向了江河湖海等水体资源。我国领海面积达到了470多万平方公里,海域分布有岛屿7600多个。我国河流湖泊众多,这些河流、湖泊不仅是中国地理环境的重要组成部分,而且还蕴藏着丰富的自然资源。其中流域面积超过1000平方千米的河流就有1500多条,另外我国共有湖泊24800多个,其中面积在1平方公里以上的天然湖泊就有2800多个。
为保障人类社会能够维持可持续化发展,对于水体资源的测绘和监测成为不可或缺的重要工作。根据我国环保部与水力资源部现行规定,不同等级水库需按时定点采集水样作水质分析,以保障居民生活用水;针对我国内湖内河需定时进行水文信息采集,以便监测收集水体信息供绘制地图和水利资源管理。我们在相关水体自然资源的监测和开发过程中,一些问题也随之而来,例如在工作过程中开发过程本身对水资源的污染以及在目前人类对水体环境的复杂工况条件应对不足等问题。
为应对水体环境的复杂工况,减少开发过程本身对水体资源的污染,以及降低对大自然的破坏程度,工程人员迫切需要提升水上装备与设施的建设水平,这其中,最首要的装备就是水面无人艇及其相关技术设备。
为节约能源、保护环境,水质采样与检测等工作多采用水面无人艇进行。水面无人艇具有高度集成、高智能化、体积小巧、噪音小、无污染等优点,高度契合水中作业环境所需的必要条件。
但是也存在以下缺点:载人船只重量大,吃水深,船体尺寸大,在小型水域不够灵活,人力成本高,噪音大,严重影响自然生态文明建设。在路径规划领域中,应用在小型无人艇上的路径规划方法因数目较少,方法不成熟或不能适应水面这种特殊的作业环境,从而导致在进行水质监测和水质采样时往往耗时费力,效率低下,占用大量人工成本的同时且路线规划效果很差。现有的常用技术有A*算法、人工势场法、栅格法、快速拓展随机树法等。现有少量算法在无人船领域的应用不够完善,运算耗时过长,导致规划出的路线效果往往很差、计算效率不高,且大多没有动态避障的功能,这使得无人艇在实际工作运行当中面临一些安全问题。
发明内容
有鉴于此,本发明的目的是提供,一种具有动态避障功能的水质采样无人艇路径规划方法,优化生成路线、能够使无人艇对动态障碍物具备一定的躲避能力。
本发明采用以下方案实现:一种具有动态避障功能的水质采样无人艇路径规划方法,包括以下步骤:
步骤S1:无人艇启动并自检,开启接收航行所需各项传感器,获取实时地图数据,摘取地图的基本重要信息,并输入无人艇核心处理器中;
步骤S2:无人艇核心处理器接收实时地图信息,对地图中将要执行路径规划的区域进行二维坐标化处理,开始路径规划前录入水质采样点坐标;
步骤S3:根据无人艇具体任务或作业要求,结合所设置采样点坐标,利用人工鱼群算法对无人艇航行路线作全局或局部路径规划;
步骤S4:由无人艇核心处理器规划生成路线后,参照导航系统和电子罗盘采集的信息,控制船体动力推进系统按照预定路线航行,如果遇到动态障碍物或其他紧急情况,再次返回步骤S3,通过局部路径规划对路线进行修正,重新规划路线。
进一步地,步骤S1中所述的所需各项传感器包括船体上安置的超声波测距传感器、GPS-北斗定位模块传感器、电子罗盘传感器和加速度感应传感器;所述地图基本重要信息包括地图范围及实物与地图比例尺。
进一步地,所述步骤S1具体包括以下步骤:
步骤S11:无人艇接通总电源启动,并逐个扫描船体上安装的各项传感器进行自检:通过能量管理系统中的电压传感器查询剩余电量情况,通过能量管理系统中的电流传感器查询无人艇的实时工作电流,通过导航系统中的GPS-北斗定位模块传感器定位无人艇所在的具体方位,通过电子罗盘系统中的电子罗盘传感器获取船体艏向,通过超声波测距系统读取超声波测距传感器感知周边障碍物;
步骤S12:获取符合要求的实时地图,对地图障碍物与自由区域进行二维数字化解析,将电子地图的部分数据导入无人艇核心处理器;所述部分数据包括水域、障碍物二维地图电子信息数据以及经纬度坐标及比例尺信息。
进一步地,所述步骤S2具体包括以下步骤:
步骤S21:无人艇上的核心处理器接收到步骤S12处理后的二维电子地图信息,
步骤S22:根据水利部相关技术准则,结合现有水域,确定水质采样点的数量和水质采样点具体位置经纬度坐标;
步骤S23:结合水质采样点经纬度坐标,通过比例尺转化为与所述二维电子地图相匹配的坐标,使采样点信息输入到二维电子地图信息中;其中,在地图上令A为起始点,B为目标点。
进一步地,所述步骤S3具体包括以下步骤:
步骤S31:根据电子地图中A、B两点坐标,确定路线的起始点xstart与目标点xgoal,即地图中点A与点B;
步骤S32:确定起始点与目标点之后,引入人工鱼模式,利用人工鱼群算法对起始点与目标点之间的路径进行规划:初始化算法程序,设置起始点xstart即点A,目标点xgoal即点B;即模拟在A点处投放人工鱼群,让其追随食物浓度值去往B点;人工鱼的感知距离Visual,最大移动步长Step,拥挤度因子δ,鱼群初始状态X=(x1,x2,…,xn);其中,人工鱼个体之间的距离di,j,表示为:
dij=||xi-xj||
(1)
以该人工鱼距离目标点B点之间的距离作为当前人工鱼所处位置的食物浓度,即目标函数Y=f(x),即
Y=f(X)=||xi-xgoal|| (2)
步骤S33:对于鱼群X,进行迭代;依次对每条人工鱼xi分别进行聚群行为与追尾行为,再判断哪种行为的效果更优,取较优行为作为最终行为;
步骤S34:对第i条人工鱼xi执行觅食行为,在其视野范围内随机选择一个状态xij,计算其食物浓度Yij=f(xij),再比对Yij和原状态所在位置的食物浓度值Yi,若更优,则往该方向前进一步,即:
xi=xij|Yij≥Yi (3)
若Yij没有原状态所在位置的食物浓度值Yi更优,则进行下一步骤S35;
步骤S35:若同时不满足追尾行为、聚群行为和觅食行为的条件,则进行随机行为,即在其视野范围内随机挑选一个状态,然后向该方向移动一步;
步骤S36,判断人工鱼是否达到目标点,若已到达,则进行后续工作执行步骤S4;若未到达,则返回执行步骤S33进行新一轮的迭代。
进一步地,所述步骤S33具体包括以下内容:
对第i条人工鱼xi,在其视觉范围Visual内搜索同伴,即满足
di,j<Visual
(4)
条件的伙伴,搜索到的伙伴数目为nf;
对第i条人工鱼xi执行追尾行为操作,对比视野范围内所有伙伴的食物浓度值,得到拥有最高食物浓度YK的那条鱼xK,若满足条件:
则说明伙伴xK处具有高的食物浓度值且不拥挤,然后令第i条人工鱼向该方向前进一个步长的距离得到状态xik和食物浓度Yik=f(xik)并保留计算结果;
对第i条人工鱼xi,执行聚群行为操作,取搜索到的伙伴状态平均值即其中心位置xc,若满足条件:
则说明xc处具有高的食物浓度值且不拥挤,然后令第i条人工鱼向伙伴中心方向前进一个步长的距离得到状态xic和食物浓度Yic=f(xic)计算Yic=f(xic),并保留计算结果;
对第i条人工鱼xi分别执行追尾行为与聚群行为操作后,分别得到食物浓度值Yik和Yic,将两者值进行比较,取其中较优者作为第i条人工鱼的下一步行为,即
若对第i条人工鱼xi分别执行追尾行为、聚群行为操作后,同时不满足拥挤条件,即公式(5)和公式(6),则进行步骤S34。
进一步地,所述步骤S4具体包括以下步骤:
步骤S41:由无人艇上处理器规划生成路线后,执行路线信息,同时打开超声波测距传感器,用以随时对船体周围的障碍物进行测距;若检测到原有规划路线上存在障碍物,或有动态障碍物靠近,则终止目前的航行,重新返回步骤S3进行路线规划;
步骤S42,由无人艇上处理器规划重新生成路线后,参照GPS-北斗定位模块传感器和电子罗盘传感器采集的信息,控制船体动力推进系统按照预定路线航行至采集点进行水质采集与返航任务。
与现有技术相比,本发明具有以下有益效果:
本发明利用人工鱼群算法中鱼群的多重行为操作,通过不同行为操作造成效果之间的对比,在每一次迭代中都选择最优的行为,对无人艇水质采样进行路径规划,大大降低了路径规划的计算时间,提升了运算与工作效率,减小了能量消耗,优化生成路线、能够使无人艇对动态障碍物具备一定的躲避能力。
附图说明
图1为本发明实施例的流程图。
图2位本发明实施例的硬件系统组成图。
图3为本发明实施例的人工鱼群算法流程图。
图4为本发明实施例的步骤S1处理后所得地图信息图像。
图5为本发明实施例在地图中障碍物未发生移动时进行路径规划的效果图。
图6为本发明实施例在地图中障碍物移动并阻挡原有生成路线后进行避障后路径规划的效果图。
具体实施方式
下面结合附图及实施例对本发明做进一步说明。
如图1、2所示,本实施例提供一种具有动态避障功能的水质采样无人艇路径规划方法,所述无人艇包括艇载核心处理器即无人艇核心处理器及与其连接的能量管理系统、超声波测距系统、导航系统、电子罗盘系统、通信系统和动力推进系统;所述能量管理系统为所述无人艇核心处理器及与其连接的超声波测距系统、导航系统、电子罗盘系统、通信系统和动力推进系统提供电能;所述超声波测距系统采用超声波测距传感器进行障碍物距离感知;所述导航系统采用GPS-北斗定位传感器感知无人艇位置;所述电子罗盘系统采用电子罗盘传感器获取无人艇艏向;所述动力推进系统包括加速度感应传感器、电机驱动器、直流电机模块;所述能量管理系统包括电压传感器和电流传感器;通过能量管理系统中的电压传感器查询剩余电量情况,通过能量管理系统中的电流传感器查询无人艇的实时工作电流,通过导航系统中的GPS-北斗定位模块传感器定位无人艇所在的具体方位,通过电子罗盘系统中的电子罗盘传感器获取船体艏向,通过超声波测距系统读取超声波测距传感器感知周边障碍物;同时所述无人艇核心处理器通过数据采集模块采集所述电压传感器查询剩余电量情况数据、电流传感器查询无人艇的实时工作电流数据、GPS-北斗定位模块传感器定位无人艇所在的具体方位数据、电子罗盘传感器获取船体艏向数据和超声波测距传感器感知周边障碍物数据。
包括以下步骤:
步骤S1:无人艇启动并自检,开启接收航行所需各项传感器,获取实时地图数据,摘取地图的基本重要信息,并输入无人艇核心处理器中;
步骤S2:无人艇核心处理器接收实时地图信息,对地图中将要执行路径规划的区域进行二维坐标化处理,开始路径规划前录入水质采样点坐标;所述采样点系按照相关环境水利规定或要求设置;
步骤S3:根据无人艇具体任务或作业要求,结合所设置采样点坐标,利用人工鱼群算法对无人艇航行路线作全局或局部路径规划;
步骤S4:由无人艇核心处理器规划生成路线后,参照导航系统和电子罗盘采集的信息,控制船体动力推进系统按照预定路线航行,如果遇到动态障碍物或其他紧急情况,再次返回步骤S3,通过局部路径规划对路线进行修正,重新规划路线。
在本实施例中,步骤S1中所述的所需各项传感器包括船体上安置的超声波测距传感器、GPS-北斗定位模块传感器、电子罗盘传感器和加速度感应传感器;所述地图基本重要信息包括地图范围及实物与地图比例尺。
在本实施例中,所述步骤S1具体包括以下步骤:
步骤S11:无人艇接通总电源启动,并逐个扫描船体上安装的各项传感器进行自检:通过能量管理系统中的电压传感器查询剩余电量情况,通过能量管理系统中的电流传感器查询无人艇的实时工作电流,通过导航系统中的GPS-北斗定位模块传感器定位无人艇所在的具体方位,通过电子罗盘系统中的电子罗盘传感器获取船体艏向,通过超声波测距系统读取超声波测距传感器感知周边障碍物;
步骤S12:由共用网络资源获取符合要求的实时地图,对地图障碍物与自由区域进行二维数字化解析,将电子地图的部分数据导入无人艇核心处理器;地图如图4所示,其中,点A为起点,点B为目标点,C为移动障碍物,会在附近作横向小幅移动。所述部分数据包括水域、障碍物二维地图电子信息数据以及经纬度坐标及比例尺信息。
在本实施例中,所述步骤S2具体包括以下步骤:
步骤S21:无人艇上的核心处理器接收到步骤S12处理后的二维电子地图信息,
步骤S22:根据中华人民共和国环境保护法与水利部相关技术准则,结合现有水域,确定水质采样点的数量和水质采样点具体位置经纬度坐标;
步骤S23:结合水质采样点经纬度坐标,通过比例尺转化为与所述二维电子地图相匹配的坐标,使采样点信息输入到二维电子地图信息中;其中,在地图上令A为起始点,B为目标点。
如图3所示,在本实施例中,所述步骤S3具体包括以下步骤:
步骤S31:根据电子地图中A、B两点坐标,确定路线的起始点xstart与目标点xgoal,即地图中点A与点B;
步骤S32:确定起始点与目标点之后,引入人工鱼模式,人工鱼群算法流程如图3所示,利用人工鱼群算法对起始点与目标点之间的路径进行规划:初始化算法程序,设置起始点xstart即点A,目标点xgoal即点B;即模拟在A点处投放人工鱼群,让其追随食物浓度值去往B点;人工鱼的感知距离Visual,最大移动步长Step,拥挤度因子δ,鱼群初始状态X=(x1,x2,…,xn);其中,人工鱼个体之间的距离di,j,表示为:
di,j=||xi-xj||
(1)
以该人工鱼距离目标点B点之间的距离作为当前人工鱼所处位置的食物浓度,即目标函数Y=f(x),即
Y=f(X)=||xi-xgoal|| (2)
步骤S33:对于鱼群X,进行迭代;依次对每条人工鱼xi分别进行聚群行为与追尾行为,再判断哪种行为的效果更优,取较优行为作为最终行为;
步骤S34:对第i条人工鱼xi执行觅食行为,在其视野范围内随机选择一个状态xij,计算其食物浓度Yij=f(xij),再比对Yij和原状态所在位置的食物浓度值Yi,若更优,则往该方向前进一步,即:
xi=xij|Yij≥Yi (3)
若Yij没有原状态所在位置的食物浓度值Yi更优,则进行下一步骤S35;
步骤S35:若同时不满足追尾行为、聚群行为和觅食行为的条件,则进行缺省行为:随机行为,即在其视野范围内随机挑选一个状态,然后向该方向移动一步;
步骤S36,判断人工鱼是否达到目标点,若已到达,则进行后续工作执行步骤S4;若未到达,则返回执行步骤S33进行新一轮的迭代。
在本实施例中,所述步骤S33具体包括以下内容:
对第i条人工鱼xi,在其视觉范围Visual内搜索同伴,即满足
di,j<Visual
(4)
条件的伙伴,搜索到的伙伴数目为nf;
对第i条人工鱼xi执行追尾行为操作,对比视野范围内所有伙伴的食物浓度值,得到拥有最高食物浓度YK的那条鱼xK,若满足条件:
则说明伙伴xK处具有高的食物浓度值且不拥挤,然后令第i条人工鱼向该方向前进一个步长的距离得到状态xik和食物浓度Yik=f(xik)并保留计算结果;
对第i条人工鱼xi,执行聚群行为操作,取搜索到的伙伴状态平均值即其中心位置xc,若满足条件:
则说明xc处具有高的食物浓度值且不拥挤,然后令第i条人工鱼向伙伴中心方向前进一个步长的距离得到状态xic和食物浓度Yic=f(xic)计算Yic=f(xic),并保留计算结果;
对第i条人工鱼xi分别执行追尾行为与聚群行为操作后,分别得到食物浓度值Yik和Yic,将两者值进行比较,取其中较优者作为第i条人工鱼的下一步行为,即
若对第i条人工鱼xi分别执行追尾行为、聚群行为操作后,同时不满足拥挤条件,即公式(5)和公式(6),则进行步骤S34。
在本实施例中,所述步骤S4具体包括以下步骤:
步骤S41:由无人艇上处理器规划生成路线后,执行路线信息,同时打开超声波测距传感器,用以随时对船体周围的障碍物进行测距;若检测到原有规划路线上存在障碍物,或有动态障碍物靠近,则终止目前的航行,重新返回步骤S3进行路线规划;
步骤S42,由无人艇上处理器规划重新生成路线后,参照GPS-北斗定位模块传感器和电子罗盘模块传感器采集的信息,控制船体动力推进系统按照预定路线航行至采集点进行水质采集与返航任务。
仿真结果最终如图5图6所示,在移动障碍物C移动的过程中,根据本实施例所提供的技术方案,所规划得出的行驶路线图。
较佳的,本实施例利用人工鱼群算法中鱼群的多重行为操作,通过不同行为操作造成效果之间的对比,在每一次迭代中都选择最优的行为。通过仿真实验可以发现,对无人艇水质采样进行路径规划,具有较少的计算时间,相对提升了运算与工作效率,并且能够避开所设置的动态障碍物重新进行路线规划。
较佳的,本实施例,针对水面这一特殊作业环境,以水面无人艇作为控制对象,以无人艇航行路线作为优化目标,制定具有动态避障功能的路径规划方法。针对无人艇上目前应用的路径规划方法,本实施例采用人工鱼群优化算法,针对实际工作任务与可能出现的动态障碍物做出相关改进,以达到缩短计算时间、优化生成路线、能够使无人艇对动态障碍物具备一定的躲避能力等目的。
以上所述仅为本发明的较佳实施例,凡依本发明申请专利范围所做的均等变化与修饰,皆应属本发明的涵盖范围。
Claims (7)
1.一种具有动态避障功能的水质采样无人艇路径规划方法,其特征在于:包括以下步骤:
步骤S1:无人艇启动并自检,开启接收航行所需各项传感器,获取实时地图数据,摘取地图的基本重要信息,并输入无人艇核心处理器中;
步骤S2:无人艇核心处理器接收实时地图信息,对地图中将要执行路径规划的区域进行二维坐标化处理,开始路径规划前录入水质采样点坐标;
步骤S3:根据无人艇具体任务或作业要求,结合所设置采样点坐标,利用人工鱼群算法对无人艇航行路线作全局或局部路径规划;
步骤S4:由无人艇核心处理器规划生成路线后,参照导航系统和电子罗盘采集的信息,控制船体动力推进系统按照预定路线航行,如果遇到动态障碍物或其他紧急情况,再次返回步骤S3,通过局部路径规划对路线进行修正,重新规划路线。
2.根据权利要求1所述的一种具有动态避障功能的水质采样无人艇路径规划方法,其特征在于:步骤S1中所述的所需各项传感器包括船体上安置的超声波测距传感器、GPS-北斗定位模块传感器、电子罗盘传感器和加速度感应传感器;所述地图基本重要信息包括地图范围及实物与地图比例尺。
3.根据权利要求2所述的一种具有动态避障功能的水质采样无人艇路径规划方法,其特征在于:所述步骤S1具体包括以下步骤:
步骤S11:无人艇接通总电源启动,并逐个扫描船体上安装的各项传感器进行自检:通过能量管理系统中的电压传感器查询剩余电量情况,通过能量管理系统中的电流传感器查询无人艇的实时工作电流,通过导航系统中的GPS-北斗定位模块传感器定位无人艇所在的具体方位,通过电子罗盘系统中的电子罗盘传感器获取船体艏向,通过超声波测距系统读取超声波测距传感器感知周边障碍物;
步骤S12:获取符合要求的实时地图,对地图障碍物与自由区域进行二维数字化解析,将电子地图的部分数据导入无人艇核心处理器;所述部分数据包括水域、障碍物二维地图电子信息数据以及经纬度坐标及比例尺信息。
4.根据权利要求3所述的一种具有动态避障功能的水质采样无人艇路径规划方法,其特征在于:所述步骤S2具体包括以下步骤:
步骤S21:无人艇上的核心处理器接收到步骤S12处理后的二维电子地图信息,
步骤S22:根据水利部相关技术准则,结合现有水域,确定水质采样点的数量和水质采样点具体位置经纬度坐标;
步骤S23:结合水质采样点经纬度坐标,通过比例尺转化为与所述二维电子地图相匹配的坐标,使采样点信息输入到二维电子地图信息中;其中,在地图上令A为起始点,B为目标点。
5.根据权利要求1所述的一种具有动态避障功能的水质采样无人艇路径规划方法,其特征在于:所述步骤S3具体包括以下步骤:
步骤S31:根据电子地图中A、B两点坐标,确定路线的起始点xstart与目标点xgoal,即地图中点A与点B;
步骤S32:确定起始点与目标点之后,引入人工鱼模式,利用人工鱼群算法对起始点与目标点之间的路径进行规划:初始化算法程序,设置起始点xstart即点A,目标点xgoal即点B;即模拟在A点处投放人工鱼群,让其追随食物浓度值去往B点;人工鱼的感知距离Visual,最大移动步长Step,拥挤度因子δ,鱼群初始状态X=(x1,x2,...,xn);其中,人工鱼个体之间的距离di,j,表示为:
di,j=||xi-xj||
(1)
以该人工鱼距离目标点B点之间的距离作为当前人工鱼所处位置的食物浓度,即目标函数Y=f(x),即
Y=f(X)=||xi-xgoal|| (2)
步骤S33:对于鱼群X,进行迭代;依次对每条人工鱼xi分别进行聚群行为与追尾行为,再判断哪种行为的效果更优,取较优行为作为最终行为;
步骤S34:对第i条人工鱼xi执行觅食行为,在其视野范围内随机选择一个状态xij,计算其食物浓度Yij=f(xij),再比对Yij和原状态所在位置的食物浓度值Yi,若更优,则往该方向前进一步,即:
xi=xij|Yij≥Yi (3)
若Yij没有原状态所在位置的食物浓度值Yi更优,则进行下一步骤S35;
步骤S35:若同时不满足追尾行为、聚群行为和觅食行为的条件,则进行随机行为,即在其视野范围内随机挑选一个状态,然后向该方向移动一步;
步骤S36,判断人工鱼是否达到目标点,若已到达,则进行后续工作执行步骤S4;若未到达,则返回执行步骤S33进行新一轮的迭代。
6.根据权利要求5所述的一种具有动态避障功能的水质采样无人艇路径规划方法,其特征在于:所述步骤S33具体包括以下内容:
对第i条人工鱼xi,在其视觉范围Visual内搜索同伴,即满足
di,j<Visual
(4)
条件的伙伴,搜索到的伙伴数目为nf;
对第i条人工鱼xi执行追尾行为操作,对比视野范围内所有伙伴的食物浓度值,得到拥有最高食物浓度YK的那条鱼xK,若满足条件:
则说明伙伴xK处具有高的食物浓度值且不拥挤,然后令第i条人工鱼向该方向前进一个步长的距离得到状态xik和食物浓度Yik=f(xik)并保留计算结果;
对第i条人工鱼xi,执行聚群行为操作,取搜索到的伙伴状态平均值即其中心位置xc,若满足条件:
则说明xc处具有高的食物浓度值且不拥挤,然后令第i条人工鱼向伙伴中心方向前进一个步长的距离得到状态xic和食物浓度Yic=f(xic)计算Yic=f(xic),并保留计算结果;
对第i条人工鱼xi分别执行追尾行为与聚群行为操作后,分别得到食物浓度值Yik和Yic,将两者值进行比较,取其中较优者作为第i条人工鱼的下一步行为,即
若对第i条人工鱼xi分别执行追尾行为、聚群行为操作后,同时不满足拥挤条件,即公式(5)和公式(6),则进行步骤S34。
7.根据权利要求1所述的一种具有动态避障功能的水质采样无人艇路径规划方法,其特征在于:所述步骤S4具体包括以下步骤:
步骤S41:由无人艇上处理器规划生成路线后,执行路线信息,同时打开超声波测距传感器,用以随时对船体周围的障碍物进行测距;若检测到原有规划路线上存在障碍物,或有动态障碍物靠近,则终止目前的航行,重新返回步骤S3进行路线规划;
步骤S42,由无人艇上处理器规划重新生成路线后,参照GPS-北斗定位模块传感器和电子罗盘传感器的信息,控制船体动力推进系统按照预定路线航行至采集点进行水质采集与返航任务。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911043014.0A CN110608744A (zh) | 2019-10-30 | 2019-10-30 | 一种具有动态避障功能的水质采样无人艇路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911043014.0A CN110608744A (zh) | 2019-10-30 | 2019-10-30 | 一种具有动态避障功能的水质采样无人艇路径规划方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110608744A true CN110608744A (zh) | 2019-12-24 |
Family
ID=68895798
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911043014.0A Pending CN110608744A (zh) | 2019-10-30 | 2019-10-30 | 一种具有动态避障功能的水质采样无人艇路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110608744A (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111964678A (zh) * | 2020-07-16 | 2020-11-20 | 武汉长江船舶设计院有限公司 | 一种江河航道航行决策方法、装置及系统 |
CN114088094A (zh) * | 2021-09-27 | 2022-02-25 | 华中光电技术研究所(中国船舶重工集团公司第七一七研究所) | 一种无人艇的智能航路规划方法及系统 |
IT202000028616A1 (it) * | 2020-11-26 | 2022-05-26 | Accurami S R L | Sistema di assistenza alle manovre di attracco dei natanti in porto |
CN115291607A (zh) * | 2022-08-02 | 2022-11-04 | 柳州城市职业学院 | 复杂未知水域内无人驾驶船路径自主规划生成方法及系统 |
CN115326100A (zh) * | 2022-10-17 | 2022-11-11 | 北京智行者科技股份有限公司 | 路径规划方法、装置、自动驾驶设备及计算机存储介质 |
CN115586777A (zh) * | 2022-11-04 | 2023-01-10 | 广西壮族自治区水利电力勘测设计研究院有限责任公司 | 一种水深测量无人船遥测控制方法 |
CN116337089A (zh) * | 2023-05-31 | 2023-06-27 | 中国科学院空天信息创新研究院 | 路径规划方法、装置及移动式植被指数测量装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103576680A (zh) * | 2012-07-25 | 2014-02-12 | 中国原子能科学研究院 | 一种机器人路径规划方法及装置 |
CN105717923A (zh) * | 2016-01-16 | 2016-06-29 | 上海大学 | 基于椭圆聚类-碰撞锥推演的无人艇海洋动态避障控制算法 |
CN108664020A (zh) * | 2018-04-11 | 2018-10-16 | 上海大学 | 一种基于速度障碍法和动态窗口法的无人艇动态避障算法 |
CN109348518A (zh) * | 2018-11-12 | 2019-02-15 | 厦门大学 | 水声协作通信网络中运用人工鱼群算法寻找路由的方法 |
CN109737970A (zh) * | 2019-03-21 | 2019-05-10 | 集美大学 | 一种基于改进rrt算法的水面无人艇路径规划方法 |
-
2019
- 2019-10-30 CN CN201911043014.0A patent/CN110608744A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103576680A (zh) * | 2012-07-25 | 2014-02-12 | 中国原子能科学研究院 | 一种机器人路径规划方法及装置 |
CN105717923A (zh) * | 2016-01-16 | 2016-06-29 | 上海大学 | 基于椭圆聚类-碰撞锥推演的无人艇海洋动态避障控制算法 |
CN108664020A (zh) * | 2018-04-11 | 2018-10-16 | 上海大学 | 一种基于速度障碍法和动态窗口法的无人艇动态避障算法 |
CN109348518A (zh) * | 2018-11-12 | 2019-02-15 | 厦门大学 | 水声协作通信网络中运用人工鱼群算法寻找路由的方法 |
CN109737970A (zh) * | 2019-03-21 | 2019-05-10 | 集美大学 | 一种基于改进rrt算法的水面无人艇路径规划方法 |
Non-Patent Citations (3)
Title |
---|
徐晓晴: "动态环境下基于群智能算法的机器人路径规划", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
袁梦茹: "基于群智能算法的移动机器人路径规划技术研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
赵嘉祺: "基于改进遗传算法的水面无人艇避障问题研究", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 * |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111964678A (zh) * | 2020-07-16 | 2020-11-20 | 武汉长江船舶设计院有限公司 | 一种江河航道航行决策方法、装置及系统 |
IT202000028616A1 (it) * | 2020-11-26 | 2022-05-26 | Accurami S R L | Sistema di assistenza alle manovre di attracco dei natanti in porto |
CN114088094A (zh) * | 2021-09-27 | 2022-02-25 | 华中光电技术研究所(中国船舶重工集团公司第七一七研究所) | 一种无人艇的智能航路规划方法及系统 |
CN115291607A (zh) * | 2022-08-02 | 2022-11-04 | 柳州城市职业学院 | 复杂未知水域内无人驾驶船路径自主规划生成方法及系统 |
CN115291607B (zh) * | 2022-08-02 | 2023-03-14 | 柳州城市职业学院 | 复杂未知水域内无人驾驶船路径自主规划生成方法及系统 |
CN115326100A (zh) * | 2022-10-17 | 2022-11-11 | 北京智行者科技股份有限公司 | 路径规划方法、装置、自动驾驶设备及计算机存储介质 |
CN115326100B (zh) * | 2022-10-17 | 2023-03-03 | 北京智行者科技股份有限公司 | 路径规划方法、装置、自动驾驶设备及计算机存储介质 |
CN115586777A (zh) * | 2022-11-04 | 2023-01-10 | 广西壮族自治区水利电力勘测设计研究院有限责任公司 | 一种水深测量无人船遥测控制方法 |
CN116337089A (zh) * | 2023-05-31 | 2023-06-27 | 中国科学院空天信息创新研究院 | 路径规划方法、装置及移动式植被指数测量装置 |
CN116337089B (zh) * | 2023-05-31 | 2023-08-11 | 中国科学院空天信息创新研究院 | 路径规划方法、装置及移动式植被指数测量装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110608744A (zh) | 一种具有动态避障功能的水质采样无人艇路径规划方法 | |
CN108564202B (zh) | 一种基于环境预报信息的无人艇航线优化方法 | |
CN108981716B (zh) | 一种适用于内陆和近海无人船的路径规划方法 | |
CN103033817B (zh) | 大型auv避碰用障碍物自主识别系统 | |
CN109856638B (zh) | 一种特定水下目标自动搜索定位的方法 | |
Wu et al. | Long-voyage route planning method based on multi-scale visibility graph for autonomous ships | |
Huang et al. | Efficient seafloor classification and submarine cable route design using an autonomous underwater vehicle | |
CN105242022A (zh) | 北斗导航智能水质监测双体船 | |
CN108681321A (zh) | 一种无人船协同编队的水下探测方法 | |
Jacobi et al. | Multi sensor underwater pipeline tracking with AUVs | |
CN114089762B (zh) | 一种基于强化学习的水空两栖无人航行器路径规划方法 | |
CN111159924A (zh) | 用于预测漂移轨迹的方法和装置 | |
CN101907711A (zh) | 一种自主水下机器人的同时检测与定位方法 | |
CN112880678A (zh) | 一种复杂水域环境中无人艇航行规划方法 | |
CN117232520A (zh) | 一种适用于海上航行的船舶智能导航系统及导航方法 | |
CN112987067A (zh) | 组合导航的洋流速度估计方法、装置和一种处理器 | |
US20220214689A1 (en) | Autonomous Vessel and Infrastructure for Supporting an Autonomous Vessel on Inland Waterways | |
CN111081071A (zh) | 一种船舶路径数据分析系统及方法 | |
Deng et al. | Underwater map-matching aided inertial navigation system based on multi-geophysical information | |
CN114548553A (zh) | 基于海浪图像遥感和人工智能海洋浮体运动预报系统 | |
CN114610046A (zh) | 一种考虑动态水深的无人艇动态安全轨迹规划方法 | |
Treacy | Aerial surveys of endangered whales in the Beaufort Sea, fall 1992 | |
Zhang et al. | A path planning method for the autonomous ship in restricted bridge area based on anisotropic fast marching algorithm | |
Park et al. | Preliminary Investigation for Feasibility of Wave Energy Converters and the Surrounding Sea as Test-site for Marine Equipment | |
Leedekerken et al. | Mapping complex marine environments with autonomous surface craft |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20191224 |