Adding I2C master software for testing