[发明专利]惯导RTK姿态角获取方法、电子设备及存储介质

说明书

本发明公开了一种惯导RTK姿态角获取方法，计算多个历元之间的位置增量，以获得姿态矩阵，根据所述姿态矩阵中的元素计算得到俯仰角、横滚角和航向角；故其GNSS位置增量采用的是GNSS载波相位单站历元间差分模型求得的，不需要对载波相位模糊度进行固定，并且可以获得优于厘米级的位置增量，其实现难度更低，位置增量精度更高，可应用于大多数RTK固定受限场景，提高了惯导RTK的环境适应性和可用性。

技术领域

本发明涉及，尤其涉及一种惯导RTK姿态角获取方法、电子设备及存储介质。

背景技术

在惯导RTK(Real-time kinematic，载波相位差分技术)倾斜测量技术中，RTK接收机可以解算出天线相位中心的位置，然后基于GNSS/IMU(Global Navigation SatelliteSystem，全球导航卫星系统)(Inertial Measurement Unit，惯性测量单元)组合定位解算获得的RTK姿态信息，对测量杆和天线构成的杆臂进行补偿，可以将RTK接收机天线相位中心的位置补偿到测量杆杆尖指定的目标测量点位置，完成目标点RTK倾斜测量作业。GNSS/IMU组合定位解算系统首先需要解决姿态角初始化的问题，常规的方法一般需要基于RTK厘米级的高精度位置约束，实现GNSS/IMU组合解算系统姿态初始化。

在某些作业场景下如RTK差分数据链路中断时无法进行RTK解算，或者GNSS信号被严重遮挡时，RTK解算固定率低、解算出的位置精度低、可靠性差，所以可用于姿态初始化的时间窗口很少，即便完成初始化，其精度和可靠性也无法保障。故本发明要解决的问题是摆脱对RTK厘米级固定解的依赖，使其在GNSS性能受限场景下，也能够解决GNSS/IMU组合解算系统的三维姿态高精度快速初始化问题。

在某些实际测量作业过程中，需要获取墙角、斜坡和崖边等传统RTK测量杆竖直测量受限场景的位置点，因此，RTK倾斜测量技术应运而生。其无需保持测量杆的竖直即可实现目标测量点的位置测量。GNSS定位技术在工程测量领域被广泛应用，其能够实现高精度厘米级定位，但是无法提供姿态。而IMU可实时输出比力和角速率，并通过GNSS/IMU组合捷联解算可获得高精度的三维姿态信息，从而对测量杆和天线构成的杆臂进行补偿，进而将RTK接收机天线相位中心的位置补偿到测量杆杆尖指定的目标测量点位置，最终实现测量目标点位置的精确测量。

目前，倾斜测量技术中初始化三维姿态角的方法主要有以下两类：

1、利用加速度计先完成俯仰角和横滚角的初始化，再利用磁强计感应地球磁场完成航向初始化；

2、基于GNSS/IMU位置匹配的测量杆推拉方式完成姿态初始化。RTK测量杆推拉过程中，保持测量杆底部不动，构建多组RTK相位中心位置杆臂补偿到测量杆杆尖指定位置的方程，从而解算出三维姿态角。

然而，基于地磁测量完成航向初始化的方法需要对磁强计进行校准，并且磁强计容易受到外部环境磁场的干扰，导致航向精度不稳定，因而难以在测绘领域广泛应用。此外，基于GNSS/IMU位置匹配的测量杆推拉方式完成姿态初始化方法的缺点在于：此方法依赖厘米级精度的RTK固定解，在RTK固定受限场景下，如RTK差分数据链路中断、GNSS信号被遮挡导致卫星观测数少，或者多路径效应严重等场景下，无法保证连续稳定高精度高可靠性的RTK固定，所以可用于姿态初始化的时间窗口少，难以完成姿态初始化，即便完成姿态初始化其精度也无法保障，用户体验和作业效率有待提升。

发明内容

为了克服现有技术的不足，本发明的目的在于提供一种惯导RTK姿态角获取方法、电子设备及存储介质，以解决现有的RTK姿态初始化易受磁场环境干扰及依赖稳定的RTK固定解的问题。

本发明的目的采用如下技术方案实现：

一种惯导RTK姿态角获取方法，包括以下步骤：

计算多个历元之间的位置增量，以获得姿态矩阵，其中两个所述历元之间的位置增量满足以下公式：