KernelLand/Kernel/debug.c

   1 /*
   2  * AcessOS Microkernel Version
   3  * debug.c
   4  */
   5 #include <acess.h>
   6 #include <stdarg.h>
   7
   8 #define DEBUG_MAX_LINE_LEN      256
   9 #define LOCK_DEBUG_OUTPUT       1       // Avoid interleaving of output lines?
  10 #define TRACE_TO_KTERM  0       // Send ENTER/DEBUG/LEAVE to debug?
  11
  12 // === IMPORTS ===
  13 extern void     Threads_Dump(void);
  14 extern void     KernelPanic_SetMode(void);
  15 extern void     KernelPanic_PutChar(char Ch);
  16 extern void     IPStack_SendDebugText(const char *Text);
  17
  18 // === PROTOTYPES ===
  19 static void     Debug_Putchar(char ch);
  20 static void     Debug_Puts(int bUseKTerm, const char *Str);
  21 void    Debug_DbgOnlyFmt(const char *format, va_list args);
  22 void    Debug_FmtS(int bUseKTerm, const char *format, ...);
  23 void    Debug_Fmt(int bUseKTerm, const char *format, va_list args);
  24 void    Debug_SetKTerminal(const char *File);
  25
  26 // === GLOBALS ===
  27  int    gDebug_Level = 0;
  28  int    giDebug_KTerm = -1;
  29  int    gbDebug_IsKPanic = 0;
  30 volatile int    gbInPutChar = 0;
  31 #if LOCK_DEBUG_OUTPUT
  32 tShortSpinlock  glDebug_Lock;
  33 #endif
  34 // - Disabled because it breaks shit
  35  int    gbSendNetworkDebug = 0;
  36
  37 // === CODE ===
  38 static void Debug_Putchar(char ch)
  39 {
  40         Debug_PutCharDebug(ch);
  41
  42         if( gbDebug_IsKPanic )
  43                 KernelPanic_PutChar(ch);
  44
  45         if( gbDebug_IsKPanic < 2 )
  46         {
  47                 if(gbInPutChar) return ;
  48                 gbInPutChar = 1;
  49                 if(giDebug_KTerm != -1)
  50                         VFS_Write(giDebug_KTerm, 1, &ch);
  51                 gbInPutChar = 0;
  52         }
  53
  54         if( gbSendNetworkDebug )
  55         {
  56                 char str[2] = {ch, 0};
  57                 IPStack_SendDebugText(str);
  58         }
  59 }
  60
  61 static void Debug_Puts(int UseKTerm, const char *Str)
  62 {
  63          int    len = 0;
  64
  65         Debug_PutStringDebug(Str);
  66
  67         if( gbDebug_IsKPanic )
  68         {
  69                 for( len = 0; Str[len]; len ++ )
  70                         KernelPanic_PutChar( Str[len] );
  71         }
  72         else
  73                 for( len = 0; Str[len]; len ++ );
  74
  75         if( gbSendNetworkDebug )
  76                 IPStack_SendDebugText(Str);
  77
  78         // Output to the kernel terminal
  79         if( UseKTerm && gbDebug_IsKPanic < 2 && giDebug_KTerm != -1)
  80         {
  81                 if(gbInPutChar) return ;
  82                 gbInPutChar = 1;
  83                 VFS_Write(giDebug_KTerm, len, Str);
  84                 gbInPutChar = 0;
  85         }
  86 }
  87
  88 void Debug_DbgOnlyFmt(const char *format, va_list args)
  89 {
  90         Debug_Fmt(0, format, args);
  91 }
  92
  93 void Debug_Fmt(int bUseKTerm, const char *format, va_list args)
  94 {
  95         char    buf[DEBUG_MAX_LINE_LEN];
  96 //       int    len;
  97         buf[DEBUG_MAX_LINE_LEN-1] = 0;
  98         /*len = */vsnprintf(buf, DEBUG_MAX_LINE_LEN-1, format, args);
  99         //if( len < DEBUG_MAX_LINE )
 100                 // do something
 101         Debug_Puts(bUseKTerm, buf);
 102         return ;
 103 }
 104
 105 void Debug_FmtS(int bUseKTerm, const char *format, ...)
 106 {
 107         va_list args;
 108         va_start(args, format);
 109         Debug_Fmt(bUseKTerm, format, args);
 110         va_end(args);
 111 }
 112
 113 void Debug_KernelPanic(void)
 114 {
 115         #if LOCK_DEBUG_OUTPUT
 116         SHORTREL(&glDebug_Lock);
 117         #endif
 118         gbDebug_IsKPanic ++;
 119         KernelPanic_SetMode();
 120 }
 121
 122 /**
 123  * \fn void LogF(const char *Msg, ...)
 124  * \brief Raw debug log (no new line, no prefix)
 125  */
 126 void LogF(const char *Fmt, ...)
 127 {
 128         va_list args;
 129
 130         #if LOCK_DEBUG_OUTPUT
 131         SHORTLOCK(&glDebug_Lock);
 132         #endif
 133
 134         va_start(args, Fmt);
 135
 136         Debug_Fmt(1, Fmt, args);
 137
 138         va_end(args);
 139
 140         #if LOCK_DEBUG_OUTPUT
 141         SHORTREL(&glDebug_Lock);
 142         #endif
 143 }
 144 /**
 145  * \fn void Debug(const char *Msg, ...)
 146  * \brief Print only to the debug channel (not KTerm)
 147  */
 148 void Debug(const char *Fmt, ...)
 149 {
 150         va_list args;
 151
 152         #if LOCK_DEBUG_OUTPUT
 153         if(!CPU_HAS_LOCK(&glDebug_Lock)) SHORTLOCK(&glDebug_Lock);
 154         #endif
 155
 156         Debug_Puts(0, "Debug: ");
 157         va_start(args, Fmt);
 158         Debug_DbgOnlyFmt(Fmt, args);
 159         va_end(args);
 160         Debug_PutCharDebug('\r');
 161         Debug_PutCharDebug('\n');
 162         #if LOCK_DEBUG_OUTPUT
 163         SHORTREL(&glDebug_Lock);
 164         #endif
 165 }
 166
 167
 168 void LogFV(const char *Fmt, va_list args)
 169 {
 170         #if LOCK_DEBUG_OUTPUT
 171         SHORTLOCK(&glDebug_Lock);
 172         #endif
 173
 174         Debug_Fmt(1, Fmt, args);
 175
 176         #if LOCK_DEBUG_OUTPUT
 177         SHORTREL(&glDebug_Lock);
 178         #endif
 179 }
 180
 181 void LogV(const char *Fmt, va_list args)
 182 {
 183         #if LOCK_DEBUG_OUTPUT
 184         SHORTLOCK(&glDebug_Lock);
 185         #endif
 186
 187         Debug_Puts(1, "Log: ");
 188         Debug_Fmt(1, Fmt, args);
 189         Debug_Puts(1, "\r\n");
 190
 191         #if LOCK_DEBUG_OUTPUT
 192         SHORTREL(&glDebug_Lock);
 193         #endif
 194 }
 195
 196 /**
 197  * \fn void Log(const char *Msg, ...)
 198  */
 199 void Log(const char *Fmt, ...)
 200 {
 201         va_list args;
 202         va_start(args, Fmt);
 203         LogV(Fmt, args);
 204         va_end(args);
 205 }
 206
 207 void Warning(const char *Fmt, ...)
 208 {
 209         va_list args;
 210
 211         #if LOCK_DEBUG_OUTPUT
 212         SHORTLOCK(&glDebug_Lock);
 213         #endif
 214
 215         Debug_Puts(1, "Warning: ");
 216         va_start(args, Fmt);
 217         Debug_Fmt(1, Fmt, args);
 218         va_end(args);
 219         Debug_Putchar('\r');
 220         Debug_Putchar('\n');
 221
 222         #if LOCK_DEBUG_OUTPUT
 223         SHORTREL(&glDebug_Lock);
 224         #endif
 225 }
 226 void Panic(const char *Fmt, ...)
 227 {
 228         va_list args;
 229
 230         #if LOCK_DEBUG_OUTPUT
 231         if( !CPU_HAS_LOCK(&glDebug_Lock) )
 232                 SHORTLOCK(&glDebug_Lock);
 233         #endif
 234         // And never SHORTREL
 235
 236         Debug_KernelPanic();
 237
 238         Debug_Puts(1, "Panic: ");
 239         va_start(args, Fmt);
 240         Debug_Fmt(1, Fmt, args);
 241         va_end(args);
 242         Debug_Putchar('\r');
 243         Debug_Putchar('\n');
 244
 245         Threads_Dump();
 246         Heap_Dump();
 247
 248         for(;;) ;
 249 }
 250
 251 void Debug_SetKTerminal(const char *File)
 252 {
 253          int    tmp;
 254         if(giDebug_KTerm != -1) {
 255                 tmp = giDebug_KTerm;
 256                 giDebug_KTerm = -1;
 257                 VFS_Close(tmp);
 258         }
 259         tmp = VFS_Open(File, VFS_OPENFLAG_WRITE);
 260 //      Log_Log("Debug", "Opened '%s' as 0x%x", File, tmp);
 261         giDebug_KTerm = tmp;
 262 //      Log_Log("Debug", "Returning to %p", __builtin_return_address(0));
 263 }
 264
 265 void Debug_Enter(const char *FuncName, const char *ArgTypes, ...)
 266 {
 267         va_list args;
 268          int    i;
 269          int    pos;
 270         tTID    tid = Threads_GetTID();
 271
 272         #if LOCK_DEBUG_OUTPUT
 273         SHORTLOCK(&glDebug_Lock);
 274         #endif
 275
 276         i = gDebug_Level ++;
 277
 278         va_start(args, ArgTypes);
 279
 280         Debug_FmtS(TRACE_TO_KTERM, "%014lli ", now());
 281         while(i--)      Debug_Puts(TRACE_TO_KTERM, " ");
 282
 283         Debug_Puts(TRACE_TO_KTERM, FuncName);
 284         Debug_FmtS(TRACE_TO_KTERM, "[%i]", tid);
 285         Debug_Puts(TRACE_TO_KTERM, ": (");
 286
 287         while(*ArgTypes)
 288         {
 289                 pos = strpos(ArgTypes, ' ');
 290                 if(pos == -1 || pos > 1) {
 291                         if(pos == -1)
 292                                 Debug_Puts(TRACE_TO_KTERM, ArgTypes+1);
 293                         else {
 294                                 Debug_FmtS(TRACE_TO_KTERM, "%.*s", pos-1, ArgTypes+1);
 295                         }
 296                         Debug_Puts(TRACE_TO_KTERM, "=");
 297                 }
 298                 switch(*ArgTypes)
 299                 {
 300                 case 'p':       Debug_FmtS(TRACE_TO_KTERM, "%p", va_arg(args, void*));  break;
 301                 case 'P':       Debug_FmtS(TRACE_TO_KTERM, "%P", va_arg(args, tPAddr)); break;
 302                 case 's':       Debug_FmtS(TRACE_TO_KTERM, "'%s'", va_arg(args, char*));        break;
 303                 case 'i':       Debug_FmtS(TRACE_TO_KTERM, "%i", va_arg(args, int));    break;
 304                 case 'u':       Debug_FmtS(TRACE_TO_KTERM, "%u", va_arg(args, Uint));   break;
 305                 case 'x':       Debug_FmtS(TRACE_TO_KTERM, "0x%x", va_arg(args, Uint)); break;
 306                 case 'b':       Debug_FmtS(TRACE_TO_KTERM, "0b%b", va_arg(args, Uint)); break;
 307                 case 'X':       Debug_FmtS(TRACE_TO_KTERM, "0x%llx", va_arg(args, Uint64));     break;  // Extended (64-Bit)
 308                 case 'B':       Debug_FmtS(TRACE_TO_KTERM, "0b%llb", va_arg(args, Uint64));     break;  // Extended (64-Bit)
 309                 }
 310                 if(pos != -1) {
 311                         Debug_Puts(TRACE_TO_KTERM, ", ");
 312                 }
 313
 314                 if(pos == -1)   break;
 315                 ArgTypes = &ArgTypes[pos+1];
 316         }
 317
 318         va_end(args);
 319         Debug_Puts(TRACE_TO_KTERM, ")\r\n");
 320
 321         #if LOCK_DEBUG_OUTPUT
 322         SHORTREL(&glDebug_Lock);
 323         #endif
 324 }
 325
 326 void Debug_Log(const char *FuncName, const char *Fmt, ...)
 327 {
 328         va_list args;
 329          int    i = gDebug_Level;
 330         tTID    tid = Threads_GetTID();
 331
 332         #if LOCK_DEBUG_OUTPUT
 333         SHORTLOCK(&glDebug_Lock);
 334         #endif
 335
 336         Debug_FmtS(TRACE_TO_KTERM, "%014lli ", now());
 337         while(i--)      Debug_Puts(TRACE_TO_KTERM, " ");
 338
 339         Debug_Puts(TRACE_TO_KTERM, FuncName);
 340         Debug_FmtS(TRACE_TO_KTERM, "[%i]", tid);
 341         Debug_Puts(TRACE_TO_KTERM, ": ");
 342
 343         va_start(args, Fmt);
 344         Debug_Fmt(TRACE_TO_KTERM, Fmt, args);
 345         va_end(args);
 346
 347         Debug_Puts(TRACE_TO_KTERM, "\r\n");
 348
 349         #if LOCK_DEBUG_OUTPUT
 350         SHORTREL(&glDebug_Lock);
 351         #endif
 352 }
 353
 354 void Debug_Leave(const char *FuncName, char RetType, ...)
 355 {
 356         va_list args;
 357          int    i;
 358         tTID    tid = Threads_GetTID();
 359
 360         #if LOCK_DEBUG_OUTPUT
 361         SHORTLOCK(&glDebug_Lock);
 362         #endif
 363
 364         i = --gDebug_Level;
 365
 366         va_start(args, RetType);
 367
 368         if( i == -1 ) {
 369                 gDebug_Level = 0;
 370                 i = 0;
 371         }
 372         Debug_FmtS(TRACE_TO_KTERM, "%014lli ", now());
 373         // Indenting
 374         while(i--)      Debug_Puts(TRACE_TO_KTERM, " ");
 375
 376         Debug_Puts(TRACE_TO_KTERM, FuncName);
 377         Debug_FmtS(TRACE_TO_KTERM, "[%i]", tid);
 378         Debug_Puts(TRACE_TO_KTERM, ": RETURN");
 379
 380         // No Return
 381         if(RetType == '-') {
 382                 Debug_Puts(TRACE_TO_KTERM, "\r\n");
 383                 #if LOCK_DEBUG_OUTPUT
 384                 SHORTREL(&glDebug_Lock);
 385                 #endif
 386                 return;
 387         }
 388
 389         switch(RetType)
 390         {
 391         case 'n':       Debug_Puts(TRACE_TO_KTERM, " NULL");    break;
 392         case 'p':       Debug_Fmt(TRACE_TO_KTERM, " %p", args); break;
 393         case 'P':       Debug_Fmt(TRACE_TO_KTERM, " %P", args); break;  // PAddr
 394         case 's':       Debug_Fmt(TRACE_TO_KTERM, " '%s'", args);       break;
 395         case 'i':       Debug_Fmt(TRACE_TO_KTERM, " %i", args); break;
 396         case 'u':       Debug_Fmt(TRACE_TO_KTERM, " %u", args); break;
 397         case 'x':       Debug_Fmt(TRACE_TO_KTERM, " 0x%x", args);       break;
 398         // Extended (64-Bit)
 399         case 'X':       Debug_Fmt(TRACE_TO_KTERM, " 0x%llx", args);     break;
 400         }
 401         Debug_Puts(TRACE_TO_KTERM, "\r\n");
 402
 403         va_end(args);
 404
 405         #if LOCK_DEBUG_OUTPUT
 406         SHORTREL(&glDebug_Lock);
 407         #endif
 408 }
 409
 410 void Debug_HexDump(const char *Header, const void *Data, size_t Length)
 411 {
 412         const Uint8     *cdat = Data;
 413         Uint    pos = 0;
 414         LogF("%014lli ", now());
 415         Debug_Puts(1, Header);
 416         LogF(" (Hexdump of %p)\r\n", Data);
 417
 418         #define CH(n)   ((' '<=cdat[(n)]&&cdat[(n)]<0x7F) ? cdat[(n)] : '.')
 419
 420         while(Length >= 16)
 421         {
 422                 LogF("%014lli Log: %04x:"
 423                         " %02x %02x %02x %02x %02x %02x %02x %02x"
 424                         " %02x %02x %02x %02x %02x %02x %02x %02x"
 425                         "  %c%c%c%c%c%c%c%c %c%c%c%c%c%c%c%c\r\n",
 426                         now(),
 427                         pos,
 428                         cdat[ 0], cdat[ 1], cdat[ 2], cdat[ 3], cdat[ 4], cdat[ 5], cdat[ 6], cdat[ 7],
 429                         cdat[ 8], cdat[ 9], cdat[10], cdat[11], cdat[12], cdat[13], cdat[14], cdat[15],
 430                         CH(0),  CH(1),  CH(2),  CH(3),  CH(4),  CH(5),  CH(6),  CH(7),
 431                         CH(8),  CH(9),  CH(10), CH(11), CH(12), CH(13), CH(14), CH(15)
 432                         );
 433                 Length -= 16;
 434                 cdat += 16;
 435                 pos += 16;
 436         }
 437
 438         {
 439                  int    i ;
 440                 LogF("%014lli Log: %04x: ", now(), pos);
 441                 for(i = 0; i < Length; i ++)
 442                 {
 443                         LogF("%02x ", cdat[i]);
 444                 }
 445                 for( ; i < 16; i ++)    LogF("   ");
 446                 LogF(" ");
 447                 for(i = 0; i < Length; i ++)
 448                 {
 449                         if( i == 8 )    LogF(" ");
 450                         LogF("%c", CH(i));
 451                 }
 452
 453                 Debug_Putchar('\r');
 454                 Debug_Putchar('\n');
 455         }
 456 }
 457
 458 // --- EXPORTS ---
 459 EXPORT(Debug);
 460 EXPORT(Log);
 461 EXPORT(Warning);
 462 EXPORT(Debug_Enter);
 463 EXPORT(Debug_Log);
 464 EXPORT(Debug_Leave);