debug output works(?) and gives IMU, pos, etc info