zaim nuriman
/
Ultra_Infra_TEST1
Final Test 1
Embed:
(wiki syntax)
Show/hide line numbers
main.cpp
00001 #include "mbed.h" 00002 #include "SRF05.h" 00003 00004 SRF05 US_ip(p36, p35); // UltraSonic_input = Trigger, Echo 00005 AnalogIn IR_ip1(p19); // InfraRed_input_1 00006 AnalogIn IR_ip2(p20); // InfraRed_input_2 00007 00008 // Testing Purposes 00009 DigitalOut led1(LED1); // If ultra sense >15cm, led1 ON 00010 DigitalOut led2(LED2); // If ultra sense <16cm, led2 ON 00011 DigitalOut led3(LED3); // If infra_1 sense <10cm, led3 ON 00012 DigitalOut led4(LED4); // If infra_2 sense <10cm, led2 ON 00013 00014 float ultra; 00015 float infra_1; 00016 float infra_2; 00017 00018 void Ultrasonic() 00019 { 00020 { 00021 ultra = US_ip.read(); 00022 00023 if(ultra>15) 00024 { 00025 led1=1; 00026 led2=0; 00027 } 00028 00029 else if(ultra<16) 00030 { 00031 led1=0; 00032 led2=1; 00033 } 00034 } 00035 } 00036 00037 void Infra_1() 00038 { 00039 { 00040 infra_1 = IR_ip1.read(); 00041 00042 if(infra_1<0.4) 00043 { 00044 led3=1; 00045 } 00046 00047 else 00048 { 00049 led3=0; 00050 } 00051 } 00052 } 00053 00054 void Infra_2() 00055 { 00056 { 00057 infra_2 = IR_ip2.read(); 00058 00059 if(infra_2<0.4) 00060 { 00061 led3=1; 00062 } 00063 00064 else 00065 { 00066 led3=0; 00067 } 00068 } 00069 } 00070 00071 int main() 00072 { 00073 //Initialise all leds to OFF 00074 led1=0; 00075 led2=0; 00076 led3=0; 00077 led4=0; 00078 wait(1); 00079 while(1) 00080 { 00081 Ultrasonic(); 00082 Infra_1(); 00083 Infra_2(); 00084 } 00085 }
Generated on Sun Jul 17 2022 01:43:03 by 1.7.2