UAVParameters loads current program state properly...
SubFlightPlanner was using airspeed instead of waypoint interval