SAFETY-CRITICAL PLANNING AND CONTROL FOR VEHICLES OPERATING IN DYNAMIC ENVIRONMENTS