Added individual motor PID