基于RID双向收发的无人机空域感知防撞系统及方法与流程

摘要: 本发明属于民用无人机低空飞行安全与无人机远程识别监管,具体为基于rid双向收发的无人机空域感知防撞系统及方法。背景技术:1、随着低空经济快速发展,物流无人机、巡...
基于RID双向收发的无人机空域感知防撞系统及方法与流程

本发明属于民用无人机低空飞行安全与无人机远程识别监管,具体为基于rid双向收发的无人机空域感知防撞系统及方法。

背景技术:

1、随着低空经济快速发展,物流无人机、巡检无人机、植保无人机及电动垂直起降飞行器在低空空域的飞行密度显著增加,机间协同防撞已成为保障低空飞行安全的核心技术需求。

2、国家强制标准gb46750《民用无人驾驶航空器远程识别规范》强制要求在售无人机搭载单向rid发射设备,通过wifi vendor-ie周期性向地面监管设备广播本机身份、位置、速度等飞行报文。然而,现有商用rid设备仅具备发射功能,无机载同频接收能力,rid广播信道仅用于地面监管,空域机间无法互通飞行数据,导致法定广播信道资源闲置。

3、在无人机防撞技术方面,现有技术主要存在以下两类方案:

4、第一类为主动探测方案,采用激光雷达、毫米波雷达或视觉传感器实现单机自主避障。该类方案受限于传感器物理特性,探测距离有限,在超视距场景下无法提供有效预警,临近避让余量极小。

5、第二类为地面集中式管控方案。例如,专利文献cn115755973a公开了一种无人机低空域交通决策方法,其通过tdoa监测站点、无人机rid监管系统及无人机飞行管理系统组成地面监测网络,获取目标空域内无人机的飞行路径规划数据及当前飞行状态信息,由地面端判断正常飞行无人机与异常飞行无人机,并基于飞行路径规划数据确定碰撞风险信息及碰撞风险无人机,进而调整碰撞风险无人机的路径规划数据。上述技术方案中,碰撞风险信息的确定及路径规划数据的调整均依赖地面端执行,无人机机载端不具备独立的空域态势感知与协同防撞能力。当无人机处于地面通信覆盖盲区、通信链路受干扰或地面端系统故障时,机载端无法获取邻机飞行数据,亦无法自主计算碰撞风险及执行避让策略,存在飞行安全隐患。此外,上述方案中rid信息仅用于地面监管系统对无人机的身份识别与状态监控,无人机机载端不具备rid接收能力,无法通过rid信道实现机间直接通信。

6、此外,在单机独立自主避障场景中,由于多机之间缺乏信息交互,易出现两机同向避让、相向越躲越近及避让失效相撞等问题。

7、因此,现有技术亟需一种不依赖地面端、完全基于机载自主实现、能够复用现有国标rid法定信道、支持超视距邻机态势感知与分布式协同避让的无人机空域感知防撞技术方案。

8、基于此,设计基于rid双向收发的无人机空域感知防撞系统及方法。

技术实现思路

1、针对上述情况,为克服现有技术的缺陷,本发明提供基于rid双向收发的无人机空域感知防撞系统及方法,有效的解决了上述背景提出的问题。

2、为实现上述目的,本发明提供如下技术方案:基于rid双向收发的无人机空域感知防撞系统,包括:

3、国标rid广播发报单元,用于遵循gb46750远程识别规范,周期性封装并通过wifivendor-ie无线广播包含本机身份、wgs-84经纬度、海拔高度、地速、航向角、升降速率及机身安全半径的合规rid报文,无人机飞行全程发射不可关闭;

4、同频rid广播接收单元,与所述国标rid广播发报单元共用国标法定射频信道,通过软件定义方式分时切换收发状态,实时侦听空域内周边无人机rid广播报文,内置三重报文校验算法过滤非法伪造假rid报文,解析有效邻机飞行数据并送入机载主控解算单元;

5、机载主控解算单元,接入本机卫星定位与惯性导航数据、所述同频rid广播接收单元解析的邻机数据,构建动态空域态势库,对本机与邻机进行航迹外推预测,采用空间球体交会算法计算机间最小会遇距离并量化碰撞风险等级,当碰撞风险高于预设阈值时,通过rid报文vendor-ie预留私有字段向冲突邻机发送协商指令;

6、飞控对接执行单元,通过串口或can总线对接无人机原生飞控,接收所述机载主控解算单元下发的避让指令,将航线修改或飞行姿态修改指令转换为高度控制、航向横滚、油门调速信号,驱动动力与舵面完成机动避让;

7、其中,所述系统不依赖地面端监测网络或设备介入,不依赖地面端进行碰撞与规避算法计算。

8、优选的,所述同频rid广播接收单元与所述国标rid广播发报单元共用单路wifi射频前端,以固定周期往复切换发射时隙与接收时隙,发射时隙完成本机rid报文广播,接收时隙关闭本机发射并切换射频前端至监听模式,扫描空域wifi信号并捕获合规rid帧。

9、优选的,所述三重报文校验算法包括oui标识校验、帧长度校验及广播周期校验,仅当三项校验均通过时,将邻机全量飞行参数存入所述动态空域态势库。

10、优选的,所述机载主控解算单元包括:

11、本机导航数据融合模块,用于通过卡尔曼滤波算法融合北斗或gps卫星定位数据与imu惯性测量单元数据,输出本机统一wgs-84坐标系下的实时位置、速度及姿态信息;

12、空域态势数据库模块,用于以动态链表结构存储本机rid数据源及邻机rid解析数据,按时间戳升序排列并设置数据有效期自动淘汰机制,对超出有效期的邻机数据执行删除;

13、碰撞概率解算模块,用于基于所述本机导航数据融合模块输出的本机航迹及所述空域态势数据库模块输出的邻机航迹,进行三维航迹线性外推,结合本机与邻机的安全球体半径,通过空间球体交会算法计算两机最小会遇距离,并依据预设预警阈值与危险碰撞阈值划分无风险、一级预警、高碰撞风险三个等级;

14、避让协商交互子模块,用于在所述碰撞概率解算模块输出高碰撞风险等级时,通过rid报文vendor-ie预留字段向冲突邻机发送包含避让策略类型、避让方向及避让幅度的协商指令,并接收冲突邻机反馈的确认报文,在连续两个广播周期内收到有效确认后锁定避让方案。

15、优选的,所述避让协商交互子模块执行的分布式协商避让策略包括:

16、纵向分层避让策略,冲突双机协商确定一机爬升、一机下降,依靠垂直空域错开实现避撞;

17、同侧侧向偏航避让策略,冲突双机统一向各自航向左侧或统一向各自航向右侧偏转航向,水平横向错开航线;

18、速率调速避让策略,冲突双机协商确定一机减速、一机保速,错开时空交会点。

19、优选的,所述避让协商交互子模块在冲突对向飞机不具备协商能力或无法建立有效通信时,触发单机自主避让策略;

20、所述单机自主避让策略包括:

21、降速悬停并通知地面站人工接管干预;

22、单机纵向分层避让,单机抬升或下降高度以垂直空域错开;

23、单侧侧向偏航避让,向自航向左侧或右侧偏转航向以规避相撞;

24、速率调速避让,自身航速增减以错开或延缓时空交会点。

25、一种基于rid双向收发的无人机空域感知防撞方法,应用于上述任一项所述的系统,包括以下步骤:

26、步骤一:上电自检初始化,系统上电后国标rid广播发报单元依据国标要求正常工作,同频rid广播接收单元锁定国标信道,机载主控解算单元录入机型安全参数并建立本机安全防撞球体模型;

27、步骤二:本机周期合规rid广播,国标rid广播发报单元按国标周期封装合规报文,通过wifi vendor-ie无线向外广播本机飞行全量信息;

28、步骤三:邻机rid报文侦听与过滤,同频rid广播接收单元实时捕获空中广播,通过三重校验剔除虚假报文,解析邻机身份、位置、速度、机身尺寸关键参数,存入动态空域态势库;

29、步骤四:航迹外推与碰撞概率计算,机载主控解算单元对本机及各邻机进行短时航迹预测,采用空间球体交会算法计算两机最小会遇距离,设置预警阈值与危险碰撞阈值,将计算得到的最小会遇距离与两级阈值比较,划分无风险、一级预警、高碰撞风险三个等级;

30、步骤五:避让策略执行,当最小会遇距离小于或等于危险碰撞阈值时,触发高碰撞风险响应,机载主控解算单元通过rid报文vendor-ie预留字段向冲突邻机发送协商指令,执行分布式协商避让或单机自主避让,并将最终避让指令下发至飞控对接执行单元,实时执行机动;

31、步骤六:循环刷新与航迹回归,避让完成后重新测计算机间距离,当最小会遇距离大于危险碰撞阈值且持续稳定超过预设回归确认周期后,无人机通过航迹回归算法恢复至预设航线,系统循环执行步骤二至步骤六。

32、优选的,所述步骤四中的空间球体交会算法包括:

33、将本机与邻机分别抽象为以各自实时位置为球心、以各自安全防撞球体模型半径为半径的空间球体;

34、基于本机与邻机的当前位置、速度矢量及航向角,建立三维航迹线性外推方程,预测未来预设时间窗口内的本机航迹点集与邻机航迹点集;

35、遍历计算两航迹点集之间的欧氏距离,提取最小值作为最小会遇距离;

36、当最小会遇距离大于预警阈值时,判定为无风险等级,持续监测;

37、当最小会遇距离小于或等于预警阈值且大于危险碰撞阈值时,判定为一级预警等级,持续刷新航迹并缩短预测时间窗口;

38、当最小会遇距离小于或等于危险碰撞阈值时,判定为高碰撞风险等级,触发步骤五的避让策略执行。

39、优选的,所述步骤五中的分布式协商避让包括:

40、冲突双机通过rid广播报文vendor-ie预留字段交互各自避让意图报文,所述避让意图报文包含本机标识、建议避让策略类型、避让方向及避让幅度;

41、双机各自依据机型优先级规则、任务优先级规则及当前飞行状态计算本机避让优先级,优先级低的一方主动执行避让,优先级高的一方保持原航迹或配合微调;

42、双机在连续两个rid广播周期内收到对方发送的确认报文后,锁定避让方案并同步执行;

43、避让执行过程中,双机通过rid广播实时上报各自实时位置及避让执行状态,直至最小会遇距离大于危险碰撞阈值。

44、优选的,所述步骤二与步骤三通过分时复用机制在同一射频前端上交替执行,每个固定周期内前段时隙为发射时隙,由国标rid广播发报单元完成rid报文封装与广播,后段时隙为接收时隙,由同频rid广播接收单元完成邻机rid报文捕获、校验与解析,接收时隙获取的邻机数据在下一轮发射时隙通过vendor-ie预留字段发送避让协商指令。

45、与现有技术相比,本发明的有益效果是:

46、1、本发明通过在不修改国标rid报文格式、不新增无线电频段、不取消原有国标发射功能的前提下,在原有rid发射模块基础上集成同频rid接收单元,复用国标wifivendor-ie信道实现机载双向rid通信,使法定广播信道同时兼顾对地监管上报与机间防撞通信功能,现有合规rid硬件仅通过固件升级即可实现双向通信能力,无需更换射频前端,兼容性与合规性优异;

47、2、本发明采用无中心分布式协商避让架构,依托现有rid广播信道实现跨机指令交互,无需地面基站、无需自建通信组网,无人机上电开机后自动完成空域组网感知,各机平等自主决策,从根本上避免了强依赖地面端模式在通信中断或地面故障时的系统性失效风险;

48、3、本发明通过机载主控解算单元融合本机导航数据与邻机rid数据,在机载端独立完成航迹外推、碰撞概率解算及避让决策,无需地面端监测网络或设备介入,无需地面端进行碰撞与规避算法计算,实现了无人机纯机载自主的超视距空域态势感知与协同防撞;

49、4、本发明采用分级标准化避让策略,单机自主避让与多机分布式协同避让模式相兼容,纵向分层、侧向偏航、速率调速三级避让规则从算法层面规避双机避让策略冲突,解决了传统单机盲避中因信息不对称导致的同向避让、相向越躲越近及避让失效相撞问题,显著提升了密集空域多机协同飞行的安全性。