that_one_nigga_you_k

quase lá

Dec 18th, 2019
139
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.45 KB | None | 0 0
  1. #include <A4988.h>
  2. #include <BasicStepperDriver.h>
  3. #include <DRV8825.h>
  4. #include <DRV8834.h>
  5. #include <DRV8880.h>
  6. #include <MultiDriver.h>
  7. #include <SyncDriver.h>
  8.  
  9. BasicStepperDriver stepper(200, 8, 9, 10);
  10. BasicStepperDriver mtr(200, 5, 6, 7);
  11.  
  12. void setup() {
  13.   // put your setup code here, to run once:
  14.   stepper.begin(120, 1);
  15.   mtr.begin(60, 1);
  16.  
  17.  
  18. }
  19.  
  20. void loop() {
  21.   // put your main code here, to run repeatedly:
  22.   rodar(3, 120, 2, 1);
  23.   rodar(5, 170, 3, 1);
  24.   rodar(7, 100, 2, 0);
  25.   rodar(1, 200, 3, 0);
  26.  
  27.  
  28. }
  29.  
  30. void rodar(int v, int vel, int m, bool s) {
  31.  
  32.   if (m == 2) {
  33.     if (s == true) {
  34.       for (int i = 0; i < (40 * v) ; i++) {
  35.         mtr.enable();
  36.         mtr.setRPM(vel);
  37.         mtr.move(5);
  38.         delayMicroseconds(10);
  39.       }
  40.       mtr.disable();
  41.     }
  42.  
  43.     else {
  44.       for (int i = 0; i < (40 * v) ; i++) {
  45.         mtr.enable();
  46.         mtr.setRPM(vel);
  47.         mtr.move(-5);
  48.         delayMicroseconds(10);
  49.       }
  50.       mtr.disable();
  51.     }
  52.   }
  53.   if (m == 3) {
  54.     if (s = true) {
  55.       for (int i = 0; i < (40 * v) ; i++) {
  56.         stepper.enable();
  57.         stepper.setRPM(vel);
  58.         stepper.move(5);
  59.         delayMicroseconds(10);
  60.       }
  61.       stepper.disable();
  62.     }
  63.  
  64.     else {
  65.       for (int i = 0; i < (40 * v) ; i++) {
  66.         stepper.enable();
  67.         stepper.setRPM(vel);
  68.         stepper.move(-5);
  69.         delayMicroseconds(10);
  70.       }
  71.       stepper.disable();
  72.     }
  73.   }
  74. }
Add Comment
Please, Sign In to add comment