HEPTA-Sat Training 2019
/
Lab4-04_Detect_Angular_velocity_x-axis
Lab4
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); } }