GNSS算法相关开源代码（含多传感器融合相关项目）

梧桐Fighting

已于 2023-01-03 09:11:03 修改

阅读量4k

点赞数 8

分类专栏： GNSS 文章标签：算法人工智能物联网

于 2022-12-29 20:55:48 首次发布

本文链接：https://blog.csdn.net/dong20081991/article/details/128487851

版权

GNSS 专栏收录该内容

23 篇文章 87 订阅

订阅专栏

开源代码总览

名称	传感器类型	组合类型	滤波方法	其余相关
RTKLIB	GNSS	-	卡尔曼滤波	GAMP/rtklibexplorer
GPSTK	GNSS	-	卡尔曼滤波
BNC	GNSS	-	卡尔曼滤波	ppp_wizard
ignav	GNSS/INS	紧组合	图优化	rtklib
GVINS	GNSS/INS/视觉	紧组合	图优化
InGVIO	GNSS/INS/视觉	紧组合	Invariant EKF
OB_GINS	GNSS/INS	松组合	图优化	KF_GINS
KF_GINS	GNSS/INS	松组合	卡尔曼滤波	OB_GINS
IC_GINS	GNSS/INS/视觉	松组合	图优化

表中组合类型是以GNSS为准，即使用GNSS原始数据，则为紧组合。

滤波方法中的图优化，其实就是最小二乘，但不仅仅是最小二乘。

直接使用名称在github上搜索，就可以找到相应的项目。

以下是各个项目的详细介绍。

RTKLIB

大部分同学对rtklib均已十分熟悉，从高须知二先生2006年发布第一个版本开始，至今已16年，该开源代码可以说造福了无数的GNSS相关的研究生同学和初创公司。至今为止，rtklib依然是GNSS领域最优秀的开源软件之一。将rtklib.com关于软件的介绍粘贴如下，以示敬意。

RTKLIB is an open source program package for standard and precise positioning with GNSS (global navigation satellite system). RTKLIB consists of a portable program library and several APs (application programs) utilizing the library.

基于rtklib二次开发的，也有许多优秀的开源项目。

比如Zhou Feng在GPS Solution期刊上发表了论文“GAMP: An open-source software of multi-GNSS precise point positioning using undifferenced and uncombined observations”，开源了基于 RTKLIB 二次开发的PPP软件GAMP。

比如大名鼎鼎的rtklibexplorer，其开发者Tim Everett在2022年的谷歌智能手机定位大赛中，基于rtklib优化的后处理模式（PPK）获得了第三名的好成绩。其在个人博客网站上也一直更新大量的关于消费级观测数据的处理经验，将开源精神贯彻到底。

GPSTK

GPSTK是笔者在做研究生时就曾用过的一款GNSS开源软件，多次惊叹于其面向对象的开发架构，但也在初学阶段被绕的晕头转向，对新手不太友好。但是，工作后基本都是使用C++面向对象开发，而且基本大厂面试都会考编程，所以提前使用优势明显。

在2021年09月，GPSTK已更名为GNSSTK，并在github分为两个项目，分别为GNSSTK (libraries)和GNSSTK-APPS (applications)。GPSTK历史版本中的定位处理相关的example在新的GNSSTK (libraries)中笔者没有找到，在GNSSTK-APPS (applications)中core/apps/positioning/文件夹下，有定位相关的说明文档和程序入口。

The GPS Toolkit (GPSTk) is an open-source (LGPL) project sponsored by the Space and Geophysics Laboratory (SGL), part of the Applied Research Laboratories (ARL) at The University of Texas at Austin.

The primary goals of the GPSTk project are to:

provide applications for use by the GNSS and satellite navigation community.

provide a core library to facilitate the development of GNSS applications.

BKG Ntrip Client (BNC)

BNC是专门为实时定位而生的软件。大量的同学使用其作为实时精密单点定位的基础软件进行二次开发。RTKLIB理论上也支持实时PPP，具体情况笔者未做验证。

PPP-Wizard则是法国CNES分析中心基于BNC修改的一款实时PPP定位软件，功能更加强大。

The BKG Ntrip Client (BNC) is an Open Source multi-stream client program designed for a variety of real-time GNSS applications. It was primarily designed for receiving data streams from any Ntrip supporting Broadcaster. The program handles the HTTP communication and transfers received GNSS data to a serial or IP port feeding networking software or a DGPS/RTK application. It can compute a real-time Precise Point Positioning (PPP) solution from RTCM streams or RINEX files. During the last years BNC has been enriched with RINEX quality and editing functions. You can run BNC with GUI as well as in batch processing mode.

ignav

ignav是基于rtklib二次开发的GNSS/INS紧组合算法。对于熟悉rtklib的同学，如果想扩展自己的技术路线，学习GNSS/INS组合导航相关算法，ignav是一个不错的选择。

ignav基本将现有的一些组合算法均已实现，包括但不限于与RTK的紧组合/里程计辅助/非完整性约束等。而且ignav的编码风格与rtklib一脉相承，注释以及文档一应俱全，对初学者十分友好。

ignav为四年前作者苏景岚提交到github上，从i2nav团队网站上了解到苏同学2019年硕士毕业，毕业论文：《车载视觉/INS/GNSS多传感器融合定位定姿算法研究》。如果ignav是苏个人硕士期间完成，只能感叹一句，大佬！

附上github简介:

IGNAV基于RTKLIB开发的INS/GNSS组合导航算法库，采用C语言编写；IGNAV适用于车载场景，目前正进行INS/GNSS融合视觉信息、激光雷达的算法编写，后续会逐步更新。 IGNAV主要功能包括：

松耦合算法；
SPP、PPP、DGPS、RTK紧耦合算法；
里程计辅助；
磁力计辅助；
NHC、ZUPT、ZARU等运动约束；
Doppler辅助INS/GNSS；
双天线航向辅助；
静对准、动对准初始化；
INS正向和反向机械编排；
INS/GNSS正向和反向组合滤波；
初步支持视觉信息辅助定位定姿；
RTS/前后向滤波平滑；
车载轨迹动态显示等。

GVINS

是香港科技大学空中机器人组发布的最新的使用GNSS原始观测量的多传感器（GNSS/INS/camera）融合开源项目。其使用伪距和多普勒观测值，与INS以及视觉同时进行图优化，可以在全场景提供连续的平滑的6-Dof位姿。

笔者没有去深入研究该代码，不过想来应该可以仅进行GNSS+IMU的组合导航运算。对于想基于图优化进行GNSS+IMU紧组合研究的同学，该套代码是一个不错的选择。

不过对GNSSer有点不友好的地方，就是需要在ROS环境下运行。ROS是机器人操作系统（Robot Operating System）的英文缩写，主要在linux系统下运行，所以需要多学习一些ROS的概念、模块以及通信等。

GVINS is a non-linear optimization based system that tightly fuses GNSS raw measurements with visual and inertial information for real-time and drift-free state estimation. By incorporating GNSS pseudorange and Doppler shift measurements, GVINS is capable to provide smooth and consistent 6-DoF global localization in complex environment. The system framework and VIO part are adapted from VINS-Mono. Our system contains the following features:

global 6-DoF estimation in ECEF frame;
multi-constellation support (GPS, GLONASS, Galileo, BeiDou);
online local-ENU frame alignment;
global pose recovery in GNSS-unfriendly or even GNSS-denied area.

InGVIO

InGVIO是清华大学近期开源的一套多传感器数据融合项目，是基于invariant-EKF，紧融合GNSS伪距和多普勒，以及惯性传感器和单/双目视觉数据。从其论文来看，与当前基于图优化和基于EKF的算法相比， invariant-EKF在准确性和计算负载方面提供了极具竞争力的结果。

与代码同时开源的，还有一组固定翼机载数据，下载地址请参考项目github。

因为涉及到了视觉，所以ROS系统必不可少。好消息是InGVIO与GVINS使用相同的GNSS数据结构体gnss_comm，只需熟悉一次。

InGVIO is an invariant filter approach for fusion of monocular/stereo camera, IMU and raw GNSS measurements including pseudo ranges and Doppler shifts. InGVIO is intrinsically consistent under conditional infinitesimal invariance of the GNSS-Visual-Inertial system. InGVIO has the following key features: (a) fast due to decoupled IMU propagation, key-frame marginalization strategy and no SLAM-features; (b) accurate due to intrinsic consistency maintenance; (c) better convergence properties than 'naive' EKF-based filters.

KF_GINS OB_GINS IC_GINS

三个项目均是武汉大学多源智能导航实验室（i2Nav）今年开源的多传感器融合的项目代码。不过遗憾的是，均是以松组合的形式融合GNSS数据。

其中KF_GINS、OB_GINS分别为基于EKF和图优化的数据处理方法，其输入和输出相同，两套开源代码可以同时阅读，相互印证。

IC_GINS则因为视觉的加入，同样需要基于ROS系统，但其代码与OB_GINS也有很多相通之处。

除了开源代码，i2Nav团队还在bilibili视频网站上传了《惯性导航与GNSS/INS组合导航原理》课程视频以及在其i2Nav官网提供课程讲义下载，真真的是广大同学的福音。最新的视频还有一节辜声峰老师讲的“GNSS/INS紧组合算法”。bilibili还有西工大严恭敏老师惯性导航相关视频，搭配严老师的书籍，方便快速入门。

We open-source OB_GINS, an optimization-based GNSS/INS integrated navigation system. The main features of OB_GINS are as follows:

- A sliding-window optimizer for GNSS/INS integration;

- Abstract IMU-preintegration implementation, including:

- The normal IMU preintegration without the Earth's rotation consideration;

- The normal IMU/ODO preintegration;

- The refined IMU preintegration with the Earth's rotation consideration;

- The refined IMU/ODO preintegration;

- Implementation of the marginalization;

- Tools for attitude parameterization and coordinate frames;

- Tools for file IO;