Takashi Matsuoka / MjGP2Y0E03

For Sharp GP2Y0E03(optical distance measurement sensor).

#include "mbed.h"
#include "MjGP2Y0E03.h"

using namespace matsujirushi;

Serial pc(USBTX, USBRX);
I2C i2c(dp5, dp27);
MjGP2Y0E03 distanceSensor(&i2c, 0x80);

int main()
{
    pc.baud(115200);
    i2c.frequency(400000);
    for(;;)
    {
        uint16_t distance = distanceSensor.getDistance();
        
        pc.printf("%4d [", distance);
        int i;
        for (i = 0; i < distance / 50; i++)
        {
            pc.putc('*');
        }
        for (; i < 4096 / 50; i++)
        {
            pc.putc(' ');
        }
        pc.puts("]\r\n");
        
        wait_ms(50);
    }
}

Diff: MjGP2Y0E03.cpp

Revision:
0:33c4a1de6547
Child:
1:1832cde75561
diff -r 000000000000 -r 33c4a1de6547 MjGP2Y0E03.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/MjGP2Y0E03.cpp	Mon Nov 24 07:51:53 2014 +0000
@@ -0,0 +1,23 @@
+#include "MjGP2Y0E03.h"
+
+namespace matsujirushi {
+
+MjGP2Y0E03::MjGP2Y0E03(I2C* i2c, uint8_t address)
+{
+    this->i2c = i2c;
+    this->address = address;
+}
+
+uint16_t MjGP2Y0E03::getDistance()
+{
+    char regAddress = 0x5e;
+    i2c->write(address, &regAddress, 1, true);
+    
+    char data[2];
+    i2c->read(address, data, sizeof (data));
+    
+    return ((uint16_t)data[0] << 4) + (data[1] & 0x0f);
+}
+
+} // namespace matsujirushi
+