SPRACC6 November   2020 TDA3LA , TDA3LX , TDA3MA , TDA3MD , TDA3MV

 

  1.   Trademarks
  2. 1Ackermann Steering Curve Generation and Drawing Algorithm
  3. 2DSP Link Generation and Integration With Vision_SDK
  4. 3Loading
  5. 4Function Inputs
  6. 5References

Ackermann Steering Curve Generation and Drawing Algorithm

The Ackermann steering model is commonly used throughout the automobile industry, to mathematically model the path that the tires of a car follow during a turn. As Figure 1-1 shows, the four tires follow a set of four concentric circles.

GUID-E66F3690-C9D7-40BA-A3CA-0D7BBEBAEF71-low.gifFigure 1-1 Ackermann Steering Curves

Given the wheelbase (L), tread (W), and inner tire steering angle (δi), the Ackermann steering model and the Pythagorean Theorem are used to determine the radius of the path of the front inner tire and the radii of the paths of the rear tires, as shown in Equation 1, Equation 2, and Equation 3. To generate the paths that the tires follow, in such a way that they can be mapped to a display, a conversion factor from inches to pixels must be applied before calculating the radii of the paths. The sample code in the Vision-SDK uses a conversion factor of 9 pixels to 1 inch.

Equation 1. GUID-A4284A55-474F-4817-B9AE-ECF7914AE000-low.gif
Equation 2. GUID-01971AD0-2956-46C5-A32C-8D0F5FC3A36C-low.gif
Equation 3. GUID-C29A4C4A-6E8B-4B38-92C6-12AD25217373-low.gif

After finding the radii of the paths, the standard form equation of a circle can be used to generate the paths the tires follow. In the current implementation, for a given x value in the set xPathMin ≤ x ≤ xPathMax, the corresponding y value is calculated using Equation 4.

Equation 4. GUID-95B0F74F-44F2-4134-9E3A-6E65F97ABDA3-low.gif

Figure 1-2 and Figure 1-3 show the MATLAB outputs of a script which takes the inner tire steering angle (δi) and turning direction input, and then generates rearview curves using the previous equations. Figure 1-2 shows the rearview curve for a 0° steering angle, and Figure 1-3 shows the back up curve for a 45° steering angle left turning direction input.

GUID-8F764564-BA5D-49CB-8872-0E33E12419BF-low.pngFigure 1-2 Rearview Curve for 0° Steering Angle
GUID-E5C58E41-1C02-4BDE-AF63-0CC122EFC549-low.pngFigure 1-3 45° Left Steering Angle

While the previous figures model the top-down view of the paths the tire follow, the rearview camera angle requires the rearview lines to appear to be converging to a finite vanishing point on the z-axis. The single-point projection transform manipulates the image such that points at infinity are mapped to a finite value in 3D space. In this case, the curves must be projected with respect to the y-axis, therefore Equation 5 was derived and used in the algorithm.

Equation 5. GUID-18FFADCE-829E-4F20-B2EE-93C23B4A6E6A-low.gif

Before the transform can be properly applied, the center point of the rear axle is mapped to the origin. Specifically, the curves must be translated so that the path of the driver-side tires is in the second quadrant, and the path of the passenger-side tires is still the tread length away from the driver side tire. Figure 1-4 shows the MATLAB output of the previous transform applied to the curve generated in Figure 1-3.

GUID-10840F11-CE7B-461A-8967-BEA3D4D35CE4-low.pngFigure 1-4 Projected Rearview Lines From Figure 1-3

Lastly, the curves are translated so that they are in the rearview camera viewing window. Figure 1-5 shows the display output of the TDA3X RVP running the surround view + rearview use case, with the dynamic rearview lines being drawn using the draw2D API included in the Vision-SDK.

GUID-AB5FC435-4906-4777-9E27-2CE18069118D-low.pngFigure 1-5 Display Output of Algorithm Running on TDA3x