Camera-Based Sensor Fusion for Low-Speed Vehicle Heading

Resolve Bottlenecks,
Find Innovative Solutions
Generate Solutions

Solution Overview

Problem

Existing automatic steering systems for vehicles face challenges in accurately determining vehicle heading, especially when the vehicle is stationary or operating at low speeds, due to gyro drift and poor GNSS signal quality.

Innovation Solution

The system integrates a camera system that uses visual odometry and SLAM (Simultaneous Localization and Mapping) to maintain accurate vehicle heading without drifting, combining this data with GNSS and IMU information using fusion algorithms such as complementary filters and Kalman filters.

Engineering Contradictions & Design Principles

VSEngineering Contradiction Analysis

1Measurement precision

If wheel odometry, inertial navigation systems (INS) and degraded GNSS are used to solve heading issues, then vehicle control precision is improved, but system complexity and cost increase

Engineering Contradiction:
Improvevehicle control precisionVSAvoidsystem complexity
Core Design Contradiction:
Measurement precisionVSDevice complexity

Solution Approach 1:

The patent combines multiple sensor types (GNSS receiver, IMU, wheel speed sensors) into an integrated navigation system that fuses data from all sources through algorithms like EKF to achieve precise heading measurement without requiring complex dual-antenna systems or expensive specialized equipment

Inventive Principle:
Principle #5Merging (Combining)

Solution Approach 2:

The system uses a single GNSS antenna that serves multiple functions: providing position data, velocity data through Doppler effect, and aiding in heading determination when combined with IMU data, eliminating the need for separate dedicated sensors for each measurement type

Inventive Principle:
Principle #6Universality (Multi-functionality)

2Measurement precision

If dual antenna systems are used to measure heading and roll, then measurement precision is improved, but hardware cost and system complexity increase

Engineering Contradiction:
Improveheading measurement precisionVSAvoidantenna hardware
Core Design Contradiction:
Measurement precisionVSDevice complexity

Solution Approach 1:

The patent introduces an IMU as an intermediary device that measures vehicle orientation (roll, pitch, yaw) directly, providing heading information without requiring complex dual-antenna geometric calculations, thereby simplifying the antenna system to a single unit

Inventive Principle:
Principle #24Intermediary (Mediator)

Solution Approach 2:

The system replaces the mechanical/geometric dual-antenna heading measurement system with an inertial measurement system using gyroscopes and accelerometers in the IMU, which directly sense vehicle orientation through physical principles rather than geometric positioning

Inventive Principle:
Principle #28Mechanics substitution (Replace mechanical system)

3Device complexity

If single antenna systems with gyros and accelerometers are used, then device complexity is reduced, but heading measurement precision deteriorates due to gyro drift

Engineering Contradiction:
Improvesystem simplicityVSAvoidheading measurement precision
Core Design Contradiction:
Device complexityVSMeasurement precision

Solution Approach 1:

The system uses GNSS velocity data (derived from Doppler effect and position changes) as feedback to continuously correct and reset the drift accumulation in IMU integrated heading measurements, maintaining long-term accuracy without requiring complex dual-antenna systems

Inventive Principle:
Principle #23Feedback

Solution Approach 2:

The system performs preliminary correction of IMU drift by periodically updating heading estimates using GNSS-derived course-over-ground information before significant drift accumulation occurs, preventing rather than correcting large errors

Inventive Principle:
Principle #10Preliminary action

4Measurement precision

If GNSS course over ground information is used to compensate gyro bias, then measurement precision is improved, but reliability deteriorates at low speed and standstill due to noisy and delayed GNSS signals

Engineering Contradiction:
Improveheading compensation accuracyVSAvoidlow-speed operation reliability
Core Design Contradiction:
Measurement precisionVSReliability

Solution Approach 1:

The system dynamically adjusts the weighting and fusion strategy between IMU and GNSS data based on vehicle speed conditions, relying more on IMU predictions at low speeds where GNSS is noisy, and transitioning to GNSS-corrected fusion at higher speeds where GNSS data is reliable

Inventive Principle:
Principle #15Dynamics

Solution Approach 2:

The system changes the operational parameters of the sensor fusion algorithm based on vehicle speed, adjusting filter gains and data weighting to optimize performance across different speed regimes, ensuring reliable heading estimation whether the vehicle is stationary or moving at high speed

Inventive Principle:
Principle #35Parameter changes

Data Source

PatentEP3519768B1Using optical sensors to resolve vehicle heading issues
Publication Date: 2025.04.30 AGJUNCTION LLC
  • EP3519768B1 patent drawingFigure 1
  • EP3519768B1 patent drawingFigure 2
  • EP3519768B1 patent drawingFigure 3

AI summary

A control system (100) fuses different sensor data together to determine an orientation of a vehicle (50). The control system (100) receives visual heading data for the vehicle (50) from a camera system (102), global navigation satellite system (GNSS) heading data from a GNSS system (108), and inertial measurement unit (IMU) heading data from an IMU (110). The control system (100) may assign weights to the visual, GNSS, and IMU heading data based on operating conditions of the vehicle (50) that can vary accuracy associated with the different visual, GNSS, and IMU data. The control system (100) then uses the weighted visual, GNSS, and IMU data to determine a more accurate vehicle heading.