AP_NavEKF: enable some debug
AP_NavEKF: enable plotting in plot2.dat too
AP_InertialSensor: make HIL treat time like PX4 does