Fabio Faria / Mbed OS ISR_Mini-explorer_Rangefinder

Preliminary sample code for using the rangefinder.

Dependencies:   ISR_Mini-explorer_tmp2

main.cpp

Committer:
fabiofaria
Date:
2018-04-19
Revision:
0:ca6c5200a318
Child:
1:8fd592bac4de

File content as of revision 0:ca6c5200a318:

#include "mbed.h"
#include "robot.h" // Inicializa o robô. Este include deverá ser usado em todos os main.cpp!
#include "Radio.h"
#include "Rangefinder.h"

int main()
{
    initRobot(124);

    while(1) {
        if( read_rangefinder() == 0 ) {
            for(int i = 0; i < 16; i++) {
                if(rgfMeasurements[i] > 1270)
                    pc.printf("%d=%u ", i, 0);
                else
                    pc.printf("%d=%u ", i, rgfMeasurements[i]);
            }
            pc.printf("\n");
        }

        wait(0.5);
    }
}