Jim Belesiu
/
HelloWorld
First experiment with mbed
Fork of HelloWorld by
main.cpp
- Committer:
- Belesiu
- Date:
- 2014-12-26
- Revision:
- 2:0aa9f1870ec1
- Parent:
- 0:fb6bbc10ffa0
File content as of revision 2:0aa9f1870ec1:
// Ultra Sonice Range Finder // Experiement #1 // Belesiu // 2014.12.26 #include "mbed.h" DigitalOut myled(LED1); I2C rangefinder(p9, p10); // sda, sc1 Serial pc(USBTX, USBRX); // tx, rx const int addr = 0xE0; char config_r[2]; char range_read[2]; float range; int main() { int x = 0; while(1) { // Test serial port myled = 1; wait(0.2); myled = 0; wait(0.2); pc.printf("Hello Jim! - %d\n", x++); // For MB7040 config_r[0] = 0x00; // set pointer reg to ‘cmd register' config_r[1] = 0x51; // config data byte1 rangefinder.write(addr, config_r, 2); wait(0.07); config_r[0] = 0x02; //set pointer reg to 'data register' rangefinder.write(addr, config_r, 1); //send to pointer 'read range' rangefinder.read(addr, range_read, 2); //read the two-byte range data range = ((range_read[0] << 8) + range_read[1]); pc.printf("Range = %.2f cm\n\r", range); //print range on screen wait(0.05); } }