This reverts commit 3c1a6bc4.
Checked with HTG FMC board. Commit 3c1a6bc4... leaves I2C communication broken. Reverting this commit fixes I2C completely.