Cleaned up and tested I2C and OLED libraries
Nav tests complete