WO2010001970A1 - 移動体の姿勢角処理装置 - Google Patents

移動体の姿勢角処理装置 Download PDF

Info

Publication number
WO2010001970A1
WO2010001970A1 PCT/JP2009/062145 JP2009062145W WO2010001970A1 WO 2010001970 A1 WO2010001970 A1 WO 2010001970A1 JP 2009062145 W JP2009062145 W JP 2009062145W WO 2010001970 A1 WO2010001970 A1 WO 2010001970A1
Authority
WO
WIPO (PCT)
Prior art keywords
output
sensor
moving body
gyro sensor
posture angle
Prior art date
Application number
PCT/JP2009/062145
Other languages
English (en)
French (fr)
Inventor
興梠　正克
蔵田　武志
Original Assignee
独立行政法人産業技術総合研究所
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 独立行政法人産業技術総合研究所 filed Critical 独立行政法人産業技術総合研究所
Priority to JP2010519112A priority Critical patent/JP5397915B2/ja
Priority to US13/001,483 priority patent/US8758275B2/en
Publication of WO2010001970A1 publication Critical patent/WO2010001970A1/ja

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C19/00—Gyroscopes; Turn-sensitive devices using vibrating masses; Turn-sensitive devices without moving masses; Measuring angular rate using gyroscopic effects
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
    • G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
    • G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
    • G01C21/183—Compensation of inertial measurements, e.g. for temperature effects
    • G01C21/188—Compensation of inertial measurements, e.g. for temperature effects for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C22/00—Measuring distance traversed on the ground by vehicles, persons, animals or other moving solid bodies, e.g. using odometers, using pedometers
    • G—PHYSICS
    • G08—SIGNALLING
    • G08G—TRAFFIC CONTROL SYSTEMS
    • G08G1/00—Traffic control systems for road vehicles
    • G08G1/005—Traffic control systems for road vehicles including pedestrian guidance indicator

Definitions

  • the present invention relates to a moving body posture angle processing apparatus that can reduce cumulative errors when continuously measuring the posture angle of a moving body.
  • the technology to acquire the state of a person (moving body) with a wearable system is indispensable for grasping human context information and realizing an intelligent interface with a computer. It is expected to be applied to many applications such as pedestrian navigation, grasping the situation of workers in remote work support, and exhibition guides in museums and large-scale exhibition facilities.
  • a posture angle processing device that can accurately obtain information on the posture angle of a person by carrying it is worn by a measurement target (a small device such as a mobile phone or a PDA, a human body, etc.)
  • the attitude angle is acquired by a signal from a small, lightweight, and inexpensive sensor group.
  • the current method of measuring the absolute attitude angle based on the geomagnetic vector estimated using a magnetic sensor is particularly reliable in indoor environments because of the disturbance of the magnetic field caused by various electronic devices and building structures. It is difficult to measure the geomagnetism that can be done, and there is a problem that it does not operate stably in a wide range of environments.
  • the absolute velocity angle measured by the gyro sensor and the acceleration vector measured by the acceleration sensor are integrated one by one from the absolute angle of the reference.
  • the posture angle is estimated by updating the posture angle, there is a problem that it is difficult to continuously acquire the absolute posture angle due to a problem such as a drift component included in the output of the gyro sensor.
  • Gyro sensors / acceleration sensors used in inertial navigation units (IMU) mounted on airplanes and the like are capable of measuring relative attitude angle changes from a reference absolute attitude angle with very high accuracy. There is a problem that it is difficult to attach to a small device or a human body due to problems of size, weight and economy.
  • an offset component is included in the zero point output of the angular velocity of the gyro sensor of the MEMS device (the angular velocity output when the sensor is stationary), and that component gradually changes over a long period of time.
  • the zero point output can be partially estimated by the temperature of the gyro sensor, in many cases, it is necessary to correct the offset component by capturing long-term fluctuations.
  • an object of the present invention is to achieve a posture angle of a moving body that can reduce a cumulative error when continuously measuring the posture angle of the moving body. It is to provide a processing apparatus. More specifically, an object of the present invention is to provide a posture angle processing apparatus for a moving body provided with means for estimating an offset component of the zero point output of angular velocity included in a gyro sensor of a MEMS device.
  • a posture angle processing apparatus for a moving body is configured based on the following concept.
  • measurement results obtained in a section moving a distance greater than or equal to a predetermined threshold are not at the same point, and the measurement conditions and environment change every moment. Is expected to approach a white noise property of zero. For this reason, it is considered that a series of measurement results obtained during movement is data having a more appropriate property as an input to a Kalman filter, a particle filter, or the like.
  • an acceleration sensor (three axes) used to detect the gravity direction and motion
  • a gyro sensor (three axes) that measures angular velocity
  • a magnetic sensor (three axes) that measures geomagnetism and environmental magnetic field
  • a device that estimates the offset component of the zero point output of the angular velocity included in the gyro sensor is configured by a device that combines the means for detecting the movement state by these sensors, and estimates the posture angle by using the estimated offset component.
  • the offset value (three-dimensional) of the zero point output of the angular velocity of the gyro sensor (three axes), the gravitational acceleration vector (three-dimensional), the environmental magnetic vector (three-dimensional), and the angular velocity (three-dimensional) are used as state vectors.
  • An extended Kalman filter is constructed and used as a gyro sensor zero point output estimation device.
  • the present invention provides a mobile body posture angle processing device according to the present invention in which the posture of the mobile body is output from outputs of an acceleration sensor, a magnetic sensor, and a gyro sensor mounted on the mobile body.
  • a posture angle estimation device that estimates and outputs an angle, based on a gyro sensor that outputs an angular velocity vector, an acceleration sensor that outputs an acceleration vector, a magnetic sensor that outputs a magnetic field vector, and an output of the acceleration sensor
  • a moving state determining device that determines a moving state of the moving body; and when the moving state determination by the moving state determining device detects that the moving body is stationary, the output of the acceleration sensor, the output of the magnetic sensor, A gyro sensor zero point output estimating device for performing processing for estimating the zero point output of the gyro sensor based on the output of the gyro sensor, Using the output of the gyro sensor zero-point output estimating unit, and corrects the zero point of the gyro sensor.
  • the gyro sensor zero-point output estimating device is used when the posture angle estimating device that estimates the posture angle based on the outputs of the acceleration sensor, the magnetic sensor, and the gyro sensor performs the estimation processing of the posture angle of the moving body. Based on the output, the output obtained by estimating the attitude angle of the moving body is corrected.
  • a mobile body posture angle processing apparatus estimates the posture angle of the mobile body from outputs from an acceleration sensor, a magnetic sensor, and a gyro sensor mounted on the mobile body.
  • a gyro sensor that outputs an angular velocity vector, an acceleration sensor that outputs an acceleration vector, a magnetic sensor that outputs a magnetic field vector, and outputs of the acceleration sensor and the gyro sensor
  • a moving state determining device that determines a moving state of the moving body; and when the moving state determination by the moving state determining device detects that the moving body is stationary, the output of the acceleration sensor, the output of the magnetic sensor,
  • a gyro sensor zero point output estimating device for performing processing for estimating the zero point output of the gyro sensor based on the output of the gyro sensor.
  • the gyro sensor zero-point output estimating device is used when the posture angle estimating device that estimates the posture angle based on the outputs of the acceleration sensor, the magnetic sensor, and the gyro sensor estimates the posture angle of the moving body. Based on the output, the output obtained by estimating the attitude angle of the moving body is corrected.
  • the mobile body posture angle processing apparatus of the present invention when performing the process of estimating the mobile body posture angle, the presence or absence of movement of the mobile body is detected, so that Specifically, by detecting the stop, the zero point of the gyro sensor is corrected, or it is determined whether the output of estimating the posture angle of the moving body is possible, and the output of the posture angle estimation process is corrected and output. Data processing.
  • the environmental magnetic field measured by the magnetic sensor can be regarded as being constant at the same point.
  • the offset value of the zero point output which is the state vector of the extended Kalman filter, is estimated by using the magnetic vector measured by the magnetic sensor as the observation result of the environmental magnetic field It becomes possible to do.
  • the moving state determination device can be configured as a device that detects a stationary state by using a statistic such as the variance of the output of the acceleration sensor alone or the acceleration sensor and the gyro sensor. Therefore, the gyro sensor zero point output estimation device can be configured without adding any other measurement means, and the posture angle estimation processing device can be configured.
  • the offset value of the zero point output of the gyro sensor (three axes) is correctly estimated by the extended Kalman filter, thereby reducing the estimation error of the moving direction calculated as the integration result from the angular velocity output of the gyro sensor. Therefore, it is possible to realize a self-contained navigation system for pedestrians with little positioning error in the long term.
  • FIG. 1 is a block diagram showing a main configuration of a posture angle processing apparatus for a moving body according to the present invention.
  • 201 is an acceleration sensor used to detect gravity direction and motion
  • 202 is a magnetic sensor that measures geomagnetism and environmental magnetic field
  • 203 is a gyro sensor that measures angular velocity
  • 204 is a moving state determination device
  • 205 is a gyro. It is a sensor zero point output estimation device.
  • the three-axis acceleration sensor 201, the three-axis magnetic sensor 202, and the three-axis gyro sensor 203 mounted on the moving body are used as sensing means, and output from the acceleration sensor 201.
  • the moving state determination device 204 determines whether or not the moving body has moved. Thereby, the moving body determination apparatus 204 determines the stop of a moving body.
  • a variance value of an acceleration vector within a certain period is calculated, which is a predetermined value. When the threshold value is exceeded, it is determined that the moving body is moving.
  • Such a method is effective when moving with vibrations appearing in the acceleration vector, such as when the moving body is a pedestrian.
  • the moving state determination device 204 outputs a true signal as an output signal 213 when a moving state is detected, and outputs a false signal as an output signal 213 when it is detected that the moving state is stationary.
  • the gyro sensor zero point output estimation device 205 is implemented by an extended Kalman filter. This extended Kalman filter has, as its state vector, offset of gravitational acceleration vector (3 axes), environmental magnetic field vector (3 axes), angular velocity vector (3 axes), and zero velocity output of gyro sensor (3 axes) angular velocity. It has a value (3D) as its component. Thereby, the zero point output (three axes) of the gyro sensor is estimated.
  • the acceleration vector 210 that is the output of the acceleration sensor 201 is used.
  • the magnetic vector 211 that is the output of the magnetic sensor 202 is used.
  • the state of the Kalman filter is updated by using the angular velocity vector 212 that is the output of the gyro sensor 203.
  • the environmental magnetic field measured by the magnetic sensor can be regarded as being constant at the same point. Therefore, when a sufficiently large number of observations are obtained, the state vector converges with time, and the zero point output of the gyro sensor can be acquired as the convergence result. This is output as an estimation result 214 from the gyro sensor zero point estimation device 205.
  • This estimation result is directly used as data for correcting the zero point of the gyro sensor. Alternatively, for example, it is used as a result of determining whether to use the result of estimating the posture angle of the moving body.
  • FIG. 2 is a block diagram showing a configuration of a moving body posture angle processing apparatus according to the present invention.
  • 201 is an acceleration sensor
  • 202 is a magnetic sensor
  • 203 is a gyro sensor
  • 204 is a moving state determination device
  • 205 is a gyro sensor zero point output estimation device
  • 206 is an attitude angle estimation device.
  • the output data from the acceleration sensor 201, the output data from the magnetic sensor 202, and the output data from the gyro sensor 203 are not only used for the gyro sensor zero point estimation process, but also the attitude angle estimation processing device This is also used to perform posture angle estimation processing at 206.
  • the posture angle estimation device 206 receives the acceleration vector 210, the magnetic vector 211, the angular velocity vector 212, and the output data from the zero point output 214 of the gyro sensor.
  • the attitude angle estimation device 206 is specifically implemented by a Kalman filter.
  • a state vector having nine components, a gravity direction vector (3 axes), a true north direction vector (3 axes) due to geomagnetism, and an angular velocity vector (3 axes) is updated.
  • the acceleration vector 210 is used as the observation of the true north direction.
  • the observation of the angular velocity vector as the observation of the angular velocity vector using the true north vector obtained by correcting the declination and the dip angle from the magnetic vector 211 as the magnetic north.
  • the vector 112 corrected from the zero point output 214 is used.
  • the attitude angle of the moving object is calculated and output using the gravity direction vector and the true north direction vector obtained by observation and update (215).
  • FIG. 3 is a block diagram showing another configuration of the mobile body posture angle processing apparatus of the present invention.
  • the three-axis acceleration sensor 201, the three-axis magnetic sensor 202, and the three-axis gyro sensor 203 mounted on the moving body are used as sensing means, and the acceleration vector 210 that is the output of the acceleration sensor 201 and the angular velocity vector 212 that is the output of the gyro sensor 203 are used.
  • the moving state determination device 304 determines whether or not the moving body has moved.
  • the variance value of the acceleration vector within a certain period is calculated, and when it exceeds a predetermined threshold value, or when the angular velocity vector exceeds a certain predetermined threshold value, the moving body moves. Can be determined. This is effective when the moving body moves with vibration and rotational motion appearing in the acceleration vector and the angular velocity vector, such as when the moving body is a pedestrian.
  • the movement state determination device 304 outputs a true signal as an output signal 313 when the movement state is detected, and outputs a false signal as an output signal 313 when it is detected that the movement state is stationary.
  • the gyro sensor zero point output estimation device 205 can be implemented by a Kalman filter.
  • This Kalman filter has a gravity vector (three axes), an environmental magnetic field vector (three axes), an angular velocity vector (three axes), and a gyro sensor zero point output (three axes) as its state vectors.
  • As an observation of the angular velocity and the zero point output of the gyro sensor using the acceleration vector 210 that is the output of the acceleration sensor 201 as the observation of the gravity direction, and the magnetic vector 211 as the output of the magnetic sensor 202 as the observation of the environmental magnetic field vector.
  • the state of the Kalman filter is updated using the angular velocity vector 212 that is the output of the gyro sensor 203.
  • the state vector converges with time, and the zero point output of the gyro sensor can be acquired as the convergence result, which is output as the estimation result of the gyro sensor zero point estimation device 205 (214).
  • FIG. 4 is a block diagram showing another configuration of the mobile body attitude angle processing apparatus of the present invention.
  • a posture angle estimation device 206 is provided.
  • the posture angle estimation device 206 receives an acceleration vector 210, a magnetic vector 211, an angular velocity vector 212, a moving state flag 313, and a zero point output 214 of the gyro sensor.
  • the posture angle estimation device 206 is implemented by, for example, a Kalman filter.
  • the state vector has nine components as a state vector: a gravity direction vector (3 axes), a true north direction vector (3 axes), and an angular velocity vector (3 axes).
  • the acceleration vector 210 is used as the observation of the true north direction.
  • the angular velocity vector as the observation of the angular velocity vector using the true north vector obtained by correcting the declination and the dip angle from the magnetic vector 211 as the magnetic north.
  • the vector 212 corrected from the zero point output 214 is used.
  • the posture angle of the moving body is calculated and output from the posture angle estimation device 206 using the gravity direction vector and the true north direction vector obtained by observation and update (215).
  • 201 acceleration sensor 202 magnetic sensor, 203 gyro sensor, 204 Moving state determination device, 205 gyro sensor zero point output estimation device, 206 posture angle estimation device, 304 moving state determination device,

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Navigation (AREA)
  • Gyroscopes (AREA)

Abstract

　移動体の姿勢角を継続的に計測する場合において累積的な誤差を減少できる移動体の姿勢角処理装置が提供される。移動体の姿勢角処理装置は、移動体に装着された加速度センサ、磁気センサ、およびジャイロセンサからの出力により当該移動体の姿勢角を推定して出力する。角速度ベクトルを出力するジャイロセンサと、加速度ベクトルを出力する加速度センサと、磁場ベクトルを出力する磁気センサと、加速度センサの出力に基づいて移動体の移動状態を判定する移動状態判定装置と、移動状態判定装置による前記移動状態の判定が移動体の静止を検知したときに、前記加速度センサの出力と、磁気センサの出力、ジャイロセンサの出力に基づき、ジャイロセンサのゼロ点出力を推定する処理を行うジャイロセンサゼロ点出力推定装置を備える。

Description

移動体の姿勢角処理装置
　本発明は、移動体の姿勢角を継続的に計測する場合において累積的な誤差を減少できる移動体の姿勢角処理装置に関するものである。
　着用型システムにより人（移動体）の状態を取得する技術は、人のコンテキスト情報を把握し、計算機との知的なインタフェースを実現する上で欠かせない。歩行者ナビや遠隔作業支援における作業員の状況把握、博物館や大規模展示施設の展示ガイドなど、多くの応用への展開が期待されている。
　例えば、人が携帯することで、その人の姿勢角の情報を正確に得ることのできる姿勢角処理装置は、被計測対象（携帯電話やＰＤＡなどの小型デバイス、人体など）に着用されてその姿勢角を小型・軽量かつ、安価なセンサ群から信号により取得される。
　従来から、磁気センサと傾斜角センサ、あるいは重力加速度センサを用いて絶対姿勢角を取得する技術は知られている。また、角速度センサを用いて、ある絶対基準姿勢角からの相対的な姿勢変化を計測する技術は知られている。これらのセンサを組み合わせて、より正確に、ロバストに計測対象の絶対姿勢角を計測する試みがなされている。
特許第３０３８４５２号公報 特開平１１－２１１４７９号公報
　磁気センサを用いて推定される地磁気ベクトルに基づいて現在の絶対姿勢角を計測する方法は、特に、屋内環境においては、さまざまな電子機器や建築構造物などによる磁場の乱れが存在するため、信頼できる地磁気を計測することが難しく、広範囲な環境下では、安定して正しく動作しない問題点がある。
　また、ジャイロセンサと加速度センサを用いた姿勢角を計測する方法においては、基準となる絶対姿勢角から、ジャイロセンサが計測する角速度ベクトルと加速度センサが計測する加速度ベクトルを積算することによって、逐一絶対姿勢角を更新して姿勢角を推定するが、ジャイロセンサの出力に含まれるドリフト成分等の問題により、長期間継続して絶対姿勢角を取得し続けることは難しいという問題点があった。
　航空機等に搭載される慣性航行装置（ＩＭＵ）に用いられるジャイロセンサ・加速度センサは非常に高い精度で、基準となる絶対姿勢角からの相対的な姿勢角変化を計測することが可能であるが、サイズ・重量と経済性の問題から、小型デバイスや人体への装着が困難であるという問題点がある。
 歩行者向けナビゲーションシステムに用いる自蔵航法システムを構成する上では、高精度・高価格のジャイロセンサを用いることは、一般的には価格や重量の観点から困難であり、低価格なＭＥＭＳ（Ｍｉｃｒｏ　Ｅｌｅｃｔｒｏ　Ｍｅｃｈａｎｉｃａｌ　Ｓｙｓｔｅｍｓ）デバイスのジャイロセンサが用いられることがほとんどである。
　しかしながら、ＭＥＭＳデバイスのジャイロセンサの角速度のゼロ点出力（センサの静止時の角速度出力）にはオフセット成分が含まれ、その成分が長期的にわたってゆるやかに変動することが知られている。ジャイロセンサの温度によってそのゼロ点出力を一部推定可能ではあるが、多くの場合、長期的な変動を捉えてそのオフセット成分を補正することが必要である。
　このような変動を補正することができない場合、自蔵航法システムは長期的に継続して移動方位を正しく推定することができなくなり、その測位誤差は非常に大きくなる問題がある。
　本発明は、このような問題を解決するためになされたものであり、本発明の目的は、移動体の姿勢角を継続的に計測する場合において累積的な誤差を減少できる移動体の姿勢角処理装置を提供することにある。具体的には、ＭＥＭＳデバイスのジャイロセンサなどに含まれる角速度のゼロ点出力のオフセット成分を推定する手段を備えた移動体の姿勢角処理装置を提供することにある。
　上記のような目的を達成するため、本発明においては、次のような考え方に基づいて、移動体の姿勢角処理装置を構成する。すなわち、所定の閾値以上の距離を移動している区間において得られる測定結果は同一地点におけるものではなく、測定される条件と環境が刻一刻と変化することから、観測データの誤差は平均値ベクトルが０のホワイトノイズ的な性質に近づくことが期待される。このため、移動中に得られる一連の測定結果は、カルマンフィルタやパーティクルフィルタなどへの入力としてより適切な性質を持ったデータであると考えられる。
　そこで、本発明においては、移動を検知することによって、移動中であるときと停止しているときの二つの状態を判別し、それぞれの状態における測定結果を異なる方法で取り扱うことにより、より適切に移動体の姿勢角の推定処理を行えるようにする。
　具体的には、重力方位と運動を検知するために用いる加速度センサ（３軸）と、角速度を計測するジャイロセンサ（３軸）と、地磁気および環境磁場を計測する磁気センサ（３軸）と、これらのセンサにより移動状態を検知する手段を組み合わせた装置により、ジャイロセンサに含まれる角速度のゼロ点出力のオフセット成分を推定する装置を構成し、推定したオフセット成分を利用して、姿勢角の推定処理を行う。
　このため、ジャイロセンサ（３軸）の角速度のゼロ点出力のオフセット値（３次元）と、重力加速度ベクトル（３次元）、環境磁気ベクトル（３次元）、角速度（３次元）を状態ベクトルとして持つ拡張カルマンフィルタを構成し、これをジャイロセンサゼロ点出力推定装置として利用する。
　具体的に、本発明は、第１の態様として、本発明による移動体の姿勢角処理装置が、移動体に装着された加速度センサ、磁気センサ、およびジャイロセンサからの出力により当該移動体の姿勢角を推定して出力する姿勢角推定装置であって、角速度ベクトルを出力するジャイロセンサと、加速度ベクトルを出力する加速度センサと、磁場ベクトルを出力する磁気センサと、前記加速度センサの出力に基づいて移動体の移動状態を判定する移動状態判定装置と、前記移動状態判定装置による前記移動状態の判定が移動体の静止を検知したときに、前記加速度センサの出力と、前記磁気センサの出力、前記ジャイロセンサの出力に基づき、前記ジャイロセンサのゼロ点出力を推定する処理を行うジャイロセンサゼロ点出力推定装置とを備え、前記ジャイロセンサゼロ点出力推定装置の出力を利用して、前記ジャイロセンサのゼロ点を補正することを特徴とする。
　また、この場合に、加速度センサ、磁気センサ、およびジャイロセンサの出力により、姿勢角を推定する姿勢角推定装置が、移動体の姿勢角を推定処理する場合に、前記ジャイロセンサゼロ点出力推定装置の出力に基づいて、移動体の姿勢角を推定した出力を補正することを特徴とする。
　本発明は、第２の態様として、本発明による移動体の姿勢角処理装置は、移動体に装着された加速度センサ、磁気センサ、およびジャイロセンサからの出力により当該移動体の姿勢角を推定して出力する姿勢角推定装置であって、角速度ベクトルを出力するジャイロセンサと、加速度ベクトルを出力する加速度センサと、磁場ベクトルを出力する磁気センサと、前記加速度センサおよび前記ジャイロセンサの出力に基づいて移動体の移動状態を判定する移動状態判定装置と、前記移動状態判定装置による前記移動状態の判定が移動体の静止を検知したときに、前記加速度センサの出力と、前記磁気センサの出力、前記ジャイロセンサの出力に基づき、前記ジャイロセンサのゼロ点出力を推定する処理を行うジャイロセンサゼロ点出力推定装置とを備え、前記ジャイロセンサゼロ点出力推定装置の出力を利用して、前記ジャイロセンサのゼロ点を補正することを特徴とする。
　また、この場合において、加速度センサ、磁気センサ、およびジャイロセンサの出力により、姿勢角を推定する姿勢角推定装置が、移動体の姿勢角を推定処理する場合に、前記ジャイロセンサゼロ点出力推定装置の出力に基づいて、移動体の姿勢角を推定した出力を補正することを特徴とする。
　本発明の移動体の姿勢角処理装置の構成によれば、移動体の姿勢角を推定する処理を行う場合に、移動体の移動の有無を検知することで、移動の有無に応じて、具体的には立ち止まりの検知することにより、ジャイロセンサのゼロ点を補正し、または、移動体の姿勢角を推定した出力の可否を判定し、姿勢角の推定処理の出力を補正して出力するようにデータ処理する。
　本装置の装着者がその場で立ち止っていると判定される場合は、磁気センサによって計測される環境磁場は同一地点のもので一定であると見なせる。すなわち、移動状態判定装置の出力が真信号であるとき、磁気センサで計測される磁気ベクトルを環境磁場の観測結果として利用することで、拡張カルマンフィルタの状態ベクトルであるゼロ点出力のオフセット値を推定することが可能となる。
　ここで、移動状態判定装置は、加速度センサ単独もしくは加速度センサとジャイロセンサの出力の変動の大きさをその分散などの統計量を用いて静止状態を検知する装置として構成できる。したがって、他の計測手段を特に追加することなく、ジャイロセンサゼロ点出力推定装置を構成して、姿勢角の推定処理装置の構成することができる。
　また、ジャイロセンサ（３軸）のゼロ点出力のオフセット値が前記拡張カルマンフィルタによって正しく推定されることで、そのジャイロセンサの角速度出力から積算結果として算出される移動方位の推定誤差を軽減することができ、したがって、長期的に測位誤差の少ない歩行者向けの自蔵航法システムを実現することが可能となる。
本発明の移動体の姿勢角処理装置の主要な構成を示すブロック図である。 本発明の移動体の姿勢角処理装置の構成を示すブロック図である。 本発明の移動体の姿勢角処理装置の別の構成を示すブロック図である。 本発明の移動体の姿勢角処理装置の別の構成を示すブロック図である。
　以下、本発明による移動体の姿勢角処理装置を実施する場合に形態について、図面を用いて具体的に説明する。図１は、本発明の移動体の姿勢角処理装置の主要な構成を示すブロック図である。図１において、２０１は重力方位と運動を検知するために用いる加速度センサ、２０２は地磁気および環境磁場を計測する磁気センサ、２０３は角速度を計測するジャイロセンサ、２０４は移動状態判定装置、２０５はジャイロセンサゼロ点出力推定装置である。
　移動体の姿勢角処理装置では、移動体に装着された３軸の加速度センサ２０１と、３軸の磁気センサ２０２と、３軸のジャイロセンサ２０３とをセンシング手段とし、加速度センサ２０１の出力である加速度ベクトル２１０に基づいて、移動状態判定装置２０４が、移動体の移動の有無を判定する。これにより、移動体判定装置２０４は、移動体の立ち止まりを判定する。なお、ここでの移動状態判定装置２０４が、これらセンサが装着されている移動体の移動状態を判定する手法としては、たとえば、一定期間内の加速度ベクトルの分散値を算出し、それが所定の閾値を越えるとき移動体が移動していると判定する。このような手法は、移動体が歩行者である場合など、加速度ベクトルに現れる振動を伴って移動するときに有効である。
　移動状態判定装置２０４は、移動状態が検知されるときには真（ＴＲＵＥ）信号を出力信号２１３として出力し、静止していると検知されるときには、偽（ＦＡＬＳＥ）信号を出力信号２１３として出力する。ジャイロセンサゼロ点出力推定装置２０５は、拡張カルマンフィルタによって実装される。この拡張カルマンフィルタは、その状態ベクトルとして、重力加速度ベクトル（３軸）と、環境磁場ベクトル（３軸）と、角速度ベクトル（３軸）と、ジャイロセンサ（３軸）の角速度のゼロ点出力のオフセット値（３次元）、その成分として持つ。これにより、ジャイロセンサのゼロ点出力（３軸）が推定される。
　重力方向の観測としては、加速度センサ２０１の出力である加速度ベクトル２１０を用いることにより、環境磁場ベクトルの観測としては、磁気センサ２０２の出力である磁気ベクトル２１１を用いることにより、角速度とジャイロセンサのゼロ点出力の観測としては、ジャイロセンサ２０３の出力である角速度ベクトル２１２を用いることにより、カルマンフィルタの状態が更新される。
　立ち止っていると判定される場合に、磁気センサによって計測される環境磁場は同一地点のものでは一定であると見なせる。このため、十分に多くの観測が得られると、状態ベクトルは時間経過とともに収束し、その収束結果としてジャイロセンサのゼロ点出力を取得することができる。これをジャイロセンサゼロ点推定装置２０５からの推定結果２１４として出力する。この推定結果は直接的には、ジャイロセンサのゼロ点を補正するデータとして利用される。または、例えば、移動体の姿勢角を推定した結果を利用するか否かを判定する結果として利用される。
　図２は、本発明による移動体の姿勢角処理装置の構成を示すブロック図である。図２において、２０１は加速度センサ、２０２は磁気センサ、２０３はジャイロセンサ、２０４は移動状態判定装置、２０５はジャイロセンサゼロ点出力推定装置、２０６は姿勢角推定装置である。この構成によると、加速度センサ２０１からの出力データ、磁気センサ２０２からの出力データ、ジャイロセンサ２０３からの出力データは、ジャイロセンサゼロ点の推定処理に使われるだけでなくて、姿勢角推定処理装置２０６において姿勢角の推定処理を行うためにも利用される。
　姿勢角推定装置２０６は、加速度ベクトル２１０と、磁気ベクトル２１１と、角速度ベクトル２１２と、ジャイロセンサのゼロ点出力２１４からの出力データを入力する。姿勢角推定装置２０６は、具体的には、カルマンフィルタによって実装される。重力方向ベクトル（３軸）と、地磁気による真北方向ベクトル（３軸）、角速度ベクトル（３軸）の９個の成分を持つ状態ベクトルが更新される。
　重力方向ベクトルの観測として、加速度ベクトル２１０を用いて、真北方向ベクトルの観測として、磁気ベクトル２１１から磁北との偏角と伏角を補正した真北ベクトルを用いて、角速度ベクトルの観測として、角速度ベクトル１１２からゼロ点出力２１４を補正したものを用いる。ここで観測と更新によって得られる重力方向ベクトルと真北方向ベクトルの二つを用いて、移動体の姿勢角を算出して出力する（２１５）。
　図３は、本発明の移動体の姿勢角処理装置の別の構成を示すブロック図である。移動体に装着された３軸加速度センサ２０１と３軸磁気センサ２０２、３軸ジャイロセンサ２０３をセンシング手段とし、加速度センサ２０１の出力である加速度ベクトル２１０とジャイロセンサ２０３の出力である角速度ベクトル２１２に基づいて、移動状態判定装置３０４は前記移動体の移動の有無を判定する。
　移動状態を判定する手段として、たとえば、一定期間内の加速度ベクトルの分散値を算出し、それが所定の閾値を越えるとき、または、角速度ベクトルが一定の所定の閾値を越えるとき、移動体が移動していると判定することができる。これは、移動体が歩行者である場合など、加速度ベクトルと角速度ベクトルに現れる振動と回転運動を伴って移動する場合には有効である。移動状態判定装置３０４は移動状態が検知されるとき、真（ＴＲＵＥ）信号を出力信号３１３として出力し、静止していると検知されるとき、偽（ＦＡＬＳＥ）信号を出力信号３１３として出力する。
　ジャイロセンサゼロ点出力推定装置２０５は、カルマンフィルタによって実装することができる。このカルマンフィルタは状態ベクトルとして、重力方向ベクトル（３軸）と環境磁場ベクトル（３軸）、角速度ベクトル（３軸）、ジャイロセンサのゼロ点出力（３軸）をその成分として持つ。重力方向の観測として加速度センサ２０１の出力である加速度ベクトル２１０を用いて、環境磁場ベクトルの観測として磁気センサ２０２の出力である磁気ベクトル２１１を用いて、角速度とジャイロセンサのゼロ点出力の観測として、ジャイロセンサ２０３の出力である角速度ベクトル２１２を用いて、カルマンフィルタの状態を更新する。
　十分に多くの観測が得られると、状態ベクトルは時間経過とともに収束し、その収束結果としてジャイロセンサのゼロ点出力を取得することができ、これをジャイロセンサゼロ点推定装置２０５の推定結果として出力する（２１４）。
　図４は、本発明の移動体の姿勢角処理装置の別の構成を示すブロック図である。図３の構成に加えて、姿勢角推定装置２０６を備える。姿勢角推定装置２０６は、加速度ベクトル２１０と磁気ベクトル２１１、角速度ベクトル２１２、移動状態フラグ３１３、ジャイロセンサのゼロ点出力２１４を入力とする。姿勢角推定装置２０６は、たとえば、カルマンフィルタによって実装される。
　その状態ベクトルは、状態ベクトルとして重力方向ベクトル（３軸）と真北方向ベクトル（３軸）、角速度ベクトル（３軸）の９個の成分を持つ。重力方向ベクトルの観測として、加速度ベクトル２１０を用いて、真北方向ベクトルの観測として、磁気ベクトル２１１から磁北との偏角と伏角を補正した真北ベクトルを用いて、角速度ベクトルの観測として、角速度ベクトル２１２からゼロ点出力２１４を補正したものを用いる。ここで観測と更新によって得られる重力方向ベクトルと真北方向ベクトルの二つを用いて、姿勢角推定装置２０６から、移動体の姿勢角を算出して出力する（２１５）。
２０１　加速度センサ、
２０２　磁気センサ、
２０３　ジャイロセンサ、
２０４　移動状態判定装置、
２０５　ジャイロセンサゼロ点出力推定装置、
２０６　姿勢角推定装置、
３０４　移動状態判定装置、

Claims (4)

  1. 　移動体に装着された加速度センサ、磁気センサ、およびジャイロセンサからの出力により当該移動体の姿勢角を推定して出力する姿勢角推定装置であって、
    　角速度ベクトルを出力するジャイロセンサと
    　加速度ベクトルを出力する加速度センサと、
    　磁場ベクトルを出力する磁気センサと、
    　前記加速度センサの出力に基づいて移動体の移動状態を判定する移動状態判定装置と、　前記移動状態判定装置による前記移動状態の判定が移動体の静止を検知したときに、前記加速度センサの出力と、前記磁気センサの出力、前記ジャイロセンサの出力に基づき、前記ジャイロセンサのゼロ点出力を推定する処理を行うジャイロセンサゼロ点出力推定装置と
    を備え、前記ジャイロセンサゼロ点出力推定装置の出力を利用して、前記ジャイロセンサのゼロ点を補正することを特徴とする移動体の姿勢角処理装置。
  2. 　請求項１に記載の移動体の姿勢角処理装置において、
    　加速度センサ、磁気センサ、およびジャイロセンサの出力により、姿勢角を推定する姿勢角推定装置は、前記ジャイロセンサゼロ点出力推定装置の出力に基づいて、
    　移動体の姿勢角を推定した出力を補正する
    ことを特徴する移動体の姿勢角処理装置。
  3. 　移動体に装着された加速度センサ、磁気センサ、およびジャイロセンサからの出力により当該移動体の姿勢角を推定して出力する姿勢角推定装置であって、
    　角速度ベクトルを出力するジャイロセンサと
    　加速度ベクトルを出力する加速度センサと、
    　磁場ベクトルを出力する磁気センサと、
    　前記加速度センサおよび前記ジャイロセンサの出力に基づいて移動体の移動状態を判定する移動状態判定装置と、
    　前記移動状態判定装置による前記移動状態の判定が移動体の静止を検知したときに、前記加速度センサの出力と、前記磁気センサの出力、前記ジャイロセンサの出力に基づき、前記ジャイロセンサのゼロ点出力を推定する処理を行うジャイロセンサゼロ点出力推定装置と、
    を備え、前記ジャイロセンサゼロ点出力推定装置の出力を利用して、前記ジャイロセンサのゼロ点を補正することを特徴とする移動体の姿勢角処理装置。
  4. 　請求項３に記載の移動体の姿勢角処理装置において、
    　加速度センサ、磁気センサ、およびジャイロセンサの出力により、姿勢角を推定する姿勢角推定装置は、前記ジャイロセンサゼロ点出力推定装置の出力に基づいて、
    　移動体の姿勢角を推定した出力を補正する
    ことを特徴する移動体の姿勢角処理装置。
PCT/JP2009/062145 2008-07-02 2009-07-02 移動体の姿勢角処理装置 WO2010001970A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2010519112A JP5397915B2 (ja) 2008-07-02 2009-07-02 移動体の姿勢角処理装置
US13/001,483 US8758275B2 (en) 2008-07-02 2009-07-02 Moving body posture angle processing device

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2008173970 2008-07-02
JP2008-173970 2008-07-02

Publications (1)

Publication Number Publication Date
WO2010001970A1 true WO2010001970A1 (ja) 2010-01-07

Family

ID=41466059

Family Applications (2)

Application Number Title Priority Date Filing Date
PCT/JP2009/062142 WO2010001968A1 (ja) 2008-07-02 2009-07-02 移動体の測位装置
PCT/JP2009/062145 WO2010001970A1 (ja) 2008-07-02 2009-07-02 移動体の姿勢角処理装置

Family Applications Before (1)

Application Number Title Priority Date Filing Date
PCT/JP2009/062142 WO2010001968A1 (ja) 2008-07-02 2009-07-02 移動体の測位装置

Country Status (3)

Country Link
US (2) US9008996B2 (ja)
JP (2) JP5397915B2 (ja)
WO (2) WO2010001968A1 (ja)

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2012047495A (ja) * 2010-08-24 2012-03-08 Ono Sokki Co Ltd 姿勢角安定化装置及び方法
JP2012093152A (ja) * 2010-10-26 2012-05-17 Aichi Micro Intelligent Corp 磁気式ジャイロ
KR20120121595A (ko) * 2011-04-27 2012-11-06 삼성전자주식회사 가속도 센서를 이용한 자세 추정 장치 및 방법
JP2013130491A (ja) * 2011-12-22 2013-07-04 Hitachi Ltd 情報処理装置、及び情報処理方法
JP2016530612A (ja) * 2013-07-17 2016-09-29 シュタビロ インターナツィオナール ゲーエムベーハーＳＴＡＢＩＬＯ Ｉｎｔｅｒｎａｔｉｏｎａｌ ＧｍｂＨ 電子ペン
WO2017175844A1 (ja) * 2016-04-06 2017-10-12 ヤマハ発動機株式会社 姿勢推定装置及び輸送機器
JP2018096914A (ja) * 2016-12-15 2018-06-21 カシオ計算機株式会社 情報処理装置、情報処理方法及びプログラム
CN109696178A (zh) * 2017-10-20 2019-04-30 夏普株式会社 偏移校正装置、偏移校正程序、步行者航位推算装置及记录介质
JP2019148494A (ja) * 2018-02-27 2019-09-05 沖電気工業株式会社 情報処理装置、及びプログラム
WO2021010068A1 (ja) * 2019-07-16 2021-01-21 ソニー株式会社 移動体制御装置および移動体制御方法
WO2023074345A1 (ja) * 2021-10-25 2023-05-04 パナソニックＩｐマネジメント株式会社 複合センサ

Families Citing this family (35)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5176145B2 (ja) * 2008-09-24 2013-04-03 富士通株式会社 方位検出方法及び装置、並びに移動履歴算出方法及び装置
JPWO2012066850A1 (ja) * 2010-11-18 2014-05-12 Ｎｅｃカシオモバイルコミュニケーションズ株式会社 電子機器
JP5059933B2 (ja) * 2010-12-02 2012-10-31 株式会社エヌ・ティ・ティ・ドコモ 移動端末、システム及び方法
US8498811B2 (en) * 2011-02-09 2013-07-30 SenionLab AB Method and device for indoor positioning
US9285224B2 (en) * 2011-04-06 2016-03-15 Uti Limited Partnership System and method for gyroscope error estimation
US8308680B1 (en) * 2011-04-26 2012-11-13 Medtronic Minimed, Inc. Selective alarms for an infusion device
CN102353383B (zh) * 2011-06-16 2013-04-17 浙江大学 基于单轴陀螺仪的计步及里程推算方法
EP2620094B1 (en) * 2011-08-01 2015-10-14 Olympus Corporation Apparatus for displaying shape of insertion portion
JP5953677B2 (ja) * 2011-08-30 2016-07-20 ソニー株式会社 情報処理装置、情報処理方法、プログラム、及び記録媒体
JP5816032B2 (ja) * 2011-09-09 2015-11-17 任天堂株式会社 入力装置、入力処理プログラム、入力処理方法、入力処理システム
JP5743838B2 (ja) * 2011-10-13 2015-07-01 キヤノン株式会社 像ブレ補正装置、光学機器および像ブレ補正方法
JP2013096724A (ja) * 2011-10-28 2013-05-20 Yamaha Corp 状態推定装置
JP5870817B2 (ja) * 2012-03-30 2016-03-01 ソニー株式会社 情報処理装置、情報処理方法、及びプログラム
KR101905150B1 (ko) * 2012-07-17 2018-10-08 엘지전자 주식회사 이동 단말기
JP6232183B2 (ja) * 2012-12-07 2017-11-15 株式会社日立アドバンストシステムズ 移動端末装置及び測位システム
US9330471B2 (en) * 2013-02-14 2016-05-03 Qualcomm Incorporated Camera aided motion direction and speed estimation
KR20140116632A (ko) * 2013-03-25 2014-10-06 삼성전자주식회사 사용자의 모션을 감지하는 웨어러블 장치 및 방법
JP6152511B2 (ja) 2013-03-29 2017-06-28 株式会社メガチップス 携帯端末装置、プログラムおよび補正方法
US10527424B2 (en) * 2013-05-14 2020-01-07 National Institute Of Advanced Industrial Science And Technology Estimated-azimuth-angle assessment device, mobile terminal device, computer-readable storage medium, control method for estimated-azimuth-angle assessment device, and positioning device
US9140802B2 (en) * 2013-08-05 2015-09-22 Texas Instruments Incorporated Auxiliary as vehicle speed when difference between auxiliary and propagation above threshold
US9622324B2 (en) * 2013-11-21 2017-04-11 General Electric Company Geolocation aid and system
US20150242314A1 (en) * 2014-02-23 2015-08-27 PNI Sensor Corporation Motion processing memory architecture
JP6357943B2 (ja) * 2014-07-18 2018-07-18 株式会社デンソー タイヤ空気圧検出装置
WO2016182179A1 (en) 2015-05-11 2016-11-17 Samsung Electronics Co., Ltd. User terminal apparatus and controlling method thereof
US10449811B2 (en) 2015-06-15 2019-10-22 Infineon Technologies Ag Tire monitoring system and method
JP6705972B2 (ja) 2016-05-20 2020-06-03 サイトセンシング株式会社 姿勢推定装置、姿勢推定方法、制御プログラム、および記録媒体
CN106092134B (zh) * 2016-05-30 2020-01-31 河北建筑工程学院 一种基于自适应算法的运动警报方法以及运动警报装置
CN106123909B (zh) * 2016-06-17 2019-05-24 北京小米移动软件有限公司 无效统计数据的检测方法和装置
KR101813143B1 (ko) 2016-10-13 2017-12-28 호남대학교 산학협력단 자세균형 이륜 전기차량
CN108377286B (zh) * 2016-10-28 2020-12-29 中兴通讯股份有限公司 一种数据传输的方法及装置
KR101880193B1 (ko) * 2017-05-18 2018-07-20 한국과학기술원 동적 변위 계산 장치 및 동적 변위 계산 방법
DE102018206786A1 (de) * 2018-05-03 2019-11-07 Robert Bosch Gmbh Verfahren zur satellitengestützten Ermittlung einer Fahrzeugposition mittels eines Bewegungs- und Positionssensors
JP7342864B2 (ja) * 2018-07-02 2023-09-12 ソニーグループ株式会社 測位プログラム、測位方法、及び測位装置
US11891339B2 (en) 2018-08-31 2024-02-06 Corning Incorporated Cordierite-indialite-pseudobrookite structured ceramic bodies, batch composition mixtures, and methods of manufacturing ceramic bodies therefrom
CN109764856B (zh) * 2019-02-28 2020-12-15 中国民航大学 基于mems传感器的道面坡度提取方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0868652A (ja) * 1994-08-31 1996-03-12 Nippondenso Co Ltd 車両用現在位置検出装置
JPH08285621A (ja) * 1995-04-14 1996-11-01 Omron Corp ナビゲーション装置
JPH095093A (ja) * 1995-06-21 1997-01-10 Victor Co Of Japan Ltd 移動体のナビゲーション装置
JP2000180171A (ja) * 1998-12-17 2000-06-30 Tokin Corp 姿勢角検出装置
JP2006329972A (ja) * 2005-04-28 2006-12-07 Denso Corp ナビゲーション装置

Family Cites Families (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE3921683A1 (de) 1989-07-01 1991-01-10 Bosch Gmbh Robert Verfahren und vorrichtung zur rueckwirkungsfreien abs-regelung
JP2798815B2 (ja) 1991-04-17 1998-09-17 アルパイン株式会社 角度算出装置
JP3038452B2 (ja) 1991-09-26 2000-05-08 株式会社トキメック ストラップダウン方式の姿勢検出装置
DE19624719A1 (de) * 1996-06-21 1998-01-02 Claas Ohg System zur Positionsbestimmung von mobilen Objekten, insbesondere von Fahrzeugen
EP0934506A4 (en) 1997-04-07 2001-01-17 Motorola Inc METHODS FOR ESTIMATING THE BIAS OF A GYROSCOPE USING GPS
JP4023889B2 (ja) 1998-01-23 2007-12-19 Ｎｅｃトーキン株式会社 姿勢角検出装置
US6140957A (en) 1998-03-12 2000-10-31 Trimble Navigation Limited Method and apparatus for navigation guidance
WO2000036376A1 (en) 1998-12-17 2000-06-22 Tokin Corporation Orientation angle detector
US6594617B2 (en) * 2000-08-18 2003-07-15 Applanix Corporation Pedometer navigator system
AU2002230578A1 (en) 2000-10-30 2002-05-15 Naval Postgraduate School Method and apparatus for motion tracking of an articulated rigid body
JP2002213979A (ja) 2001-01-12 2002-07-31 Clarion Co Ltd 測位位置／方位の修正が可能なｄｒ機能付きｇｐｓレシーバ
JP2002286829A (ja) * 2001-03-27 2002-10-03 Mitsubishi Motors Corp 絶対位置推定装置
US6826477B2 (en) * 2001-04-23 2004-11-30 Ecole Polytechnique Federale De Lausanne (Epfl) Pedestrian navigation method and apparatus operative in a dead reckoning mode
JP4243684B2 (ja) 2003-10-07 2009-03-25 独立行政法人産業技術総合研究所 歩行動作検出処理装置および歩行動作検出処理方法
US20050240347A1 (en) 2004-04-23 2005-10-27 Yun-Chun Yang Method and apparatus for adaptive filter based attitude updating
US7106189B2 (en) 2004-04-29 2006-09-12 Tracetech Incorporated Tracking system and methods thereof
US7535456B2 (en) * 2004-04-30 2009-05-19 Hillcrest Laboratories, Inc. Methods and devices for removing unintentional movement in 3D pointing devices
US7526402B2 (en) 2005-04-19 2009-04-28 Jaymart Sensors, Llc Miniaturized inertial measurement unit and associated methods
IL169269A (en) * 2005-06-19 2012-08-30 Israel Aerospace Ind Ltd Method for automatic navigation of an unmanned vehicle Carrying data that can be read by a computer and storing a program to perform the method
US7561960B2 (en) * 2006-04-20 2009-07-14 Honeywell International Inc. Motion classification methods for personal navigation
US7761233B2 (en) * 2006-06-30 2010-07-20 International Business Machines Corporation Apparatus and method for measuring the accurate position of moving objects in an indoor environment
US7643960B2 (en) * 2007-03-05 2010-01-05 Gm Global Technology Operations, Inc. Correction of factors in vehicle accelerometer signals
US7835863B2 (en) * 2007-04-18 2010-11-16 Mitac International Corporation Method and system for navigation using GPS velocity vector

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0868652A (ja) * 1994-08-31 1996-03-12 Nippondenso Co Ltd 車両用現在位置検出装置
JPH08285621A (ja) * 1995-04-14 1996-11-01 Omron Corp ナビゲーション装置
JPH095093A (ja) * 1995-06-21 1997-01-10 Victor Co Of Japan Ltd 移動体のナビゲーション装置
JP2000180171A (ja) * 1998-12-17 2000-06-30 Tokin Corp 姿勢角検出装置
JP2006329972A (ja) * 2005-04-28 2006-12-07 Denso Corp ナビゲーション装置

Cited By (17)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2012047495A (ja) * 2010-08-24 2012-03-08 Ono Sokki Co Ltd 姿勢角安定化装置及び方法
JP2012093152A (ja) * 2010-10-26 2012-05-17 Aichi Micro Intelligent Corp 磁気式ジャイロ
KR101956186B1 (ko) * 2011-04-27 2019-03-11 삼성전자주식회사 가속도 센서를 이용한 자세 추정 장치 및 방법
KR20120121595A (ko) * 2011-04-27 2012-11-06 삼성전자주식회사 가속도 센서를 이용한 자세 추정 장치 및 방법
JP2013130491A (ja) * 2011-12-22 2013-07-04 Hitachi Ltd 情報処理装置、及び情報処理方法
JP2016530612A (ja) * 2013-07-17 2016-09-29 シュタビロ インターナツィオナール ゲーエムベーハーＳＴＡＢＩＬＯ Ｉｎｔｅｒｎａｔｉｏｎａｌ ＧｍｂＨ 電子ペン
US10474252B2 (en) 2013-07-17 2019-11-12 Stabilo International Gmbh Electronic pen
JPWO2017175844A1 (ja) * 2016-04-06 2018-04-12 ヤマハ発動機株式会社 姿勢推定装置及び輸送機器
WO2017175844A1 (ja) * 2016-04-06 2017-10-12 ヤマハ発動機株式会社 姿勢推定装置及び輸送機器
US10634694B2 (en) 2016-04-06 2020-04-28 Yamaha Hatsudoki Kabushiki Kaisha Attitude estimation apparatus and transportation machine
JP2018096914A (ja) * 2016-12-15 2018-06-21 カシオ計算機株式会社 情報処理装置、情報処理方法及びプログラム
CN109696178A (zh) * 2017-10-20 2019-04-30 夏普株式会社 偏移校正装置、偏移校正程序、步行者航位推算装置及记录介质
JP2019078560A (ja) * 2017-10-20 2019-05-23 シャープ株式会社 ジャイロセンサのオフセット補正装置、オフセット補正プログラム、歩行者自律航法装置
JP2019148494A (ja) * 2018-02-27 2019-09-05 沖電気工業株式会社 情報処理装置、及びプログラム
WO2021010068A1 (ja) * 2019-07-16 2021-01-21 ソニー株式会社 移動体制御装置および移動体制御方法
JP7484915B2 (ja) 2019-07-16 2024-05-16 ソニーグループ株式会社 移動体制御装置および移動体制御方法
WO2023074345A1 (ja) * 2021-10-25 2023-05-04 パナソニックＩｐマネジメント株式会社 複合センサ

Also Published As

Publication number Publication date
US20110106487A1 (en) 2011-05-05
JPWO2010001968A1 (ja) 2011-12-22
JP5397915B2 (ja) 2014-01-22
US9008996B2 (en) 2015-04-14
JP5339304B2 (ja) 2013-11-13
US8758275B2 (en) 2014-06-24
JPWO2010001970A1 (ja) 2011-12-22
US20110105957A1 (en) 2011-05-05
WO2010001968A1 (ja) 2010-01-07

Similar Documents

Publication Publication Date Title
JP5397915B2 (ja) 移動体の姿勢角処理装置
Deilamsalehy et al. Sensor fused three-dimensional localization using IMU, camera and LiDAR
US8010308B1 (en) Inertial measurement system with self correction
US9939273B2 (en) Attitude estimating device, attitude estimating method, and storage medium
Michel et al. On attitude estimation with smartphones
Neto et al. 3-D position estimation from inertial sensing: Minimizing the error from the process of double integration of accelerations
JP2012185111A (ja) 測位装置、測位方法
Kim et al. Performance improvement of an AHRS for motion capture
JP2012173190A (ja) 測位システム、測位方法
JPWO2008146757A1 (ja) 物理量計測装置および物理量計測方法
JP2019078560A (ja) ジャイロセンサのオフセット補正装置、オフセット補正プログラム、歩行者自律航法装置
Woyano et al. Evaluation and comparison of performance analysis of indoor inertial navigation system based on foot mounted IMU
Zhang et al. Pedestrian motion based inertial sensor fusion by a modified complementary separate-bias Kalman filter
CN105547291B (zh) 室内人员自主定位***的自适应静止检测方法
Won et al. Fastening tool tracking system using a Kalman filter and particle filter combination
Yuan et al. Indoor pedestrian navigation using miniaturized low-cost MEMS inertial measurement units
Marotto et al. Orientation analysis through a gyroscope sensor for indoor navigation systems
Schindhelm et al. Usability of apple iPhones for inertial navigation systems
Edrisi et al. Attitude estimation of an accelerated rigid body with sensor fusion based-on switching extended Kalman filter
Lee et al. A sequential orientation kalman filter for AHRS limiting effects of magnetic disturbance to heading estimation
TWI472953B (zh) 慣性感測輸入裝置、系統及其方法
Lee et al. 3-Dimensional pose sensor algorithm for humanoid robot
Sang et al. A self-developed indoor three-dimensional pedestrian localization platform based on MEMS sensors
Mumtaz et al. Development of a low cost wireless IMU using MEMS sensors for pedestrian navigation
JP3783061B1 (ja) 傾斜角と並進加速度の検出方法および検出装置

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 09773548

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 2010519112

Country of ref document: JP

WWE Wipo information: entry into national phase

Ref document number: 13001483

Country of ref document: US

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 09773548

Country of ref document: EP

Kind code of ref document: A1