Test Motor — Arduino Nano simulation

An interactive Arduino Nano circuit simulation you can run free in your browser on Velxio, by rocsen.

Components

Sketch code

// constants won't change. They're used here to set pin numbers:
const int EN1 = 9;
const int IN1 = A1;
const int IN2 = A2;
const int EN2 = 10;
const int IN3 = A4;
const int IN4 = A5;
const int SW1 = 2;
const int SW2 = 3;
const int SW3 = 4;
// Variables will change:
bool _init = 0;
bool State0_SW1;
//bool State1_SW1;
bool State0_SW2;
//int State1_SW2 = HIGH;
bool State0_SW3;
//int State1_SW3 = HIGH;

void setup() {
  Serial.begin(9600);
  Serial.println("Doorlock Test ready!");

  pinMode(SW1, INPUT_PULLUP);
  pinMode(SW2, INPUT_PULLUP);
  pinMode(SW3, INPUT_PULLUP);
  pinMode(EN1, OUTPUT);
  pinMode(IN1, OUTPUT);
  pinMode(IN2, OUTPUT);

}

void MotorRun(int Nr, bool dir, int v){
  Serial.print("Motor ");
  Serial.println(Nr);
  if (dir) { Serial.print(" - run forward, "); }
  if (!dir) { Serial.print(" - run reverse, "); }
  Serial.print("speed: ");
  Serial.println(v);
  if (Nr == 1) {
    analogWrite(EN1, v);
    digitalWrite(IN1, dir);
    digitalWrite(IN2, !dir);
  }
  if (Nr == 2) {
    analogWrite(EN2, v);
    digitalWrite(IN3, dir);
    digitalWrite(IN4, !dir);
  }
}

void MotorStop(int Nr, bool off){
  Serial.print("Motor ");
  Serial.println(Nr);
  if (off) { Serial.println(" - braked"); }
  else { Serial.println(" - coast"); }
  if (Nr == 1) {
    analogWrite(EN1, off);
    digitalWrite(IN1, !off);
    digitalWrite(IN2, !off);
  }
  if (Nr == 2) {
    analogWrite(EN2, off);
    digitalWrite(IN3, !off);
    digitalWrite(IN4, !off);
  }
}
void loop() {
  if (!_init) {
    delay(1000);
    _init = 1;
  }
  if (_init) {
    bool SW_lft = digitalRead(SW1) ? 0 : 1;
    bool SW_rgt = digitalRead(SW2) ? 0 : 1;
    bool SW_stp = digitalRead(SW3) ? 0 : 1;

    if (SW_lft != State0_SW1) {
      if (SW_lft) {
        MotorRun(1,0,5);
        delay(1000);
        MotorRun(2,0,50);
        MotorRun(1,1,5);
        delay(2000);
        MotorStop(2,1);
        MotorRun(1,1,100);
      }
    }
    if (SW_rgt != State0_SW2) {
      if (SW_rgt) {
        MotorRun(1,0,255);
        MotorRun(2,0,255);
      }
    }
    if (SW_stp != State0_SW3) {
      if (SW_stp) {
        MotorStop(1,0);
        MotorStop(2,1);
      }
    }
    
    State0_SW1 = SW_lft;
    State0_SW2 = SW_rgt;
    State0_SW3 = SW_stp;
  }
}