Added header format note to waypoint note
Discrete u and state propagation functional in new ekf class