一种仿复眼偏振传感器多方向标定方法技术

本发明专利技术提出一种仿复眼偏振传感器多方向标定方法，包括步骤：获取不同方向观测点的偏振角信息；利用载体所在的地理位置信息以及时间信息计算出地理坐标系下单位太阳矢量；结合高精度导航模块提供的姿态转换矩阵，天顶偏振传感器提供的偏振矢量，由观测点确定观测矢量，建立仿复眼偏振传感器坐标系与载体系的安装误差量测方程，并估计出两者之间的安装误差；利用加速度计获取重力信息，计算仿复眼偏振传感器坐标系下的太阳矢量信息；利用地理系下的太阳矢量与重力矢量的夹角作为量测，建立不同方向偏振传感器模块坐标系与仿复眼偏振传感器坐标系的安装误差量测方程，估计出不同方向偏振传感器的模块坐标系与仿复眼偏振传感器坐标系的安装误差。

A method of multi direction calibration for polarization sensor imitating compound eye

【技术实现步骤摘要】
一种仿复眼偏振传感器多方向标定方法
本专利技术涉及一种仿复眼偏振传感器多方向标定方法，用于估计仿复眼偏振传感器与高精度导航模块以及仿复眼偏振传感器中不同方向偏振传感器与天顶偏振传感器的位置安装误差，提高传感器的定姿、定位精度。
技术介绍
自然界的生物具备高超的感知和获取空间运动信息的能力，经过研究发现生物可以通过感知天空偏振光分布，获取空间运动信息。因此，研究生物的导航机制，提出了偏振光导航的方法，由于偏振光导航具有自主性、抗干扰性以及环境适应性等优点，近几年受到国内外广泛的关注，而偏振传感器作为感知仪器，是信息获取的源头，导航的眼睛。因此，偏振传感器的研制成为仿生偏振导航系统的前端核心部分。近几年，生物复眼的导航原理及结构成为研究热点，论文“多方向偏振光实时定位样机的设计与搭建”设计了5个方向的仿复眼偏振传感器，但是并未对仿复眼偏振传感器中不同方向偏振传感器间的位置关系进行标定和补偿。专利“一种基于扩展卡尔曼滤波的仿生偏振传感器多源误差标定方法”(申请号:201810129372.2)，“一种基于无迹卡尔曼滤波的仿生偏振传感器多源误差标定方法”(申请号:201810129371.8)，分析了单个传感器的误差标定及补偿方法，同样未涉及仿复眼偏振传感器中不同角度偏振传感器间的位置标定和补偿。随着对导航精度要求的提高，对仿复眼偏振传感器标定的准确性、全面性要求也提高，特别是对仿复眼偏振传感器中不同角度偏振传感器间位置关系的标定和补偿的研究还有待研究。
技术实现思路
为了解决上述问题，克服现有技术的不足，本专利技术提出一种仿复眼偏振传感器多方向标定方法，结合重力信息、天空偏振信息、太阳矢量信息、观测矢量信息、高精度导航模块，所述高精度是指姿态精度0.1°，航向精度0.1°,估计仿复眼偏振传感器与高精度导航模块以及仿复眼偏振传感器中不同方向偏振传感器与天顶偏振传感器的位置安装误差，提高传感器的定姿、定位精度。本专利技术的技术解决方案为：一种仿复眼偏振传感器多方向标定方法，实现步骤如下：步骤(1)、载体上安装有仿复眼偏振传感器，通过天文年历获取地理坐标系下的单位太阳矢量Sn，利用仿复眼偏振传感器的天顶偏振传感器测量天空相应点的单位偏振矢量结合地理系下的太阳矢量信息，仿复眼偏振传感器坐标系下的观测矢量信息、偏振矢量信息，高精度导航模块提供的姿态转换矩阵信息，建立仿复眼偏振传感器坐标系与载体系，即高精度导航模块所在的坐标系的安装误差状态模型与量测模型，安装误差表示为φ1，为三维安装误差角，上标为数字1；步骤(2)估计仿复眼偏振传感器坐标系与载体系的位置安装误差φ1，最后得到两者间的位置安装矩阵；步骤(3)利用仿复眼偏振传感器中不同方向偏振传感器测量的偏振矢量其中i＝2～9，并结合天顶偏振传感器测量的偏振矢量，计算仿复眼偏振传感器坐标系下的太阳矢量；步骤(4)根据载体系下的重力矢量，结合步骤(3)得到的仿复眼偏振传感器坐标系下的太阳矢量以及步骤(2)估计出的位置安装矩阵，并利用地理系与载体系两个不同坐标系下，太阳矢量与重力矢量夹角不变的原理，建立不同方向偏振传感器模块坐标系，即每个单独偏振传感器的坐标系与仿复眼偏振传感器坐标系的安装误差状态模型与量测模型，估计出不同方向偏振传感器的模块坐标系与仿复眼偏振传感器坐标系的位置安装误差φi，表示不同方向偏振传感器的模块坐标系与仿复眼偏振传感器坐标系的三维安装误差角，i＝2～9；步骤(5)，经过步骤(1)～(4)，完成仿复眼偏振传感器坐标系与载体系安装误差角以及不同方向偏振传感器的模块坐标系与仿复眼偏振传感器坐标系安装误差角的估计，即完成对仿复眼偏振传感器安装误差的标定。进一步的，所述步骤(1)中，载体上安装有仿复眼偏振传感器，通过天文年历获取地理坐标系下的单位太阳矢量Sn，利用仿复眼偏振传感器的天顶偏振传感器测量天空相应点的单位偏振矢量结合地理系下的太阳矢量信息，仿复眼偏振传感器坐标系下的观测矢量信息、偏振矢量信息，高精度导航模块提供的姿态转换矩阵信息，建立仿复眼偏振传感器坐标系与载体系的安装误差状态模型与量测模型，所述高精度导航模块的姿态精度0.1°，航向精度0.1°，安装误差表示为φ1，为三维安装误差角；仿复眼偏振传感器坐标系为m1系，天顶偏振传感器测得的偏振方位角为得到仿复眼偏振传感器坐标系m1系下的单位偏振矢量为：中的下标为数字1，与m1的下标均为数字1；选取仿复眼偏振传感器坐标系与载体坐标系的安装误差φ1为状态量，建立状态模型：量测模型：由于在同一坐标系下，偏振矢量垂直于太阳矢量与观测矢量，故：其中，为仿复眼偏振传感器坐标系与载体系之间已知的安装角度，为已知的安装矩阵，为待估计的安装误差角，M为待估计的安装误差矩阵，符号右上方的T表示转置；k1＝±1，由偏振传感器测得的初始偏振矢量确定，为观测矢量，由高精度导航模块提供，sn表示地理系下的太阳矢量，V1表示天顶偏振传感器测量噪声；根据上述模型便估计出仿复眼偏振传感器坐标系与载体系的安装误差进一步的，所述步骤(2)，估计仿复眼偏振传感器坐标系与载体系的位置安装误差φ1，最后得到两者间的位置安装矩阵：为已知的安装矩阵，M为待估计的安装误差矩阵。进一步的，所述步骤(3)，利用仿复眼偏振传感器中不同方向偏振传感器测量的偏振矢量并结合天顶偏振传感器测量的偏振矢量，计算仿复眼偏振传感器坐标系下的太阳矢量；不同安装方向的偏振传感器中，每个偏振传感器固连于1个传感器模块坐标系即m系，天顶偏振传感器坐标系，即仿复眼偏振传感器坐标系为m1系，除天顶外，其他方向偏振传感器坐标系为mi系，每个传感器模块坐标系mi系(i＝2～9)到仿复眼偏振传感器坐标系m1系的位置矩阵为表示为：其中，为不同方向偏振传感器与天顶偏振传感器间已知的安装角度，表示不同方向偏振传感器与天顶偏振传感器间等效旋转轴的方位角与高度角，表示绕等效旋转轴旋转的角度；为待估计的安装误差，代表等效旋转轴，表示等效旋转轴的第一个分量，表示等效旋转轴的第二个分量，表示等效旋转轴的第三个分量。第i个偏振传感器测量得到偏振方位角得到传感器模块坐标系mi下的单位偏振矢量为：进一步得到m1坐标系下第i个单位偏振矢量为：根据同一坐标系下太阳矢量与偏振矢量垂直的关系，得到m1系下的太阳矢量：进一步的，所述步骤(4)中，根据载体系下的重力矢量，结合步骤(3)得到的仿复眼偏振传感器坐标系下的太阳矢量以及步骤(2)估计出的位置安装矩阵，并利用地理系与载体系两个不同坐标系下，太阳矢量与重力矢量夹角不变的原理，建立不同方向偏振传感器模块坐标系，即每个单独偏振传感器的坐标系与仿复眼偏振传感器坐标系的安装误差状态模型与量测模型，估计出不同方向偏振传感器的模块坐标系与仿复眼偏振传感器坐标系的位置安装误差φi，表示不同方向偏振传感器的模块坐标系与仿复眼偏振传感器坐标系的三维安装误差角，i＝2本文档来自技高网...

【技术保护点】
1.一种仿复眼偏振传感器多方向标定方法，其特征在于，实现步骤如下：/n步骤(1)、载体上安装有仿复眼偏振传感器，通过天文年历获取地理坐标系下的单位太阳矢量S

【技术特征摘要】
1.一种仿复眼偏振传感器多方向标定方法，其特征在于，实现步骤如下：
步骤(1)、载体上安装有仿复眼偏振传感器，通过天文年历获取地理坐标系下的单位太阳矢量Sn，利用仿复眼偏振传感器的天顶偏振传感器测量天空相应点的单位偏振矢量结合地理系下的太阳矢量信息，仿复眼偏振传感器坐标系下的观测矢量信息、偏振矢量信息，高精度导航模块提供的姿态转换矩阵信息，建立仿复眼偏振传感器坐标系与载体系，即高精度导航模块所在的坐标系的安装误差状态模型与量测模型，安装误差表示为φ1，为三维安装误差角，上标为数字1；
步骤(2)估计仿复眼偏振传感器坐标系与载体系的位置安装误差φ1，最后得到两者间的位置安装矩阵；
步骤(3)利用仿复眼偏振传感器中不同方向偏振传感器测量的偏振矢量其中i＝2～9，并结合天顶偏振传感器测量的偏振矢量，计算仿复眼偏振传感器坐标系下的太阳矢量；
步骤(4)根据载体系下的重力矢量，结合步骤(3)得到的仿复眼偏振传感器坐标系下的太阳矢量以及步骤(2)估计出的位置安装矩阵，并利用地理系与载体系两个不同坐标系下，太阳矢量与重力矢量夹角不变的原理，建立不同方向偏振传感器模块坐标系，即每个单独偏振传感器的坐标系与仿复眼偏振传感器坐标系的安装误差状态模型与量测模型，估计出不同方向偏振传感器的模块坐标系与仿复眼偏振传感器坐标系的位置安装误差φi，表示不同方向偏振传感器的模块坐标系与仿复眼偏振传感器坐标系的三维安装误差角，i＝2～9；
步骤(5)、经过步骤(1)～(4)，完成仿复眼偏振传感器坐标系与载体系安装误差角以及不同方向偏振传感器的模块坐标系与仿复眼偏振传感器坐标系安装误差角的估计，即完成对仿复眼偏振传感器安装误差的标定。


2.根据权利要求1所述的一种仿复眼偏振传感器多方向标定方法，其特征在于：
所述步骤(1)中，载体上安装有仿复眼偏振传感器，通过天文年历获取地理坐标系下的单位太阳矢量Sn，利用仿复眼偏振传感器的天顶偏振传感器测量天空相应点的单位偏振矢量结合地理系下的太阳矢量信息，仿复眼偏振传感器坐标系下的观测矢量信息、偏振矢量信息，高精度导航模块提供的姿态转换矩阵信息，建立仿复眼偏振传感器坐标系与载体系的安装误差状态模型与量测模型，所述高精度导航模块的姿态精度0.1°，航向精度0.1°，安装误差表示为φ1，为三维安装误差角；仿复眼偏振传感器坐标系为m1系，天顶偏振传感器测得的偏振方位角为得到仿复眼偏振传感器坐标系m1系下的单位偏振矢量为：




中的下标为数字1，与m1的下标均为数字1；
选取仿复眼偏振传感器坐标系与载体坐标系的安装误差φ1为状态量，建立状态模型：



量测模型：由于在同一坐标系下，偏振矢量垂直于太阳矢量与观测矢量，故：



其中，







为仿复眼偏振传感器坐标系与载体系之间已知的安装角度，为已知的安装矩阵，为待估计的安装误差角，M为待估计的安装误差矩阵，符号右上方的T表示转置；k1＝±1，由偏振传感器测得的初始偏振矢量确定，为观测矢量，由高精度导航模块提供，sn表示地...

【专利技术属性】
技术研发人员：郭雷，刘鑫，杨健，王善澎，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：北京;11