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

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

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为天向速度。

3、4、2、1 转子就位后的测量检查测量转子的晃度转子轴颈的晃度是指由于轴颈的加工误差，造成轴颈外圆不同心所形成的椭圆度。本发明采用在高度轴的两端，各设置一只高度钢带码盘，即数字角度编码器，以及两对正交对径分布的读数头，由各码盘偏心误差的变化，即对径两读数头读数之差值的变化，分别解算出各轴端由轴系误差引起的跳动方向和量值，进而解算出高度轴在观测过程中的实时偏摆的方向和量值，从而替代轴准直器，由于光栅码盘的测量结果是数字量，因此大大提高了高度轴线摆动量测量的效率，并且检测结构较简单。第五天的控制点坐标计算和展绘工作，前面三天的测量我们历经辛苦，一边测量，一边记录~计算~检查~校对误差，最终很好地控制了误差，因此利用老师给出了b9点的三维坐标，很快地完成了坐标计算和展绘的工作。

在本公开的一些实施例中，取关于航向角的三维矩阵方程中的两维建立航向角的方程组，该航向角的方程组满足：(三)有益效果从上述技术方案可以看出，本公开提供的基于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

全部详细技术资料下载 我是这个专利的主人