An Obstacle Detection and Distance Measurement Method for Sloped Roads Based on VIDAR

Figure 2

Transformation between coordinate systems.