发明名称 线阵APS太阳敏感器中的两轴角度确定方法
摘要 本发明涉及线阵APS太阳敏感器中的两轴角度确定方法,包含角度计算及误差补偿两部分,入射光通过“N”型光缝玻璃在线阵图像传感器上形成图像,利用质心算法提取中心直缝图像的质心坐标及其两侧斜缝图像的质心坐标,依据光缝玻璃与图像传感器安装的几何关系,利用直缝与斜缝的质心坐标及光缝玻璃与图像传感器之间的高度值求解两轴角度值;角度补偿部分对两轴角度值进行多项式拟合补偿后,进行多次互相迭代补偿,以选取合适的补偿曲线,并在选取补偿曲线时,依据测角值在两条相邻的补偿曲线间进行权重分配,即对两误差补偿多项式进行加权求和的方式求解补偿值,本发明方法大大提高了线阵APS太阳敏感器的测角精度,且运算开销小,效果显著。
申请公布号 CN103411580A 申请公布日期 2013.11.27
申请号 CN201310319829.3 申请日期 2013.07.26
申请人 北京控制工程研究所 发明人 梁鹤;张建福;吕政欣;贾锦忠;莫亚男;余成武;何伟;孙建波;张韩笑
分类号 G01C1/00(2006.01)I 主分类号 G01C1/00(2006.01)I
代理机构 中国航天科技专利中心 11009 代理人 范晓毅
主权项 1.线阵APS太阳敏感器中的两轴角度确定方法,其特征在于:所述线阵APS太阳敏感器包括光缝玻璃和线阵APS图像传感器,其中光缝玻璃包括一条中央直缝S0和两条斜缝S1、S2,两条斜缝S1、S2分别位于中央直缝S0的两侧,具体包括如下步骤:步骤(一)、计算太阳光矢量的两轴姿态角α和β(1)建立直角坐标系OXYZ,其中坐标原点O在线阵APS图像传感器中像元总长度的1/2处;X轴与APS光敏单元排列线重合,由零像元指向最大像元处;Y轴在线阵APS的光敏面内,Z轴通过右手法则定义;入射光矢量在YOZ面上的投影与Z轴之间的夹角为β;入射光在XOZ面上的投影与Z轴之间的夹角为α;(2)利用公式(1)计算中央直缝S0的质心坐标,及斜缝S1或S2的质心坐标;<maths num="0001"><![CDATA[<math><mrow><msub><mi>x</mi><mn>0</mn></msub><mo>=</mo><mi>b</mi><mo>&CenterDot;</mo><mfrac><mrow><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mi>m</mi></mrow><mi>n</mi></munderover><mi>i</mi><mo>&CenterDot;</mo><msubsup><mi>v</mi><mi>i</mi><mo>'</mo></msubsup></mrow><mrow><munderover><mi>&Sigma;</mi><mrow><mi>i</mi><mo>=</mo><mi>m</mi></mrow><mi>n</mi></munderover><msubsup><mi>v</mi><mi>i</mi><mo>'</mo></msubsup></mrow></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中:x<sub>0</sub>为质心坐标;b为线阵APS图像传感器相邻两个像元的中心距离;i为像元序号,m为光斑的起始像元,n为光斑的终止像元;v<sub>i</sub>'为第i个像元经去背景处理后的输出值;(3)计算太阳光线矢量的两轴姿态角β<maths num="0002"><![CDATA[<math><mrow><mi>tg&beta;</mi><mo>=</mo><mfrac><mrow><mi>&Delta;</mi><msub><mi>x</mi><mn>1</mn></msub><mo>-</mo><mi>&Delta;x</mi></mrow><mi>htg&gamma;</mi></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow></math>]]></maths>或<maths num="0003"><![CDATA[<math><mrow><mi>tg&beta;</mi><mo>=</mo><mfrac><mrow><mi>&Delta;x</mi><mo>-</mo><mi>&Delta;</mi><msub><mi>x</mi><mn>2</mn></msub></mrow><mi>htg&gamma;</mi></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中:Δx<sub>1</sub>为斜缝S1的光斑位置与斜缝S1在零位时的光斑位置之差;Δx<sub>2</sub>为斜缝S2的光斑位置与斜缝S2在零位时的光斑位置之差;Δx为中央直缝S0的光斑位置与中央直缝S0在零位时的光斑位置之差;γ为倾斜狭缝与中央狭缝的夹角;h为光缝玻璃下表面与APS图像传感器器件封装玻璃上表面之间的距离;(4)计算太阳光线矢量的两轴姿态角α<maths num="0004"><![CDATA[<math><mrow><mfrac><mi>&Delta;x</mi><mrow><mi>tan</mi><mi>&alpha;</mi></mrow></mfrac><mo>-</mo><mfrac><mi>e</mi><msqrt><mrow><mo>(</mo><msup><mi>n</mi><mn>2</mn></msup><mo>-</mo><mn>1</mn><mo>)</mo></mrow><msup><mi>tan</mi><mn>2</mn></msup><mi>&alpha;</mi><mo>+</mo><mrow><mo>(</mo><msup><mi>n</mi><mn>2</mn></msup><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>+</mo><mi>cos</mi><mi>&beta;</mi></msqrt></mfrac><mo>=</mo><mi>h</mi><mo>+</mo><mi>t</mi><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>4</mn><mo>)</mo></mrow></mrow></math>]]></maths>其中:n为APS图像传感器器件封装玻璃的折射率;e为APS图像传感器器件封装玻璃的厚度;t为APS图像传感器器件封装玻璃下表面与APS图像传感器器件光敏面之间的距离;不考虑APS图像传感器封装玻璃的折射带来的影响,将求解α角的公式(4)简化为公式(5)所示:<maths num="0005"><![CDATA[<math><mrow><mi>tan</mi><mi>&alpha;</mi><mo>=</mo><mfrac><mi>&Delta;x</mi><mi>h</mi></mfrac><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>5</mn><mo>)</mo></mrow></mrow></math>]]></maths>步骤(二)、对太阳光线矢量的两轴姿态角α和β进行误差补偿(1)、分别建立α角和β角在视场范围内的二维误差补偿系数表,建立方法为:(a)、在线阵APS太阳敏感器的视场范围内,给出一组固定角度间隔的太阳光矢量的两轴姿态角真实值α<sub>真实</sub>和β<sub>真实</sub>,其中固定角度间隔为K,再根据步骤(一)中的计算方法计算出一组相应的姿态角α<sub>实测</sub>和β<sub>实测</sub>,得到姿态角的误差值α<sub>误差</sub>=α<sub>真实</sub>-α<sub>实测</sub>和β<sub>误差</sub>=β<sub>真实</sub>-β<sub>实测</sub>;分别对α<sub>误差</sub>和β<sub>误差</sub>进行曲线拟合得到拟合曲线的补偿系数值,如下公式6、7所示:α<sub>补</sub>=A0+A1×α<sup>7</sup>+A2×α<sup>6</sup>+A3×α<sup>5</sup>+A4×α<sup>4</sup>+A5×α<sup>3</sup>+A6×α<sup>2</sup>+A7×α;      (6)β<sub>补</sub>=B0+B1×β<sup>7</sup>+B2×β<sup>6</sup>+B3×β<sup>5</sup>+B4×β<sup>4+</sup>B5×β<sup>3</sup>+B6×β<sup>2</sup>+B7×β;      (7)其中A0、A1……A7;B0、B1……B7为拟合曲线上的多项式系数,即补偿系数值;α、β为拟合曲线上的自变量;(b)、根据所述补偿系数值建立α角和β角在线阵APS太阳敏感器的视场范围内的二维误差补偿系数表,具体方法为:在线阵APS太阳敏感器的视场范围内,以固定角度间隔K变化的每一个两轴姿态角β<sub>真实</sub>对应α<sub>真实</sub>的一组误差补偿系数,从而得到α的误差补偿系数表;以固定角度间隔K变化的每一个两轴姿态角α<sub>真实</sub>对应β<sub>真实</sub>的一组误差补偿系数,从而得到β的误差补偿系数表;(2)利用实测的β<sub>实测</sub>查找α的误差补偿系数表,找到β<sub>实测</sub>对应的一组误差补偿系数A0、A1……A7,利用公式6求出误差补偿值α<sub>补</sub>,对α<sub>实测</sub>进行补偿,得到补偿后的α<sub>补+实测</sub>,即α<sub>补+实测</sub>=α<sub>补</sub>+α<sub>实测</sub>;(3)利用补偿后的α<sub>补+实测</sub>查找β的误差补偿系数表,找到α<sub>补+实测</sub>对应的一组误差补偿系数B0、B1……B7,利用公式7求出β的误差补偿值β<sub>补</sub>,对β<sub>实测</sub>进行补偿,得到补偿后的β<sub>补+实测</sub>,即β<sub>补+实测</sub>=β<sub>补</sub>+β<sub>实测</sub>;(4)对补偿后的α<sub>补+实测</sub>进行加权处理,得到加权处理后的α,具体方法如下:(a)根据步骤(3)中补偿后的β<sub>补+实测</sub>查找α的误差补偿系数表,找到与β<sub>补+实测</sub>最接近的两个固定角度β<sub>M</sub>、β<sub>M+1</sub>,计算权重因子C<sub>M</sub>、C<sub>M+1</sub>,其中<img file="FDA00003577478800031.GIF" wi="435" he="154" /><img file="FDA00003577478800032.GIF" wi="493" he="154" />确定β<sub>M</sub>对应的一组误差补偿系数A0<sub>M</sub>、A1<sub>M</sub>……A7<sub>M</sub>和β<sub>M+1</sub>对应的一组误差补偿系数A0<sub>M+1</sub>、A1<sub>M+1</sub>……A7<sub>M+1</sub>,将α<sub>实测</sub>代入β<sub>M</sub>对应的一组误差补偿系数A0<sub>M</sub>、A1<sub>M</sub>……A7<sub>M</sub>,根据公式(6)得到α<sub>补M</sub>:将α<sub>实测</sub>代入β<sub>M+1</sub>对应的一组误差补偿系数A0<sub>M+1</sub>、A1<sub>M+1</sub>……A7<sub>M+1</sub>,根据式公式(6)得到α<sub>补M+1</sub>:(b)得到加权处理后的αα<sub>补</sub>=C<sub>M</sub>×α<sub>补M</sub>+C<sub>M+1</sub>×α<sub>补M+1</sub>α=α<sub>实测</sub>+α<sub>补</sub>;(5)对补偿后的β<sub>补+实测</sub>进行加权处理,得到加权处理后的β,具体方法如下:(a)根据步骤(2)中补偿后的α<sub>补+实测</sub>查找β的误差补偿系数表,找到与α<sub>补+实测</sub>最接近的两个固定角度α<sub>N</sub>、α<sub>N+1</sub>,计算权重因子C<sub>N</sub>、C<sub>N+1</sub>,其中<img file="FDA00003577478800041.GIF" wi="426" he="148" /><img file="FDA00003577478800042.GIF" wi="477" he="150" />确定α<sub>N</sub>对应的一组误差补偿系数B0<sub>N</sub>、B1<sub>N</sub>……B7<sub>N</sub>和α<sub>N+1</sub>对应的一组误差补偿系数B0<sub>N+1</sub>、B1<sub>N+1</sub>……B7<sub>N+1</sub>,将β<sub>实测</sub>代入α<sub>N</sub>对应的一组误差补偿系数B0<sub>N</sub>、B1<sub>N</sub>……B7<sub>N</sub>,根据公式(7)得到β<sub>补N</sub>:将β<sub>实测</sub>代入α<sub>N+1</sub>对应的一组误差补偿系数B0<sub>N+1</sub>、B1<sub>N+1</sub>……B7<sub>N+1</sub>,根据公式(7)得到β<sub>补N+1</sub>:(b)得到加权处理后的ββ<sub>补</sub>=C<sub>N</sub>×β<sub>补N</sub>+C<sub>N+1</sub>×β<sub>补N+1</sub>β=β<sub>实测</sub>+β<sub>补</sub>。
地址 100080 北京市海淀区北京2729信箱