Adjust parameters
change i2c driver
Adjust PID