407 code
Dependencies: mbed SeeedShieldBot BluetoothSerial
main.cpp@0:ac051b1bec3c, 2022-05-26 (annotated)
- Committer:
- sangwan_
- Date:
- Thu May 26 15:49:26 2022 +0000
- Revision:
- 0:ac051b1bec3c
- Child:
- 1:6fe4d6e4c602
407 code;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
sangwan_ | 0:ac051b1bec3c | 1 | #include "mbed.h" |
sangwan_ | 0:ac051b1bec3c | 2 | #include "time.h" |
sangwan_ | 0:ac051b1bec3c | 3 | #define timedelay 500 |
sangwan_ | 0:ac051b1bec3c | 4 | PwmOut LampStep(D3); |
sangwan_ | 0:ac051b1bec3c | 5 | DigitalOut LampDir(D5); |
sangwan_ | 0:ac051b1bec3c | 6 | AnalogIn ldr1in(A3); |
sangwan_ | 0:ac051b1bec3c | 7 | AnalogIn ldr2in(A4); |
sangwan_ | 0:ac051b1bec3c | 8 | DigitalOut ldr1out(D1); |
sangwan_ | 0:ac051b1bec3c | 9 | DigitalOut ldr2out(D0); |
sangwan_ | 0:ac051b1bec3c | 10 | DigitalOut PrismStep(D6); |
sangwan_ | 0:ac051b1bec3c | 11 | DigitalOut PrismDir(D8); |
sangwan_ | 0:ac051b1bec3c | 12 | DigitalIn button(USER_BUTTON); |
sangwan_ | 0:ac051b1bec3c | 13 | Timer t; |
sangwan_ | 0:ac051b1bec3c | 14 | DigitalOut led1(LED1); |
sangwan_ | 0:ac051b1bec3c | 15 | DigitalOut ms1(PC_1); |
sangwan_ | 0:ac051b1bec3c | 16 | DigitalOut ms2(PC_2); |
sangwan_ | 0:ac051b1bec3c | 17 | DigitalOut ms3(PC_3); |
sangwan_ | 0:ac051b1bec3c | 18 | /*void LampArm() |
sangwan_ | 0:ac051b1bec3c | 19 | { |
sangwan_ | 0:ac051b1bec3c | 20 | LampStep.write(0.01); |
sangwan_ | 0:ac051b1bec3c | 21 | wait(10); |
sangwan_ | 0:ac051b1bec3c | 22 | LampStep.write(0); |
sangwan_ | 0:ac051b1bec3c | 23 | wait(1000); |
sangwan_ | 0:ac051b1bec3c | 24 | }*/ |
sangwan_ | 0:ac051b1bec3c | 25 | /* |
sangwan_ | 0:ac051b1bec3c | 26 | void PrismMotor() |
sangwan_ | 0:ac051b1bec3c | 27 | { |
sangwan_ | 0:ac051b1bec3c | 28 | |
sangwan_ | 0:ac051b1bec3c | 29 | } |
sangwan_ | 0:ac051b1bec3c | 30 | */ |
sangwan_ | 0:ac051b1bec3c | 31 | int main() |
sangwan_ | 0:ac051b1bec3c | 32 | { |
sangwan_ | 0:ac051b1bec3c | 33 | LampDir.write(1); |
sangwan_ | 0:ac051b1bec3c | 34 | ms1.write(3); |
sangwan_ | 0:ac051b1bec3c | 35 | ms2.write(3); |
sangwan_ | 0:ac051b1bec3c | 36 | ms3.write(3); |
sangwan_ | 0:ac051b1bec3c | 37 | int counter = 0; |
sangwan_ | 0:ac051b1bec3c | 38 | int x = 0; |
sangwan_ | 0:ac051b1bec3c | 39 | x = button.read(); |
sangwan_ | 0:ac051b1bec3c | 40 | if (x == 0){ |
sangwan_ | 0:ac051b1bec3c | 41 | for (counter = 0; counter<=100; counter++) |
sangwan_ | 0:ac051b1bec3c | 42 | { |
sangwan_ | 0:ac051b1bec3c | 43 | LampStep.period_ms(100); |
sangwan_ | 0:ac051b1bec3c | 44 | LampStep.pulsewidth_ms(5); |
sangwan_ | 0:ac051b1bec3c | 45 | //counter+=1; |
sangwan_ | 0:ac051b1bec3c | 46 | } |
sangwan_ | 0:ac051b1bec3c | 47 | } |
sangwan_ | 0:ac051b1bec3c | 48 | else if (x == 1) |
sangwan_ | 0:ac051b1bec3c | 49 | { |
sangwan_ | 0:ac051b1bec3c | 50 | LampStep.period_ms(0); |
sangwan_ | 0:ac051b1bec3c | 51 | LampStep.pulsewidth_ms(0); |
sangwan_ | 0:ac051b1bec3c | 52 | } |
sangwan_ | 0:ac051b1bec3c | 53 | } |
sangwan_ | 0:ac051b1bec3c | 54 | |
sangwan_ | 0:ac051b1bec3c | 55 | |
sangwan_ | 0:ac051b1bec3c | 56 |