Gyro and accel are working, magnetometer is still causing problems.