More I2C fixes

Have gotten correct responses from the slave a few times, need to
further debug to see why we aren't actually picking up those values
correctly.