基于GPS与加速度计的姿态观测方法技术

本发明专利技术公开了一种基于GPS与加速度计的姿态观测方法，包括：根据GPS测量的位置信息获取地理坐标系下载体的测量加速度信息；根据地理坐标系与本体坐标系下载体的测量加速度信息，建立姿态方程；以及根据载体运动状态求解姿态方程。该方法获得的姿态信息的误差不随时间积累，具有很好的实时性，有助于提高惯性与GPS组合导航的长时间、高精度导航能力。

Attitude observation method based on GPS and accelerometer

The invention discloses a GPS and accelerometer based on the attitude observation method, including: according to the position information of GPS measurement for measurement of acceleration information download the geographical coordinates; according to the measured acceleration information download the geographic coordinate system and body coordinate system, establish the attitude equation; and according to the motion state of the carrier attitude equation solving. The error of attitude information acquired by this method does not accumulate over time, and has good real-time performance. It helps to improve the navigation ability of inertial and GPS integrated navigation for long time and high accuracy.

【技术实现步骤摘要】
基于GPS与加速度计的姿态观测方法
本公开属于组合导航
，涉及一种基于GPS与加速度计的姿态观测方法。
技术介绍
组合导航技术以测量运动载体的姿态、速度和位置信息为目的，获取姿态观测数据是惯性与GPS组合导航获取长时间、高精度测量结果的关键内容之一。组合导航技术中的主要测量器件包括陀螺和加速度计，由于实际应用中受陀螺体积、重量、功耗、价格等诸多因素的限制，常选用低精度陀螺进行集成测试，但低精度陀螺存在无法对准、导航时间短、姿态误差累积等缺点，而获取实时的、没有姿态误差累积的姿态观测数据对于提高惯性与GPS组合导航的长时间、高精度导航能力的关键点，因此，亟需提出一种姿态观测方法，能够获取实时的、误差不随时间累积的姿态信息。
技术实现思路
(一)要解决的技术问题本公开提供了一种基于GPS与加速度计的姿态观测方法，以至少部分解决以上所提出的技术问题。(二)技术方案根据本公开的一个方面，提供了一种基于GPS与加速度计的姿态观测方法，包括：根据GPS测量的位置信息获取地理坐标系下载体的测量加速度信息；根据地理坐标系与本体坐标系下载体的测量加速度信息，建立姿态方程；以及根据载体运动状态求解姿态方程。在本公开的一些实施例中，根据GPS测量的位置信息获取地理坐标系下载体的测量加速度信息包括：根据GPS测量的位置信息获取地理坐标系下载体的加速度信息，然后将载体的加速度信息和当地地球重力加速度信息进行相加获得载体的测量加速度信息；其中，根据GPS测量的位置信息获取地理坐标系下载体的加速度信息包括：根据GPS测量的连续三个时刻的GPS位置数据，利用一次求导运算和二次求导运算解得地理坐标系下载体在中间时刻的加速度信息。在本公开的一些实施例中，中间时刻的加速度信息满足：其中，t-1，t0，t1为连续三个时刻；Ae为东向加速度；An为北向加速度；Au为天向加速度；n表示在地理坐标系下的矩阵；为时刻对应的速度；为时刻对应的速度；Ve为东向速度；Vn为北向速度；Vu为天向速度。在本公开的一些实施例中，时刻对应的速度满足：时刻对应的速度满足：其中，Lat-1，Lat0，Lat1分别为t-1，t0，t1三个时刻对应的GPS纬度；Lon-1，Lon0，Lon1分别为t-1，t0，t1三个时刻对应的GPS经度；Alt-1，Alt0，Alt1分别为t-1，t0，t1三个时刻对应的GPS高度；Re为地球半径。在本公开的一些实施例中，本体坐标系下载体的测量加速度信息是利用三轴加速度计测量得到的。在本公开的一些实施例中，建立的姿态方程满足：其中，为本体坐标系下t0时刻的测量加速度信息；为地理坐标系到本体坐标系的姿态变换矩阵；为地理坐标系下t0时刻的加速度信息；为地理坐标系下地球重力加速度信息；为三轴加速度计在t0时刻的测量误差。在本公开的一些实施例中，姿态变换矩阵满足：其中，θ为俯仰角；γ为横滚角；为航向角。在本公开的一些实施例中，根据载体运动状态求解姿态方程包括：当载体做匀速直线运动或加速度小于1m/s2的变速直线运动时，将载体的加速度信息视为零，将三轴加速度计的测量误差也视为零，得到简化的姿态方程，然后进行该简化的姿态方程的求解。在本公开的一些实施例中，根据载体运动状态求解姿态方程包括：当载体做加速度大于1m/s2的变速直线运动，或者三轴加速度计的误差为定值时，采用简化后的姿态方程对俯仰角和横滚角进行求解；然后将求得的俯仰角和横滚角的解代入建立的姿态方程中，得到关于航向角的三维矩阵方程，求解航向角；该简化后的姿态方程是通过将建立的姿态方程中载体的加速度信息视为零，将三轴加速度的测量误差也视为零得到的。在本公开的一些实施例中，取关于航向角的三维矩阵方程中的两维建立航向角的方程组，该航向角的方程组满足：(三)有益效果从上述技术方案可以看出，本公开提供的基于GPS与加速度计的姿态观测方法，具有以下有益效果：通过分析GPS位置测量误差的特点，利用GPS位置信息不随时间积累的特点，给出了地理坐标系下载体运动的测量加速度信息计算方法；并结合三轴加速度计在本体坐标系下测量的加速度信息以及本体坐标系与地理坐标系间的矩阵转换关系建立姿态方程；然后结合载体运动环境求解姿态信息。该方法获得的姿态信息的误差不随时间积累，具有很好的实时性，有助于提高惯性与GPS组合导航的长时间、高精度导航能力。附图说明图1为根据本公开实施例基于GPS与加速度计的姿态观测方法的流程图。图2为根据本公开实施例基于GPS与加速度计的姿态观测方法的具体实施过程图。图3为根据本公开实施例地理坐标系与本体坐标系的坐标变换关系示意图。具体实施方式本公开提供了一种基于GPS与加速度计的姿态观测方法，通过分析GPS位置测量误差的特点，利用GPS位置信息不随时间积累的特点，给出了地理坐标系下载体运动的测量加速度信息计算方法；并结合三轴加速度计在本体坐标系下测量的加速度信息以及本体坐标系与地理坐标系间的矩阵转换关系建立姿态方程；然后结合载体运动环境求解姿态信息。该方法获得的姿态信息的误差不随时间积累，具有很好的实时性，有助于提高惯性与GPS组合导航的长时间、高精度导航能力。为使本公开的目的、技术方案和优点更加清楚明白，以下结合具体实施例，并参照附图，对本公开进一步详细说明。本公开通过分析GPS位置测量误差的特点，利用GPS位置信息不随时间积累的特点，给出了地理坐标系下载体运动的测量加速度信息计算方法。由于GPS位置测量误差的特点是只存在常值误差和随机误差，常值误差通过一次求导运算即可消除，而随机误差相对GPS位置变化存在一两个数量级的差别，通过两次求导后其影响非常小，所以充分利用GPS位置信息不随时间累积的特点，通过两次求导运算，即可获取地理坐标系下有效的载体运动的加速度信息，然后，根据GPS获取的载体运动加速度信息和当地地球重力加速度信息，两者直接相加即可获取地理坐标系下载体的测量加速度信息。本公开中提到的地理坐标系指的是：东北天空间直角坐标系，符合右手定则。在本公开的第一个示例性实施例中，提供了一种基于GPS与加速度计的姿态观测方法。图1为根据本公开实施例基于GPS与加速度计的姿态观测方法的流程图。图2为根据本公开实施例基于GPS与加速度计的姿态观测方法的具体实施过程图。参照图1和图2所示，本公开的基于GPS与加速度计的姿态观测方法，包括：步骤S102：根据GPS测量的位置信息获取地理坐标系下载体的测量加速度信息；该步骤S102包括：根据GPS测量的位置信息获取地理坐标系下载体的加速度信息，然后将载体的加速度信息和当地地球重力加速度信息进行相加获得载体的测量加速度信息；其中，根据GPS测量的位置信息获取地理坐标系下载体的加速度信息包括：根据GPS测量的连续三个时刻的GPS位置数据，利用一次求导运算和二次求导运算解得地理坐标系下载体在中间时刻的加速度信息。本实施例中，GPS的测量是基于地理坐标系进行的，定义三个连续的时刻分别为：t-1，t0，t1；在这三个时刻对应测得的GPS纬度分别为：Lat-1，Lat0，Lat1；GPS经度分别为：Lon-1，Lon0，Lon1；GPS高度分别为：Alt-1，Alt0，Alt1；已知地球半径为：Re＝6378135.072m；则利用一次求导运算可得和时本文档来自技高网...

【技术保护点】
一种基于GPS与加速度计的姿态观测方法，包括：根据GPS测量的位置信息获取地理坐标系下载体的测量加速度信息；根据地理坐标系与本体坐标系下载体的测量加速度信息，建立姿态方程；以及根据载体运动状态求解姿态方程。

【技术特征摘要】
1.一种基于GPS与加速度计的姿态观测方法，包括：根据GPS测量的位置信息获取地理坐标系下载体的测量加速度信息；根据地理坐标系与本体坐标系下载体的测量加速度信息，建立姿态方程；以及根据载体运动状态求解姿态方程。2.根据权利要求1所述的姿态观测方法，其中，所述根据GPS测量的位置信息获取地理坐标系下载体的测量加速度信息包括：根据GPS测量的位置信息获取地理坐标系下载体的加速度信息，然后将载体的加速度信息和当地地球重力加速度信息进行相加获得载体的测量加速度信息；其中，根据GPS测量的位置信息获取地理坐标系下载体的加速度信息包括：根据GPS测量的连续三个时刻的GPS位置数据，利用一次求导运算和二次求导运算解得地理坐标系下载体在中间时刻的加速度信息。3.根据权利要求2所述的姿态观测方法，其中，所述中间时刻的加速度信息满足：其中，t-1，t0，t1为连续三个时刻；Ae为东向加速度；An为北向加速度；Au为天向加速度；n表示在地理坐标系下的矩阵；为时刻对应的速度；为时刻对应的速度；Ve为东向速度；Vn为北向速度；Vu为天向速度。4.根据权利要求3所述的姿态观测方法，其中：所述时刻对应的速度满足：所述时刻对应的速度满足：其中，Lat-1，Lat0...

【专利技术属性】
技术研发人员：杨振礼，董勇伟，梁兴东，丁赤飚，
申请(专利权)人：中国科学院电子学研究所，
类型：发明
国别省市：北京,11