Fixed bugs for I2C_CPAL_Driver