SMS: Path Planning for Autonomous Vehicle