Diff: main.cpp

Branch:

Thread????

Revision:

21:8802034b7810

Parent:

18:fa3f9ba17af8

Child:

22:5cbebf097600

--- a/main.cpp	Sat Dec 17 09:12:39 2016 +0000
+++ b/main.cpp	Fri Jan 06 11:41:32 2017 +0000
@@ -19,11 +19,11 @@
 #define SD_WRITE_NUM 10
 #define INIT_SERVO_PERIOD_MS 20
 
-//Cadence cadence(p13,p14);
+Cadence cadence(p13,p14);
 //Ticker cadenceTicker;
 
-Serial pc(USBTX,USBRX);
-Serial Android(p13,p14);
+RawSerial pc(USBTX,USBRX);
+RawSerial Android(p13,p14);
 BufferedSoftSerial twe(p9,p10);
 BufferedSoftSerial soudaSerial(p17,p18);
 //Ticker writeDatasTicker;
@@ -64,6 +64,7 @@
 void init();
 void FusokukeiInit();
 void SdInit();
+void SDprintf(void const *argument);
 void DataReceiveFromSouda();
 void WriteDatas();
 float calcAttackAngle();
@@ -122,18 +123,21 @@
     }
 }
 
-void SDprintf(){
-    fp = fopen("/sd/mydir/sdtest.csv", "a");
-    if(fp == NULL) {
-        error("Could not open file for write\n");
+void SDprintf(void const *argument){
+    if(write_datas_index == SD_WRITE_NUM-1){
+        fp = fopen("/sd/mydir/sdtest.csv", "a");
+        if(fp == NULL) {
+            error("Could not open file for write\n");
+        }
+        for(int i = 0; i < SD_WRITE_NUM; i++){
+            for(int j = 0; j < WRITE_DATAS_NUM; j++){
+                fprintf(fp,"%f,", writeDatas[i][j]);
+            }
+        }
+        fprintf(fp,"\n\r");
+        fclose(fp);
+        write_datas_index=0;
     }
-    for(int i = 0; i < SD_WRITE_NUM; i++){
-        for(int j = 0; j < WRITE_DATAS_NUM; j++){
-            fprintf(fp,"%f,", writeDatas[i][j]);
-        }
-    }
-    fprintf(fp,"\n\r");
-    fclose(fp);
 }
 
 void WriteDatas(){
@@ -158,7 +162,7 @@
 //    pc.printf("\n\r");
 //    twe.printf("\n\r");
     if(write_datas_index == SD_WRITE_NUM-1){
-        SDprintf();
+//        SDprintf();
         write_datas_index=0;
     }
     else{