See I2Cdev library for reference/wrapper. Implemented in pure Arduino code in [2017-Fire-Fighter](http://github.com/GW-Robotics/2017-Fire-Fighter).