Revision 2:0aa9f1870ec1, committed 2014-12-26

Comitter:

Belesiu

Date:

Fri Dec 26 21:27:32 2014 +0000

Parent:

1:03c191369089

Commit message:

First experiment with mbed.

Changed in this revision

--- a/main.cpp	Sun Jan 01 20:57:57 2012 +0000
+++ b/main.cpp	Fri Dec 26 21:27:32 2014 +0000
@@ -1,12 +1,47 @@
+// Ultra Sonice Range Finder
+// Experiement #1
+// Belesiu
+// 2014.12.26
+
 #include "mbed.h"
 
 DigitalOut myled(LED1);
 
-int main() {
+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);
+
     }
 }