Added IMU debug functions directly in the library