Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- if (realservo >= 1000 && realservo < 1180) {
- int servo1 = realservo;
- servo1 = map(servo1, 1000, 1180, 0, 180);
- myservo1.write(servo1);
- Serial.println("Servo 1 ON");
- delay(10);
- }
- if (realservo >= 2000 && realservo < 2180) {
- int servo2 = realservo;
- servo2 = map(servo2, 2000, 2180, 0, 180);
- myservo2.write(servo2);
- Serial.println("Servo 2 ON");
- delay(10);
- }
- if (realservo >= 3000 && realservo < 3180) {
- int servo3 = realservo;
- servo3 = map(servo3, 3000, 3180, 0, 180);
- myservo3.write(servo3);
- Serial.println("Servo 3 ON");
- delay(10);
- }
- if (realservo >= 4000 && realservo < 4180) {
- int servo4 = realservo;
- servo4 = map(servo4, 4000, 4180, 0, 180);
- myservo4.write(servo4);
- Serial.println("Servo 4 ON");
- delay(10);
- }
- valor = Serial.read();
- if (valor == "W")
- {
- motor1.run(FORWARD);
- motor2.run(FORWARD);
- }
- if (valor == "A")
- {
- motor2.run(FORWARD);
- }
- if (valor == "D")
- {
- motor1.run(FORWARD);
- }
- if (valor == "S")
- {
- motor1.run(BACKWARD);
- motor2.run(BACKWARD);
- }
Add Comment
Please, Sign In to add comment