Add missing undefined symbols to be sure to use mine
Dependents: DS130x_I2CApp MCP41xxxApp FM24Vxx_I2CApp MCP320xApp ... more
Debug.cpp@5:7ddb6bca6d01, 2010-12-08 (annotated)
- Committer:
- Yann
- Date:
- Wed Dec 08 13:33:24 2010 +0000
- Revision:
- 5:7ddb6bca6d01
- Parent:
- 4:d03fcf494eb6
- Child:
- 6:14a596126adf
V0.0.0.6
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Yann | 0:311a0646b95a | 1 | #include <cstdarg> |
Yann | 0:311a0646b95a | 2 | #include "Debug.h" |
Yann | 0:311a0646b95a | 3 | |
Yann | 0:311a0646b95a | 4 | #ifdef __DEBUG |
Yann | 0:311a0646b95a | 5 | |
Yann | 5:7ddb6bca6d01 | 6 | #define __LINE_LENGTH__ 91 |
Yann | 5:7ddb6bca6d01 | 7 | |
Yann | 0:311a0646b95a | 8 | void DebugHelper::Debug(const char* p_format, ...) { |
Yann | 0:311a0646b95a | 9 | va_list argp; |
Yann | 0:311a0646b95a | 10 | |
Yann | 0:311a0646b95a | 11 | va_start(argp, p_format); |
Yann | 0:311a0646b95a | 12 | vprintf(p_format, argp); |
Yann | 0:311a0646b95a | 13 | va_end(argp); |
Yann | 4:d03fcf494eb6 | 14 | } // End of method DebugHelper::Debug |
Yann | 4:d03fcf494eb6 | 15 | |
Yann | 4:d03fcf494eb6 | 16 | void DebugHelper::HexaDump(unsigned char* p_buffer, int p_count, int p_offset) { |
Yann | 4:d03fcf494eb6 | 17 | |
Yann | 4:d03fcf494eb6 | 18 | int currentIdx = p_offset; |
Yann | 4:d03fcf494eb6 | 19 | unsigned short startAddress = ((unsigned short)(p_offset / 16)) * 16; |
Yann | 4:d03fcf494eb6 | 20 | |
Yann | 4:d03fcf494eb6 | 21 | DEBUG(">>> %d - %d - %d - %d - %d", p_count, p_offset, p_count + p_offset, currentIdx / 16, currentIdx % 16); |
Yann | 4:d03fcf494eb6 | 22 | |
Yann | 4:d03fcf494eb6 | 23 | // Display header |
Yann | 4:d03fcf494eb6 | 24 | printf(" HEX | 00 01 02 03 04 05 06 07 08 09 0A 0B 0C 0D 0E 0F : 0 1 2 3 4 5 6 7 8 9 A B C D E F \r\n"); |
Yann | 4:d03fcf494eb6 | 25 | printf("-----|+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+-:--+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+\r\n"); |
Yann | 4:d03fcf494eb6 | 26 | // 0123456789012345678901234567890123456789012345678901234567890123456789012345678901234567890 |
Yann | 4:d03fcf494eb6 | 27 | // 0 1 2 3 4 5 6 7 8 9 |
Yann | 4:d03fcf494eb6 | 28 | // Address offset padding |
Yann | 5:7ddb6bca6d01 | 29 | char line[__LINE_LENGTH__]; |
Yann | 5:7ddb6bca6d01 | 30 | memset(line, 0x20, __LINE_LENGTH__); |
Yann | 4:d03fcf494eb6 | 31 | sprintf(line, "%04x |", (unsigned short)startAddress); |
Yann | 4:d03fcf494eb6 | 32 | line[6] = 0x20; // Remove NULL character added by sprintf |
Yann | 4:d03fcf494eb6 | 33 | int idx = 0; |
Yann | 4:d03fcf494eb6 | 34 | int hexOffset = 7; |
Yann | 4:d03fcf494eb6 | 35 | int charOffset = 58; |
Yann | 4:d03fcf494eb6 | 36 | for ( ; idx < (int)(currentIdx % 16); idx++) { |
Yann | 4:d03fcf494eb6 | 37 | line[hexOffset] = 0x30; |
Yann | 4:d03fcf494eb6 | 38 | line[hexOffset + 1] = 0x30; |
Yann | 4:d03fcf494eb6 | 39 | hexOffset += 3; |
Yann | 4:d03fcf494eb6 | 40 | charOffset += 2; |
Yann | 4:d03fcf494eb6 | 41 | } |
Yann | 4:d03fcf494eb6 | 42 | // Fill line by line |
Yann | 4:d03fcf494eb6 | 43 | int endOfDump = p_count + p_offset; |
Yann | 4:d03fcf494eb6 | 44 | while(currentIdx < endOfDump) { |
Yann | 4:d03fcf494eb6 | 45 | for ( ; (idx < 16) && (currentIdx < endOfDump); idx++) { |
Yann | 4:d03fcf494eb6 | 46 | line[hexOffset] = DebugHelper::ToHexDigit(*(p_buffer + currentIdx) >> 4); |
Yann | 4:d03fcf494eb6 | 47 | line[hexOffset + 1] = DebugHelper::ToHexDigit(*(p_buffer + currentIdx) & 0x0f); |
Yann | 4:d03fcf494eb6 | 48 | line[charOffset] = DebugHelper::ToCharDigit(*(p_buffer + currentIdx)); |
Yann | 4:d03fcf494eb6 | 49 | // Prepare next byte |
Yann | 4:d03fcf494eb6 | 50 | hexOffset += 3; |
Yann | 4:d03fcf494eb6 | 51 | charOffset += 2; |
Yann | 4:d03fcf494eb6 | 52 | currentIdx += 1; |
Yann | 4:d03fcf494eb6 | 53 | } |
Yann | 4:d03fcf494eb6 | 54 | // Display the line |
Yann | 4:d03fcf494eb6 | 55 | line[56] = ':'; |
Yann | 5:7ddb6bca6d01 | 56 | line[__LINE_LENGTH__ - 2] = 0x0d; |
Yann | 5:7ddb6bca6d01 | 57 | line[__LINE_LENGTH__ - 1] = 0x0a; |
Yann | 4:d03fcf494eb6 | 58 | printf(line); |
Yann | 4:d03fcf494eb6 | 59 | if (currentIdx < endOfDump) { // Prepare next line, one line = 16 digits |
Yann | 4:d03fcf494eb6 | 60 | startAddress += 16; |
Yann | 5:7ddb6bca6d01 | 61 | memset(line, 0x20, __LINE_LENGTH__); |
Yann | 4:d03fcf494eb6 | 62 | sprintf(line, "%04x |", (unsigned short)startAddress); |
Yann | 4:d03fcf494eb6 | 63 | line[6] = 0x20; // Remove NULL character added by sprintf |
Yann | 4:d03fcf494eb6 | 64 | idx = 0; |
Yann | 4:d03fcf494eb6 | 65 | hexOffset = 7; |
Yann | 4:d03fcf494eb6 | 66 | charOffset = 58; |
Yann | 4:d03fcf494eb6 | 67 | } else { // End of line padding |
Yann | 4:d03fcf494eb6 | 68 | break; |
Yann | 4:d03fcf494eb6 | 69 | } |
Yann | 4:d03fcf494eb6 | 70 | } // End of 'while' statement |
Yann | 4:d03fcf494eb6 | 71 | } // End of method DebugHelper::HexaDump |
Yann | 0:311a0646b95a | 72 | |
Yann | 0:311a0646b95a | 73 | void DebugHelper::BreakPoint(const char* p_file, int p_line) { |
Yann | 0:311a0646b95a | 74 | printf("Stop in %s at line %d\r\n", p_file, p_line); |
Yann | 0:311a0646b95a | 75 | fflush(stdout); |
Yann | 0:311a0646b95a | 76 | getchar(); |
Yann | 0:311a0646b95a | 77 | fflush(stdin); |
Yann | 4:d03fcf494eb6 | 78 | } // End of method DebugHelper::BreakPoint |
Yann | 0:311a0646b95a | 79 | |
Yann | 0:311a0646b95a | 80 | #endif // __DEBUG |