Creating geometry for advanced driver assistance systems
View Patent ↗A method and system for creating geometry for ADAS are described. Link chains, which are a sequence of segments, are created. The link chains are used to create 2D splines. The link chains, the 2D splines, and height data are used to create 3D splines. The 3D splines and possibly the 2D splines are converted to Bezier curves, which can be used to create a 2D polyline. ADAS applications can use the Bezier curves and the 2D polylines to provide ADAS functions.
1. A method comprising:
identifying one or more two-dimensional curves for a plurality of segments that represent a portion of a road network;
calculating, by a processor, a three-dimensional spline curve from the one or more two-dimensional curves and height data; and
storing the three-dimensional spline curve in a database, wherein a driver assistance application is configured to incorporate the three-dimensional spline curve to affect vehicle operation.
2. The method of claim 1 , wherein the driver assistance application is configured to directly control vehicle operation.
3. The method of claim 2 , wherein the driver assistance application includes adaptive cruise control, predictive cruise control or adaptive shift control.
4. The method of claim 1 , wherein the driver assistance application includes headlight aiming, lane departure warning and control, curve warning, speed limit notification, or hazard warning.
5. The method of claim 1 , further comprising:
fitting the one or more two-dimensional curves to the plurality of segments.
6. The method of claim 5 , further comprising:
calculating an angle between a first segment of the plurality of segments and a second segment of the plurality of segments; and
comparing the angle to a kink threshold.
7. The method of claim 6 , further comprising:
dividing the plurality of segments between the first segment and the second segment when the angle exceeds the kink threshold.
8. The method of claim 5 , further comprising:
determining whether the plurality of segments includes a ramp; and
calculate a ramp offset vector to connect the one or more two-dimensional curves or the three-dimensional spline through the ramp to a subsequent path.
9. The method of claim 5 , further comprising:
determining whether the plurality of segments includes a roundabout; and
extending the one or more two-dimensional curves to one or more revolutions of the roundabout.
10. The method of claim 1 , wherein the driver application includes cruise control, shift control, headlight control, lane departure control, curve warning, or hazard warning.
11. An apparatus comprising:
at least one processor; and
at least one memory including computer program code for one or more programs; the at least one memory and the computer program code configured to, with the at least one processor, cause the apparatus to at least perform:
identify one or more two-dimensional curves for a plurality of segments that represent a portion of a road network;
calculate a three-dimensional piecewise curve from the one or more two-dimensional curves and height data; and
store the three-dimensional spline curve in a database, wherein a driver assistance application is configured to access the three-dimensional spline curve to affect vehicle operation.
12. The apparatus of claim 11 , wherein the driver assistance application is configured to directly control vehicle operation.
13. The apparatus of claim 11 , wherein the driver assistance application assists a driver using headlight aiming, lane departure warning and control, curve warning, speed limit notification, or hazard warning.
14. The apparatus of claim 11 , wherein the at least one memory and the computer program code configured to, with the at least one processor, cause the apparatus to:
fit the one or more two-dimensional curves to the plurality of segments.
15. The apparatus of claim 14 , wherein the fit of the one or more two-dimensional curves to the plurality of segments includes minimizing a change of curvature along the one or more two-dimensional curves.
16. The apparatus of claim 14 , wherein the fit of the one or more two-dimensional curves to the plurality of segments includes minimizing a least squared error along the one or more two-dimensional curves.
17. The apparatus of claim 11 , wherein the height data is a one dimensional elevation spline.
18. The apparatus of claim 11 , wherein the height data is matched to the one or more two-dimensional curves by projecting the height data on possible paths limited by coded road restrictions.
19. The apparatus of claim 11 , wherein a number of knots in the three-dimensional spline curve is a function of a variance of the height data.
20. A method comprising:
identifying one or more two-dimensional curves for a plurality of segments that represent a portion of a road network;
calculating, by a processor, a three-dimensional spline curve from the one or more two-dimensional curves and altitude data; and
storing the three-dimensional spline curve in a database, wherein a driver application is configured to incorporate the three-dimensional spline curve into vehicle operation.