Advertisement
Not a member of Pastebin yet?
Sign Up,
it unlocks many cool features!
- int moveUntilHold()
- {
- int endStopState = getEndStoperState();
- if (endStopState == 0)
- {
- n = n - 30;
- printf("n=%d\n", n);
- setGripperPosition(n);
- }
- if(endStopState == 1)
- {
- n = n + 15;
- setGripperPosition(n);
- endStopState = getEndStoperState();
- if(endStopState == 0)
- {
- n = n - 14;
- setGripperPosition(n);
- }
- if(endStopState == 1)
- {
- n = n + 14;
- setGripperPosition(n);
- }
- }
- endStopState = getEndStoperState();
- if(endStopState == 1)
- {
- n = n + 15;
- setGripperPosition(n);
- endStopState = getEndStoperState();
- if(endStopState == 0)
- {
- n = n - 14;
- setGripperPosition(n);
- }
- if(endStopState == 1)
- {
- n = n + 14;
- setGripperPosition(n);
- }
- }
- endStopState = getEndStoperState();
- if(endStopState == 1)
- {
- n = n + 15;
- setGripperPosition(n);
- endStopState = getEndStoperState();
- if(endStopState == 0)
- {
- n = n - 14;
- setGripperPosition(n);
- }
- if(endStopState == 1)
- {
- n = n + 14;
- setGripperPosition(n);
- }
- }
- endStopState = getEndStoperState();
- if(endStopState == 1)
- {
- n = n + 15;
- setGripperPosition(n);
- endStopState = getEndStoperState();
- if(endStopState == 0)
- {
- n = n - 14;
- setGripperPosition(n);
- }
- if(endStopState == 1)
- {
- n = n + 14;
- setGripperPosition(n);
- }
- }
- endStopState = getEndStoperState();
- if(endStopState == 1)
- {
- n = n + 15;
- setGripperPosition(n);
- endStopState = getEndStoperState();
- if(endStopState == 0)
- {
- n = n - 14;
- setGripperPosition(n);
- }
- if(endStopState == 1)
- {
- n = n + 14;
- setGripperPosition(n);
- }
- }
- endStopState = getEndStoperState();
- if(endStopState == 1)
- {
- n = n + 15;
- setGripperPosition(n);
- endStopState = getEndStoperState();
- if(endStopState == 0)
- {
- n = n - 14;
- setGripperPosition(n);
- }
- if(endStopState == 1)
- {
- n = n + 14;
- setGripperPosition(n);
- }
- }
- endStopState = getEndStoperState();
- if(endStopState == 1)
- {
- n = n + 15;
- setGripperPosition(n);
- endStopState = getEndStoperState();
- if(endStopState == 0)
- {
- n = n - 14;
- setGripperPosition(n);
- }
- if(endStopState == 1)
- {
- n = n + 14;
- setGripperPosition(n);
- }
- }
- endStopState = getEndStoperState();
- if(endStopState == 1)
- {
- n = n + 15;
- setGripperPosition(n);
- endStopState = getEndStoperState();
- if(endStopState == 0)
- {
- n = n - 14;
- setGripperPosition(n);
- }
- if(endStopState == 1)
- {
- n = n + 14;
- setGripperPosition(n);
- }
- }
- }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement