WO2010134411A1 - 移動状態検出装置 - Google Patents
移動状態検出装置 Download PDFInfo
- Publication number
- WO2010134411A1 WO2010134411A1 PCT/JP2010/056932 JP2010056932W WO2010134411A1 WO 2010134411 A1 WO2010134411 A1 WO 2010134411A1 JP 2010056932 W JP2010056932 W JP 2010056932W WO 2010134411 A1 WO2010134411 A1 WO 2010134411A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- acceleration
- component
- angle
- mounting angle
- state detection
- Prior art date
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P21/00—Testing or calibrating of apparatus or devices covered by the preceding groups
-
- 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/185—Compensation of inertial measurements, e.g. for temperature effects for gravity
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P15/00—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration
- G01P15/02—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration by making use of inertia forces using solid seismic masses
- G01P15/08—Measuring acceleration; Measuring deceleration; Measuring shock, i.e. sudden change of acceleration by making use of inertia forces using solid seismic masses with conversion into electric or magnetic values
- G01P15/0802—Details
Definitions
- the present invention relates to a moving state detection device that is installed on a moving body and detects a moving state such as a speed and a pitch angle of the moving body.
- various navigation devices that are attached to a moving body such as an automobile, detect the position, traveling speed, and traveling direction of the moving body and display information for assisting traveling to a destination have been devised.
- a navigation device detects its own position based on a positioning signal from a positioning satellite such as a GPS satellite, speed information inherent in the moving body such as a vehicle speed pulse in an automobile, and a gyroscope.
- the moving state of the moving body is detected by using direction information by a sensor or the like.
- navigation can be executed by acquiring speed information by a single navigation device separately from a navigation device that is installed in advance on the mobile body as described above and that can acquire speed information and the like of the mobile body.
- Various personal navigation devices that are relatively small and portable are also devised. By installing such a personal navigation device on the moving body, the navigation system can be used even if the navigation device is not originally mounted on the moving body.
- the mounting angle calculation devices described in Patent Documents 1 and 2 described above do not detect the mounting angle based only on the output value of the acceleration sensor, but can be obtained from the angular velocity from the gyro sensor or the angular velocity sensor, or from the moving body described above.
- the acceleration output from the acceleration sensor includes unnecessary components such as a bias component and a noise component, but these are not taken into consideration. Therefore, since the mounting angle is calculated using acceleration including an error due to a bias component and a noise component, the mounting angle cannot be calculated with high accuracy. For this reason, the acceleration from the acceleration sensor is not accurately corrected, and the traveling speed and traveling direction of the moving body cannot be obtained accurately.
- the object of the present invention is to eliminate the influence of unnecessary components such as bias components and noise components included in the acceleration output from the acceleration sensor, accurately calculate the mounting angle of the acceleration sensor, and accurately determine the acceleration from the acceleration sensor.
- An object of the present invention is to realize a moving state detection device that can be well corrected.
- the moving state detection device of the present invention includes an acceleration sensor and an acceleration correction unit.
- the acceleration sensor is installed on the moving body and detects the acceleration of the moving body.
- the acceleration correction unit decomposes the acceleration obtained from the acceleration sensor for each frequency band, estimates the mounting angle of the acceleration sensor based on the gravitational frequency component and the motion acceleration frequency component including the predetermined frequency band component, and the mounting angle The acceleration is corrected based on the above.
- the moving state detection device of the present invention includes an acceleration sensor and an acceleration correction unit.
- the acceleration sensor is installed on the moving body and detects the acceleration of the moving body.
- the acceleration correction unit decomposes the acceleration obtained from the acceleration sensor into a bias frequency component, a gravity frequency component, a motion acceleration frequency component, and a noise frequency component for each frequency band sequentially from the low frequency side, and the gravity frequency component and the motion acceleration frequency component. Is used to estimate the mounting angle of the acceleration sensor, and the acceleration is corrected based on the mounting angle.
- the acceleration obtained by the acceleration sensor is decomposed for each frequency component.
- the bias frequency component is a component that is output substantially steadily regardless of the moving state of the moving body, and is composed of an extremely low frequency.
- the noise frequency component is a component that continues to fluctuate randomly regardless of the moving state of the moving object, and has a high frequency.
- the gravitational frequency component and the motion acceleration frequency component depend on the moving state of the moving body, and the fluctuation is larger than the bias frequency component. Therefore, the frequency component is higher than the bias frequency component. Since there is no randomness, the frequency component is lower than the noise frequency component.
- the acceleration correction unit of the moving state detection device of the present invention frequency-decomposes the acceleration by wavelet transform.
- the acceleration sensor of the moving state detection apparatus of the present invention detects acceleration components using the longitudinal acceleration component, the lateral acceleration component, and the vertical acceleration component orthogonal to each other.
- the acceleration correction unit estimates the azimuth direction mounting angle from the longitudinal acceleration component and the lateral acceleration component, estimates the pitch direction mounting angle from the longitudinal acceleration component and the vertical acceleration component, the longitudinal acceleration component, and the lateral acceleration component. , And at least one of estimation of the roll direction mounting angle based on the vertical direction acceleration component and the pitch direction mounting angle.
- the acceleration sensor of the moving state detection apparatus of the present invention detects acceleration components using the longitudinal acceleration component, the lateral acceleration component, and the vertical acceleration component orthogonal to each other.
- the acceleration correction unit estimates the azimuth mounting angle from the longitudinal acceleration component and the lateral acceleration component, and estimates the pitch direction mounting angle from the longitudinal acceleration component and the vertical acceleration component.
- the roll direction mounting angle is estimated from the acceleration component, the vertical direction acceleration component, and the pitch direction mounting angle.
- the acceleration correction unit of the moving state detection device of the present invention estimates at least one of the azimuth direction mounting angle and the pitch direction mounting angle when the lateral acceleration component is less than a predetermined threshold.
- the acceleration correction unit of the moving state detection device of the present invention estimates the azimuth direction mounting angle and the pitch direction mounting angle when the lateral acceleration component is less than a predetermined threshold.
- the acceleration correction unit of the moving state detection device of the present invention estimates the roll direction mounting angle when the lateral acceleration component is equal to or greater than a predetermined threshold.
- the acceleration correction unit of the moving state detection device of the present invention sequentially stores the estimated mounting angles and calculates the mounting angles by time averaging processing. At this time, the acceleration correcting unit lowers the weight of the past mounting angle in the time averaging process when the currently estimated mounting angle changes by a predetermined angle or more with respect to the mounting angle estimated immediately before.
- the error component of the estimated mounting angle is suppressed by performing the time averaging process.
- the time averaging process For example, in the case of a vehicle that travels in a normal urban area or the like, most of the travel route is often flat, so the error component due to the mounting angle affected by the gradient angle estimated when climbing or descending It is suppressed by the time averaging process.
- the attachment angle can be calculated with higher accuracy.
- the attachment angle changes greatly for example, when the user forcibly changes the attachment angle, the influence of the attachment angle estimated and calculated in the past can be suppressed.
- the moving state detecting device of the present invention further includes a speed / traveling angle calculating unit that calculates at least one of the speed of the moving body and the traveling pitch angle that is the vertical inclination angle based on the acceleration corrected by the acceleration correcting unit. I have.
- This configuration shows a specific configuration example of the moving state detection device, and the speed and traveling angle of the moving body can be calculated with high accuracy from the acceleration of the moving body obtained with high accuracy as described above.
- the speed / running angle calculation unit of the moving state detection device calculates a division value by the gravitational acceleration of the gravity frequency component when the running pitch angle is calculated, and the calculated running pitch is calculated based on the division value. Correct the corners.
- the moving state detection device detects a stop of a moving body by detecting that the sum of the motion acceleration frequency component and the noise frequency component is less than a predetermined threshold when the noise frequency component is calculated.
- a detection unit is provided.
- the navigation device of the present invention includes the above-described movement state detection device, and executes its own position and navigation processing based on information relating to the movement of the moving object calculated by the movement state detection device.
- the mounting angle of the acceleration sensor can be calculated with high accuracy and the acceleration can be corrected with high accuracy.
- the speed and traveling angle of the moving body can be detected with high accuracy.
- FIG. 1 is a block diagram illustrating a main configuration of a moving state detection device 1 according to the present embodiment.
- the moving state detection device 1 includes an acceleration sensor 20, an acceleration correction unit 10, and a speed / running angle calculation unit 30, and is fixedly installed on a moving body such as a vehicle.
- the moving state detection device 1 according to the present embodiment detects the speed and traveling angle (traveling pitch angle, traveling roll angle, traveling azimuth angle (yaw angle)) of the moving object. If only acceleration is output, the speed / running angle calculation unit 30 may be omitted.
- the acceleration sensor 20 has, in its own coordinate system (sensor coordinate system), an acceleration component a x s corresponding to the x-axis direction that is the front-rear direction of the moving body and an acceleration corresponding to the y-axis direction that is the lateral direction of the moving body.
- a sensor coordinate system acceleration [a x b , a y b , a z b ] composed of a component a y s and an acceleration component a z s corresponding to the z-axis direction that is the vertical direction of the moving body is detected.
- FIG. 2 is a diagram for explaining the coordinate system of the moving body.
- the coordinate system of the moving body includes an x-axis having the longitudinal direction of the moving body as an axial direction, a y-axis having the lateral direction of the moving body as an axial direction, and the vertical direction of the moving body as an axial direction.
- the direction rotating around the x axis as the central axis is the roll angle ( ⁇ ) direction
- the direction rotating around the y axis as the central axis is the pitch angle ( ⁇ ) direction
- the direction rotating around the z axis as the central axis is the azimuth angle
- the direction is ( ⁇ ).
- the acceleration sensor 20 is attached to the moving body at the attachment angles [ ⁇ , ⁇ , ⁇ ], the sensor coordinate system acceleration [a x s , a y s , a output from the acceleration sensor 20 is provided. between each component of z s ] and each component of moving body coordinate system acceleration [a x b , a y b , a z b ] according to the solid angle based on the mounting angle [ ⁇ , ⁇ , ⁇ ] There is a difference.
- the acceleration correction unit 10 includes a frequency analysis unit 11, an attachment angle estimation unit 12, and a correction calculation unit 13.
- Frequency analyzer 11 the sensor coordinate system acceleration [a x s, a y s , a z s] to be converted into acceleration component group on the frequency axis by the wavelet transform. More specifically, the frequency analyzer 11, the sensor coordinate system acceleration [a x s, a y s , a z s] , for example, it acquired every second, stores 64 seconds, these 64 seconds Perform wavelet transform based on minute data. Then, the frequency analysis unit 11 includes a substantially stationary component (DC component) corresponding to a sampling period of 64 seconds, a fluctuation component (AC component) corresponding to a sampling period of 32 seconds, and a fluctuation component (AC component) corresponding to a sampling period of 16 seconds.
- DC component substantially stationary component
- AC component fluctuation component
- AC component fluctuation component
- AC component fluctuation component
- AC component fluctuation component corresponding to a sampling period of 8 seconds (AC component), fluctuation component corresponding to a sampling period of 4 seconds (AC component), fluctuation component corresponding to a sampling period of 2 seconds (AC component), 1 A fluctuation component (AC component) corresponding to a sampling period of seconds is acquired.
- the frequency analysis unit 11 uses the acquired 64 second width DC component of the extremely low frequency as a bias frequency component, the 32 second width AC component of the mid frequency and the 16 second width AC component as the gravitational frequency component, and the mid frequency 8
- the second-width AC component, the 4-second width AC component, and the 2-second width AC component are set as the motion acceleration frequency component, and the 1-second width AC component is set as the noise frequency component.
- the DC component obtained with a width of 64 seconds can be considered to be output from the acceleration sensor 20 substantially constantly regardless of the moving state of the moving body.
- the AC component obtained in the width of 32 seconds or 16 seconds depends on the moving state of the moving body, but has a relatively low influence, and depends on the gravity generated in the moving body rather than the motion acceleration of the moving body. It is because it can be considered that it is an easy component.
- the AC components obtained in the widths of 8 seconds, 4 seconds, and 2 seconds are greatly affected by the moving state of the moving body, and the movement acceleration of the moving body is higher than the constant gravitational acceleration. It is because it can be considered that it is a component which is easy to depend on.
- the AC component obtained in 1 second width can be regarded as including more randomness than the motion acceleration of the moving body.
- the frequency analysis unit 11 uses the sum of the gravity frequency component and the motion acceleration frequency component obtained by the wavelet transform as detection accelerations [a x (AG) s , a y (AG) s , a z (AG) s ]. And output to the mounting angle estimation unit 12 and the correction calculation unit 13.
- the attachment angle estimation unit 12 estimates and calculates the attachment angles [ ⁇ , ⁇ , ⁇ ] from the accelerations for detection [ax (AG) s , a y (AG) s , a z (AG) s ].
- the estimation of the mounting angle may be performed, for example, every second in accordance with the acquisition timing of the sensor coordinate system acceleration described above, and the timing set appropriately while buffering each frequency component of the sensor coordinate system acceleration. It may be done every time.
- C b s is a rotation matrix for converting the moving body coordinate system to the acceleration sensor coordinate system, and can be expressed by the following equation using the mounting angles [ ⁇ , ⁇ , ⁇ ].
- equation (1) can be expressed by the following equation.
- equation (5) is expressed as the following equation.
- the roll direction attachment angle ⁇ is calculated from the following equation using the pitch direction azimuth ⁇ calculated by the above equation (7).
- the mounting angles [ ⁇ , ⁇ , ⁇ ] can be estimated and calculated from only the detection accelerations [ax (AG) s , a y (AG) s , a z (AG) s ].
- a selection condition for straight traveling or turning is set. This is because a threshold value for turning detection is set in advance for the lateral acceleration a y (AG) s . If the lateral acceleration a y (AG) s is equal to or greater than the threshold value, it is determined that the vehicle is turning, and if it is less than the threshold value, it is determined that the vehicle is traveling straight.
- a threshold value for turning detection is set in advance for the lateral acceleration a y b in the moving body coordinate system calculated by the correction calculation unit 13 described later, and the lateral acceleration a y b is equal to or greater than the threshold value. It may be determined that the vehicle is traveling straight, and if it is less than the threshold value, it is determined that the vehicle is traveling straight.
- the mounting angle estimation unit 12 calculates the mounting angles [ ⁇ , ⁇ , ⁇ ] at predetermined timings from the above formulas (7A), (7B), and (10). Then, after performing a process corresponding to the time averaging process using the following Kalman filter, the estimated mounting angles [ ⁇ , ⁇ , ⁇ ] are output to the correction calculation unit 13.
- the azimuth direction mounting angle ⁇ , the pitch direction mounting angle ⁇ , and the roll direction mounting angle ⁇ are time-averaged, and the condition for traveling on flat ground is canceled, and the mounting angles [ ⁇ , ⁇ , ⁇ ] can be estimated and calculated.
- the mounting angles [ ⁇ , ⁇ , ⁇ ] are estimated and calculated with high accuracy. can do.
- ⁇ is a weight value and can be set as appropriate. However, if the weight value ⁇ is set based on the following conditions, a further effect can be obtained.
- ⁇ is a weight value and can be set as appropriate.
- ⁇ is set based on the following conditions, a further effect can be obtained.
- only the azimuth direction mounting angle ⁇ will be described, but the same effect can be obtained with respect to the pitch direction mounting angle ⁇ and the roll direction mounting angle ⁇ .
- the longitudinal acceleration a x (AG) s of the sensor coordinate system is not “0”, but is in a straight traveling state, and ( ⁇ a y (AG) s / a x (AG) s ⁇ [ If t]) is less than the threshold value ⁇ for detecting the attachment angle change, ⁇ 1 is set. Further, the longitudinal acceleration a x (AG) s of the sensor coordinate system is not “0” with respect to the weight value ⁇ , but is in a straight traveling state and ( ⁇ a y (AG) s / a x (AG) s ⁇ If ⁇ [t]) is equal to or larger than the threshold ⁇ for detecting the attachment angle change, ⁇ 2 is set.
- ⁇ 1 and ⁇ 2 are set to satisfy 0 ⁇ 1 ⁇ ⁇ 2 ⁇ 1.
- the installation angle calculated this time has not changed significantly with respect to the installation angle calculated and time-averaged last time, the installation angle based on the past calculation results Time average processing is performed so as to be greatly affected.
- the installation angle calculated this time has changed significantly with respect to the installation angle calculated and time-averaged the previous time, the time-average process is made to be less affected by the installation angle based on past calculation results. Is done.
- the mounting angle of the moving state detection device 1, that is, the acceleration sensor 20 is not changed, it is possible to estimate and calculate the mounting angle with higher accuracy using the past stable mounting angle. Even when it is forcibly changed by a user or the like, the attachment angle can be estimated and calculated continuously while suppressing the influence of the change.
- the correction calculation unit 13 Based on the mounting angles [ ⁇ , ⁇ , ⁇ ] estimated and calculated by the mounting angle estimation unit 12, the correction calculation unit 13 detects accelerations [ax (AG) s , a y output from the frequency analysis unit 11. By correcting (AG) s , a z (AG) s ], the mobile body coordinate system acceleration [a x b , a y b , a z b ] is calculated and output.
- this correction is based on the following principle.
- the acceleration for detection [a x (AG) s , a y (AG) s , a z (AG) s ] and the moving body coordinate system acceleration [a x b , a y b , a z b ] are given, Holds.
- C s b is a rotation matrix for converting the moving body coordinate system to the acceleration sensor coordinate system, and can be expressed by the following expression using the estimated mounting angles [ ⁇ , ⁇ , ⁇ ].
- the correction calculation unit 13 uses the rotation matrix C s b to convert the detection acceleration [a x (AG) s , a y (AG) s , a z (AG) s ] into the moving body coordinate system acceleration. It is converted into [a x b , a y b , a z b ] and output.
- the system acceleration [a x b , a y b , a z b ] can also be a highly accurate value.
- the speed / travel angle calculation unit 30 calculates the travel speed and travel angle of the moving body based on the following principle.
- an example of calculating only the longitudinal speed v x and the vertical direction driving pitch angle a traveling angle of ⁇ of the mobile also applies to the running speed and running angle in the other direction It can be calculated by using the principle of
- the longitudinal component a x b , the vertical component a z b of the acceleration of the moving body coordinate system, the traveling speed v x in the longitudinal direction, and the traveling pitch angle ⁇ are as follows when the gravitational acceleration is g. It becomes.
- the vertical component a z b of the acceleration of the moving body coordinate system is the acceleration for detection [a x (AG) s , a y (AG) s , from which the bias frequency component is removed by the wavelet transform as described above.
- az (AG) s ] the equation (15B) can be expressed by the following equation.
- the longitudinal component a x b of the acceleration in the moving body coordinate system is also detected by detecting acceleration [a x (AG) s , a y (AG) from which the bias frequency component has been removed by the wavelet transform as described above. s 1 , a z (AG) s ], the equation (15A) can be expressed by the following equation.
- equation (16) by calculating the simultaneous differential equations consisting of the equation (17) can be calculated with the traveling speed v x in the longitudinal direction, the running pitch angle theta.
- the speed / running angle calculation unit 30 executes a Kalman filter process shown in the following equation.
- t is time (calculation timing)
- ⁇ t indicates an update time interval.
- the traveling speed and traveling angle of the moving body can be calculated with high accuracy by using the acceleration of the moving object coordinate system obtained with high accuracy as described above.
- FIG. 3 is a graph showing the transition of acceleration in the vertical direction
- FIG. 3A shows the transition of vertical acceleration when the configuration of this embodiment is used
- FIG. 3B shows the conventional configuration. The transition of vertical acceleration when used is shown.
- a section of about 240 seconds to about 350 seconds and a section of about 440 seconds to about 550 seconds are time zones in which the vehicle travels on the slope.
- the speed-travel angle calculating unit 30 calculates the correction running pitch angle ⁇ c by dividing the gravity frequency component by the gravitational acceleration g.
- the speed / travel angle calculation unit 30 calculates the travel pitch angle to be output by performing a weighted average process on the travel pitch angle ⁇ obtained by the above formulas (18A) and (18B) and the correction travel pitch angle ⁇ c. To do. By performing such processing, accumulation errors can be prevented from being accumulated, and deterioration in accuracy due to long-term calculation processing can be suppressed.
- the timing at which this weighted average process is performed may be set for each calculation timing of the running pitch angle ⁇ , but may be set as appropriate at a longer predetermined timing interval.
- FIG. 4 is a block diagram showing the main configuration of the moving state detection device 1 ′ of this embodiment.
- the movement state detection device 1 ′ of the present embodiment is obtained by adding a stop detection unit 40 to the movement state detection device 1 shown in the first embodiment. Only the part related to is described.
- Stop detection unit 40 the frequency analyzing unit 11, the sensor coordinate system acceleration [a x s, a y s , a z s] in the motion acceleration frequency component and stop detecting acceleration comprising a sum of a noise frequency component [a x (AN) s , a y (AN) s , a z (AN) s ].
- the stop detection unit 40 includes the longitudinal component a x (AN) s and the lateral component a y (AN ) of the acceleration [ax (AN) s , a y (AN) s , a z (AN) s ] for stop detection.
- a stop detection threshold value ( ⁇ 0) is stored in advance for s .
- the stop detecting unit 40 detects that the longitudinal component a x (AN) s and the lateral component a y (AN) s of the acceleration for detecting the stop are both equal to or less than the threshold for detecting the stop, the moving body stops.
- the stop detection data is output to the speed / running angle calculation unit 30.
- FIG. 5 is a block diagram illustrating a main configuration of the moving state detection apparatus 100 according to the present embodiment.
- the movement state detection apparatus 100 of the present embodiment is not limited to the speed and traveling angle according to the configuration of the movement state detection apparatus 1 shown in the first embodiment, but also various data from the GPS receiver 102 and the gyro sensor 101. Based on the angular velocity data, the position and moving direction of the moving body are calculated. Therefore, in the following description, description is abbreviate
- the moving state detection device 100 includes an azimuth calculation unit 50 and a position calculation unit 60 together with the configuration of the movement state detection device 1, and is connected to the gyro sensor 101 and the GPS receiver 102.
- the gyro sensor 101 has a configuration capable of detecting at least rotation in the azimuth direction, detects an angular velocity in the azimuth direction, and provides the azimuth detection unit 60 with the angular velocity.
- the GPS receiver 102 receives a GPS signal from a GPS satellite, performs positioning by a known method from the received GPS signal, and calculates GPS position data, GPS speed data, and GPS azimuth data.
- the GPS receiver 102 provides GPS position data to the position calculation unit 60, provides GPS speed data to the speed / running angle calculation unit 30 ′, and provides GPS direction data to the direction calculation unit 50.
- the speed / running angle calculation unit 30 ′ calculates the running angle from the above equations (18A) and (18B) using the differential value of the GPS speed data during the period when the GPS speed data is acquired.
- the speed / running angle calculation unit 30 ′ is a weighted average value of the differential value of the GPS speed data and the moving body coordinate system acceleration [a x b , a y b , a z b ] given from the acceleration correction unit 10.
- the traveling angle is calculated from the above equations (18A) and (18B).
- the speed / running angle calculation unit 30 ′ sets the speed data last output using the GPS speed data as an initial value, from the above formulas (18A) and (18B). Calculate speed and running angle.
- the azimuth calculation unit 50 outputs the GPS azimuth data as it is during the period of acquiring the GPS azimuth data.
- the azimuth calculation unit 50 may calculate and output a weighted average value of the value obtained by integrating the angular velocity data from the gyro sensor 101 and integrating it into the previously output azimuth data and the GPS azimuth data.
- the azimuth calculation unit 50 calculates the azimuth data by integrating the angular velocity data and integrating the initial azimuth data output using the GPS azimuth data as an initial value. .
- the position calculation unit 60 outputs the GPS position data as it is during the period of acquiring the GPS position data.
- the position calculating unit 60 integrates the speed data calculated from the speed data, the traveling angle data by the speed / traveling angle calculating unit 30, and the azimuth data by the azimuth calculating unit 50, and adds it to the previously output position data. And a weighted average value with the GPS position data may be calculated and output.
- the position calculation unit 60 sets the position data last output using the GPS position data as an initial value, the speed data, the traveling angle data, The position data is calculated by integrating and integrating the velocity vectors calculated from the direction data by the direction calculation unit 50.
- the position, speed, traveling angle, and direction of the moving body can be calculated with high accuracy.
- the various movement information of the moving body calculated with high accuracy in this way is used for navigation processing or the like in the navigation apparatus in which the movement state detection apparatus 1 is mounted.
- the navigation device includes at least a navigation processing unit that executes route navigation processing, a display unit, and an operation unit that can also be used as the display unit.
- the optimal route is calculated from the current position and the target position, and the route is displayed on the display unit.
- the navigation apparatus can implement
- the frequency analysis unit 11 performs wavelet transform.
- wavelet transformation is preferably used, but other frequency transformation processing, for example, Fourier transformation processing may be performed, and further, the frequency components may be decomposed by a plurality of filters having different pass frequency bands. Also good.
- the acceleration correction unit 10 is functionally divided into the frequency analysis unit 11, the attachment angle estimation unit 12, and the correction calculation unit 13 has been described. It may be realized. Further, even if the acceleration correction unit 10 and the speed / running angle calculation units 30 and 30 ′ are realized by one arithmetic element and an execution program, one arithmetic element is included so as to include the stop detection unit 40 in addition to these. And may be realized by an execution program.
- each element (azimuth direction) of these mounting angles [ ⁇ , ⁇ , ⁇ ] is shown.
- At least one of the attachment angle ⁇ , the pitch direction attachment angle ⁇ , and the roll direction attachment angle ⁇ ) may be estimated and calculated.
- the sensor coordinate system acceleration [a x s , a y s , a z s ] is decomposed into four components: a bias frequency component, a gravity frequency component, a motion acceleration frequency component, and a noise frequency component.
- the mounting angle is estimated using at least the gravitational frequency component and the motion acceleration frequency component in the sensor coordinate system acceleration [a x s , a y s , a z s ]. Extract it and use it.
- a bandpass filter whose passband is a frequency band corresponding to the gravity frequency component and the motion acceleration frequency component may be used. And when using this band pass filter, you may perform processes, such as changing a pass band according to a moving state, to moving bodies, such as travel speed.
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
Description
図1は、本実施形態の移動状態検出装置1の主要構成を示すブロック図である。
図1に示すように、移動状態検出装置1は、加速度センサ20、加速度補正部10、速度・走行角算出部30を備え、車両等の移動体に固定的に設置される。なお、本実施形態の移動状態検出装置1は、移動体の速度および走行角(走行ピッチ角、走行ロール角、走行方位角(ヨー角))を検出するものであるが、例えば、移動体の加速度のみを出力するものであれば、速度・走行角算出部30を省略しても良い。
図4は本実施形態の移動状態検出装置1’の主要構成を示すブロック図である。
本実施形態の移動状態検出装置1’は、第1の実施形態に示した移動状態検出装置1に対して停止検出部40が加えられたものであり、以下では、当該停止検出部40およびこれに関連する箇所のみを説明する。
図5は、本実施形態の移動状態検出装置100の主要構成を示すブロック図である。
本実施形態の移動状態検出装置100は、第1の実施形態に示した移動状態検出装置1の構成による速度や走行角のみでなく、GPS受信機102からの各種データや、ジャイロセンサ101からの角速度データに基づいて、移動体の位置および移動方位を算出するものである。したがって、以下の説明では、第1の実施形態に示した移動状態検出装置1の構成と同じ箇所については説明を省略し、異なる箇所のみを説明する。
Claims (13)
- 移動体に設置された加速度センサと、
該加速度センサから得られる加速度を周波数帯域毎に分解し、所定周波数帯域成分からなる重力周波数成分および運動加速度周波数成分に基づいて前記加速度センサの取付角度を推定して、該取付角度に基づいて前記加速度を補正する加速度補正部と、
を備えた移動状態検出装置。 - 前記加速度補正部は、
該加速度センサから得られる加速度を、周波数帯域毎にバイアス周波数成分、前記重力周波数成分、前記運動加速度周波数成分、および雑音周波数成分に分解し、前記重力周波数成分および前記運動加速度周波数成分に基づいて前記加速度センサの取付角度を推定して、該取付角度に基づいて前記加速度を補正する、
請求項1に記載の移動状態検出装置。 - 前記加速度補正部は、前記加速度をウェーブレット変換により周波数分解する、請求項1または請求項2に記載の移動状態検出装置。
- 前記加速度センサは、それぞれに直交する前後方向加速度成分、横方向加速度成分、および上下方向加速度成分で加速度成分を検出し、
前記加速度補正部は、
前記前後方向加速度成分と前記横方向加速度成分とによる方位方向取付角度の推定、
前記前後方向加速度成分と前記上下方向加速度成分とによるピッチ方向取付角度の推定、
前記前後方向加速度成分、前記横方向加速度成分、および前記上下方向加速度成分と前記ピッチ方向取付角度とによるロール方向取付角度の推定の少なくとも1つを実行する、請求項1または請求項3に記載の移動状態検出装置。 - 前記加速度センサは、それぞれに直交する前後方向加速度成分、横方向加速度成分、および上下方向加速度成分で加速度成分を検出し、
前記加速度補正部は、
前記前後方向加速度成分と前記横方向加速度成分とにより方位方向取付角度を推定し、
前記前後方向加速度成分と前記上下方向加速度成分とによりピッチ方向取付角度を推定し、
前記前後方向加速度成分、前記横方向加速度成分、および前記上下方向加速度成分と前記ピッチ方向取付角度とによりロール方向取付角度を推定する、請求項1~請求項3のいずれかに記載の移動状態検出装置。 - 前記加速度補正部は、
前記横方向加速度成分が所定閾値を未満の場合に、前記方位方向取付角度、前記ピッチ方向取付角度の少なくとも一方を推定する請求項4に記載の移動状態検出装置。 - 前記加速度補正部は、
前記横方向加速度成分が所定閾値を未満の場合に、前記方位方向取付角度および前記ピッチ方向取付角度を推定する請求項5に記載の移動状態検出装置。 - 前記加速度補正部は、
前記横方向加速度成分が前記所定閾値以上の場合に、前記ロール方向取付角度を推定する、請求項4~請求項7に記載の移動状態検出装置。 - 前記加速度補正部は、
推定した前記取付角度を順次記憶するとともに、前記取付角度を時間平均処理により算出し、
今回の推定した取付角度が直前に推定した取付角度に対して所定角度以上変化した場合、前記時間平均処理における過去の取付角度の重みを低くする、請求項1~請求項8のいずれかに記載の移動状態検出装置。 - 前記加速度補正部で補正された加速度に基づいて、前記移動体の速度、上下方向傾き角である走行ピッチ角の少なくとも一方を算出する速度・走行角算出部を備えた、請求項1~請求項9のいずれかに記載の移動状態検出装置。
- 前記速度・走行角算出部は、前記走行ピッチ角が算出される場合に、前記重力周波数成分の重力加速度による除算値を算出し、該除算値により、算出した走行ピッチ角を補正する、請求項10に記載の移動状態検出装置。
- 前記雑音周波数成分が算出される場合に、前記運動加速度周波数成分および前記雑音周波数成分の和が所定閾値未満であることを検出して前記移動体の停止を検出する停止検出部を備えた、請求項2~請求項11のいずれかに記載の移動状態検出装置。
- 請求項1~請求項12のいずれかに記載の移動状態検出装置を備え、
該移動状態検出装置が算出した前記移動体の移動に関する情報に基づいて自身の位置やナビゲーション処理を実行するナビゲーション装置。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
EP10777646.0A EP2434298B1 (en) | 2009-05-19 | 2010-04-19 | Movement condition detection device |
CN201080020698.3A CN102422166B (zh) | 2009-05-19 | 2010-04-19 | 移动状态检测装置 |
KR1020117030370A KR101761933B1 (ko) | 2009-05-19 | 2010-04-19 | 이동 상태 검출 장치 |
US13/265,762 US10012672B2 (en) | 2009-05-19 | 2010-04-19 | Moving state detecting device |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2009-121375 | 2009-05-19 | ||
JP2009121375A JP5736106B2 (ja) | 2009-05-19 | 2009-05-19 | 移動状態検出装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2010134411A1 true WO2010134411A1 (ja) | 2010-11-25 |
Family
ID=43126097
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2010/056932 WO2010134411A1 (ja) | 2009-05-19 | 2010-04-19 | 移動状態検出装置 |
Country Status (6)
Country | Link |
---|---|
US (1) | US10012672B2 (ja) |
EP (1) | EP2434298B1 (ja) |
JP (1) | JP5736106B2 (ja) |
KR (1) | KR101761933B1 (ja) |
CN (1) | CN102422166B (ja) |
WO (1) | WO2010134411A1 (ja) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012066821A1 (ja) * | 2010-11-18 | 2012-05-24 | 古野電気株式会社 | 角速度検出装置、角速度検出方法、移動状態検出装置およびナビゲーション装置 |
CN102506822A (zh) * | 2011-11-30 | 2012-06-20 | 北京天地玛珂电液控制系统有限公司 | 一种矿用倾角传感器 |
US9883173B2 (en) | 2013-12-25 | 2018-01-30 | 3Di Llc | Stereoscopic display |
US9986228B2 (en) | 2016-03-24 | 2018-05-29 | 3Di Llc | Trackable glasses system that provides multiple views of a shared display |
WO2020080459A1 (ja) * | 2018-10-19 | 2020-04-23 | パナソニックIpマネジメント株式会社 | 表示システム、表示装置、及び表示制御方法 |
US10652525B2 (en) | 2013-10-31 | 2020-05-12 | 3Di Llc | Quad view display system |
US11343487B2 (en) | 2013-10-31 | 2022-05-24 | David Woods | Trackable glasses system for perspective views of a display |
Families Citing this family (22)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20100318257A1 (en) * | 2009-06-15 | 2010-12-16 | Deep Kalinadhabhotla | Method and system for automatically calibrating a three-axis accelerometer device |
US20120173195A1 (en) * | 2010-12-03 | 2012-07-05 | Qualcomm Incorporated | Inertial sensor aided heading and positioning for gnss vehicle navigation |
JP6094026B2 (ja) * | 2011-03-02 | 2017-03-15 | セイコーエプソン株式会社 | 姿勢判定方法、位置算出方法及び姿勢判定装置 |
JP5794624B2 (ja) * | 2011-07-26 | 2015-10-14 | 本田技研工業株式会社 | 自動二輪車のピッチ角推定装置及びピッチ角推定プログラム |
WO2013049819A1 (en) * | 2011-09-30 | 2013-04-04 | Ims Solutions, Inc. | A method of correcting the orientation of a freely installed accelerometer in a vehicle |
BR112014025395B1 (pt) * | 2012-04-13 | 2022-07-26 | Wi-Tronix, Llc | Métodos para registrar, processar e transmitir dados a partir de um bem móvel |
JP6233727B2 (ja) * | 2013-12-05 | 2017-11-22 | ▲華▼▲為▼▲終▼端有限公司 | 車両加速度を判定するための方法および装置 |
US11504029B1 (en) | 2014-10-26 | 2022-11-22 | David Martin | Mobile control using gait cadence |
US20160166180A1 (en) * | 2014-12-11 | 2016-06-16 | David Martin | Enhanced Real Time Frailty Assessment for Mobile |
KR102335738B1 (ko) * | 2014-12-10 | 2021-12-06 | 삼성전자주식회사 | 디바이스의 회전각 결정 방법 및 이를 위한 장치 |
US10031236B2 (en) * | 2015-10-06 | 2018-07-24 | Topcon Positioning Systems, Inc. | Navigation receiver with an adaptive system for tracking carrier phases received from a constellation of navigation satellites |
CN105807095B (zh) * | 2016-03-10 | 2019-01-11 | 同济大学 | 一种三轴加速度传感器安装误差修正方法 |
DE102016220440A1 (de) * | 2016-10-19 | 2018-04-19 | Robert Bosch Gmbh | Navigationseinrichtung für Kraftfahrzeuge sowie Verfahren zur Navigation von Kraftfahrzeugen |
CN107036630B (zh) * | 2017-04-27 | 2020-09-25 | 深圳市思拓通信系统有限公司 | 一种车辆驾驶预警装置安装角度的自动识别系统及方法 |
CN109254172B (zh) * | 2017-07-12 | 2022-02-18 | 罗伯特·博世有限公司 | 车用加速度传感器的位置校准方法及装置、车辆控制设备 |
JP2019020186A (ja) * | 2017-07-13 | 2019-02-07 | 株式会社グローバル・ニュークリア・フュエル・ジャパン | 加速度計、健全性検査装置及び方法 |
US11199410B2 (en) * | 2019-04-30 | 2021-12-14 | Stmicroelectronics, Inc. | Dead reckoning by determining misalignment angle between movement direction and sensor heading direction |
US11747142B2 (en) * | 2019-04-30 | 2023-09-05 | Stmicroelectronics, Inc. | Inertial navigation system capable of dead reckoning in vehicles |
CN110260841A (zh) * | 2019-06-10 | 2019-09-20 | 东南大学 | 倾角传感器 |
JP2022072338A (ja) * | 2020-10-29 | 2022-05-17 | セイコーエプソン株式会社 | 慣性計測装置 |
CN113566850B (zh) * | 2021-07-29 | 2024-03-08 | 深圳元戎启行科技有限公司 | 惯性测量单元的安装角度标定方法、装置和计算机设备 |
KR102582056B1 (ko) * | 2023-05-26 | 2023-09-25 | 주식회사 원테이크 | 서라운드 뷰 제공 장치 및 이의 동작 방법 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10104259A (ja) * | 1996-09-30 | 1998-04-24 | Mitsubishi Motors Corp | 車両用前後加速度推定装置 |
JPH10332415A (ja) * | 1997-05-27 | 1998-12-18 | Hitachi Ltd | ナビゲーション装置 |
JPH11190743A (ja) * | 1997-12-26 | 1999-07-13 | Hokuriku Electric Ind Co Ltd | 移動体搭載用三軸加速度検出装置 |
JP2001109738A (ja) * | 1999-10-13 | 2001-04-20 | Toyota Motor Corp | ピーク時刻検出装置およびピーク時刻検出方法 |
JP2004138553A (ja) * | 2002-10-18 | 2004-05-13 | Matsushita Electric Ind Co Ltd | 移動体位置検出装置、移動体位置検出方法、プログラムおよび記録媒体 |
JP2006010520A (ja) * | 2004-06-25 | 2006-01-12 | Takamisawa Cybernetics Co Ltd | 感震器及び地震計システム |
JP2008058273A (ja) * | 2006-09-04 | 2008-03-13 | Sony Corp | ナビゲーション装置、停止検出方法及び停止検出プログラム |
Family Cites Families (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4213116A (en) * | 1979-01-22 | 1980-07-15 | Halperin Herbert H | Vehicle turn detection apparatus |
JPH0943269A (ja) * | 1995-07-28 | 1997-02-14 | Omron Corp | 加速度トランスデューサ |
JP3662118B2 (ja) * | 1998-08-07 | 2005-06-22 | トヨタ自動車株式会社 | 車輌の加減速度演算方法 |
DE19844911B4 (de) * | 1998-09-30 | 2006-01-05 | Robert Bosch Gmbh | Verfahren und Vorrichtung zur Überwachung eines in einem Fahrzeug eingesetzten Beschleunigungssensors |
JP4191499B2 (ja) * | 2003-02-03 | 2008-12-03 | パイオニア株式会社 | 車載装置 |
EP1788397A4 (en) * | 2004-09-07 | 2011-11-02 | Vodafone Plc | WATER POUCH FOR ULTRASONIC PROBE USED IN ULTRASONIC DIAGNOSTIC DEVICE |
EP1708362B1 (en) | 2005-03-31 | 2008-12-31 | STMicroelectronics S.r.l. | Displacement detection device of a portable apparatus using a digital high-pass filter |
DE102005030295B4 (de) | 2005-06-24 | 2008-11-20 | Siemens Ag | Fahrzeuggeschwindigkeitssensor |
JP2007107951A (ja) * | 2005-10-12 | 2007-04-26 | Matsushita Electric Ind Co Ltd | 取付け角度算出装置 |
JP4655901B2 (ja) * | 2005-11-21 | 2011-03-23 | パナソニック株式会社 | 移動体の水平走行判定装置及び方法 |
JP4955285B2 (ja) * | 2006-03-03 | 2012-06-20 | マイクロストーン株式会社 | 傾斜角測定センサ |
US7292925B1 (en) | 2006-03-08 | 2007-11-06 | Yamaha Hatsudoki Kabushiki Kaisha | Acceleration estimation device and vehicle |
JP2006227018A (ja) * | 2006-03-24 | 2006-08-31 | Denso Corp | 加速度を利用した処理装置 |
JP4816340B2 (ja) * | 2006-08-31 | 2011-11-16 | ソニー株式会社 | ナビゲーション装置、位置検出方法及び位置検出プログラム |
US7665361B2 (en) | 2007-01-25 | 2010-02-23 | Freescale Semiconductor, Inc. | Method and apparatus for closed loop offset cancellation |
US7979207B2 (en) * | 2007-03-19 | 2011-07-12 | Sirf Technology, Inc. | Systems and methods for detecting a vehicle static condition |
JP4964047B2 (ja) * | 2007-07-12 | 2012-06-27 | アルパイン株式会社 | 位置検出装置及び位置検出方法 |
-
2009
- 2009-05-19 JP JP2009121375A patent/JP5736106B2/ja active Active
-
2010
- 2010-04-19 WO PCT/JP2010/056932 patent/WO2010134411A1/ja active Application Filing
- 2010-04-19 EP EP10777646.0A patent/EP2434298B1/en active Active
- 2010-04-19 US US13/265,762 patent/US10012672B2/en active Active
- 2010-04-19 KR KR1020117030370A patent/KR101761933B1/ko active IP Right Grant
- 2010-04-19 CN CN201080020698.3A patent/CN102422166B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH10104259A (ja) * | 1996-09-30 | 1998-04-24 | Mitsubishi Motors Corp | 車両用前後加速度推定装置 |
JPH10332415A (ja) * | 1997-05-27 | 1998-12-18 | Hitachi Ltd | ナビゲーション装置 |
JPH11190743A (ja) * | 1997-12-26 | 1999-07-13 | Hokuriku Electric Ind Co Ltd | 移動体搭載用三軸加速度検出装置 |
JP2001109738A (ja) * | 1999-10-13 | 2001-04-20 | Toyota Motor Corp | ピーク時刻検出装置およびピーク時刻検出方法 |
JP2004138553A (ja) * | 2002-10-18 | 2004-05-13 | Matsushita Electric Ind Co Ltd | 移動体位置検出装置、移動体位置検出方法、プログラムおよび記録媒体 |
JP2006010520A (ja) * | 2004-06-25 | 2006-01-12 | Takamisawa Cybernetics Co Ltd | 感震器及び地震計システム |
JP2008058273A (ja) * | 2006-09-04 | 2008-03-13 | Sony Corp | ナビゲーション装置、停止検出方法及び停止検出プログラム |
Non-Patent Citations (1)
Title |
---|
See also references of EP2434298A4 * |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2012066821A1 (ja) * | 2010-11-18 | 2012-05-24 | 古野電気株式会社 | 角速度検出装置、角速度検出方法、移動状態検出装置およびナビゲーション装置 |
JP5643334B2 (ja) * | 2010-11-18 | 2014-12-17 | 古野電気株式会社 | 角速度検出装置、角速度検出方法、移動状態検出装置およびナビゲーション装置 |
CN102506822A (zh) * | 2011-11-30 | 2012-06-20 | 北京天地玛珂电液控制系统有限公司 | 一种矿用倾角传感器 |
CN102506822B (zh) * | 2011-11-30 | 2013-10-23 | 北京天地玛珂电液控制系统有限公司 | 一种矿用倾角传感器 |
US10652525B2 (en) | 2013-10-31 | 2020-05-12 | 3Di Llc | Quad view display system |
US11343487B2 (en) | 2013-10-31 | 2022-05-24 | David Woods | Trackable glasses system for perspective views of a display |
US9883173B2 (en) | 2013-12-25 | 2018-01-30 | 3Di Llc | Stereoscopic display |
US10469834B2 (en) | 2013-12-25 | 2019-11-05 | 3Di Llc | Stereoscopic display |
US9986228B2 (en) | 2016-03-24 | 2018-05-29 | 3Di Llc | Trackable glasses system that provides multiple views of a shared display |
WO2020080459A1 (ja) * | 2018-10-19 | 2020-04-23 | パナソニックIpマネジメント株式会社 | 表示システム、表示装置、及び表示制御方法 |
JPWO2020080459A1 (ja) * | 2018-10-19 | 2021-10-07 | パナソニックIpマネジメント株式会社 | 表示システム、表示装置、及び表示制御方法 |
JP7411915B2 (ja) | 2018-10-19 | 2024-01-12 | パナソニックIpマネジメント株式会社 | 表示システム、表示装置、及び表示制御方法 |
Also Published As
Publication number | Publication date |
---|---|
CN102422166A (zh) | 2012-04-18 |
JP5736106B2 (ja) | 2015-06-17 |
KR20120050413A (ko) | 2012-05-18 |
KR101761933B1 (ko) | 2017-07-26 |
EP2434298A1 (en) | 2012-03-28 |
US20120041702A1 (en) | 2012-02-16 |
US10012672B2 (en) | 2018-07-03 |
JP2010271086A (ja) | 2010-12-02 |
EP2434298A4 (en) | 2012-11-21 |
CN102422166B (zh) | 2015-06-03 |
EP2434298B1 (en) | 2014-04-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP5736106B2 (ja) | 移動状態検出装置 | |
JP5643334B2 (ja) | 角速度検出装置、角速度検出方法、移動状態検出装置およびナビゲーション装置 | |
JP5328252B2 (ja) | ナビゲーションシステムの位置検出装置および位置検出方法 | |
EP1653194B1 (en) | Azimuth/attitude detecting sensor | |
JP4781300B2 (ja) | 位置検出装置および位置検出方法 | |
JP5036462B2 (ja) | ナビゲーション・システムおよびナビゲーション方法 | |
KR101417456B1 (ko) | 차량 요레이트센서의 바이어스 획득방법 | |
US20100007550A1 (en) | Positioning apparatus for a mobile object | |
JP5586994B2 (ja) | 位置標定装置、位置標定装置の位置標定方法および位置標定プログラム | |
JP2010271086A5 (ja) | ||
CN106153069B (zh) | 自主导航系统中的姿态修正装置和方法 | |
WO2012137415A1 (ja) | 位置算出方法及び位置算出装置 | |
JP6488860B2 (ja) | 勾配推定装置及びプログラム | |
JPH09189564A (ja) | 移動体位置速度算出装置 | |
US11085773B2 (en) | Angular velocity sensor correction device and method for correcting output signal from angular velocity sensor, and direction estimation device and method for estimating direction by correcting output signal from angular velocity sensor | |
CN112762944A (zh) | 零速区间检测及零速更新方法 | |
JP4988170B2 (ja) | 方位角計測装置、および、方位角計測方法 | |
WO2014171227A1 (ja) | 姿勢角推定装置およびそれを備える移動状態検出装置 | |
JP3581392B2 (ja) | 積分型センシング装置 | |
JP4955115B2 (ja) | 方位角計測装置、および、方位角計測方法 | |
JP2021018112A (ja) | 自己位置推定装置 | |
JP6409625B2 (ja) | 車両位置算出装置 | |
JP2015102330A (ja) | 移動情報算出装置、移動情報算出方法、移動情報算出プログラム、および移動体 | |
CN117029849A (zh) | 车辆行驶定位方法、装置、设备及存储介质 | |
KR20140044966A (ko) | 차량 자세 보정 장치 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
WWE | Wipo information: entry into national phase |
Ref document number: 201080020698.3 Country of ref document: CN |
|
121 | Ep: the epo has been informed by wipo that ep was designated in this application |
Ref document number: 10777646 Country of ref document: EP Kind code of ref document: A1 |
|
WWE | Wipo information: entry into national phase |
Ref document number: 2010777646 Country of ref document: EP |
|
WWE | Wipo information: entry into national phase |
Ref document number: 13265762 Country of ref document: US |
|
NENP | Non-entry into the national phase |
Ref country code: DE |
|
ENP | Entry into the national phase |
Ref document number: 20117030370 Country of ref document: KR Kind code of ref document: A |