LAURUS
output only raw data (acceleration, anguler rate, geomagnetism, air pressure)
Dependencies: mbed SDFileSystem ConfigFile
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