test

Dependencies:   mbed

Committer:
zero515
Date:
Sun Feb 05 15:35:18 2017 +0000
Revision:
0:772c5a4f6be1
send

Who changed what in which revision?

UserRevisionLine numberNew 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,&reg,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 }