MotorsControl

class MotorsControl {
  int _pwmPinLeftMotorVar;
  int _pwmPinRightMotorVar;
  int _outputPinTwoVar;
  int _outputPinThreeVar;
  int _outputPinFourVar;
  int _outputPinFiveVar;
  int _motorSpeedVar;

public:
  MotorsControl(int pwmPinLeftMotorVar, int pwmPinRightMotorVar, int outputPinTwoVar, int outputPinThreeVar, int outputPinFourVar, int outputPinFiveVar, int motorSpeedVar) {
    _pwmPinLeftMotorVar = pwmPinLeftMotorVar;
    _pwmPinRightMotorVar = pwmPinRightMotorVar;
    _outputPinTwoVar = outputPinTwoVar;
    _outputPinThreeVar = outputPinThreeVar;
    _outputPinFourVar = outputPinFourVar;
    _outputPinFiveVar = outputPinFiveVar;
    _motorSpeedVar = motorSpeedVar;
    pinMode(_pwmPinLeftMotorVar, OUTPUT);
    pinMode(_pwmPinRightMotorVar, OUTPUT);
    pinMode(_outputPinTwoVar, OUTPUT);
    pinMode(_outputPinThreeVar, OUTPUT);
    pinMode(_outputPinFourVar, OUTPUT);
    pinMode(_outputPinFiveVar, OUTPUT);
    analogWrite(_pwmPinLeftMotorVar, _motorSpeedVar);
    analogWrite(_pwmPinRightMotorVar, _motorSpeedVar);
  }
  void resetPins() {
    digitalWrite(_outputPinTwoVar, LOW);
    digitalWrite(_outputPinThreeVar, LOW);
    digitalWrite(_outputPinFourVar, LOW);
    digitalWrite(_outputPinFiveVar, LOW);
  }

  void moveForward(int duration) {
    digitalWrite(_outputPinTwoVar, HIGH);
    digitalWrite(_outputPinThreeVar, LOW);
    digitalWrite(_outputPinFourVar, HIGH);
    digitalWrite(_outputPinFiveVar, LOW);
    delay(duration);
  }
};