基于三级避障机制的果园植保无人机避障装置及方法制造方法及图纸

本发明专利技术公开了一种基于三级避障机制的果园植保无人机避障装置及方法，果园植保无人机避障装置包括均与无人机飞控连接的微波雷达、若干超声波传感器以及若干近程红外传感器阵列，所述微波雷达用于探测无人机的远距离障碍物信息，所述超声波传感器用于探测无人机周边中距离障碍物信息，所述近程红外传感器用于探测无人机近距离障碍物信息；所述超声波传感器和近程红外传感器阵列数量均为4个，所述微波雷达设置于无人机飞控顶部，所述超声波传感器和近程红外传感器阵列均设置于无人机机翼上；所述近程红外传感器阵列包括5个近程红外传感器。本发明专利技术满足了山地果园环境下的地形、地貌、植被在复杂多变情况下果园无人机作业可靠的需要。

Obstacle avoidance device and method for orchard plant protection unmanned aerial vehicle based on three stage obstacle avoidance mechanism

The invention discloses a UAV obstacle avoidance device based on three level orchard plant protection mechanism and obstacle avoidance method, UAV obstacle avoidance orchard plant protection device comprises both with and without microwave radar, flight control computer connected with a plurality of ultrasonic sensors and a plurality of near infrared sensor array, the micro wave radar is used to detect the UAV obstacle distance information, the ultrasonic sensor is used to detect the free distance of the obstacle information surrounding the man-machine, near infrared sensor is used to detect the UAV close obstacle information; the ultrasonic sensor and infrared sensor array short-range number is 4, the microwave radar is arranged on the top of the UAV flight control, ultrasonic sensor and near infrared sensor array are mounted on the UAV wing; the short-range infrared sensor array includes 5 short-range infrared sensor. The invention satisfies the requirements of the operation of the orchard unmanned aerial vehicle in the complex and changeable circumstances, and satisfies the topography, physiognomy and vegetation of the Mountain Orchard environment.

【技术实现步骤摘要】
基于三级避障机制的果园植保无人机避障装置及方法
本专利技术涉及山地果园植保无人机避障
，尤其涉及一种基于三级避障机制的果园植保无人机避障装置及方法。
技术介绍
在山地丘陵环境下，果树随地形地貌的变化而起伏不平，因此果园植保无人机在进行植保作业时飞行状态需随果园果树的变化而随时进行调整，同时，果园里往往存在着果树枝干、电线杆，高压线等潜在空中隐患，因此，植保无人机在山地果园作业风险比平地作业大大增加。目前，在无人机避障方面，目前采用的方法主要包括通过激光雷达、图像摄像头、光流传感器或者超声波传感器来识别障碍物，并反馈给飞控，进而飞控用于控制无人机规避障碍物。但这些避障方法和技术均没有分级考虑引入远、中、近三级障碍物探测及其避障处理方法，从而降低复杂作业环境下无人机飞行的可靠性。因此，设计出一种基于三级避障机制的果园植保无人机避障装置及方法具有较高的理论和实际意义。
技术实现思路
为了克服现有技术存在的缺点与不足，本专利技术提供一种基于三级避障机制的果园植保无人机避障装置及方法，满足山地果园环境下的地形、地貌、植被在复杂多变情况下果园无人机作业可靠的需要。为解决上述技术问题，本专利技术提供如下技术方案：一种基于三级避障机制的果园植保无人机避障装置，包括均与无人机飞控连接的微波雷达、若干超声波传感器以及若干近程红外传感器阵列，所述微波雷达用于探测无人机的远距离障碍物信息，所述超声波传感器用于探测无人机周边中距离障碍物信息，所述近程红外传感器用于探测无人机近距离障碍物信息。进一步地，所述超声波传感器和近程红外传感器阵列数量均为4个，所述微波雷达设置于无人机飞控顶部，所述超声波传感器和近程红外传感器阵列均设置于无人机机翼上；所述近程红外传感器阵列包括5个近程红外传感器，所述近红外传感器相互之间夹角为90度，用于获取近距离障碍物信息。本专利技术另一目的是提供一种基于三级避障机制的果园植保无人机避障方法，包括下述步骤：S1、在无人机飞行过程中，微波雷达对无人机360度范围内的物体进行扫描，探测物体与无人机之间的距离，并建立远距离避障指数函数；S2、无人机持续更新远距离避障指数函数的远距离避障指数，若前行路径方向的远距离避障指数大于最小远距离避障指数的设定值，则无人机在前行路径方向的正负10度范围内，选择最小避障指数值的方向进行飞行；无人机在最小避障指数值的方向飞行时，若最小避障指数值小于设定值，则无人机持续更新远距离避障指数函数的远距离避障指数；若最小避障指数值大于等于设定值，则启动超声波传感器，建立中距离避障指数函数；S3、无人机持续更新中距离避障指数函数的中距离避障指数，若中距离避障指数小于给定值，则关闭超声波传感器，返回步骤S2；若中距离避障指数大于另一给定值，则启动近程红外传感器阵列；S4、近程红外传感器阵列探测周边的障碍物距离，建立近距离避障指数函数；S5、无人机持续更新近距离避障指数函数的近距离避障指数，并根据近距离避障指数调整飞行路径；S6、若最小近距离避障指数大于调整值，则无人机进行180度调整飞行方向，并选择最小近距离避障指数方向飞行；S7、无人机进行180度调整飞行方向后，若此时的近距离避障指数小于调整值，则关闭近程红外传感器阵列并返回步骤S2；若此时的近距离避障指数大于等于调整值，则返回步骤S6。进一步地，所述步骤S1的远距离避障指数函数为：其中，α(θ)表示远距离避障指数，θ表示方向角，以正北方向为零度角，按顺时针方向进行角度的增加；d(θ)表示距离障碍物的距离。进一步地，所述步骤S2，若当前行径方向的远距离避障指数大于0.3，0.3所述设定值，则无人机在前行路径方向的正负10度范围内，选择最小避障指数值αmin(θ)的方向进行飞行，最小避障指数值αmin(θ)为：αmin(θ)＝min(α(θ))，若最小避障指数值αmin(θ)小于0.30，则无人机持续更新远距离避障指数函数的远距离避障指数，最小避障指数值αmin(θ)大于等于0.30，则启动超声波传感器，建立中距离避障指数β(φ)函数，所述中距离避障指数β(φ)函数为：其中，φi表示第i个超声波传感器的方向角，以正北方向为零度角；i等于1、2、3、4，分别表示安装在无人机上的四个超声波传感器；m(φi)表示超声波传感器探测到的距离障碍物的距离。进一步地，所述步骤S3，若前行路径方向的中距离避障指数小于0.03，0.03为所述给定值，则关闭超声波传感器，返回步骤S2；若前行路径方向的大于0.07，0.07为所述另一给定值，则无人机将飞行速度减半，同时启动近程红外传感器阵列。进一步地，所述步骤S4中距离避障指数γ(xij,yij)函数为：其中，xij表示球面坐标的方位角，yij表示球面坐标的仰角；其中i等于1、2、3、4，分别表示无人机上的四个近程红外传感器阵列；j等于1、2、3、4、5，分别表示红外近程传感器阵列中相互垂直的5个近程红外传感器；c(xij,yij)表示近程红外传感器阵列探测到的距离障碍物的距离。进一步地，所述步骤S5中根据距离避障指数调整飞行路径，具体为：S51、若前行路径方向的近距离避障指数小于0.012，则关闭近程红外传感器阵列，返回步骤S3；否则，进入下一步骤；S52、若前行路径方向的近距离避障指数γ(xij,yij)小于0.03，则继续飞行；若大于等于0.03，无人机将飞行速度减半，在前行路径方向的正负90度范围内，选择最小近距离避障指数值的方向进行飞行，并进入步骤S6，其中最小近距离避障指数值表示为：γmin(xij,yij)＝min(γmin(xij,yij))其中，进一步地，所述步骤S6，具体为：若最小近距离避障指数值大于0.03，0.03为所述调整值，则无人机首先180度调整其飞行方向，即：接着，无人机选择最小近距离避障指数方向飞行；所述步骤S6的持续时间为1秒，在1秒的持续时间内：若近距离避障指数小于0.03，则继续飞行；若近距离避障指数大于0.03，则无人机保持悬停，并等待人工干预操作。进一步地，所述步骤S7，具体为：若近距离避障指数小于0.03，0.03为所述调整值，则关闭近程红外传感器阵列，并返回步骤S2，同时方向角更新为：若近距离避障指数大于等于0.03，则返回步骤S6。采用上述技术方案后，本专利技术至少具有如下有益效果：(1)、本专利技术方法采用远、中、近三级障碍物探测及其避障处理方法，提高了无人机飞行作业的可靠性；(2)、本专利技术方法的近距离探测采用近程红外传感器阵列，具有成本较低、安装简单、耗电小、体积小和精度高等优点，满足果园无人机近距离障碍物高精度实时探测的需要。附图说明图1是本专利技术基于三级避障机制的果园植保无人机避障装置的结构示意图。具体实施方式需要说明的是，在不冲突的情况下，本申请中的实施例及实施例中的特征可以相互结合，下面结合附图和具体实施例对本申请作进一步详细说明。本实施例所述基于三级避障机制的果园植保无人机避障装置，如图1所示，包括旋翼1、飞控2、微波雷达3、超声波传感器4、近程红外传感器阵列5。如图1所示，旋翼1、微波雷达3、超声波传感器4、近程红外传感器阵列5均与飞控2相连。如图1所示，所述微波雷达3，部署在植保无人机正中的无人机飞控2顶部，用于探测无人机360度方向上的远距离障碍物本文档来自技高网...

【技术保护点】
一种基于三级避障机制的果园植保无人机避障装置，其特征在于，包括均与无人机飞控连接的微波雷达、若干超声波传感器以及若干近程红外传感器阵列，所述微波雷达用于探测无人机的远距离障碍物信息，所述超声波传感器用于探测无人机周边中距离障碍物信息，所述近程红外传感器用于探测无人机近距离障碍物信息。

【技术特征摘要】
1.一种基于三级避障机制的果园植保无人机避障装置，其特征在于，包括均与无人机飞控连接的微波雷达、若干超声波传感器以及若干近程红外传感器阵列，所述微波雷达用于探测无人机的远距离障碍物信息，所述超声波传感器用于探测无人机周边中距离障碍物信息，所述近程红外传感器用于探测无人机近距离障碍物信息。2.如权利要求1所述的基于三级避障机制的果园植保无人机避障装置，其特征在于，所述超声波传感器和近程红外传感器阵列数量均为4个，所述微波雷达设置于无人机飞控顶部，所述超声波传感器和近程红外传感器阵列均设置于无人机机翼上；所述近程红外传感器阵列包括5个近程红外传感器，所述近红外传感器相互之间夹角为90度，用于获取近距离障碍物信息。3.一种基于三级避障机制的果园植保无人机避障方法，其特征在于，包括下述步骤：S1、在无人机飞行过程中，微波雷达对无人机360度范围内的物体进行扫描，探测物体与无人机之间的距离，并建立远距离避障指数函数；S2、无人机持续更新远距离避障指数函数的远距离避障指数，若前行路径方向的远距离避障指数大于最小远距离避障指数的设定值，则无人机在前行路径方向的正负10度范围内，选择最小避障指数值的方向进行飞行；无人机在最小避障指数值的方向飞行时，若最小避障指数值小于设定值，则无人机持续更新远距离避障指数函数的远距离避障指数；若最小避障指数值大于等于设定值，则启动超声波传感器，建立中距离避障指数函数；S3、无人机持续更新中距离避障指数函数的中距离避障指数，若中距离避障指数小于给定值，则关闭超声波传感器，返回步骤S2；若中距离避障指数大于另一给定值，则启动近程红外传感器阵列；S4、近程红外传感器阵列探测周边的障碍物距离，建立近距离避障指数函数；S5、无人机持续更新近距离避障指数函数的近距离避障指数，并根据近距离避障指数调整飞行路径；S6、若最小近距离避障指数大于调整值，则无人机进行180度调整飞行方向，并选择最小近距离避障指数方向飞行；S7、无人机进行180度调整飞行方向后，若此时的近距离避障指数小于调整值，则关闭近程红外传感器阵列并返回步骤S2；若此时的近距离避障指数大于等于调整值，则返回步骤S6。4.如权利要求3所述的基于三级避障机制的果园植保无人机避障方法，其特征在于，所述步骤S1的远距离避障指数函数为：其中，α(θ)表示远距离避障指数，θ表示方向角，以正北方向为零度角，按顺时针方向进行角度的增加；d(θ)表示距离障碍物的距离。5.如权利要求4所述的基于三级避障机制的果园植保无人机避障方法，其特征在于，所述步骤S2，若当前行径方向的远距离避障指数大于0.3，0.3所述设定值，则无人机在前行路径方向的正负10度范围内，选择最小避障指数值αmin(θ)的方向进行飞行，最小避障指数值αmin(θ)为：αmin(θ)＝min(α(θ))，若最小避障指数值αmin...

【专利技术属性】
技术研发人员：徐兴，王臻杰，李君，杨洲，蔡坤，卢明剑，钟志清，刘伟，
申请(专利权)人：华南农业大学，
类型：发明
国别省市：广东,44