一种具有动态避障功能的水质采样无人艇路径规划方法技术

本发明专利技术涉及一种具有动态避障功能的水质采样无人艇路径规划方法，包括以下步骤：步骤S1：无人艇启动并自检，开启接收航行所需各项传感器，获取实时地图数据，摘取地图的基本重要信息，并输入无人艇核心处理器中进行处理；步骤S2：开始路径规划前录入水质采样点坐标；步骤S3：利用人工鱼群算法对无人艇航行路线作全局或局部路径规划；步骤S4：由无人艇核心处理器规划生成路线后，参照导航系统和电子罗盘采集的信息，控制船体动力推进系统按照预定路线航行，如果遇到动态障碍物或其他紧急情况，再次返回步骤S3，通过局部路径规划对路线进行修正，重新规划路线。本发明专利技术优化生成路线、能够使无人艇对动态障碍物具备一定的躲避能力。

A path planning method of water sampling unmanned boat with dynamic obstacle avoidance function

【技术实现步骤摘要】
一种具有动态避障功能的水质采样无人艇路径规划方法
本专利技术涉及路径规划领域，特别是一种具有动态避障功能的水质采样无人艇路径规划方法。
技术介绍
当今世界，不论是科学
还是人文领域，人类都取得了非同凡响的进步与成绩。在陆上资源已经被相对充分地开发利用的大背景下，人类开始把目标转向了江河湖海等水体资源。我国领海面积达到了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处具有高的食物浓度本文档来自技高网...

【技术保护点】
1.一种具有动态避障功能的水质采样无人艇路径规划方法，其特征在于：包括以下步骤：/n步骤S1：无人艇启动并自检，开启接收航行所需各项传感器，获取实时地图数据，摘取地图的基本重要信息，并输入无人艇核心处理器中；/n步骤S2：无人艇核心处理器接收实时地图信息，对地图中将要执行路径规划的区域进行二维坐标化处理，开始路径规划前录入水质采样点坐标；/n步骤S3：根据无人艇具体任务或作业要求，结合所设置采样点坐标，利用人工鱼群算法对无人艇航行路线作全局或局部路径规划；/n步骤S4：由无人艇核心处理器规划生成路线后，参照导航系统和电子罗盘采集的信息，控制船体动力推进系统按照预定路线航行，如果遇到动态障碍物或其他紧急情况，再次返回步骤S3，通过局部路径规划对路线进行修正，重新规划路线。/n

【技术特征摘要】
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，...

【专利技术属性】
技术研发人员：吴德烽，张朕，杨荣峰，李素文，
申请(专利权)人：集美大学，
类型：发明
国别省市：福建;35