Bug Fixe

Set port D2..D9 to output in setup
Removed I2C speed of 400KHz