Radius of curvature detecting apparatus and the method thereof
First Claim
1. A radius of curvature detecting apparatus of a vehicle for detecting a radius of curvature of a curve located ahead of said vehicle based on road information obtained from a vehicle navigation system, comprising:
- three-points detecting means for detecting a first point, a second point and a third point in order of traveling direction of said vehicle from point data showing a road configuration and provided by said vehicle navigation system, said first point and said third point being located on said road configuration, and said second point being located away from said curve to define a first tangent to the curve with the first point and to define a second tangent to the curve with the third point;
distance comparing means for comparing a distance of a straight line connecting said first point and said second point with a distance of a straight line connecting said second point and said third point and for determining a short straight line and a long straight line, respectively;
mid-point calculating means for finding a fourth point located at a half distance of said short straight line from said second point;
equivalent mid-point calculating means for finding a fifth point located at said half distance from said second point on said long straight line; and
radius of curvature calculating means for determining a point of intersection of perpendicular lines from said fourth point and said fifth point, respectively, as a center of said curve and for calculating a radius of curvature based on said center of said curve.
1 Assignment
0 Petitions
Accused Products
Abstract
A radius of curvature detecting apparatus and method of a vehicle for detecting a radius of curvature of a curve based on road information obtained from a vehicle navigation system comprises, three-points detection of a first point, a second point and a third point in order of traveling direction of the vehicle from point data showing a road configuration which are provided by the vehicle navigation system, distance comparison of a distance of a straight line connecting the first point and the second point with a distance of a straight line connecting the second point and the third point and for determining a short straight line and a long straight line, respectively, mid-point calculation for finding a mid-point point located at a half distance of the short straight line from the second point, equivalent mid-point calculation for finding an equivalent mid-point located at the half distance from the second point on the long straight line, and radius of curvature calculation for determining a point of intersection of perpendicular lines from the mid-point point and the equivalent mid-point as a center of the curve and for calculating a radius of curvature based on the center of the curve. The calculated radius of curvature is corrected, for example when the road width is small or the distance of the short straight line is large.
-
Citations
8 Claims
-
1. A radius of curvature detecting apparatus of a vehicle for detecting a radius of curvature of a curve located ahead of said vehicle based on road information obtained from a vehicle navigation system, comprising:
-
three-points detecting means for detecting a first point, a second point and a third point in order of traveling direction of said vehicle from point data showing a road configuration and provided by said vehicle navigation system, said first point and said third point being located on said road configuration, and said second point being located away from said curve to define a first tangent to the curve with the first point and to define a second tangent to the curve with the third point; distance comparing means for comparing a distance of a straight line connecting said first point and said second point with a distance of a straight line connecting said second point and said third point and for determining a short straight line and a long straight line, respectively; mid-point calculating means for finding a fourth point located at a half distance of said short straight line from said second point; equivalent mid-point calculating means for finding a fifth point located at said half distance from said second point on said long straight line; and radius of curvature calculating means for determining a point of intersection of perpendicular lines from said fourth point and said fifth point, respectively, as a center of said curve and for calculating a radius of curvature based on said center of said curve.
-
-
2. A radius of curvature detecting apparatus of a vehicle for detecting a radius of curvature of a curve located ahead of said vehicle based on road information obtained from a vehicle navigation system, comprising:
-
three-points detecting means for detecting a first point, a second point and a third point in order of traveling direction of said vehicle from point data showing a road configuration and provided by said vehicle navigation system; distance comparing means for comparing a distance of a straight line connecting said first point and said second point with a distance of a straight line connecting said second point and said third point and for determining a short straight line and a long straight line, respectively; mid-point calculating means for finding a fourth point located at a half distance of said short straight line from said second point; equivalent mid-point calculating means for finding a fifth point located at said half distance from said second point on said long straight line; radius of curvature calculating means for determining a point of intersection of perpendicular lines from said fourth point and said fifth point, respectively, as a center of said curve and for calculating a radius of curvature based on said center of said curve; and radius of curvature correcting means for correcting said radius of curvature calculated in said radius of curvature calculating means, when a difference between a distance from said center of curvature to said second point and said radius of curvature exceeds a predetermined allowable error value, in such a way that said difference agrees with said predetermined allowable error value. - View Dependent Claims (3, 4, 5, 6)
-
-
7. A radius of curvature detecting method of detecting a radius of curvature of a curve of a road based on point data showing a configuration of said road, comprising the steps of:
-
detecting a first point, a second point and a third point from said point data, said first point and said third point being located on said road configuration, and said second point being located away from said curve to define a first tangent to the curve with the first point and to define a second tangent to the curve with the third point; comparing a distance of a straight line connecting said first point and said second point with a distance of a straight line connecting said second point and said third point and determining a short straight line and a long straight line, respectively; finding a fourth point located at a half distance of said short straight line from said second point; finding a fifth point located at said half distance from said second point on said long straight line; and determining a point of intersection of perpendicular lines from said fourth point and said fifth point, respectively, as a center of said curve and calculating a radius of curvature based on said center of said curve.
-
-
8. A radius of curvature detecting method of detecting a radius of curvature of a curve of a road based on point data showing a configuration of said road, comprising the steps of:
-
detecting a first point, a second point and a third point from said point data; comparing a distance of a straight line connecting said first point and said second point with a distance of a straight line connecting said second point and said third point and determining a short straight line and a long straight line, respectively; finding a fourth point located at a half distance of said short straight line from said second point; finding a fifth point located at said half distance from said second point on said long straight line; determining a point of intersection of perpendicular lines from said fourth point and said fifth point, respectively, as a center of said curve and calculating a radius of curvature based on said center of said curve; and correcting said calculated radius of curvature when a difference between a distance from said center of curvature to said second point and said radius of curvature exceeds a predetermined allowable error value, in such a way that said difference agrees with said predetermined allowable error value.
-
Specification