ATTITUDE DETERMINATION METHOD, POSITION CALCULATION METHOD, AND ATTITUDE DETERMINATION DEVICE

• US 20130338915A1
• Filed: 03/01/2012
• Published: 12/19/2013
• Est. Priority Date: 03/02/2011
• Status: Active Grant

• Current Assignee: Seiko Epson Corporation (Seiko Group)
• Original Assignee: Seiko Epson Corporation (Seiko Group)
• Inventors: Mizuochi, Shunichi, Kumar, Anand, Sato, Akinobu, Onda, Kenji, Sanjay, Rama
• Granted Patent: US 9,494,428 B2
• Time in Patent Office: Days
• US Class Current: 701/500
• CPC Class Codes: B60G 17/018 characterised by the use of a specific signal treatment or control method
• CPC Class Codes: B60G 17/019 characterised by the type of sensor or the arrangement thereof B60G17/01941 takes precedence
• CPC Class Codes: B60G 17/0195 characterised by the regulation being combined with other vehicle control systems conjoint control of vehicle sub-units including control of suspension systems B60W10/22
• CPC Class Codes: B60G 2400/05 Attitude
• CPC Class Codes: B60G 2400/0512 Pitch angle
• CPC Class Codes: B60G 2400/0513 Yaw angle
• CPC Class Codes: G01C 21/10 by using measurements of speed or acceleration G01C21/24, G01C21/26 take precedence
• CPC Class Codes: G01C 21/12 executed aboard the object being navigated; Dead reckoning
• CPC Class Codes: G01C 21/188 for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems
• CPC Class Codes: G01C 21/28 with correlation of data from several navigational instruments
• CPC Class Codes: G01C 25/005 initial alignment, calibration or starting-up of inertial devices
• CPC Class Codes: G01C 9/08 Means for compensating acceleration forces due to movement of instrument
• CPC Class Codes: G01G 19/086 wherein the vehicle mass is dynamically estimated
• CPC Class Codes: G01S 19/42 Determining position
• CPC Class Codes: H04W 52/0254 detecting a user operation or a tactile contact or a motion of the device
• CPC Class Codes: Y02D 30/70 in wireless communication networks

Abstract

A new method for determining an attitude of a sensor with respect to a moving body is proposed. A movement vector is measured by a sensor mounted in the moving body. In addition, the attitude of the sensor with respect to the moving body is determined using the movement vector measured by the sensor when the moving body starts to move.

Claims

1. An attitude determination method comprising:

a step of measuring a movement vector by a sensor which is mounted in a moving body and measures the movement vector; and

a step of determining an attitude of the sensor with respect to the moving body using the movement vector measured by the sensor when the moving body starts to move.

2. The attitude determination method according to claim 1, further comprising:

a step of compensating for a measurement result of the sensor using a first constraint condition regarding a velocity of the moving body when the moving body is in a stop state.

3. The attitude determination method according to claim 1,

wherein the step of determining the attitude is to determine at least one of a pitch component and a yaw component without determining a roll component of the attitude with respect to the moving body.

4. The attitude determination method according to claim 1,

wherein the step of measuring the movement vector is to measure a movement vector in an absolute coordinate system which describes a moving space of the moving body, and

the step of determining the attitude is to determine the attitude of the sensor using the movement vector and a direction of the sensor expressed in the absolute coordinate system.

5. The attitude determination method according to claim 1,

wherein the step of determining the attitude includes:

a step of calculating a velocity vector in a local coordinate system, which is a measurement coordinate system of the sensor, using a movement vector measured by the sensor when the moving body is stopped and a movement vector measured when the moving body starts to move; and

a step of determining the attitude of the sensor using the velocity vector.

6. The attitude determination method according to claim 1,

wherein the step of determining the attitude is to determine the attitude using the movement vector when the stop of the moving body is released and the velocity or acceleration of the moving body reaches a predetermined threshold value.

7. A position calculation method comprising:

a step of determining the attitude using the attitude determination method according to claim 1; and

a step of calculating a position of the moving body using the attitude and the movement vector.

8. The position calculation method according to claim 7,

wherein the step of calculating the position includes:

a step of calculating an absolute coordinate position of the moving body in the absolute coordinate system using the movement vector;

a step of performing coordinate transformation of the absolute coordinate position to a moving body coordinate position based on the moving body using the attitude and a direction of the sensor expressed in the absolute coordinate system; and

a step of correcting the absolute coordinate position using the moving body coordinate position and a second constraint condition regarding a movement direction of the moving body.

9. An attitude determination device that determines a attitude of a sensor, which is mounted in a moving body and measures a movement vector, with respect to the moving body using the movement vector measured by the sensor when the moving body starts to move.