Integrate Direction Command + PID tuning