sub

Dependencies:   HCSR04 mbed

Fork of Cat_Bot_sub by kazuki ishibashi

Committer:
number_key
Date:
Thu Feb 02 15:37:06 2017 +0000
Revision:
0:31a72c321609
Child:
1:f4ae12a86f80
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 //I2C to_main(dp4,dp5);
number_key 0:31a72c321609 5 //I2CSlave to_main(dp4,dp5);
number_key 0:31a72c321609 6 Serial to_main(dp4,dp5);
number_key 0:31a72c321609 7 //Serial pc(USBTX,USBRX);
number_key 0:31a72c321609 8
number_key 0:31a72c321609 9 HCSR04 front(dp24,dp25);
number_key 0:31a72c321609 10 HCSR04 back(dp22,dp23);
number_key 0:31a72c321609 11 HCSR04 right(dp20,dp21);
number_key 0:31a72c321609 12 HCSR04 left(dp18,dp19);
number_key 0:31a72c321609 13
number_key 0:31a72c321609 14 //DigitalOut led(dp12);
number_key 0:31a72c321609 15
number_key 0:31a72c321609 16 //const int addr=0x0A;
number_key 0:31a72c321609 17
number_key 0:31a72c321609 18 int main() {
number_key 0:31a72c321609 19 char dist[4]={0};
number_key 0:31a72c321609 20 //to_main.baud(19200);
number_key 0:31a72c321609 21 //to_main.address(addr);
number_key 0:31a72c321609 22 while(1) {
number_key 0:31a72c321609 23 front.start();
number_key 0:31a72c321609 24 back.start();
number_key 0:31a72c321609 25 right.start();
number_key 0:31a72c321609 26 left.start();
number_key 0:31a72c321609 27 dist[0]=front.get_dist_cm();
number_key 0:31a72c321609 28 dist[1]=back.get_dist_cm();
number_key 0:31a72c321609 29 dist[2]=right.get_dist_cm();
number_key 0:31a72c321609 30 dist[3]=left.get_dist_cm();
number_key 0:31a72c321609 31 //led=to_main.write(addr,dist,4);
number_key 0:31a72c321609 32 //led=to_main.write(dist, 4);
number_key 0:31a72c321609 33 to_main.putc(1);
number_key 0:31a72c321609 34 for(int i=0;i<4;i++){
number_key 0:31a72c321609 35 to_main.putc(dist[i]);
number_key 0:31a72c321609 36 }
number_key 0:31a72c321609 37 //pc.putc('\n');
number_key 0:31a72c321609 38 }
number_key 0:31a72c321609 39 }