no optics
Dependencies: Stepper mbed PinDetect
main.cpp@3:af3195b3330d, 2019-09-04 (annotated)
- Committer:
- rschimpf78
- Date:
- Wed Sep 04 18:47:29 2019 +0000
- Revision:
- 3:af3195b3330d
- Parent:
- 2:65c5232b9465
no optics
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
rschimpf78 | 0:88834eed3de0 | 1 | #include "mbed.h" |
rschimpf78 | 0:88834eed3de0 | 2 | #include "Stepper.h" |
rschimpf78 | 2:65c5232b9465 | 3 | #include "string" |
rschimpf78 | 2:65c5232b9465 | 4 | DigitalIn optic(D5); |
rschimpf78 | 2:65c5232b9465 | 5 | Stepper mot(D3,D2); //(PUL+,DIR+) |
rschimpf78 | 2:65c5232b9465 | 6 | DigitalOut en(D4); |
rschimpf78 | 0:88834eed3de0 | 7 | Serial pc(USBTX, USBRX); |
rschimpf78 | 0:88834eed3de0 | 8 | |
rschimpf78 | 2:65c5232b9465 | 9 | int main() |
rschimpf78 | 0:88834eed3de0 | 10 | { |
rschimpf78 | 2:65c5232b9465 | 11 | optic.mode(PullDown); |
rschimpf78 | 2:65c5232b9465 | 12 | wait(0.1); |
rschimpf78 | 2:65c5232b9465 | 13 | int steps = 0; |
rschimpf78 | 2:65c5232b9465 | 14 | int slot = 0; |
rschimpf78 | 2:65c5232b9465 | 15 | en = 1; // stepper motor off |
rschimpf78 | 2:65c5232b9465 | 16 | wait(1); |
rschimpf78 | 2:65c5232b9465 | 17 | mot.setSpeed(400); //stepper speed |
rschimpf78 | 2:65c5232b9465 | 18 | mot.setPositionZero(); //set origin for stepper steps |
rschimpf78 | 2:65c5232b9465 | 19 | while(1) |
rschimpf78 | 2:65c5232b9465 | 20 | { |
rschimpf78 | 2:65c5232b9465 | 21 | pc.printf("\n\n\nEnter desired position: "); |
rschimpf78 | 3:af3195b3330d | 22 | pc.scanf("%d",&slot); |
rschimpf78 | 3:af3195b3330d | 23 | |
rschimpf78 | 2:65c5232b9465 | 24 | en = 0; //turns on stepper driver |
rschimpf78 | 3:af3195b3330d | 25 | mot.goesTo(slot*1000); // move to absolute slot*500 step position |
rschimpf78 | 2:65c5232b9465 | 26 | while(!mot.stopped()); // while motor is turning...do line below |
rschimpf78 | 2:65c5232b9465 | 27 | steps = mot.getPosition(); //read in absolute step postition |
rschimpf78 | 2:65c5232b9465 | 28 | pc.printf("\nIn Position"); |
rschimpf78 | 2:65c5232b9465 | 29 | en = 1; //disable the motor and driver |
rschimpf78 | 0:88834eed3de0 | 30 | } |
rschimpf78 | 0:88834eed3de0 | 31 | } |