Fabio Faria / Mbed OS ISR_Mini-explorer_Rangefinder

Preliminary sample code for using the rangefinder.

Dependencies:   ISR_Mini-explorer_tmp2

main.cpp@0:ca6c5200a318, 2018-04-19 (annotated)

Committer:
fabiofaria
Date:
Thu Apr 19 15:44:58 2018 +0000
Revision:
0:ca6c5200a318
Child:
1:8fd592bac4de
.

Who changed what in which revision?

UserRevisionLine numberNew 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 0:ca6c5200a318 9
fabiofaria 0:ca6c5200a318 10 while(1) {
fabiofaria 0:ca6c5200a318 11 if( read_rangefinder() == 0 ) {
fabiofaria 0:ca6c5200a318 12 for(int i = 0; i < 16; i++) {
fabiofaria 0:ca6c5200a318 13 if(rgfMeasurements[i] > 1270)
fabiofaria 0:ca6c5200a318 14 pc.printf("%d=%u ", i, 0);
fabiofaria 0:ca6c5200a318 15 else
fabiofaria 0:ca6c5200a318 16 pc.printf("%d=%u ", i, rgfMeasurements[i]);
fabiofaria 0:ca6c5200a318 17 }
fabiofaria 0:ca6c5200a318 18 pc.printf("\n");
fabiofaria 0:ca6c5200a318 19 }
fabiofaria 0:ca6c5200a318 20
fabiofaria 0:ca6c5200a318 21 wait(0.5);
fabiofaria 0:ca6c5200a318 22 }
fabiofaria 0:ca6c5200a318 23 }