一种高原型高载重无人机飞行控制系统的制作方法
本发明涉及高原重载无人机自动控制及飞行状态调节,具体为一种高原型高载重无人机飞行控制系统。
背景技术:
1、高原型高载重无人机主要在低气压、低空气密度和载荷接近推进能力上限的环境中执行物资吊运、设备转运及垂直起降任务,飞行控制对象包括空间位置、垂向高度、机体姿态、角速度以及各旋翼输出。现有飞控通常采集惯性测量、磁航向、气压高度和卫星定位数据,在控制周期内对传感数据进行时序同步和振动噪声滤除,通过状态融合获得位置、速度、姿态与角速度,再采用位置环、姿态环和角速度环构成的串级控制结构处理航迹指令,其中位置环将位置偏差转换为期望速度及加速度,姿态环依据期望合推力方向生成姿态指令,角速度环根据姿态响应计算滚转、俯仰和偏航力矩,混控器依据旋翼布局关系将总推力与三轴力矩换算为各电机控制量,由电子调速器驱动旋翼形成升力和姿态控制力矩。
2、与高原重载工况最接近的现有方案通常在飞行前通过台架试验和悬停试验建立旋翼转速、控制指令、空气状态与输出推力之间的标定关系,并按照机体质量和装载质量确定悬停推力基准,再为不同载荷区间及气压高度区间保存相应的推力曲线和串级控制增益,起飞前还依据装载记录选择对应的载荷档位并写入飞行控制器。飞行过程中,飞控器根据气压与温度换算空气密度,利用空气密度修正悬停输出及总推力指令,同时根据电池母线电压对电机控制量进行供能补偿;经补偿的总推力与三轴力矩进入固定旋翼布局矩阵,形成各旋翼输出指令,输出端按照电机允许范围实施限幅,角速度控制环依据限幅状态执行积分回退,位置与高度控制环继续根据融合位置、融合速度及航迹目标生成后续控制需求。
3、上述控制方式依赖预先标定的推力映射和离散工况对应关系表示无人机的推进能力,而高原飞行中的空气密度变化、重载状态、母线电压下降、旋翼转速跟随偏差及姿态倾斜会在同一控制周期内共同改变可实现总推力和三轴力矩边界,预设映射难以根据实际飞行响应同步更新边界。位置与姿态控制仍按照标定推力关系生成合推力需求,旋翼输出受限时仅在控制分配末端被截断,未被执行的合推力与姿态力矩也未沿串级关系返回航迹指令转换过程,导致外环持续输出超出当前推进能力的指令,位置误差和高度误差进入积分状态后进一步维持高输出,由此形成控制需求增加、旋翼饱和、实际升力不足和误差继续累积的闭环状态,其集中表现为无法依据实时推力实现能力约束高原重载无人机的串级飞行控制。
技术实现思路
1、本发明的目的在于提供一种高原型高载重无人机飞行控制系统,可以解决上述背景技术中的问题。
2、为实现上述目的,本发明采取的技术方案为:
3、一种高原型高载重无人机飞行控制系统,包括飞行响应处理器以及与所述飞行响应处理器连接的串级飞行控制器;
4、所述飞行响应处理器将推进指令对应的理论合推力与经姿态补偿的实际合推力响应进行时序关联,形成推力实现残差,并依据所述推力实现残差生成当前可用总推力及三轴力矩边界;
5、所述串级飞行控制器在边界内将航迹指令转换为合推力指令和姿态指令,依据所述推力实现残差修正旋翼控制分配结果,并将所述旋翼控制分配结果中的未实现控制量反馈至航迹指令转换过程。
6、优选的,所述飞行响应处理器将气压和温度形成的大气状态引入旋翼转速与推力的对应关系,按照各旋翼的推进指令生成理论分推力,并依据旋翼空间位置合成理论合推力;
7、将惯性测量获得的机体加速度按照姿态变换至导航坐标系,分离重力分量并结合机体基准质量与装载质量形成所述实际合推力响应;
8、将所述理论合推力、所述实际合推力响应和推进指令变化时刻对齐,按照推进指令变化前后的响应差形成推力实现残差序列。
9、优选的,所述飞行响应处理器将所述推力实现残差序列与依据角速度变化及载荷分布对应惯量关系形成的三轴力矩残差组合为控制实现残差向量,并通过旋翼布局关系将控制实现残差向量约束反投影至各旋翼控制通道;
10、将反投影结果中沿相同方向变化的残差汇聚为共模衰减量,将围绕通道均值反向变化且与相应旋翼转速跟随偏差一致的残差汇聚为差模衰减量,并分别形成整机推力效能状态和三轴力矩效能状态。
11、优选的,所述飞行响应处理器将所述整机推力效能状态、所述三轴力矩效能状态及各旋翼剩余输出范围映射至总推力与三轴力矩坐标空间,形成随控制周期更新的可用控制域;
12、所述串级飞行控制器将航迹指令对应的垂向支撑需求和姿态倾斜引起的升力分解关系投影至所述可用控制域,并根据投影结果形成受约束的合推力指令和姿态指令,再将所述合推力指令和所述姿态指令转换为位于各旋翼剩余输出范围内的旋翼控制量。
13、优选的,所述飞行响应处理器依据旋翼转速变化和电调电流变化之间的同步区段建立推进电能至旋翼机械响应的状态关系,并将电池母线电压变化映射为状态关系的供能修正量;
14、依据气压与温度确定的空气状态对所述旋翼机械响应进行密度折算,形成各旋翼的理论分推力;
15、在所述推进指令保持而所述旋翼转速发生持续偏离时,冻结所述空气状态对所述理论分推力的更新,并将对应偏离写入所述推力实现残差序列。
16、优选的,所述飞行响应处理器按照所述旋翼布局关系建立由各旋翼控制通道指向总推力和三轴力矩的控制效能矩阵,将所述控制实现残差向量与各旋翼转速跟随偏差共同输入带有输出范围约束的反投影运算,获得通道残差组合;
17、对所述通道残差组合实施同向分量提取和零和分量提取,并利用姿态角加速度方向对所述零和分量进行轴向归属,形成与总推力通道分离的滚转、俯仰及偏航力矩效能状态。
18、优选的,所述飞行响应处理器从所述可用控制域中提取满足当前载荷垂向支撑需求的控制量截面,将所述控制量截面沿航迹期望加速度方向投影,形成垂向升力占用量与水平机动占用量关联的指令可达区域;
19、所述串级飞行控制器将超出所述指令可达区域的航迹指令沿区域边界回缩,并依据回缩后的水平加速度方向重构姿态指令,将合推力方向设定为与回缩后的航迹指令对应的方向。
20、优选的,所述串级飞行控制器依据所述可用控制域依次锁定总推力分量、由滚转与俯仰构成的横向姿态分量以及偏航分量,将所述合推力指令及所述姿态指令组成期望控制向量,并在各旋翼剩余输出范围内求取与所述期望控制向量对应的旋翼控制量;
21、将所述旋翼控制量回代至控制效能矩阵形成可实现控制向量,以所述期望控制向量与所述可实现控制向量之差形成未实现控制量,并按照控制通道归属写入所述串级飞行控制器的反馈端。
22、优选的,所述飞行响应处理器将总推力指令变化时刻和旋翼转速合量变化时刻写入气压观测序列,形成推进变化标记区段;
23、在所述推进变化标记区段内,将气压高度变化与惯性垂向响应及卫星定位垂向速度进行方向一致性比较,将仅与推进变化同步而未获得运动学响应支持的气压变化分离为旋翼诱导压力分量;
24、利用所述旋翼诱导压力分量修正所述气压观测序列,并以修正后的气压观测序列形成所述实际合推力响应的高度约束。
25、优选的,所述串级飞行控制器将未实现控制量按照所述合推力方向和姿态力矩方向分解,将所述合推力方向的未实现控制量沿航迹指令转换关系反投影至垂向加速度分量和水平加速度分量,将所述姿态力矩方向的未实现控制量按照姿态指令转换关系反投影至滚转、俯仰和偏航分量;
26、依据相邻控制周期的可用控制域边界位移比例对各反投影分量连续插值,并将插值后的反投影分量分别写入位置控制、姿态控制和角速度控制的积分状态更新端。
27、与现有技术相比,本发明的有益效果在于:
28、1.通过将推进指令对应的理论合推力与姿态补偿后的实际合推力响应进行时序关联,可形成随飞行状态更新的推力实现残差,并由推力实现残差生成当前可用总推力及三轴力矩边界;串级飞行控制过程将航迹指令对应的垂向支撑需求和姿态倾斜产生的升力分解关系投影至边界,把超出指令可达区域的爬升需求和水平机动需求沿边界回缩,再在各旋翼剩余输出范围内完成控制分配。理论指令与实际响应之间的偏离因而直接转化为控制边界变化,控制边界变化继续约束位置环和姿态环的后续指令,未实现控制量同时返回相应积分状态更新端,形成响应辨识、边界更新、指令整形、输出分配和未实现量反馈的闭合链路,减少旋翼持续饱和、积分累积、垂向高度下沉及姿态往复振荡,并保持飞行指令与当前推进能力相符。
29、2.推力实现残差经旋翼布局关系反投影后分离为共模衰减量和差模衰减量,共模衰减量对应整机总推力效能变化,差模衰减量按照姿态角加速度方向归属至滚转、俯仰和偏航通道,使空气密度、供能状态共同造成的整体推力下降与单个旋翼跟随偏差造成的力矩不均能够进入不同控制边界。总推力指令变化时刻与旋翼转速合量变化时刻被写入气压观测序列后,气压高度变化可与惯性垂向响应及卫星定位垂向速度进行一致性比较,旋翼诱导压力分量从高度观测中分离并用于修正实际合推力响应;控制分配形成的未实现控制量再按合推力方向和姿态力矩方向反投影至位置、姿态及角速度积分状态,使传感观测偏差、通道输出不均和分配截断分别进入对应处理路径,降低气压扰动引起的虚假升降、旋翼不对称引起的轴间耦合以及控制域变化引起的指令跳变。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com