Advertisement
gabbyshimoni

moveTwoSteppersSimultaneous

May 22nd, 2018
150
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 0.76 KB | None | 0 0
  1. void setup() {
  2.   // put your setup code here, to run once:
  3.  
  4. }
  5.  
  6. void loop() {
  7.   Xmove = 500;
  8.   Ymove = -500;
  9.  
  10.   if (Xmove < 0 ) {
  11.     Xdir = 2; // backward
  12.   }
  13.   else {
  14.     Xdir = 1; // forward
  15.   }
  16.   if (Ymove < 0 ) {
  17.     Ydir = 2; // backward
  18.   }
  19.   else {
  20.     Ydir = 1; // forward
  21.   }
  22.  
  23.   if (abs(Xmove) > abs(Ymove)) {
  24.     steps = Ymove;
  25.   }
  26.   else {
  27.     steps = Xmove;
  28.   }
  29. // זוז את כמות הצעדים הזהה
  30.   for (int i = 0; i < steps; i++) {
  31.  
  32.     motorX.step(1, Xdir, SINGLE);
  33.     motorY.step(1, Ydir, SINGLE);
  34.   }
  35.   // השלם את כמות הצעדים השונה
  36.   if (abs(Xmove) > abs(Ymove)) {
  37.     motorX.step(abs(Xmove) - steps, Xdir, SINGLE);
  38.   }
  39.   else {
  40.     motorY.step(abs(Ymove) - steps, Xdir, SINGLE);
  41.   }
  42. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement