Fabio Faria / Mbed OS LibraryPublishing01

Sample code for using the rangefinder.

Dependencies:   ISR_Mini-explorer_tmp

Embed: (wiki syntax)

« Back to documentation index

Show/hide line numbers main.cpp Source File

main.cpp

00001 #include "mbed.h"
00002 #include "robot.h" // Inicializa o robô. Este include deverá ser usado em todos os main.cpp!
00003 #include "Radio.h"
00004 #include "Rangefinder.h"
00005 
00006 int main()
00007 {
00008     initRobot(124);
00009     init_rangefinder(&i2c1, &mutex_i2c1);
00010 
00011     while(1) {
00012         if( read_rangefinder() == 0 ) {
00013             for(int i = 0; i < 16; i++) {
00014                 if(rgfMeasurements[i] > 1270)
00015                     pc.printf("%d=%u ", i, 0);
00016                 else
00017                     pc.printf("%d=%u ", i, rgfMeasurements[i]);
00018             }
00019             pc.printf("\n");
00020         }
00021 
00022         wait(1);
00023     }
00024 }
Generated on Thu Jul 28 2022 12:06:28 by  doxygen 1.7.2