Filter3D: Separate prediction/correction and process IMU input