ANGULAR VELOCITY DETECTING DEVICE, ANGULAR VELOCITY DETECTING METHOD, MOVEMENT STATE DETECTING DEVICE AND NAVIGATION DEVICE

• US 20130238277A1
• Filed: 07/15/2011
• Published: 09/12/2013
• Est. Priority Date: 11/18/2010
• Status: Abandoned Application

• Current Assignee: Furuno Electric Co, Ltd
• Original Assignee: Furuno Electric Co, Ltd
• Inventors: Toda, Hiroyuki, Sasakura, Hiroshi
• Application Number:
  US13/988,202
• Publication Number:
  US 20130238277A1
• Time in Patent Office: Days
• US Class Current: 702/141
• CPC Class Codes: G01C 19/5776 Signal processing not specific to any of the devices covered by groups G01C19/5607 - G01C19/5719
• CPC Class Codes: G01C 25/005 initial alignment, calibration or starting-up of inertial devices

Abstract

An angular velocity detecting device which can estimate and detect correct mounting angles of a gyro sensor is achieved using outputs from the gyro sensor. The gyro sensor measures angular velocities in a sensor coordinate system and outputs them to an angular velocity calculating unit. A bias component removing unit of the angular velocity calculating unit carries out time average processing of the sensor coordinate system angular velocities, divides the sensor coordinate system angular velocities by time average values, and outputs them to a misalignment angle estimating unit. The misalignment angle estimating unit calculates, during a period in which a movable body is turning, a roll direction misalignment angle αφ using an angular velocity ω_y^se in a pitch angle θ direction and an angular velocity ω_z^se in a heading ψ direction in the sensor coordinate system. The misalignment angle estimating unit calculates a pitch direction misalignment angle Δθ using an angular velocity ω_x^se in a roll angle φ direction and an angular velocity ω_z^se in the heading ψ direction.

Claims

1. An angular velocity detecting device mounted to a movable body and for detecting angular velocities of the movable body, comprising:

a gyro sensor for measuring angular velocities in three axes perpendicular to each other in a sensor coordinate system;

a misalignment angle estimating unit for estimating, based on the angular velocities in the sensor coordinate system, angular differences between the three axes of the gyro sensor perpendicular to each other and three axes of the movable body perpendicular to each other; and

a coordinates converting unit for converting the angular velocities in the sensor coordinate system into angular velocities in a movable body coordinate system based on the angular differences.

2. The angular velocity detecting device of claim 1, comprising a bias component removing unit for removing bias components of the angular velocities, wherein the misalignment angle estimating unit and the coordinates converting unit performs the calculations using the angular velocities after the bias components are removed.

3. The angular velocity detecting device of claim 2, wherein the bias component removing unit removes the bias components by correcting the angular velocities using time average values of the angular velocities outputted from the gyro sensor.

4. The angular velocity detecting device of claim 1, comprising a frequency analyzing unit for performing a frequency analysis of the angular velocities and calculating angular velocities comprised of frequency components obtained by removing the frequency components of the bias components and the noise components, wherein the misalignment angle estimating unit and the coordinates converting unit performs the calculations using the angular velocities outputted from the frequency analyzing unit.

5. The angular velocity detecting device of claim 4, wherein the frequency analyzing unit performs the frequency analysis using a wavelet conversion.

6. The angular velocity detecting device of claim 1, comprising a turning detection unit for detecting that the movable body is turning based on acceleration of the movable body and angular velocities detected in the past.

7. The angular velocity detecting device of claim 1, comprising:

an attitude angle detecting unit for detecting an attitude angle of the movable body using the angular velocities detected by the angular velocity detecting device;

an acceleration sensor for detecting acceleration of the movable body;

a positioning unit for receiving positioning signals and measuring a position, a speed, and a heading of the movable body; and

a movement state calculating unit for calculating a movement state containing a position, a speed, and an attitude angle of the movable body using the attitude angle obtained from the attitude angle detecting unit, the acceleration obtained from the acceleration sensor, and the position, the speed and the heading obtained from the positioning unit.

8. The movement state detecting device of claim 7, comprising a user informing unit for informing navigational information containing the movement state.

9. An angular velocity detecting method for detecting angular velocities of a movable body, comprising the steps of:

measuring angular velocities in three axes perpendicular to each other;

estimating, based on the angular velocities on the three axes perpendicular to each other, angular differences between the three axes of a gyro sensor perpendicular to each other and three axes of the movable body perpendicular to each other,

converting the angular velocities in a sensor coordinate system into angular velocities in a movable body coordinate system based on the angular differences.

10. The angular velocity detecting method of claim 9, comprising removing bias components of the angular velocities, wherein the estimating angular differences and the converting the angular velocities include performing the calculations using the angular velocities after the bias components are removed.

11. The angular velocity detecting method of claim 10, wherein the removing bias components includes removing the bias components by correcting the angular velocities using time average values of the measured angular velocities.

12. The angular velocity detecting method of claim 9, comprising performing a frequency analysis of the angular velocities and calculating angular velocities comprised of frequency components obtained by removing the frequency components of the bias components and the noise components, wherein the estimating angular differences and the converting the angular velocities include performing the calculations using the angular velocities calculated by the performing a frequency analysis.

13. The angular velocity detecting method of claim 12, wherein the performing a frequency analysis includes performing the frequency analysis using a wavelet conversion.

14. The angular velocity detecting method of claim 9, comprising detecting that the movable body is turning based on acceleration of the movable body.