zdenekpetrzd

Funkční motor

Mar 21st, 2019
154
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.93 KB | None | 0 0
  1. int pinMotor[] = {16, 5, 4, 0};
  2. int poziceMot[8][4] = {
  3. {0,0,0,1},
  4. {0,0,1,1},
  5. {0,0,1,0},
  6. {0,1,1,0},
  7. {0,1,0,0},
  8. {1,1,0,0},
  9. {1,0,0,0},
  10. {1,0,0,1},
  11. };
  12.  
  13. void otaceni(int smer) {
  14. while(smer > 0) {
  15. for(int i = 0; i < 8; i++) {
  16. for(int d = 0; d < 4; d++) {
  17. digitalWrite(pinMotor[d], poziceMot[i][d]);
  18. }
  19. delay(1);
  20. }
  21. smer--;
  22. }
  23. while(smer < 0){
  24. for(int i = 7; i >= 0; i--) {
  25. for(int d = 0; d < 4; d++) {
  26. digitalWrite(pinMotor[d], poziceMot[i][d]);
  27. }
  28. delay(1);
  29. }
  30. smer++;
  31. }
  32. }
  33.  
  34. void setup() {
  35. Serial.begin(115200);
  36. Serial.println("Jsen tuL");
  37. for(int i = 0; i < 4; i++) {
  38. pinMode(pinMotor[i], OUTPUT);
  39. }
  40.  
  41. }
  42.  
  43. void loop() {
  44. otaceni(512);
  45. delay(10);
  46. otaceni(-512);
  47.  
  48.  
  49. }
Advertisement
Add Comment
Please, Sign In to add comment