WO2009107424A1 - 衛星航法／推測航法統合測位装置 - Google Patents

衛星航法／推測航法統合測位装置 Download PDF

Info

Publication number
WO2009107424A1
WO2009107424A1 PCT/JP2009/050899 JP2009050899W WO2009107424A1 WO 2009107424 A1 WO2009107424 A1 WO 2009107424A1 JP 2009050899 W JP2009050899 W JP 2009050899W WO 2009107424 A1 WO2009107424 A1 WO 2009107424A1
Authority
WO
WIPO (PCT)
Prior art keywords
sensor
value
angular velocity
navigation
detection value
Prior art date
Application number
PCT/JP2009/050899
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 EP09715707.7A priority Critical patent/EP2249172B1/en
Priority to US12/918,016 priority patent/US8965690B2/en
Publication of WO2009107424A1 publication Critical patent/WO2009107424A1/ja

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
    • G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/42—Determining position
    • G01S19/48—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system
    • G01S19/49—Determining position by combining or switching between position solutions derived from the satellite radio beacon positioning system and position solutions derived from a further system whereby the further system is an inertial position system, e.g. loosely-coupled
    • 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/165—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 combined with non-inertial navigation instruments
    • 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
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/01—Determining conditions which influence positioning, e.g. radio environment, state of motion or energy consumption
    • G01S5/018—Involving non-radio wave signals or measurements

Definitions

  • the present invention relates to a satellite navigation / dead-reckoning navigation integrated positioning device that performs positioning by integrating an observation amount obtained by receiving a positioning signal from a navigation satellite and an observation amount obtained from an external sensor such as an acceleration sensor. is there.
  • a satellite navigation calculation based on an observation amount obtained from a GPS positioning device which is a non-independent system
  • an inertial navigation calculation based on a detection value of an external sensor such as an acceleration sensor or an angular velocity sensor
  • a satellite navigation / dead-reckoning navigation integrated positioning device that obtains navigation data such as position, velocity, and direction has been used (see, for example, Patent Document 1).
  • the accuracy of the detection value of the external sensor becomes a problem.
  • the satellite navigation / dead-reckoning integrated positioning device using an inexpensive acceleration sensor and angular velocity sensor if these external sensors are not properly corrected, the positioning signal from the navigation satellite will be interrupted. The positioning accuracy is significantly degraded due to the low accuracy of the detection value from the sensor.
  • an object of the present invention is to make it possible to determine whether or not the correction of the detection value of the external sensor is appropriate even when the inertial navigation is performed without receiving the positioning signal from the navigation satellite.
  • Another object of the present invention is to provide a satellite navigation / dead-reckoning navigation integrated positioning device that solves the above-mentioned problems by continuing the positioning operation or stopping the output of erroneous navigation data.
  • the satellite navigation / dead-reckoning navigation integrated positioning device of the present invention is configured as follows.
  • the external sensor includes at least an acceleration sensor for detecting acceleration and an angular velocity sensor for detecting angular velocity, and a detection value of the acceleration sensor and a detection value of the angular velocity sensor
  • the sensor detection value appropriate correction determination means for determining whether or not the error exceeds a predetermined threshold value is provided.
  • the external sensor includes an X-axis direction that is the front-rear direction of the moving body and a Y-axis that is the left-right direction of the moving body
  • An acceleration sensor that detects at least two-axis acceleration in a direction
  • an at least one-axis angular velocity sensor that detects an angular velocity in an azimuth direction (turning direction) about the Z-axis orthogonal to the X-axis direction and the Y-axis direction.
  • Vx speed in the forward direction
  • ⁇ z angular velocity in the azimuth direction
  • ay centrifugal force
  • ay Vx ⁇ ⁇ z
  • the integrated positioning calculation means when it is determined that the correction is appropriate, continues the positioning calculation using the detection values of the acceleration sensor and the angular velocity sensor, or outputs the result of the positioning calculation, When the correction is determined to be inappropriate, the positioning calculation using the detection value of the external sensor is stopped, or the positioning calculation using the detection value of the external sensor such as a positioning result immediately before stopping the positioning calculation is performed. A value other than the result shall be output.
  • This configuration can prevent navigation data with extremely low accuracy from being output, and can prevent abnormal navigation data from being provided to the user.
  • the appropriate correction determination means performs the determination when the absolute values of the velocity in the X-axis direction and the angular velocity in the azimuth direction each exceed a predetermined threshold value.
  • the appropriate correction determination means determines whether or not the absolute value of the product of the velocity in the X-axis direction and the angular velocity in the azimuth direction exceeds a comparison value including the absolute value of the acceleration in the Y-axis direction. To do.
  • the appropriate correction determination means performs the determination based on whether or not the product of the velocity in the X-axis direction and the angular velocity in the azimuth direction has the same sign as the acceleration in the Y-axis direction.
  • the present invention it is possible to determine whether or not the external sensor is properly corrected even when the positioning signal from the navigation satellite is interrupted. For this reason, there is a problem that inertial navigation calculation using the detection value of the external sensor that is not properly corrected continues, or significantly deteriorated navigation data using the detection value of the external sensor that is not properly corrected is output. Can be avoided.
  • FIG. 1 It is a block diagram which shows the structure of the satellite navigation / dead-reckoning navigation integrated positioning apparatus which concerns on embodiment of this invention. It is a flowchart which shows the processing content accompanying determination of the appropriate correction
  • FIG. 1 It is a block diagram which shows the structure of the satellite navigation / dead-reckoning navigation integrated positioning apparatus which concerns on embodiment of this invention. It is a flowchart which shows the processing content accompanying determination of the appropriate correction
  • Example 1 The configuration of the satellite navigation / dead-reckoning navigation integrated positioning device (hereinafter simply referred to as “navigation device”) of the present invention is shown in FIG.
  • a navigation device 100 includes a GPS receiver 11, an acceleration sensor 12, an angular velocity sensor 13 formed of a vibration gyro, and an integrated calculation unit 30 formed of a CPU or the like, and is a mobile object. Mounted on.
  • the GPS receiver 11 receives a positioning signal transmitted from a GPS satellite, which is a navigation satellite, and outputs a GPS positioning signal.
  • the acceleration sensor 12 detects at least biaxial acceleration in the X-axis direction that is the front-rear direction of the moving body and the Y-axis direction that is the left-right direction of the moving body.
  • the angular velocity sensor 13 detects an angular velocity in an azimuth direction (turning direction) about the Z axis that is orthogonal to the X axis direction and the Y axis direction.
  • the acceleration sensor 12 and the angular velocity sensor 13 correspond to an “external sensor” according to the present invention.
  • the integrated calculation unit 30 can be represented by a tracking processing unit 20, a GPS / INS calculation unit 21, and a sensor detection value appropriate correction determination unit 22 if the calculation processing content is blocked.
  • the tracking processing unit 20 inputs a GPS positioning signal from the GPS receiver 11 and tracks the phase of a baseband GPS positioning signal obtained by receiving a signal from each GPS satellite, and the pseudorange and Doppler frequency observation amount Find the position and speed of each satellite.
  • the GPS / INS calculation unit 21 obtains the position / velocity of the reception point based on the pseudorange, the Doppler frequency observation amount, the position / velocity of each satellite, and the like.
  • the GPS / INS integration calculation is performed based on the pseudorange, the Doppler frequency frequency observation amount, and the detection signals of the angular velocity sensor 13 and the acceleration sensor 12.
  • the GPS / INS calculation unit 21 corresponds to “integrated positioning calculation means” according to the present invention.
  • the GPS / INS calculation unit 21 performs GPS / INS integrated positioning calculation and outputs navigation data such as position, speed, and direction as a positioning result to the user device.
  • the GPS / INS integration calculation is performed, and the detection values of the acceleration sensor 12 and the angular velocity sensor 13 are corrected. That is, correction values for the detection values of the acceleration sensor 12 and the angular velocity sensor 13 are obtained so that the result of the inertial navigation calculation matches the result of the GPS calculation, and these are fed back to the detection values of the acceleration sensor 12 and the angular velocity sensor 13.
  • the GPS / INS calculation unit 21 performs inertial navigation calculation based on the detection values of the acceleration sensor 12 and the angular velocity sensor 13 when the GPS positioning signal is not obtained, and the position / velocity / azimuth etc. for the user device.
  • the navigation data is output as positioning results.
  • the sensor detection value appropriate correction determination unit 22 determines whether correction of the detection values of the acceleration sensor 12 and the angular velocity sensor 13 is appropriate by a method described later.
  • FIG. 2 is a flowchart showing the determination as to whether or not the correction of the sensor detection value is appropriate in the integrated arithmetic unit 30 of the navigation apparatus shown in FIG. 1 and the processing contents associated with the determination result.
  • GPS / INS calculation is performed (S1).
  • the satellite navigation and inertial navigation integrated calculation is performed as described above. Further, when the GPS positioning signal is not obtained, only inertial navigation calculation is performed.
  • the determination is made regardless of whether or not the GPS positioning signal is obtained. However, if the GPS positioning signal is obtained, the correction of the sensor detection value is regarded as appropriate, and the GPS positioning signal is determined. It may be determined whether or not the correction of the sensor detection value is appropriate only when the above is not obtained.
  • step S3 the result of the GPS / INS calculation obtained in step S1 is updated and the user is notified (S3). If it is determined that the correction is not appropriate, the positioning result is not updated, and the positioning result immediately before stopping the positioning calculation is notified to the user (S4).
  • FIG. 3 is a flowchart showing a specific example of a process for determining whether the correction of the sensor detection value shown in FIG. 2 is appropriate.
  • Vx is a speed obtained by correcting and integrating the detection value of the acceleration sensor 12 that detects the acceleration in the forward direction (X-axis direction) of the moving body
  • ⁇ z is the detection value of the angular velocity sensor 13 that detects the angular velocity in the azimuth direction.
  • the corrected angular velocity, ay is a centrifugal force obtained by correcting the detection value of the acceleration sensor 12 that detects the acceleration in the left-right direction (Y-axis direction) of the moving body.
  • the absolute value of the velocity Vx in the forward direction of the moving body exceeds a predetermined threshold th1
  • the absolute value of the angular velocity ⁇ z in the azimuth direction (turning direction) exceeds a predetermined threshold th2. It is determined whether or not (S11).
  • Threshold th1 0.5 [m / s]
  • Threshold th2 5.0 [° / s]
  • Threshold th3 5 (times)
  • Comparison value 1 3 ⁇
  • Comparison value 2 ⁇ 1 ⁇ th1 ⁇ th2 ⁇ (3 ⁇ (ay observation noise))
  • the threshold value and comparison value are set as follows.
  • Threshold value th2 sets an angular velocity that can be considered to exceed when turning. If pedestrians and vehicles are assumed, it may be set to about 1 ° / s to 10 ° / s.
  • the means for executing the determination process using the threshold values th1 and th2 corresponds to the “sensor detection value appropriate correction determination means” according to claim 1.
  • the reason why the threshold value th3 is used is to prevent erroneous determination that the sensor correction value is inappropriate even when a large noise occurs suddenly in the sensor detection value.
  • the threshold th3 may be set to several times (2 to 10 times) on the assumption that the sensor noise may suddenly increase if it is several times.
  • the comparison value 1 is a determination as to whether or not the correction of the value of the right side (Vx ⁇ ⁇ z) of the expression (1) is appropriately performed by comparing with the value of the value of the left side ay of the expression (1). Therefore, the magnitude of ay (centrifugal force) is "(1 + acceleration sensor sensitivity error% catalog specification value x 0.01) times" to "about 3 times” (less expensive acceleration sensor, centrifugal force detection accuracy Therefore, it may be set to an addition value of a value that can be regarded as not exceeding when stopped (approximately 3 to 6 times the observation noise that can normally be taken when stopped).
  • the observation noise that can normally be taken when the centrifugal force ay is stopped may be a catalog specification value of the acceleration sensor, or a value measured in advance as a standard deviation of the centrifugal force ay at the time of stop.
  • step S11 in FIG. 3 If the condition of step S11 in FIG. 3 is not satisfied, the subsequent determination process may be skipped. That is, when the moving body is stopped or is moving straight, there is a possibility that neither the detection value of the acceleration sensor in the X-axis direction nor the detection value of the angular velocity sensor is small, so that accurate determination cannot be made. In that case, it may not be determined whether or not the correction of the sensor detection value is appropriate.
  • FIG. 4 is a flowchart illustrating determination of whether the correction of the sensor detection value is appropriate and the processing content associated with the determination result in the integrated calculation unit of the navigation apparatus according to the second embodiment.
  • the configuration of the hardware of the navigation apparatus according to the second embodiment is the same as that shown in FIG. 1 and the contents of determination as to whether the correction of the sensor detection value is appropriate or not are omitted here.
  • the processing content shown in FIG. 4 is as follows. *
  • GPS / INS calculation is performed. As described above, when necessary GPS positioning signals are obtained, navigation calculations of satellite navigation and inertial navigation are performed, and when GPS positioning signals are not obtained, only inertial navigation calculations are performed (S21).
  • the reliability of the GPS / INS calculation result is determined (S22). Specifically, when the difference between the GPS / INS calculation result obtained up to the previous time and the GPS calculation result is smaller than a predetermined value, the reliability of the GPS / INS calculation result is determined as “present” and is larger than the predetermined value. In this case, the reliability of the GPS / INS calculation result is determined as “none” (S23). When it is determined that the reliability of the GPS / INS calculation result is “Yes”, the reliability of the GPS / INS calculation result in the initial state is changed from “No” to “Yes”, and the reliability of the GPS / INS calculation result is changed to “Yes”. If it is determined as “None”, the reliability of the initial GPS / INS calculation result “None” is maintained (S24).
  • the predetermined value used for this determination is set to be equal to or greater than the error of the GPS calculation result.
  • step S25 it is determined whether or not the correction of the sensor detection value is appropriate (S25).
  • the determination of whether or not the correction of the sensor detection value is appropriate is the same as step S2 (the process of FIG. 3) shown in FIG. 2, and the description thereof is omitted here. *
  • the reliability of the GPS / INS calculation result is determined (S27). Specifically, the same processing as in step S23 is performed. As a result, when the reliability of the GPS / INS calculation result is determined as “present”, the positioning result is updated using the GPS / INS calculation result (S28).
  • the positioning result is updated using the GPS calculation result (S30). However, if the reliability of the GPS / INS calculation result is determined as “none” and an invalid status is obtained from the GPS calculation result, the positioning result is not updated (S31).
  • a process of “validating the status indicating the positioning state” is performed instead of the process of “update the result of the GPS / INS calculation”.
  • a process of “invalidating the status indicating the positioning state” may be performed instead of the process of “not updating the GPS / INS calculation result”. Good.
  • step S11 of FIG. 3 the continuous number is cleared to 0 (zero), and the sensor detection value is appropriate. Therefore, the positioning result is updated.
  • the second embodiment shown in FIG. 4 when it is determined that the correction of the sensor detection value is not properly performed when the GPS is interrupted, the positioning result is not updated until the GPS positioning is restarted. . For this reason, it is possible to prevent the output of the positioning result with degraded accuracy.
  • the positioning result is not updated even if the GPS calculation result is valid.
  • the positioning result is quickly updated by the GPS positioning calculation.
  • the corrected sensor detection value (acceleration, angular velocity) corresponds to the differential value of the GPS / INS calculation result
  • the integral value of the invalid value is not reliable. Therefore, if it is determined that the sensor detection value is not properly corrected, the GPS / INS calculation result is not reliable.
  • the correction of the sensor detection value is appropriate because the differential value of the GPS / INS calculation result can only be trusted, and it is determined that the correction of the sensor detection value is properly performed.
  • the GPS / INS calculation result is not always reliable. Therefore, as in step (S25 ⁇ S26) in FIG. 4, when it is determined that the sensor detection value is not properly corrected, the reliability of the GPS / INS calculation result is changed to “none”. .
  • the present invention can be used for a satellite navigation / dead-reckoning navigation integrated positioning device that performs positioning by integrating observation amounts obtained by receiving positioning signals from navigation satellites and observation amounts obtained from external sensors such as acceleration sensors. It is.

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Navigation (AREA)
  • Traffic Control Systems (AREA)
  • Position Fixing By Use Of Radio Waves (AREA)

Abstract

慣性航法を行っているときでも、外部センサの検出値の補正が適正であるか否かを判定できるようにして、著しく劣化した測位結果が出力されるのを防止する。航法装置１００は、ＧＰＳ受信機１１、移動体の前後方向であるＸ軸方向と、移動体の左右方向であるＹ軸方向の少なくとも２軸の加速度を検出する加速度センサ１２と、Ｘ軸方向及びＹ軸方向に対してそれぞれ直交するＺ軸回りの方位方向の角速度を検出する少なくとも１軸の角速度センサ１３を含み、ＣＰＵ等からなる統合演算部３０のセンサ検出値の適正補正判定部２２は、Ｘ軸方向の加速度検出値を積分した値（速度）と、方位方向の角速度検出値の積とを求め、この値とＹ軸方向の加速度検出値との誤差を求め、この誤差が所定のしきい値を超えるか否かを判定することによって加速度センサおよび角速度センサの補正が適切であるか否かを判定する。

Description

衛星航法／推測航法統合測位装置
　この発明は、航法衛星からの測位信号を受信して得られる観測量と、加速度センサ等の外部センサより得られる観測量とを統合して測位を行う衛星航法／推測航法統合測位装置に関するものである。
　非自立システムである例えばＧＰＳ測位装置より得られる観測量を基にした衛星航法演算と、加速度センサや角速度センサ等の外部センサの検出値を基にした慣性航法演算とを統合して移動体の位置・速度・方位等の航法データを求める衛星航法／推測航法統合測位装置が従来用いられている（例えば特許文献１参照）。
先行技術文献
特許第３３８０４０４号公報
　このような衛星航法／推測航法統合測位装置においては、外部センサの検出値の精度が問題となる。安価な加速度センサと角速度センサを用いた衛星航法／推測航法統合測位装置では、これらの外部センサの補正が適正に行われていないと、航法衛星からの測位信号の中断等が生じた際、外部センサからの検出値の低精度の影響によって測位精度は著しく劣化する。
　ところが、航法衛星からの測位信号の中断時においては外部センサの補正が適正に行われているか否かを判定する手段がなく、外部センサの検出値を用いた慣性航法演算を継続し、その結果を出力し続けるしかなかった。
　そこで、この発明の目的は、航法衛星からの測位信号を受信できずに慣性航法を行っているときでも、外部センサの検出値の補正が適正であるか否かを判定できるようにして、誤った測位演算の継続または誤った航法データの出力を停止して上述の問題を解消した衛星航法／推測航法統合測位装置を提供することにある。
　前記課題を解決するために、この発明の衛星航法／推測航法統合測位装置は次のように構成する。
　（１）　航法衛星の測位信号と外部センサの検出値とを基に移動体の航法データを求めるとともに、前記外部センサの検出値に対する補正値を求めて、前記外部センサの検出値にフィードバックする統合測位演算手段を備えた衛星航法／推測航法統合測位装置において、前記外部センサは少なくとも加速度を検出する加速度センサと角速度を検出する角速度センサを含み、前記加速度センサの検出値と前記角速度センサの検出値の誤差を求め、当該誤差が所定のしきい値を超えるか否かを判定するセンサ検出値の適正補正判定手段を備える。
　（２）航法衛星の測位信号と外部センサの検出値とを基に移動体の航法データ（位置・速度等）を求めるとともに、前記外部センサの検出値に対する補正値を求めて、前記外部センサの検出値にフィードバックする統合測位演算手段を備えた衛星航法／推測航法統合測位装置において、前記外部センサには、移動体の前後方向であるＸ軸方向と、前記移動体の左右方向であるＹ軸方向の少なくとも２軸の加速度を検出する加速度センサと、前記Ｘ軸方向及び前記Ｙ軸方向に対して直交するＺ軸回りの方位方向（旋回方向）の角速度を検出する少なくとも１軸の角速度センサを含み、前記Ｘ軸方向の加速度を検出する加速度センサの検出値を積分したＸ軸方向（円弧の接線方向）の速度と、前記角速度センサの検出値との積（＝遠心力）を求めるとともに、Ｙ軸方向の加速度を検出する加速度センサの検出値と前記積（遠心力）との差を求め、当該差が所定のしきい値を超えるか否かを判定することによって前記加速度センサおよび角速度センサの検出値の補正が適切であるか否かを判定する手段を備える。
　すなわちここで、
　Ｖｘ：前進方向の速度
　ωｚ：方位方向の角速度
　ａｙ：遠心力
とすると、
　ａｙ＝Ｖｘ・ωｚ　　…（１）
の関係を、ある許容誤差または許容差の範囲内で満たすか否かを判定することによって加速度センサおよび角速度センサの補正が適正であるか否かを判定する。
　これにより、航法衛星からの測位信号が中断された状態でも外部センサの補正が適正に行われているか否かを判定できる。そのため、適正な補正がなされていない外部センサの検出値を用いた慣性航法演算が継続される問題や、適正な補正がなされていない外部センサの検出値を用いた著しく劣化した航法データが出力される、という問題が回避できる。
　（３）前記統合測位演算手段は、前記補正が適正であると判定されたとき、前記加速度センサ及び前記角速度センサの検出値を用いた測位演算を継続し、または測位演算の結果を出力し、前記補正が不適正と判定されたとき、前記外部センサの検出値を用いた測位演算を停止し、または測位演算を停止する直前の測位結果等、前記外部センサの検出値を用いた測位演算の結果以外の値を出力するものとする。
　この構成により、著しく精度の劣化した航法データが出力されるのを防止でき、異常な航法データがユーザーに提供されるのを防止することができる。
　（４）前記適正補正判定手段は、前記Ｘ軸方向の速度と前記方位方向の角速度の絶対値がそれぞれ所定のしきい値を超えるときに前記判定を行うものとする。
　これにより、無用な判定が防止できるとともに判定精度を高めることができる。
　（５）前記適正補正判定手段は、前記Ｘ軸方向の速度と前記方位方向の角速度との積の絶対値が前記Ｙ軸方向の加速度の絶対値を含む比較値を超えるか否かによって前記判定を行うこととする。
　これにより、簡単な演算によって各センサのうちいずれかの検出値の補正が不適正であるか否かを的確に判定できる。
　（６）前記適正補正判定手段は、前記Ｘ軸方向の速度と前記方位方向の角速度との積が前記Ｙ軸方向の加速度と同符号であるか否かによって前記判定を行う。
　これにより、Ｘ軸方向の加速度センサの検出値、方位方向の角速度センサの検出値、またはＹ軸方向の加速度センサの検出値のいずれかの補正が不適正であるか否かを的確に判定できる。
　この発明によれば、航法衛星からの測位信号が中断された状態でも外部センサの補正が適正に行われているか否かを判定できる。そのため、適正な補正がなされていない外部センサの検出値を用いた慣性航法演算が継続される問題や、適正な補正がなされていない外部センサの検出値を用いた著しく劣化した航法データが出力される、という問題が回避できる。
本発明の実施形態に係る衛星航法／推測航法統合測位装置の構成を示すブロック図である。 図１に示した航法装置の統合演算部３０における、センサ検出値の適正補正の判定およびその判定結果に伴う処理内容を示すフローチャートである。 図２に示したステップＳ２でのセンサ検出値の適正補正の判定処理の具体的な内容の例を示すフローチャートである。 実施例２に係る航法装置の統合演算部における、センサ検出値の適正補正の判定およびその判定結果に伴う処理内容を示すフローチャートである。
発明を実施するための形態
《実施例１》
　本発明の衛星航法／推測航法統合測位装置（以下、単に「航法装置」という。）の構成を図１に示す。この図１に示すように、航法装置１００は、ＧＰＳ受信機１１と、加速度センサ１２と、振動ジャイロからなる角速度センサ１３と、ＣＰＵ等からなる統合演算部３０と、を備えていて、移動体に搭載される。
　ＧＰＳ受信機１１は航法衛星であるＧＰＳ衛星から送信される測位信号を受信し、ＧＰＳ測位信号を出力する。
　加速度センサ１２は、移動体の前後方向であるＸ軸方向と、前記移動体の左右方向であるＹ軸方向の少なくとも２軸の加速度を検出する。角速度センサ１３は、Ｘ軸方向及びＹ軸方向に対してそれぞれ直交するＺ軸回りの方位方向（旋回方向）の角速度を検出する。この加速度センサ１２及び角速度センサ１３が本発明に係る「外部センサ」に相当する。
　統合演算部３０は、演算処理内容をブロック化すれば、追尾処理部２０、ＧＰＳ／ＩＮＳ演算部２１、及びセンサ検出値の適正補正判定部２２で表すことができる。
　追尾処理部２０は、ＧＰＳ受信機１１からのＧＰＳ測位信号を入力し、各ＧＰＳ衛星からの信号を受信して得られるベースバンドのＧＰＳ測位信号の位相を追尾するとともに擬似距離、ドップラー周波数観測量、各衛星の位置・速度などを求める。
　ＧＰＳ／ＩＮＳ演算部２１は、擬似距離及びドップラー周波数観測量、各衛星の位置・速度等に基づいて受信点の位置・速度を求める。また、擬似距離、ドップラー周波数周波数観測量、及び角速度センサ１３と加速度センサ１２の検出信号を基にＧＰＳ／ＩＮＳ統合演算を行う。このＧＰＳ／ＩＮＳ演算部２１が本発明に係る「統合測位演算手段」に相当する。ＧＰＳ／ＩＮＳ演算部２１は、ＧＰＳ測位信号が得られているとき、ＧＰＳ／ＩＮＳ統合測位演算を行って、ユーザー装置に対して位置・速度・方位等の航法データを測位結果として出力する。また、このＧＰＳ／ＩＮＳの統合演算を行うとともに、加速度センサ１２及び角速度センサ１３の検出値の補正を行う。すなわち、慣性航法演算の結果がＧＰＳ演算の結果に一致するように、加速度センサ１２及び角速度センサ１３の検出値に対する補正値を求め、これらを加速度センサ１２及び角速度センサ１３の検出値にフィードバックする。
　ＧＰＳ／ＩＮＳ演算部２１は、ＧＰＳ測位信号が得られていないとき、加速度センサ１２及び角速度センサ１３の検出値を基にして慣性航法演算を行って、ユーザー装置に対して位置・速度・方位等の航法データを測位結果として出力する。
　センサ検出値の適正補正判定部２２は、後述する方法により加速度センサ１２及び角速度センサ１３の検出値の補正が適正であるか否かを判定する。
　図２は、図１に示した航法装置の統合演算部３０における、センサ検出値の補正が適正であるか否かの判定およびその判定結果に伴う処理内容を示すフローチャートである。
　まず、ＧＰＳ／ＩＮＳ演算を行う（Ｓ１）。ＧＰＳ測位信号が得られているときには、前述したとおり、衛星航法と慣性航法の統合演算を行う。また、ＧＰＳ測位信号が得られていないときには慣性航法演算のみを行う。
　続いて、センサ検出値の補正が適正か否かの判定を行う（Ｓ２）。この判定ではＧＰＳ測位信号が得られているか否かに依らずに判定を行っているが、ＧＰＳ測位信号が得られている場合にはセンサ検出値の補正が適正であると見なし、ＧＰＳ測位信号が得られていない場合に限りセンサ検出値の補正が適正かの判定を行ってもよい。
　補正が適正と判定すれば、ステップＳ１で求めたＧＰＳ／ＩＮＳ演算の結果を更新するとともにユーザーへ通知する（Ｓ３）。また補正が適正でないと判定した場合には測位結果を更新せず、測位演算を停止する直前の測位結果をユーザーへ通知する（Ｓ４）。
　上記補正が適正と判定したとき、「ＧＰＳ／ＩＮＳ演算の結果を更新する」という処理に代えて、「測位状態を表すステータスを有効にする」という処理を行い、補正が適正でないと判定したとき、上記「ＧＰＳ／ＩＮＳ演算結果を更新しない」という処理に代えて、「測位状態を表すステータスを無効とする」という処理を行うようにしてもよい。
　図３は、図２に示したセンサ検出値の補正が適正かの判定処理の具体例を示すフローチャートである。図３において、Ｖｘは移動体の前進方向（Ｘ軸方向）の加速度を検出する加速度センサ１２の検出値を補正し積分した速度、ωｚは方位方向の角速度を検出する角速度センサ１３の検出値を補正した角速度、ａｙは移動体の左右方向（Ｙ軸方向）の加速度を検出する加速度センサ１２の検出値を補正した遠心力である。
　まず移動体（車両）の前進方向の速度Ｖｘの絶対値が所定のしきい値ｔｈ１を超えていて、且つ方位方向（旋回方向）の角速度ωｚの絶対値が所定のしきい値ｔｈ２を超えているか否かを判定する（Ｓ１１）。
　また、速度Ｖｘと角速度ωｚの積の絶対値が所定の比較値１を超えているか否かを判定する。または、速度Ｖｘと角速度ωｚの積が遠心力ａｙと同符号であるか否かを判定する。この方法としては、速度Ｖｘと角速度ωｚと遠心力ａｙの３つの積が所定の比較値２より小さいか否かを判定することによって判定する（Ｓ１２）。
　上記ステップＳ１１とＳ１２の判定条件を連続して満たす場合に、その連続回数をカウントする（Ｓ１３→Ｓ１４）。
　上記連続回数がしきい値ｔｈ３に達した時には、それ以上のカウントアップは行わない（Ｓ１３→Ｓ１６）。また上記連続回数がしきい値ｔｈ３に達するまでにステップＳ１１，Ｓ１２での判定条件を満たさなかったなら、その連続回数を０にクリアする（Ｓ１５）。
　その後、上記連続回数がしきい値ｔｈ３に達していれば、センサ検出値の補正が適正でないものと判定する（Ｓ１６→Ｓ１７）。また連続回数がｔｈ３未満である間はセンサ検出値の補正が適正であるものと判定する（Ｓ１８）。　
　図３に示した判定処理は例えば１秒に１回の頻度で繰り返し実行する。
　上記各しきい値と比較値の具体的な設定値は次のとおりである。　
　　しきい値ｔｈ１：０．５　［ｍ／ｓ］
　　しきい値ｔｈ２：５．０　［°／ｓ］
　　しきい値ｔｈ３：５（回）
　　比較値１：３×｜ａｙ｜　＋　３×（ａｙの観測雑音）
　　比較値２：－１×ｔｈ１×ｔｈ２×（３×（ａｙの観測雑音））
上記しきい値及び比較値の設定方法は次のとおりである。　
　しきい値ｔｈ１には、前進時には超えると見なせる速度を設定する。歩行者を想定すれば５０ｃｍ／ｓ程度、車両を想定すれば５ｋｍ／ｈ程度であるので、０．５ｍ／ｓ（＝５０ｃｍ／ｓ）～１８ｍ／ｓ（＝５ｋｍ／ｈ）の範囲で設定すればよい。
　しきい値ｔｈ２は、旋回時には超えると見なせる角速度を設定する。歩行者および車両を想定すれば１°／ｓ～１０°／ｓ程度に設定すればよい。
　このしきい値ｔｈ１，ｔｈ２を用いた判定処理（図３におけるステップＳ１１）を実行する手段が、請求項１に記載の「センサ検出値の適正補正判定手段」に相当する。
　しきい値ｔｈ３を用いて判定を行うのは、センサ検出値に突発的に大きな雑音が生じたときでも、それをセンサ補正の不適正と誤判定しないようにするためである。数回ならばセンサ雑音が突発的に大きいこともあり得ると想定して、しきい値ｔｈ３は数回（２～１０回）程度に設定すればよい。
　比較値１は、（１）式の右辺（Ｖｘ・ωｚ）の値の大きさが、（１）式の左辺ａｙの値の大きさと比較して補正が適正に行われているか否かの判定に用いるので、ａｙ（遠心力）の大きさを"（１＋加速度センサの感度誤差％のカタログ仕様値×０．０１）倍"～"３倍程度（安価な加速度センサ程、遠心力の検出精度が低いために大きな倍率）"した値と停止時に超えないと見なせる値（停止時に通常とり得る観測雑音の３倍～６倍程度）の加算値に設定すればよい。
　遠心力ａｙの停止時に通常とり得る観測雑音は、加速度センサのカタログ仕様値でも良いし、停止時における遠心力ａｙの標準偏差として予め計測した値でもよい。
　比較値２は、（１）式の右辺（Ｖｘ・ωｚ）の値と左辺ａｙの値とを掛けた値の符号がマイナスで、絶対値が停止時には超えないと見なせる値より大きいか否かの判定に用いるので、停止時に超えないと見なせる速度（＝しきい値ｔｈ１）と停止時に超えないと見なせる角速度（＝しきい値ｔｈ２）と停止時に超えないと見なせる遠心力（＝ａｙの停止時に通常取り得る観測雑音の３倍～６倍程度）を掛けた大きさとなる値の負の値に設定すればよい。
　なお、図３のステップＳ１１の条件を満たさなかったときには、以降の判定処理をスキップするようにしてもよい。すなわち、移動体が停止しているときや直進しているときには、Ｘ軸方向の加速度センサの検出値および角速度センサの検出値のいずれもが小さいので的確な判定が行えない可能性がある。その場合にはセンサ検出値の補正が適正か否かの判定を行わないようにしてもよい。
《実施例２》
　図４は、実施例２に係る航法装置の統合演算部における、センサ検出値の補正が適正かの判定およびその判定結果に伴う処理内容を示すフローチャートである。実施例２に係る航法装置のハードウェアの構成は図１、センサ検出値の補正が適正かの判定内容については図３に示したものと同様であり、ここでは説明を省略する。
　図４に示す処理内容は次のとおりである。　
　まず、ＧＰＳ／ＩＮＳ演算を行う。前述したとおり、必要なＧＰＳ測位信号が得られているときには、衛星航法と慣性航法の航法演算を行い、ＧＰＳ測位信号が得られないときには、慣性航法演算のみを行う（Ｓ２１）。
　そして、必要なＧＰＳ測位信号が得られて、ＧＰＳ演算結果による有効または無効のステータスのうち、有効なステータスが得られたかを判定する（Ｓ２２）。
　続いてＧＰＳ／ＩＮＳ演算結果の信頼性判定を行う（Ｓ２２）。具体的には、前回までに求めたＧＰＳ／ＩＮＳ演算結果とＧＰＳ演算結果との差が所定値より小さい場合に、ＧＰＳ／ＩＮＳ演算結果の信頼性を「有り」と判定し、所定値より大きい場合はＧＰＳ／ＩＮＳ演算結果の信頼性を「無し」と判定する（Ｓ２３）。そしてＧＰＳ／ＩＮＳ演算結果の信頼性を「有り」と判定した場合、初期状態のＧＰＳ／ＩＮＳ演算結果の信頼性「無し」から「有り」に変更し、ＧＰＳ／ＩＮＳ演算結果の信頼性を「無し」と判定した場合には、初期状態のＧＰＳ／ＩＮＳ演算結果の信頼性「無し」を維持する（Ｓ２４）。ここでこの判定に用いる所定値には、ＧＰＳ演算結果の誤差と同等以上に設定する。
　その後、センサ検出値の補正が適正であるか否かの判定を行う（Ｓ２５）。このセンサ検出値の補正が適正であるか否かの判定は図２に示したステップＳ２（図３の処理）と同様であり、ここでの説明は省略する。　
　センサ検出値が適正に補正されていないと判定した場合、ＧＰＳ／ＩＮＳ演算結果の信頼性を「無し」に変更する（Ｓ２６）。
　そして、ＧＰＳ／ＩＮＳ演算結果の信頼性の判定を行う（Ｓ２７）。具体的にはステップＳ２３と同様の処理を行い、その結果、ＧＰＳ／ＩＮＳ演算結果の信頼性を「有り」と判定した場合、ＧＰＳ／ＩＮＳ演算結果を用いて測位結果を更新する（Ｓ２８）。
　ＧＰＳ／ＩＮＳ演算結果の信頼性を「無し」と判定した場合、ＧＰＳ演算結果で有効なステータスが得られているか否かを判定する（Ｓ２９）。そしてＧＰＳ測位結果で有効なステータスが得られている場合は、ＧＰＳ演算結果を用いて測位結果を更新する（Ｓ３０）。しかし、ＧＰＳ／ＩＮＳ演算結果の信頼性を「無し」と判定し、ＧＰＳ演算結果で無効なステータスが得られている場合には測位結果を更新しない（Ｓ３１）。
　上記ＧＰＳ／ＩＮＳ演算結果の信頼性を「有り」と判定したとき、「ＧＰＳ／ＩＮＳ演算の結果を更新する」という処理に代えて、「測位状態を表すステータスを有効にする」処理を行い、ＧＰＳ／ＩＮＳ演算結果の信頼性を「無し」と判定したとき、「ＧＰＳ／ＩＮＳ演算結果を更新しない」という処理に代えて、「測位状態を表すステータスを無効にする」という処理を行ってもよい。
　図２・図３に示した実施例１の処理では、移動体の直進時や停車時には図３のステップＳ１１で常にＮＯとなり、連続回数が０（零）にクリアされて、センサ検出値が適正に補正されていると判定されるので、測位結果が更新されてしまう。これに対して、図４に示した実施例２では、ＧＰＳ中断時にセンサ検出値の補正が適正に行われていないと判断された場合には、ＧＰＳ測位が再開するまでは測位結果が更新されない。そのため、精度の劣化した測位結果の出力を防ぐことができる。
　また、図２・図３に示した実施例１の処理では、センサ検出値の補正が適正に行われていないと判定された場合にはＧＰＳ演算結果が有効であっても測位結果を更新しないが、図４に示した実施例２では、ＧＰＳ演算結果が有効になればＧＰＳ測位演算により測位結果が速やかに更新される。
　補正されたセンサ検出値（加速度，角速度）はＧＰＳ／ＩＮＳ演算結果の微分値に相当するものであるため、妥当性のない値の積分値は信頼できない。そのため、センサ検出値の補正が適正に行われていないと判定された場合にはＧＰＳ／ＩＮＳ演算結果は信頼できない。しかし、センサ検出値の補正が適正である、ということはＧＰＳ／ＩＮＳ演算結果の微分値が信頼できることにしかならないので、センサ検出値の補正が適正に行われていると判定された場合であっても、ＧＰＳ／ＩＮＳ演算結果が信頼できるとは必ずしも限らない。そこで、図４のステップ（Ｓ２５→Ｓ２６）のように、センサ検出値の補正が適正に行われていないと判定された場合には、ＧＰＳ／ＩＮＳ演算結果の信頼性を「なし」に変更する。
　なお、以上に示した例では衛星航法測位のためにＧＰＳを用いる例を示したが、別の衛星航法測位システムを利用する場合にも同様に適用できる。
　この発明は、航法衛星からの測位信号を受信して得られる観測量と、加速度センサ等の外部センサより得られる観測量とを統合して測位を行う衛星航法／推測航法統合測位装置に利用可能である。
符号の説明
　１１…ＧＰＳ受信機、１２…加速度センサ、１３…角速度センサ、２０…追尾処理部、２１…ＧＰＳ／ＩＮＳ演算部、２２…センサ検出値の適正補正判定部、３０…統合演算部、１００…航法装置

Claims (6)

  1. 　航法衛星の測位信号と外部センサの検出値とを基に移動体の航法データを求めるとともに、前記外部センサの検出値に対する補正値を求めて、前記外部センサの検出値にフィードバックする統合測位演算手段を備えた衛星航法／推測航法統合測位装置において、
    　前記外部センサは少なくとも加速度を検出する加速度センサと角速度を検出する角速度センサを含み、
    　前記加速度センサの検出値と前記角速度センサの検出値の誤差を求め、当該誤差が所定のしきい値を超えるか否かを判定するセンサ検出値の適正補正判定手段を備えた衛星航法／推測航法統合測位装置。
  2. 　航法衛星の測位信号と外部センサの検出値とを基に移動体の航法データを求めるとともに、前記外部センサの検出値に対する補正値を求めて、前記外部センサの検出値にフィードバックする統合測位演算手段を備えた衛星航法／推測航法統合測位装置において、
    　前記外部センサは少なくとも加速度を検出する加速度センサと角速度を検出する角速度センサを含み、
    　前記加速度センサは、移動体の前後方向であるＸ軸方向と、前記移動体の左右方向であるＹ軸方向の少なくとも２軸の加速度を検出する加速度センサであり、前記角速度センサは、前記Ｘ軸方向及び前記Ｙ軸方向に対して直交するＺ軸回りの方位方向の角速度を検出する少なくとも１軸の角速度センサであり、
    　前記Ｘ軸方向の加速度を検出する加速度センサの検出値を積分したＸ軸方向の速度と、前記角速度センサの検出値との積を求めるとともに、Ｙ軸方向の加速度を検出する加速度センサの検出値と前記積との差を求め、当該差が所定のしきい値を超えるか否かを判定することによって前記加速度センサおよび角速度センサの検出値が適切であるか否かを判定するセンサ検出値の適正補正判定手段を備えた衛星航法／推測航法統合測位装置。
  3. 　前記統合測位演算手段は、前記検出値が適正であると判定されたとき、前記加速度センサ及び前記角速度センサの検出値を用いた測位演算を継続し、または測位演算の結果を出力し、前記検出値が不適正と判定されたとき、前記外部センサの検出値を用いた測位演算を停止し、または測位演算を停止する直前の測位結果等、前記外部センサの検出値を用いた測位演算の結果以外の値を出力するものである、請求項１または２に記載の衛星航法／推測航法統合測位装置。
  4. 　前記適正補正判定手段は、前記Ｘ軸方向の速度と前記方位方向の角速度の絶対値がそれぞれ所定のしきい値を超えるときに前記判定を行う、請求項１～３のいずれかに記載の衛星航法／推測航法統合測位装置。
  5. 　前記適正補正判定手段は、前記Ｘ軸方向の速度と前記方位方向の角速度との積の絶対値が前記Ｙ軸方向の加速度の絶対値を含む比較値を超えるか否かによって前記判定を行う、請求項１～４のいずれかに記載の衛星航法／推測航法統合測位装置。
  6. 　前記適正補正判定手段は、前記Ｘ軸方向の速度と前記方位方向の角速度との積が前記Ｙ軸方向の加速度と同符号であるか否かによって前記判定を行う、請求項１～５のいずれかに記載の衛星航法／推測航法統合測位装置。
PCT/JP2009/050899 2008-02-29 2009-01-21 衛星航法／推測航法統合測位装置 WO2009107424A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
EP09715707.7A EP2249172B1 (en) 2008-02-29 2009-01-21 Satellite navigation/dead-reckoning navigation integrated positioning device
US12/918,016 US8965690B2 (en) 2008-02-29 2009-01-21 Satellite navigation/dead-reckoning navigation integrated positioning device

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2008051145A JP5354931B2 (ja) 2008-02-29 2008-02-29 衛星航法／推測航法統合測位装置
JP2008-051145 2008-02-29

Publications (1)

Publication Number Publication Date
WO2009107424A1 true WO2009107424A1 (ja) 2009-09-03

Family

ID=41015830

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2009/050899 WO2009107424A1 (ja) 2008-02-29 2009-01-21 衛星航法／推測航法統合測位装置

Country Status (4)

Country Link
US (1) US8965690B2 (ja)
EP (1) EP2249172B1 (ja)
JP (1) JP5354931B2 (ja)
WO (1) WO2009107424A1 (ja)

Families Citing this family (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8140263B2 (en) * 2008-01-31 2012-03-20 Victor Company Of Japan, Limited Method for deriving conversion coefficient used for specifying position from value detected by various sensors, and navigation apparatus
JP4780155B2 (ja) * 2008-08-01 2011-09-28 株式会社デンソー 車載装置
US20150099987A1 (en) * 2010-06-07 2015-04-09 Affectiva, Inc. Heart rate variability evaluation for mental state analysis
KR101796322B1 (ko) * 2011-01-07 2017-12-01 삼성전자주식회사 항법 알고리즘을 이용한 위치 정보 검출 장치 및 방법
FR2977314B1 (fr) * 2011-06-29 2013-07-12 Ixblue Dispositif et procede de navigation integrant plusieurs systemes inertiels de navigation hybrides
GB2498801B (en) 2012-01-30 2014-08-20 Toshiba Res Europ Ltd Dynamic compensation for wireless device location determination
US9064352B2 (en) * 2013-04-24 2015-06-23 Caterpillar Inc. Position identification system with multiple cross-checks
US11036238B2 (en) 2015-10-15 2021-06-15 Harman International Industries, Incorporated Positioning system based on geofencing framework
US10234292B2 (en) 2014-08-08 2019-03-19 Stmicroelefctronics S.R.L. Positioning apparatus and global navigation satellite system, method of detecting satellite signals
CN107764260A (zh) * 2017-09-30 2018-03-06 湖南城市学院 一种卫星航迹定位系统
JP7069624B2 (ja) * 2017-10-05 2022-05-18 日産自動車株式会社 位置演算方法、車両制御方法及び位置演算装置
KR20200057511A (ko) 2018-11-16 2020-05-26 현대자동차주식회사 차량 측위 시스템 및 방법
US10845197B2 (en) * 2018-11-27 2020-11-24 Aptiv Technologies Limited Dead-reckoning guidance system and method with cardinal-direction based coordinate-corrections
US11567186B2 (en) 2019-03-19 2023-01-31 Kabushiki Kaisha Toshiba Compensating radio tracking with comparison to image based tracking
FR3102879A1 (fr) * 2019-10-30 2021-05-07 Renault S.A.S Système et procédé de gestion de la position d’un véhicule autonome.

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0850024A (ja) * 1994-08-05 1996-02-20 Nippondenso Co Ltd 車両用ナビゲーション装置
JP2002333332A (ja) * 2001-05-08 2002-11-22 Pioneer Electronic Corp ハイブリッド処理方法及び装置、ナビゲーションシステム並びにコンピュータプログラム
JP3380404B2 (ja) 1995-08-28 2003-02-24 日本政策投資銀行 移動検出装置
JP2006071474A (ja) * 2004-09-02 2006-03-16 Alpine Electronics Inc 角速度センサの感度誤差検出装置および方法
JP2006242578A (ja) * 2005-02-28 2006-09-14 Matsushita Electric Works Ltd 測位装置およびそれを用いる位置情報システム
JP2007071868A (ja) * 2005-08-08 2007-03-22 Furuno Electric Co Ltd キャリア位相相対測位装置及び方法

Family Cites Families (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH06229772A (ja) * 1993-02-04 1994-08-19 Hitachi Ltd 積分型センシング装置
US5935191A (en) * 1994-11-08 1999-08-10 Matsushita Electric Industrial Co., Ltd. Navigation apparatus for a vehicle
JP3783257B2 (ja) * 1994-11-08 2006-06-07 松下電器産業株式会社 ナビゲーション装置
US5828987A (en) * 1995-08-28 1998-10-27 Data Tec Co., Ltd. Movement detecting device
JPH10153443A (ja) * 1996-11-21 1998-06-09 Matsushita Electric Ind Co Ltd ナビゲーション装置
US6234799B1 (en) 1998-04-06 2001-05-22 American Gnc Corporation Real-time IMU simulator
JPH11295103A (ja) * 1998-04-15 1999-10-29 Sony Corp 航法装置
US6167347A (en) 1998-11-04 2000-12-26 Lin; Ching-Fang Vehicle positioning method and system thereof
US6246960B1 (en) 1998-11-06 2001-06-12 Ching-Fang Lin Enhanced integrated positioning method and system thereof for vehicle
US6240367B1 (en) 1998-11-27 2001-05-29 Ching-Fang Lin Full fusion positioning method for vehicle
CN1384915A (zh) * 1999-09-15 2002-12-11 赛尔弗技术公司 用于跟踪目标位置的导航系统和方法
US6480152B2 (en) 2000-07-20 2002-11-12 American Gnc Corporation Integrated GPS/IMU method and microsystem thereof
US6408245B1 (en) 2000-08-03 2002-06-18 American Gnc Corporation Filtering mechanization method of integrating global positioning system receiver with inertial measurement unit
US6697736B2 (en) 2002-02-06 2004-02-24 American Gnc Corporation Positioning and navigation method and system thereof
KR20060097559A (ko) * 2003-10-21 2006-09-14 마쯔시다덴기산교 가부시키가이샤 리샘플 길이 결정 방법과 장치
JP3868416B2 (ja) * 2003-11-06 2007-01-17 松下電器産業株式会社 角速度補正装置
JP2007040766A (ja) * 2005-08-01 2007-02-15 Toyota Motor Corp センサユニット
GB2429128B (en) 2005-08-08 2009-03-11 Furuno Electric Co Apparatus and method for carrier phase-based relative positioning
JP2008089517A (ja) * 2006-10-04 2008-04-17 Sony Corp 方位判別装置、方位判別方法及び方位判別プログラム
JP4781300B2 (ja) * 2007-03-01 2011-09-28 アルパイン株式会社 位置検出装置および位置検出方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH0850024A (ja) * 1994-08-05 1996-02-20 Nippondenso Co Ltd 車両用ナビゲーション装置
JP3380404B2 (ja) 1995-08-28 2003-02-24 日本政策投資銀行 移動検出装置
JP2002333332A (ja) * 2001-05-08 2002-11-22 Pioneer Electronic Corp ハイブリッド処理方法及び装置、ナビゲーションシステム並びにコンピュータプログラム
JP2006071474A (ja) * 2004-09-02 2006-03-16 Alpine Electronics Inc 角速度センサの感度誤差検出装置および方法
JP2006242578A (ja) * 2005-02-28 2006-09-14 Matsushita Electric Works Ltd 測位装置およびそれを用いる位置情報システム
JP2007071868A (ja) * 2005-08-08 2007-03-22 Furuno Electric Co Ltd キャリア位相相対測位装置及び方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
See also references of EP2249172A4

Also Published As

Publication number Publication date
US8965690B2 (en) 2015-02-24
US20100332135A1 (en) 2010-12-30
EP2249172A1 (en) 2010-11-10
EP2249172B1 (en) 2015-08-26
JP2009210296A (ja) 2009-09-17
EP2249172A4 (en) 2012-08-15
JP5354931B2 (ja) 2013-11-27

Similar Documents

Publication Publication Date Title
JP5354931B2 (ja) 衛星航法／推測航法統合測位装置
Ryu et al. Vehicle sideslip and roll parameter estimation using GPS
US9183463B2 (en) Orientation model for a sensor system
JP5270184B2 (ja) 衛星航法／推測航法統合測位装置
JP4191499B2 (ja) 車載装置
US20090088975A1 (en) Navigation device
JP4854778B2 (ja) 車両用推定航法装置、車両用推定航法及び車両用推定航法のプログラム
JP2008116370A (ja) 移動体位置測位装置
JP4739378B2 (ja) 取付け角度検出装置
US8798925B2 (en) System and method of determining an unambiguous heading direction of a vehicle
US9605958B2 (en) Method and device for determining the inclined position of a vehicle
JP2010274701A (ja) 車両物理量推定装置
JP3505494B2 (ja) 移動体の方位推定装置および位置推定装置
JP2011053166A (ja) 測位方法および装置
KR100586894B1 (ko) 차량의 정지상태 판단방법과 이를 이용한 차량 항법정보생성방법 및 차량항법장치
KR101367759B1 (ko) 차량용 블랙박스 시스템의 제어방법
US20220212742A1 (en) Body posture detection device and straddle type vehicle
JP2012042285A (ja) ヨー角初期化異常判定装置及び方法
KR20050018440A (ko) 차량의 위치 보정 시스템
JP6632727B2 (ja) 角度計測装置
JP2008209242A (ja) 対地車速計測装置
JP2021067472A (ja) センサ誤差補正装置
CN108779986B (zh) 行进方向推测装置
JP2021142969A5 (ja)
JP2020080743A (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: 09715707

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 12918016

Country of ref document: US

WWE Wipo information: entry into national phase

Ref document number: 2009715707

Country of ref document: EP

NENP Non-entry into the national phase

Ref country code: DE