Improve I2C_TIMINGR register calculation