Added button input to change mode, structured debug mode display, I2C done