Diff: main.cpp

Revision:

0:28fb80eb93ca

Child:

1:0cf1f2254f10

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Fri Dec 26 21:20:04 2014 +0000
@@ -0,0 +1,47 @@
+// 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);
+
+    }
+}