Diff: Debug.cpp

Revision:

0:63d45df56584

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Debug.cpp	Sun Jul 08 20:18:58 2012 +0000
@@ -0,0 +1,79 @@
+#include <cstdarg>
+#include "Debug.h"
+
+#ifdef __DEBUG
+
+#define __LINE_LENGTH__ 93
+
+void DebugHelper::Debug(const char* p_format, ...) {
+  va_list argp;
+  
+  va_start(argp, p_format);
+  vprintf(p_format, argp);
+  va_end(argp);
+} // End of method DebugHelper::Debug
+
+void DebugHelper::HexaDump(unsigned char* p_buffer, int p_count, int p_offset) {
+
+    int currentIdx = p_offset;
+    unsigned short startAddress = ((unsigned short)(p_offset / 16)) * 16;
+
+    // Display header
+    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");
+    printf("-----|+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+--+-:--+-+-+-+-+-+-+-+-+-+-+-+-+-+-+-+\r\n");
+    //      01234567890123456789012345678901234567890123456789012345678901234567890123456789012345678901 2
+    //      0         1         2         3         4         5         6         7         8         9
+    // Address offset padding
+    char line[__LINE_LENGTH__ + 1];
+    memset(line, 0x20, __LINE_LENGTH__);
+    line[__LINE_LENGTH__] = 0x00; // NULL character
+    sprintf(line, "%04x |", (unsigned short)startAddress);
+    line[6] = 0x20; // Remove NULL character added by sprintf
+    int idx = 0;
+    int hexOffset = 7;
+    int charOffset = 58;
+    for ( ; idx < (int)(currentIdx % 16); idx++) {
+        line[hexOffset] = 0x30;
+        line[hexOffset + 1] = 0x30;
+        hexOffset += 3;
+        charOffset += 2;
+    }
+    // Fill line by line
+    int endOfDump = p_count + p_offset;
+    while(currentIdx < endOfDump) {
+        for ( ; (idx < 16) && (currentIdx < endOfDump); idx++) {
+            line[hexOffset] = DebugHelper::ToHexDigit(*(p_buffer + currentIdx) >> 4);
+            line[hexOffset + 1] = DebugHelper::ToHexDigit(*(p_buffer + currentIdx) & 0x0f);
+            line[charOffset] = DebugHelper::ToCharDigit(*(p_buffer + currentIdx));
+            // Prepare next byte
+            hexOffset += 3;
+            charOffset += 2;
+            currentIdx += 1;
+        }
+        // Display the line
+        line[56] = ':';
+        line[__LINE_LENGTH__ - 1] = 0x0d;
+        line[__LINE_LENGTH__] = 0x0a;    
+        printf(line);
+        if (currentIdx < endOfDump) { // Prepare next line, one line = 16 digits
+            startAddress += 16;
+            memset(line, 0x20, __LINE_LENGTH__);
+            sprintf(line, "%04x |", (unsigned short)startAddress);
+            line[6] = 0x20; // Remove NULL character added by sprintf
+            idx = 0;
+            hexOffset = 7;
+            charOffset = 58;
+        } else { // End of line padding
+            break;
+        }
+    } // End of 'while' statement
+} // End of method DebugHelper::HexaDump
+
+void DebugHelper::BreakPoint(const char* p_file, int p_line) {
+  printf("Stop in %s at line %d\r\n", p_file, p_line);
+  fflush(stdout);
+  getchar();
+  fflush(stdin);
+} // End of method DebugHelper::BreakPoint
+
+#endif // __DEBUG