Added sample task

NB: undefine IMU_L and IMU_R to make the USB work if no I2C device is
connected!