diff --git a/src/logs.cpp b/src/logs.cpp index 3d176a914..320867085 100644 --- a/src/logs.cpp +++ b/src/logs.cpp @@ -42,11 +42,13 @@ const pm_char * g_logError = NULL; uint8_t logDelay; #if defined(PCBTARANIS) -int mswitchState(bool sw1, bool sw2) { - return (sw1 ? -1 : (sw2 ? 1 : 0)); -} + #define get2PosState(sw) (switchState(SW_ ## sw ## 0) ? -1 : 1) +#else + #define get2PosState(sw) (switchState(SW_ ## sw) ? -1 : 1) #endif +#define get3PosState(sw) (switchState(SW_ ## sw ## 0) ? -1 : (switchState(SW_ ## sw ## 2) ? 1 : 0)) + const pm_char * openLogs() { // Determine and set log file filename @@ -103,6 +105,8 @@ const pm_char * openLogs() if (f_size(&g_oLogFile) == 0) { #if defined(RTCLOCK) f_puts("Date,Time,", &g_oLogFile); +#else + f_puts("Time,", &g_oLogFile); #endif #if defined(FRSKY_SPORT) @@ -169,7 +173,9 @@ void writeLogs() #if defined(RTCLOCK) struct gtm utm; gettime(&utm); - f_printf(&g_oLogFile, "%4d-%02d-%02d,%02d:%02d:%02d,", utm.tm_year+1900, utm.tm_mon+1, utm.tm_mday, utm.tm_hour, utm.tm_min, utm.tm_sec); + f_printf(&g_oLogFile, "%4d-%02d-%02d,%02d:%02d:%02d.02d,", utm.tm_year+1900, utm.tm_mon+1, utm.tm_mday, utm.tm_hour, utm.tm_min, utm.tm_sec, g_ms100); +#else + f_printf(&g_oLogFile, "%d,", tmr10ms); #endif #if defined(FRSKY_SPORT) @@ -187,21 +193,35 @@ void writeLogs() #if defined(FRSKY_HUB) if (IS_USR_PROTO_FRSKY_HUB()) { - f_printf(&g_oLogFile, "%4d-%02d-%02d,", frskyData.hub.year+2000, frskyData.hub.month, frskyData.hub.day); - f_printf(&g_oLogFile, "%02d:%02d:%02d,", frskyData.hub.hour, frskyData.hub.min, frskyData.hub.sec); - f_printf(&g_oLogFile, "%03d.%04d%c,", frskyData.hub.gpsLongitude_bp, frskyData.hub.gpsLongitude_ap, - frskyData.hub.gpsLongitudeEW ? frskyData.hub.gpsLongitudeEW : '-'); - f_printf(&g_oLogFile, "%03d.%04d%c,", frskyData.hub.gpsLatitude_bp, frskyData.hub.gpsLatitude_ap, - frskyData.hub.gpsLatitudeNS ? frskyData.hub.gpsLatitudeNS : '-'); - f_printf(&g_oLogFile, "%03d.%d,", frskyData.hub.gpsCourse_bp, frskyData.hub.gpsCourse_ap); - f_printf(&g_oLogFile, "%d.%d,", TELEMETRY_GPS_SPEED_BP, TELEMETRY_GPS_SPEED_AP); - f_printf(&g_oLogFile, "%03d.%d,", TELEMETRY_GPS_ALT_BP, TELEMETRY_GPS_ALT_AP); - f_printf(&g_oLogFile, "%d.%d,", TELEMETRY_ALT_BP, TELEMETRY_ALT_AP); - f_printf(&g_oLogFile, "%d,%d,", frskyData.hub.temperature1, frskyData.hub.temperature2); - f_printf(&g_oLogFile, "%d,", frskyData.hub.rpm); - f_printf(&g_oLogFile, "%d,", frskyData.hub.fuelLevel); - f_printf(&g_oLogFile, "%d,", frskyData.hub.volts); - f_printf(&g_oLogFile, "%d,%d,%d,", frskyData.hub.accelX, frskyData.hub.accelY, frskyData.hub.accelZ); + f_printf(&g_oLogFile, "%4d-%02d-%02d,%02d:%02d:%02d,%03d.%04d%c,%03d.%04d%c,%03d.%d,%d.%d,%03d.%d,%d.%d,%d,%d,%d,%d,%d,%d,%d,%d,", + frskyData.hub.year+2000, + frskyData.hub.month, + frskyData.hub.day, + frskyData.hub.hour, + frskyData.hub.min, + frskyData.hub.sec, + frskyData.hub.gpsLongitude_bp, + frskyData.hub.gpsLongitude_ap, + frskyData.hub.gpsLongitudeEW ? frskyData.hub.gpsLongitudeEW : '-', + frskyData.hub.gpsLatitude_bp, + frskyData.hub.gpsLatitude_ap, + frskyData.hub.gpsLatitudeNS ? frskyData.hub.gpsLatitudeNS : '-', + frskyData.hub.gpsCourse_bp, + frskyData.hub.gpsCourse_ap, + TELEMETRY_GPS_SPEED_BP, + TELEMETRY_GPS_SPEED_AP, + TELEMETRY_GPS_ALT_BP, + TELEMETRY_GPS_ALT_AP, + TELEMETRY_ALT_BP, + TELEMETRY_ALT_AP, + frskyData.hub.temperature1, + frskyData.hub.temperature2, + frskyData.hub.rpm, + frskyData.hub.fuelLevel, + frskyData.hub.volts, + frskyData.hub.accelX, + frskyData.hub.accelY, + frskyData.hub.accelZ); } #endif @@ -211,33 +231,35 @@ void writeLogs() } #endif + for (uint8_t i=0; i