Sample code for using the rangefinder.
Dependencies: ISR_Mini-explorer_tmp
main.cpp@0:1750d1fd5e73, 2018-04-19 (annotated)
- Committer:
- fabiofaria
- Date:
- Thu Apr 19 15:36:56 2018 +0000
- Revision:
- 0:1750d1fd5e73
Initial commit
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
fabiofaria | 0:1750d1fd5e73 | 1 | #include "mbed.h" |
fabiofaria | 0:1750d1fd5e73 | 2 | #include "robot.h" // Inicializa o robô. Este include deverá ser usado em todos os main.cpp! |
fabiofaria | 0:1750d1fd5e73 | 3 | #include "Radio.h" |
fabiofaria | 0:1750d1fd5e73 | 4 | #include "Rangefinder.h" |
fabiofaria | 0:1750d1fd5e73 | 5 | |
fabiofaria | 0:1750d1fd5e73 | 6 | int main() |
fabiofaria | 0:1750d1fd5e73 | 7 | { |
fabiofaria | 0:1750d1fd5e73 | 8 | initRobot(124); |
fabiofaria | 0:1750d1fd5e73 | 9 | init_rangefinder(&i2c1, &mutex_i2c1); |
fabiofaria | 0:1750d1fd5e73 | 10 | |
fabiofaria | 0:1750d1fd5e73 | 11 | while(1) { |
fabiofaria | 0:1750d1fd5e73 | 12 | if( read_rangefinder() == 0 ) { |
fabiofaria | 0:1750d1fd5e73 | 13 | for(int i = 0; i < 16; i++) { |
fabiofaria | 0:1750d1fd5e73 | 14 | if(rgfMeasurements[i] > 1270) |
fabiofaria | 0:1750d1fd5e73 | 15 | pc.printf("%d=%u ", i, 0); |
fabiofaria | 0:1750d1fd5e73 | 16 | else |
fabiofaria | 0:1750d1fd5e73 | 17 | pc.printf("%d=%u ", i, rgfMeasurements[i]); |
fabiofaria | 0:1750d1fd5e73 | 18 | } |
fabiofaria | 0:1750d1fd5e73 | 19 | pc.printf("\n"); |
fabiofaria | 0:1750d1fd5e73 | 20 | } |
fabiofaria | 0:1750d1fd5e73 | 21 | |
fabiofaria | 0:1750d1fd5e73 | 22 | wait(1); |
fabiofaria | 0:1750d1fd5e73 | 23 | } |
fabiofaria | 0:1750d1fd5e73 | 24 | } |