Preliminary sample code for using the rangefinder.

Dependencies:   ISR_Mini-explorer_tmp2

Committer:
fabiofaria
Date:
Wed May 02 14:05:07 2018 +0000
Revision:
1:8fd592bac4de
Parent:
0:ca6c5200a318
Child:
2:d4d7d6d4a827
Truncation removed.

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 1:8fd592bac4de 13 pc.printf("%d=%u ", i, rgfMeasurements[i]);
fabiofaria 0:ca6c5200a318 14 }
fabiofaria 0:ca6c5200a318 15 pc.printf("\n");
fabiofaria 0:ca6c5200a318 16 }
fabiofaria 0:ca6c5200a318 17
fabiofaria 0:ca6c5200a318 18 wait(0.5);
fabiofaria 0:ca6c5200a318 19 }
fabiofaria 0:ca6c5200a318 20 }