Guest User

Untitled

a guest
Jan 22nd, 2019
77
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.98 KB | None | 0 0
  1. if (realservo >= 1000 && realservo < 1180) {
  2. int servo1 = realservo;
  3. servo1 = map(servo1, 1000, 1180, 0, 180);
  4. myservo1.write(servo1);
  5. Serial.println("Servo 1 ON");
  6. delay(10);
  7. }
  8. if (realservo >= 2000 && realservo < 2180) {
  9. int servo2 = realservo;
  10. servo2 = map(servo2, 2000, 2180, 0, 180);
  11. myservo2.write(servo2);
  12. Serial.println("Servo 2 ON");
  13. delay(10);
  14. }
  15. if (realservo >= 3000 && realservo < 3180) {
  16. int servo3 = realservo;
  17. servo3 = map(servo3, 3000, 3180, 0, 180);
  18. myservo3.write(servo3);
  19. Serial.println("Servo 3 ON");
  20. delay(10);
  21. }
  22. if (realservo >= 4000 && realservo < 4180) {
  23. int servo4 = realservo;
  24. servo4 = map(servo4, 4000, 4180, 0, 180);
  25. myservo4.write(servo4);
  26. Serial.println("Servo 4 ON");
  27. delay(10);
  28. }
  29. valor = Serial.read();
  30. if (valor == "W")
  31. {
  32. motor1.run(FORWARD);
  33. motor2.run(FORWARD);
  34. }
  35. if (valor == "A")
  36. {
  37. motor2.run(FORWARD);
  38. }
  39. if (valor == "D")
  40. {
  41. motor1.run(FORWARD);
  42. }
  43. if (valor == "S")
  44. {
  45. motor1.run(BACKWARD);
  46. motor2.run(BACKWARD);
  47. }
Add Comment
Please, Sign In to add comment