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

本发明专利技术公开了一种基于3D_Z_螺旋逆风算法的无人机恶臭溯源方法，包括采用风向仪测量风向，多旋翼无人机将结合实时监测的气体浓度和算法逻辑逆风搜索恶臭源。具体为无人机先进行偏向于上风向的斜线运动（Z运动），横穿整个恶臭场源污染区获取足够多的场源浓度；在飞出恶臭污染区后，无人机开始做螺旋运动（Spiral），返回恶臭污染区中；然后逆风做直线运动（Surge），寻找恶臭源。无人机不断重复以上三个运动，逐渐逼近当前平面恶臭污染源。在找到认为的当前平面恶臭源时，无人机下降一定高度（3D）。并且把下降后的位置做为进行新平面溯源的起点，重复以上三个运动，寻找恶臭源。直到无人机下降到允许的最低高度，并且找到了该高度平面的恶臭源时，停止运动，认为找到恶臭源的位置。

【技术实现步骤摘要】
一种基于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＝Vty＝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.一种基于3D_Z_螺旋逆风算法的无人机恶臭溯源方法，其特征在于，包括以下步骤：步骤1：根据环境监测部门或群众反映，找到疑似恶臭污染区。步骤2：利用风向仪测量疑似恶臭污染区的风向，多旋翼无人机将逆风搜索恶臭源。步骤3：无人机从疑似恶臭污染区任意一点起飞，无人机先进行偏向于上风向的斜线运动(Z运动)，横穿整个恶臭场源污染区获取足够多的场源浓度。步骤4：当无人机上气体传感器所获得气体浓度Cp低于阈值Cni，认为这时无人机已经飞出恶臭污染区，无人机开始做螺旋运动(Spiral)，返回恶臭污染区中，无人机回到恶臭污染区的判定标准是当前所处位置的气体浓度Cp高于阈值Cnj。步骤5：无人机做逆风直线运动(Surge)，如果直线运动(Surge)中浓度Cp一直大于阈值Cnj，则持续做直线运动(Surge)直至飞行时间达到30s后，返回步骤3；如果直线运动(Surge)中浓度Cp小于阈值Cnj，则返回步骤3。步骤6：无人机不断重复步骤3到步骤5，逐渐逼近当前平面恶臭污染源。步骤7：当无人机在某点附近小范围内来回运动，此时认为找到了当前平面恶臭源，无人机下降一定高度(3D)。步骤8：把下降后的位置做为进行新平面溯源的起点，继续重复步骤3到步骤7，直到无人机下降到允许的最低高度，并且找到了该高度平面的恶臭源时，停止运动，认为找到恶臭源的位置。...

【技术特征摘要】
1.一种基于3D_Z_螺旋逆风算法的无人机恶臭溯源方法，其特征在于，包括以下步骤：步骤1：根据环境监测部门或群众反映，找到疑似恶臭污染区。步骤2：利用风向仪测量疑似恶臭污染区的风向，多旋翼无人机将逆风搜索恶臭源。步骤3：无人机从疑似恶臭污染区任意一点起飞，无人机先进行偏向于上风向的斜线运动(Z运动)，横穿整个恶臭场源污染区获取足够多的场源浓度。步骤4：当无人机上气体传感器所获得气体浓度Cp低于阈值Cni，认为这时无人机已经飞出恶臭污染区，无人机开始做螺旋运动(Spiral)，返回恶臭污染区中，无人机回到恶臭污染区的判定标准是当前所处位置的气体浓度Cp高于阈值Cnj。步骤5：无人机做逆风直线运动(Surge)，如果直线运动(Surge)中浓度Cp一直大于阈值Cnj，则持续做直线运动(Surge)直至飞行时间达到30s后，返回步骤3；如果直线运动(Surge)中浓度Cp小于阈值Cnj，则返回步骤3。步骤6：无人机不断重复步骤3到步骤5，逐渐逼近当前平面恶臭污染源。步骤7：当无人机在某点附近小范围内来回运动，此时认为找到了当前平面恶臭源，无人机下降一定高度(3D)。步骤8：把下降后的位置做为进行新平面溯源的起点，继续重复步骤3到步骤7，直到无人机下降到允许的最低高度，并且找到了该高度平面的恶臭源时，停止运动，认为找到恶臭源的位置。2.根据权利要求1所述的一种基于3D_Z_螺旋逆风算法的无人机恶臭溯源方法，其特征在于：所述步骤3中气体传...

【专利技术属性】
技术研发人员：丁涛，崔学林，王伟，陈海佳，谢丽华，刘莎莎，徐铭驰，陈海生，
申请(专利权)人：中国计量大学，杭州存览科技有限公司，
类型：发明
国别省市：浙江,33