Lab4

Dependencies:   mbed HEPTA_EPS

main.cpp

Committer:
HeptaSatTraining2019
Date:
2019-08-29
Revision:
25:864883d3fe57
Parent:
24:ca9f33c96136

File content as of revision 25:864883d3fe57:

#include "mbed.h"
#include "HEPTA_EPS.h"

Serial pc(USBTX,USBRX);
HEPTA_EPS eps(p16,p26);
I2C i2c(p28, p27);

const int addr_accel_gyro = 0xD0;
char cmd[2];
short int xl,xh,yl,yh,zl,zh;
int main()
{
    i2c.frequency(100000);
    cmd[0]=0x6B;
    cmd[1]=0x00;
    i2c.write(addr_accel_gyro,cmd,2);
    cmd[0] = 0x37;
    cmd[1] = 0x02;
    i2c.write(addr_accel_gyro,cmd,2);
    i2c.stop();
    while(1) {
        i2c.start();
        i2c.write(addr_accel_gyro);
        i2c.write(0x3b);//read adress
        i2c.start();
        i2c.write(addr_accel_gyro|0x01);
        xh = i2c.read(0);
        i2c.stop();
        i2c.start();
        i2c.write(addr_accel_gyro);
        i2c.write(0x3c);
        i2c.start();
        i2c.write(addr_accel_gyro|0x01);
        xl = i2c.read(0);
        i2c.stop();
        double  acc_ax = short((xh<<8) | (xl));
        double AX = (acc_ax)*2/32768*9.81;
        pc.printf("AX = %f\r\n",AX);
        wait(0.5);
    }
}