CRANE JIB ATTITUDE AND HEADING REFERENCE SYSTEM CALIBRATION AND INITIALIZATION

• US 20120271582A1
• Filed: 04/19/2011
• Published: 10/25/2012
• Est. Priority Date: 04/19/2011
• Status: Active Grant

• Current Assignee: Honeywell International Inc.
• Original Assignee: Honeywell International Inc.
• Inventors: Bageshwar, Vibhor L., Elgersma, Michael Ray, Mahadev, Balaji, Fly, Brian E., Cienciwa, Steven P.
• Granted Patent: US 8,862,419 B2
• Time in Patent Office: Days
• US Class Current: 702/92
• CPC Class Codes: B66C 13/46 Position indicators for suspended loads or for crane elements
• CPC Class Codes: B66C 23/26 for use on building sites; constructed, e.g. with separable parts, to facilitate rapid assembly or dismantling, for operation at successively higher levels, for transport by road or rail with supporting couples provided by walls or buildings B66C23/20; mounted on vehicles B66C23/36; jib constructions B66C23/64
• CPC Class Codes: G01R 33/0035 Calibration of single magnetic sensors, e.g. integrated calibration
• CPC Class Codes: G01R 33/028 Electrodynamic magnetometers

Abstract

Methods and apparatus are provided for calibrating and initializing/aligning an attitude and heading reference system of a crane jib. Magnetometer measurements are generated using a magnetometer that is attached to the crane jib, while crane jib maneuvers are performed including crane jib slewing. The magnetometer measurements are supplied to a processor that is configured to generate magnetometer calibration parameters using the magnetometer measurements and to initialize and align a plurality of filters.

Claims

1. A method of calibrating an attitude and heading reference system of a crane jib, comprising the steps of:

while one or more crane jib maneuvers are performed, collecting magnetometer measurements using a magnetometer that is attached to the crane jib;

supplying the magnetometer measurements to a processor; and

in the processor, generating magnetometer calibration parameters using the magnetometer measurements.

2. The method of claim 1, wherein:

the attitude and heading reference system includes a plurality of filters; and

the method further comprises initializing and aligning each of the filters.

3. The method of claim 1, wherein the one or more crane jib maneuvers include one or more of slewing the crane jib, moving a cable trolley mounted on the crane jib, and moving a cable hook block mounted on the crane jib.

4. The method of claim 3, wherein the one or more crane jib maneuvers includes slewing the crane jib at least one complete rotation through the available range of motion.

5. The method of claim 1, wherein the magnetometer calibration parameters are generated using a magnetometer measurement model.

6. The method of claim 5, wherein the magnetometer measurement model is defined as:

C_bmm(t_k)=A_mc(t_k)_k(t_k)+C_bmm(t_k)+C_mm(t_k),

where _m is a magnetometer measurement vector, _k is the local Earth magnetic field vector, _m is a hard iron bias vector, _m is a measurement noise vector, A_mc is a 3×

3 matrix consisting of soft iron bias, misalignment of magnetometer measurement axes, and scale factor errors of sensed magnetometer measurements, and C_bm is a direction cosine matrix from a magnetometer measurement frame to a body frame.

7. The method of claim 5, wherein the magnetometer calibration parameters are generated using an algorithm that:

fits an ellipse to the magnetometer measurements; and

computes parameters that transform the ellipse to a canonical circle.

8. A method of calibrating an attitude and heading reference system of a crane jib, comprising the steps of:

rendering commands on a display device that inform an operator to implement one or more crane jib maneuvers;

generating magnetometer measurements, using a magnetometer that is attached to the crane jib, while the one or more crane jib maneuvers are being implemented;

supplying the magnetometer measurements to a processor; and

in the processor, generating magnetometer calibration parameters using the magnetometer measurements.

9. The method of claim 8, wherein:

the attitude and heading reference system includes a plurality of filters; and

the method further comprises initializing and aligning the plurality of filters using the magnetometer calibration parameters.

10. The method of claim 8, wherein the step of initializing and aligning the plurality of filters comprises:

supplying initial state vector statistics to each of the filters, the initial state vector statistics including initial state vectors that are based in part on the magnetometer calibration parameters; and

in the processor, determining at least when filter-based measurements converge to within predetermined values of sensor measurements.

11. The method of claim 8, wherein the magnetometer calibration parameters are generated using a magnetometer measurement model.

12. The method of claim 11, wherein the magnetometer measurement model is defined as:

C_bmm(t_k)=A_mc(t_k)_k(t_k)+C_bmm(t_k)+C_bmm(t_k),

where _m is a magnetometer measurement vector, _k is the local Earth magnetic field vector, _m is a hard iron bias vector, _m is a measurement noise vector, A_mc is a 3×

3 matrix consisting of soft iron bias, misalignment of magnetometer measurement axes, and scale factor errors of sensed magnetometer measurements, and C_bm is a direction cosine matrix from a magnetometer measurement frame to a body frame.

13. The method of claim 10, wherein the magnetometer calibration parameters are generated using an algorithm that:

fits an ellipse to the magnetometer measurements; and

computes parameters that transform the ellipse to a canonical circle.

14. A crane jib attitude and heading reference system, comprising:

a plurality of magnetometers, each magnetometer configured to sense local magnetic field at least proximate the crane jib and supply magnetometer signals representative thereof; and

a processor coupled to receive the magnetometer signals and configured, upon receipt thereof, to generate magnetometer calibration parameters.

15. The system of claim 14, wherein the processor implements a plurality of filters and is further configured to supply initial state vector statistics to each of the filters.

16. The system of claim 14, wherein the processor generates the magnetometer calibration parameters using a magnetometer measurement model.

17. The system of claim 16, wherein the magnetometer measurement model is defined as:

C_bmm(t_k)=A_mc(t_k)_k(t_k)+C_bmm(t_k)+C_bmm(t_k),

where _m is a magnetometer measurement vector, _k is the local Earth magnetic field vector, _m is a hard iron bias vector, _m is a measurement noise vector, A_mc is a 3×

3 matrix consisting of soft iron bias, misalignment of magnetometer measurement axes, and scale factor errors of sensed magnetometer measurements, and C_bm is a direction cosine matrix from a magnetometer measurement frame to a body frame.

18. The system of claim 16, wherein the processor generates the magnetometer calibration parameters using an algorithm that:

fits an ellipse to the magnetometer measurements; and

computes parameters that transform the ellipse to a canonical circle.

19. The system of claim 14, wherein:

the processor implements a plurality of filters; and

the processor is further configured to initialize and align the plurality of filters using at least the magnetometer calibration parameters.

20. The system of claim 19, wherein the processor is configured to:

supply initial state vector statistics to each of the filters, the initial state vector statistics including initial state vectors that are based in part on the magnetometer calibration parameters; and

determine at least when filter-based measurements converge to within predetermined values of sensor measurements.