[发明专利]飞行器及其姿态控制模型参数辨识方法、装置及存储介质

说明书

本发明提供一种飞行器及其姿态控制模型参数辨识方法、装置及存储介质，创新性地引入遗传算法对特征模型的参数进行辨识，对于飞行器俯仰、滚转、偏航三个姿态角通道分别建立特征模型，分别输入遗传算法辨识过程，达到精度要求指标后输出所需的辨识参数估计结果，可用于控制器设计；可实现在线循环运算，但不再需要进行反复的矩阵运算，因此降低了对硬件算力的要求，提高了参数辨识效率；与传统算法不同，遗传算法同时考虑多个搜索结果，以目标函数作为搜索信息，更加有效，可以避免局部最优解，因此也提高了参数辨识精度；此外，遗传算法对目标函数的限制最小，其并行计算能力提高了它的运行速度。

技术领域

本发明涉及飞行姿态控制技术领域，尤其涉及飞行器及其姿态控制模型参数辨识方法、装置及存储介质。

背景技术

飞行器的姿态控制研究十分必要，由姿态控制保证快速、精度和鲁棒性。大部分算法都需要依赖于飞行器的精准数学模型，且相关参数的选取没有成熟的规律可循，参数的改变对控制效果的影响比较敏感，存在局限性。

对于模型的建立以及后续控制器设计，需对特征参数进行在线辨识。常见辨识方法有如最小二乘法、梯度投影法等，在线反复输入姿态状态量循环计算，最终在达到参数要求范围且平稳固定后得到特征模型参数。

传统的参数辨识算法如最小二乘法、梯度算法是非循环单次算法，将数据进行离线辨识处理，而特征建模过程中与变化状态量相关的辨识，无法获取参数随时间变化情况，因此不能应用于飞行器姿态参数控制建模。

为了适用于飞行器姿态参数控制建模，目前对传统参数辨识算法进行了改进，例如目前常见特征模型参数辨识方法包括递推最小二乘法在线辨识、含有遗忘因子的递推最小二乘法在线辨识等。

递推最小二乘辨识：新的参数估计值＝旧的参数估计值+修正项。根据时间顺序，在飞行器运行过程中随每一次的状态量改变进行估计，并随着时间的推进修正数值。

含有遗忘因子的递推最小二乘辨识：当辨识过程中，因旧数据被新数据替代，为适应时变系统参数变化，在递推最小二乘辨识算法的基础上加入遗忘因子，以降低较前时刻数据的权重，提升新数据的相关度，不断减小旧数据的参考作用。

但该改进的特征模型参数辨识算法，仍然存在如下问题：

因为在选择参数辨识方法时需要考虑两个因素：辨识精度和参数辨识所需的时间。而飞行器的姿态控制需要较强的实时性，而特征参数辨识在控制过程中是重要的一环，应尽可能提升辨识速度。但目前常见特征参数辨识方法如递推最小二乘需要较长迭代次数，且每一轮计算估计过程较为复杂，参数收敛速度较慢。

其二，所辨识特征模型的特征参数对于被控对象的反映不够准确，或者说可能得到的特征模型与对象动态模型的响应输出误差相对较大。

其三，最小二乘算法中涉及矩阵运算，其中矩阵P(k)运算量较大，对于实际无人机采用的主流ARM架构芯片计算能力是一种挑战。且飞控系统其他并行过程较多，占用过多算力可能会影响实时控制效果。

其四，带有遗忘因子的递推最小二乘选取合适的遗忘因子较为困难。遗忘因子λ较大时，辨识结果遗忘慢，随辨识数据增多，算法丧失参数估计能力；遗忘因子λ较小时，对己得到的辨识结果遗忘快，随辨识数据增多，辨识结果中的各个元素趋向于无穷，会造成待辨识参数大范围的波动甚至辨识结果发散。

发明内容

本发明提供的飞行器及其姿态控制模型参数辨识方法、装置及存储介质，主要解决的技术问题是：如何提高飞行器姿态控制模型参数辨识精度和效率。

为解决上述技术问题，本发明提供一种飞行器姿态控制模型参数辨识方法，包括：

S10、针对飞行器俯仰、滚转和偏航三个姿态角通道分别建立如下特征模型：