407 code

Dependencies:   mbed SeeedShieldBot BluetoothSerial

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?

UserRevisionLine numberNew 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