Debug I2C, rewrite Motors.h