Add method to wait for i2c ready