A system comprises a set of sensors on a first end of a vehicle having the first end and a second end, and a controller. The sensors are configured to generate corresponding sensor data based on a detected object along a direction of movement of the vehicle. The controller is configured to compare a time at which the first sensor detected the object with a time at which the second sensor detected the object to identify the first end or the second end as a leading end of the vehicle, and to calculate a position of the leading end of the vehicle based on the sensor data generated by one or more of the first sensor or the second sensor. The controller is also configured to generate a map of the plurality of objects based on the sensor data.