Implemented fix for I2C freezes

Discussed in http://forum.arduino.cc/index.php/topic,19624.0.html