Positioning device, and navigation system
First Claim
1. A positioning device that detects a position of a mobile body with a radio navigation positioning unit, comprising:
- first and second autonomous sensors configured to obtain, respectively, first and second behavioral information on the mobile body;
a position detecting unit configured to obtain an estimated position of the mobile body by updating a detection result from the radio navigation positioning unit based on the first behavioral information obtained by the first autonomous sensor;
a map data positioning unit configured to refer to a map data storage unit based on the estimated position obtained by the position detecting unit and thereby to obtain a map data linked position that is a predetermined distance away from a link corresponding to the estimated position;
a most probable position estimating unit configured to estimate the position of the mobile body from the estimated position and the map data linked position by applying an observation equation to a Kalman filter which couples the first behavioral information obtained by the first autonomous sensor with the second behavioral information obtained by the second autonomous sensor; and
a direction detecting unit configured to obtain a cumulative estimated direction by updating the detection result from the radio navigation positioning unit based on the second behavioral information obtained by the second autonomous sensor, whereinthe position detecting unit is further configured to estimate a direction of the mobile body based on the first behavioral information, andthe most probable position estimating unit is configured to estimate the position of the mobile body from the estimated position, the map data linked position, the estimated direction, and the cumulative estimated direction by applying the observation equation to the Kalman filter.
1 Assignment
0 Petitions
Accused Products
Abstract
A positioning device that detects a position of a mobile body with a radio navigation positioning unit includes: first and second autonomous sensors obtaining behavioral information on the mobile body; a position detecting unit obtaining an estimated position and an estimated direction by updating a detection result based on the behavioral information from the first autonomous sensor; a map data positioning unit that refers to a map data storage unit based on the estimated position and obtains a map data linked position at a predetermined distance away from a link; a direction detecting unit obtaining a cumulative estimated direction by updating the detection result based on the behavioral information from the second autonomous sensor; and a most probable position estimating unit estimating the position of the mobile body from the estimated positions and directions using the Kalman filter.
-
Citations
8 Claims
-
1. A positioning device that detects a position of a mobile body with a radio navigation positioning unit, comprising:
-
first and second autonomous sensors configured to obtain, respectively, first and second behavioral information on the mobile body; a position detecting unit configured to obtain an estimated position of the mobile body by updating a detection result from the radio navigation positioning unit based on the first behavioral information obtained by the first autonomous sensor; a map data positioning unit configured to refer to a map data storage unit based on the estimated position obtained by the position detecting unit and thereby to obtain a map data linked position that is a predetermined distance away from a link corresponding to the estimated position; a most probable position estimating unit configured to estimate the position of the mobile body from the estimated position and the map data linked position by applying an observation equation to a Kalman filter which couples the first behavioral information obtained by the first autonomous sensor with the second behavioral information obtained by the second autonomous sensor; and a direction detecting unit configured to obtain a cumulative estimated direction by updating the detection result from the radio navigation positioning unit based on the second behavioral information obtained by the second autonomous sensor, wherein the position detecting unit is further configured to estimate a direction of the mobile body based on the first behavioral information, and the most probable position estimating unit is configured to estimate the position of the mobile body from the estimated position, the map data linked position, the estimated direction, and the cumulative estimated direction by applying the observation equation to the Kalman filter. - View Dependent Claims (2, 3, 4)
-
-
5. A positioning device that detects a position of a mobile body with a radio navigation positioning unit, comprising:
-
first and second autonomous sensors configured to obtain, respectively, first and second behavioral information on the mobile body; means for obtaining an estimated position of the mobile body by updating a detection result from the radio navigation positioning unit based on the first behavioral information obtained by the first autonomous sensor; means for obtaining a map data linked position that is a predetermined distance away from a link corresponding to the estimated position by referring to a map data storage unit based on the estimated position obtained by the means for obtaining the estimated position of the mobile body; means for estimating a most probable position of the mobile body from the estimated position and the map data linked position by applying an observation equation to a Kalman filter which couples the first behavioral information obtained by the first autonomous sensor with the second behavioral information obtained by the second autonomous sensor; and means for obtaining a cumulative estimated direction by updating the detection result from the radio navigation positioning unit based on the second behavioral information obtained by the second autonomous sensor, wherein the means for obtaining the estimated position of the mobile body also estimates a direction of the mobile body based on the first behavioral information, and the means for estimating the most probable position estimates the position of the mobile body from the estimated position, the map data linked position, the estimated direction, and the cumulative estimated direction by applying the observation equation to the Kalman filter. - View Dependent Claims (6)
-
-
7. A positioning method for detecting a position of a mobile body with a radio navigation positioning unit, comprising:
-
obtaining, from first and second autonomous sensors, first and second behavioral information on the mobile body; obtaining an estimated position of the mobile body by updating a detection result from the radio navigation positioning unit based on the first behavioral information obtained by the first autonomous sensor; obtaining a map data linked position that is a predetermined distance away from a link corresponding to the estimated position by referring to a map data storage unit based on the estimated position obtained by the obtaining the estimated position of the mobile body; estimating a most probable position of the mobile body from the estimated position and the map data linked position by applying an observation equation to a Kalman filter which couples the first behavioral information obtained by the first autonomous sensor with the second behavioral information obtained by the second autonomous sensor; and obtaining a cumulative estimated direction by updating the detection result from the radio navigation positioning unit based on the second behavioral information obtained by the second autonomous sensor; and obtaining an estimated a direction of the mobile body based on the first behavioral information, wherein the most probable position is estimated from the estimated position, the map data linked position, the estimated direction, and the cumulative estimated direction by applying the observation equation to the Kalman filter. - View Dependent Claims (8)
-
Specification