Add debug for I2C code and finish BMP code.  Not tested against hardware.