Calibrating sensor unit orientation for use in a vehicle monitoring system

• US 9,958,473 B1
• Filed: 05/01/2017
• Issued: 05/01/2018
• Est. Priority Date: 05/01/2017
• Status: Active Grant

• Current Assignee: SmartDrive Systems, Inc. (Solera Holdings Incorporated)
• Original Assignee: SmartDrive Systems, Inc. (Solera Holdings Incorporated)
• Inventors: Sljivar, Slaven, Forney, David, Freitas, Mark, Deninger, Daniel A., Griswold, Jeffrey, Palmer, Jason
• Primary Examiner(s): Hilgendorf, Dale W
• Application Number:
  US15/583,854
• Time in Patent Office: 365 Days
• CPC Class Codes: G01C 25/00 Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass testing, calibrating or compensating compasses G01C17/38
• CPC Class Codes: G01C 25/005 initial alignment, calibration or starting-up of inertial devices
• CPC Class Codes: G01P 1/04 Special adaptations of driving means
• CPC Class Codes: G01P 15/18 in two or more dimensions
• CPC Class Codes: G01P 21/00 Testing or calibrating of apparatus or devices covered by the preceding groups
• CPC Class Codes: G01P 21/02 of speedometers

Abstract

This disclosure relates to a system and method for calibrating sensors upon installation in a vehicle. The system includes a sensor set configured to generate output signals conveying vectors of acceleration of the vehicle. The system determines a three-dimensional orientation of the sensor set in relation to the vehicle. The system converts output signals from the sensor set into vectors of acceleration of the vehicle.

Claims

1. A system configured to calibrate orientation of an accelerometer upon installation in a vehicle, the system configured to couple with the vehicle, the system comprising:

a sensor set including one or more sensors, wherein the sensor set is configured to generate output signals conveying one or more vectors of acceleration of the vehicle, wherein the sensor set is positioned in or on the vehicle, wherein the sensor set has a three-dimensional orientation in relation to the vehicle, wherein the sensor set includes a speed sensor configured to generate a signal conveying speed of the vehicle;

one or more processors configured to;

determine that the vehicle is stopped based on the signal generated by the speed sensor;

determine a gravity vector based on the generated output signals and further based on the determination that the vehicle is stopped;

determine a rate of current speed change of the vehicle, based on the signal generated by the speed sensor;

compare the rate of current speed change with a speed change threshold level to determine whether a magnitude of the rate of current speed change is sufficient to assume the vehicle is not turning left or right but moving in a straight line;

determine whether the vehicle is longitudinally accelerating and not turning left or right responsive to a determination that the magnitude of the rate of current speed change has breached the speed change threshold level for at least a specified duration;

responsive to a determination that the vehicle is longitudinally accelerating and not turning left or right, determine a longitudinal vector of the vehicle based on the generated output signals;

determine the three-dimensional orientation of the sensor set in relation to the vehicle, wherein determination of the three-dimensional orientation is based on the gravity vector and the longitudinal vector; and

convert output signals generated by the sensor set into one or more vectors of acceleration of the vehicle, wherein conversion is based on the three-dimensional orientation of the sensor set in relation to the vehicle.

2. The system of claim 1, wherein the speed change threshold level corresponds to at least 0.1 g.

3. The system of claim 1, wherein the one or more processors are further configured to determine a current acceleration vector during a duration when the vehicle has been determined to be longitudinally accelerating, and wherein determining the longitudinal vector includes a subtraction of the gravity vector from the current acceleration vector.

4. The system of claim 1, wherein the one or more processors are further configured to:

determine a lateral vector that is orthogonal to both the gravity vector and the longitudinal vector;

construct a rotation matrix based on the gravity vector, the longitudinal vector, and the lateral vector; and

invert the rotation matrix,

wherein determining the three-dimensional orientation of the sensor set in relation to the vehicle is based on the inverted rotation matrix.

5. The system of claim 4, wherein determination of the lateral vector includes normalization of the longitudinal vector and performance of a cross product of the gravity vector and the longitudinal vector.

6. The system of claim 4, wherein conversion of the output signals includes multiplication of the output signals of the sensor set with the inverted rotation matrix.

7. The system of claim 1, wherein determination of the gravity vector is performed more than twice and results of the determination are aggregated.

8. The system of claim 1, wherein determination of the longitudinal vector is performed repeatedly for a duration spanning at least 10 minutes and results of the determination are aggregated.

9. The system of claim 1, wherein the one or more vectors of acceleration of the vehicle include three orthogonal vectors of acceleration.

10. The system of claim 1, wherein the sensor set includes the accelerometer.

11. The system of claim 1, wherein the sensor set includes the accelerometer and a magnetometer.

12. The system of claim 1, wherein the sensor set includes a three-axis accelerometer, a three-axis magnetometer, and a three-axis gyroscope.

13. A method to calibrate orientation of an accelerometer upon installation in a vehicle, the method comprising:

generating, by a sensor set include one or more sensors, output signals conveying one or more vectors of acceleration of the vehicle, wherein the sensor set is positioned in or on the vehicle, wherein the sensor set has a three-dimensional orientation in relation to the vehicle, wherein the sensor set includes a speed sensor that generates a signal conveying speed of the vehicle;

determine that the vehicle is stopped based on the signal generated by the speed sensor;

determining a gravity vector based on the generated output signals and further based on the determination that the vehicle is stopped;

determining a rate of current speed change of the vehicle, based on the signal generated by the speed sensor;

comparing the rate of current speed change with a speed change threshold level to determine whether a magnitude of the rate of current speed change is sufficient to assume the vehicle is not turning left or right but moving in a straight line;

determining whether the vehicle is longitudinally accelerating and not turning left or right responsive to a determination that the magnitude of the rate of current speed change has breached the speed change threshold level for at least a specified duration;

responsive to determining that the vehicle is longitudinally accelerating and not turning left or right, determining a longitudinal vector of the vehicle based on the generated output signals;

determining the three-dimensional orientation of the sensor set in relation to the vehicle, wherein determining the three-dimensional orientation is based on the gravity vector and the longitudinal vector; and

converting output signals generated by the sensor set into one or more vectors of acceleration of the vehicle, wherein converting is based on the three-dimensional orientation of the sensor set in relation to the vehicle.

14. The method of claim 13, further comprising:

determining a lateral vector that is orthogonal to the gravity vector and the longitudinal vector;

constructing a rotation matrix based on the gravity vector, the longitudinal vector, and the lateral vector; and

inverting the rotation matrix,

wherein determining the three-dimensional orientation of the sensor set in relation to the vehicle is based on the inverted rotation matrix, and

wherein converting the output signals includes multiplying the output signals of the sensor set with the inverted rotation matrix.

15. A system configured to calibrate orientation of an accelerometer upon installation in a vehicle, the system configured to couple with the vehicle, the system comprising:

a sensor set including one or more sensors, wherein the sensor set is configured to generate output signals conveying one or more vectors of acceleration of the vehicle, wherein the sensor set is positioned in or on the vehicle, wherein the sensor set has a three-dimensional orientation in relation to the vehicle, wherein the sensor set includes a speed sensor configured to generate a signal conveying speed of the vehicle;

one or more processors configured to;

determine that the vehicle is stopped based on the signal generated by the speed sensor;

determine a gravity vector based on the generated output signals and further based on the determination that the vehicle is stopped;

determine a rate of current speed change of the vehicle, based on the signal generated by the speed sensor;

compare the rate of current speed change with a speed change threshold level to determine whether a magnitude of the rate of current speed change is sufficient to assume the vehicle is not turning left or right but moving in a straight line;

make a first determination whether the magnitude of the rate of current speed change has breached the speed change threshold level for a duration that exceeds a specified duration threshold;

responsive to the first determination, make a second determination whether the vehicle is longitudinally accelerating and not turning left or right;

responsive to the second determination that the vehicle is longitudinally accelerating and not turning left or right, determine a longitudinal vector of the vehicle based on the generated output signals;

determine the three-dimensional orientation of the sensor set in relation to the vehicle, wherein determination of the three-dimensional orientation is based on the gravity vector and the longitudinal vector; and

convert output signals generated by the sensor set into one or more vectors of acceleration of the vehicle, wherein conversion is based on the three-dimensional orientation of the sensor set in relation to the vehicle.