Advertisement
Golden_Rus

Untitled

Jul 25th, 2015
223
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 1.10 KB | None | 0 0
  1. #include <Servo.h>
  2.  
  3. Servo servo0;
  4. Servo servo1;
  5. Servo servo2;
  6. Servo servo3;
  7. Servo servo4;
  8. Servo servo5;
  9.  
  10. void setup() {
  11. servo0.attach(0);
  12. servo1.attach(1);
  13. servo2.attach(2);
  14. servo3.attach(3);
  15. servo4.attach(4);
  16. servo5.attach(5);
  17.  
  18. pinMode(A0, INPUT);
  19. pinMode(A1, INPUT);
  20. pinMode(A2, INPUT);
  21. pinMode(A3, INPUT);
  22. pinMode(A4, INPUT);
  23. pinMode(A5, INPUT);
  24.  
  25. pinMode(6, OUTPUT);
  26. pinMode(7, OUTPUT);
  27. }
  28.  
  29. void loop() {
  30. int R0 = analogRead(A0);
  31. int map_R0 = map(R0, 0, 1023, 0, 180);
  32. int map_R1 = map(R0, 0, 1023, 180, 0);
  33.  
  34. int R1 = analogRead(A1);
  35. int map_R2 = map(R1, 0, 1023, 0, 180);
  36.  
  37. int R2 = analogRead(A2);
  38. int map_R3 = map(R2, 0, 1023, 0, 180);
  39.  
  40. int R3 = analogRead(A3);
  41. int map_R4 = map(R3, 0, 1023, 0, 180);
  42.  
  43. int R4 = analogRead(A4);
  44. int map_R5 = map(R4, 0, 1023, 0, 180);
  45.  
  46. int R5 = analogRead(A5);
  47. bool map_R6 = map(R5, 0, 1023, 0, 1);
  48. //------
  49. servo0.write(map_R0);
  50.  
  51. servo1.write(map_R1);
  52.  
  53. servo2.write(map_R2);
  54.  
  55. servo3.write(map_R3);
  56.  
  57. servo4.write(map_R4);
  58.  
  59. servo5.write(map_R5);
  60. //-------
  61. if(map_R6)
  62. {
  63.     digitalWrite(6, HIGH);
  64.     digitalWrite(7, LOW);
  65. }
  66. else
  67. {
  68.     digitalWrite(7, HIGH);
  69.     digitalWrite(6, LOW);  
  70. }
  71. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement