CN110006456A - 一种检测车对准方法、装置和设备 - Google Patents

Abstract

本申请提供了一种检测车对准方法、装置和设备，该方法包括：根据检测车的位置信息及预设信息，确定第一角速度、第二角速度、第三角速度，其中，第一角速度为检测车的载体坐标系相对于惯性坐标系的角速度，第二角速度为地球的自转角速度在惯性坐标系中的投影角速度，第三角速度为检测车的地理坐标系相对于地球坐标系的角速度；将所述第一角速度、所述第二角速度、所述第三角速度作为预设的四元数姿态角确定模型输入，确定所述检测车的姿态角；输出所述检测车的姿态角。

Description

一种检测车对准方法、装置和设备

技术领域

本申请涉及数据处理技术领域，具体而言，涉及一种检测车对准方法、装置和设备。

背景技术

基于惯性导航的轨道检测车可以提供高精度、快速、连续的轨道参数测量。惯性导航初始对准的精度是决定轨检车位置姿态系统精度的重要因素，对于地面静基座对准，粗对准和精对准是对准的两个主要阶段。但粗对准受惯性器件精度限制，且以静态为前提，实际应用中对准精度极低；而基于卡尔曼滤波精对准虽然目标是提高对准精度，但所需时间长，鲁棒性差。

发明内容

有鉴于此，本申请的目的在于提供一种检测车对准方法、装置和设备，用于解决现有技术中对检测车对准效率低的问题。

第一方面，本申请实施例提供了一种检测车对准方法，该方法包括：

根据检测车的位置信息及预设信息，确定第一角速度、第二角速度、第三角速度，其中，第一角速度为检测车的载体坐标系相对于惯性坐标系的角速度，第二角速度为地球的自转角速度在惯性坐标系中的投影角速度，第三角速度为检测车的地理坐标系相对于地球坐标系的角速度；

将所述第一角速度、所述第二角速度、所述第三角速度作为预设的姿态角确定模型输入，确定所述检测车的姿态角；

输出所述检测车的姿态角。

可选地，根据检测车的位置信息及预设信息，确定第二角速度，包括：

通过以下公式计算第二角速度

其中，为地球的自转角速度在惯性坐标系中的投影角速度，L为检测车的纬度，ω_ie为地球的自转角速度。

可选地，根据检测车的位置信息及预设信息，确定第三角速度，包括

通过以下公式计算第三角速度

其中，为检测车的地理坐标系相对于地球坐标系的角速度，V_E为检测车在地理坐标系中的东向速度，V_N为检测车在地理坐标系中的北向速度，R_M为沿子午圈的主曲率半径，R_N为卯酉圈的主曲率半径，H为检测车的高度，L为检测车的纬度。

可选地，所述将所述第一角速度、所述第二角速度、所述第三角速度作为预设的四元数姿态角确定模型输入，确定所述检测车的姿态角，包括：

通过以下公式计算所述检测车的姿态角：

L(q)＝q^TKq-λ(q^Tq-1)

(K+λI)q＝0

其中，

q＝q₀+q₁i+q₂j+q₃k

其中，为初始姿态转换矩阵，C_n ^b为导航坐标系到载体坐标系的姿态转换矩阵，β(t)为第一中间变量，α(t)为第二中间变量，χ_n(0,t)为检测车的地理坐标系相对于地球坐标系的运动速度的函数；vⁿ为检测车在地理坐标系的速度；为地球的自转角速度在惯性坐标系中的投影角速度；为检测车的地理坐标系相对于地球坐标系的角速度；gⁿ为重力加速度在地理坐标系下投影，其中，gⁿ＝[00-g]^T；χ_b(0,t)为第一角速度的函数；f^b为检测车的比力矢量，q为姿态四元数；L(q)为导航坐标系中加速度与零加速度差值的均方差统计值，K为L(q)的矩阵，λ为矩阵K的特征值，q₀、q₁、q₂、q₃分别为构成四元数q的实数，b为载体坐标系，n为导航坐标系，θ为检测车的姿态角中的俯仰角，r为检测车的姿态角中的横滚角，为检测车的姿态角中的航向角。

可选地，该方法还包括：

对所述检测车的姿态角进行校准。

第二方面，本申请实施例提供了一种检测车对准装置，该装置包括：

第一确定模块，用于根据检测车的位置信息及预设信息，确定第一角速度、第二角速度、第三角速度，其中，第一角速度为检测车的载体坐标系相对于惯性坐标系的角速度，第二角速度为地球的自转角速度在惯性坐标系中的投影角速度，第三角速度为检测车的地理坐标系相对于地球坐标系的角速度；

第二确定模块，用于将所述第一角速度、所述第二角速度、所述第三角速度作为预设的四元数姿态角确定模型输入，确定所述检测车的姿态角；

输出模块，用于输出所述检测车的姿态角。

可选地，所述第一确定模块具体用于：

通过以下公式计算第二角速度

其中，为地球的自转角速度在惯性坐标系中的投影角速度，L为检测车的纬度，ω_ie为地球的自转角速度。

可选地，所述第一确定模块具体用于：

通过以下公式计算第三角速度

其中，为检测车的地理坐标系相对于地球坐标系的角速度，V_E为检测车在地理坐标系中的东向速度，V_N为检测车在地理坐标系中的北向速度，R_M为沿子午圈的主曲率半径，R_N为卯酉圈的主曲率半径，H为检测车的高度，L为检测车的纬度。

可选地，所述第二确定模块具体用于：

通过以下公式计算所述检测车的姿态角：

L(q)＝q^TKq-λ(q^Tq-1)

(K+λI)q＝0

其中，

q＝q₀+q₁i+q₂j+q₃k

其中，为初始姿态转换矩阵，C_n ^b为导航坐标系到载体坐标系的姿态转换矩阵，β(t)为第一中间变量，α(t)为第二中间变量，χ_n(0,t)为检测车的地理坐标系相对于地球坐标系的运动速度的函数；vⁿ为检测车在地理坐标系的速度；为地球的自转角速度在惯性坐标系中的投影角速度；为检测车的地理坐标系相对于地球坐标系的角速度；gⁿ为重力加速度在地理坐标系下投影，其中，gⁿ＝[00-g]^T；χ_b(0,t)为第一角速度的函数；f^b为检测车的比力矢量，q为姿态四元数；L(q)为导航坐标系中加速度与零加速度差值的均方差统计值，K为L(q)的矩阵，λ为矩阵K的特征值，q₀、q₁、q₂、q₃分别为构成四元数q的实数，b为载体坐标系，n为导航坐标系，θ为检测车的姿态角中的俯仰角，r为检测车的姿态角中的横滚角，为检测车的姿态角中的航向角。

第三方面，本申请实施例提供了一种计算机设备包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序，所述处理器执行所述计算机程序时实现上述方法的步骤。

本申请实施例提供的一种检测车对准方法，根据检测车的位置信息及预设信息，确定第一角速度、第二角速度、第三角速度，其中，第一角速度为检测车的载体坐标系相对于惯性坐标系的角速度，第二角速度为地球的自转角速度在惯性坐标系中的投影角速度，第三角速度为检测车的地理坐标系相对于地球坐标系的角速度；将所述第一角速度、所述第二角速度、所述第三角速度作为预设的四元数姿态角确定模型输入，确定所述检测车的姿态角。本申请通过基于四元数的姿态角确定模型计算检测车的姿态角，具有强鲁棒性、快速性和高精度的优点，提高了对准精度，进而提高了轨检车姿态解算精度。

为使本申请的上述目的、特征和优点能更明显易懂，下文特举较佳实施例，并配合所附附图，作详细说明如下。

附图说明

为了更清楚地说明本申请实施例的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，应当理解，以下附图仅示出了本申请的某些实施例，因此不应被看作是对范围的限定，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他相关的附图。

图1为本申请实施例提供的一种检测车对准方法的流程示意图；

图2为本申请实施例提供的一种检测车对准装置的第一种结构示意图；

图3为本申请实施例提供的一种检测车对准装置的第二种结构示意图；

图4为本申请实施例提供的一种计算机设备400的结构示意图。

具体实施方式

为使本申请实施例的目的、技术方案和优点更加清楚，下面将结合本申请实施例中附图，对本申请实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本申请一部分实施例，而不是全部的实施例。通常在此处附图中描述和示出的本申请实施例的组件可以以各种不同的配置来布置和设计。因此，以下对在附图中提供的本申请的实施例的详细描述并非旨在限制要求保护的本申请的范围，而是仅仅表示本申请的选定实施例。基于本申请的实施例，本领域技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例，都属于本申请保护的范围。

本申请实施例提供了一种检测车对准方法，如图1所示，该方法包括以下步骤：

S110，根据检测车的位置信息及预设信息，确定第一角速度、第二角速度、第三角速度，其中，第一角速度为检测车的载体坐标系相对于惯性坐标系的角速度，第二角速度为地球的自转角速度在惯性坐标系中的投影角速度，第三角速度为检测车的地理坐标系相对于地球坐标系的角速度；

这里，检测车一般为轨道检测车，位置信息包括检测车所处的纬度、高度、检测车在东向的速度V_E、检测车在北向的速度V_N、检测车在天向的速度V_U、预设信息包括地球子午圈的主曲率半径R_M、地球卯酉圈的主曲率半径R_N，地球自转角速度ω_ie、地球椭球长半轴R_e＝6378137m、地球椭球长半轴R_e＝6378137m、地球引力矢量Gⁿ、地球半径Rⁿ、重力加速度gⁿ等，其中，重力加速度在导航系下投影为gⁿ＝[00-g]^T。

本申请在位置姿态系统测量过程中，通常选取本地地理系作为导航坐标系。

在具体实施中，第一角速度为检测车相对于惯性坐标系的角速度一般由惯性导航系统直接量测获得。

通过以下公式计算第二角速度

其中，为地球的自转角速度在惯性坐标系中的投影角速度，L为检测车的纬度，ω_ie为地球的自转角速度。

通过以下公式计算第三角速度

其中，为检测车的地理坐标系相对于地球坐标系的角速度，V_E为检测车在地理坐标系中的东向速度，V_N为检测车在地理坐标系中的北向速度，R_M为地球子午圈的主曲率半径，R_N为地球卯酉圈的主曲率半径，H为检测车的高度，该高度一般为检测车作业时所处的当地的高度，L为检测车的纬度，该纬度一般为作业时所处的当地的纬度。

S120，将所述第一角速度、所述第二角速度、所述第三角速度作为预设的四元数姿态角确定模型输入，确定所述检测车的姿态角，这里确定的姿态角一般为检测车的初始姿态角；

这里，检测车的姿态角包括检测车的俯仰角θ、横滚角r、航向角

通过以下公式计算所述检测车的姿态角：

L(q)＝q^TKq-λ(q^Tq-1)

(K+λI)q＝0

其中，

q＝q₀+q₁i+q₂j+q₃k

其中，为初始姿态转换矩阵，C_n ^b为导航坐标系到载体坐标系的姿态转换矩阵，β(t)为第一中间变量，α(t)为第二中间变量，χ_n(0,t)为检测车的地理坐标系相对于地球坐标系的运动速度的函数；vⁿ为检测车在地理坐标系的速度；为地球的自转角速度在惯性坐标系中的投影角速度；为检测车的地理坐标系相对于地球坐标系的角速度；gⁿ为重力加速度在地理坐标系下投影，其中，gⁿ＝[0 0 -g]^T；χ_b(0,t)为第一角速度的函数；f^b为检测车的比力矢量，q为姿态四元数；L(q)为导航坐标系中加速度与零加速度差值的均方差统计值，K为L(q)的矩阵，λ为矩阵K的特征值，q₀、q₁、q₂、q₃分别为构成四元数q的实数，b为载体坐标系，n为导航坐标系，θ为检测车的姿态角中的俯仰角，r为检测车的姿态角中的横滚角，为检测车的姿态角中的航向角。

以下为计算检测车的姿态角的计算公式的推导原理：

R_M＝R_e(1-2e+3e sin²L)

R_N＝R_e(1+e sin²L)

其中，R_M为地球子午圈的主曲率半径；R_N为地球卯酉圈的主曲率半径；e为地球扁率，e＝1/298.257；R_e为地球椭球长半轴，R_e＝6378137m；

基础表达式为：

其中，β(t)和α(t)分别表达如下：

其中，χ_b(0,t)为的函数，χ_n(0,t)为的函数，vⁿ为导航坐标系的速度，静态对准中该速度为0；表示导航坐标系系相对于地球坐标系的运动速度，静态对准过程中认为该值为地球自转角速度；f^b表示直接量测获得的比力矢量，一般是由物体三轴姿态角(角速率、加速度)测量装置(Inertial measurement unit，IMU)直接量测获得的。

为了便于计算，将公式1改为四元数运算的形式为：

其中，q为姿态四元数，q^*为q的转置。

姿态四元数q满足：

其中，为第三中间变量，为第四中间变量；

其中，K阵定义如下：

基于公式6对公式(5)处理后得到的公式如下：

同时，q满足：q^Tq＝1 (8)

为了将上述条件(公式8)融入运算中，使解算方便，应用拉格朗日乘子法定义L(q)如下：

L(q)＝q^TKq-λ(q^Tq-1) (9)

其中，L(q)为导航中加速度与零加速度差值的均方差统计值，λ为K矩阵的特征值。

因此，当L(q)取得最小值时，应符合如下条件

其中，I为单位矩阵。

由于式(11)是四元数自然属性，只需将式(10)重新整理可得：

(K+λI)q＝0 (12)

L(q)表示导航中加速度与零加速度差值的均方差统计值，而K阵的最小特征值λ_min，即表示L(q)所能达到的最小值。因此，当q取对应于K阵最小特征值λ_min的特征向量时，L(q)取得最小值λ_min，此时，即为所求姿态四元数。

姿态转换矩阵可以表示为：

式中：q为上述其中，q＝q₀+q₁i+q₂j+q₃k，

继而根据公式13求得初始姿态角俯仰角θ、横滚角r、航向角为如下表达式。

其中，θ为检测车的俯仰角、r为检测车的横滚角、为检测车的航向角。

另外，公式1的推导过程如下：

在传统捷联解算算法中，通常选取地理系作为导航系。在该系中，IMU姿态微分方程如下：

其中，表示由更新的姿态矩阵，表示载体坐标系相对于导航坐标系的角速度，表示载体坐标系相对于惯性坐标系的角速度，该量由IMU直接量测获得；表示地球自转角速度在惯性系中的投影，表示导航系相对于地球系的转动角速度。

导航坐标系下的速度微分方程如下：

其中，为导航坐标系下的速度。

由于和可以表示为：

其中，χ_b(0,t)为的函数，χ_n(0,t)为的函数。

因此，可以表示为：

将上式代入速度微分方程，可得公式1：

公式5的推导原理如下：

公式(4)中姿态四元数定义为q＝[s η]，由标量部分s和矢量部分η组成，与关系表示如下：

根据四元数相乘法则如下：

其中，s₂为四元数q₂的标量部分，η₂为四元数q₂的矢量部分，s₁为四元数q₁的标量部分，η₁为四元数q₁的矢量部分。

其中，和定义为

公式23可以转化为：

继而转化为：

姿态四元数q满足：

上述算法可以实现对准，但是，观察β(t)表达式，由于每时刻真实不可知，故算法假设静基座对准下始终为零。

S130，输出所述检测车的姿态角(初始姿态角)。

在输出检测车的姿态角之前还包括：

对所述检测车的姿态角(初始姿态角)进行校准。

在具体实施中，通过反馈校验对检测车的姿态角(初始姿态角)进行校准，现有技术中已有详细的介绍，此处不再进行过多说明。

本申请实施例提供的一种检测车对准方法，根据检测车的位置信息及预设信息，确定第一角速度、第二角速度、第三角速度，其中，第一角速度为检测车的载体坐标系相对于惯性坐标系的角速度，第二角速度为地球的自转角速度在惯性坐标系中的投影角速度，第三角速度为检测车的地理坐标系相对于地球坐标系的角速度；将所述第一角速度、所述第二角速度、所述第三角速度作为预设的四元数姿态角确定模型输入，确定所述检测车的姿态角。本申请通过基于四元数的姿态角确定模型计算检测车的姿态角，具有强鲁棒性、快速性和高精度的优点，提高了对准精度，进而提高了轨检车姿态解算精度。

本申请实施例提供了一种检测车对准装置，如图2所示。该装置包括：

第一确定模块21，用于用于根据检测车的位置信息及预设信息，确定第一角速度、第二角速度、第三角速度，其中，第一角速度为检测车的载体坐标系相对于惯性坐标系的角速度，第二角速度为地球的自转角速度在惯性坐标系中的投影角速度，第三角速度为检测车的地理坐标系相对于地球坐标系的角速度；

第二确定模块22，用于将所述第一角速度、所述第二角速度、所述第三角速度作为预设的四元数姿态角确定模型输入，确定所述检测车的姿态角；

输出模块23，用于输出所述检测车的姿态角。

可选地，所述第一确定模块具体用于：

通过以下公式计算第二角速度

其中，为地球的自转角速度在惯性坐标系中的投影角速度，L为检测车的纬度，ω_ie为地球的自转角速度。

可选地，所述第一确定模块具体用于：

通过以下公式计算第三角速度

其中，为检测车的地理坐标系相对于地球坐标系的角速度，V_E为检测车在地理坐标系中的东向速度，V_N为检测车在地理坐标系中的北向速度，R_M为沿子午圈的主曲率半径，R_N为卯酉圈的主曲率半径，H为检测车的高度，该高度一般为检测车作业时所处的当地的高度，L为检测车作的纬度，该纬度一般为检测车作业时所处的当地的纬度。

可选地，所述第二确定模块22具体用于：

通过以下公式计算所述检测车的姿态角：

L(q)＝q^TKq-λ(q^Tq-1)

(K+λI)q＝0

其中，

q＝q₀+q₁i+q₂j+q₃k

其中，为初始姿态转换矩阵，C_n ^b为导航坐标系到载体坐标系的姿态转换矩阵，β(t)为第一中间变量，α(t)为第二中间变量，χ_n(0,t)为检测车的地理坐标系相对于地球坐标系的运动速度的函数；vⁿ为检测车在地理坐标系的速度；为地球的自转角速度在惯性坐标系中的投影角速度；为检测车的地理坐标系相对于地球坐标系的角速度；gⁿ为重力加速度在地理坐标系下投影，其中，gⁿ＝[0 0 -g]^T；χ_b(0,t)为第一角速度的函数；f^b为检测车的比力矢量，q为姿态四元数；L(q)为导航坐标系中加速度与零加速度差值的均方差统计值，K为L(q)的矩阵，λ为矩阵K的特征值，q₀、q₁、q₂、q₃分别为构成四元数q的实数，b为载体坐标系，n为导航坐标系，θ为检测车的姿态角中的俯仰角，r为检测车的姿态角中的横滚角，为检测车的姿态角中的航向角。

本申请实施例还提供了一种检测车对准装置，如图3所示，该装置与图2中的装置相比，还包括：校准模块24，所述校准模块24用于：

对所述检测车的姿态角进行校准。

如图4所示，本申请一实施例提供了一种计算机设备400，用于执行图1中检测车对准方法，该设备包括存储器401、处理器402及存储在该存储器401上并可在该处理器402上运行的计算机程序，其中，上述处理器402执行上述计算机程序时实现上述检测车对准方法的步骤。

具体地，上述存储器401和处理器402能够为通用的存储器和处理器，这里不做具体限定，当处理器402运行存储器401存储的计算机程序时，能够执行上述检测车对准方法，用于解决现有技术中对检测车对准效率低的问题，根据检测车的位置信息及预设信息，确定第一角速度、第二角速度、第三角速度，其中，第一角速度为检测车的载体坐标系相对于惯性坐标系的角速度，第二角速度为地球的自转角速度在惯性坐标系中的投影角速度，第三角速度为检测车的地理坐标系相对于地球坐标系的角速度；将所述第一角速度、所述第二角速度、所述第三角速度作为预设的四元数姿态角确定模型输入，确定所述检测车的姿态角。本申请通过基于四元数的姿态角确定模型计算检测车的姿态角，具有强鲁棒性、快速性和高精度的优点，提高了对准精度，进而提高了轨检车姿态解算精度。

对应于图1中的检测车对准方法，本申请实施例还提供了一种计算机可读存储介质，该计算机可读存储介质上存储有计算机程序，该计算机程序被处理器运行时执行上述检测车对准方法的步骤。

具体地，该存储介质能够为通用的存储介质，如移动磁盘、硬盘等，该存储介质上的计算机程序被运行时，能够执行上述检测车对准方法，用于解决现有技术中对检测车对准效率低的问题，根据检测车的位置信息及预设信息，确定第一角速度、第二角速度、第三角速度，其中，第一角速度为检测车的载体坐标系相对于惯性坐标系的角速度，第二角速度为地球的自转角速度在惯性坐标系中的投影角速度，第三角速度为检测车的地理坐标系相对于地球坐标系的角速度；将所述第一角速度、所述第二角速度、所述第三角速度作为预设的四元数姿态角确定模型输入，确定所述检测车的姿态角。本申请通过基于四元数的姿态角确定模型计算检测车的姿态角，具有强鲁棒性、快速性和高精度的优点，提高了对准精度，进而提高了轨检车姿态解算精度。

在本申请所提供的实施例中，应该理解到，所揭露装置和方法，可以通过其它的方式实现。以上所描述的装置实施例仅仅是示意性的，例如，所述单元的划分，仅仅为一种逻辑功能划分，实际实现时可以有另外的划分方式，又例如，多个单元或组件可以结合或者可以集成到另一个系统，或一些特征可以忽略，或不执行。另一点，所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些通信接口，装置或单元的间接耦合或通信连接，可以是电性，机械或其它的形式。

所述作为分离部件说明的单元可以是或者也可以不是物理上分开的，作为单元显示的部件可以是或者也可以不是物理单元，即可以位于一个地方，或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。

另外，在本申请提供的实施例中的各功能单元可以集成在一个处理单元中，也可以是各个单元单独物理存在，也可以两个或两个以上单元集成在一个单元中。

所述功能如果以软件功能单元的形式实现并作为独立的产品销售或使用时，可以存储在一个计算机可读取存储介质中。基于这样的理解，本申请的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来，该计算机软件产品存储在一个存储介质中，包括若干指令用以使得一台计算机设备(可以是个人计算机，服务器，或者网络设备等)执行本申请各个实施例所述方法的全部或部分步骤。而前述的存储介质包括：U盘、移动硬盘、只读存储器(ROM，Read-Only Memory)、随机存取存储器(RAM，Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。

应注意到：相似的标号和字母在下面的附图中表示类似项，因此，一旦某一项在一个附图中被定义，则在随后的附图中不需要对其进行进一步定义和解释，此外，术语“第一”、“第二”、“第三”等仅用于区分描述，而不能理解为指示或暗示相对重要性。

最后应说明的是：以上所述实施例，仅为本申请的具体实施方式，用以说明本申请的技术方案，而非对其限制，本申请的保护范围并不局限于此，尽管参照前述实施例对本申请进行了详细的说明，本领域的普通技术人员应当理解：任何熟悉本技术领域的技术人员在本申请揭露的技术范围内，其依然可以对前述实施例所记载的技术方案进行修改或可轻易想到变化，或者对其中部分技术特征进行等同替换；而这些修改、变化或者替换，并不使相应技术方案的本质脱离本申请实施例技术方案的精神和范围。都应涵盖在本申请的保护范围之内。因此，本申请的保护范围应所述以权利要求的保护范围为准。

Claims (10)

1.一种检测车对准方法，其特征在于，该方法包括：

根据检测车的位置信息及预设信息，确定第一角速度、第二角速度、第三角速度，其中，第一角速度为检测车的载体坐标系相对于惯性坐标系的角速度，第二角速度为地球的自转角速度在惯性坐标系中的投影角速度，第三角速度为检测车的地理坐标系相对于地球坐标系的角速度；

将所述第一角速度、所述第二角速度、所述第三角速度作为预设的姿态角确定模型输入，确定所述检测车的姿态角；

输出所述检测车的姿态角。

2.如权利要求1所述的方法，其特征在于，根据检测车的位置信息及预设信息，确定第二角速度，包括：

通过以下公式计算第二角速度

其中，为地球的自转角速度在惯性坐标系中的投影角速度，L为检测车的纬度，ω_ie为地球的自转角速度。

3.如权利要求1所述的方法，其特征在于，根据检测车的位置信息及预设信息，确定第三角速度，包括

通过以下公式计算第三角速度

其中，为检测车的地理坐标系相对于地球坐标系的角速度，V_E为检测车在地理坐标系中的东向速度，V_N为检测车在地理坐标系中的北向速度，R_M为沿子午圈的主曲率半径，R_N为卯酉圈的主曲率半径，H为检测车的高度，L为检测车的纬度。

4.如权利要求1所述的方法，其特征在于，所述将所述第一角速度、所述第二角速度、所述第三角速度作为预设的四元数姿态角确定模型输入，确定所述检测车的姿态角，包括：

通过以下公式计算所述检测车的姿态角：

L(q)＝q^TKq-λ(q^Tq-1)

(K+λI)q＝0

其中，

q＝q₀+q₁i+q₂j+q₃k

其中，为初始姿态转换矩阵，C_n ^b为导航坐标系到载体坐标系的姿态转换矩阵，β(t)为第一中间变量，α(t)为第二中间变量，χ_n(0,t)为检测车的地理坐标系相对于地球坐标系的运动速度的函数，vⁿ为检测车在地理坐标系的速度，为检测车在地理坐标系的速度的一阶导数；为地球的自转角速度在惯性坐标系中的投影角速度；为检测车的地理坐标系相对于地球坐标系的角速度，gⁿ为重力加速度在地理坐标系下投影，其中，gⁿ＝[0 0 -g]^T，χ_b(0,t)为第一角速度的函数，为第一角速度的转置函数；f^b为检测车的比力矢量，q为姿态四元数，q^T为姿态四元数的转置，q^*为姿态四元数的转置，L(q)为导航坐标系中加速度与零加速度差值的均方差统计值，K为L(q)的矩阵，λ为矩阵K的特征值，q₀、q₁、q₂、q₃分别为构成四元数q的实数，b为载体坐标系，n为导航坐标系，θ为检测车的姿态角中的俯仰角，r为检测车的姿态角中的横滚角，为检测车的姿态角中的航向角。

5.如权利要求1所述的方法，其特征在于，该方法还包括：

对所述检测车的姿态角进行校准。

6.一种检测车对准装置，其特征在于，该装置包括：

第一确定模块，用于根据检测车的位置信息及预设信息，确定第一角速度、第二角速度、第三角速度，其中，第一角速度为检测车的载体坐标系相对于惯性坐标系的角速度，第二角速度为地球的自转角速度在惯性坐标系中的投影角速度，第三角速度为检测车的地理坐标系相对于地球坐标系的角速度；

第二确定模块，用于将所述第一角速度、所述第二角速度、所述第三角速度作为预设的四元数姿态角确定模型输入，确定所述检测车的姿态角；

输出模块，用于输出所述检测车的姿态角。

7.如权利要求6所述的装置，其特征在于，所述第一确定模块具体用于：

通过以下公式计算第二角速度

其中，为地球的自转角速度在惯性坐标系中的投影角速度，L为检测车的纬度，ω_ie为地球的自转角速度。

8.如权利要求6所述的装置，其特征在于，所述第一确定模块具体用于：

通过以下公式计算第三角速度

其中，为检测车的地理坐标系相对于地球坐标系的角速度，V_E为检测车在地理坐标系中的东向速度，V_N为检测车在地理坐标系中的北向速度，R_M为沿子午圈的主曲率半径，R_N为卯酉圈的主曲率半径，H为检测车的高度，L为检测车的纬度。

9.如权利要求6所述的装置，其特征在于，所述第二确定模块具体用于：

通过以下公式计算所述检测车的姿态角：

L(q)＝q^TKq-λ(q^Tq-1)

(K+λI)q＝0

其中，

q＝q₀+q₁i+q₂j+q₃k

其中，为初始姿态转换矩阵，C_n ^b为导航坐标系到载体坐标系的姿态转换矩阵，β(t)为第一中间变量，α(t)为第二中间变量，χ_n(0,t)为检测车的地理坐标系相对于地球坐标系的运动速度的函数；vⁿ为检测车在地理坐标系的速度；为地球的自转角速度在惯性坐标系中的投影角速度；为检测车的地理坐标系相对于地球坐标系的角速度；gⁿ为重力加速度在地理坐标系下投影，其中，gⁿ＝[0 0 -g]^T；χ_b(0,t)为第一角速度的函数；f^b为检测车的比力矢量，q为姿态四元数；L(q)为导航坐标系中加速度与零加速度差值的均方差统计值，K为L(q)的矩阵，λ为矩阵K的特征值，q₀、q₁、q₂、q₃分别为构成四元数q的实数，b为载体坐标系，n为导航坐标系，θ为检测车的姿态角中的俯仰角，r为检测车的姿态角中的横滚角，为检测车的姿态角中的航向角。

10.一种计算机设备包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序，其特征在于，所述处理器执行所述计算机程序时实现上述权利要求1至5任一项所述的方法的步骤。