Cat_Bot / Mbed 2 deprecated Cat_Bot_sub

sub

Dependencies:   HCSR04 mbed

Fork of Cat_Bot_sub by kazuki ishibashi

main.cpp@1:f4ae12a86f80, 2017-02-03 (annotated)

Committer:
number_key
Date:
Fri Feb 03 10:34:43 2017 +0000
Revision:
1:f4ae12a86f80
Parent:
0:31a72c321609
Child:
2:3f2d37164a10
new cat_bot_sub;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
number_key 0:31a72c321609 1 #include "mbed.h"
number_key 0:31a72c321609 2 #include "hcsr04.h"
number_key 0:31a72c321609 3
number_key 0:31a72c321609 4 Serial to_main(dp4,dp5);
number_key 0:31a72c321609 5 //Serial pc(USBTX,USBRX);
number_key 0:31a72c321609 6
number_key 0:31a72c321609 7 HCSR04 front(dp24,dp25);
number_key 0:31a72c321609 8 HCSR04 back(dp22,dp23);
number_key 0:31a72c321609 9 HCSR04 right(dp20,dp21);
number_key 0:31a72c321609 10 HCSR04 left(dp18,dp19);
number_key 0:31a72c321609 11
number_key 0:31a72c321609 12
number_key 0:31a72c321609 13
number_key 0:31a72c321609 14 int main() {
number_key 0:31a72c321609 15 char dist[4]={0};
number_key 0:31a72c321609 16 //to_main.baud(19200);
number_key 0:31a72c321609 17 while(1) {
number_key 0:31a72c321609 18 front.start();
number_key 0:31a72c321609 19 back.start();
number_key 0:31a72c321609 20 right.start();
number_key 0:31a72c321609 21 left.start();
number_key 1:f4ae12a86f80 22 if(front.get_dist_cm()>255)
number_key 1:f4ae12a86f80 23 dist[0]=255;
number_key 1:f4ae12a86f80 24 else
number_key 1:f4ae12a86f80 25 dist[0]=front.get_dist_cm();
number_key 1:f4ae12a86f80 26 if(back.get_dist_cm()>255)
number_key 1:f4ae12a86f80 27 dist[1]=255;
number_key 1:f4ae12a86f80 28 else
number_key 1:f4ae12a86f80 29 dist[1]=back.get_dist_cm();
number_key 1:f4ae12a86f80 30 if(right.get_dist_cm()>255)
number_key 1:f4ae12a86f80 31 dist[2]=255;
number_key 1:f4ae12a86f80 32 else
number_key 1:f4ae12a86f80 33 dist[2]=right.get_dist_cm();
number_key 1:f4ae12a86f80 34 if(left.get_dist_cm()>255)
number_key 1:f4ae12a86f80 35 dist[3]=255;
number_key 1:f4ae12a86f80 36 else
number_key 1:f4ae12a86f80 37 dist[3]=left.get_dist_cm();
number_key 1:f4ae12a86f80 38
number_key 0:31a72c321609 39 to_main.putc(1);
number_key 0:31a72c321609 40 for(int i=0;i<4;i++){
number_key 0:31a72c321609 41 to_main.putc(dist[i]);
number_key 0:31a72c321609 42 }
number_key 0:31a72c321609 43 //pc.putc('\n');
number_key 0:31a72c321609 44 }
number_key 0:31a72c321609 45 }