407 code

Dependencies:   mbed SeeedShieldBot BluetoothSerial

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?

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