Merge pull request #17 from tjahnk/i2cwrite_cleanup