本发明涉及的是一种姿态测量方法,具体地说是一种基于偏振光与地磁组合导航姿态测量方法。
背景技术:
目前,偏振光、地磁等天然基本物理场均携带方位信息。利用天然的地磁场进行导航的方法具有无源自主,抗干扰能力强,无长期误差积累的特点,但是常见的磁场测量工具受周围环境中磁场的影响较大,并且在地球两极地区地球磁场几乎垂直于地面,因此在很多情况采用此种方法并不可靠。利用大气自然偏振特性携带的方位信息进行导航的方法,有着无线电导航和卫星导航等非自主导航方式所无法具有的隐蔽性、抗干扰性和稳定性,并能够补充天文导航和地磁导航等常规自主导航方式的不足。
技术实现要素:
根据上述提出的技术问题,而提供一种基于偏振光与地磁组合导航姿态测量方法。本发明主要利用将地磁矢量测量与偏振光测量技术结合的方法。本发明采用的技术手段如下:
一种基于偏振光与地磁组合导航姿态测量方法,包括下述步骤:
s1:在载体上建立载体坐标系obxbybzb;
s2:测量所述载体所在处太阳在所述载体坐标系下的太阳方向矢量
载体坐标系下所述载体所在位置天空中任意两个观测点的偏振方向矢量分别为
s3:测量所述载体所在处磁场在所述载体坐标系下的磁场强度矢量
s4:根据所述载体所在位置和实时时间查询载体所在处太阳在地平坐标系下的太阳方向矢量
s5:利用载体坐标系和地平坐标系之间的姿态转换矩阵
s6:对步骤s5中的方程进行求解,得到所述载体在所述载体坐标系下的姿态角α,β,γ。
在所述在步骤s5中提供的矢量方程中可以建立四个独立的方程,但因只需要载体在所述载体坐标系下的姿态角α,β,γ三个未知量,方程是冗余的。为了使定姿的方法更加简单,步骤s3中磁场强度矢量
本发明具有以下优点:
本文提出将地磁矢量测量与偏振光测量技术结合的方法,不仅可以提供完整的姿态信息,而且在应用场合上与目前存在的航姿参考系统相比,具有不随时间积累发散的特点。
基于上述理由本发明可在导航领域广泛推广。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图做以简单地介绍,显而易见地,下面描述中的附图是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1是本发明具体实施方式中一种基于偏振光与地磁组合导航姿态测量方法流程图。
图2是本发明具体实施方式中载体上搭建的三棱柱示意图。
图3是本发明具体实施方式中从z1轴正方向向b面看去的示意图。
图4是本发明具体实施方式中是从z2轴正方向向c面看去的示意图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
如图1-图4所示,本实施例所提供的一种基于偏振光与地磁组合导航姿态测量方法中使用了设置在载体上的偏振光传感器ⅰ、偏振光传感器ⅱ、磁力计和定位系统,还使用了可以查询太阳矢量的太阳矢量查询模块和可以查询地磁矢量的地磁矢量查询模块,其中太阳矢量查询模块和地磁矢量查询模块可设置在上位计算机中。
一种基于偏振光与地磁组合导航姿态测量方法,包括下述步骤:
s1:在载体上搭建如图2所示三棱柱结构,且所述三棱柱的截面为等要直角三角形,三棱柱的三个侧面a、b、c分别代表:a面表示载体初始状态下的平面,b面和c面分别用以安装偏振光传感器ⅰ和偏振光传感器ⅱ,b、c面通过a面与载体固定连接,在a面建立载体坐标系obxbybzb(左手系),zb轴垂直于a面且正方向与a面的内法线方向一致;xb在a平面内,垂直于a面与b面的交线且xb轴正方向与b面的法线方向在a面上的正投影方向相同,yb轴在a面内,yb轴垂直于xb轴,且正方向由左手系确定;
s2:测量所述载体所在处太阳方向在所述载体坐标系下的太阳方向矢量
所述偏振光传感器ⅰ在b面建立局部坐标系o1x1y1z1(左手系),y1轴设置在所述b面内垂直于a面和b面的交线,且y1轴的正方向与xb轴在b面正投影的方向一致,z1轴垂直于b面且正方向与b面的外法线方向一致,x1轴在b面内,正方向由左手系确定;所述偏振光传感器ⅱ在c面建立局部坐标系o2x2y2z2(左手系),y2轴设置在所述c面内垂直于a面和c面的交线,且y2轴的正方向与xb轴在c面正投影的方向相反,z2轴垂直于c面且正方向与c面的外法线方向一致,x2轴在c面内,正方向由左手系确定;偏振光传感器ⅰ和偏振光传感器ⅱ的0°方向分别与所述y1轴和y2轴的正方向相一致。
所述载体所在处太阳在所述载体坐标系下的太阳方向矢量
使用偏振光传感器ⅰ测量所述载体所在位置所述偏振光传感器ⅰ所对应的观测点1的太阳散射光的偏振角度θ1(偏振光传感器ⅰ的0°方向与观测点1的最大偏振方向的夹角);
使用偏振光传感器ⅱ测量所述载体所在位置所述偏振光传感器ⅱ所对应的观测点2的太阳散射光的偏振角度θ2(偏振光传感器ⅱ的0°方向与观测点2的最大偏振方向的夹角);
如图3所示,偏振光传感器ⅰ可测得观测点1在所述局部坐标系o1x1y1z1中的偏振方向矢量
如图4所示,偏振光传感器ⅱ可测得观测点2在所述局部坐标系o2x2y2z2中的偏振方向矢量
通过局部坐标系o1x1y1z1与载体坐标系obxbybzb的坐标转换矩阵
通过局部坐标系o2x2y2z2与载体坐标系obxbybzb的坐标转换矩阵
s3:测量所述载体所在处磁场在所述载体坐标系下的磁场强度矢量
s4:根据所述载体所在位置和实时时间查询载体所在处太阳在地平坐标系下的太阳方向矢量
s5:利用载体坐标系和地平坐标系之间的姿态转换矩阵
α,β,γ为所述载体三维姿态角;
s6:对步骤s5中的方程进行求解,得到所述载体在所述载体坐标系下的姿态角α,β,γ。
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。