CPC B62D 15/0285 (2013.01) [B60D 1/245 (2013.01); B60W 30/06 (2013.01); B60W 30/09 (2013.01); B62D 13/06 (2013.01); G05D 1/0038 (2013.01); G05D 1/0044 (2013.01); G06V 20/586 (2022.01); B60W 2300/14 (2013.01); B60W 2420/42 (2013.01); G05D 2201/0213 (2013.01)] | 13 Claims |
1. A method for autonomously parking a vehicle-trailer system, the method comprising:
receiving, at data processing hardware supported by a vehicle of the vehicle-trailer system, sensor system data from a sensor system supported by the vehicle, the sensor system data including images of surroundings along a driving path of the vehicle-trailer system;
determining, at the data processing hardware, a three-dimensional local map based on the sensor system data, the local map being a map of a parking lot including surroundings along the driving path of the vehicle-trailer system in the parking lot, the three-dimensional local map including point clouds;
determining, at the data processing hardware, a three-dimensional pose of the vehicle in the three-dimensional local map;
assigning, by the data processing hardware, a label to each point of the point clouds of the three-dimensional local map and each pixel in the images;
fusing, by the data processing hardware, the images with the labeled three-dimensional local map;
sending, from the data processing hardware, instructions causing the display to display the fused, labeled local map showing available parking spaces;
receiving, at the data processing hardware, a user selection of an image location within the displayed fused, labeled local map, the image location representing a position in the three-dimensional local map associated with a selected location within the surroundings;
determining, at the data processing hardware, a parking path from a current location of the vehicle-trailer system based on the three-dimensional pose of the vehicle to the position based on the three-dimensional local map; and
sending, from the data processing hardware to a drive system, instructions to execute an autonomous parking behavior causing the vehicle-trailer system to autonomously drive along the parking path and autonomously park in the selected location.
|