I2c pinmux fix

Fixes pinmux for I2C (before this we always would get NACK from the slave since STM was actively driving the line high). Adds a shell command to verify we can read data over I2C.