一种基于3D_Z_螺旋逆风算法的无人机恶臭溯源方法与流程

本发明涉及一种基于无人机的恶臭溯源方法，属于多旋翼无人机飞行器与大气环境监测领域。

背景技术：

恶臭污染是一种常见的环境污染，是世界公认的七大环境公害之一。恶臭是指各种使人有不愉快感觉的气味(异味)的总称，当环境中的恶臭物质浓度达到一定程度时，不仅影响居民的生活质量，严重时也会直接危及到人们的健康。有些恶臭物质会刺激人的呼吸道，对心脑血管的生理功能产生影响，导致判断力和记忆力降低，工作效率降低。其中一些芳香族化合物还可能造成人体畸变、癌变，高浓度的恶臭还会导致接触者发生肺水肿甚至窒息死亡。因此恶臭污染源定位对人类安全与环境保护有着非常重要的意义。

目前已有的气味源定位算法，主要包括：浓度梯度搜索算法、z字形遍历算法、spiralsurge算法、aco算法、e.coli算法等，主要应用于地面机器人的气味源定位，并且有各自应用的局限性。z字形遍历算法可以找到气味源，但是耗费较长时间以及不精确，优点是可以完全的获知气味源场的信息。spiralsurge算法可以比较精确的找到气味源，但是溯源运动路径偏向于气味源一边，可能会陷入局部最优点，不能够完全的获知气味源场的信息。

技术实现要素：

本发明要解决的技术问题是如何结合已有的气味源定位算法和空中恶臭溯源的实际情况，开发出合适的恶臭溯源算法并且应用到无人机中，因此我们提供一种基于3d_z_螺旋逆风算法的无人机恶臭溯源方法。该方法具有溯源快速精确、路径最优、避免陷入局部最优点等优点。

为了实现上述目的，本发明所采用的技术方案包括以下步骤：

步骤1：根据环境监测部门或群众反映，找到疑似恶臭污染区，疑似恶臭污染源区域设定通常以造纸厂、养殖场、饲料厂和化工厂、屠宰场等区域为主。

步骤2：利用风向仪测量疑似恶臭污染区的风向，多旋翼无人机将逆风搜索恶臭源。

步骤3：建立以当前顺风方向为x轴正方向，重力加速度方向为z轴的正方向，然后依据右手原则确定y轴正方向的坐标系。整个恶臭溯源过程中无人机速度大小为v。无人机从疑似恶臭污染区任意一点起飞，无人机先进行偏向于上风向的斜线运动(z)，横穿整个恶臭场源污染区获取足够多的场源气体浓度数据。气体传感器每秒读取一次数据，所读取的数据是当前无人机所在位置的气体浓度值cp。

所述步骤3：无人机起飞点的气体浓度为第一个阈值cni，i＝1代表第一次的斜线运动(z)。对步骤3过程中采集的气体浓度进行比较，将最大的气体浓度设为max1。

步骤4：当无人机上气体传感器所获得气体浓度cp低于阈值cni，认为这时无人机已经飞出恶臭污染区，无人机开始做螺旋运动(spiral)，返回恶臭污染区中，无人机回到恶臭污染区的判定标准是当前所处位置的气体浓度cp高于阈值cnj。

所述步骤4：阈值第一次螺旋运动j＝1，n＝1。其中j＝1代表第一次螺旋运动(spiral)。此次n＝1且每次计算n加1。

步骤5：无人机从返回点开始逆风做直线运动(surge)，寻找恶臭源。对步骤5过程中采集的气体浓度进行比较，将最大的气体浓度设为max2。

所述步骤5：无人机逆风直线运动(surge)，如果直线运动(surge)中浓度cp一直大于阈值cnj，则持续做直线运动(surge)直至飞行时间达到30s后，返回步骤3。如果直线运动(surge)中浓度cp小于阈值cnj，则返回步骤3。

步骤6：无人机不断重复步骤3到步骤5的运动，逐渐逼近当前平面恶臭污染源。

所述步骤6：一直重复步骤3到步骤5的过程，n、i、j每经过一次循环数值加1，阈值不断更新，当i大于等于2时，无人机不断靠近恶臭源，当非常接近恶臭源时，会在恶臭源附近小范围内来回运动，此时认为找到了当前平面恶臭源，如图2所示。

步骤7：当无人机在某点附近小范围内来回运动，此时认为找到了当前平面恶臭源，无人机下降一定高度(3d)。

所述步骤7：每次下降的高度，会根据初始位置的高度进行调节，防止出现循环过少或效率太低的问题。根据初始高度，每次下降初始高度的20％。

步骤8：把下降后的位置做为进行新平面溯源的起点，继续重复步骤3到步骤7，直到无人机下降到允许的最低高度，并且找到了该高度平面的恶臭源时，停止运动，认为找到恶臭源的位置。

附图说明

图1是本发明基于3d_z_螺旋逆风算法的无人机恶臭溯源方法的流程图；

图2是本发明疑似恶臭污染源区域及算法策略示意图。

具体实施方式

如图1所示，一种基于3d_z_螺旋逆风算法的无人机恶臭溯源方法具体包括以下步骤：

步骤1：根据环境监测部门或群众反映，找到疑似恶臭污染区，疑似恶臭污染源区域设定通常以造纸厂、养殖场、饲料厂和化工厂、屠宰场等区域为主。

步骤2：利用风向仪测量疑似恶臭污染区的风向，多旋翼无人机将逆风搜索恶臭源，保证恶臭溯源的效率。

步骤3：无人机从疑似恶臭污染区任意一点起飞，无人机先进行偏向于上风向的斜线运动(z)，横穿整个恶臭场源污染区获取足够多的场源气体浓度数据。气体传感器每秒读取一次数据，所读取的数据是当前无人机所在位置的气体浓度值cp。

所述步骤3：建立以当前顺风方向为x轴正方向，重力加速度方向为z轴的正方向，然后依据右手原则确定y轴正方向的坐标系。整个恶臭溯源过程中无人机速度的大小为v。

所述步骤3：无人机起飞点的气体浓度为第一个阈值cni，i＝1代表第一次的斜线运动(z)。对步骤3过程中采集的气体浓度进行比较，将最大的气体浓度设为max1。无人机进行偏向于上风向的斜线运动(z)，具体角度为：与x轴正方向成120°夹角，每次运动的距离为stepsize。

所述步骤3：此次运动由斜线组成，其对应的公式为：

x＝vt

y＝d×vt

其中x,y为无人机的运动坐标，单位为m；t为无人机运动时间，单位为s；d为无人机运动方程的斜率，单位为1。其中t小于等于30s，如果无人机飞行30s仍未结束此次运动(z)，则无人机从飞行30s后的所在位置重新开始步骤3。

步骤4：当无人机上气体传感器所获得气体浓度cp低于阈值cni，认为这时无人机已经飞出恶臭污染区，无人机开始做大的螺旋运动(spiral)，返回恶臭污染区中，无人机回到恶臭污染区的判定标准是当前所处位置的气体浓度cp高于阈值cnj。

所述步骤4：此次无人机螺旋运动为公式为：

x＝t×cos(ωt)

y＝t×sin(ωt)

其中x，y为无人机的运动坐标，单位为m；t为无人机运动时间，单位为s；ω为无人机运动角速度，单位为rad/s。其中t小于等于30s，如果无人机飞行30s仍未结束此次螺旋运动(spiral)，则无人机从飞行30s后的所在位置重新开始步骤4。

所述步骤4：阈值第一次螺旋运动j＝1，n＝1。其中j＝1代表第一次螺旋运动(spiral)。

步骤5：无人机从返回点开始逆风做直线运动(surge)，寻找恶臭源。对步骤5过程中采集的气体浓度进行比较，将最大的气体浓度设为max2。

所述步骤5：无人机逆风直线运动(surge)，如果直线运动(surge)中浓度cp一直大于阈值cnj，则持续做直线运动(surge)直至飞行时间达到30s后，返回步骤3。如果直线运动(surge)中浓度cp小于阈值cnj，则返回步骤3。

步骤6：无人机不断重复步骤3到步骤5的运动，逐渐逼近当前平面恶臭污染源。

所述步骤6：一直重复步骤3到步骤5的过程，n、i、j每经过一次循环数值加1，阈值不断更新。当i大于等于2时，无人机不断靠近恶臭源，当非常接近恶臭源时，会在恶臭源附近小范围内来回运动，此时认为找到了当前平面恶臭源，如图2所示。

步骤7：当无人机在某点附近小范围内来回运动，此时认为找到了当前平面恶臭源，无人机下降一定高度(3d)。

所述步骤7：判断找到当前平面恶臭源的标准为：计算此次循环步骤3中斜线运动(z)起点与上次循环步骤3中的斜线运动(z)的起点之间的距离d，若连续三次d小于等于1m，则认为找到当前平面的恶臭源。

距离计算公式：

其中xn，yn为无人机此次循环步骤3中斜线运动(z)起点的运动坐标，xn-1，yn-1为上次循环步骤3中斜线运动(z)起点的运动坐标，单位为m；d为两次起点之间的距离，单位为m。

所述步骤7：每次下降的高度，会根据初始位置的高度进行调节，防止出现循环过少或效率太低的问题。根据初始高度，每次下降初始高度的20％，这样3到4次就可以完成溯源，找到恶臭源。

步骤8：把下降后的位置做为进行新平面溯源的起点，继续重复步骤3到步骤7，直到无人机下降到允许的最低高度，并且找到了该高度平面的恶臭源时，停止运动，认为找到恶臭源的位置。