Fixed minor bugs

Fixed initialization problems with i2c, need to create function that transforms hex to char.