The future of parking: A survey on automated valet parking with an outlook on high density parking
path planning for autonomous vehicles in unknown semi - structured environments .