Added 2nd waypoint for doors.