搭载云台的斜侧装无人机毫米波雷达避障和定高方法技术

本发明专利技术公开了搭载云台的斜侧装无人机毫米波雷达避障和定高方法，方法包括步骤：雷达原始数据预处理，获得一维距离向数据和距离多普勒数据；雷达高精度解角算法处理后输出三维目标点云数据；对全区域点云进行分割操作，负45度附近的点云作为避障处理区域，正45度附近的点云作为定高处理区域，在避障处理区域内检测跟踪三维点云数据，如果满足连续数帧点云与其速度匹配，则形成避障距离航迹，否则清除航迹；在定高源点云簇中计算得到无人机定高数据；对数据结果进行融合处理。本发明专利技术可防止雷达平台跟着无人机姿态倾斜，实时保持雷达波束照射方向与飞行方向一致，实现单个雷达全向探测功能。测功能。测功能。

【技术实现步骤摘要】
搭载云台的斜侧装无人机毫米波雷达避障和定高方法


[0001]本专利技术属于雷达
，尤其涉及搭载云台的斜侧装无人机毫米波雷达避障和定高方法。

技术介绍

[0002]随着科技的发展，无人机应用领域变得越来越广泛。为了保障无人机在低空复杂环境中执行任务时的安全,需要安装传感器来进行障碍物主动避障和恒定高度仿地飞行。相比于超声波避障、激光避障、视觉避障在探测能力、成本、抗干扰能力等方面的缺陷，毫米波雷达可靠性高、抗电磁干扰、全天候全天时工作的特点与无人机的需求很契合。然而一个毫米波雷达仅仅只能具有单方向的避障或者定高，所以无人机为了实现定高和全向避障功能需要安装一个垂直向下探测的定高雷达和前后左右方向的四个避障雷达，共计五个雷达。这样会导致无人机系统的造价成本增加，载重多且安装复杂。同时，无云台的固定安装方式的避障雷达探测效果受无人机的飞行姿态影响很大，雷达天线照射方向造成偏移引入地杂波的干扰，存在目标误报和漏报的隐患，而已无法实现真正的全方面安全防护。

技术实现思路

[0003]有鉴于此，本专利技术提出了一种搭载云台的斜侧装无人机毫米波雷达多合一避障定高方法，云台包括三轴云台、云台支架，云台用于接收飞行姿态的速度信息，并根据无人机解算的运动方向信息驱动云台水平方向与垂直方向的360度转动，还能对雷达平台实现无人机姿态误差补偿，使得云台搭载的雷达的天线照射方向始终保持运动方向一致，雷达的多目标检测算法可实时探测运动方向正前方的目标。无人机以任何方向飞行时都可以准确探测往其靠近的目标，实现了前后左右全方位的目标避障。配备宽波束天线的毫米波雷达斜侧装的特殊安装方式可实时探测前后左右方和下方的目标，这样就能兼备垂直向下探测的定高雷达功能。同时，雷达有着高性能处理芯片加持，并植入了先进的雷达信号处理算法，融合实现定高和避障两种算法功能，获得了十分良好的三维点云效果和测距测高精度。
[0004]本专利技术公开的搭载云台的斜侧装无人机毫米波雷达避障和定高方法，所述雷达为45度斜侧安装，即雷达天线照射方向与水平方向夹角45度斜向下探测地面，方法包括以下步骤：步骤一：雷达原始数据预处理，获得合通道的一维距离向数据和距离多普勒数据；步骤二：雷达高精度解角算法处理后输出三维目标点云数据，每个点云数据包括坐标和速度信息；步骤三：对全区域点云进行分割操作，负45度预设范围内的点云作为避障处理区域，获到避障源点云簇U，正45度预设范围内的点云作为定高处理区域，获得定高源点云簇K；步骤四：避障模块信号处理，在避障处理区域内检测跟踪三维点云数据，如果满足连续数帧点云与其速度匹配，则形成避障距离航迹并发送给无人机控制系统，否则清除航
迹；得到了有避障距离航迹和无避障距离航迹两种状态；步骤五：在定高源点云簇K中选取点云中的最近点，以最近点划聚类半径后形成一个新的目标点云簇Q，并且求取质心，计算得到目标质心到雷达的距离，即当前无人机定高数据；步骤六：对步骤四和步骤五数据结果进行融合处理，将定高和避障的结果按时间序列排列形成观测数据，观测数据中的定高数据决定着无人机正下方的高度值，避障数据决定着无人机前后左右方向的距离值；根据无人机实时姿态和坐标信息定位出前后左右下五个方向目标，与无人机控制系统双向通信，实现定高和避障两种功能。
[0005]进一步的，在步骤四中，为了避免虚假目标形成航迹，在形成航迹前会去筛选目标点云数据，在无避障距离航迹状态时距离分段设置多个门限值去限制进入检测跟踪的条件。
[0006]进一步的，在步骤四中，形成避障距离航迹后有一定目标丢失的概率，为了确保其一直维持稳定跟踪目标，对已有避障距离航迹状态时进行航迹维持处理，即根据当前避障距离航迹R值，关联到当前帧雷达一维距离向数据R值所在的一定区域内是否有满足一个低门限20dB的峰值，如果符合关联条件，将航迹维持并且附加额外的3秒延时；不满足关联条件且延时时间内也关联失败，将航迹清除。
[0007]进一步的，无人机控制系统得到避障距离后会有刹车制动操作，刹车制动系数S(t)的模型满足：其中，t为避障距离持续的时间；v(i)为无人机当前时刻速度；R(i)为航迹的避障距离；N为避障响应时间；λ为无人机刹车制动因子。
[0008]进一步的，当前无人机定高数据如下：进一步的，当前无人机定高数据如下：其中，Q为以定高源点云簇K中与雷达距离最近点划取聚类半径后形成一个新的目标点云簇，H为雷达输出的无人机定高数据，n为最近点聚类半径内的点云数量；q1为最近点聚类半径内第一个点云目标坐标；q
n
为最近点聚类半径内最后一个点云目标坐标；q
j
(r)为聚类后当前遍历中点云对应的雷达到目标距离；q1(r)为聚类后第一个遍历点云对应的雷达到目标距离；q
n
(r)为聚类后最后一个遍历中点云对应的雷达到目标距离。
[0009]本专利技术的有益效果如下：搭载云台的斜侧装无人机毫米波雷达，可防止雷达平台跟着无人机姿态倾斜，实时保持雷达波束照射方向与飞行方向一致，实现单个雷达360度全向探测功能。
[0010]毫米波雷达的宽波束天线设计和斜侧装方式，可兼备定高和避障两种雷达功能。
[0011]本专利技术系统流程结构简单，运算速度快，可得到很好的稳定性和收敛性。
附图说明
[0012]图1本专利技术的无人机系统结构图；图2本专利技术的斜侧装雷达工作示意图；图3本专利技术的雷达信号处理流程图；图4本专利技术的数据融合处理流程图。
具体实施方式
[0013]下面结合附图对本专利技术作进一步的说明，但不以任何方式对本专利技术加以限制，基于本专利技术教导所作的任何变换或替换，均属于本专利技术的保护范围。
[0014]本专利技术应用于无人机，参考图1，无人机包括以下系统：1) 无人机控制系统：无人机完成躲避障碍、仿地飞行、执行任务和返场回收等一系列飞行过程的核心系统；2) 自稳系统：包括三轴云台装置和全球定位系统GPS。云台可满足雷达平台的三个活动自由度，绕X、Y、Z轴旋转，每个轴心内都有电机，当无人机倾斜时，同样会配合无人机控制系统给相应的云台电机加强反方向的动力，防止雷达平台跟着无人机姿态倾斜。根据无人机飞行姿态信息控制云台水平方向，实时保持雷达波束照射方向与飞行方向一致；3) 被控单元：包括方向舵、升降舵和油门。无人机控制系统通过油门，方向舵和升降舵控制机翼的状态。从而使机身发生倾斜和升降，来改变飞机的姿态和速度；4) 雷达系统：多发多收毫米波雷达信号处理系统，由宽波束天线给目标连续发送毫米波电磁波，然后接收从物体返回的反射电磁波，通过信号处理模块来得到目标点云信息，最后经算法处理后可向无人机系统传输存储测距和测高数据。多发多收毫米波雷达为45度斜侧安装。
[0015]参考图3，本专利技术的雷达避障和定高方法步骤如下：步骤一：雷达为多发多收机制，雷达天线接收到多个来自不同天线通道的一维距离向数据（以3发4收天线为例，会形成12个通道数据），雷达数据预处理，首先进行45度斜侧装雷达原始数据预处理，获得合通道的一维距离向数据和距离多普勒数本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.搭载云台的斜侧装无人机毫米波雷达避障和定高方法，其特征在于，所述雷达为45度斜侧安装，即雷达天线照射方向与水平方向夹角45度斜向下探测地面，方法包括以下步骤：步骤一：雷达原始数据预处理，获得合通道的一维距离向数据和距离多普勒数据；步骤二：雷达高精度解角算法处理后输出三维目标点云数据，每个点云数据包括坐标和速度信息；步骤三：对全区域点云进行分割操作，负45度预设范围内的点云作为避障处理区域，获到避障源点云簇U，正45度预设范围内的点云作为定高处理区域，获得定高源点云簇K；步骤四：避障模块信号处理，在避障处理区域内检测跟踪三维点云数据，如果满足连续数帧点云与其速度匹配，则形成避障距离航迹并发送给无人机控制系统，否则清除航迹；得到了有避障距离航迹和无避障距离航迹两种状态；步骤五：在定高源点云簇K中选取点云中的最近点，以最近点划聚类半径后形成一个新的目标点云簇Q，并且求取质心，计算得到目标质心到雷达的距离，即当前无人机定高数据；步骤六：对步骤四和步骤五数据结果进行融合处理，将定高和避障的结果按时间序列排列形成观测数据，观测数据中的定高数据决定着无人机正下方的高度值，避障数据决定着无人机前后左右方向的距离值；根据无人机实时姿态和坐标信息定位出前后左右下五个方向目标，与无人机控制系统双向通信，实现定高和避障两种功能。2.根据权利要求1所述的搭载云台的斜侧装无人机毫米波雷达避障和定高方法，其特征在于，在步骤四中，为了避免虚假目标形成航迹，在形成航迹前会去筛选目标点云数据，在无避障距离航迹状态时距离分段设置多个门限值去限制进入检测跟...

【专利技术属性】
技术研发人员：杨博，
申请(专利权)人：长沙莫之比智能科技有限公司，
类型：发明
国别省市：