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