SINS/GNSS组合导航:SINS系统及参数解算

1 SINS系统及原理

SINS 主要包括导航计算机、惯性测量单元。惯性测量单元包括陀螺仪和加速度计,加速度计用于测量载体相对于i系的加速度与引力加速度之差,简称为比力,记为f^b。陀螺仪用于测量载体相对于i 系的旋转角速度,记为 w_{ib}^b惯导的机械编排方程用这两个信息获取位置、速度、姿态角这三个导航信息。

采用 SINS 进行导航时,由通过将惯性传感器得到的旋转角速度及比力信息进行 积分,解算出载体的速度、位置信息。通过不断更新姿态矩阵得到载体的姿态信息。 并通过姿态矩阵将加速度计的输出信息从载体坐标系转换到导航坐标系下,然后进行 导航解算。

SINS/GNSS组合导航:SINS系统及参数解算_第1张图片

2 SINS参数解算

2.1 姿态角更新

捷联惯导中的姿态角表示了载体坐标系到导航坐标系的旋转信息,一般用滤波的方法进行组合时状态量以导航坐标系下为准,该姿态角用于状态信息的转换。

用r表示姿态,r^b表示b系下的姿态,r^n表示n系下的姿态,有:

                                                                              r^b=C_n^br^n                                              (2-1)

对t求导数有:

                                                                     \dot{r^b}=\dot{C_n^b}r^n+C_n^b\dot{r^n}                                          (2-2)

将地理坐标系作为导航坐标系,\dot{r^n}=0,有:

                                                                             \dot{r^b}=\dot{C_n^b}r^n                                                (2-3)

又因为有b系转n系公式:

                                                                            r^n=C_b^nr^b                                                (2-4)

得到:

                                                                           \dot{r^b}=\dot{C_n^b}C_b^nr^b                                             (2-5)

根据矢量的相对导数和绝对导数的关系有:

                                                                   \frac{dr}{dt}_n=\frac{dr}{dt}_b+w_{nb}\times r                                       (2-6)

左边等于0,有:

                                                                       \dot{r^b}=-w_{nb}\times r                                             (2-7)

比较(2-7)(2-5)得到:

                                                                    \dot{C_n^b}C_b^n=[-w_{nb}\times ]                                            (2-8)

等式两边同时左乘以C_n^b得到:

                                                                     \dot{C_n^b}=[-w_{nb}\times ]C_n^b                                           (2-9)

上式中:

                                                                   w_{nb}=w_{ib}-w_{in}                                               (2-10)

代入(2-9)得到:

                                                       \dot{C_n^b}=[w_{in}\times ]C_n^b-[w_{ib}\times ]C_n^b                                        (2-11)

上式即为姿态角跟新方程,w_{ib}表示陀螺仪输出的角速度值,即在体系相对于惯性系的角速度值,w_{in}如下:

                                                    w_{in}^n=\left [ \begin{matrix}-\frac{v_N}{R_M}\\ w_{ie}cos\varphi+\frac{v_E}{R_N} \\w_{ie}sin\varphi +\frac{v_E}{R_N}tan\varphi\\ \end{matrix} \right ]                                         (2-12)

R_M,R_N表示子午圈卯酉圈曲率半径,w_{ie}为地球自转角速度。

2.2 位置更新

位置矢量为维度精度高程,经纬高的导数与东向、北向速度有关,有:

                                                          \begin{bmatrix} \dot{L} \\ \dot{\lambda} \\ \dot{h} \end{bmatrix} =\begin{bmatrix} \frac{v_N^{n}}{R_M+h} \\ \frac{v_E^n}{(R_N+h)cosL} \\ v_U^n \end{bmatrix}

2.3 速度更新

SINS中的比力方程如下;

                                              \dot{V_{en}}=f-(2w_{ie}-w_{en})\times V_{en}+g

f为加速度计输出量,\2w_{ie}\times v_{en}表示哥氏加速度,用矩阵表示,则导航系下的三维速度如下:

            \begin{bmatrix} \dot{v_E^n}\\ \dot{v_N^n} \\ \dot{v_U^n} \end{bmatrix}=\begin{bmatrix} f_x^n\\ f_y^n \\ f_z^n \end{bmatrix}+\begin{bmatrix} 0\\ 0 \\ -f^n \end{bmatrix}-\begin{bmatrix} 0 & -(2w_{iez}^n+w_{enz}^n) & 2w_{iey}^n+w_{eny}^n \\ 2w_{iez}^n+w_{enz}^n & 0 & -(2w_{iex}^n+w_{enx}^n) \\ - 2w_{iey}^n+w_{eny}^n & 2w_{iex}^n+w_{enx}^n & 0 \end{bmatrix}\begin{bmatrix} {v_E^n}\\ {v_N^n} \\ {v_U^n} \end{bmatrix}

 

你可能感兴趣的:(组合导航)