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     }