Improved minor bugs in I2C code.  Still need to figure out cause of non-working bus with logic analyzer