zaim nuriman / Mbed 2 deprecated Ultra_Infra_TEST1

Final Test 1

Dependencies:   SRF05 mbed

main.cpp@0:83e1c7eacb3d, 2013-06-27 (annotated)

Committer:
eman87
Date:
Thu Jun 27 13:30:47 2013 +0000
Revision:
0:83e1c7eacb3d
Final Test 1

Who changed what in which revision?

UserRevisionLine numberNew contents of line
eman87 0:83e1c7eacb3d 1 #include "mbed.h"
eman87 0:83e1c7eacb3d 2 #include "SRF05.h"
eman87 0:83e1c7eacb3d 3
eman87 0:83e1c7eacb3d 4 SRF05 US_ip(p36, p35); // UltraSonic_input = Trigger, Echo
eman87 0:83e1c7eacb3d 5 AnalogIn IR_ip1(p19); // InfraRed_input_1
eman87 0:83e1c7eacb3d 6 AnalogIn IR_ip2(p20); // InfraRed_input_2
eman87 0:83e1c7eacb3d 7
eman87 0:83e1c7eacb3d 8 // Testing Purposes
eman87 0:83e1c7eacb3d 9 DigitalOut led1(LED1); // If ultra sense >15cm, led1 ON
eman87 0:83e1c7eacb3d 10 DigitalOut led2(LED2); // If ultra sense <16cm, led2 ON
eman87 0:83e1c7eacb3d 11 DigitalOut led3(LED3); // If infra_1 sense <10cm, led3 ON
eman87 0:83e1c7eacb3d 12 DigitalOut led4(LED4); // If infra_2 sense <10cm, led2 ON
eman87 0:83e1c7eacb3d 13
eman87 0:83e1c7eacb3d 14 float ultra;
eman87 0:83e1c7eacb3d 15 float infra_1;
eman87 0:83e1c7eacb3d 16 float infra_2;
eman87 0:83e1c7eacb3d 17
eman87 0:83e1c7eacb3d 18 void Ultrasonic()
eman87 0:83e1c7eacb3d 19 {
eman87 0:83e1c7eacb3d 20 {
eman87 0:83e1c7eacb3d 21 ultra = US_ip.read();
eman87 0:83e1c7eacb3d 22
eman87 0:83e1c7eacb3d 23 if(ultra>15)
eman87 0:83e1c7eacb3d 24 {
eman87 0:83e1c7eacb3d 25 led1=1;
eman87 0:83e1c7eacb3d 26 led2=0;
eman87 0:83e1c7eacb3d 27 }
eman87 0:83e1c7eacb3d 28
eman87 0:83e1c7eacb3d 29 else if(ultra<16)
eman87 0:83e1c7eacb3d 30 {
eman87 0:83e1c7eacb3d 31 led1=0;
eman87 0:83e1c7eacb3d 32 led2=1;
eman87 0:83e1c7eacb3d 33 }
eman87 0:83e1c7eacb3d 34 }
eman87 0:83e1c7eacb3d 35 }
eman87 0:83e1c7eacb3d 36
eman87 0:83e1c7eacb3d 37 void Infra_1()
eman87 0:83e1c7eacb3d 38 {
eman87 0:83e1c7eacb3d 39 {
eman87 0:83e1c7eacb3d 40 infra_1 = IR_ip1.read();
eman87 0:83e1c7eacb3d 41
eman87 0:83e1c7eacb3d 42 if(infra_1<0.4)
eman87 0:83e1c7eacb3d 43 {
eman87 0:83e1c7eacb3d 44 led3=1;
eman87 0:83e1c7eacb3d 45 }
eman87 0:83e1c7eacb3d 46
eman87 0:83e1c7eacb3d 47 else
eman87 0:83e1c7eacb3d 48 {
eman87 0:83e1c7eacb3d 49 led3=0;
eman87 0:83e1c7eacb3d 50 }
eman87 0:83e1c7eacb3d 51 }
eman87 0:83e1c7eacb3d 52 }
eman87 0:83e1c7eacb3d 53
eman87 0:83e1c7eacb3d 54 void Infra_2()
eman87 0:83e1c7eacb3d 55 {
eman87 0:83e1c7eacb3d 56 {
eman87 0:83e1c7eacb3d 57 infra_2 = IR_ip2.read();
eman87 0:83e1c7eacb3d 58
eman87 0:83e1c7eacb3d 59 if(infra_2<0.4)
eman87 0:83e1c7eacb3d 60 {
eman87 0:83e1c7eacb3d 61 led3=1;
eman87 0:83e1c7eacb3d 62 }
eman87 0:83e1c7eacb3d 63
eman87 0:83e1c7eacb3d 64 else
eman87 0:83e1c7eacb3d 65 {
eman87 0:83e1c7eacb3d 66 led3=0;
eman87 0:83e1c7eacb3d 67 }
eman87 0:83e1c7eacb3d 68 }
eman87 0:83e1c7eacb3d 69 }
eman87 0:83e1c7eacb3d 70
eman87 0:83e1c7eacb3d 71 int main()
eman87 0:83e1c7eacb3d 72 {
eman87 0:83e1c7eacb3d 73 //Initialise all leds to OFF
eman87 0:83e1c7eacb3d 74 led1=0;
eman87 0:83e1c7eacb3d 75 led2=0;
eman87 0:83e1c7eacb3d 76 led3=0;
eman87 0:83e1c7eacb3d 77 led4=0;
eman87 0:83e1c7eacb3d 78 wait(1);
eman87 0:83e1c7eacb3d 79 while(1)
eman87 0:83e1c7eacb3d 80 {
eman87 0:83e1c7eacb3d 81 Ultrasonic();
eman87 0:83e1c7eacb3d 82 Infra_1();
eman87 0:83e1c7eacb3d 83 Infra_2();
eman87 0:83e1c7eacb3d 84 }
eman87 0:83e1c7eacb3d 85 }