SYSTEM FOR ESTIMATING ROAD SLOPE

• US 20140309803A1
• Filed: 08/28/2013
• Published: 10/16/2014
• Est. Priority Date: 04/15/2013
• Status: Abandoned Application

• Current Assignee: Hyundai Motor Company (Hyundai Motor Group)
• Original Assignee: Hyundai Motor Company (Hyundai Motor Group)
• Inventors: YOU, Seung Han, SHIN, Young Ho
• Application Number:
  US14/012,716
• Publication Number:
  US 20140309803A1
• Time in Patent Office: Days
• US Class Current: 701/1
• CPC Class Codes: B60W 2520/105 Longitudinal acceleration
• CPC Class Codes: B60W 2520/125 Lateral acceleration
• CPC Class Codes: B60W 2520/14 Yaw
• CPC Class Codes: B60W 2520/16 Pitch
• CPC Class Codes: B60W 2520/18 Roll
• CPC Class Codes: B60W 2520/28 Wheel speed
• CPC Class Codes: B60W 2540/18 Steering angle
• CPC Class Codes: B60W 40/076 Slope angle of the road
• CPC Class Codes: G01C 9/00 Measuring inclination, e.g. by clinometers, by levels
• CPC Class Codes: G01C 9/02 Details

Abstract

A system for estimating a road slope, includes a signal processor receiving a raw signal including information on acceleration and rotation velocity transmitted from a 6 degrees of freedom (6DOF) inertial sensor, a vehicle motion estimator calculating overall angles of a vehicle based on the signals from the 6DOF inertial sensor filtered by the signal processor and on vehicle measurement information transmitted from a vehicle sensor. The system further includes a vehicle suspension angle estimator calculating a vehicle suspension angle based on the signal from the 6DOF inertial sensor and the vehicle measurement information and a road slope estimator determining a difference between the overall angles of the vehicle and the vehicle suspension angle so as to calculate a road slope.

Claims

1. A system for estimating a road slope, comprising:

a signal processor receiving raw signal signals including information on acceleration and rotation velocity transmitted from a 6 degrees of freedom (6DOF) inertial sensor, and performing filtering thereon;

a vehicle motion estimator calculating overall angles including weighted gain values of a roll angle and weighted gain values of a pitch angle of a vehicle based on the raw signals from the 6DOF inertial sensor filtered by the signal processor and on vehicle measurement information transmitted from a vehicle sensor different from the 6DOF inertial sensor;

a vehicle suspension angle estimator calculating a vehicle suspension angle based on the signal from the 6DOF inertial sensor and the vehicle measurement information; and

a road slope estimator determining a difference between the overall angles of the vehicle and the vehicle suspension angle so as to calculate the road slope.

2. The system according to claim 1, wherein a plurality of vehicle sensors different from the 6DOF inertial sensor includes a steering angle sensor and wheel speed sensors;

and

the vehicle measurement information includes steering angle measurement information and wheel speed measurement information.

3. The system according to claim 1, wherein the signal processor includes:

an offset compensator offset-compensating for the rotation velocity and the acceleration of the vehicle; and

a non-alignment error compensator compensating for an error of the 6DOF inertial sensor itself.

4. The system according to claim 3, wherein the offset compensator performs a rotation velocity correction of the vehicle using Equation 1, and performs an acceleration correction of the vehicle using Equation 2:

5. The system according to claim 3, wherein the non-alignment error compensator compensates for an orthogonal error at a time of manufacturing the 6DOF inertial sensor, a sensitivity error of the 6DOF inertial sensor itself, and a cross axis sensitivity.

6. The system according to claim 1, wherein the vehicle motion estimator includes:

a static roll/pitch calculator calculating a static roll angle and a static pitch angle of the vehicle using a predetermined acceleration equation;

an initial roll/pitch calculator determining an initial roll angle and an initial pitch angle of the vehicle when the vehicle is static;

a roll/pitch gain calculator calculating weighted gain values of the roll angle and weighted gain values of the pitch angle based on the static roll angle and the static pitch angle reflected in determining an overall angle and a pitch angle; and

an overall vehicle roll/pitch estimator calculating an overall roll angle and a pitch angle of the vehicle based on the information calculated by the static roll/pitch calculator, the initial roll/pitch calculator, and the roll/pitch gain calculator.

7. The system according to claim 6, wherein the roll/pitch gain calculator assigns weight to the static roll angle and the static pitch angle by comparing the signal from the 6DOF inertial sensor and a vehicle measurement information with a lookup table for pitch angles and a lookup table for roll angles.

8. The system according to claim 7, wherein the roll/pitch gain calculator includes:

a pitch-angle-weight determiner determining a dynamic condition if the levels of signals of longitudinal acceleration, a pitch rate, a lateral slip angle of a rear wheel and a yaw rate are equal to or higher than reference levels, and adjusting a static pitch angle gain value to a smaller value based on the lookup table for pitch angles; and

a roll-angle-weight determiner determining the dynamic condition if the levels of signals of a change rate of a steering angle, lateral acceleration, pseudo vehicle roll, and a lateral slip angle of a rear wheel are equal to or higher than reference levels, and adjusting a static roll angle gain value to a smaller value based on the lookup table for roll angles.

9-10. -10. (canceled)