Lab4

Dependencies:   mbed HEPTA_EPS

main.cpp

Committer:
HeptaSatTraining2019
Date:
2019-08-27
Revision:
25:2c0dd68faae0
Parent:
24:cfcbac775459
Child:
26:8ef365eb183e

File content as of revision 25:2c0dd68faae0:

#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 gxl,gxh,gyl,gyh,gzl,gzh;
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(0x43);
        i2c.start();
        i2c.write(addr_accel_gyro|0x01);
        gxh = i2c.read(0);
        i2c.stop();
        i2c.start();
        i2c.write(addr_accel_gyro);
        i2c.write(0x44);
        i2c.start();
        i2c.write(addr_accel_gyro|0x01);
        gxl = i2c.read(0);
        i2c.stop();
        double  gyro_ax = short((gxh<<8) | (gxl));
        double GX = (gyro_ax)*0.00763;
        pc.printf("GX = %f\r\n",GX);
        wait(0.5);
    }
}