Success!

Dependencies:   mbed

Committer:
Soyoon
Date:
Tue Jul 19 15:47:17 2016 +0000
Revision:
0:9f0027e4c618
Robo Frien

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Soyoon 0:9f0027e4c618 1 #include "mbed.h"
Soyoon 0:9f0027e4c618 2 #include "LocalFileSystem.h"
Soyoon 0:9f0027e4c618 3 #include "Barometer.h"
Soyoon 0:9f0027e4c618 4 #include "math.h"
Soyoon 0:9f0027e4c618 5
Soyoon 0:9f0027e4c618 6 Serial pc(USBTX, USBRX);
Soyoon 0:9f0027e4c618 7 Barometer barometer(p9, p10);
Soyoon 0:9f0027e4c618 8 Serial AHRS(p13, p14);
Soyoon 0:9f0027e4c618 9
Soyoon 0:9f0027e4c618 10 LocalFileSystem local("local");
Soyoon 0:9f0027e4c618 11 int i=0;
Soyoon 0:9f0027e4c618 12 float p = 0.0f, t = 0.0f, alt = 0.0f;
Soyoon 0:9f0027e4c618 13 float roll,pitch,yaw,accx,accy,accz;
Soyoon 0:9f0027e4c618 14
Soyoon 0:9f0027e4c618 15 int file_no=0;
Soyoon 0:9f0027e4c618 16 char filename[256];
Soyoon 0:9f0027e4c618 17
Soyoon 0:9f0027e4c618 18 int main() {
Soyoon 0:9f0027e4c618 19 AHRS.baud(9600);
Soyoon 0:9f0027e4c618 20 sprintf(filename, "/local/out%d.txt", file_no); // Open "tem%d.txt" on the local file system for writing
Soyoon 0:9f0027e4c618 21 FILE *fp;
Soyoon 0:9f0027e4c618 22 fp = fopen(filename, "r");
Soyoon 0:9f0027e4c618 23 while(fp){ ////File!!!
Soyoon 0:9f0027e4c618 24 fclose(fp);
Soyoon 0:9f0027e4c618 25 file_no ++;
Soyoon 0:9f0027e4c618 26 sprintf(filename, "/local/out%d.txt", file_no); // Open "tem%d.txt" on the local file system for writing
Soyoon 0:9f0027e4c618 27 fp = fopen(filename, "r");
Soyoon 0:9f0027e4c618 28 pc.printf("File Yes !! \r\n");
Soyoon 0:9f0027e4c618 29 }
Soyoon 0:9f0027e4c618 30 fp = fopen(filename, "w");
Soyoon 0:9f0027e4c618 31 for(i=0;i<=50;i++) {
Soyoon 0:9f0027e4c618 32 while(AHRS.getc() != '\n')
Soyoon 0:9f0027e4c618 33 AHRS.scanf("*%f,%f,%f,%f,%f,%f\n", &roll, &pitch, &yaw, &accx,&accy,&accz);
Soyoon 0:9f0027e4c618 34 fprintf(fp, "roll:%f yaw:%f\r\n",roll, yaw);
Soyoon 0:9f0027e4c618 35 pc.printf("%.2f,%.2f,%.2f,%f,%f,%f \r\n", roll, pitch, yaw,accx,accy, accz);
Soyoon 0:9f0027e4c618 36 }
Soyoon 0:9f0027e4c618 37 fclose(fp);
Soyoon 0:9f0027e4c618 38 }