[发明专利]利用自然光偏振模式确定大气层内飞行器空间姿态的方法有效
申请号: | 201410143392.7 | 申请日: | 2014-04-11 |
公开(公告)号: | CN103913167A | 公开(公告)日: | 2014-07-09 |
发明(设计)人: | 刘俊;唐军;任建斌;石云波;李杰;张晓明;王飞;张楠 | 申请(专利权)人: | 中北大学 |
主分类号: | G01C21/02 | 分类号: | G01C21/02 |
代理公司: | 太原科卫专利事务所(普通合伙) 14100 | 代理人: | 朱源 |
地址: | 030051*** | 国省代码: | 山西;14 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 利用 自然光 偏振 模式 确定 大气层 飞行器 空间 姿态 方法 | ||
1.一种利用自然光偏振模式确定大气层内飞行器空间姿态的方法,其特征在于:包括如下步骤:
(1)、建立体坐标系,以飞行器的质心为原点Ob,Xb轴位于飞行器对称面内、平行于机身轴线,向前为正;Yb轴垂直于飞行器对称面,向右为正;Zb轴位于飞行器对称平面内,向下为正;
建立参考坐标系,原点Oα位于地面上某一点,Xα轴指向正北方向,Yα轴指向正东方向,Zα轴铅直向下;以XαOαYα平面为参考水平面;
将仿生复眼球面传感器阵列安装在飞行器的质心处,即原点Ob;
(2)、确定偏航角ψ
将原点Ob和Oα重合后,利用仿生复眼球面传感器阵列实时采集各个方向上的太阳光E-矢量信息与偏振度信息,并确定检测到水平方向的E-矢量的小眼阵列及其在球面上的几何位置,那么检测到水平方向的E-矢量的小眼阵列在参考水平面上的投影,即太阳子午线在参考水平面上的投影CD;同时仿生复眼球面传感器阵列测量确定CD与Xb纵轴在参考水平面上的投影Xb′的夹角
此时,由太阳历理论计算得出在参考水平面上CD与Xα轴的夹角
偏航角ψ由公式(1)确定:
(3)、确定太阳位置
参考坐标系下,太阳位置Sa=(xa ya za)T,由太阳历理论确定;
体坐标系下,太阳位置Sb=(xb yb zb)T,由仿生复眼球面传感器阵列检测到的偏振信息确定,即寻找满足下列三个条件的点:a)光强最大;b)偏振度为零;c)E-矢量方向水平;
(4)、确定俯仰角θ和滚转角γ
俯仰角θ由公式(2)确定:
滚转角γ由公式(3)确定:
其中中间变量u由公式(4)确定:
u=xcsinθ-yccosθ……………………………………(4)
参数xc、yc和zc由公式(5)确定:
即解算出偏航角ψ、俯仰角θ和滚转角γ,完成飞行器在空间的三维姿态确定。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中北大学,未经中北大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201410143392.7/1.html,转载请声明来源钻瓜专利网。