一种基于光束法平差的星载摄影测量系统一体化检校方法与流程

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

技术特征:

1.一种基于光束法平差的星载摄影测量系统一体化检校方法,其特征在于,所述方法包括以下步骤:

步骤1,获取基于惯性系的以归一化四元数形式表示的卫星姿态数据;

步骤2,将通过步骤1获得的所述卫星姿态数据的表达形式由归一化四元数的形式转换为欧拉角形式;

步骤3,将通过步骤2获得的欧拉角形式的卫星姿态数据从惯性坐标系转换至地球固定直角坐标系;

步骤4,获取基于地球固定直角坐标系的卫星定位观测值;

步骤5,构建卫星摄影测量一体化检校平差模型;

步骤6,基于步骤5建立的星载摄影测量系统一体化检校平差模型,优选的按最小二乘原理求待检校参数估计值。

2.根据权利要求1所述的方法,其特征在于,在所述步骤1中,所述卫星姿态数据优选的用归一化四元数表示为:

<mrow> <mi>q</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> </mtd> </mtr> <mtr> <mtd> <msub> <mi>q</mi> <mn>4</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>q</mi> <mn>1</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>q</mi> <mn>2</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>q</mi> <mn>3</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>q</mi> <mn>4</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>,</mo> </mrow>

其中,q为一个卫星姿态值,q1、q2和q3表示归一化四元数的虚部,q4表示归一化四元数的实部,其中,

3.根据权利要求1所述的方法,其特征在于,在所述步骤2中,根据下述转换公式(11)将卫星姿态数据的表达形式由归一化四元数的形式转换为欧拉角形式:

<mrow> <msub> <mi>A</mi> <mrow> <mi>e</mi> <mi>u</mi> <mi>l</mi> <mi>a</mi> <mi>r</mi> </mrow> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>R</mi> <mi>o</mi> <mi>l</mi> <mi>l</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>P</mi> <mi>i</mi> <mi>t</mi> <mi>c</mi> <mi>h</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>Y</mi> <mi>a</mi> <mi>w</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mi>arctan</mi> <mfrac> <mrow> <mn>2</mn> <mrow> <mo>(</mo> <msub> <mi>q</mi> <mn>1</mn> </msub> <msub> <mi>q</mi> <mn>4</mn> </msub> <mo>+</mo> <msub> <mi>q</mi> <mn>2</mn> </msub> <msub> <mi>q</mi> <mn>3</mn> </msub> <mo>)</mo> </mrow> </mrow> <mrow> <mn>1</mn> <mo>-</mo> <mn>2</mn> <mrow> <mo>(</mo> <msubsup> <mi>q</mi> <mn>1</mn> <mn>2</mn> </msubsup> <mo>+</mo> <msubsup> <mi>q</mi> <mn>2</mn> <mn>2</mn> </msubsup> <mo>)</mo> </mrow> </mrow> </mfrac> </mtd> </mtr> <mtr> <mtd> <mi>arcsin</mi> <mo>(</mo> <mn>2</mn> <mrow> <mo>(</mo> <mrow> <msub> <mi>q</mi> <mn>2</mn> </msub> <msub> <mi>q</mi> <mn>4</mn> </msub> <mo>-</mo> <msub> <mi>q</mi> <mn>1</mn> </msub> <msub> <mi>q</mi> <mn>3</mn> </msub> </mrow> <mo>)</mo> </mrow> <mo>)</mo> </mtd> </mtr> <mtr> <mtd> <mi>arctan</mi> <mfrac> <mrow> <mn>2</mn> <mrow> <mo>(</mo> <msub> <mi>q</mi> <mn>3</mn> </msub> <msub> <mi>q</mi> <mn>4</mn> </msub> <mo>+</mo> <msub> <mi>q</mi> <mn>1</mn> </msub> <msub> <mi>q</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> </mrow> <mrow> <mn>1</mn> <mo>-</mo> <mn>2</mn> <mrow> <mo>(</mo> <msubsup> <mi>q</mi> <mn>2</mn> <mn>2</mn> </msubsup> <mo>+</mo> <msubsup> <mi>q</mi> <mn>3</mn> <mn>2</mn> </msubsup> <mo>)</mo> </mrow> </mrow> </mfrac> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>11</mn> <mo>)</mo> </mrow> </mrow>

其中,Roll、Pitch和Yaw分别为以欧拉角形式表示的横滚角、俯仰角和偏航角,Aeular表示转换后的三轴欧拉角矩阵。

4.根据权利要求1所述的方法,其特征在于,在所述步骤3中,根据下述公式将卫星姿态数据从惯性坐标系转换至地球固定直角坐标系:

RITRS=H(t)·RGCRS

其中,RITRS为卫星在地球固定直角坐标系下的旋转矩阵,RITRS中的元素是由基于地球固定直角坐标系的三个姿态角phi、omega、kappa计算的方向余弦;RGCRS为卫星在惯性坐标系下的旋转矩阵,RGCRS中的元素是由基于惯性坐标系的三个姿态角Roll、Pitch、Yaw计算的方向余弦;H(t)=W(t)·R(t)·Q(t),W(t),R(t)和Q(t)分别对应极移、自转和岁差章动转换矩阵。

5.根据权利要求1所述的方法,其特征在于,步骤5具体包括以下子步骤:

步骤5.1,建立像点观测方程,所述像点观测方程如下式(1)所示:

<mrow> <mfenced open = "" close = "}"> <mtable> <mtr> <mtd> <mrow> <mi>x</mi> <mo>=</mo> <mn>0</mn> <mo>=</mo> <mo>-</mo> <mi>f</mi> <mfrac> <mrow> <msub> <mi>a</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>X</mi> <mi>T</mi> </msub> <mo>-</mo> <msup> <msub> <mi>X</mi> <mi>S</mi> </msub> <mo>,</mo> </msup> </mrow> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>b</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>Y</mi> <mi>T</mi> </msub> <mo>-</mo> <msup> <msub> <mi>Y</mi> <mi>S</mi> </msub> <mo>,</mo> </msup> </mrow> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>c</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>Z</mi> <mi>T</mi> </msub> <mo>-</mo> <msup> <msub> <mi>Z</mi> <mi>S</mi> </msub> <mo>,</mo> </msup> </mrow> <mo>)</mo> </mrow> </mrow> <mrow> <msub> <mi>a</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>X</mi> <mi>T</mi> </msub> <mo>-</mo> <msup> <msub> <mi>X</mi> <mi>S</mi> </msub> <mo>,</mo> </msup> </mrow> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>b</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>Y</mi> <mi>T</mi> </msub> <mo>-</mo> <msup> <msub> <mi>Y</mi> <mi>S</mi> </msub> <mo>,</mo> </msup> </mrow> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>c</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>Z</mi> <mi>T</mi> </msub> <mo>-</mo> <msup> <msub> <mi>Z</mi> <mi>S</mi> </msub> <mo>,</mo> </msup> </mrow> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>+</mo> <msub> <mi>x</mi> <mn>0</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>y</mi> <mo>=</mo> <mo>-</mo> <mi>f</mi> <mfrac> <mrow> <msub> <mi>a</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>X</mi> <mi>T</mi> </msub> <mo>-</mo> <msup> <msub> <mi>X</mi> <mi>S</mi> </msub> <mo>,</mo> </msup> </mrow> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>b</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>Y</mi> <mi>T</mi> </msub> <mo>-</mo> <msup> <msub> <mi>Y</mi> <mi>S</mi> </msub> <mo>,</mo> </msup> </mrow> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>c</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>Z</mi> <mi>T</mi> </msub> <mo>-</mo> <msup> <msub> <mi>Z</mi> <mi>S</mi> </msub> <mo>,</mo> </msup> </mrow> <mo>)</mo> </mrow> </mrow> <mrow> <msub> <mi>a</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>X</mi> <mi>T</mi> </msub> <mo>-</mo> <msup> <msub> <mi>X</mi> <mi>S</mi> </msub> <mo>,</mo> </msup> </mrow> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>b</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>Y</mi> <mi>T</mi> </msub> <mo>-</mo> <msup> <msub> <mi>Y</mi> <mi>S</mi> </msub> <mo>,</mo> </msup> </mrow> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>c</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mrow> <msub> <mi>Z</mi> <mi>T</mi> </msub> <mo>-</mo> <msup> <msub> <mi>Z</mi> <mi>S</mi> </msub> <mo>,</mo> </msup> </mrow> <mo>)</mo> </mrow> </mrow> </mfrac> <mo>+</mo> <msub> <mi>y</mi> <mn>0</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>)</mo> </mrow> </mrow>

其中,(x,y)为像点坐标;(x0,y0)为相机的像主点坐标;f为成像相机主距;(XS',YS',ZS')为成像相机外方位线元素;aj,bj,cj(j=1,2,3)为成像相机外方位角元素构成的旋转矩阵方向余弦值;(XT,YT,ZT)为该像点对应的地面点在地固坐标系下的空间坐标;

将式(1)进行线性化,得到像点坐标误差方程为:

VX=AX1t1+AX2t2+Ii+Jj+Bx+Cc-LX (2)

其中,VX为像点坐标误差,t1为基准相机外方位线元素增量;t2为基准相机外方位角元素增量;x为地面点物方坐标增量;c为相机内方位元素参数增量;AX1表示像点坐标对基准相机外方位线元素的偏导系数矩阵;AX2表示像点坐标对基准相机外方位角元素的偏导系数矩阵;I表示像点坐标对相机间摄影中心空间偏移量的偏导系数矩阵;J表示像点坐标对相机间相对旋转角的偏导系数矩阵;B表示像点坐标对地面点物方坐标的偏导系数矩阵;B表示像点坐标对地面点物方坐标的偏导系数矩阵;C表示像点坐标对相机内方位元素的偏导系数矩阵;LX为像点坐标观测值的残差向量;对于前(后)视相机所成像点,i为前(后)视相机相对于正视相机的摄影中心空间偏移量增量;j为前(后)视相机本体相对于正视相机本体的相对旋转角增量;对于正视相机所成像点,有i,j=0;

步骤5.2,建立卫星定位观测方程,所述卫星定位观测方程如下式(16)所示:

<mrow> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>X</mi> <mi>g</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Y</mi> <mi>g</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Z</mi> <mi>g</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>X</mi> <mi>S</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Y</mi> <mi>S</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>Z</mi> <mi>S</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>+</mo> <msub> <mi>R</mi> <mi>B</mi> </msub> <mo>&CenterDot;</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>u</mi> <mi>g</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>v</mi> <mi>g</mi> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>w</mi> <mi>g</mi> </msub> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>16</mn> <mo>)</mo> </mrow> </mrow>

式中,[Xg Yg Zg]T表示卫星定位观测值,[XS YS ZS]T表示基准相机摄影中心坐标,[ug vgwg]T表示卫星定位观测中心在卫星摄影测量系统坐标系中的三维坐标,RB表示基准相机外方位角元素构成的旋转矩阵;

在建立卫星定位接收机与基准相机的几何关系后,将式(16)简化为式(3)

G=S+RB·u (3)

其中,G为卫星定位观测值向量;S为基准相机摄影中心空间坐标向量;RB表示基准相机外方位角元素构成的旋转矩阵;u为卫星定位接收机观测中心相对于基准相机摄影中心的空间偏移向量;

将式(3)进行线性化,得到卫星定位观测误差方程:

VG=AG1t1+AG2t2+Dd-LG (4)

其中,VG表示卫星定位观测误差,AG1表示卫星位置坐标对基准相机外方位线元素的偏导系数矩阵子块,AG2表示卫星位置坐标对基准相机外方位角元素的偏导系数矩阵子块,t1为基准相机外方位线元素增量,t2为基准相机外方位角元素增量,D为卫星位置坐标对观测中心空间偏移量的偏导系数矩阵子块,d为卫星定位观测中心空间偏移量增量,LG为卫星定位观测值的残差向量;

步骤5.3,建立卫星姿态观测方程,所述卫星姿态观测方程如下式(5)所示:

<mrow> <msup> <mi>R</mi> <mo>&prime;</mo> </msup> <mo>=</mo> <msub> <mi>R</mi> <mi>B</mi> </msub> <msubsup> <mi>A</mi> <mi>i</mi> <mi>T</mi> </msubsup> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>5</mn> <mo>)</mo> </mrow> </mrow>

其中,为相对旋转角构成的旋转矩阵,为绕系统坐标系V轴旋转对应的旋转矩阵,为绕系统坐标系U轴旋转ωA对应的旋转矩阵,为绕系统坐标系W轴旋转κA对应的旋转矩阵;R'为卫星姿态观测值phi、omega、kappa构成的旋转矩阵,RB为基准相机三轴姿态角即外方位角元素构成的旋转矩阵;

将式(5)进行线性化,得到卫星姿态观测误差方程如下式(6)所示:

VS=ASt2+Mm-LS (6)

其中,VS表示卫星姿态观测误差,AS表示卫星姿态对基准相机外方位角元素的偏导系数矩阵子块,t2为基准相机外方位角元素增量,M为卫星姿态对相对旋转角的偏导系数矩阵子块,m为姿态输出设备本体与基准相机本体的相对旋转角增量,LS为卫星姿态观测值的残差向量;

步骤5.4,联立所述像点坐标误差方程、卫星定位观测误差方程和卫星姿态观测误差方程,建立星载摄影测量系统一体化检校平差模型,如下式所示:

<mrow> <mfenced open = "" close = "}"> <mtable> <mtr> <mtd> <mrow> <msub> <mi>V</mi> <mi>X</mi> </msub> <mo>=</mo> <msub> <mi>A</mi> <mrow> <mi>X</mi> <mn>1</mn> </mrow> </msub> <msub> <mi>t</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>A</mi> <mrow> <mi>X</mi> <mn>2</mn> </mrow> </msub> <msub> <mi>t</mi> <mn>2</mn> </msub> <mo>+</mo> <mi>I</mi> <mi>i</mi> <mo>+</mo> <mi>J</mi> <mi>i</mi> <mo>+</mo> <mi>B</mi> <mi>x</mi> <mo>+</mo> <mi>C</mi> <mi>c</mi> <mo>-</mo> <msub> <mi>L</mi> <mi>X</mi> </msub> <mo>,</mo> <mi>E</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>V</mi> <mi>G</mi> </msub> <mo>=</mo> <msub> <mi>A</mi> <mrow> <mi>G</mi> <mn>1</mn> </mrow> </msub> <msub> <mi>t</mi> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>A</mi> <mrow> <mi>G</mi> <mn>2</mn> </mrow> </msub> <msub> <mi>t</mi> <mn>2</mn> </msub> <mo>+</mo> <mi>D</mi> <mi>d</mi> <mo>-</mo> <msub> <mi>L</mi> <mi>G</mi> </msub> <mo>,</mo> <msub> <mi>P</mi> <mi>G</mi> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>V</mi> <mi>S</mi> </msub> <mo>=</mo> <msub> <mi>A</mi> <mi>S</mi> </msub> <msub> <mi>t</mi> <mn>2</mn> </msub> <mo>+</mo> <mi>M</mi> <mi>m</mi> <mo>-</mo> <msub> <mi>L</mi> <mi>S</mi> </msub> <mo>,</mo> <msub> <mi>P</mi> <mi>S</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>.</mo> </mrow>

6.根据权利要求5所述的方法,其特征在于,所述步骤5.4还包括:

根据平差模型,将上述星载摄影测量系统一体化检校平差模型表示为:

V=Ky-l,P

其中,V=Ky-l为平差函数模型,P为平差随机模型,即观测值的权矩阵。

具体地,

即观测值改正数向量;

y=[t1 t2 i j x c d m]T,即待求参数增量向量;

即观测值对待求参数的偏导系数矩阵;

即观测值与其近似值之差的向量;

为观测值的权矩阵;其中,E为单位矩阵,其对角线元素全为1,非对角线元素全为0;PG为卫星定位观测值的权矩阵,其对角线元素的数值为0为像点坐标观测中误差,σG为卫星定位观测中误差),非对角线元素全为0;PS为卫星姿态观测值的权矩阵,其对角线元素的数值为S为卫星姿态观测中误差),非对角线元素全为0。

7.根据权利要求1所述的方法,其特征在于,所述步骤6具体包括:

按最小二乘原理,构建卫星摄影测量一体化检校平差的法方程,其形式为

<mrow> <msup> <mi>K</mi> <mi>T</mi> </msup> <mi>P</mi> <mi>K</mi> <mover> <mi>y</mi> <mo>^</mo> </mover> <mo>-</mo> <msup> <mi>K</mi> <mi>T</mi> </msup> <mi>P</mi> <mi>l</mi> <mo>=</mo> <mn>0</mn> </mrow>

其中,K为观测值对待求参数的偏导系数矩阵,P为观测值的权矩阵,l为观测值与其近似值之差的向量;表示待求参数增量的最小二乘估计值。

由此可得到参数增量的最小二乘估计值:

<mrow> <mover> <mi>y</mi> <mo>^</mo> </mover> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msup> <mi>K</mi> <mi>T</mi> </msup> <mi>P</mi> <mi>K</mi> <mo>)</mo> </mrow> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <msup> <mi>K</mi> <mi>T</mi> </msup> <mi>P</mi> <mi>l</mi> </mrow>

则待求参数的估计值为

<mrow> <mover> <mi>Y</mi> <mo>^</mo> </mover> <mo>=</mo> <msup> <mi>Y</mi> <mn>0</mn> </msup> <mo>+</mo> <mover> <mi>y</mi> <mo>^</mo> </mover> </mrow>

上式中,Y0为待求参数的初始值。

8.根据权利要求7所述的方法,其特征在于,所述待检校参数是所述待求参数的一部分。

9.根据权利要求7所述的方法,其特征在于,其特征在于,所述待求参数包括基准相机外方位线元素、基准相机外方位角元素、地面点物方坐标、成像相机内方位元素、成像相机相对于基准相机的摄影中心空间偏移量、成像相机相对于基准相机的相对旋转角、卫星定位观测中心空间偏移量、姿态输出设备本体与基准相机本体的相对旋转角;所述待检校参数包括成像相机内方位元素、成像相机相对于基准相机的摄影中心空间偏移量、成像相机相对于基准相机的相对旋转角、卫星定位观测中心空间偏移量、姿态输出设备本体与基准相机本体的相对旋转角。

10.一种计算机程序,其特征在于,当执行所述计算机程序时,执行上述权利要求1-9中的任意一项所述的方法。

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