#define Motor1A 7 #define Motor1B 8 #define en1 6 //motor 1 #define Motor2A 10 #define Motor2B 12 #define en2 5 //motor 2 #define Motor3A A5 #define Motor3B A4 #define en3 11 //motor 2 #define Motor4A A3 #define Motor4B A2 #define en4 9 //motor 4 void setup() { // put your setup code here, to run once: Serial.begin(9600); //motor 1 pinMode(Motor1A, OUTPUT); pinMode(Motor1B, OUTPUT); pinMode(en1, OUTPUT); //motor 2 pinMode(Motor2A, OUTPUT); pinMode(Motor2B, OUTPUT); pinMode(en2, OUTPUT); //motor 3 pinMode(Motor3A, OUTPUT); pinMode(Motor3B, OUTPUT); pinMode(en3, OUTPUT); //motor 4 pinMode(Motor4A, OUTPUT); pinMode(Motor4B, OUTPUT); pinMode(en4, OUTPUT); pinMode(LED_BUILTIN, OUTPUT); } void loop() { digitalWrite(LED_BUILTIN, HIGH); // turn the LED on (HIGH is the voltage level) delay(2000); // wait for a second if (Serial.available() > 0) { //read bytes when serial has more than two bytes availible /* int X = Serial.read(); delay(10); int X1 = (int) X; if (X1 == 1) { */ //forwards //motor 1 digitalWrite(Motor1A, LOW); digitalWrite(Motor1B, HIGH); analogWrite(en1, 0); //motor 2 digitalWrite(Motor2A, LOW); digitalWrite(Motor2B, HIGH); analogWrite(en2, 0); //motor 3 digitalWrite(Motor3A, HIGH); digitalWrite(Motor3B, LOW); analogWrite(en3, 175); //motor 4 digitalWrite(Motor4A, HIGH); digitalWrite(Motor4B, LOW); analogWrite(en4, 175); digitalWrite(LED_BUILTIN, LOW); // turn the LED off by making the voltage LOW delay(2000); ////////////////////// ///back //motor 1 digitalWrite(Motor1A, LOW); digitalWrite(Motor1B, HIGH); analogWrite(en1, 0); //motor 2 digitalWrite(Motor2A, LOW); digitalWrite(Motor2B, HIGH); analogWrite(en2, 0); //motor 3 digitalWrite(Motor3A, LOW); digitalWrite(Motor3B, HIGH); analogWrite(en3, 175); //motor 4 digitalWrite(Motor4A, LOW); digitalWrite(Motor4B, HIGH); analogWrite(en4, 175); digitalWrite(LED_BUILTIN, LOW); // turn the LED off by making the voltage LOW delay(2000); ///////////////////////////part 2: //left? //motor 1 digitalWrite(Motor1A, HIGH); digitalWrite(Motor1B, LOW); analogWrite(en1, 175); //motor 2 digitalWrite(Motor2A, LOW); digitalWrite(Motor2B, HIGH); analogWrite(en2, 175); //motor 3 digitalWrite(Motor3A, LOW); digitalWrite(Motor3B, HIGH); analogWrite(en3, 0); //motor 4 digitalWrite(Motor4A, LOW); digitalWrite(Motor4B, HIGH); analogWrite(en4, 0); delay(2000); //right //motor 1 digitalWrite(Motor1A, LOW); digitalWrite(Motor1B, HIGH); analogWrite(en1, 175); //motor 2 digitalWrite(Motor2A, HIGH); digitalWrite(Motor2B, LOW); analogWrite(en2, 175); //motor 3 digitalWrite(Motor3A, LOW); digitalWrite(Motor3B, HIGH); analogWrite(en3, 0); //motor 4 digitalWrite(Motor4A, LOW); digitalWrite(Motor4B, HIGH); analogWrite(en4, 0); delay(2000); } }