Advertisement
Guest User

Untitled

a guest
Oct 19th, 2019
85
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.69 KB | None | 0 0
  1. #include <String.h>
  2. #include <Servo.h>
  3. Servo sv1;
  4. Servo sv2;
  5. String PTangle, kari;
  6. unsigned int ang;
  7.  
  8. void setup() {
  9. Serial.begin(9600);
  10. pinMode(13, OUTPUT);
  11. digitalWrite(13, LOW);
  12. sv1.attach(9);
  13. sv2.attach(10);
  14. sv1.write(85);
  15. sv2.write(90);
  16. }
  17.  
  18. void loop() {
  19. if (Serial.available() > 0) {
  20. PTangle = Serial.readStringUntil("\n");
  21. kari = PTangle.substring(1);
  22. ang = kari.toInt();
  23. if (ang >= 10 && ang <= 180) {
  24. if (PTangle.startsWith("p")) {
  25. ptang(sv1, ang);
  26. } else if (PTangle.startsWith("t")) {
  27. ptang(sv2, ang);
  28. }
  29. }
  30. }
  31. }
  32.  
  33. void ptang(Servo x, int y) {
  34. digitalWrite(13, HIGH);
  35. x.write(y);
  36. delay(300);
  37. digitalWrite(13, LOW);
  38. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement