Soyoon Kim
/
mbed_Datalogger
Success!
main.cpp@0:9f0027e4c618, 2016-07-19 (annotated)
- Committer:
- Soyoon
- Date:
- Tue Jul 19 15:47:17 2016 +0000
- Revision:
- 0:9f0027e4c618
Robo Frien
Who changed what in which revision?
User | Revision | Line number | New 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 | } |