gaussfit train with filtered imu