Move all pin defined into it's own header
Decreased I2C_TIMEOUT

It should never take this long
Moved stopAndReset function into PID.cpp
Updated default cfg values and updated some comments