#define pinLed 16

#define pwmMotorA D1
#define pwmMotorB D2
#define dirMotorA D3
#define dirMotorB D4

int motorSpeed = 100; // use analogWrite(pin, val) to set speed, range from 0 to 255
int interval = 2000;

void Car::init()
{
    pinMode(pinLed, OUTPUT);
    pinMode(pwmMotorA, OUTPUT);
    pinMode(pwmMotorB, OUTPUT);
    pinMode(dirMotorA, OUTPUT);
    pinMode(dirMotorB, OUTPUT);

    digitalWrite(pwmMotorA, LOW);
    digitalWrite(pwmMotorB, LOW);
    digitalWrite(dirMotorA, LOW);
    digitalWrite(dirMotorB, LOW);

    Serial.println("Initialized");
}

void Car::turnLeft(int t, int speed)
{
    Serial.println("Turn left");
    analogWrite(pwmMotorA, speed);
    analogWrite(pwmMotorB, 0);
    digitalWrite(dirMotorA, LOW);

    delay(t);

    analogWrite(pwmMotorA, 0);
}

void Car::turnRight(int t, int speed)
{
    Serial.println("Turn right");
    analogWrite(pwmMotorA, 0);
    analogWrite(pwmMotorB, speed);
    digitalWrite(dirMotorB, HIGH);

    delay(t);

    analogWrite(pwmMotorB, 0);
}