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!