Total revamp including new I2C lib and serial port dump functionality