一种双折射太阳敏感器及其载体三轴姿态的测量方法与流程

文档序号:11100770阅读:来源:国知局

技术特征:

1.一种双折射太阳敏感器,包括:光线过滤模块、单轴晶体镜头、图像传感器和数据处理模块;其特征在于,所述光线过滤模块将光线进行集束,形成较细的入射光线;所述单轴晶体镜头将入射光线进行双折射,形成两条折射光线;所述图像传感器对两束折射光线进行成像;所述数据处理模块用于提取像点中心,并根据两条折射光线计算入射光线的矢量信息,由此计算出载体的三轴姿态信息。

2.根据权利要求1所述的双折射太阳敏感器,其特征在于,所述单轴晶体镜头的材质为方解石。

3.根据权利要求1或2所述的双折射太阳敏感器,其特征在于,所述光线过滤模块为在单轴晶体镜头的表面设置透光孔;所述透光孔置于单轴晶体镜头外表面的中心位置,所述透光孔的直径不大于0.1mm。

4.根据权利要求1或2所述的双折射太阳敏感器,其特征在于,所述光线过滤模块为在单轴晶体镜头上设置黑色原点;所述黑色原点置于单轴晶体镜头外表面的中心位置,所述黑色原点的直径不大于0.1mm。

5.根据权利要求1或2所述的双折射太阳敏感器,其特征在于,所述光线过滤模块为在单轴晶体镜头前设置凸透镜片;所述凸透镜片设置在单轴晶体镜头之前,其中心与单轴晶体镜头前表面的距离为所述凸透镜片的焦距。

6.一种载体三轴姿态的测量方法,通过在载体上安装权利要求1-5之一所述的双折射太阳敏感器实现,所述方法包括:

步骤1)所述光线过滤模块对太阳光线进行过滤;

步骤2)过滤后的入射光线通过单轴晶体镜头成为双折射光线:o光和e光;

步骤3)利用图像传感器对o光和e光所形成的光斑进行成像;

步骤4)提取o光和e光的光斑质心;

步骤5)利用两束折射光线计算入射光线的矢量信息;

步骤6)根据入射光线和两条折射光线计算载体的三维姿态信息。

7.根据权利要求6所述的载体三轴姿态的测量方法,其特征在于,所述步骤5)的具体实现过程为:

平面波在折射时满足n1·r=n2·r,r为分界面任意矢量,n1和n2为光线折射前后的介质折射率,波矢量仍然在入射平面内;

对于o光,波矢量方向与折射光线重合,即

θo=θ2=arcsin(n1sinθ1/no) (1)

式中,θ1为入射光线入射角,θo和θ2为折射光o光与单轴晶体镜头表面法线的夹角;

no分别为o光在单轴晶体镜头中的折射率;

对于e光,n2表示为:

<mrow> <msub> <mi>n</mi> <mn>2</mn> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>n</mi> <mi>o</mi> </msub> <msub> <mi>n</mi> <mi>e</mi> </msub> </mrow> <msqrt> <mrow> <msubsup> <mi>n</mi> <mi>o</mi> <mn>2</mn> </msubsup> <msup> <mi>sin</mi> <mn>2</mn> </msup> <msub> <mi>&theta;</mi> <mrow> <mi>k</mi> <mi>p</mi> </mrow> </msub> <mo>+</mo> <msubsup> <mi>n</mi> <mi>e</mi> <mn>2</mn> </msubsup> <msup> <mi>cos</mi> <mn>2</mn> </msup> <msub> <mi>&theta;</mi> <mrow> <mi>k</mi> <mi>p</mi> </mrow> </msub> </mrow> </msqrt> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow>

θkp为光波矢量与光轴的夹角,所以有:

<mrow> <msub> <mi>n</mi> <mn>1</mn> </msub> <msub> <mi>sin&theta;</mi> <mn>1</mn> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>n</mi> <mi>o</mi> </msub> <msub> <mi>n</mi> <mi>e</mi> </msub> </mrow> <msqrt> <mrow> <msubsup> <mi>n</mi> <mi>o</mi> <mn>2</mn> </msubsup> <msup> <mi>sin</mi> <mn>2</mn> </msup> <msub> <mi>&theta;</mi> <mrow> <mi>k</mi> <mi>p</mi> </mrow> </msub> <mo>+</mo> <msubsup> <mi>n</mi> <mi>e</mi> <mn>2</mn> </msubsup> <msup> <mi>cos</mi> <mn>2</mn> </msup> <msub> <mi>&theta;</mi> <mrow> <mi>k</mi> <mi>p</mi> </mrow> </msub> </mrow> </msqrt> </mfrac> <msub> <mi>sin&theta;</mi> <mi>k</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>

θk为e光波矢量ek与单轴晶体镜头表面法线的夹角,e光波矢量ek仍然在入射平面内,表示为:

ek=cosθkez+sinθkex (4)

其中,ez、ex为三轴分量单位矢量;故得到:

cosθkp=ek·ep=cosθkcosθp+sinθksinθpcosφp (5)

θp为单轴晶体镜头光轴与z轴的夹角,φp为光轴在单轴晶体表面的投影线与x轴夹角,ep为光轴单位矢量,e光波矢量确定后,e光线单位矢量er与光轴的夹角θrp由下式确定:

<mrow> <msub> <mrow> <mi>tan</mi> <mi>&theta;</mi> </mrow> <mi>rp</mi> </msub> <mo>=</mo> <mrow> <mo>(</mo> <msubsup> <mi>n</mi> <mi>o</mi> <mi>e</mi> </msubsup> <mo>/</mo> <msubsup> <mi>n</mi> <mi>e</mi> <mn>2</mn> </msubsup> <mo>)</mo> </mrow> <msub> <mrow> <mi>tan</mi> <mi>&theta;</mi> </mrow> <mi>kp</mi> </msub> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>6</mn> <mo>)</mo> </mrow> </mrow>

由于e光光线、e光波矢量与光轴三者共面,设三者满足:

er=αek+βep (7)

α和β为待定系数,经过各矢量之间的约束关系得到:

<mrow> <mi>&alpha;</mi> <mo>=</mo> <mfrac> <msubsup> <mi>n</mi> <mi>o</mi> <mn>2</mn> </msubsup> <msubsup> <mi>n</mi> <mi>e</mi> <mn>2</mn> </msubsup> </mfrac> <mfrac> <mrow> <msub> <mi>cos&theta;</mi> <mrow> <mi>r</mi> <mi>p</mi> </mrow> </msub> </mrow> <mrow> <msub> <mi>cos&theta;</mi> <mrow> <mi>k</mi> <mi>p</mi> </mrow> </msub> </mrow> </mfrac> <mo>=</mo> <mfrac> <msubsup> <mi>n</mi> <mi>o</mi> <mn>2</mn> </msubsup> <msubsup> <mi>n</mi> <mi>e</mi> <mn>2</mn> </msubsup> </mfrac> <mfrac> <mn>1</mn> <msqrt> <mrow> <msup> <mi>cos</mi> <mn>2</mn> </msup> <msub> <mi>&theta;</mi> <mrow> <mi>k</mi> <mi>p</mi> </mrow> </msub> <mo>+</mo> <mrow> <mo>(</mo> <msubsup> <mi>n</mi> <mi>o</mi> <mn>4</mn> </msubsup> <mo>/</mo> <msubsup> <mi>n</mi> <mi>e</mi> <mn>4</mn> </msubsup> <mo>)</mo> </mrow> <msup> <mi>sin</mi> <mn>2</mn> </msup> <msub> <mi>&theta;</mi> <mrow> <mi>k</mi> <mi>p</mi> </mrow> </msub> </mrow> </msqrt> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>8</mn> <mo>)</mo> </mrow> </mrow>

<mrow> <mi>&beta;</mi> <mo>=</mo> <mrow> <mo>(</mo> <mrow> <mn>1</mn> <mo>-</mo> <msubsup> <mi>n</mi> <mi>o</mi> <mi>e</mi> </msubsup> <mo>/</mo> <msubsup> <mi>n</mi> <mi>e</mi> <mn>2</mn> </msubsup> </mrow> <mo>)</mo> </mrow> <msub> <mi>cos&theta;</mi> <mrow> <mi>r</mi> <mi>p</mi> </mrow> </msub> <mo>=</mo> <mrow> <mo>(</mo> <mrow> <mn>1</mn> <mo>-</mo> <msubsup> <mi>n</mi> <mi>o</mi> <mi>e</mi> </msubsup> <mo>/</mo> <msubsup> <mi>n</mi> <mi>e</mi> <mn>2</mn> </msubsup> </mrow> <mo>)</mo> </mrow> <mfrac> <mrow> <msub> <mi>cos&theta;</mi> <mrow> <mi>k</mi> <mi>p</mi> </mrow> </msub> </mrow> <msqrt> <mrow> <msup> <mi>cos</mi> <mn>2</mn> </msup> <msub> <mi>&theta;</mi> <mrow> <mi>k</mi> <mi>p</mi> </mrow> </msub> <mo>+</mo> <mrow> <mo>(</mo> <mrow> <msubsup> <mi>n</mi> <mi>o</mi> <mn>4</mn> </msubsup> <mo>/</mo> <msubsup> <mi>n</mi> <mi>e</mi> <mn>4</mn> </msubsup> </mrow> <mo>)</mo> </mrow> <msup> <mi>sin</mi> <mn>2</mn> </msup> <msub> <mi>&theta;</mi> <mrow> <mi>k</mi> <mi>p</mi> </mrow> </msub> </mrow> </msqrt> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>9</mn> <mo>)</mo> </mrow> </mrow>

进而得到:

er=(αsinθk+βsinθpcosφp)ex+βsinθpsinφpey (10)

+(αcosθk+βcosθp)ez

通过选定单轴晶体镜头,利用公式(1)确定o光的入射光θ1与折射光的关系,利用公式(10)确定e光线单位矢量er与θp、θk的关系,再由公式(3)确定θk与θ1之间的关系,这样联合公式(1)、(3)和(10)确定了入射光与两束折射光之间的关系,通过测量得到两束折射光线,则入射光线矢量也就唯一确定了。

8.根据权利要求7所述的载体三轴姿态的测量方法,其特征在于,所述步骤6)的具体实现过程为:

载体的姿态信息包含俯仰角、偏航角和滚动角;直接测量两束折射光在图像传感器上的二维坐标(x,y),经过计算得到两束折射光的俯仰角θ和偏航角ψ的信息,具体为:

<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mi>&theta;</mi> <mo>=</mo> <mi>arctan</mi> <mrow> <mo>(</mo> <mfrac> <mi>y</mi> <mi>f</mi> </mfrac> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>&psi;</mi> <mo>=</mo> <mi>arctan</mi> <mrow> <mo>(</mo> <mfrac> <mi>x</mi> <mi>f</mi> </mfrac> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> </mfenced>

式中,f为凸透镜的焦距;

经过直接测量两束折射光光斑质心确定入射光的俯仰角θm和偏航角ψm,对两束折射光光斑质心进行连线,确定出入射光的旋转角度,即滚动角此时确定的三个姿态角均为太阳敏感器坐标系下的值,记为通过敏感器的转换矩阵Tbm,将姿态转化为飞行器本体坐标系下,即

为载体本体坐标系下的姿态信息。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1