Fixed bugs with adding and removing waypoints or planes