Tests for I2c

This PR takes coverage from 14.7% to 95.1%