wheelchair.ino

int data;
String readStringr;

#define r1 3
#define r2 4
#define r3 5

#define l1 6
#define l2 7
#define l3 8

void left() {
  Serial.println("LEFT");
  digitalWrite(r1, !1);
  digitalWrite(r2, !1);
  digitalWrite(r3, !1);

  digitalWrite(l1, !0);
  digitalWrite(l2, !0);
  digitalWrite(l3, !0);
}

void right() {
  Serial.println("RIGHT");
  digitalWrite(r1, !0);
  digitalWrite(r2, !0);
  digitalWrite(r3, !0);

  digitalWrite(l1, !1);
  digitalWrite(l2, !1);
  digitalWrite(l3, !1);
}

void forward() {
  Serial.println("FORward");
  digitalWrite(r1, !1);
  digitalWrite(r2, !1);
  digitalWrite(r3, !1);

  digitalWrite(l1, !1);
  digitalWrite(l2, !1);
  digitalWrite(l3, !1);
}
void stopF() {
  Serial.println("Stop");
  digitalWrite(r1, !0);
  digitalWrite(r2, !0);
  digitalWrite(r3, !0);

  digitalWrite(l1, !0);
  digitalWrite(l2, !0);
  digitalWrite(l3, !0);
  data = 0;

}

void setup() {
  Serial.begin(4800);
  Serial.setTimeout(50);
  delay(100);
  for (int i = 3; i <= 8; i++) {
    pinMode(i, OUTPUT);
  }
  stopF();
}

void loop() {
  if (Serial.available() > 0) {
    //Serial.println("got");
    data = Serial.parseInt();
    
  }
  if (data == 1) {
    //Serial.println(data);
    forward();

  }
  if (data == 2) {
    //Serial.println(data);
    right();

  }
  if (data ==  3) {
    //Serial.println(data);
    left();
    
  }
  if (data == 4 ) {
    //Serial.println(data);
    stopF();
  }
}
/*
  void loop()
  {
  while(!Serial.available()) {}
  // serial read section
  while (Serial.available())
  {
    if (Serial.available() >0)
    {
      char c = Serial.read();  //gets one byte from serial buffer
      readString += c; //makes the string readString
    }
  }

  if (readString.length() >0)
  {
    Serial.print("Arduino received: ");
    Serial.println(readString); //see what was received
  }

  delay(500);

  // serial write section

  char ard_sends = '1';
  Serial.print("Arduino sends: ");
  Serial.println(ard_sends);
  Serial.print("\n");
  Serial.flush();
  }
*/