一种用于仿生偏振光导航的姿态无约束优化求解方法技术

本发明专利技术涉及一种用于仿生偏振光导航的姿态无约束优化求解方法，属于仿生导航姿态解算技术领域。包括如下步骤：采集加速度计与偏振光传感器测量数据，经姿态坐标转换结合瑞利散射模型构建姿态误差函数；采集陀螺仪测量数据，由实时四元数微分构建动态步长因子，预测姿态四元数变化趋势；设计共轭参数修正姿态迭代寻优过程中的负梯度方向，以保证前后搜索方向相互共轭，提高收敛速度，获得最优四元数完成姿态解算。本发明专利技术采用姿态误差函数建模的方法，修正了陀螺仪的测量偏差，可以消除偏振光传感器测角的模糊性，实现三维空间全姿态角解算；设计动态步长因子预测四元数更新趋势，以提高复杂运动状态下的姿态解算性能，保障了偏振光辅助航姿参考系统的可靠性与准确性。

【技术实现步骤摘要】
一种用于仿生偏振光导航的姿态无约束优化求解方法
本专利技术属于仿生导航姿态解算
，涉及一种用于仿生偏振光导航的姿态无约束优化求解方法，特别是涉及一种采用动态步长因子的共轭梯度优化姿态求解方法。
技术介绍
导航技术是信息化社会和武器装备信息化的重要支撑之一。航姿参考系统(AHRS，AttitudeandHeadingReferenceSystem)可以为导航提供稳定的姿态参数信息。目前，航姿参考系统一般采用低成本的MEMS惯性测量单元作为姿态解算的主要部件。惯性测量单元由陀螺仪和加速度计组成，两者进行姿态数据融合可以修正陀螺仪的水平姿态角漂移。为修正航向误差，一般在惯性测量单元的基础上，引入磁强计或GPS作进一步融合。磁强计也叫地磁传感器，通过测量地磁场强度和方向获得载体方位信息，但机体振动或控制电路产生的电磁场会降低其测量精度，信息化战争中电磁权是双方争夺的首要制高点，其工作环境无法得到安全保障。GPS卫星导航作为非自主导航方式之一，卫星信号易受人为干扰甚至导航卫星存在被摧毁的可能，不适用于某些特殊场合。针对磁强计和GPS存在的显著缺点，国内外学者在寻找和利用全新的导航方法方面做了大量研究。偏振光导航是近几年兴起的新型导航方式，其原理是通过大气偏振光在天空中的偏振分布模式进行航向测量，具有完全自主、误差不随时间累积、稳定性好的优势。现阶段偏振光导航方法主要有两种：一是利用偏振光传感器进行自主定位；二是基于卡尔曼滤波与惯性测量单元进行数据融合，由测量所得的偏振方位角修正姿态误差。利用偏振光传感器进行自主定位由于其精度较低所以并不适合实际应用。基于卡尔曼滤波的姿态数据融合由于每次迭代过程中计算量大，实时性难以保证，同时偏振光传感器测量误差受多种因素影响，无法准确获得噪声模型，因此很多还停留在仿真阶段。
技术实现思路
针对现有技术的不足之处，本专利技术提出一种用于仿生偏振光导航的姿态无约束优化求解方案。为克服一般梯度下降法收敛速度慢的缺点，本专利技术设计共轭参数保证姿态迭代寻优过程中前后搜索方向相互共轭；由实时四元数微分构建动态步长因子预测姿态更新趋势，使搜索方向具有目的性，提高姿态求解效率，避免了一般梯度优化方法中步长需要求二阶导数带来的计算复杂性。最后，以无约束梯度优化理论为基础，构建融合陀螺仪、加速度计、偏振光传感器的共轭梯度优化模型，实现偏振光辅助定姿的三维全姿态角求解，保证了偏振光辅助导航系统的精度与可靠性。本专利技术的技术方案如下：一种用于仿生偏振光导航的姿态无约束优化求解方法，具体步骤如下：步骤一：采集陀螺仪在载体坐标系下的测量值、加速度计在载体坐标系下的测量值、偏振光传感器在测量坐标系下的测量值，陀螺仪测量值设为ωb＝[ωxωyωz]T，加速度计测量值设为ab＝[axayaz]T，偏振光传感器测量值设为pm＝[pxpypz]T；其中，下标b表示载体坐标系；下标m表示偏振光传感器测量坐标系；下标x,y,z表示测量值在三轴的投影分量；步骤二：假定导航坐标系三轴x-y-z对应北东地三个方向，载体坐标系三轴x-y-z对应载体前右下三个方向，太阳坐标系三轴x-y-z对应西南天三个方向，偏振光传感器测量坐标系三轴x-y-z对应载体前左上三个方向；将重力矢量在导航坐标系下的投影[00g]T由变换矩阵变换到载体坐标系，计算出理论重力矢量，设为将太阳位置矢量在太阳坐标系下的投影[cos(hs)sin(As)cos(hs)cos(As)sin(hs)]T由变换矩阵变换到导航坐标系，再由变换矩阵变换到载体坐标系，最后由变换矩阵变换到偏振光传感器测量坐标系，根据瑞利散射模型计算出理论偏振矢量，设为其中g表示重力加速度的大小；hs和As分别表示太阳高度角和太阳方位角，可通过查询天文历表获得；表示太阳坐标系到导航坐标系的变换矩阵；表示导航坐标系到载体坐标系的变换矩阵；表示载体坐标系到偏振光传感器测量坐标系的变换矩阵；上标*表示重力矢量和偏振矢量分别在载体坐标系和偏振光传感器测量坐标系下的理论测量值；下标x,y,z表示理论测量值在三轴的投影分量；步骤三：计算重力矢量误差函数，设为eg；计算偏振矢量误差函数，设为ep；对重力矢量误差函数求导获得雅可比矩阵，设为Jg；对偏振矢量误差函数求导获得雅可比矩阵，设为Jp；将偏振矢量误差函数与重力矢量误差函数及其雅可比矩阵组合成综合目标误差函数与综合雅可比矩阵，分别设为e＝[egep]T、J＝[JgJp]T；其中q＝[q0q1q2q3]为姿态角的四元数表示；ax、ay、az和px、py、pz分别为步骤一所测量得到的加速度计和偏振光传感器输出值；和分别为步骤二所计算得到的理论重力矢量和理论偏振矢量；步骤四：根据无约束优化方法中的梯度优化理论，由式(8)计算综合目标误差函数梯度gk；由式(9)计算初始迭代的搜索方向d0；由式(10)计算第k次迭代的搜索方向dk，其中，k≠0，βk为保证前后搜索方向相互共轭的参数，式(11)给出βk的计算公式；式(12)给出步长λk的计算公式；其中，下标k表示四元数姿态求解过程中的第k次迭代；gk＝JTe(8)d0＝-g0(9)dk＝-gk+βkdk-1(k≠0)(10)步骤五：为根据载体运动状态实时调整步长大小，由式(13)求解陀螺仪四元数微分方程，并由式(14)构建动态步长因子αk，预测四元数更新趋势；在已知第k次迭代的姿态四元数q(k)后，根据迭代公式(15)更新得到下一时刻的姿态四元数q(k+1)；其中，表示陀螺仪四元数微分；ωx、ωy、ωz为步骤一测量得到的三轴角速度值；Δt表示姿态更新周期；步骤六：利用步骤五迭代得到的姿态四元数，由式(16)换算出当前载体的横滚角γ、俯仰角θ和航向角ψ；步骤七：重复步骤一至步骤六，实现偏振光辅助航姿参考系统测量定姿。本专利技术的有益效果：(1)相比基于卡尔曼滤波的偏振光辅助定姿方法，本专利技术不需要建立噪声估计模型，减少了迭代过程中的计算量，提高了导航求解的实时性，降低了对硬件处理能力的要求，适用于低成本的航姿参考系统。(2)本专利技术使用天空偏振光作为导航信息来源，可以避免使用磁力计所带来的电磁场干扰，在GPS卫星信号丢失的情况下仍能进行正常导航，具有完全自主、稳定性高的优势。(3)本专利技术所提出的共轭梯度优化方法以梯度优化理论为基础，通过建立姿态误差函数去修正陀螺仪漂移，避免偏振光矢量作为双向矢量所导致的角度求解模糊性问题，能够将偏振光传感器用于三维空间全姿态角解算。(4)本专利技术引入共轭参数保证前后搜索方向相互共轭，克服了梯度下降法收敛速度慢的缺点，减小了角度突变时的滞后现象，提高了姿态角获取的效率。引入四元数微分构建动态步长因子，可以实时预测姿态变化趋势，提高动态环境下的姿态求解精度与稳定性。附图说明图1是本专利技术的数据融合过程原理图；图2是本本文档来自技高网...

【技术保护点】
1.一种用于仿生偏振光导航的姿态无约束优化求解方法，其特征在于，具体步骤如下：/n步骤一：采集陀螺仪在载体坐标系下的测量值、加速度计在载体坐标系下的测量值、偏振光传感器在测量坐标系下的测量值，陀螺仪测量值设为ω

【技术特征摘要】
1.一种用于仿生偏振光导航的姿态无约束优化求解方法，其特征在于，具体步骤如下：
步骤一：采集陀螺仪在载体坐标系下的测量值、加速度计在载体坐标系下的测量值、偏振光传感器在测量坐标系下的测量值，陀螺仪测量值设为ωb＝[ωxωyωz]T，加速度计测量值设为ab＝[axayaz]T，偏振光传感器测量值设为pm＝[pxpypz]T；其中，下标b表示载体坐标系；下标m表示偏振光传感器测量坐标系；下标x,y,z表示测量值在三轴的投影分量；
步骤二：假定导航坐标系三轴x-y-z对应北东地三个方向，载体坐标系三轴x-y-z对应载体前右下三个方向，太阳坐标系三轴x-y-z对应西南天三个方向，偏振光传感器测量坐标系三轴x-y-z对应载体前左上三个方向；将重力矢量在导航坐标系下的投影[00g]T由变换矩阵变换到载体坐标系，计算出理论重力矢量，设为将太阳位置矢量在太阳坐标系下的投影[cos(hs)sin(As)cos(hs)cos(As)sin(hs)]T由变换矩阵变换到导航坐标系，再由变换矩阵变换到载体坐标系，最后由变换矩阵变换到偏振光传感器测量坐标系，根据瑞利散射模型计算出理论偏振矢量，设为其中g表示重力加速度的大小；hs和As分别表示太阳高度角和太阳方位角，通过查询天文历表获得；表示太阳坐标系到导航坐标系的变换矩阵；表示导航坐标系到载体坐标系的变换矩阵；表示载体坐标系到偏振光传感器测量坐标系的变换矩阵；上标*表示重力矢量和偏振矢量分别在载体坐标系和偏振光传感器测量坐标系下的理论测量值；下标x,y,z表示理论测量值在三轴的投影分量；









步骤三：计算重力矢量误差函数，设为eg；计算偏振矢量误差函数，设为ep；对重力矢量误差函数求导获得雅可比矩阵，设为Jg；对偏振矢量误差函数求...

【专利技术属性】
技术研发人员：金仁成，蔚彦昭，魏巍，洪金辉，褚金奎，
申请(专利权)人：大连理工大学，
类型：发明
国别省市：辽宁;21