[发明专利]单天线GNSS和IMU组合导航的初始对准方法及装置

说明书

本发明公开了一种单天线GNSS和IMU组合导航的初始对准方法及装置，方法包括：实时采集IMU测量数据和GNSSRTK导航数据；对IMU测量数据中的高频加速度值进行滑动平均，获得纵向加速度平滑值；根据GNSSRTK导航数据中的速度信息和纵向加速度平滑值确定载体速度与载体纵向的相对关系；根据GNSSRTK导航数据中的速度信息和航迹角确定航向角，对航向角进行连续性处理及平滑滤波，得到平滑滤波航向角；根据载体速度与载体纵向的相对关系对平滑滤波航向角进行偏差修正，得到初始航向值。本发明安装结构简单、成本低、抗磁干扰能力强，可在较宽的速度范围内获得较高精度的初始航向角，可进一步提高农机作业的自动化、智能化程度，降低物料和维护成本，提高经济效益。

技术领域

本发明涉及定位导航技术领域，尤其涉及一种单天线GNSS和IMU组合导航的初始对准方法及装置。

背景技术

全球卫星导航系统(GNSS)与惯性测量单元(IMU)形成的组合导航技术在农业方面得到了深入和广泛的研究和应用。GNSS提供广泛的不受时间影响的高精度绝对位置信息和授时信息，但容易受到天气、信号遮挡和多径的影响。IMU则可以提供不受外界影响的姿态信息和相对定位信息，两者组合可以弥补相互之间的不足，提供更加稳定可靠、精准、冗余的导航信息。

初始对准是组合导航中的一项关键技术，初始对准为组合导航提供初始的位置、速度及姿态信息(包括航向角)，初始位置、速度一般由GNSS直接给出，水平姿态由IMU的加速度计输出值计算得到；获取高精度的初始航向角则比较困难和复杂，也是初始对准的一个主要任务和目标。不同的初始对准方法，将决定组合导航系统的组成、成本和使用方式等。

现有技术中，初始对准时获取初始航向角一般包括：采用双天线GNSS的航向信息作为初始航向角；采用磁力计测量地球磁场计算初始航向角；以及采用单天线GNSS信息获得初始航向角。以上三种方式存在如下不足：

1)采用双天线GNSS的航向信息作为初始航向角：需要安装两个相对距离足够长的天线以及配合使用的高精度定位定向板卡，其安装结构复杂，多一个天线增加了成本，且双天线GNSS的定位定向板卡价格较贵，整体成本较高；

2)采用磁力计测量地球磁场计算初始航向角：该方法通过三轴磁力计测量地球磁场计算得到磁航向角，再补偿磁偏角后得到真北航向，使用之前需对磁力计进行误差标校。由于农机容易导磁，除地球磁场外，磁力计所处的磁场环境还包括变化的干扰磁场，而且磁力计标定参数的误差随时间变化。因此，这种方法容易受到干扰导致航向角误差较大，且需要经常校准磁力计参数，造成使用烦杂、维护成本高；

3)采用单天线GNSS信息获得初始航向角：该方法的常规做法是直接使用GNSS输出的航迹角作为初始航向角。但在速度较低时，航迹角与航向角的偏差较大，直接将航迹角作为初始航向角将导致初始航向角精度较低。

另外，载体纵向(车头方向)与速度方向的相对关系对获取初始航向角也至关重要，现有技术中人工指定农机车头方向将降低自动化和智能化程度，已公开的车头方向判断方法尚不成熟，尤其不能实现低速下农机车头方向的准确判断。

发明内容

本发明所要解决的技术问题是针对现有技术存在的问题，提供一种单天线GNSS和IMU组合导航的初始对准方法及装置。

为解决上述技术问题，本发明提供一种单天线GNSS和IMU组合导航的初始对准方法，包括：实时采集IMU测量数据和GNSSRTK导航数据；对IMU测量数据中的高频加速度值进行滑动平均，获得纵向加速度平滑值；根据GNSSRTK导航数据中的GNSS速度和纵向加速度平滑值确定载体速度与载体纵向的相对关系；根据GNSSRTK导航数据中的GNSS速度和航迹角确定航向角，并对航向角进行连续性处理及平滑滤波，得到平滑滤波航向角；根据载体速度与载体纵向的相对关系对平滑滤波航向角进行偏差修正，得到初始对准的初始航向值。