Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- void setup() {
- // put your setup code here, to run once:
- }
- void loop() {
- Xmove = 500;
- Ymove = -500;
- if (Xmove < 0 ) {
- Xdir = 2; // backward
- }
- else {
- Xdir = 1; // forward
- }
- if (Ymove < 0 ) {
- Ydir = 2; // backward
- }
- else {
- Ydir = 1; // forward
- }
- if (abs(Xmove) > abs(Ymove)) {
- steps = Ymove;
- }
- else {
- steps = Xmove;
- }
- // זוז את כמות הצעדים הזהה
- for (int i = 0; i < steps; i++) {
- motorX.step(1, Xdir, SINGLE);
- motorY.step(1, Ydir, SINGLE);
- }
- // השלם את כמות הצעדים השונה
- if (abs(Xmove) > abs(Ymove)) {
- motorX.step(abs(Xmove) - steps, Xdir, SINGLE);
- }
- else {
- motorY.step(abs(Ymove) - steps, Xdir, SINGLE);
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement