kazushiro tanimoto / Mbed 2 deprecated fifi

test

Dependencies:   mbed

main.cpp

Committer:
zero515
Date:
2017-02-05
Revision:
0:772c5a4f6be1

File content as of revision 0:772c5a4f6be1:

#include "mbed.h"

I2C i2c(D4, D5);
Serial pc(USBTX, USBRX);

int getDis()
{
    char data[2];
    
    data[0] = 0x00;
    data[1] = 0x51;
    int ack = i2c.write(0xE0,data,2);  
    wait_ms(30);
    
    char reg = 0x02;   
    ack = i2c.write(0xE0,&reg,1);  
    ack = i2c.read(0xE1,data,2); 
    return (data[0] << 8) | data[1];
}

int main() {
pc.baud(115200);
pc.printf("st\r\n");
i2c.frequency(400000);
 
   while(1) {

       int dist = getDis();
       pc.printf("%d\r\n",dist);
       //wait_ms(50);

   }
}