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-05-02
Revision:
1:8fd592bac4de
Parent:
0:ca6c5200a318
Child:
2:d4d7d6d4a827

File content as of revision 1:8fd592bac4de:

#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++) {
                pc.printf("%d=%u ", i, rgfMeasurements[i]);
            }
            pc.printf("\n");
        }

        wait(0.5);
    }
}