Line Follower Robot for following a white line on a black background.
Line Follower Robot for following a white line on a black background.
main.cpp@0:116b193a6a75, 2014-01-22 (annotated)
- Committer:
- msarun003
- Date:
- Wed Jan 22 21:21:50 2014 +0000
- Revision:
- 0:116b193a6a75
Line Follower Robot for following a white line on a black background.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
msarun003 | 0:116b193a6a75 | 1 | /* |
msarun003 | 0:116b193a6a75 | 2 | ######################################################### |
msarun003 | 0:116b193a6a75 | 3 | ## Program Created by Harshavardan T V & Arun M S ## |
msarun003 | 0:116b193a6a75 | 4 | ######################################################### |
msarun003 | 0:116b193a6a75 | 5 | ---- harshavardan61@gmail.com & msarun003@gmail.com ----- |
msarun003 | 0:116b193a6a75 | 6 | */ |
msarun003 | 0:116b193a6a75 | 7 | |
msarun003 | 0:116b193a6a75 | 8 | #include "mbed.h" |
msarun003 | 0:116b193a6a75 | 9 | |
msarun003 | 0:116b193a6a75 | 10 | DigitalOut led1(LED1); |
msarun003 | 0:116b193a6a75 | 11 | DigitalOut led2(LED2); |
msarun003 | 0:116b193a6a75 | 12 | DigitalOut led3(LED3); |
msarun003 | 0:116b193a6a75 | 13 | DigitalOut led4(LED4); |
msarun003 | 0:116b193a6a75 | 14 | AnalogIn left(p16); //IR Enable. |
msarun003 | 0:116b193a6a75 | 15 | AnalogIn right(p17); //IR Enable. |
msarun003 | 0:116b193a6a75 | 16 | DigitalOut left1(p21); |
msarun003 | 0:116b193a6a75 | 17 | DigitalOut left2(p22); |
msarun003 | 0:116b193a6a75 | 18 | DigitalOut right1(p23); |
msarun003 | 0:116b193a6a75 | 19 | DigitalOut right2(p24); |
msarun003 | 0:116b193a6a75 | 20 | |
msarun003 | 0:116b193a6a75 | 21 | |
msarun003 | 0:116b193a6a75 | 22 | int main() { |
msarun003 | 0:116b193a6a75 | 23 | float l,r; |
msarun003 | 0:116b193a6a75 | 24 | while (1) |
msarun003 | 0:116b193a6a75 | 25 | { |
msarun003 | 0:116b193a6a75 | 26 | l=left; //Assign Variable "p" to piezo. |
msarun003 | 0:116b193a6a75 | 27 | r=right; //Assign Variable "i" to ir. |
msarun003 | 0:116b193a6a75 | 28 | if(l<0.8) |
msarun003 | 0:116b193a6a75 | 29 | { |
msarun003 | 0:116b193a6a75 | 30 | if(r>0.8) |
msarun003 | 0:116b193a6a75 | 31 | { |
msarun003 | 0:116b193a6a75 | 32 | led4=1; |
msarun003 | 0:116b193a6a75 | 33 | led3=1; |
msarun003 | 0:116b193a6a75 | 34 | led1=0; |
msarun003 | 0:116b193a6a75 | 35 | led2=0; |
msarun003 | 0:116b193a6a75 | 36 | left1=0; |
msarun003 | 0:116b193a6a75 | 37 | left2=1; |
msarun003 | 0:116b193a6a75 | 38 | right1=1; |
msarun003 | 0:116b193a6a75 | 39 | right2=0; |
msarun003 | 0:116b193a6a75 | 40 | } |
msarun003 | 0:116b193a6a75 | 41 | else |
msarun003 | 0:116b193a6a75 | 42 | { |
msarun003 | 0:116b193a6a75 | 43 | led1=1; |
msarun003 | 0:116b193a6a75 | 44 | led4=1; |
msarun003 | 0:116b193a6a75 | 45 | led2=0; |
msarun003 | 0:116b193a6a75 | 46 | led3=0; |
msarun003 | 0:116b193a6a75 | 47 | left1=1; |
msarun003 | 0:116b193a6a75 | 48 | left2=0; |
msarun003 | 0:116b193a6a75 | 49 | right1=1; |
msarun003 | 0:116b193a6a75 | 50 | right2=0; |
msarun003 | 0:116b193a6a75 | 51 | } |
msarun003 | 0:116b193a6a75 | 52 | } |
msarun003 | 0:116b193a6a75 | 53 | else if(l>0.8) |
msarun003 | 0:116b193a6a75 | 54 | { |
msarun003 | 0:116b193a6a75 | 55 | if(r<0.8) |
msarun003 | 0:116b193a6a75 | 56 | { |
msarun003 | 0:116b193a6a75 | 57 | led1=1; |
msarun003 | 0:116b193a6a75 | 58 | led2=1; |
msarun003 | 0:116b193a6a75 | 59 | led3=0; |
msarun003 | 0:116b193a6a75 | 60 | led4=0; |
msarun003 | 0:116b193a6a75 | 61 | left1=1; |
msarun003 | 0:116b193a6a75 | 62 | left2=0; |
msarun003 | 0:116b193a6a75 | 63 | right1=0; |
msarun003 | 0:116b193a6a75 | 64 | right2=1; |
msarun003 | 0:116b193a6a75 | 65 | } |
msarun003 | 0:116b193a6a75 | 66 | else |
msarun003 | 0:116b193a6a75 | 67 | { |
msarun003 | 0:116b193a6a75 | 68 | led1=1; |
msarun003 | 0:116b193a6a75 | 69 | led4=1; |
msarun003 | 0:116b193a6a75 | 70 | led2=0; |
msarun003 | 0:116b193a6a75 | 71 | led3=0; |
msarun003 | 0:116b193a6a75 | 72 | left1=1; |
msarun003 | 0:116b193a6a75 | 73 | left2=0; |
msarun003 | 0:116b193a6a75 | 74 | right1=1; |
msarun003 | 0:116b193a6a75 | 75 | right2=0; |
msarun003 | 0:116b193a6a75 | 76 | } |
msarun003 | 0:116b193a6a75 | 77 | } |
msarun003 | 0:116b193a6a75 | 78 | else |
msarun003 | 0:116b193a6a75 | 79 | { |
msarun003 | 0:116b193a6a75 | 80 | led1=1; |
msarun003 | 0:116b193a6a75 | 81 | led4=1; |
msarun003 | 0:116b193a6a75 | 82 | led2=0; |
msarun003 | 0:116b193a6a75 | 83 | led3=0; |
msarun003 | 0:116b193a6a75 | 84 | left1=1; |
msarun003 | 0:116b193a6a75 | 85 | left2=0; |
msarun003 | 0:116b193a6a75 | 86 | right1=1; |
msarun003 | 0:116b193a6a75 | 87 | right2=0; |
msarun003 | 0:116b193a6a75 | 88 | } |
msarun003 | 0:116b193a6a75 | 89 | } |
msarun003 | 0:116b193a6a75 | 90 | } |