一种面向大范围水质监测的仿生鱼协同控制方法
【技术领域】
本发明涉及一种水质监测方法,具体涉及一种面向大范围水质监测的仿生鱼协同控制方法,属于水质监测技术领域。
【背景技术】
目前,我国的水质监测方法有实验室监测、自动监测和移动监测。实验室监测是通过设置某些断面定时定点瞬时取样,然后将样品带回实验室进行仪器分析,分析精度虽高但储存的水样会因为悬浮物的凝聚沉降以及生物的代谢过程、死亡分解过程等的影响而发生改变,且数据实时性较差。自动监测是设定在流域内的现场水质自动监测站,建设一个自动监测站需要建造专门的厂房,同时在线水质分析仪器价格也十分昂贵。移动监测多为人工驾驶的水质监测船,不仅成本高而且存在二次污染。
随着物联网技术的兴起,水下监测结合无线传感网越来越受到人们的重视。体积较小,探测范围广、精度高的移动水质监测节点具有较大的社会价值和经济效益。如何让这些节点能够组成网络,协同地采集水质参数显得尤为重要。
因此,为解决上述技术问题,确有必要提供一种创新的面向大范围水质监测的仿生鱼协同控制方法,以克服现有技术中的所述缺陷。
【发明内容】
为解决上述技术问题,本发明的目的在于一种体积较小,探测范围广、精度高,可在线监测不同水域的水质参数的面向大范围水质监测的仿生鱼协同控制方法。
为实现上述目的,本发明采取的技术方案为:一种面向大范围水质监测的仿生鱼协同控制方法,其包括领航仿生节点、跟随仿生节点和岸上基站;其包括如下步骤:
S1:岸上基站发送运行轨迹控制指令给领航仿生节点;
S2:跟随仿生节点搜索领航仿生节点位置,计算得出相对距离与角度;
S3:根据模糊控制方法,追踪领航仿生节点,采集并发送水质参数;
S4:领航仿生节点接收跟随仿生节点发来的信息,解析、打包后发送到岸上基站;
S5:重复步骤S1~S5。
本发明的面向大范围水质监测的仿生鱼协同控制方法进一步为:所述模糊控制方法包括如下步骤:
S31:获取相对距离,相对角度,在其论域上建立两个个隶属度函数,在输出论域上建立航速与航向六个隶属度函数;
S32:对输入进行离散化,划分为N,M个离散值;
S33:输入离散值后,根据实际经验建立的3×3模糊推理规则表计算其模糊输出,得到M×N对决策值,所述模糊控制策略包括航速信息和航向信息;
S34:根据模糊控制查询表分别控制直流电机与舵机,模糊编队控制多个仿生移动节点协同前进。
本发明的面向大范围水质监测的仿生鱼协同控制方法进一步为:所述模糊编队控制策略还包括转向信息和转速信息,所述转向信息和转速信息所依据的模糊控制查询表是预先通过以下模糊推理机计算所得的:
输入:相对距离较远、适中、较近与相对角度偏小、正好、偏大,根据领航 — 跟随移动节点相对位置实际情况设定;相对距离在0~5米为较近,5~6米适中,大于6米较远;相对角度在0~40度偏小,40~50度正好,50~90度偏大;
模糊规则如下:
若相对距离适中且相对角度正好,则决策为匀速,前行;
若相对距离适中且相对角度偏小,则决策为匀速,左转;
若相对距离适中且相对角度偏大,则决策为匀速,右转;
若相对距离较近且相对角度正好,则决策为减速,前行;
若相对距离较近且相对角度偏小,则决策为减速,左转;
若相对距离较近且相对角度偏大,则决策为减速,右转;
若相对距离较远且相对角度正好,则决策为加速,前行;
若相对距离较远且相对角度偏小,则决策为加速,左转;
若相对距离较远且相对角度偏大,则决策为加速,右转;
对输入进行离散化:
相对距离0-1米归为0.5米,1-2米归为1.5米,2-3米归为2.5米,3-4米归为3.5米,4-5米归为4.5米,5-6米归为5.5米,6-7米归为6.5米,7-8米归为7.5米,大于8米归为8米;
相对角度0-10度归为5度,10-20度归为15度,20-30度归为25度,30-40度归为35度,40-50度归为45度,50-60度归为55度,60-70度归为65度,70-80度归为75度,80-90度归为85度;
本发明的面向大范围水质监测的仿生鱼协同控制方法进一步为:所述跟随仿生节点系统包括水质传感器、电荷放大模块、模数转换模块、单片机模块、水声通信模块、GPRS模块、定位模块、姿态检测模块、电机驱动模块、直流电机、舵机和微型水泵,所述水质传感器采集水质参数信息,所述电荷放大模块与水质传感器、模数转换模块相连,所述模数转换模块对多个电荷放大模块处理的多路信号同步采样,所述单片机对模数采样的信号进行处理,所述水声通信模块将单片机输出信号向水里广播或接收指令,所述GPRS模块将单片机输出信号向岸上发送出去或接收指令,所述电机驱动模块驱动直流电机和微型水泵,所述直流电机、微型水泵和舵机协同运作分别控制仿生移动节点前进、转向以及沉浮,所述定位模块采集节点位置信息。
本发明的面向大范围水质监测的仿生鱼协同控制方法进一步为:所述水质参数采集、水声通信系统、动力系统、定位模块和姿态检测模块共用一个微处理器,所述微处理器为ARM® Cortex M3 内核32位高性能的STM32F103芯片。
本发明的面向大范围水质监测的仿生鱼协同控制方法进一步为:所述领航仿生节点、跟随仿生节点采用仿金枪鱼的外观设计。
本发明的面向大范围水质监测的仿生鱼协同控制方法还可为:所述领航仿生节点和跟随仿生节点间采用水声通信。
与现有技术相比,本发明具有如下有益效果:
1. 移动节点模仿金枪鱼的外观设计,具有移动速度快,环境适应性强等特点。
2. 利用发射换能器与接收换能器组成的水声通信系统,实现水下远距离通信。
3. 浮于水面区域的领航仿生节点以GPRS方式转发水质参数信息到岸上基站,数据传输效率高。
4. 多个移动节点以编队的方式协同驱动,同时监测水环境,感知范围广,精度高。
5. 采用分布式模糊控制算法,跟随仿生节点可自动搜寻领航仿生节点并追踪其运行轨迹。
6. 有效地在线实时监测水质,一旦发现部分水域出现水质恶化,将及时通知岸上基站。
【附图说明】
图1是本发明的面向大范围水质监测的仿生鱼系统的整体示意图;
图2为跟仿生节点系统搭建图;
图3为三个移动节点编队队形示意图;
图4为领航仿生节点程序流程图;
图5为跟随仿生节点程序流程图;
图6为相对距离隶属度函数示意图;
图7为相对角度隶属度函数示意图;
图8为输出速度隶属度函数示意图;
图9为输出角度隶属度函数示意图;
图10为是电机驱动模块连接图。
图11是电源模块。
【具体实施方式】
下面结合附图对本发明中的技术方案进行进一步的描述:
参照图1,一种面向大范围水质监测的仿生鱼协同控制方法,包括领航仿生节点1、跟随仿生节点2和岸上基站3。所述跟随仿生节点采集并发送水质参数信息,自动追踪领航仿生节点运行轨迹(程序流程图见图4),所述领航仿生移动节点浮于水面,利用水声接收跟随仿生节点采集的水质参数信息,转换后发送至岸上基站,同时接收岸上基站发来的运行状态控制指令(程序流程图见图5)。所述领航仿生节点1、跟随仿生节点2采用仿金枪鱼的外观设计,具有移动速度快,环境适应性强等特点;且领航仿生节点1与跟随仿生节点2间采用水声通信,可行性高;领航仿生节点接收跟随仿生节点发来的信息,解析后以GPRS方式转发给岸上基站,传输距离远,通信效率较高,可实现远距离程控,在线监测不同水域的水质参数。所述跟随仿生节点2能自主追踪领航仿生节点运行轨迹,可任意增加或减少跟随仿生节点数量,自由变换队形。
参照图2,所述跟随仿生节点系统搭建图,包括水质传感器21、电荷放大模块22、模数转换模块23、单片机模块24、水声通信模块25、GPRS模块26、定位模块211、姿态检测模块212、电机驱动模块27、直流电机28、舵机29和微型水泵210,所述水质传感器21采集水质参数信息,所述电荷放大模块23与水质传感器21、模数转换模块23相连,所述模数转换模块23对多个电荷放大模块22处理的多路信号同步采样,所述单片机24对模数采样的信号进行处理,所述水声通信模块25将单片机25输出信号向水里广播或接收指令,所述GPRS模块26将单片机24输出信号向岸上发送出去或接收指令,所述电机驱动模块27驱动直流电机28和微型水泵210,所述直流电机28、微型水泵210和舵机29协同运作分别控制仿生移动节点2前进、转向以及沉浮,所述定位模块211采集节点位置信息。其中,所述水质参数采集21、水声通信系统25、直流电机28、舵机29、微型水泵210、定位模块211和姿态检测模块212共用一个微处理器,所述微处理器为ARM® Cortex M3 内核32位高性能的STM32F103芯片。
如图3~9所示,本发明提供一种面向大范围水质监测的仿生鱼协同控制方法,包括以下步骤:
S1:岸上基站发送运行轨迹控制指令给领航仿生节点,领航仿生节点由GPRS接收控制指令后可输出PWM波控制直流电机、舵机和微型水泵进入巡游模式,并以水声方式广播队形信息。
S2:跟随仿生节点通过水声搜索领航仿生节点位置,接收队形信息后,可计算得出相对距离与角度;
S3:根据模糊控制算法,跟随仿生节点输出PWM波控制直流电机、舵机和微型水泵进入追踪模式,追踪领航仿生节点运行轨迹,同时采集并发送水质参数信息;
S4:领航仿生节点接收跟随仿生节点发来的水质参数信息,解析、打包后发送到岸上基站;
S5:重复步骤S1~S5。
本发明的面向大范围水质监测的仿生鱼协同控制方法采用多个移动节点编队控制方式采集水质参数信息。移动节点模仿金枪鱼外观设计,可分为领航仿生节点和跟随仿生节点。领航仿生节点浮于水面区域巡游,以水声广播的方式告知水里的跟随仿生节点队形信息,同时收集跟随仿生节点采集的水质参数信息,并与岸上基站实现通信。跟随仿生移动节点接收队形信息后以一定的几何构型跟随领航仿生节点移动,并采集、发送水质参数信息。领航与跟随仿生节点间采用水声通信技术,领航仿生节点与岸上基站间采用GPRS通信技术。编队系统采用分布式模糊编队控制方式,可以实现远程控制,测试范围广,精度高,在线监测不同水域的水质参数。
进一步,通过模糊编队控制方式,利用领航与跟随仿生节点间的相对距离、方向协同驱动一个领航仿生节点与多个跟随仿生节点,感知能力广,可监测大范围水质环境。所述模糊控制方法包含:
S31:获取相对距离,相对角度,在其论域上建立两个隶属度函数,在输出论域上建立航速与航向六个隶属度函数;
S32:对输入进行离散化,划分为N,M个离散值;
S33:输入离散值后,根据实际经验建立的3×3模糊推理规则表计算其模糊输出,得到M×N对决策值,所述模糊控制策略包括航速信息和航向信息;
S34:根据已经反模糊化的模糊控制查询表分别控制直流电机与舵机,编队控制多个仿生移动节点协同前进。
更进一步,所述模糊编队控制策略包括转向信息和转速信息,所述转向信息和转速信息所依据的模糊控制查询表是预先通过以下模糊推理机计算所得的:
输入:相对距离较远、适中、较近与相对角度偏小、正好、偏大,根据领航 — 跟随移动节点相对位置实际情况设定。相对距离在0~5米为较近,5~6米适中,大于6米较远;相对角度在0~40度偏小,40~50度正好,50~90度偏大。
模糊规则如下:
若相对距离适中且相对角度正好,则决策为匀速,前行;
若相对距离适中且相对角度偏小,则决策为匀速,左转;
若相对距离适中且相对角度偏大,则决策为匀速,右转;
若相对距离较近且相对角度正好,则决策为减速,前行;
若相对距离较近且相对角度偏小,则决策为减速,左转;
若相对距离较近且相对角度偏大,则决策为减速,右转;
若相对距离较远且相对角度正好,则决策为加速,前行;
若相对距离较远且相对角度偏小,则决策为加速,左转;
若相对距离较远且相对角度偏大,则决策为加速,右转。
对输入进行离散化:
相对距离0-1米归为0.5米,1-2米归为1.5米,2-3米归为2.5米,3-4米归为3.5米,4-5米归为4.5米,5-6米归为5.5米,6-7米归为6.5米,7-8米归为7.5米,大于8米归为8米。
相对角度0-10度归为5度,10-20度归为15度,20-30度归为25度,30-40度归为35度,40-50度归为45度,50-60度归为55度,60-70度归为65度,70-80度归为75度,80-90度归为85度。
由此可得模糊控制查询表如下(还需乘与放大系数α):
最终实现结果如图3所示,(Px0,Py0)表示领航仿生节点,(Px1,Py1)和(Px2,Py2)表示跟随仿生节点,由模糊编队控制使得跟随仿生节点在扇形区域内追踪前行。
参照图10,电机驱动模块采用ST公司生产的L298N芯片,它是一种高电压、大电流电机驱动芯片。主要特点是:工作电压高,最高工作电压可达46V。输出电流大,瞬间峰值电流可达3A,持续工作电流为2A,额定功率25W。支持两路直流电机和一个步进电机的驱动。采用标准逻辑电平信号控制,具有两个使能控制端,在不受输入信号影响的情况下允许或禁止器件工作有一个逻辑电源输入端,使内部逻辑电路部分在低电压下工作;可以外接检测电阻,将变化量反馈给控制电路。
参照图11,电源模块采用德州仪器(TI)生产的LM2596芯片,它是一款3A电流输出降压开关型集成稳压芯片,内含固定频率振荡器(150KHZ)和基准稳压器(1.23v),并具有完善的保护电路、电流限制、热关断电路等。利用该器件只需极少的外围器件便可构成高效的稳压电路,提供的主要有3.3V、5V、12V等多个电压。
本发明操作过程如下,首先用手打开多个移动节点的开关,即电源模块开始工作,此时多个移动节点开始工作,将一个领航仿生节点和多个跟随仿生节点放入水中,由上位机软件发送控制指令驱动领航仿生节点。跟随仿生节点利用水声搜索到领航仿生节点后计算相对距离、方向,经模糊编队控制器计算后,自动追踪领航仿生节点轨迹。同时,多个跟随仿生节点采集水质参数信息,发送给领航仿生节点。领航仿生节点收集各节点水质参数信息,转发至岸上基站。
以上的具体实施方式仅为本创作的较佳实施例,并不用以限制本创作,凡在本创作的精神及原则之内所做的任何修改、等同替换、改进等,均应包含在本创作的保护范围之内。