i2c: Optimize function i2c_detect()