Working I2C master code but bad code form... plan to clean up