kazushiro tanimoto
/
fifi
test
main.cpp@0:772c5a4f6be1, 2017-02-05 (annotated)
- Committer:
- zero515
- Date:
- Sun Feb 05 15:35:18 2017 +0000
- Revision:
- 0:772c5a4f6be1
send
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
zero515 | 0:772c5a4f6be1 | 1 | #include "mbed.h" |
zero515 | 0:772c5a4f6be1 | 2 | |
zero515 | 0:772c5a4f6be1 | 3 | I2C i2c(D4, D5); |
zero515 | 0:772c5a4f6be1 | 4 | Serial pc(USBTX, USBRX); |
zero515 | 0:772c5a4f6be1 | 5 | |
zero515 | 0:772c5a4f6be1 | 6 | int getDis() |
zero515 | 0:772c5a4f6be1 | 7 | { |
zero515 | 0:772c5a4f6be1 | 8 | char data[2]; |
zero515 | 0:772c5a4f6be1 | 9 | |
zero515 | 0:772c5a4f6be1 | 10 | data[0] = 0x00; |
zero515 | 0:772c5a4f6be1 | 11 | data[1] = 0x51; |
zero515 | 0:772c5a4f6be1 | 12 | int ack = i2c.write(0xE0,data,2); |
zero515 | 0:772c5a4f6be1 | 13 | wait_ms(30); |
zero515 | 0:772c5a4f6be1 | 14 | |
zero515 | 0:772c5a4f6be1 | 15 | char reg = 0x02; |
zero515 | 0:772c5a4f6be1 | 16 | ack = i2c.write(0xE0,®,1); |
zero515 | 0:772c5a4f6be1 | 17 | ack = i2c.read(0xE1,data,2); |
zero515 | 0:772c5a4f6be1 | 18 | return (data[0] << 8) | data[1]; |
zero515 | 0:772c5a4f6be1 | 19 | } |
zero515 | 0:772c5a4f6be1 | 20 | |
zero515 | 0:772c5a4f6be1 | 21 | int main() { |
zero515 | 0:772c5a4f6be1 | 22 | pc.baud(115200); |
zero515 | 0:772c5a4f6be1 | 23 | pc.printf("st\r\n"); |
zero515 | 0:772c5a4f6be1 | 24 | i2c.frequency(400000); |
zero515 | 0:772c5a4f6be1 | 25 | |
zero515 | 0:772c5a4f6be1 | 26 | while(1) { |
zero515 | 0:772c5a4f6be1 | 27 | |
zero515 | 0:772c5a4f6be1 | 28 | int dist = getDis(); |
zero515 | 0:772c5a4f6be1 | 29 | pc.printf("%d\r\n",dist); |
zero515 | 0:772c5a4f6be1 | 30 | //wait_ms(50); |
zero515 | 0:772c5a4f6be1 | 31 | |
zero515 | 0:772c5a4f6be1 | 32 | } |
zero515 | 0:772c5a4f6be1 | 33 | } |