Preliminary sample code for using the rangefinder.
Dependencies: ISR_Mini-explorer_tmp2
main.cpp@4:0312c52bd9ed, 2018-05-16 (annotated)
- Committer:
- fabiofaria
- Date:
- Wed May 16 14:24:01 2018 +0000
- Revision:
- 4:0312c52bd9ed
- Parent:
- 2:d4d7d6d4a827
Bug fixed on read_radio.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
fabiofaria | 0:ca6c5200a318 | 1 | #include "mbed.h" |
fabiofaria | 0:ca6c5200a318 | 2 | #include "robot.h" // Inicializa o robô. Este include deverá ser usado em todos os main.cpp! |
fabiofaria | 0:ca6c5200a318 | 3 | #include "Radio.h" |
fabiofaria | 0:ca6c5200a318 | 4 | #include "Rangefinder.h" |
fabiofaria | 0:ca6c5200a318 | 5 | |
fabiofaria | 0:ca6c5200a318 | 6 | int main() |
fabiofaria | 0:ca6c5200a318 | 7 | { |
fabiofaria | 0:ca6c5200a318 | 8 | initRobot(124); |
fabiofaria | 2:d4d7d6d4a827 | 9 | X=20; |
fabiofaria | 2:d4d7d6d4a827 | 10 | Y=20; |
fabiofaria | 2:d4d7d6d4a827 | 11 | THETA=0; |
fabiofaria | 0:ca6c5200a318 | 12 | |
fabiofaria | 0:ca6c5200a318 | 13 | while(1) { |
fabiofaria | 0:ca6c5200a318 | 14 | if( read_rangefinder() == 0 ) { |
fabiofaria | 0:ca6c5200a318 | 15 | for(int i = 0; i < 16; i++) { |
fabiofaria | 1:8fd592bac4de | 16 | pc.printf("%d=%u ", i, rgfMeasurements[i]); |
fabiofaria | 0:ca6c5200a318 | 17 | } |
fabiofaria | 0:ca6c5200a318 | 18 | pc.printf("\n"); |
fabiofaria | 0:ca6c5200a318 | 19 | } |
fabiofaria | 2:d4d7d6d4a827 | 20 | else |
fabiofaria | 2:d4d7d6d4a827 | 21 | { |
fabiofaria | 2:d4d7d6d4a827 | 22 | pc.printf("Rangefinder reading failed!\n"); |
fabiofaria | 2:d4d7d6d4a827 | 23 | q_led_red_rea = 0; // Turns ON rear red LED. |
fabiofaria | 2:d4d7d6d4a827 | 24 | } |
fabiofaria | 0:ca6c5200a318 | 25 | |
fabiofaria | 0:ca6c5200a318 | 26 | wait(0.5); |
fabiofaria | 0:ca6c5200a318 | 27 | } |
fabiofaria | 0:ca6c5200a318 | 28 | } |