Prepared for I2C. Moved init stuff to controller.