V1

main.cpp

Committer:
Tanakacool
Date:
2018-12-25
Revision:
0:63c69398407f

File content as of revision 0:63c69398407f:

#include "mbed.h"
I2C i2c(A1, A0);// sda, scl

const int addr8bit = 0x15 << 1;
//I2C i2c( D14, D15);
Serial pc(USBTX, USBRX);
DigitalOut led1(LED1);


int main()
{


    pc.baud(9600);
    i2c.frequency (10000);
    int address = 0x15 << 1;
    int encoder;
    char speed[10] = "2000";
    char buffer[3];
    char enc[6];
    printf("send\n");
    int motorOutPut=2000;
    motorOutPut=atoi(speed);

    buffer[0]=0x00;
    buffer[1]= motorOutPut>>8;
    buffer[2]=motorOutPut;
    i2c.write(address,buffer,3);
    i2c.stop();
    // i2c.read(address,enc,6);
    

    while (1) {
        //atoi
 /*       if (pc.readable()) {
            pc.gets(speed, sizeof(speed));
            pc.printf("out : %s",speed);

            motorOutPut=atoi(speed);

            buffer[0]=0x00;
            buffer[1]= motorOutPut>>8;
            buffer[2]=motorOutPut;
            i2c.write(address,buffer,3);
           // i2c.write(addr8bit,buffer,3);
            //i2c.stop();
            led1 = !led1;
       }*/
        
        i2c.read( addr8bit, enc, 6);
        encoder=(enc[0]<<24)|(enc[1]<<16)|(enc[2]<<8)|(enc[3]);
       // encoder=enc[0];
        printf("%d\n", encoder);
        
        led1 = !led1;
        
        wait(1);

    }
}