Back to results
US 10,761,218 B2Granted
System for land vehicle navigation and corresponding method
AssigneeSTMicroelectronics S.r.l.
InventorsNicola Matteo Palella, Leonardo Colombo
Life of this patent
Estimating the term…
Abstract
In an embodiment, a system for land vehicle navigation includes: a GNSS receiver providing GNSS data, a set of sensors positioned on a wheel of a vehicle and on board the vehicle; and a processing unit. An on-wheel unit is located on the wheel of the vehicle, the on-wheel unit including a first subset of sensors. An on-board unit includes a second subset of sensors configured to generate a second sensor data. The processing unit is configured to process the first and second sensor data to obtain the distance and the attitude of vehicle and to perform a fusion with the GNSS data.
Claims21
A system for land vehicle navigation comprising:
- a Global Navigation Satellite System (GNSS) receiver configured to provide GNSS data;
- a set of sensors positioned on a wheel of a vehicle and on board the vehicle, wherein the set of sensors is configured to generate sensor data that can be processed to obtain a distance travelled by the vehicle and an attitude of vehicle;
- a processor configured to perform a fusion of the sensor data from the set of sensors and the GNSS data, the processor including a velocity calculation block having a first feedback path and a navigation engine block having a second feedback path;
- an on-wheel unit located on the wheel of the vehicle, the on-wheel unit comprising a first wireless communication module, and a first subset of sensors of the set of sensors, the first subset of sensors configured to generate first sensor data that can be processed to obtain the distance travelled by the vehicle;
- an on-board unit comprising the GNSS receiver, a second wireless communication module, and a second subset of sensors of the set of sensors, the second subset of sensors configured to generate second sensor data that can be processed to obtain the attitude of vehicle, wherein the first and second wireless communication modules are configured to establish a wireless link to exchange over the wireless link the first sensor data, the on-board unit being configured to operate in association with the processor to process the first and second sensor data to obtain the distance and the attitude of the vehicle and to perform the fusion with the GNSS data;
- and
- a plurality of calibration blocks coupled to at least one of the on-wheel unit and/or on-board unit and coupled to at least one of the first or second feedback paths,
- wherein the processor is further configured to:
- assess if the vehicle is stationary based on the first subset of sensors,
- when the vehicle is stationary, determine a bias error based on the first subset of sensors and update a bias estimate based on the bias error, and
- when the vehicle is moving, determine a velocity of the vehicle based on the updated bias estimate.
8 more elements
A method for land vehicle navigation, the method comprising:
- receiving sensor data from a plurality of inertial sensors, wherein a first subset of sensors of the plurality of inertial sensors is located on a wheel of a vehicle, and a second subset of sensors of the plurality of inertial sensors is located on board of the vehicle, and wherein the plurality of inertial sensors are external to the vehicle;
- receiving Global Navigation Satellite System (GNSS) position, velocity, heading and time values from a GNSS receiver;
- calibrating the sensor data with calibration parameters;
- calculating inertial position, heading, velocity and time values based on the sensor data, without using GNSS position, velocity, heading and time values;
- calculating a quality indicator, indicative of a quality of the GNSS position, heading, velocity and time values, based on a GNSS signal power of a GNSS signal received by the GNSS receiver;
- computing respective error values as differences between inertial and GNSS position velocity, and heading values in a velocity calculation block and a navigation engine block of a processor;
- updating the calibration parameters as a function of the calibration parameters and the respective error values via a feedback path from at least one of the velocity calculation block and the navigation engine block of the processor;
- calculating a corrected position, heading, velocity and time values as a function of the respective error values by weighting a contribution of the GNSS position, heading, velocity and time values based on the quality indicator when the GNSS signal power is above a power threshold, wherein the quality indicator comprises a value between 0 and 1 based on the GNSS signal power;
- and
- transmitting the corrected position, heading, velocity and time values.
7 more elements
A vehicle comprising:
- a wheel comprising an on-wheel unit, the on-wheel unit comprising a first wireless module and a first inertial sensor, the first inertial sensor configured to generate first inertial data;
- and
- an on-board unit comprising:
- a Global Navigation Satellite System (GNSS) receiver configured to receive a GNSS signal having a GNSS signal power and configured to provide GNSS data based on the GNSS signal,
- a second inertial sensor configured to generate second inertial data,
- a second wireless module configured to establish a wireless link with the first wireless module, and
- a processor configured to:
- calculate inertial position, heading, velocity and time values of the vehicle based on the first and second inertial data,
- calculate a GNSS quality indicator indicative of a quality of GNSS data based on the GNSS signal power,
- compute corrected position, velocity, heading and time values of the vehicle by weighting a contribution of the GNSS data based on the GNSS quality indicator when the GNSS signal power is above a power threshold, wherein the GNSS quality indicator comprises a value between 0 and 1 based on the GNSS signal power, and
- generate position and velocity error signals for calibration blocks associated with the on-wheel unit and/or on-board unit via one or more feedback paths.
8 more elements
Dependencies are inferred from the claim text.