PID tuning in navigation.cpp