Added K22F I2C + fixed I2C

First part was pinouts. Second part is that the earlier done new I2C
commands were wrong. The macros for writing for example status register
expect the I2C base address, and were only getting the number of the i2c
peripheral. After figuring that one out technically the changes in
timeout_status_poll aren't necesary, but it won't hurt either.
And unbreaking MMA test code