Airio-Base test program. Grove 6-Axis v1.0 data write to FlashAir(SD card).
Dependencies: LSM6DS3 SDFileSystem mbed
Fork of Airio-Base_Grove_6Axis by
Diff: main.cpp
- Revision:
- 0:e71e12e06e4b
diff -r 000000000000 -r e71e12e06e4b main.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Tue Aug 07 20:30:05 2018 +0000 @@ -0,0 +1,70 @@ +#include "mbed.h" +#include "SDFileSystem.h" +#include "LSM6DS3.h" + +//------------------------------------------------------------------------------- +//Port Settings +DigitalOut led1(LED1); +DigitalOut led2(P1_13,0); +//DigitalOut USB_CONNECT(P0_6,0); +DigitalIn sw(P1_20); +DigitalIn isp(P0_1); +DigitalOut sd_en(P1_16, 1); +//DigitalIn sd_dat3(P0_17); // 0x10 +//DigitalIn sd_dat2(P1_22); // 0x08 +//DigitalIn sd_dat1(P1_14); // 0x04 +//DigitalIn sd_dat0(P0_22); // 0x02 +//DigitalIn sd_cmd(P0_21); // 0x01 + +//------------------------------------------------------------------------------- +// +SDFileSystem fs(P0_21, P0_22, P1_15, P0_17, "sd"); // mosi(CMD), miso(DAT0), sclk(CLK), cs(DAT3) +LSM6DS3 lsm(P0_5, P0_4, LSM6DS3_AG_I2C_ADDR(0) ); + + +//------------------------------------------------------------------------------- +// +int main() +{ + while(1) + { + led1 = 1; + wait(0.2); + led1 = 0; + wait(0.2); + + if(sw == 0) + { + led2 = 0; + } + else + { + led2 = 1; + } + + if(isp == 0) + { + FILE *fp = fopen("/sd/TEST.txt", "w"); + if(fp != NULL) + { + lsm.begin(); + for(int i = 0;i < 5;i++) + { + led2 = 0; + wait(0.1); + lsm.readGyro(); + fprintf(fp,"gx:%f gy:%f gz:%f\r\n",lsm.gx ,lsm.gy ,lsm.gz); + lsm.readAccel(); + fprintf(fp,"ax:%f ay:%f az:%f\r\n",lsm.ax ,lsm.ay ,lsm.az); + lsm.readTemp(); + fprintf(fp,"temp:%f\r\n",lsm.temperature_c ); + led2 = 1; + wait(0.3); + } + fprintf(fp,"\r\n"); + fclose(fp); + free(fp); + } + } + } +}