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); } }
MjGP2Y0E03.cpp@0:33c4a1de6547, 2014-11-24 (annotated)
- Committer:
- matsujirushi
- Date:
- Mon Nov 24 07:51:53 2014 +0000
- Revision:
- 0:33c4a1de6547
- Child:
- 1:1832cde75561
Create MjGP2Y0E03 class.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
matsujirushi | 0:33c4a1de6547 | 1 | #include "MjGP2Y0E03.h" |
matsujirushi | 0:33c4a1de6547 | 2 | |
matsujirushi | 0:33c4a1de6547 | 3 | namespace matsujirushi { |
matsujirushi | 0:33c4a1de6547 | 4 | |
matsujirushi | 0:33c4a1de6547 | 5 | MjGP2Y0E03::MjGP2Y0E03(I2C* i2c, uint8_t address) |
matsujirushi | 0:33c4a1de6547 | 6 | { |
matsujirushi | 0:33c4a1de6547 | 7 | this->i2c = i2c; |
matsujirushi | 0:33c4a1de6547 | 8 | this->address = address; |
matsujirushi | 0:33c4a1de6547 | 9 | } |
matsujirushi | 0:33c4a1de6547 | 10 | |
matsujirushi | 0:33c4a1de6547 | 11 | uint16_t MjGP2Y0E03::getDistance() |
matsujirushi | 0:33c4a1de6547 | 12 | { |
matsujirushi | 0:33c4a1de6547 | 13 | char regAddress = 0x5e; |
matsujirushi | 0:33c4a1de6547 | 14 | i2c->write(address, ®Address, 1, true); |
matsujirushi | 0:33c4a1de6547 | 15 | |
matsujirushi | 0:33c4a1de6547 | 16 | char data[2]; |
matsujirushi | 0:33c4a1de6547 | 17 | i2c->read(address, data, sizeof (data)); |
matsujirushi | 0:33c4a1de6547 | 18 | |
matsujirushi | 0:33c4a1de6547 | 19 | return ((uint16_t)data[0] << 4) + (data[1] & 0x0f); |
matsujirushi | 0:33c4a1de6547 | 20 | } |
matsujirushi | 0:33c4a1de6547 | 21 | |
matsujirushi | 0:33c4a1de6547 | 22 | } // namespace matsujirushi |
matsujirushi | 0:33c4a1de6547 | 23 |