Some work on a custom i2c "library"