Advertisement
Guest User

Serwoo

a guest
Mar 31st, 2020
118
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.60 KB | None | 0 0
  1. // Include the Servo library
  2. #include <Servo.h>
  3.  
  4. Servo serwomechanizm; // tworzenie obiektu serwomechanizm
  5. Servo serwomechanizm2;
  6.  
  7. const int button1_open = 8; // krańcówka otwarte do pinu 8
  8. const int button2_close = 11; // krańcówka zamknięte do pinu 11
  9.  
  10. int button1 = 0; //stan przycisku w położeniu 0 nie wcisniety
  11. int button2 = 0;
  12.  
  13. int pozycja_180_close = 0;
  14. int pozycja_180_open = 180;
  15. int pozycja_360 = 90;
  16.  
  17.  
  18. void setup() {
  19.  
  20.  
  21. serwomechanizm.attach(10); // przypisanie obiektu myservo_360 do pinu 10
  22. serwomechanizm2.attach(9);
  23.  
  24. pinMode(button1, INPUT_PULLUP); // inicjalizacja krancowek i wlaczenie wewnetrznego rezystora podciagajacego
  25. pinMode(button2, INPUT_PULLUP);
  26.  
  27. }
  28.  
  29. void loop()
  30. {
  31.  
  32. button1 = digitalRead(button1_open); //sprawdzenie ktory przycisk jest wcisniety
  33. button2 = digitalRead(button2_close);
  34.  
  35. if (pozycja_180_close >= 0) {
  36. serwomechanizm2.write(pozycja_180_close);
  37. }
  38.  
  39. if ((pozycja_180_close == 0) && (button2 == LOW) && (pozycja_360 == 90)) {
  40. serwomechanizm2.write(pozycja_180_open);
  41. }
  42.  
  43. if ((pozycja_180_open == 180) && (button2 == LOW) && (pozycja_360 = 90)) {
  44. serwomechanizm.write(180);
  45. }
  46.  
  47.  
  48. if ((pozycja_180_open == 180) && (button1 == LOW)) {
  49. serwomechanizm.write(90);
  50. }
  51.  
  52. if ((pozycja_180_open == 180) && (pozycja_360 == 90) && (button1 == LOW)) {
  53. serwomechanizm.write(20);
  54. }
  55.  
  56. if ((pozycja_180_open == 180) && (button2 == LOW)) {
  57. serwomechanizm.write(90);
  58. }
  59.  
  60. if ((pozycja_180_open == 180) && (pozycja_360 == 90) && (button2 == LOW)) {
  61. serwomechanizm2.write(pozycja_180_close);
  62.  
  63. }
  64. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement