two velocity PID controllers added