Position Detecting Device And Position Detecting Method
First Claim
1. A position detecting device for detecting a current position of a vehicle, the position detecting device comprising:
- a moving distance detection unit for measuring the moving distance of the vehicle;
an acceleration sensor for detecting the acceleration of the vehicle;
a relative direction sensor for outputting a signal in accordance with the amount of change in the direction of the vehicle,a Global Positioning System receiver for receiving satellite radio waves from a Global Positioning System satellite and outputting information of a vehicle position and a vehicle speed in the latitudinal direction, the longitudinal direction, and the height direction;
a dead reckoning unit which, on a first cycle, calculates the vehicle position in the latitudinal direction, the longitudinal direction, and the height direction by using a pitch angle θ
with respect to a horizontal surface and a yaw angle Y of the sensors for dead reckoning, a sensor installation pitch angle A and a sensor installation yaw angle A2 with respect to the vehicle, and the moving distance, and calculates the vehicle speed by using an acceleration signal output from the acceleration sensor;
a first correction unit which, on a second cycle longer than the first cycle, calculates the vehicle speed by using a signal output from the moving distance detection unit, and corrects, on the basis of the difference in speed between the thus calculated vehicle speed and the vehicle speed calculated by the dead reckoning unit, the vehicle speed, the pitch angle θ
, the sensor installation pitch angle A, and the sensor installation yaw angle A2 calculated by the dead reckoning unit; and
a second correction unit which, on a third cycle longer than the second cycle, corrects the vehicle position in the latitudinal direction, the longitudinal direction, and the height direction, the vehicle speed, the pitch angle θ
, the sensor installation pitch angle A, the yaw angle Y, the sensor installation yaw angle A2, an angular speed signal offset, and an acceleration signal offset calculated by the dead reckoning unit, by using the vehicle position and the vehicle speed in the latitudinal direction, the longitudinal direction, and the height direction output from the Global Positioning System receiver and the vehicle position and the vehicle speed in the latitudinal direction, the longitudinal direction, and the height direction output from the dead reckoning unit.
1 Assignment
0 Petitions
Accused Products
Abstract
A dead reckoning unit calculates vehicle position from a pitch angle and a yaw angle of dead reckoning sensors, a sensor installation pitch angle and a sensor installation yaw angle, and a moving distance calculated by a speed sensor, and calculates vehicle speed from an acceleration signal. On a first cycle, a first correction unit calculates the vehicle speed from signals output from the speed sensor, and corrects the pitch angle, the sensor installation pitch angle, and the sensor installation yaw angle, based on the difference between the thus calculated vehicle speed and the vehicle speed calculated by the dead reckoning unit. On a second cycle, a second correction unit corrects the pitch angle, the sensor installation pitch angle, the yaw angle, and the sensor installation yaw angle, by using vehicle position and speed output from a GPS receiver and vehicle position and speed output from the dead reckoning unit.
57 Citations
10 Claims
-
1. A position detecting device for detecting a current position of a vehicle, the position detecting device comprising:
-
a moving distance detection unit for measuring the moving distance of the vehicle; an acceleration sensor for detecting the acceleration of the vehicle; a relative direction sensor for outputting a signal in accordance with the amount of change in the direction of the vehicle, a Global Positioning System receiver for receiving satellite radio waves from a Global Positioning System satellite and outputting information of a vehicle position and a vehicle speed in the latitudinal direction, the longitudinal direction, and the height direction; a dead reckoning unit which, on a first cycle, calculates the vehicle position in the latitudinal direction, the longitudinal direction, and the height direction by using a pitch angle θ
with respect to a horizontal surface and a yaw angle Y of the sensors for dead reckoning, a sensor installation pitch angle A and a sensor installation yaw angle A2 with respect to the vehicle, and the moving distance, and calculates the vehicle speed by using an acceleration signal output from the acceleration sensor;a first correction unit which, on a second cycle longer than the first cycle, calculates the vehicle speed by using a signal output from the moving distance detection unit, and corrects, on the basis of the difference in speed between the thus calculated vehicle speed and the vehicle speed calculated by the dead reckoning unit, the vehicle speed, the pitch angle θ
, the sensor installation pitch angle A, and the sensor installation yaw angle A2 calculated by the dead reckoning unit; anda second correction unit which, on a third cycle longer than the second cycle, corrects the vehicle position in the latitudinal direction, the longitudinal direction, and the height direction, the vehicle speed, the pitch angle θ
, the sensor installation pitch angle A, the yaw angle Y, the sensor installation yaw angle A2, an angular speed signal offset, and an acceleration signal offset calculated by the dead reckoning unit, by using the vehicle position and the vehicle speed in the latitudinal direction, the longitudinal direction, and the height direction output from the Global Positioning System receiver and the vehicle position and the vehicle speed in the latitudinal direction, the longitudinal direction, and the height direction output from the dead reckoning unit. - View Dependent Claims (2, 3, 4, 5)
-
-
6. A position detecting method for detecting a current position of a vehicle, the position detecting method comprising:
-
a first step of, in a dead reckoning unit, and on a first cycle, calculating a vehicle position in the latitudinal direction, the longitudinal direction, and the height direction by using a pitch angle θ
with respect to a horizontal surface and a yaw angle Y of dead reckoning sensors, which output signals in accordance with the acceleration of the vehicle and the amount of change in the direction of the vehicle, a sensor installation pitch angle A and a sensor installation yaw angle A2 with respect to the vehicle, and a moving distance of the vehicle detected by a moving distance detection unit, and calculating a vehicle speed by using an acceleration signal output from one of the sensors;a second step of, on a second cycle longer than the first cycle, calculating the vehicle speed by using a signal output from the moving distance detection unit, and correcting, on the basis of the difference in speed between the thus calculated vehicle speed and the vehicle speed calculated by the dead reckoning unit, the vehicle speed, the pitch angle θ
, the sensor installation pitch angle A, and the sensor installation yaw angle A2 calculated by the dead reckoning unit; anda third step of, on a third cycle longer than the second cycle, correcting the vehicle position in the latitudinal direction, the longitudinal direction, and the height direction, the vehicle speed, the pitch angle θ
, the sensor installation pitch angle A, the yaw angle Y, the sensor installation yaw angle A2, an angular speed signal offset, and an acceleration signal offset calculated by the dead reckoning unit, by using a vehicle position and a vehicle speed in the latitudinal direction, the longitudinal direction, and the height direction output from a Global Positioning System receiver and the vehicle position and the vehicle speed in the latitudinal direction, the longitudinal direction, and the height direction output from the dead reckoning unit. - View Dependent Claims (7, 8, 9, 10)
-
Specification