Cat_Bot
/
Cat_Bot_sub
sub
Fork of Cat_Bot_sub by
main.cpp@0:31a72c321609, 2017-02-02 (annotated)
- 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?
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 | //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 | } |