kopia lustrzana https://github.com/DL7AD/pecanpico9
107 wiersze
4.2 KiB
C
107 wiersze
4.2 KiB
C
|
#ifndef __TRACE_H__
|
||
|
|
#define __TRACE_H__
|
||
|
|
|
||
|
|
#include "ch.h"
|
||
|
|
#include "hal.h"
|
||
|
|
#include "chprintf.h"
|
||
|
|
#include "ptime.h"
|
||
|
|
#include "config.h"
|
||
|
|
#include "error.h"
|
||
|
|
#include <string.h>
|
||
|
|
|
||
|
|
#define __FILENAME__ (strrchr(__FILE__, '/') ? strrchr(__FILE__, '/') + 1 : __FILE__)
|
||
|
|
|
||
|
|
extern mutex_t trace_mtx;
|
||
|
|
extern const SerialConfig uart_config;
|
||
|
|
|
||
|
|
// Initializer for serial debug and LEDs
|
||
|
|
#define DEBUG_INIT() { \
|
||
|
|
palSetPadMode(PORT(IO_LED4), PIN(IO_LED4), PAL_MODE_OUTPUT_PUSHPULL); \
|
||
|
|
palSetPadMode(PORT(IO_LED3), PIN(IO_LED3), PAL_MODE_OUTPUT_PUSHPULL); \
|
||
|
|
palSetPadMode(PORT(IO_LED2), PIN(IO_LED2), PAL_MODE_OUTPUT_PUSHPULL); \
|
||
|
|
palSetPadMode(PORT(IO_LED1), PIN(IO_LED1), PAL_MODE_OUTPUT_PUSHPULL); \
|
||
|
|
\
|
||
|
|
sdStart(&SD3, &uart_config); \
|
||
|
|
palSetPadMode(PORT(IO_TXD), PIN(IO_TXD), PAL_MODE_ALTERNATE(7)); \
|
||
|
|
/*palSetPadMode(PORT(IO_RXD), PIN(IO_RXD), PAL_MODE_ALTERNATE(7));*/ \
|
||
|
|
chMtxObjectInit(&trace_mtx); \
|
||
|
|
chMtxLock(&trace_mtx); \
|
||
|
|
chprintf((BaseSequentialStream*)&SD3, "\r\n"); \
|
||
|
|
chMtxUnlock(&trace_mtx); \
|
||
|
|
}
|
||
|
|
|
||
|
|
#define TRACE_BASE(format, type, args...) { \
|
||
|
|
chMtxLock(&trace_mtx); \
|
||
|
|
if(TRACE_TIME) \
|
||
|
|
chprintf((BaseSequentialStream*)&SD3, "[%8d.%03d]", chVTGetSystemTimeX()/CH_CFG_ST_FREQUENCY, (chVTGetSystemTimeX()*1000/CH_CFG_ST_FREQUENCY)%1000); \
|
||
|
|
chprintf((BaseSequentialStream*)&SD3, "[%s]", type); \
|
||
|
|
if(TRACE_FILE) \
|
||
|
|
chprintf((BaseSequentialStream*)&SD3, "[%10s %04d]", __FILENAME__, __LINE__); \
|
||
|
|
chprintf((BaseSequentialStream*)&SD3, " "); \
|
||
|
|
chprintf((BaseSequentialStream*)&SD3, (format), ##args); \
|
||
|
|
chprintf((BaseSequentialStream*)&SD3, "\r\n"); \
|
||
|
|
chMtxUnlock(&trace_mtx); \
|
||
|
|
}
|
||
|
|
|
||
|
|
#define TRACE_DEBUG(format, args...) TRACE_BASE(format, "DEBUG", ##args)
|
||
|
|
#define TRACE_INFO(format, args...) TRACE_BASE(format, " ", ##args)
|
||
|
|
#define TRACE_WARN(format, args...) TRACE_BASE(format, "WARN ", ##args)
|
||
|
|
#define TRACE_ERROR(format, args...) { \
|
||
|
|
TRACE_BASE(format, "ERROR", ##args); \
|
||
|
|
log_error(__FILENAME__, __LINE__); \
|
||
|
|
}
|
||
|
|
|
||
|
|
#if TRACE_TIME && TRACE_FILE
|
||
|
|
#define TRACE_TAB " "
|
||
|
|
#elif TRACE_TIME && !TRACE_FILE
|
||
|
|
#define TRACE_TAB " "
|
||
|
|
#elif !TRACE_TIME && TRACE_FILE
|
||
|
|
#define TRACE_TAB " "
|
||
|
|
#else
|
||
|
|
#define TRACE_TAB " "
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#define TRACE_GPSFIX(fix) { \
|
||
|
|
TRACE_INFO("GPS > New GPS Fix\r\n"\
|
||
|
|
"%s GPS Time: %04d-%02d-%02d %02d:%02d:%02d\r\n" \
|
||
|
|
"%s Sats: %d (used for solution)\r\n" \
|
||
|
|
"%s Latitude: %d.%07ddeg\r\n" \
|
||
|
|
"%s Longitude: %d.%07ddeg\r\n" \
|
||
|
|
"%s Altitude: %d Meter", \
|
||
|
|
TRACE_TAB, (fix)->time.year, (fix)->time.month, (fix)->time.day, (fix)->time.hour, (fix)->time.minute, (fix)->time.second, \
|
||
|
|
TRACE_TAB, (fix)->num_svs, \
|
||
|
|
TRACE_TAB, (fix)->lat/10000000, ((fix)->lat > 0 ? 1:-1)*(fix)->lat%10000000, \
|
||
|
|
TRACE_TAB, (fix)->lon/10000000, ((fix)->lon > 0 ? 1:-1)*(fix)->lon%10000000, \
|
||
|
|
TRACE_TAB, (fix)->alt \
|
||
|
|
); \
|
||
|
|
}
|
||
|
|
|
||
|
|
#define TRACE_BIN(data, len) { \
|
||
|
|
chMtxLock(&trace_mtx); \
|
||
|
|
chprintf((BaseSequentialStream*)&SD3, "[%8d.%03d][DEBUG] ", chVTGetSystemTimeX()/CH_CFG_ST_FREQUENCY, (chVTGetSystemTimeX()*1000/CH_CFG_ST_FREQUENCY)%1000); \
|
||
|
|
chprintf((BaseSequentialStream*)&SD3, " > Binary data (%d bits)\r\n", (len)); \
|
||
|
|
for(uint32_t i=0; i<((len)+7)/8; i+=8) \
|
||
|
|
chprintf((BaseSequentialStream*)&SD3, "%s 0x%03x ... 0x%02x 0x%02x 0x%02x 0x%02x 0x%02x 0x%02x 0x%02x 0x%02x\r\n", \
|
||
|
|
TRACE_TAB, i, (data)[i], (data)[i+1], (data)[i+2], (data)[i+3], (data)[i+4], (data)[i+5], (data)[i+6], (data)[i+7]); \
|
||
|
|
chMtxUnlock(&trace_mtx); \
|
||
|
|
}
|
||
|
|
|
||
|
|
#define TRACE_BIN_CHAR(data, len) { \
|
||
|
|
chMtxLock(&trace_mtx); \
|
||
|
|
chprintf((BaseSequentialStream*)&SD3, "[%8d.%03d][DEBUG] ", chVTGetSystemTimeX()/CH_CFG_ST_FREQUENCY, (chVTGetSystemTimeX()*1000/CH_CFG_ST_FREQUENCY)%1000); \
|
||
|
|
chprintf((BaseSequentialStream*)&SD3, " > Binary data (%d bits)\r\n", (len)); \
|
||
|
|
for(uint32_t i=0; i<((len)+7)/8; i+=8) \
|
||
|
|
chprintf((BaseSequentialStream*)&SD3, "%s %c%c%c%c%c%c%c%c\r\n", \
|
||
|
|
TRACE_TAB, i, (data)[i], (data)[i+1], (data)[i+2], (data)[i+3], (data)[i+4], (data)[i+5], (data)[i+6], (data)[i+7]); \
|
||
|
|
chMtxUnlock(&trace_mtx); \
|
||
|
|
}
|
||
|
|
|
||
|
|
#define PRINT_TIME(thd) { \
|
||
|
|
ptime_t dbgtime; \
|
||
|
|
getTime(&dbgtime); \
|
||
|
|
TRACE_INFO("%-4s > Current time: %02d-%02d-%02d %02d:%02d:%02d:%03d", thd, dbgtime.year, dbgtime.month, dbgtime.day, dbgtime.hour, dbgtime.minute, dbgtime.second, dbgtime.millisecond); \
|
||
|
|
}
|
||
|
|
|
||
|
|
#endif
|
||
|
|
|