Added I2C read/write functions and a proper startup for the CS43L22