Cat_Bot
/
Cat_Bot_sub
sub
Fork of Cat_Bot_sub by
main.cpp
- Committer:
- number_key
- Date:
- 2017-02-03
- Revision:
- 1:f4ae12a86f80
- Parent:
- 0:31a72c321609
- Child:
- 2:3f2d37164a10
File content as of revision 1:f4ae12a86f80:
#include "mbed.h" #include "hcsr04.h" Serial to_main(dp4,dp5); //Serial pc(USBTX,USBRX); HCSR04 front(dp24,dp25); HCSR04 back(dp22,dp23); HCSR04 right(dp20,dp21); HCSR04 left(dp18,dp19); int main() { char dist[4]={0}; //to_main.baud(19200); while(1) { front.start(); back.start(); right.start(); left.start(); if(front.get_dist_cm()>255) dist[0]=255; else dist[0]=front.get_dist_cm(); if(back.get_dist_cm()>255) dist[1]=255; else dist[1]=back.get_dist_cm(); if(right.get_dist_cm()>255) dist[2]=255; else dist[2]=right.get_dist_cm(); if(left.get_dist_cm()>255) dist[3]=255; else dist[3]=left.get_dist_cm(); to_main.putc(1); for(int i=0;i<4;i++){ to_main.putc(dist[i]); } //pc.putc('\n'); } }