i2c works perfect. added motor control. moved everything to the main and fixed some of the interrupts.