Correct type in i2c setup and add call to arbitrarily move server when forward is pressed