Design of a Multi-Source Fusion Navigation Architecture for Vehicles Based on INS, GNSS, and Odometry

In automotive applications, individual navigation sources possess inherent limitations: Inertial Navigation Systems (INS) offer high short-term accuracy, yet their errors diverge over time; GNSS provides absolute positioning but is susceptible to signal obstruction and multipath effects; and odometry (ODO)—relying on wheel speed—yields stable velocity observations, though it is affected by wheel slip and variations in tire radius. The core challenge in multi-source fusion lies in maintaining the continuity and consistency of the navigation solution, even when observation quality fluctuates and sensor failures occur unpredictably.

System Architecture

The fusion system employs a federated filtering architecture, utilizing the INS as a common reference system, while GNSS and odometry serve as local filters. A master filter is responsible for information fusion and fault detection. The state vector is defined as a 15-dimensional error state:

最小化图片
编辑图片
删除图片

INS Mechanization and Error Propagation

The INS recursive equations are:

最大化图片
编辑图片
删除图片

 

最小化图片
编辑图片
删除图片

 

最大化图片
编辑图片
删除图片

After linearization, the error-state propagation model is obtained:

最大化图片
编辑图片
删除图片
最大化图片
编辑图片
删除图片

Observation Model

(1) GNSS Observations

GNSS provides position and velocity observations:

最大化图片
编辑图片
删除图片

The observation matrix is:

最大化图片
编辑图片
删除图片

(2) Odometer observations

The relationship between the odometer output—scalar velocity v_{ODO}—and the INS velocity is as follows:

最小化图片
编辑图片
删除图片

After linearization

最大化图片
编辑图片
删除图片
最大化图片
编辑图片
删除图片

in

最大化图片
编辑图片
删除图片

The fusion equation for the main filter of a federated filter is:

最大化图片
编辑图片
删除图片
最大化图片
编辑图片
删除图片

The principles for information distribution are as follows:

最大化图片
编辑图片
删除图片
最大化图片
编辑图片
删除图片
最大化图片
编辑图片
删除图片

Fault Detection and Adaptation

Fault detection using residual chi-square test:

最大化图片
编辑图片
删除图片

Further introduce an adaptive factor a_k to adjust the observation noise matrix:

最大化图片
编辑图片
删除图片

When GNSS signal quality degrades (e.g., a reduction in the number of visible satellites or an increase in the Dilution of Precision, DOP), the parameter $a_k$ is adaptively increased, which is mathematically equivalent to reducing the weight assigned to GNSS<

оставить сообщение

оставить сообщение
Если вас заинтересовала наша продукция и вы хотите узнать больше подробностей, пожалуйста, оставьте сообщение здесь, мы ответим вам как можно скорее.

Дом

Продукты

whatsApp

контакт

КОРЗИНА
item.name
[[ item.product_name ]]
[[ line.text ]]
[[ item.delivery_text ]]
* [[ item.qty ]]
Your Cart Is Empty!