Working on i2c connection with IMU. waitcnt doesn't seem to work...