Low cost INS

Patent metadata

Field	Value
Publication number	US-11226203-B2
Application number	US-201816497627-A
Country	US
Kind code	B2
Filing date	Mar 28, 2018
Priority date	Mar 31, 2017
Publication date	Jan 18, 2022
Grant date	Jan 18, 2022

Abstract

This disclosure relates to an underground mining vehicle comprising a three-axis MEMS gyroscope rotatable about a rotation axis and a gyroscope interface that calculates a first rotation rate bias with respect to a first axis different to the rotation axis, a second rotation rate bias with respect to a second axis different to the first axis and different to the rotation axis, a rotation rate about the rotation axis based on the Earth rotation rate vector by correcting the rotational measurement data using the first rotation rate bias and the second rotation rate bias and a third rotation rate bias with respect to the rotation axis based on the calculated rotation rate about the rotation axis. A navigation unit receives the first rotation rate bias, the second rotation rate bias and the third rotation rate bias and calculates a pose of the vehicle.

First claim

The invention claimed is:

1. An underground mining vehicle, comprising:
a three-axis MEMS gyroscope mounted in a fixed position and pose relative to the underground mining vehicle and mounted on a rotator having a single rotation axis configured to index the three axis MEMS gyroscope about the rotation axis into multiple different orientations;
a gyroscope interface connected to the three-axis MEMS gyroscope configured to receive rotational measurement data from the three-axis MEMS gyroscope for the multiple different orientations and further configured to:
in a first step:
calculate a first rotation rate bias of the three-axis MEMS gyroscope with respect to a first axis substantially orthogonal to the rotation axis based on the rotational measurement data,
calculate a second rotation rate bias of the three-axis MEMS gyroscope with respect to a second axis substantially orthogonal to the first axis and to the rotation axis based on the rotational measurement data,
calculate a corrected first rotation rate by correcting the rotational measurement data using the first rotation rate bias;
calculate a corrected second rotation rate by correcting the rotational measurement data using the second rotation rate bias;
in a second step after the first step:
calculate an expected rotation rate about the rotation axis by performing an arithmetic operation on the Earth rotation rate vector, known for a given location of the underground mining vehicle, the corrected first rotation rate and the corrected second rotation rate; and
in a third step after the second step:
calculate a third rotation rate bias of the three-axis MEMS gyroscope with respect to the rotation axis based on the calculated expected rotation rate about the rotation axis; and

a navigation unit connected to the gyroscope interface configured to
receive the first rotation rate bias, the second rotation rate bias and the third rotation rate bias from the gyroscope interface, and
calculate a pose of the underground mining vehicle based on the Earth rotation rate vector, the first rotation rate bias, second rotation rate bias and third rotation rate bias.

2. The underground mining vehicle of claim 1 , further comprising a vehicle controller connected to the vehicle and configured to stop the vehicle;
correct an inertial navigation system while the vehicle is stopped;
cause the rotator to rotate the three-axis gyroscope while the vehicle is stopped;
cause the gyroscope interface to calculate the first, second and third rotation rate biases; and
resume movement of the vehicle based on the calculated pose.

3. The underground mining vehicle of claim 1 , further comprising a three-axis accelerometer communicatively coupled to the navigation unit, wherein the navigation unit is configured to calculate the pose based on acceleration data from the three-axis accelerometer.

4. The underground mining vehicle of claim 1 , wherein the navigation unit is an inertial navigation unit and is configured to determine an absolute location of the underground mining vehicle based on the pose.

5. The underground mining vehicle of claim 1 , wherein the gyroscope interface is configured to calculate the expected rotation rate ω third about the rotation axis according to ω third =√{square root over (ω Earth 2 −ω first 2 −ω second 2 )} where ω Earth is the Earth rotation rate vector magnitude, ω first is the corrected first rotation rate about the first axis and ω second is the corrected second rotation rate about the second axis corrected by the calculated first and second rotation rate bias, respectively.

6. The underground mining vehicle of claim 1 , further comprising a filter connected to the gyroscope interface and configured to continually track the third rotation rate bias.

7. The underground mining vehicle of claim 1 , further comprising a further three-axis MEMS gyroscope mounted in a fixed position and pose relative to the underground mining vehicle,
wherein the navigation unit is connected to the further three-axis MEMS gyroscope and is configured to receive further rotational measurement data from the further three-axis MEMS gyroscope and to calculate the pose of the underground mining vehicle based on the further rotational measurement data.

8. The underground mining vehicle of claim 1 , wherein
the gyroscope interface is configured to calculate the expected rotation rate ω third about the rotation axis according to ω third =√{square root over (ω Earth 2 −ω first 2 −ω second 2 )}, where ω Earth is the Earth rotation rate vector magnitude, ω first is the corrected first rotation rate about the first axis and ω second is corrected second rotation rate about the second axis corrected by the calculated first and second rotation rate bias, respectively;
the underground mining vehicle further comprises a three-directional accelerometer communicatively coupled to the navigation unit and the navigation unit is configured to calculate the pose based on acceleration data from the three-directional accelerometer; and
the underground mining vehicle further comprises a further three-axis MEMS gyroscope mounted in a fixed position and pose relative to the underground mining vehicle and the navigation unit is connected to the further three-axis MEMS gyroscope and is configured to receive further rotational measurement data from the further three-axis MEMS gyroscope and to calculate the pose of the underground mining vehicle based on the further rotational measurement data.

9. A method for calculating a pose of an underground mining vehicle, the method comprising:
indexing a three axis MEMS gyroscope mounted in a fixed position and pose relative to the underground mining vehicle about a single rotation axis into multiple different orientations;
receiving rotational measurement data from the three-axis MEMS gyroscope for the multiple different orientations;
in a first step:
calculating a first rotation rate bias of the three-axis MEMS gyroscope with respect to a first axis substantially orthogonal to the rotation axis based on the rotational measurement data;
calculating a second rotation rate bias of the three-axis MEMS gyroscope with respect to a second axis substantially orthogonal to the first axis and different to the rotation axis based on the rotational measurement data,
calculating a corrected first rotation rate by correcting the rotational measurement data using the first rotation rate bias;
calculating a corrected second rotation rate by correcting the rotational measurement data using the second rotation rate bias;

in a second step after the first step:
calculating an expected rotation rate about the rotation axis by performing an arithmetic operation on the Earth rotation rate vector, known for a given location of the underground mining vehicle, the corrected first rotation rate and the corrected second rotation rate; and

in a third step after the second step:
calculating a third rotation rate bias of the three-axis MEMS gyroscope with respect to the rotation axis based on the calculated expected rotation rate about the rotation axis; and

calculating a pose of the underground mining vehicle based on the Earth rotation rate vector, the first rotation rate bias, second rotation rate bias and third rotation rate bias.

10. The method of claim 9 , further comprising:
stopping the vehicle;
correcting an inertial navigation system while the vehicle is stopped;
rotating the three-axis gyroscope while the vehicle is stopped;
calculating the first, second and third rotation rate biases; and
resuming movement of the vehicle based on the calculated pose.

11. The method of claim 10 , wherein stopping t

Assignees

• Commw Scient Ind Res Org

Inventors

• Reid Peter
• Malos John
• Dunn Mark
• Pitt Alexander

Classifications

• G01C21/185

  for gravity · CPC title

• G01C21/188 Primary

  for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems · CPC title

• G01C21/20 Primary

  Instruments for performing navigational calculations (G01C21/24, G01C21/26 take precedence) · CPC title

• B81B7/02

  containing distinct electrical or optical devices of particular relevance for their function, e.g. microelectro-mechanical systems [MEMS] (B81B7/04 takes precedence) · CPC title

• G01C21/18

  Stabilised platforms, e.g. by gyroscope · CPC title