Titech Cansat / Mbed 2 deprecated FM_ver4_for_test

change2shinsu

Dependencies:   mbed mbedTimer SDFileSystem MU2 GPS

main.cpp@3:4f1bac105598, 2019-08-05 (annotated)

Committer:
takepiyo
Date:
Mon Aug 05 07:44:41 2019 +0000
Revision:
3:4f1bac105598
Parent:
2:d6dc5c2224cc
Child:
4:0d087e3f731d
jazz;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Nerosho 0:d0f3991839ec 1 #include "mbed.h"
Nerosho 0:d0f3991839ec 2 #include "MU2.h"
Nerosho 0:d0f3991839ec 3 #include "SDFileSystem.h"
takepiyo 3:4f1bac105598 4 #include "inletclose.h"
Nerosho 2:d6dc5c2224cc 5 //#include "GPS.h"
Nerosho 1:a8772ca26d1b 6
takepiyo 3:4f1bac105598 7 MU2 MuPort(p27,p28);
takepiyo 3:4f1bac105598 8 SDFileSystem sd(p11, p12, p13, p14, "sd");
Nerosho 2:d6dc5c2224cc 9 //GPS gps(p13,p14);
takepiyo 3:4f1bac105598 10 Serial gps(p9,p10); //tx, rx
takepiyo 3:4f1bac105598 11
takepiyo 3:4f1bac105598 12 Inlet inlet(p26,p15,p16);//モーター出力,感圧センサー1入力,感圧センサー2入力
Nerosho 2:d6dc5c2224cc 13
Nerosho 0:d0f3991839ec 14
takepiyo 3:4f1bac105598 15 //DigitalIn flight(p21); //フライトピン
takepiyo 3:4f1bac105598 16 DigitalOut FIRE(p24); //溶断
Nerosho 1:a8772ca26d1b 17
Nerosho 1:a8772ca26d1b 18 DigitalOut myled(LED1);
Nerosho 1:a8772ca26d1b 19 DigitalOut myled3(LED3);
Nerosho 1:a8772ca26d1b 20 DigitalOut myled4(LED4);
Nerosho 0:d0f3991839ec 21
Nerosho 0:d0f3991839ec 22 int main()
Nerosho 0:d0f3991839ec 23 {
Nerosho 2:d6dc5c2224cc 24
Nerosho 1:a8772ca26d1b 25 wait(3);
Nerosho 0:d0f3991839ec 26
Nerosho 2:d6dc5c2224cc 27 //FILE* fp1= fopen("/sd/cansat/log3.txt", "w");
takepiyo 3:4f1bac105598 28 FILE* fp2= fopen("/sd/cansat/gpsdata11.csv", "w");
takepiyo 3:4f1bac105598 29
Nerosho 2:d6dc5c2224cc 30 /*if(fp1 == NULL || fp2 == NULL)
takepiyo 3:4f1bac105598 31 {
Nerosho 2:d6dc5c2224cc 32 (fp1 == NULL) ? fprintf(stderr, "fname1 open error.\n") : fclose(fp1);
Nerosho 2:d6dc5c2224cc 33 (fp2 == NULL) ? fprintf(stderr, "fname2 open error.\n") : fclose(fp2);
Nerosho 2:d6dc5c2224cc 34 return -1;
takepiyo 3:4f1bac105598 35 }*/
Nerosho 2:d6dc5c2224cc 36
takepiyo 3:4f1bac105598 37 //溶断機構部分
Nerosho 2:d6dc5c2224cc 38
Nerosho 2:d6dc5c2224cc 39 //fprintf(fp1, "CanSat start!\r\n");
Nerosho 0:d0f3991839ec 40
takepiyo 3:4f1bac105598 41 //fprintf(fp1, "Fire!!\r\n");
takepiyo 3:4f1bac105598 42 //FIRE=1;
takepiyo 3:4f1bac105598 43 myled=1;//テストようにLED光らせてる
takepiyo 3:4f1bac105598 44 wait(5);//溶断にかかる時間TBD秒
takepiyo 3:4f1bac105598 45 //FIRE=0;
takepiyo 3:4f1bac105598 46 myled=0;
takepiyo 3:4f1bac105598 47
takepiyo 3:4f1bac105598 48 //溶断機構終わり
Nerosho 0:d0f3991839ec 49
Nerosho 2:d6dc5c2224cc 50 gps.baud(9600);
Nerosho 2:d6dc5c2224cc 51 char recvGPS=0;
Nerosho 2:d6dc5c2224cc 52 char getGPS[128];
Nerosho 2:d6dc5c2224cc 53 int i=0;
takepiyo 3:4f1bac105598 54 int timer=0;
takepiyo 3:4f1bac105598 55 int count=0;
takepiyo 3:4f1bac105598 56
Nerosho 2:d6dc5c2224cc 57 //fprintf(fp1, "GPS start!\r\n");
Nerosho 2:d6dc5c2224cc 58
takepiyo 3:4f1bac105598 59 while(1)
takepiyo 3:4f1bac105598 60 {
takepiyo 3:4f1bac105598 61 if(gps.readable())
takepiyo 3:4f1bac105598 62 {
Nerosho 2:d6dc5c2224cc 63 recvGPS=gps.getc();
Nerosho 2:d6dc5c2224cc 64 getGPS[i]=recvGPS;
Nerosho 2:d6dc5c2224cc 65
takepiyo 3:4f1bac105598 66 if(getGPS[i]=='\n')
takepiyo 3:4f1bac105598 67 {
Nerosho 2:d6dc5c2224cc 68
takepiyo 3:4f1bac105598 69 if((getGPS[5]=='G')&&(getGPS[6]=='A'))
takepiyo 3:4f1bac105598 70 {
takepiyo 3:4f1bac105598 71 if(count==10)
takepiyo 3:4f1bac105598 72 {
takepiyo 3:4f1bac105598 73 MuPort.send(getGPS);
takepiyo 3:4f1bac105598 74
Nerosho 2:d6dc5c2224cc 75 /*if(fp == NULL) {
Nerosho 2:d6dc5c2224cc 76 error("Could not open file for write\n");
Nerosho 2:d6dc5c2224cc 77 }*/
takepiyo 3:4f1bac105598 78
Nerosho 2:d6dc5c2224cc 79 fprintf(fp2, "%s\n",getGPS);
Nerosho 2:d6dc5c2224cc 80 //fclose(fp);
takepiyo 3:4f1bac105598 81
takepiyo 3:4f1bac105598 82 count=0;
takepiyo 3:4f1bac105598 83 }
takepiyo 3:4f1bac105598 84 wait(0.1);
Nerosho 2:d6dc5c2224cc 85 }
Nerosho 2:d6dc5c2224cc 86
Nerosho 2:d6dc5c2224cc 87 i=0;
Nerosho 2:d6dc5c2224cc 88 }
Nerosho 2:d6dc5c2224cc 89 i++;
takepiyo 3:4f1bac105598 90 timer++;
takepiyo 3:4f1bac105598 91 if(timer>150)//落下開始してからTBD秒後whileを抜ける．
takepiyo 3:4f1bac105598 92 {
takepiyo 3:4f1bac105598 93 break;
takepiyo 3:4f1bac105598 94 }
takepiyo 3:4f1bac105598 95 count++;
Nerosho 2:d6dc5c2224cc 96 }
Nerosho 2:d6dc5c2224cc 97
Nerosho 2:d6dc5c2224cc 98 // wait(1);
Nerosho 2:d6dc5c2224cc 99 //fclose(fp);
Nerosho 0:d0f3991839ec 100 }
takepiyo 3:4f1bac105598 101
takepiyo 3:4f1bac105598 102 while(1)
takepiyo 3:4f1bac105598 103 {
takepiyo 3:4f1bac105598 104 if(gps.readable())
takepiyo 3:4f1bac105598 105 {
takepiyo 3:4f1bac105598 106 recvGPS=gps.getc();
takepiyo 3:4f1bac105598 107 getGPS[i]=recvGPS;
takepiyo 3:4f1bac105598 108
takepiyo 3:4f1bac105598 109 if(getGPS[i]=='\n')
takepiyo 3:4f1bac105598 110 {
takepiyo 3:4f1bac105598 111
takepiyo 3:4f1bac105598 112 if((getGPS[5]=='G')&&(getGPS[6]=='A'))
takepiyo 3:4f1bac105598 113 {
takepiyo 3:4f1bac105598 114 if(count==10)
takepiyo 3:4f1bac105598 115 {
takepiyo 3:4f1bac105598 116 MuPort.send(getGPS);
takepiyo 3:4f1bac105598 117
takepiyo 3:4f1bac105598 118 /*if(fp == NULL) {
takepiyo 3:4f1bac105598 119 error("Could not open file for write\n");
takepiyo 3:4f1bac105598 120 }*/
takepiyo 3:4f1bac105598 121
takepiyo 3:4f1bac105598 122 fprintf(fp2, "%s\n",getGPS);
takepiyo 3:4f1bac105598 123 //fclose(fp);
takepiyo 3:4f1bac105598 124 count=0;
takepiyo 3:4f1bac105598 125 }
takepiyo 3:4f1bac105598 126 wait(0.1);
takepiyo 3:4f1bac105598 127 }
takepiyo 3:4f1bac105598 128
takepiyo 3:4f1bac105598 129 i=0;
takepiyo 3:4f1bac105598 130 }
takepiyo 3:4f1bac105598 131 i++;
takepiyo 3:4f1bac105598 132 inlet.Close(0.9);
takepiyo 3:4f1bac105598 133 count++;
takepiyo 3:4f1bac105598 134 }
takepiyo 3:4f1bac105598 135
takepiyo 3:4f1bac105598 136 // wait(1);
takepiyo 3:4f1bac105598 137 //fclose(fp);
takepiyo 3:4f1bac105598 138 }
takepiyo 3:4f1bac105598 139
takepiyo 3:4f1bac105598 140
Nerosho 2:d6dc5c2224cc 141 //fclose(fp1);
Nerosho 2:d6dc5c2224cc 142 fclose(fp2);
Nerosho 2:d6dc5c2224cc 143
Nerosho 2:d6dc5c2224cc 144 }
Nerosho 2:d6dc5c2224cc 145
Nerosho 2:d6dc5c2224cc 146
Nerosho 2:d6dc5c2224cc 147