Switch mode to active when armed and moving at more than 5m/s; calculate altitude from pressure differential properly; don't copy NaN values when resetting the UKF