Distance calculation device and calculation program
First Claim
Patent Images
1. A distance calculation device which calculates a distance between a movable body and a fixed subject, comprising:
- an azimuth angle calculating unit calculating as an azimuth angle an angle made by a direction connecting the movable body to the subject and a traveling direction of the movable body on a horizontal plane;
a traveled distance calculation unit calculating a traveled distance between two points of time of the movable body;
an amount-of-angular-change calculating unit calculating a rotation angle of a movable body on a vertical axis passing through a centroid of a movable body between two points of time as an amount of angular change in a traveling direction; and
a linear distance calculating unit calculating a linear distance between the movable body and the subject using output of the azimuth angle calculating unit, the traveled distance calculation unit, and the amount-of-angular-change calculating unit.
1 Assignment
0 Petitions
Accused Products
Abstract
It is intended to accurately calculate the distance between a movable body and a subject on the basis of various quantities of state, such as the azimuth angle between the movable body and the subject, velocity, and yaw rate. A calculation device includes a unit for calculating the azimuth angle between movable body and a subject, a unit for calculating the distance traveled by the movable body between two points of time, a unit for calculating a change in angle in the direction of movement, and a unit for calculating the linear distance from the movable body to the subject by using the unit.
14 Citations
15 Claims
-
1. A distance calculation device which calculates a distance between a movable body and a fixed subject, comprising:
-
an azimuth angle calculating unit calculating as an azimuth angle an angle made by a direction connecting the movable body to the subject and a traveling direction of the movable body on a horizontal plane; a traveled distance calculation unit calculating a traveled distance between two points of time of the movable body; an amount-of-angular-change calculating unit calculating a rotation angle of a movable body on a vertical axis passing through a centroid of a movable body between two points of time as an amount of angular change in a traveling direction; and a linear distance calculating unit calculating a linear distance between the movable body and the subject using output of the azimuth angle calculating unit, the traveled distance calculation unit, and the amount-of-angular-change calculating unit. - View Dependent Claims (2, 3, 4, 5, 6, 7)
-
-
8. A distance calculation device which calculates a distance between a movable body and a fixed subject, comprising:
-
an elevation angle calculation unit calculating as an elevation angle an angle made by a direction connecting the movable body to the subject and a horizontal plane; a traveled distance calculation unit calculating a traveled distance between two points of time of the movable body; a pitching angle calculation unit calculating as a pitching angle a rotation angle of the movable body on a vertical plane depending on a traveling direction and a vertical direction of the movable body; and a traveling direction distance calculation unit calculating a component in a traveling direction of a linear distance from the movable body to the subject using output of the elevation angle calculation unit, the traveled distance calculation unit, and the pitching angle calculation unit. - View Dependent Claims (9, 10, 11, 12, 13, 14)
-
-
15. A computer-readable storage medium storing a program used to direct a computer which calculates a distance between a movable body and a fixed subject to perform a process, comprising:
-
calculating as an azimuth angle an angle made by a direction connecting the movable body to the subject and a traveling direction of the movable body on a horizontal plane; calculating a traveled distance between two points of time of the movable body; calculating a rotation angle of a movable body on a vertical axis passing through a centroid of a movable body between two points of time as an amount of angular change in a traveling direction; calculating a linear distance between the movable body and the subject using the calculated azimuth angle, traveled distance, and amount of angular change; and storing the calculated linear distance.
-
Specification