// Bluetooth RC Robot // Programmed By Garret Kamine-HJS const int motor1Pin1 = 12; const int motor1Pin2 = 10; const int enablem1Pin3 = 11; const int motor2Pin1 = 4; const int motor2Pin2 = 2; const int enablem2Pin3 = 3; #define LED 13 //forlygter #define LED2 7 //baglygter #define HORN 8 //horn byte serialA; void setup() { Serial.begin(9600); pinMode(motor1Pin1, OUTPUT); pinMode(motor1Pin2, OUTPUT); pinMode(enablem1Pin3, OUTPUT); pinMode(motor2Pin1, OUTPUT); pinMode(motor2Pin2, OUTPUT); pinMode(enablem2Pin3, OUTPUT); pinMode(LED, OUTPUT); //Set the LED pin. pinMode(LED2, OUTPUT); //Set the LED2 pin. pinMode(HORN, OUTPUT); //Set the HORN pin. } void loop() { if (Serial.available() > 0) { serialA = Serial.read(); Serial.println(serialA); } switch (serialA) { // forward case 'F': digitalWrite(motor1Pin1, HIGH); digitalWrite(motor1Pin2, LOW); digitalWrite(motor2Pin1, LOW); digitalWrite(motor2Pin2, HIGH); digitalWrite(enablem1Pin3, HIGH); digitalWrite(enablem2Pin3, HIGH); break; // left case 'R': digitalWrite(motor1Pin1, HIGH); digitalWrite(motor1Pin2, LOW); digitalWrite(motor2Pin1, HIGH); digitalWrite(motor2Pin2, LOW); digitalWrite(enablem1Pin3, HIGH); digitalWrite(enablem2Pin3, LOW); break; // right case 'L': digitalWrite(motor1Pin1, LOW); digitalWrite(motor1Pin2, HIGH); digitalWrite(motor2Pin1, LOW); digitalWrite(motor2Pin2, HIGH); digitalWrite(enablem1Pin3, LOW); digitalWrite(enablem2Pin3, HIGH); break; // forward left case 'G': digitalWrite(motor1Pin1, HIGH); digitalWrite(motor1Pin2, LOW); digitalWrite(motor2Pin1, LOW); digitalWrite(motor2Pin2, LOW); digitalWrite(enablem1Pin3, HIGH); digitalWrite(enablem2Pin3, HIGH); break; // forward right case 'I': digitalWrite(motor1Pin1, LOW); digitalWrite(motor1Pin2, LOW); digitalWrite(motor2Pin1, LOW); digitalWrite(motor2Pin2, HIGH); digitalWrite(enablem1Pin3, HIGH); digitalWrite(enablem2Pin3, HIGH); break; // backward left case 'H': digitalWrite(motor1Pin1, HIGH); digitalWrite(motor1Pin2, LOW); digitalWrite(motor2Pin1, HIGH); digitalWrite(motor2Pin2, LOW); digitalWrite(enablem1Pin3, HIGH); digitalWrite(enablem2Pin3, HIGH); break; // backward right case 'J': digitalWrite(motor1Pin1, LOW); digitalWrite(motor1Pin2, HIGH); digitalWrite(motor2Pin1, LOW); digitalWrite(motor2Pin2, HIGH); digitalWrite(enablem1Pin3, HIGH); digitalWrite(enablem2Pin3, HIGH); break; // backward case 'B': digitalWrite(motor1Pin1, LOW); digitalWrite(motor1Pin2, HIGH); digitalWrite(motor2Pin1, HIGH); digitalWrite(motor2Pin2, LOW); digitalWrite(enablem1Pin3, HIGH); digitalWrite(enablem2Pin3, HIGH); break; // Stop case 'S': digitalWrite(motor1Pin1, LOW); digitalWrite(motor1Pin2, LOW); digitalWrite(motor2Pin1, LOW); digitalWrite(motor2Pin2, LOW); digitalWrite(enablem1Pin3, LOW); digitalWrite(enablem2Pin3, LOW); break; //Forlys case 'W': //LED pin on or off. digitalWrite(LED, HIGH); break; case 'w': digitalWrite(LED, LOW); break; //Baglys case 'U': //LED2 pin on or off. digitalWrite(LED2, HIGH); break; case 'u': digitalWrite(LED2, LOW); break; //Horn case 'V': //Horn pin on or off. digitalWrite(HORN, HIGH); break; case 'v': digitalWrite(HORN, LOW); break; } }