Safe, High-performance Motion Planning Under Uncertainty for Autonomous Driving Applications