AP_NavEKF: added plot.dat output