that_one_nigga_you_k

muito quase lá

Dec 18th, 2019
165
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.86 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, 0);
  23.   rodar(7, 100, 3, 0);
  24.   rodar(3, 154, 2, 1);
  25.   rodar(6.2, 120, 3, 1);
  26.   rodar(9, 142, 2, 1);
  27.   rodar(4, 170, 3, 0);
  28.  
  29.  
  30.  
  31.  
  32.   //tentativa(7, 60, 200, 1);
  33.   //tentativa(7, 170, 120, 1);
  34. }
  35.  
  36. void rodar(float v, int vel, int m, bool s) {
  37.  
  38.   if (m == 2) {
  39.     if (s == true) {
  40.       for (int i = 0; i < (40 * v) ; i++) {
  41.         mtr.enable();
  42.         mtr.setRPM(vel);
  43.         mtr.move(5);
  44.         delayMicroseconds(10);
  45.       }
  46.       mtr.disable();
  47.     }
  48.  
  49.     else {
  50.       for (int i = 0; i < (40 * v) ; i++) {
  51.         mtr.enable();
  52.         mtr.setRPM(vel);
  53.         mtr.move(-5);
  54.         delayMicroseconds(10);
  55.       }
  56.       mtr.disable();
  57.     }
  58.   }
  59.   if (m == 3) {
  60.     if (s = true) {
  61.       for (int i = 0; i < (40 * v) ; i++) {
  62.         stepper.enable();
  63.         stepper.setRPM(vel);
  64.         stepper.move(5);
  65.         delayMicroseconds(10);
  66.       }
  67.       stepper.disable();
  68.     }
  69.  
  70.     else {
  71.       for (int i = 0; i < (40 * v) ; i++) {
  72.         stepper.enable();
  73.         stepper.setRPM(vel);
  74.         stepper.move(-5);
  75.         delayMicroseconds(10);
  76.       }
  77.       stepper.disable();
  78.     }
  79.   }
  80. }
  81.  
  82. void tentativa(float v, int vel1, int vel2, bool s) {
  83.  
  84.   for (int i = 0; i < (40 * v) ; i++) {
  85.     stepper.setRPM(vel1);
  86.     stepper.move(5);
  87.     delayMicroseconds(10);
  88.     mtr.setRPM(vel2);
  89.     mtr.move(5);
  90.     delayMicroseconds(10);
  91.   }
  92.   stepper.disable();
  93.   mtr.disable();
  94. }
Add Comment
Please, Sign In to add comment