Airio-Base test program. Grove 6-Axis v1.0 data write to FlashAir(SD card).

Dependencies:   LSM6DS3 SDFileSystem mbed

Committer:
crane_elec
Date:
Tue Aug 07 21:47:55 2018 +0000
Revision:
0:e0d29f49be16
1st release.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
crane_elec 0:e0d29f49be16 1 #include "mbed.h"
crane_elec 0:e0d29f49be16 2 #include "SDFileSystem.h"
crane_elec 0:e0d29f49be16 3 #include "LSM6DS3.h"
crane_elec 0:e0d29f49be16 4
crane_elec 0:e0d29f49be16 5 //-------------------------------------------------------------------------------
crane_elec 0:e0d29f49be16 6 //Port Settings
crane_elec 0:e0d29f49be16 7 DigitalOut led1(LED1);
crane_elec 0:e0d29f49be16 8 DigitalOut led2(P1_13,0);
crane_elec 0:e0d29f49be16 9 //DigitalOut USB_CONNECT(P0_6,0);
crane_elec 0:e0d29f49be16 10 DigitalIn sw(P1_20);
crane_elec 0:e0d29f49be16 11 DigitalIn isp(P0_1);
crane_elec 0:e0d29f49be16 12 DigitalOut sd_en(P1_16, 1);
crane_elec 0:e0d29f49be16 13 //DigitalIn sd_dat3(P0_17); // 0x10
crane_elec 0:e0d29f49be16 14 //DigitalIn sd_dat2(P1_22); // 0x08
crane_elec 0:e0d29f49be16 15 //DigitalIn sd_dat1(P1_14); // 0x04
crane_elec 0:e0d29f49be16 16 //DigitalIn sd_dat0(P0_22); // 0x02
crane_elec 0:e0d29f49be16 17 //DigitalIn sd_cmd(P0_21); // 0x01
crane_elec 0:e0d29f49be16 18
crane_elec 0:e0d29f49be16 19 //-------------------------------------------------------------------------------
crane_elec 0:e0d29f49be16 20 //
crane_elec 0:e0d29f49be16 21 SDFileSystem fs(P0_21, P0_22, P1_15, P0_17, "sd"); // mosi(CMD), miso(DAT0), sclk(CLK), cs(DAT3)
crane_elec 0:e0d29f49be16 22 LSM6DS3 lsm(P0_5, P0_4, LSM6DS3_AG_I2C_ADDR(0) );
crane_elec 0:e0d29f49be16 23
crane_elec 0:e0d29f49be16 24
crane_elec 0:e0d29f49be16 25 //-------------------------------------------------------------------------------
crane_elec 0:e0d29f49be16 26 //
crane_elec 0:e0d29f49be16 27 int main()
crane_elec 0:e0d29f49be16 28 {
crane_elec 0:e0d29f49be16 29 while(1)
crane_elec 0:e0d29f49be16 30 {
crane_elec 0:e0d29f49be16 31 led1 = 1;
crane_elec 0:e0d29f49be16 32 wait(0.2);
crane_elec 0:e0d29f49be16 33 led1 = 0;
crane_elec 0:e0d29f49be16 34 wait(0.2);
crane_elec 0:e0d29f49be16 35
crane_elec 0:e0d29f49be16 36 if(sw == 0)
crane_elec 0:e0d29f49be16 37 {
crane_elec 0:e0d29f49be16 38 led2 = 0;
crane_elec 0:e0d29f49be16 39 }
crane_elec 0:e0d29f49be16 40 else
crane_elec 0:e0d29f49be16 41 {
crane_elec 0:e0d29f49be16 42 led2 = 1;
crane_elec 0:e0d29f49be16 43 }
crane_elec 0:e0d29f49be16 44
crane_elec 0:e0d29f49be16 45 if(isp == 0)
crane_elec 0:e0d29f49be16 46 {
crane_elec 0:e0d29f49be16 47 FILE *fp = fopen("/sd/TEST.txt", "w");
crane_elec 0:e0d29f49be16 48 if(fp != NULL)
crane_elec 0:e0d29f49be16 49 {
crane_elec 0:e0d29f49be16 50 lsm.begin();
crane_elec 0:e0d29f49be16 51 for(int i = 0;i < 5;i++)
crane_elec 0:e0d29f49be16 52 {
crane_elec 0:e0d29f49be16 53 led2 = 0;
crane_elec 0:e0d29f49be16 54 wait(0.1);
crane_elec 0:e0d29f49be16 55 lsm.readGyro();
crane_elec 0:e0d29f49be16 56 fprintf(fp,"gx:%f gy:%f gz:%f\r\n",lsm.gx ,lsm.gy ,lsm.gz);
crane_elec 0:e0d29f49be16 57 lsm.readAccel();
crane_elec 0:e0d29f49be16 58 fprintf(fp,"ax:%f ay:%f az:%f\r\n",lsm.ax ,lsm.ay ,lsm.az);
crane_elec 0:e0d29f49be16 59 lsm.readTemp();
crane_elec 0:e0d29f49be16 60 fprintf(fp,"temp:%f\r\n",lsm.temperature_c );
crane_elec 0:e0d29f49be16 61 led2 = 1;
crane_elec 0:e0d29f49be16 62 wait(0.3);
crane_elec 0:e0d29f49be16 63 }
crane_elec 0:e0d29f49be16 64 fprintf(fp,"\r\n");
crane_elec 0:e0d29f49be16 65 fclose(fp);
crane_elec 0:e0d29f49be16 66 free(fp);
crane_elec 0:e0d29f49be16 67 }
crane_elec 0:e0d29f49be16 68 }
crane_elec 0:e0d29f49be16 69 }
crane_elec 0:e0d29f49be16 70 }