AP_NavEKF: Modifed Vel Pos fusion to fuse height data whenever baro reading has changed