Cat_Bot
/
Cat_Bot_sub
sub
Fork of Cat_Bot_sub by
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?
User | Revision | Line number | New 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 | } |