# US 2023/0066919 A1 · Calibrating multiple inertial measurement units

> Agents: this data is available as JSON from the patentgrep API and MCP server — see https://patentgrep.com/llms.txt

- Number: US 2023/0066919 A1
- Document ID: US20230066919A1
- Status: Published application
- Kind: A1
- Application number: 17/463,027
- Filed: 2021-08-31
- Published: 2023-03-02
- Earliest claimed: 2021-08-31
- Assignees: Zoox, Inc.
- Applicants: Zoox, Inc.
- Inventors: Siddharth Ratapani Navin; Derek Adams; Michael Carsten Bosse; Aleksandrs Ecins
- Web page: https://patentgrep.com/patent/US20230066919A1

## CPC

- G01C 25/005: {initial alignment, calibration or starting-up of inertial devices}
- B60W 30/02: Control of vehicle driving stability
- B60W 40/10: related to vehicle motion
- B60W 50/0205: {Diagnosing or detecting failures; Failure detection models}
- B60W 50/06: Improving the dynamic response of the control system, e.g. improving the speed of regulation or avoiding hunting or overshoot
- G01C 21/1652: {with ranging devices, e.g. LIDAR or RADAR}
- G01P 15/08: with conversion into electric or magnetic values
- B60W 2050/0083: {Setting, resetting, calibration}
- B60W 2420/403: Image sensing, e.g. optical camera
- B60W 2420/408: Radar; Laser, e.g. lidar
- B60W 2520/14: Yaw
- B60W 2520/16: Pitch
- B60W 2520/18: Roll
- G01C: MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY (measuring liquid level G01F; radio navigation, determining distance or velocity by use of propagation effects, e.g. Doppler effects, propagation time, of radio waves, analogous arrangements using other waves G01S)
- B60W: CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- G01P: MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT (measuring or recording blood flow A61B5/02, A61B8/06; monitoring speed or deceleration of electrically-propelled vehicles B60L3/00; vehicle lighting systems adapted to indicate speed B60Q1/54; determining position or course in navigation, measuring ground distance in geodesy or surveying G01C; combined measuring devices for measuring two or more variables of movement G01C23/00; measuring velocity of sound G01H; measuring velocity of light G01J7/00; measuring direction or velocity of solid objects by reception or emission of radiowaves or other waves and based on propagation effects, e.g. Doppler effect, propagation time, direction of propagation, G01S; measuring speed of nuclear radiation G01T; measuring acceleration of gravity G01V; {measuring or recording the speed of trains B61L23/00; speed indicators incorporated in motor vehicles B60K35/00; measuring frequency or phase G01R; traffic control G08G})

## Abstract

Systems and methods for calibrating multiple inertial measurement units on a system include calibrating a first of the inertial measurement units relative to the system using a first calibration model, and calibrating the remaining inertial measurement unit(s) relative to the first inertial measurement unit using a second calibration model. The calibration of the remaining inertial measurement unit(s) to the first inertial measurement unit can be based on a rigid body model by aligning a rotational velocity of the first inertial measurement unit with a rotational velocity of the remaining inertial measurement unit(s).

## Claims

### Claim 1

A vehicle comprising:
a first inertial measurement unit;
a second inertial measurement unit fixed relative to the first inertial measurement unit;
a sensor mounted on the vehicle and configured to generate sensor data;
one or more processors; and
memory storing instructions executable by the one or more processors to cause the vehicle to perform acts comprising:
receiving, from the first inertial measurement unit, a first angular velocity;
receiving, from the sensor, sensor data;
determining, based at least in part on a first technique, a first calibration of the first inertial measurement unit relative to the vehicle based at least in part on the first angular velocity and the sensor data;
receiving, from the second inertial measurement unit, a second angular velocity;
determining, based at least in part on a second technique, a relative rotation of the second inertial measurement unit relative to the first inertial measurement unit based at least in part on the first angular velocity and the second angular velocity;
determining a second calibration of the second inertial measurement unit relative to the vehicle based at least in part on the relative rotation and a bias between the first inertial measurement unit and the second inertial measurement unit; and
controlling, based at least in part on the first calibration or the second calibration, the vehicle based at least in part on data from the first inertial measurement unit or data from the second inertial measurement unit.

### Claim 2 (depends on 1)

The vehicle of claim 1, wherein the second technique comprises determining a rotation matrix that minimizes the sum of squared deviation between data of the first inertial measurement unit and data of the second inertial measurement unit.

### Claim 3 (depends on 1)

The vehicle of claim 1, wherein the acts further comprise:
determining, based at least in part on the second calibration, an error associated with the second inertial measurement unit.

### Claim 4 (depends on 3)

The vehicle of claim 3, wherein the acts further comprise:
determining that the error exceeds a threshold error,
wherein the controlling the vehicle comprises one of:
controlling the vehicle at the exclusion of the data from the second inertial measurement unit;
generating first weighted data based on a first weighting factor and the data from the first inertial measurement unit, generating second weighted data based on a second weighting factor and the data from the second inertial measurement unit, and controlling the vehicle based on the first weighted data and the second weighted data;
limiting functionality of the vehicle; or
requesting remote assistance for navigating the vehicle.

### Claim 5 (depends on 1)

The vehicle of claim 1, further comprising:
receiving a first linear acceleration from a first accelerometer associated with the first inertial measurement unit;
receiving a second linear acceleration from a second accelerometer associated with the second inertial measurement unit; and
determining a relative translation between the second IMU and the first IMU based at least in part on the first linear acceleration and the second linear acceleration.

### Claim 6

A method comprising:
receiving, from a first inertial measurement unit coupled to a system, first rotational velocity information;
calibrating, based at least in part on the first rotational velocity information and using a first technique, the first inertial measurement unit relative to the system;
receiving, from a second inertial measurement unit fixed relative to the first inertial measurement unit, second rotational velocity information; and
calibrating, using a second technique that determines a relative rotation of the second inertial measurement unit relative to the first inertial measurement unit, the second inertial measurement unit relative to the reference.

### Claim 7 (depends on 6)

The method of claim 6, wherein the calibrating the first inertial measurement unit relative to the reference comprises:
receiving sensor data from a sensor coupled to the system,
wherein the calibrating the first inertial measurement unit comprises comparing the first rotational velocity to the sensor data.

### Claim 8 (depends on 7)

The method of claim 7, wherein:
the calibrating the first inertial measurement unit comprises determining a transformation representative of a position of the first inertial measurement unit relative to the system; and
the calibrating the second inertial measurement unit comprises determining a product of the transformation and the relative rotation of the second inertial measurement unit relative to the second inertial measurement unit.

### Claim 9 (depends on 7)

The method of claim 7, wherein the sensor comprises one or more of a LiDAR sensor, a radar sensor, or an imaging sensor.

### Claim 10 (depends on 9)

The method of claim 9, wherein the second technique aligns the first angular velocity with the second angular velocity to determine a rotation matrix based at least in part on a least-squares optimization.

### Claim 11 (depends on 9)

The method of claim 9, wherein the second technique aligns the first angular velocity with the second angular velocity to determine a rotation matrix that minimizes the sum of squared deviation between data of the first inertial measurement unit and data of the second inertial measurement unit.

### Claim 12 (depends on 6)

The method of claim 6, further comprising:
receiving, from a third inertial measurement unit fixed relative to the first inertial measurement unit and the second inertial measurement unit, third rotational velocity information; and
calibrating, using the second technique, the third inertial measurement unit relative to the reference.

### Claim 13 (depends on 12)

The method of claim 12, wherein the calibrating the second inertial measurement unit relative to the reference and the calibrating the third inertial measurement unit relative to the reference comprises performing a joint optimization.

### Claim 14 (depends on 6)

The method of claim 6, further comprising exciting the system to induce movement of the system about a plurality of degrees of freedom.

### Claim 15 (depends on 14)

The method of claim 14, wherein the system comprises a vehicle and the exciting the system comprises controlling the vehicle to induce rotational motion corresponding to one or more of a roll, pitch, or yaw of the vehicle.

### Claim 16 (depends on 6)

The method of claim 6, wherein the system comprises a vehicle, the method further comprising:
determining a calibration error between the first inertial measurement unit and the second inertial measurement unit; and
implementing a corrective action at the vehicle based at least in part on the calibration error meeting or exceeding a threshold calibration error.

### Claim 17 (depends on 16)

The method of claim 16, wherein the corrective action comprising one or more of:
controlling the vehicle at the exclusion of the data from the second inertial measurement unit;
generating first weighted data based on a first weighting factor and the data from the first inertial measurement unit, generating second weighted data based on a second weighting factor and the data from the second inertial measurement unit, and controlling the vehicle based on the first weighted data and the second weighted data;
limiting functionality of the vehicle; or
requesting remote assistance for navigating the vehicle.

### Claim 18

A system comprising:
a first inertial measurement unit
a second inertial measurement unit fixed relative to the first inertial measurement unit;
one or more processors; and
memory storing instructions executable by the one or more processors to cause the vehicle to perform acts comprising:
receiving, from a first inertial measurement unit coupled to a system, a first rotational velocity information;
calibrating, based at least in part on the first rotational velocity information and using a first technique, the first inertial measurement unit relative to the system;
receiving, from a second inertial measurement unit fixed relative to the first inertial measurement unit, a second rotational velocity information; and
calibrating, using a second technique that determines a relative rotation of the second inertial measurement unit relative to the first inertial measurement unit, the second inertial measurement unit relative to the reference.

### Claim 19 (depends on 18)

The system of claim 18, further comprising a sensor comprising at least one of a radar sensor, a lidar sensor, or an image sensor, the acts further comprising:
receiving sensor data from the sensor,
wherein the calibrating the first inertial measurement unit comprises comparing the first rotational velocity to the sensor data.

### Claim 20 (depends on 18)

The system of claim 18, the acts further comprising:
receiving, from a third inertial measurement unit fixed relative to the first inertial measurement unit and the second inertial measurement unit, third rotational velocity information; and
calibrating, using the second technique, the third inertial measurement unit relative to the reference.
