一种基于多执行机构的飞行器的姿态控制分配方法组成比例

本发明专利技术公开一种基于多执行机构的飞行器的姿态控制分配方法，包括：S1、建立飞行器的姿态运动学方程；S2、通过姿态转换矩阵确定飞行器的姿态角；S3、建立飞行器的姿态动力学方程；S4、根据控制律计算飞行器的期望控制力矩；S5、利用控制分配算法获得当前时刻飞行器的各执行机构的状态组合。本发明专利技术适合飞行器大角度姿态快速机动与高精度稳定的机动任务需求。

【技术实现步骤摘要】
一种基于多执行机构的飞行器的姿态控制分配方法
本专利技术涉及飞行器智能控制领域。更具体地，涉及一种基于多执行机构的飞行器的姿态控制分配方法。
技术介绍
基于多执行机构的飞行器是一种在智能材料、智能自适应非线性控制分配技术、微推进系统的基础上，发挥各自的优势，组合在一起的多用途、多功能的新型片状材料组合体式飞行器。该飞行器具有可变蒙皮，具备变轨机动性能大幅提升，实现最佳气动性能，提高可重复使用能力，可重构能力大幅提升等优点。该型飞行器需要在姿态机动、高精度稳定等控制模式之间快速切换.快速机动为攻击敌方目标、规避敌方攻击争取更多的时间，而机动后的快速高精度稳定则是为了保证飞行平稳性，使其在高精度飞行中提高可重复使用能力。因此大角度姿态快速机动与高精度稳定成为基于多执行机构飞行器的关键技术之一。执行机构的选择决定飞行器控制系统的机动能力，选择不同的执行机构也对系统的机动性能起决定作用。针对上述复杂任务，单一的执行机构已无法满足需求，多个执行机构联合控制方式能够发挥各个机构组合的长处，实现优势互补，以最小代价实现控制目标。因此，需要提供一种基于多执行机构的飞行器的姿态控制分配方法。
技术实现思路
本专利技术的目的在于提供一种基于多执行机构的飞行器的姿态控制分配方法，解决传统姿态控制分配方法假设条件理想化的问题。为达到上述目的，本专利技术采用下述技术方案：一种基于多执行机构的飞行器的姿态控制分配方法，该方法包括如下步骤：S1、建立飞行器的姿态运动学方程；S2、通过姿态转换矩阵确定飞行器的姿态角；S3、建立飞行器的姿态动力学方程；S4、根据控制律计算飞行器的期望控制力矩；S5、利用控制分配算法获得当前时刻飞行器的各执行机构的状态组合。优选地，步骤S1中飞行器的姿态运动学方程为：其中，q0、q1、q2和q3为当前时刻飞行器姿态的四元数；和为当前时刻飞行器姿态的四元数导数；wx为飞行器绕X轴转动角速度；wy为飞行器绕Y轴转动角速度；wz为飞行器绕Z轴转动角速度。优选地，步骤S2中姿态转换矩阵为：优选地，步骤S3中飞行器的姿态动力学方程为：其中，Ix为飞行器绕X轴转动惯量；Iy为飞行器绕Y轴转动惯量；Iz为飞行器绕Z轴转动惯量；dwx为飞行器绕X轴转动角速度的导数；dwy为飞行器绕Y轴转动角速度的导数；dwz为飞行器绕Z轴转动角速度的导数；Tx为作用于飞行器上的所有外力对质心之力矩在X轴上的分量；Ty为作用于飞行器上的所有外力对质心之力矩在Y轴上的分量；Tz为作用于飞行器上的所有外力对质心之力矩在Z轴上的分量。优选地，步骤S4进一步包括如下子步骤：S4.1、计算当前时刻飞行器姿态的四元数微分：dq0＝qc0×q0+qc1×q1+qc2×q2+qc3×q3dq1＝-qc1×q0+qc1×q1+qc2×q2+qc3×q3dq2＝-qc3×q1-qc4×q2+qc2×q2+qc3×q3dq3＝-qc3×q0+qc2×q1-qc1×q2+qc0×q3其中，dq0、dq1、dq2和dq3为当前时刻飞行器姿态的四元数微分；qc0、qc1、qc2和qc3为飞行器期望姿态的四元数；S4.2、计算飞行器的期望控制力矩的非线性补偿项TR：TR＝J×dwc+w×J×w其中，w为飞行器当前姿态角速度；dwc为飞行器期望角加速度；J为飞行器的转动惯量矩阵，S4.3、计算飞行器的期望控制力矩的比例项Tp：其中，Kp为比例系数矩阵；S4.4、计算飞行器的期望控制力矩的微分项Td：Td＝-Kd×J×(w-wc)其中，wc为飞行器期望角速度；S4.5、计算飞行器的期望控制力矩的误差补偿项Te：其中，ww为误差补偿项归一化系数，Kep为第一误差补偿比较项系数，Ked为第二误差补偿比较项系数；S4.6、计算飞行器的期望控制力矩Tc：Tc＝TR+Tp+Te+Td。优选地，步骤S5进一步包括如下子步骤：S5.1、确定控制指令所在的象限；S5.2、根据控制指令的方向选择执行机构组合；S5.3、确定执行机构组合中各执行机构的可能状态；S5.4、计算执行机构组合中各执行机构的可能状态对应的力矩；S5.5、比较得出执行机构组合中各执行机构的可能状态对应的力矩之和与期望控制力矩之间误差最小值对应的各执行机构的状态组合，作为当前时刻飞行器的各执行机构的状态组合。本专利技术的有益效果如下：本专利技术所述技术方案在执行机构存在冗余的条件下，可以实现某一优化准则或约束下的优化分配，提高系统对执行机构故障的容错能力，为冗余异构执行机构情况下的姿态快速机动与高精度稳定控制问题提供了一条可行的解决途径。具体的，本专利技术所述技术方案在建立执行机构控制方案基础上，提出了一种基于MEMS微执行机构的姿态控制方法，建立了姿态运动学和动力学方程，通过制定控制分配方案给出各个微执行机构的状态，即确定动态分配控制策略，仿真中设置三种典型仿真场景，从仿真结果中可以看出，当前的姿态角和姿态角速度与期望的姿态角和姿态角速度误差在0.5度范围之内，满足误差要求，并且开关机次数满足该飞行器执行任务的需要，实现了最大机动角速度以及目标函数约束下的最优机动.该方案适合飞行器大角度姿态快速机动与高精度稳定的机动任务需求。附图说明下面结合附图对本专利技术的具体实施方式作进一步详细的说明。图1示出基于多执行机构的飞行器的姿态控制分配方法的流程图。图2示出飞行器的当前姿态角和期望控制角度图。图3示出飞行器的当前姿态角速度和期望控制姿态角速度图。图4示出飞行器的3s后的姿态跟踪误差图。图5示出飞行器的期望控制力矩图。图6示出飞行器的实际输出力矩图。图7示出飞行器的期望控制力矩示意图。图8示出飞行器的微执行机构开关曲线图。具体实施方式为了更清楚地说明本专利技术，下面结合优选实施例和附图对本专利技术做进一步的说明。附图中相似的部件以相同的附图标记进行表示。本领域技术人员应当理解，下面所具体描述的内容是说明性的而非限制性的，不应以此限制本专利技术的保护范围。如图1所示，本实施例提供的基于多执行机构的飞行器(以下简称飞行器)的姿态控制分配方法，包括如下步骤：S1、建立飞行器的姿态运动学方程；S2、通过姿态转换矩阵确定飞行器的姿态角；S3、建立飞行器的姿态动力学方程；S4、根据控制律计算飞行器的期望控制力矩；S5、利用控制分配算法获得当前时刻飞行器的各执行机构的状态组合。其中，步骤S1中飞行器的姿态运动学方程为：其中，q0、q1、q2和q3为当前时刻飞行器姿态(惯性坐标系到弹体坐标系)的四元数；和为当前时刻飞行器姿态的四元数导数；wx为飞行器绕(惯性坐标系)X轴转动角速度；wy为飞行器绕Y轴转动角速度；wz为飞行器绕Z轴转动角速度。步骤S2的具体过程为：按照Z-Y-X顺序旋转惯性坐标系，将飞行器的姿态四元数转换为飞行器的欧拉角。姿态转换矩阵为：步骤S3中飞行器的姿态动力学方程为：其中，Ix为飞行器绕X轴转动惯量；Iy为飞行器绕Y轴转动惯量；Iz为飞行器绕Z轴转动惯量；dwx为飞行器绕X轴转动角速度的导数；dwy为飞行器绕Y轴转动角速度的导数；dwz为飞行器绕Z轴转动角速度的导数；Tx为作用于飞行器上的所有外力(包括空气动力和推力)对质心之力矩在(弹体坐标系)X轴上的分量；Ty为作用于飞行器上的所有外力(包括空气动力和推力)对质心之力矩在Y轴上的分量；Tz为作本文档来自技高网...

【技术保护点】
一种基于多执行机构的飞行器的姿态控制分配方法，其特征在于，该方法包括如下步骤：S1、建立飞行器的姿态运动学方程；S2、通过姿态转换矩阵确定飞行器的姿态角；S3、建立飞行器的姿态动力学方程；S4、根据控制律计算飞行器的期望控制力矩；S5、利用控制分配算法获得当前时刻飞行器的各执行机构的状态组合。

【技术特征摘要】
1.一种基于多执行机构的飞行器的姿态控制分配方法，其特征在于，该方法包括如下步骤：S1、建立飞行器的姿态运动学方程；S2、通过姿态转换矩阵确定飞行器的姿态角；S3、建立飞行器的姿态动力学方程；S4、根据控制律计算飞行器的期望控制力矩；S5、利用控制分配算法获得当前时刻飞行器的各执行机构的状态组合。2.根据权利要求1所述的方法，其特征在于，步骤S1中飞行器的姿态运动学方程为：其中，q0、q1、q2和q3为当前时刻飞行器姿态的四元数；和为当前时刻飞行器姿态的四元数导数；wx为飞行器绕X轴转动角速度；wy为飞行器绕Y轴转动角速度；wz为飞行器绕Z轴转动角速度。3.根据权利要求2所述的方法，其特征在于，步骤S2中姿态转换矩阵为：4.根据权利要求2所述的方法，其特征在于，步骤S3中飞行器的姿态动力学方程为：其中，Ix为飞行器绕X轴转动惯量；Iy为飞行器绕Y轴转动惯量；Iz为飞行器绕Z轴转动惯量；dwx为飞行器绕X轴转动角速度的导数；dwy为飞行器绕Y轴转动角速度的导数；dwz为飞行器绕Z轴转...

【专利技术属性】
技术研发人员：秦雷，吴限德，李君龙，谢晓瑛，张锐，
申请(专利权)人：北京电子工程总体研究所，
类型：发明
国别省市：北京,11