Device and method for estimating slip angle of vehicle wheel

Patent metadata

Field	Value
Publication number	US-10625747-B2
Application number	US-201615771150-A
Country	US
Kind code	B2
Filing date	Sep 7, 2016
Priority date	Nov 11, 2015
Publication date	Apr 21, 2020
Grant date	Apr 21, 2020

Abstract

A device of estimating a slip angle of vehicle wheel has an attitude-toward-road surface estimation section that uses a series of distances to measurement points on a road surface to estimate vehicle-body-road-surface coordinate conversion information (VCCI) for conversion from a vehicle-body coordinate system to a road-surface coordinate system, an on-road-surface inertia quantity calculation section that removes a gravity acceleration component from the vehicle-body inertia quantity to obtain inertia quantity caused by motion of a vehicle body and uses the VCCI to convert from the inertia quantity caused by the motion of the vehicle body to the road-surface coordinate system, and a wheel slip angle estimation section that estimates a sideslip angle of the vehicle wheel on the basis of a difference between a wheel acceleration vector and the acceleration vector converted to the road-surface coordinate system.

First claim

The invention claimed is:

1. A device for estimating a slip angle of a vehicle wheel of a dump truck, the dump truck being equipped with vehicle wheels and a vehicle body on the vehicle wheels via suspensions, and comprising a three-axis acceleration sensor that is mounted to the vehicle body to output an acceleration of the vehicle body, a gyro sensor that is mounted to the vehicle body to output an angular velocity of the vehicle body, one or more Laser Imaging Detection and Ranging (LIDAR) sensors configured to measure a distance to a road surface including a wheel-road contact point of the vehicle wheel mounted to the vehicle body, and
a processor programmed to:
use a series of distances to measurement points on the road surface measured by the one or more LIDAR sensors to estimate vehicle body coordinate system-road surface coordinate system conversion information for conversion from a vehicle body coordinate system of a three orthogonal axis system including a longitudinal axis of the vehicle body, a lateral axis of the vehicle body and an up-down axis orthogonal to both the longitudinal axis and the lateral axis, to a road surface coordinate system of a three orthogonal axis system including two orthogonal axes obtained by projecting the longitudinal axis and the lateral axis onto the road surface and a road surface vertical axis perpendicular to the two orthogonal axes;
remove a gravity acceleration component from acceleration of the vehicle body measured by the three-axis acceleration sensor defined by the vehicle body coordinate system in order to obtain an acceleration caused by vehicle body motion, and
use the vehicle body coordinate system-road surface coordinate system conversion information to convert from the acceleration caused by vehicle body motion and angular velocity output by the gyro sensor to the road surface coordinate system;
acquire a steering angle of the vehicle wheel and acquire a wheel speed of the vehicle wheel;
determine a wheel acceleration vector derived from the wheel speed of the vehicle wheel along an inclination direction of the vehicle wheel, on the basis of the steering angle and the wheel speed;
use the acceleration and angular velocity caused by vehicle body motion converted to the road surface coordinate system to calculate an acceleration vector at the wheel-road contact point derived from the three-axis acceleration sensor and the gyro sensor; and
estimate a sideslip angle of the vehicle wheel on the basis of a difference between the acceleration vector and the wheel acceleration vector at a wheel-road contact point.

2. The device for estimating a slip angle of a vehicle wheel of the dump truck according to claim 1 ,
wherein the processor is further programmed to:
obtain a normal vector to the road surface defined by the vehicle body coordinate system, on the basis of the series of distances to measurement points on the road surface,
calculate an inclination angle of the road surface vertical axis and the normal vector, and
use the inclination angle to estimate the vehicle body coordinate system-road surface coordinate system conversion information.

3. The device for estimating a slip angle of a vehicle wheel of the dump truck according to claim 1 ,
wherein the processor is further programmed to:
measure a roll angle, a pitch angle and a yaw angle which are conversion parameters from a global coordinate system of which relation to the road surface coordinate system is perpetually constant, to the vehicle body coordinate system,
estimate global coordinate system-vehicle body coordinate system conversion information to convert from the global coordinate system, to the vehicle body coordinate system on the basis of these measured values,
use the global coordinate system-vehicle body coordinate system conversion information to convert from gravity acceleration to the vehicle body coordinate system, and
remove gravity acceleration, after the conversion, from the acceleration of the vehicle body measured by the three-axis acceleration sensor.

4. The device for estimating a slip angle of a vehicle wheel of the dump truck according to claim 1 ,
wherein the processor is programmed to:
determine a centripetal acceleration vector in the road surface coordinate system from a difference of the wheel acceleration vector and the acceleration vector, and
estimate, as a sideslip angle of the vehicle wheel, an angle formed between the centripetal acceleration vector and a vector crossing perpendicular to the wheel acceleration vector on the road surface.

5. The device for estimating a slip angle of a vehicle wheel of the dump truck according to claim 1 ,
wherein the dump truck further comprises a front left wheel, a front right wheel, a rear left wheel and a rear right wheel, and
wherein the processor is programmed to:
determine, for each of the front left vehicle wheel, the front right vehicle wheel, the rear left vehicle wheel and the rear right vehicle wheel, the wheel acceleration vector at each wheel-road contact point of each vehicle wheel in contact with the road surface, and the acceleration vector derived from the three-axis acceleration sensor at the each wheel-road contact point.

6. The device for estimating a slip angle of a vehicle wheel of the dump truck according to claim 1 ,
wherein the one or more LIDAR sensors measure two or more points on the road surface which are able to be connected or approximated by a single straight line intersecting a travel direction of the vehicle body at the same time of sampling.

7. A device for estimating a slip angle of a vehicle wheel of a dump truck, the dump truck being equipped with vehicle wheels and a vehicle body on the vehicle wheels via suspensions, and comprising: a stroke sensor that measures a stroke distance between the vehicle wheel and the vehicle body, a vehicle body speed measurement device configured to include a GNSS antenna or a millimeter-wave radar that measures a speed of the vehicle body, a yaw rate sensor that measures a yaw rate of the vehicle body, and
a processor programmed to:
use the stroke distance to estimate vehicle body coordinate system-road surface coordinate system conversion information for conversion from a vehicle body coordinate system of a three orthogonal axis system including a longitudinal axis of the vehicle body, a lateral axis of the vehicle body and an up-down axis orthogonal to both the longitudinal axis and the lateral axis, to a road surface coordinate system of a three orthogonal axis system including two orthogonal axes and a road surface vertical axis perpendicular to the two orthogonal axes, the two orthogonal axes being obtained by projecting the longitudinal axis and the lateral axis onto a plane parallel to the road surface contacted by the vehicle wheel in an axle location of an axle connecting the vehicle wheels;
convert from angular velocity of the vehicle body output by the yaw rate sensor and a vehicle body velocity vector measured by the vehicle body speed measurement device to the road surface coordinate system on the basis of the vehicle body coordinate system-road surface coordinate system conversion information;
estimate a vehicle body velocity vector expressed in the road surface coordinate system in the axle location on the plane on the basis of the angular velocity of the vehicle body and the vehicle body velocity vector which have been converted to the road surface coordinate system; and
estimate a sideslip angle of the vehicle wheel, based on an acquired steering angle, and a value obtained by dividing a lateral component of a vehicle body velocity vector in the axle location by magnitude of the vehicle body velocity vector.

8. A method for estimating a slip angle of a vehicle wh

Assignees

• Hitachi Construction Mach Co

Inventors

• Bando Mikio
• Ono Yukihiko
• Satou Takayuki
• Ishimoto Hidefumi

Classifications

• B60W40/103

  Side slip angle of vehicle body · CPC title

• B60W2720/125

  Lateral acceleration · CPC title

• B60W40/10

  related to vehicle motion · CPC title

• B60W2520/18

  Roll · CPC title

• B60W2520/28

  Wheel speed · CPC title