Multi-Level Planning for Semi-autonomous Vehicles in Traffic Scenarios Based on Separation Maximization