面向真实无人机的双模飞行控制切换系统及其控制方法与流程
本发明涉及无人机飞行控制,尤其涉及面向真实无人机的双模飞行控制切换系统及其控制方法。
背景技术:
1、无人机地面站是连接操作人员与无人机的重要交互枢纽,广泛应用于低空观光运营、基础设施巡检及飞行训练仿真等场景。现有无人机地面站系统通常同时提供自动航线飞行与手动遥控两种操作方式。在自动航线模式下,系统按预规划航线控制无人机飞行,座椅随动单元依据航线预测姿态进行跟踪;在手动遥控模式下,操作人员通过操纵杆输入控制指令,以人工方式实时控制无人机姿态与速度。
2、然而,现有无人机地面站系统在模式切换与管理方面存在明显不足。多数系统仅以简单的切换开关在自动与手动模式之间跳转,缺乏权限分级、条件校验与过渡平滑处理,切换瞬间座椅姿态速率突变,导致体验者产生眩晕感,甚至引发安全事故。在商用低空观光场景下,游客、安全员、管理员共用同一操纵杆或界面,缺乏三级权限隔离,存在误操作导致无人机偏离航线或侵入禁飞区的隐患。现有电子围栏功能多为软提示,未与座椅运动控制、操纵杆使能形成硬联锁,越界后座椅仍继续剧烈运动,增加乘客恐慌风险。此外,现有显示屏仅显示简单仪表信息,未将航线轨迹、下一航点、剩余电量、气象信息、围栏状态等叠加于同一画面,操作员需要频繁切换界面,认知负荷较高。最后,现有方案未提供结构化的巡检任务工单与训练评分机制,难以支撑商业化运营。
技术实现思路
1、(一)要解决的技术问题
2、鉴于现有技术的上述缺点、不足,本发明提供面向真实无人机的双模飞行控制切换系统及其控制方法,其解决了上述的技术问题。
3、(二)技术方案
4、本发明的目的是提供面向真实无人机的双模飞行控制切换系统及其控制方法,其包括无人机单元、地面处理单元、操纵杆控制单元、座椅单元、权限管理模块、模式切换握手模块、座椅过渡控制器以及电子围栏与返航联锁模块;
5、所述无人机单元配置为在外场飞行并输出机载视频流与飞行姿态遥测;
6、所述地面处理单元与所述无人机单元通信连接,配置为接收所述机载视频流与飞行姿态遥测,并生成视景输出信号与平台驱动指令;
7、所述座椅单元与所述地面处理单元电连接,配置为接收所述平台驱动指令并执行座椅运动;
8、所述操纵杆控制单元与所述地面处理单元电连接,配置为供体验者输入飞行控制指令;
9、所述权限管理模块配置为将系统用户分为至少三级:管理员级、安全员级和体验者级,其中体验者级的操纵杆使能在未被授权时处于空挡锁定状态;
10、所述模式切换握手模块配置为:接收操纵杆接管请求,校验当前是否满足空域围栏条件、最低安全高度条件、剩余电量条件与风速条件;若全部校验通过且经安全员批准,则将无人机飞行控制权由自动航线模式迁移至人工操纵杆模式;
11、所述座椅过渡控制器配置为在模式切换窗口内对所述座椅单元的目标角速度施加收敛过渡,使所述座椅单元角速度从第一值平滑过渡至第二值;
12、所述电子围栏与返航联锁模块配置为:当检测到无人机越过围栏边界或电量和/或风况不满足安全阈值时,强制执行模式回退至自动保护模式,向所述座椅单元下发平台回中与运动禁止指令,并锁定操纵杆使能信号。
13、具体地,所述座椅过渡控制器采用一阶低通滤波算法对座椅目标角速度施加收敛过渡,所述一阶低通滤波算法按照如下递推公式计算座椅当前角速度:
14、,
15、其中,为控制周期,为时间常数,所述收敛过渡使切换期间座椅角加速度不超过500°/s²。
16、具体地,所述电子围栏定义为多边形区域,所述电子围栏与返航联锁模块在每个控制周期内将无人机gps坐标转换为局部enu坐标,并使用射线法判断无人机是否位于所述电子围栏内;当无人机距围栏边界小于10m时触发黄色预警,越过边界时触发红色告警并执行强制返航、座椅回中与操纵杆锁定。
17、具体地,所述模式切换握手模块的校验条件包括:无人机当前gps坐标在电子围栏内且距边界不小于10m、高度不小于最低安全高度30m、剩余电量不小于返航所需电量加20%冗余、当前风速不大于12m/s;任一条件不满足则拒绝接管请求并返回对应错误码。
18、具体地,还包括hud合成模块,配置为将航线轨迹层、高度、速度、气象信息、围栏状态叠加于所述机载视频流画面上,形成hud图层输出至本地显示屏与vr眼镜。
19、具体地,还包括巡检任务执行模块,配置为按航点列表自动执行悬停拍照、红外测温或激光测距动作,并将执行结果附带时间戳与gps坐标存入数据库并上传云端服务器存证。
20、具体地,还包括飞行训练评分模块,配置为记录体验者操控期间的飞行数据,按稳定度、越界次数与航点命中率生成综合评分报告;
21、稳定度得分(滚转角积分惩罚,单位°·s)
22、越界得分=100-越界次数×20(每次越界扣20分)
23、航点命中率=命中航点数/ 总航点数×100%
24、综合得分=稳定度得分×0.4+越界得分×0.3+航点命中率×0.3。
25、具体地,所述无人机单元输出的机载视频流经图传链路回传且端到端时延小于20ms,所述飞行姿态遥测以20hz刷新率经数传链路回传。
26、另一方面,本技术还提供了一种面向真实无人机的双模飞行控制切换方法,包括以下步骤:
27、步骤s1,接收体验者的操纵杆接管请求,获取请求包,所述请求包包括请求者标识、目标模式与时间戳;
28、步骤s2,读取无人机当前状态,执行围栏检查、高度检查、电量检查与风速检查;其中,围栏检查包括判断无人机当前gps坐标是否位于电子围栏内且距边界不小于10m,高度检查包括判断高度是否不小于最低安全高度30m,电量检查包括判断剩余电量是否不小于返航所需电量加20%冗余,风速检查包括判断当前风速是否不大于12m/s;
29、步骤s3,若全部检查通过,向安全员控制台发送确认对话框;若任一检查失败,拒绝请求并返回错误码;
30、步骤s4,接收安全员批准指令,将无人机飞行控制权由自动航线模式迁移至人工操纵杆模式;
31、步骤s5,在模式切换窗口内,对座椅目标角速度施加一阶低通滤波收敛过渡,使座椅角加速度不超过500°/s²;
32、步骤s6,在操控期间持续监测围栏、电量与风况;当触发返航条件时,强制切换至自动保护模式,执行座椅回中、操纵杆锁定与hud告警。
33、具体地,步骤s5中,所述一阶低通滤波按照如下公式计算座椅角速度:
34、,
35、其中,为控制周期为10ms,为时间常数且取值为切换窗口时长的三分之一,切换窗口时长为0.5s至2s之间。
36、(三)有益效果
37、本发明具有以下有益效果:
38、由于模式切换握手模块在控制权迁移前执行围栏、高度、电量与风速四项校验,并经安全员批准后执行控制权迁移,避免了不满足安全条件的工况下进入人工操控,因此双模切换过程具备安全性与可审计性。
39、由于座椅过渡控制器在模式切换窗口内对座椅目标角速度施加一阶低通滤波收敛过渡,使座椅角速度从当前值连续过渡至目标值,消除了切换瞬间的阶跃倾斜,因此切换期间座椅角加速度不超过500°/s²,有效降低了体验者的眩晕风险。
40、由于电子围栏与返航联锁模块以硬联锁方式在越界或电量/风况异常时强制回退至自动保护模式,并同步执行座椅回中、平台运动禁止与操纵杆使能锁定,因此即使发生误操作也不会导致无人机越界或座椅失控。
41、进一步的,由于hud合成模块将航线轨迹层、高度、速度、气象信息与围栏状态叠加于实景视频画面,减少了操作员的界面切换频次,因此降低了操作员的认知负荷,提高了运营效率。
42、进一步的,由于设置了巡检任务执行模块与飞行训练评分模块,可自动执行航点动作并将结果附带时间戳与gps坐标存证,同时自动生成量化评分报告,因此提高了巡检与训练场景的适配性和可回溯性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com