|
Algorithm 2. Obstacle input representation algorithm |
| Initialize the sectorial and rectangular areas according to the maximum slip angle of the front wheel, the size of the ego vehicle frame, and the speed of the ego vehicle. |
| Obtain the number and of the sectors and rectangles, and determine the angular interval of the sector and the distance interval of the rectangle . |
| Combine multiple obstacle vehicles and lane boundaries into one obstacle set. |
| Initialize the sector area representation , and the rectangle area representation within the extended area , in which represents the radius of the sector and represents the length of the rectangle. |
| # Calculate sector representation. |
|
For in cycles do: |
| if The current line segment intersects the set of obstacles: |
| Confirm the intersection of the current line segment and the obstacle, and calculate the distance from the intersection to the origin, and update the corresponding
|
| else:
|
| The current corresponding section is not updated |
| end for |
|
for in cycles do: |
| if The current line segment intersects the set of obstacles: |
| Confirm the intersection of the current line segment and the obstacle, and calculate the distance from the intersection to the corresponding horizontal reference line of the vehicle, and update the corresponding . |
| else: |
| The current corresponding section is not updated. |
| end for |
| Normalize the updated and . |