Guest User

Code

a guest
Oct 28th, 2018
76
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.09 KB | None | 0 0
  1. #include <Servo.h>
  2.  
  3. //define servos
  4. Servo servo1;
  5. Servo servo2;
  6. Servo servo3;
  7. Servo servo4;
  8.  
  9. //define potentiometers
  10. int pot1 = A1;
  11. int pot2 = A2;
  12. int pot3 = A3;
  13.  
  14. //value variables
  15. int valpot1;
  16. int valpot2;
  17. int valpot3;
  18. int sensorValue;
  19. void setup() {
  20. // put your setup code here, to run once:
  21. Serial.begin(9600);
  22. //Servo pin atttach
  23. servo1.attach(3);
  24. servo2.attach(5);
  25. servo3.attach(6);
  26. servo4.attach(9);
  27.  
  28. //servo base angle
  29. servo1.write(0);
  30. servo2.write(0);
  31. servo3.write(0);
  32. servo4.write(0);
  33.  
  34. //Button setup
  35. pinMode(4, INPUT_PULLUP);
  36.  
  37. }
  38.  
  39. void loop() {
  40. // put your main code here, to run repeatedly:
  41. valpot1 = analogRead(pot1);
  42. valpot1 = map(valpot1, 0, 1023, 0, 180);
  43. servo1.write(valpot1);
  44.  
  45. valpot2 = analogRead(pot2);
  46. valpot2 = map(valpot2, 0, 1023, 0, 180);
  47. servo2.write(valpot2);
  48.  
  49. valpot3 = analogRead(pot3);
  50. valpot3 = map(valpot3, 0, 1023, 0, 180);
  51. servo3.write(valpot3);
  52.  
  53. sensorValue = digitalRead(4);
  54. if(sensorValue == HIGH){
  55. servo4.write(180);
  56.  
  57. }else{
  58. servo4.write(0);
  59. }
  60.  
  61. delay(200);
  62. }
Add Comment
Please, Sign In to add comment