Still trying to fix accel/mag output