/* * Copyright (C) OpenTX * * Based on code named * th9x - http://code.google.com/p/th9x * er9x - http://code.google.com/p/er9x * gruvin9x - http://code.google.com/p/gruvin9x * * License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. */ #include "opentx.h" #include "stamp.h" #include #if defined(SIMU) traceCallbackFunc traceCallback = 0; #endif #if defined(SIMU) #define PRINTF_BUFFER_SIZE 1024 void debugPrintf(const char * format, ...) { va_list arglist; char tmp[PRINTF_BUFFER_SIZE]; va_start(arglist, format); vsnprintf(tmp, PRINTF_BUFFER_SIZE, format, arglist); va_end(arglist); fputs(tmp, stdout); fflush(stdout); if (traceCallback) { traceCallback(tmp); } } #endif #if defined(DEBUG_TRACE_BUFFER) static struct TraceElement traceBuffer[TRACE_BUFFER_LEN]; static uint8_t traceBufferPos; extern Fifo serial2TxFifo; gtime_t filltm(gtime_t *t, struct gtm *tp); void trace_event(enum TraceEvent event, uint32_t data) { if (traceBufferPos >= TRACE_BUFFER_LEN) return; __disable_irq(); struct TraceElement * p = &traceBuffer[traceBufferPos++]; __enable_irq(); p->time = g_rtcTime; p->time_ms = g_ms100; p->event = event; p->data = data; } void trace_event_i(enum TraceEvent event, uint32_t data) { if (traceBufferPos >= TRACE_BUFFER_LEN) return; struct TraceElement * p = &traceBuffer[traceBufferPos++]; p->time = g_rtcTime; p->time_ms = g_ms100; p->event = event; p->data = data; } const struct TraceElement * getTraceElement(uint16_t idx) { if (idx < TRACE_BUFFER_LEN) return &traceBuffer[idx]; return 0; } void dumpTraceBuffer() { TRACE("Dump of Trace Buffer (" VERSION " " DATE " " TIME "):"); TRACE("# Time Event Data"); for(int n = 0; n < TRACE_BUFFER_LEN; ++n) { struct gtm tp; filltm(&traceBuffer[n].time, &tp); TRACE_INFO_WP("%02d ", n); TRACE_INFO_WP("%4d-%02d-%02d,%02d:%02d:%02d.%02d0", tp.tm_year+1900, tp.tm_mon+1, tp.tm_mday, tp.tm_hour, tp.tm_min, tp.tm_sec, traceBuffer[n].time_ms); TRACE(" %03d 0x%08x", traceBuffer[n].event, traceBuffer[n].data); if (traceBuffer[n].time == 0 && traceBuffer[n].time_ms == 0) break; #if !defined(SIMU) if ((n % 5) == 0) { while (!serial2TxFifo.isEmpty()) { CoTickDelay(1); } } #endif } TRACE("End of Trace Buffer dump"); } #endif #if defined(DEBUG_INTERRUPTS) #if defined(PCBHORUS) const char * interruptNames[INT_LAST] = { "Tick ", // INT_TICK, "1ms ", // INT_1MS, "Ser2 ", // INT_SER2, "TelDm", // INT_TELEM_DMA, "Sdio ", // INT_SDIO, "SdDma", // INT_SDIO_DMA, "D2S7 ", // INT_DMA2S7, "Tim1 ", // INT_TIM1CC, "Tim2 ", // INT_TIM2, "Tim3 ", // INT_TIM3, "Usb " // INT_OTG_FS, }; #elif defined(PCBTARANIS) const char * interruptNames[INT_LAST] = { "Tick ", // INT_TICK, "5ms ", // INT_5MS, "Audio", // INT_AUDIO, "BlueT", // INT_BLUETOOTH, "Lcd ", // INT_LCD, "T1CC ", // INT_TIM1CC, "Tim1 ", // INT_TIM1, "Tim8 ", // INT_TIM8, "Ser2 ", // INT_SER2, "TelDm", // INT_TELEM_DMA, "TelUs", // INT_TELEM_USART, "Train", // INT_TRAINER, "Usb ", // INT_OTG_FS, }; #endif struct InterruptCounters interruptCounters; #endif //#if defined(DEBUG_INTERRUPTS) #if defined(DEBUG_TASKS) uint32_t taskSwitchLog[DEBUG_TASKS_LOG_SIZE] __SDRAM; uint16_t taskSwitchLogPos; /** ******************************************************************************* * @brief Hook for task switch logging * @param[in] taskID Task which is now in RUNNING state * @retval None * * @par Description * @details This function logs the time when a task entered the RUNNING state. ******************************************************************************* */ void CoTaskSwitchHook(uint8_t taskID) { /* Log task switch here */ taskSwitchLog[taskSwitchLogPos] = (taskID << 24) + ((uint32_t)CoGetOSTime() & 0xFFFFFF); if(++taskSwitchLogPos >= DEBUG_TASKS_LOG_SIZE) { taskSwitchLogPos = 0; } } #endif // #if defined(DEBUG_TASKS) #if defined(DEBUG_TIMERS) void DebugTimer::start() { _start_hiprec = getTmr2MHz(); _start_loprec = get_tmr10ms(); } void DebugTimer::stop() { // getTmr2MHz is 16 bit timer, resolution 0.5us, max measurable value 32.7675 milli seconds // tmr10ms_t tmr10ms = get_tmr10ms(); 32 bit timer, resolution 10ms, max measurable value: 42949672.95 s = 1.3 years // if time difference is bigger than 30ms, then use low resolution timer // otherwise use high resolution if ((_start_hiprec == 0) && (_start_loprec == 0)) return; last = get_tmr10ms() - _start_loprec; //use low precision timer if (last < 3) { //use high precision last = (uint16_t)(getTmr2MHz() - _start_hiprec) / 2; } else { last *= 10000ul; //adjust unit to 1us } evalStats(); } DebugTimer debugTimers[DEBUG_TIMERS_COUNT]; const char * debugTimerNames[DEBUG_TIMERS_COUNT] = { "Pulses int." // debugTimerIntPulses, ,"Pulses dur." // debugTimerIntPulsesDuration, ,"10ms dur. " // debugTimerPer10ms, ,"Rotary enc." // debugTimerRotEnc, ,"Haptic " // debugTimerHaptic, ,"Mixer calc " // debugTimerMixer, ,"Tel. wakeup" // debugTimerTelemetryWakeup, ,"perMain dur" // debugTimerPerMain, ," perMain s1" // debugTimerPerMain1, ," guiMain " // debugTimerGuiMain, ," LUA bg " // debugTimerLuaBg, ," LCD wait " // debugTimerLcdRefreshWait, ," LUA fg " // debugTimerLuaFg, ," LCD refr." // debugTimerLcdRefresh, ," Menus " // debugTimerMenus, ," Menu hnd" // debugTimerMenuHandlers, ,"Menu Vers. " // debugTimerVersion, ,"Menu simple" // debugTimerSimpleMenu, ,"Menu drawte" // debugTimerDrawText, ,"Menu drawt1" // debugTimerDrawText1, ,"Mix ADC " // debugTimerGetAdc, ,"Mix getsw " // debugTimerGetSwitches, ,"Mix eval " // debugTimerEvalMixes, ,"Mix 10ms " // debugTimerMixes10ms, ,"ADC read " // debugTimerAdcRead, ,"ADC loop " // debugTimerAdcLoop, ,"ADC wait " // debugTimerAdcWait, ,"mix-pulses " // debugTimerMixerCalcToUsage ,"mix-int. " // debugTimerMixerIterval }; #endif