Top > Search of International Patents > Attitude angle processor and attitude angle processing method

Attitude angle processor and attitude angle processing method UPDATE_EN commons meetings

Foreign code F170009164
Posted date Sep 7, 2017
Country United States of America
Application number 54236004
Gazette No. 20060217921
Gazette No. 7222045
Date of filing Jan 14, 2004
Gazette Date Sep 28, 2006
Gazette Date May 22, 2007
International application number JP2004000184
International publication number WO2004063667
Date of international filing Jan 14, 2004
Date of international publication Jul 29, 2004
Priority data
  • P2003-007660 (Jan 15, 2003) JP
  • 2004WO-JP00184 (Jan 14, 2004) WO
Title Attitude angle processor and attitude angle processing method UPDATE_EN commons meetings
Abstract (US7222045)
A posture angle processing apparatus includes a magnetic sensor, a gravitational acceleration sensor, a position information acquisition device, and a dip angle database device wherein a correlation of the absolute location and a geomagnetic dip angle at the corresponding point is stored.
Based on the absolute location of the current point, a dip angle estimation and determination device reads the geomagnetic dip angle at the current point, calculates an angle formed by a horizontal plane and the magnetic vector, compares the angle formed by the magnetic vector and the horizontal plane with the geomagnetic dip angle of the current point, and outputs either a true signal or a false signal depending on the error between the angle and the geomagnetic dip angle.
Scope of claims [claim1]
1. A posture angle processing apparatus comprising: a magnetic sensor for detecting a magnetic vector;
a gravitational acceleration sensor for detecting a gravitational acceleration vector;a position information acquisition device for obtaining an absolute location for a current point;a dip angle database device for storing a correlation of the absolute location and a geomagnetic dip angle at a corresponding point;
and
a dip angle estimation and determination device, for, based on the absolute location of the current point received from the position information acquisition device, reading a geomagnetic dip angle for the current point from the dip angle database device, for employing the magnetic vector detected by the magnetic sensor and the gravitational acceleration vector detected by the gravitational acceleration sensor to calculate an angle formed by a horizontal plane and the magnetic vector, for comparing the angle formed by the magnetic vector and the horizontal plane with the geomagnetic dip angle for the current point, and for, when an error between the angle and the geomagnetic dip angle is within a predetermined range, outputting a true signal indicating that the magnetic vector detected by the magnetic sensor is reliable as a geomagnetic vector, and in other cases, outputting a false signal indicating that the current magnetic vector is not reliable.
[claim2]
2. The posture angle processing apparatus according to claim 1, further comprising: a movement detection device for detecting the presence or absence of a moving state;
and
a signal output device, for, when the movement detection device is detecting a moving state over a predesignated moving distance or over a predesignated moving period of time, and when the dip angle estimation and determination device is continuously outputting a true signal, outputting a true signal indicating that the current magnetic vector detected by the magnetic sensor is reliable as a geomagnetic vector, and in other cases, outputting a false signal indicating that the current magnetic vector is not reliable.
[claim3]
3. The posture angle processing apparatus according to claim 1, further comprising: an absolute posture angle estimation device, for, when the dip angle estimation and determination device is outputting a true signal, estimating and outputting an absolute posture angle based on the magnetic vector detected by the magnetic sensor and the gravitational acceleration vector detected by the gravitational acceleration sensor.
[claim4]
4. The posture angle processing apparatus according to claim 2, wherein the movement detection device includes a walking detection device for detecting a person is walking to determine the presence or absence of a moving state.
[claim5]
5. The posture angle processing apparatus according to claim 2, further comprising;
an absolute posture angle estimation device, for, when the dip angle estimation and determination device is outputting a true signal, estimating and outputting an absolute posture angle based on the magnetic vector detected by the magnetic sensor and the gravitational acceleration vector detected by the gravitational acceleration sensor.
[claim6]
6. The posture angle processing apparatus according to claim 4, wherein the walking detection device includes: an acceleration sensor for detecting the walking of the person;
and
the walking detection device detects a vertical direction in accordance with the gravitational acceleration vector detected by the gravitational acceleration sensor, detects a typical pattern created by the walking of the person, in accordance with a component in the vertical direction included in the acceleration vector that is detected by the acceleration sensor, detects a typical pattern created by the walking of the person, in accordance with a component in the direction of a plane perpendicular to the vertical direction of the acceleration vector, and employs the detection results of these patterns to detect the walking of the person.
[claim7]
7. The posture angle processing apparatus according to claim 3, further comprising: an angular velocity sensor, whereinwhen the dip angle estimation and determination device is outputting a true signal, the absolute posture angle estimation device outputs, as a current absolute posture angle, the absolute posture angle output by the absolute posture angle estimation device, andwhen the dip angle estimation and determination device is outputting a false signal, the absolute posture angle estimation device employs, as a reference, the last absolute posture angle that is output by the absolute posture estimation device, estimates the current absolute posture angle by adding an angular velocity vector measured by the angular velocity sensor, and outputs the results.
[claim8]
8. The posture angle processing apparatus according to claim 5, further comprising: an angular velocity sensor, whereinwhen the dip angle estimation and determination device is outputting a true signal, the absolute posture angle estimation device outputs, as a current absolute posture angle, the absolute posture angle output by the absolute posture angle estimation device, andwhen the dip angle estimation and determination device is outputting a false signal, the absolute posture angle estimation device employs, as a reference, the last absolute posture angle that is output by the absolute posture estimation device, estimates the current absolute posture angle by adding an angular velocity vector measured by the angular velocity sensor, and outputs the results.
[claim9]
9. A posture angle processing method by which a posture angle process is performed by a posture angle processing apparatus that includes: a magnetic sensor for detecting a magnetic vector, a gravitational acceleration sensor for detecting a gravitational acceleration vector, a position information acquisition device for obtaining an absolute location for a current point, a dip angle database device for storing a correlation of the absolute location and a geomagnetic dip angle at a corresponding point, and a data processing device, the posture angle processing method comprising the steps of:based on an absolute location of a current point received from a position information acquisition device that obtains an absolute location of a current point, reading a geomagnetic dip angle for the current point from a dip angle database device wherein a correlation of the absolute location and the geomagnetic dip angle at the corresponding point is stored;
employing a magnetic vector detected by a magnetic sensor and a gravitational acceleration vector detected by a gravitational acceleration sensor to calculate an angle formed by a horizontal plane and the magnetic vector;comparing the angle formed by the magnetic vector and the horizontal plane with the geomagnetic dip angle for the current point, andwhen an error between the angle and the geomagnetic dip angle is within a predetermined range, outputting a true signal indicating that the magnetic vector detected by the magnetic sensor is reliable as a geomagnetic vector, and in other cases, outputting a false signal indicating that the current magnetic vector is not reliable.
[claim10]
10. The posture angle processing method according to claim 9, wherein a movement detection device that detects the presence or absence of a moving state is detecting a moving state over a predesignated moving distance or over a predesignated moving period of time;
and
the angle formed by the magnetic vector is compared with the horizontal plane with the geomagnetic dip angle for the current point, andwhen an error between the angle and the geomagnetic dip angle is within a predetermined range, and when a true signal indicating that the magnetic vector detected by the magnetic sensor is reliable as a geomagnetic vector is continuously output, a true signal indicating that the current magnetic vector detected by the magnetic sensor is reliable as a geomagnetic vector is output, and in other cases, a false signal indicating that the current magnetic vector is not reliable is output.
[claim11]
11. The posture angle processing method according to claim 9, wherein the angle formed by the magnetic vector is compared with the horizontal plane with the geomagnetic dip angle for the current point, andwhen an error between the angle and the geomagnetic dip angle is within a predetermined range, and when a true signal indicating that the magnetic vector detected by the magnetic sensor is reliable as a geomagnetic vector is continuously output, an absolute posture angle is estimated and output based on the magnetic vector detected by the magnetic sensor and the gravitational acceleration vector detected by the gravitational acceleration sensor.
[claim12]
12. The posture angle processing method according to claim 10, wherein the movement detection device detects a person is walking to determine the presence or absence of a moving state.
[claim13]
13. The posture angle processing method according to claim 10, wherein the angle formed by the magnetic vector is compared with the horizontal plane with the geomagnetic dip angle for the current point, andwhen an error between the angle and the geomagnetic dip angle is within a predetermined range, and when a true signal indicating that the magnetic vector detected by the magnetic sensor is reliable as a geomagnetic vector is continuously output, an absolute posture angle is calculated and output based on the magnetic vector detected by the magnetic sensor and the gravitational acceleration vector detected by the gravitational acceleration sensor.
[claim14]
14. The posture angle processing method according to claim 12, wherein a vertical direction is detected in accordance with the gravitational acceleration vector detected by the gravitational acceleration sensor;a typical pattern created by the walking of the person is detected, in accordance with a component in the vertical direction included in an acceleration vector that is detected by an acceleration sensor that detects walking of a person;a typical pattern created by the walking of the person is detected, in accordance with a component in the direction of a plane perpendicular to the vertical direction of the acceleration vector;
and
the detection results of the patterns are employed to detect the walking of the person.
[claim15]
15. The posture angle processing method according to claim 11, wherein the angle formed by the magnetic vector is compared with the horizontal plane with the geomagnetic dip angle for the current point, andwhen an error between the angle and the geomagnetic dip angle is within a predetermined range, and when a true signal indicating that the magnetic vector detected by the magnetic sensor is reliable as a geomagnetic vector is continuously output, an absolute posture angle is output as a current absolute posture angle based on the magnetic vector detected by the magnetic sensor and the gravitational acceleration vector detected by the gravitational acceleration sensor;
and when the true signal is not output, the last absolute posture angle that is output is employed as a reference to estimate the current absolute posture angle by adding an angular velocity vector measured by the angular velocity sensor, and the results are output.
[claim16]
16. The posture angle processing method according to claim 13, wherein the angle formed by the magnetic vector is compared with the horizontal plane with the geomagnetic dip angle for the current point, andwhen an error between the angle and the geomagnetic dip angle is within a predetermined range, and when a true signal indicating that the magnetic vector detected by the magnetic sensor is reliable as a geomagnetic vector is continuously output, an absolute posture angle is output as a current absolute posture angle based on the magnetic vector detected by the magnetic sensor and the gravitational acceleration vector detected by the gravitational acceleration sensor;
and when the true signal is not output, the last absolute posture angle that is output is employed as a reference to estimate the current absolute posture angle by adding an angular velocity vector measured by the angular velocity sensor, and the results are output.
  • Inventor, and Inventor/Applicant
  • KOUROGI MASAKATSU
  • KURATA TAKESHI
  • KATO TAKAKAZU
  • OKUMA TAKASHI
  • SAKATA NOBUCHIKA
  • NATIONAL INSTITUTE OF ADVANCED INDUSTRIAL SCIENCE AND TECHNOLOGY
IPC(International Patent Classification)
U.S. Cl./(Sub)
  • G01C017/38

PAGE TOP

close
close
close
close
close
close