HEPTA-Sat Training 2017~2018
/
Lab4-02_Detect_acceleration_x-axis
Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependencies: mbed HeptaBattery
Fork of
Lab7-01_template
by 
HEPTA-Sat Training 2017~2018
Diff: main.cpp
- Revision:
- 14:1becf2edba9c
- Parent:
- 13:a1fa75a002f6
- Child:
- 15:c9e7bc2c90b9
--- a/main.cpp Wed Sep 06 02:59:57 2017 +0000
+++ b/main.cpp Thu Sep 07 13:31:00 2017 +0000
@@ -1,25 +1,36 @@
#include "mbed.h"
-#include "SDFileSystem.h"
-#include "HeptaXbee.h"
-#include "HeptaCamera_GPS.h"
-#include "Hepta9axis.h"
-#include "HeptaTemp.h"
-#include "HeptaBattery.h"
-
-Serial pc(USBTX,USBRX);
-SDFileSystem sd(p5, p6, p7, p8, "sd");
-HeptaXbee xbee(p9,p10);
-HeptaCamera_GPS cam_gps(p13, p14,p25,p24);
-Hepta9axis n_axis(p28,p27,0xD0,0x18);
-HeptaTemp temp(p17);
-HeptaBattery battery(p16,p26);
-
-DigitalOut myled(LED1);
-
-int main()
-{
- myled = 1;
- wait(0.5);
- myled = 0;
- wait(0.5);
+I2C i2c(p28, p27);
+Serial pc(USBTX, USBRX);
+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/32764*9.81;
+ pc.printf("AX = %f\r\n",AX);
+ wait(0.5);
+ }
}
\ No newline at end of file