Suga koubou
/
StepperMotor
see http://mbed.org/users/okini3939/notebook/stepper/
main.cpp@0:0d54fba4f015, 2013-06-20 (annotated)
- Committer:
- okini3939
- Date:
- Thu Jun 20 08:17:56 2013 +0000
- Revision:
- 0:0d54fba4f015
1st build
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
okini3939 | 0:0d54fba4f015 | 1 | #include "mbed.h" |
okini3939 | 0:0d54fba4f015 | 2 | |
okini3939 | 0:0d54fba4f015 | 3 | Serial pc(USBTX, USBRX); |
okini3939 | 0:0d54fba4f015 | 4 | DigitalOut led1(LED1), led2(LED2), led3(LED3); |
okini3939 | 0:0d54fba4f015 | 5 | |
okini3939 | 0:0d54fba4f015 | 6 | DigitalIn mo1(p20), mo2(p17); |
okini3939 | 0:0d54fba4f015 | 7 | DigitalOut ck1(p19), cw1(p18), ck2(p16), cw2(p15); |
okini3939 | 0:0d54fba4f015 | 8 | DigitalOut m1(p14), m2(p13); |
okini3939 | 0:0d54fba4f015 | 9 | |
okini3939 | 0:0d54fba4f015 | 10 | int main() { |
okini3939 | 0:0d54fba4f015 | 11 | |
okini3939 | 0:0d54fba4f015 | 12 | pc.baud(115200); |
okini3939 | 0:0d54fba4f015 | 13 | pc.printf("stepper\r\n"); |
okini3939 | 0:0d54fba4f015 | 14 | |
okini3939 | 0:0d54fba4f015 | 15 | mo1.mode(PullUp); // motor1 MO |
okini3939 | 0:0d54fba4f015 | 16 | mo2.mode(PullUp); // motor2 MO |
okini3939 | 0:0d54fba4f015 | 17 | |
okini3939 | 0:0d54fba4f015 | 18 | // micro step |
okini3939 | 0:0d54fba4f015 | 19 | m1 = 1; // motor1,2 M1 |
okini3939 | 0:0d54fba4f015 | 20 | m2 = 1; // motor1,2 M2 |
okini3939 | 0:0d54fba4f015 | 21 | |
okini3939 | 0:0d54fba4f015 | 22 | cw1 = 0; // motor1 CW/CCW |
okini3939 | 0:0d54fba4f015 | 23 | cw2 = 1; // motor2 CW/CCW |
okini3939 | 0:0d54fba4f015 | 24 | |
okini3939 | 0:0d54fba4f015 | 25 | while(1) { |
okini3939 | 0:0d54fba4f015 | 26 | led1 = ! led1; |
okini3939 | 0:0d54fba4f015 | 27 | // pulse |
okini3939 | 0:0d54fba4f015 | 28 | ck1 = ! ck1; // motor1 CK |
okini3939 | 0:0d54fba4f015 | 29 | ck2 = ! ck2; // motor2 CK |
okini3939 | 0:0d54fba4f015 | 30 | // monitor |
okini3939 | 0:0d54fba4f015 | 31 | led2 = ! mo1; |
okini3939 | 0:0d54fba4f015 | 32 | led3 = ! mo2; |
okini3939 | 0:0d54fba4f015 | 33 | |
okini3939 | 0:0d54fba4f015 | 34 | wait_us(250); |
okini3939 | 0:0d54fba4f015 | 35 | } |
okini3939 | 0:0d54fba4f015 | 36 | } |