Position estimating apparatus and position estimating method
A position estimating apparatus including: a position estimating unit that compares a target in first coordinate system data indicating a position of the target by coordinates in a first coordinate system and a target in second coordinate system data indicating a position of the target present around a position estimation object by coordinates in a second coordinate system set based on a position and an attitude of the position estimation object at a predetermined starting timing, and estimates a position of the position estimation object in the first coordinate system based on a comparison result; and a comparison range adjusting unit that shrinks a coordinate range used for the comparison by the position estimating unit in the second coordinate system data when the position estimation object is turning.
1. A position estimating apparatus comprising: a processor operating as a control unit,
wherein the processor includes:
a first coordinate system-data acquiring unit configured to acquire first coordinate system data indicating a position of a target by coordinates in a first coordinate system;
a second coordinate system-data acquiring unit configured to acquire second coordinate system data indicating a position of a target present around a position estimation object by coordinates in a second coordinate system set based on a position and an attitude of the position estimation object at a predetermined starting timing;
a position estimating unit configured to compare the target in the first coordinate system data and the target in the second coordinate system data, and estimates a position of the position estimation object in the first coordinate system based on a comparison result; and
a comparison range adjusting unit configured to shrink a coordinate range used for the comparison by the position estimating unit in the second coordinate system data when the position estimation object is turning,
wherein the comparison range adjusting unit limits the coordinate range to a range forward of the position estimation object in a traveling direction of the position estimation object,
wherein the control unit controls the position estimation object based on the estimated position.
2. A position estimating apparatus comprising: a processor operating as a control unit,
wherein the processor includes:
a first coordinate system-data acquiring unit configured to acquire first coordinate system data indicating a position of a target by coordinates in a first coordinate system;
a second coordinate system-data acquiring unit configured to acquire second coordinate system data indicating a position of a target present around a position estimation object by coordinates in a second coordinate system set based on a position and an attitude of the position estimation object at a predetermined starting timing;
a position estimating unit configured to compare the target in the first coordinate system data and the target in the second coordinate system data, and estimates a position of the position estimation object in the first coordinate system based on a comparison result; and
a comparison range adjusting unit configured to shrink a coordinate range used for the comparison by the position estimating unit in the second coordinate system data when the position estimation object is turning,
wherein the comparison range adjusting unit extends the coordinate range by a degree corresponding to a speed of the position estimation object, when restoring the coordinate range after the turning ends,
wherein the control unit controls the position estimation object based on the estimated position.
3. A position estimating method performed by a position estimating apparatus including a processor and estimating a position of a position estimation object, the position estimating method comprising the steps of:
acquiring first coordinate system data indicating a position of a target by coordinates in a first coordinate system;
acquiring second coordinate system data indicating a position of a target present around a position estimation object by coordinates in a second coordinate system set based on a position and an attitude of the position estimation object at a predetermined starting timing;
comparing the target in the first coordinate system data and the target in the second coordinate system data, and estimates a position of the position estimation object in the first coordinate system based on a comparison result; and
controlling the position estimation object based on the estimated position, wherein
in the step of comparing, the position estimating apparatus shrinks a coordinate range used for the comparison in the second coordinate system data when the position estimation object is turning, and the coordinate range is limited to a range forward of the position estimation object in a traveling direction of the position estimation object.