MPUとHMCでうごくかもver
Dependencies: ConfigFile SDFileSystem mbed
Fork of LAURUS_program by
Revision 16:174daf81eea0, committed 2015-06-21
- Comitter:
- onaka
- Date:
- Sun Jun 21 15:45:38 2015 +0000
- Parent:
- 15:d14d385d37e2
- Child:
- 18:9dd72e417c60
- Commit message:
- bug fix
Changed in this revision
--- a/GMS6_CR6/GMS6_CR6.cpp Sat Jun 20 16:39:11 2015 +0000 +++ b/GMS6_CR6/GMS6_CR6.cpp Sun Jun 21 15:45:38 2015 +0000 @@ -33,17 +33,20 @@ } void GMS6_CR6::INT_Rx() { + char *sp; buff1[pointer] = p_port->getc(); if(buff1[pointer] != '\r') { - pointer = (pointer+1)%BuffSize; + if(pointer<(BuffSize-1)){ + pointer = pointer+1; + } } else { - if(strstr((const char*)buff1, "GPGGA") != NULL) { + if((sp=strstr(buff1, "$GPGGA")) != NULL) { buff1[pointer] = '\0'; INT_flag = 1; - strcpy(buff2, (const char*)buff1); + strcpy(buff2, sp); INT_flag = 0; - pointer = 0; } + pointer = 0; } } \ No newline at end of file
--- a/main.cpp Sat Jun 20 16:39:11 2015 +0000 +++ b/main.cpp Sun Jun 21 15:45:38 2015 +0000 @@ -50,8 +50,8 @@ ConfigFile cfg; // ConfigFile PwmOut servoL(PB_6), servoR(PC_7); // サーボ用PWM出力 AnalogIn optSensor(PC_0); // 照度センサ用アナログ入力 -AnalogIn servoVcc(PA_0); // バッテリー電圧監視用アナログ入力(サーボ用) -AnalogIn logicVcc(PA_1); // バッテリー電圧監視用アナログ入力(ロジック用) +AnalogIn servoVcc(PA_1); // バッテリー電圧監視用アナログ入力(サーボ用) +AnalogIn logicVcc(PA_0); // バッテリー電圧監視用アナログ入力(ロジック用) DigitalIn paraSensor(PB_0); // パラフォイルに繋がる(予定)の物理スイッチ Ticker INT_timer; // 割り込みタイマー Timer timer; // 時間計測用タイマー @@ -259,7 +259,7 @@ float lv = (float)logicVcc.read_u16() * ADC_LSB_TO_V * 2.0f; // ロジック電源電圧 // データをmicroSDに保存し、XBeeでPCへ送信する - sprintf(data, "%.3f,%.3f,%.3f, %.3f,%.3f,%.3f, %.3f,%.3f,%.3f, %.3f,%d\r\n", + sprintf(data, "%.3f,%.3f,%.3f, %.3f,%.5f,%.5f, %.3f,%.3f,%.3f, %.3f,%d\r\n", yaw, pitch, roll, press, gms.longitude, gms.latitude, sv, lv, vrt_acc,
--- a/mbed.bld Sat Jun 20 16:39:11 2015 +0000 +++ b/mbed.bld Sun Jun 21 15:45:38 2015 +0000 @@ -1,1 +1,1 @@ -http://mbed.org/users/mbed_official/code/mbed/builds/cbbeb26dbd92 \ No newline at end of file +http://mbed.org/users/mbed_official/code/mbed/builds/7cff1c4259d7 \ No newline at end of file