kern/src/monitor.c

   1 // Simple command-line kernel monitor useful for
   2 // controlling the kernel and exploring the system interactively.
   3
   4 #include <arch/arch.h>
   5 #include <stab.h>
   6 #include <smp.h>
   7 #include <arch/console.h>
   8
   9 #include <stdio.h>
  10 #include <string.h>
  11 #include <assert.h>
  12 #include <monitor.h>
  13 #include <trap.h>
  14 #include <pmap.h>
  15 #include <kdebug.h>
  16 #include <testing.h>
  17 #include <manager.h>
  18 #include <schedule.h>
  19 #include <kdebug.h>
  20 #include <syscall.h>
  21 #include <kmalloc.h>
  22 #include <elf.h>
  23 #include <event.h>
  24 #include <trap.h>
  25 #include <time.h>
  26 #include <percpu.h>
  27
  28 #include <ros/memlayout.h>
  29 #include <ros/event.h>
  30
  31 #define CMDBUF_SIZE     80      // enough for one VGA text line
  32
  33 typedef struct command {
  34         const char *name;
  35         const char *desc;
  36         // return -1 to force monitor to exit
  37         int (*func)(int argc, char **argv, struct hw_trapframe *hw_tf);
  38 } command_t;
  39
  40 static command_t commands[] = {
  41         { "help", "Display this list of commands", mon_help },
  42         { "kerninfo", "Display information about the kernel", mon_kerninfo },
  43         { "backtrace", "Dump a backtrace", mon_backtrace },
  44         { "bt", "Dump a backtrace", mon_backtrace },
  45         { "reboot", "Take a ride to the South Bay", mon_reboot },
  46         { "showmapping", "Shows VA->PA mappings", mon_showmapping},
  47         { "sm", "Shows VA->PA mappings", mon_sm},
  48         { "cpuinfo", "Prints CPU diagnostics", mon_cpuinfo},
  49         { "ps", "Prints process list", mon_ps},
  50         { "nanwan", "Meet Nanwan!!", mon_nanwan},
  51         { "bin_ls", "List files in /bin", mon_bin_ls},
  52         { "bin_run", "Create and run a program from /bin", mon_bin_run},
  53         { "manager", "Run the manager", mon_manager},
  54         { "procinfo", "Show information about processes", mon_procinfo},
  55         { "pip", "Shorthand for procinfo pid", mon_pip},
  56         { "kill", "Kills a process", mon_kill},
  57         { "exit", "Leave the monitor", mon_exit},
  58         { "e", "Leave the monitor", mon_exit},
  59         { "kfunc", "Run a kernel function directly (!!!)", mon_kfunc},
  60         { "notify", "Notify a process.  Vcoreid will skip their prefs", mon_notify},
  61         { "measure", "Run a specific measurement", mon_measure},
  62         { "trace", "Run some tracing functions", mon_trace},
  63         { "monitor", "Run the monitor on another core", mon_monitor},
  64         { "fs", "Filesystem Diagnostics", mon_fs},
  65         { "sh", "Try to run a shell (bash)", mon_shell},
  66         { "bash", "Try to run a shell (bash)", mon_shell},
  67         { "bb", "Try to run a shell (bash)", mon_shell},
  68         { "alarm", "Alarm Diagnostics", mon_alarm},
  69         { "msr", "read/write msr: msr msr [value]", mon_msr},
  70         { "db", "Misc debugging", mon_db},
  71         { "px", "Toggle printx", mon_px},
  72         { "kpfret", "Attempt to idle after a kernel fault", mon_kpfret},
  73         { "ks", "Kernel scheduler hacks", mon_ks},
  74         { "coreinfo", "Print diagnostics for a core", mon_coreinfo},
  75 };
  76 #define NCOMMANDS (sizeof(commands)/sizeof(commands[0]))
  77
  78 /***** Implementations of basic kernel monitor commands *****/
  79
  80 int mon_help(int argc, char **argv, struct hw_trapframe *hw_tf)
  81 {
  82         int i;
  83
  84         for (i = 0; i < NCOMMANDS; i++)
  85                 cprintf("%s - %s\n", commands[i].name, commands[i].desc);
  86         return 0;
  87 }
  88
  89 int mon_ps(int argc, char** argv, struct hw_trapframe *hw_tf)
  90 {
  91         print_allpids();
  92         return 0;
  93 }
  94
  95 int mon_kerninfo(int argc, char **argv, struct hw_trapframe *hw_tf)
  96 {
  97         extern char _start[], etext[], end[];
  98
  99         cprintf("Special kernel symbols:\n");
 100         cprintf("  _start %016x (virt)  %016x (phys)\n", _start, (uintptr_t)(_start - KERNBASE));
 101         cprintf("  etext  %016x (virt)  %016x (phys)\n", etext, (uintptr_t)(etext - KERNBASE));
 102         cprintf("  end    %016x (virt)  %016x (phys)\n", end, (uintptr_t)(end - KERNBASE));
 103         cprintf("Kernel executable memory footprint: %dKB\n",
 104                 (uint32_t)(end-_start+1023)/1024);
 105         return 0;
 106 }
 107
 108 static int __backtrace(int argc, char **argv, struct hw_trapframe *hw_tf)
 109 {
 110         uintptr_t pc, fp;
 111         if (argc == 1) {
 112                 backtrace();
 113                 return 0;
 114         }
 115         if (argc != 3) {
 116                 printk("Need either no arguments, or two (PC and FP) in hex\n");
 117                 return 1;
 118         }
 119         pc = strtol(argv[1], 0, 16);
 120         fp = strtol(argv[2], 0, 16);
 121         printk("Backtrace from instruction %p, with frame pointer %p\n", pc, fp);
 122         backtrace_frame(pc, fp);
 123         return 0;
 124 }
 125
 126 int mon_backtrace(int argc, char **argv, struct hw_trapframe *hw_tf)
 127 {
 128         return __backtrace(argc, argv, hw_tf);
 129 }
 130
 131 int mon_reboot(int argc, char **argv, struct hw_trapframe *hw_tf)
 132 {
 133         cprintf("[Scottish Accent]: She's goin' down, Cap'n!\n");
 134         reboot();
 135
 136         // really, should never see this
 137         cprintf("Sigh....\n");
 138         return 0;
 139 }
 140
 141 static int __showmapping(int argc, char **argv, struct hw_trapframe *hw_tf)
 142 {
 143         struct proc *p;
 144         uintptr_t start;
 145         size_t size;
 146         pgdir_t pgdir;
 147         pid_t pid;
 148         if (argc < 3) {
 149                 printk("Shows virtual -> physical mappings for a virt addr range.\n");
 150                 printk("Usage: showmapping PID START_ADDR [END_ADDR]\n");
 151                 printk("    PID == 0 for the boot pgdir\n");
 152                 return 1;
 153         }
 154         pid = strtol(argv[1], 0, 10);
 155         if (!pid) {
 156                 pgdir = boot_pgdir;
 157         } else {
 158                 p = pid2proc(pid);
 159                 if (!p) {
 160                         printk("No proc with pid %d\n", pid);
 161                         return 1;
 162                 }
 163                 pgdir = p->env_pgdir;
 164         }
 165         start = ROUNDDOWN(strtol(argv[2], 0, 16), PGSIZE);
 166         size = (argc == 3) ? 1 : strtol(argv[3], 0, 16) - start;
 167         if (size/PGSIZE > 512) {
 168                 cprintf("Not going to do this for more than 512 items\n");
 169                 return 1;
 170         }
 171         show_mapping(pgdir, start, size);
 172         return 0;
 173 }
 174
 175 int mon_showmapping(int argc, char **argv, struct hw_trapframe *hw_tf)
 176 {
 177         return __showmapping(argc, argv, hw_tf);
 178 }
 179
 180 int mon_sm(int argc, char **argv, struct hw_trapframe *hw_tf)
 181 {
 182         return __showmapping(argc, argv, hw_tf);
 183 }
 184
 185 static spinlock_t print_info_lock = SPINLOCK_INITIALIZER_IRQSAVE;
 186
 187 static void print_info_handler(struct hw_trapframe *hw_tf, void *data)
 188 {
 189         uint64_t tsc = read_tsc();
 190
 191         spin_lock_irqsave(&print_info_lock);
 192         cprintf("----------------------------\n");
 193         cprintf("This is Core %d\n", core_id());
 194         cprintf("Timestamp = %lld\n", tsc);
 195 #ifdef CONFIG_X86
 196         cprintf("Hardware core %d\n", hw_core_id());
 197         cprintf("MTRR_DEF_TYPE = 0x%08x\n", read_msr(IA32_MTRR_DEF_TYPE));
 198         cprintf("MTRR Phys0 Base = 0x%016llx, Mask = 0x%016llx\n",
 199                 read_msr(0x200), read_msr(0x201));
 200         cprintf("MTRR Phys1 Base = 0x%016llx, Mask = 0x%016llx\n",
 201                 read_msr(0x202), read_msr(0x203));
 202         cprintf("MTRR Phys2 Base = 0x%016llx, Mask = 0x%016llx\n",
 203                 read_msr(0x204), read_msr(0x205));
 204         cprintf("MTRR Phys3 Base = 0x%016llx, Mask = 0x%016llx\n",
 205                 read_msr(0x206), read_msr(0x207));
 206         cprintf("MTRR Phys4 Base = 0x%016llx, Mask = 0x%016llx\n",
 207                 read_msr(0x208), read_msr(0x209));
 208         cprintf("MTRR Phys5 Base = 0x%016llx, Mask = 0x%016llx\n",
 209                 read_msr(0x20a), read_msr(0x20b));
 210         cprintf("MTRR Phys6 Base = 0x%016llx, Mask = 0x%016llx\n",
 211                 read_msr(0x20c), read_msr(0x20d));
 212         cprintf("MTRR Phys7 Base = 0x%016llx, Mask = 0x%016llx\n",
 213                 read_msr(0x20e), read_msr(0x20f));
 214 #endif // CONFIG_X86
 215         cprintf("----------------------------\n");
 216         spin_unlock_irqsave(&print_info_lock);
 217 }
 218
 219 static bool print_all_info(void)
 220 {
 221         cprintf("\nCORE 0 asking all cores to print info:\n");
 222         smp_call_function_all(print_info_handler, NULL, 0);
 223         cprintf("\nDone!\n");
 224         return true;
 225 }
 226
 227 int mon_cpuinfo(int argc, char **argv, struct hw_trapframe *hw_tf)
 228 {
 229         cprintf("Number of Cores detected: %d\n", num_cores);
 230         cprintf("Calling CPU's ID: 0x%08x\n", core_id());
 231
 232         if (argc < 2)
 233                 smp_call_function_self(print_info_handler, NULL, 0);
 234         else
 235                 smp_call_function_single(strtol(argv[1], 0, 10),
 236                                          print_info_handler, NULL, 0);
 237         return 0;
 238 }
 239
 240 int mon_manager(int argc, char** argv, struct hw_trapframe *hw_tf)
 241 {
 242         manager();
 243         panic("should never get here");
 244         return 0;
 245 }
 246
 247 int mon_nanwan(int argc, char **argv, struct hw_trapframe *hw_tf)
 248 {
 249         /* Borrowed with love from http://www.geocities.com/SoHo/7373/zoo.htm
 250          * (http://www.ascii-art.com/).  Slightly modified to make it 25 lines tall.
 251          */
 252         printk("\n");
 253         printk("             .-.  .-.\n");
 254         printk("             |  \\/  |\n");
 255         printk("            /,   ,_  `'-.\n");
 256         printk("          .-|\\   /`\\     '. \n");
 257         printk("        .'  0/   | 0\\  \\_  `\".  \n");
 258         printk("     .-'  _,/    '--'.'|#''---'\n");
 259         printk("      `--'  |       /   \\#\n");
 260         printk("            |      /     \\#\n");
 261         printk("            \\     ;|\\    .\\#\n");
 262         printk("            |' ' //  \\   ::\\# \n");
 263         printk("            \\   /`    \\   ':\\#\n");
 264         printk("             `\"`       \\..   \\#\n");
 265         printk("                        \\::.  \\#\n");
 266         printk("                         \\::   \\#\n");
 267         printk("                          \\'  .:\\#\n");
 268         printk("                           \\  :::\\#\n");
 269         printk("                            \\  '::\\#\n");
 270         printk("                             \\     \\#\n");
 271         printk("                              \\:.   \\#\n");
 272         printk("                               \\::   \\#\n");
 273         printk("                                \\'   .\\#\n");
 274         printk("                             jgs \\   ::\\#\n");
 275         printk("                                  \\      \n");
 276         return 0;
 277 }
 278
 279 int mon_bin_ls(int argc, char **argv, struct hw_trapframe *hw_tf)
 280 {
 281         struct dirent dir = {0};
 282         struct file *bin_dir;
 283         int retval = 0;
 284
 285         bin_dir = do_file_open("/bin", O_READ, 0);
 286         if (!bin_dir) {
 287                 printk("No /bin directory!\n");
 288                 return 1;
 289         }
 290         printk("Files in /bin:\n-------------------------------\n");
 291         do {
 292                 retval = bin_dir->f_op->readdir(bin_dir, &dir);
 293                 printk("%s\n", dir.d_name);
 294         } while (retval == 1);
 295         kref_put(&bin_dir->f_kref);
 296         return 0;
 297 }
 298
 299 int mon_bin_run(int argc, char **argv, struct hw_trapframe *hw_tf)
 300 {
 301         if (argc < 2) {
 302                 printk("Usage: bin_run FILENAME\n");
 303                 return 1;
 304         }
 305         struct file *program;
 306         int retval = 0;
 307         char buf[5 + MAX_FILENAME_SZ + 1] = "/bin/";    /* /bin/ + max + \0 */
 308
 309         strlcpy(buf, "/bin/", sizeof(buf));
 310         if (strlcat(buf, argv[1], sizeof(buf)) > sizeof(buf)) {
 311                 printk("Filename '%s' too long!\n", argv[1]);
 312                 return 1;
 313         }
 314         program = do_file_open(buf, O_READ, 0);
 315         if (!program) {
 316                 printk("No such program!\n");
 317                 return 1;
 318         }
 319         char **p_argv = kmalloc(sizeof(char*) * argc, 0);       /* bin_run's argc */
 320         for (int i = 0; i < argc - 1; i++)
 321                 p_argv[i] = argv[i + 1];
 322         p_argv[argc - 1] = 0;
 323         /* super ugly: we need to stash current, so that proc_create doesn't pick up
 324          * on random processes running here and assuming they are the parent */
 325         struct proc *old_cur = current;
 326         current = 0;
 327         struct proc *p = proc_create(program, p_argv, NULL);
 328         current = old_cur;
 329         kfree(p_argv);
 330         proc_wakeup(p);
 331         proc_decref(p); /* let go of the reference created in proc_create() */
 332         kref_put(&program->f_kref);
 333         /* Make a scheduling decision.  You might not get the process you created,
 334          * in the event there are others floating around that are runnable */
 335         run_scheduler();
 336         /* want to idle, so we un the process we just selected.  this is a bit
 337          * hackish, but so is the monitor. */
 338         smp_idle();
 339         assert(0);
 340         return 0;
 341 }
 342
 343 int mon_procinfo(int argc, char **argv, struct hw_trapframe *hw_tf)
 344 {
 345         int verbosity = 0;
 346
 347         if (argc < 2) {
 348                 printk("Usage: procinfo OPTION\n");
 349                 printk("\tall: show all active pids\n");
 350                 printk("\tpid NUM: show a lot of info for proc NUM\n");
 351                 printk("\tunlock: unlock the lock for the ADDR (OMG!!!)\n");
 352                 printk("\tkill NUM: destroy proc NUM\n");
 353                 return 1;
 354         }
 355         if (!strcmp(argv[1], "all")) {
 356                 print_allpids();
 357         } else if (!strcmp(argv[1], "pid")) {
 358                 if (argc < 3) {
 359                         printk("Give me a pid number.\n");
 360                         return 1;
 361                 }
 362                 if (argc >= 4)
 363                         verbosity = strtol(argv[3], 0, 0);
 364                 print_proc_info(strtol(argv[2], 0, 0), verbosity);
 365         } else if (!strcmp(argv[1], "unlock")) {
 366                 if (argc != 3) {
 367                         printk("Gimme lock address!  Me want lock address!.\n");
 368                         return 1;
 369                 }
 370                 spinlock_t *lock = (spinlock_t*)strtol(argv[2], 0, 16);
 371                 if (!lock) {
 372                         printk("Null address...\n");
 373                         return 1;
 374                 }
 375                 spin_unlock(lock);
 376         } else if (!strcmp(argv[1], "kill")) {
 377                 if (argc != 3) {
 378                         printk("Give me a pid number.\n");
 379                         return 1;
 380                 }
 381                 struct proc *p = pid2proc(strtol(argv[2], 0, 0));
 382                 if (!p) {
 383                         printk("No such proc\n");
 384                         return 1;
 385                 }
 386                 proc_destroy(p);
 387                 proc_decref(p);
 388         } else {
 389                 printk("Bad option\n");
 390                 return 1;
 391         }
 392         return 0;
 393 }
 394
 395 int mon_pip(int argc, char **argv, struct hw_trapframe *hw_tf)
 396 {
 397         int verbosity = 0;
 398
 399         if (argc < 2) {
 400                 printk("Give me a pid number.\n");
 401                 return 1;
 402         }
 403         if (argc >= 3)
 404                 verbosity = strtol(argv[2], 0, 0);
 405         print_proc_info(strtol(argv[1], 0, 0), verbosity);
 406         return 0;
 407 }
 408
 409 int mon_kill(int argc, char **argv, struct hw_trapframe *hw_tf)
 410 {
 411         struct proc *p;
 412
 413         if (argc < 2) {
 414                 printk("Usage: kill PID\n");
 415                 return 1;
 416         }
 417         p = pid2proc(strtol(argv[1], 0, 0));
 418         if (!p) {
 419                 printk("No such proc\n");
 420                 return 1;
 421         }
 422         p->exitcode = 1;        /* typical EXIT_FAILURE */
 423         proc_destroy(p);
 424         proc_decref(p);
 425         return 0;
 426 }
 427
 428 int mon_exit(int argc, char **argv, struct hw_trapframe *hw_tf)
 429 {
 430         return -1;
 431 }
 432
 433 int mon_kfunc(int argc, char **argv, struct hw_trapframe *hw_tf)
 434 {
 435         long ret;
 436         long (*func)(void *arg, ...);
 437
 438         if (argc < 2) {
 439                 printk("Usage: kfunc FUNCTION [arg1] [arg2] [etc]\n");
 440                 printk("Use 0x with hex arguments.  Can take 6 args.\n");
 441                 return 1;
 442         }
 443         func = (void*)get_symbol_addr(argv[1]);
 444         if (!func) {
 445                 printk("Function not found.\n");
 446                 return 1;
 447         }
 448         /* Not elegant, but whatever.  maybe there's a better syntax, or we can do
 449          * it with asm magic. */
 450         switch (argc) {
 451         case 2: /* have to fake one arg */
 452                 ret = func((void*)0);
 453                 break;
 454         case 3: /* the real first arg */
 455                 ret = func((void*)strtol(argv[2], 0, 0));
 456                 break;
 457         case 4:
 458                 ret = func((void*)strtol(argv[2], 0, 0),
 459                                   strtol(argv[3], 0, 0));
 460                 break;
 461         case 5:
 462                 ret = func((void*)strtol(argv[2], 0, 0),
 463                                   strtol(argv[3], 0, 0),
 464                                   strtol(argv[4], 0, 0));
 465                 break;
 466         case 6:
 467                 ret = func((void*)strtol(argv[2], 0, 0),
 468                                   strtol(argv[3], 0, 0),
 469                                   strtol(argv[4], 0, 0),
 470                                   strtol(argv[5], 0, 0));
 471                 break;
 472         case 7:
 473                 ret = func((void*)strtol(argv[2], 0, 0),
 474                                   strtol(argv[3], 0, 0),
 475                                   strtol(argv[4], 0, 0),
 476                                   strtol(argv[5], 0, 0),
 477                                   strtol(argv[6], 0, 0));
 478                 break;
 479         case 8:
 480                 ret = func((void*)strtol(argv[2], 0, 0),
 481                                   strtol(argv[3], 0, 0),
 482                                   strtol(argv[4], 0, 0),
 483                                   strtol(argv[5], 0, 0),
 484                                   strtol(argv[6], 0, 0),
 485                                   strtol(argv[7], 0, 0));
 486                 break;
 487         default:
 488                 printk("Bad number of arguments.\n");
 489                 return -1;
 490         }
 491         printk("%s (might have) returned %p\n", argv[1], ret);
 492         return 0;
 493 }
 494
 495 /* Sending a vcoreid forces an event and an IPI/notification */
 496 int mon_notify(int argc, char **argv, struct hw_trapframe *hw_tf)
 497 {
 498         struct proc *p;
 499         uint32_t vcoreid;
 500         struct event_msg msg = {0};
 501
 502         if (argc < 3) {
 503                 printk("Usage: notify PID NUM [VCOREID]\n");
 504                 return 1;
 505         }
 506         p = pid2proc(strtol(argv[1], 0, 0));
 507         if (!p) {
 508                 printk("No such proc\n");
 509                 return 1;
 510         }
 511         msg.ev_type = strtol(argv[2], 0, 0);
 512         if (argc == 4) {
 513                 vcoreid = strtol(argv[3], 0, 0);
 514                 /* This will go to the private mbox */
 515                 post_vcore_event(p, &msg, vcoreid, EVENT_VCORE_PRIVATE);
 516                 proc_notify(p, vcoreid);
 517         } else {
 518                 /* o/w, try and do what they want */
 519                 send_kernel_event(p, &msg, 0);
 520         }
 521         proc_decref(p);
 522         return 0;
 523 }
 524
 525 /* Micro-benchmarky Measurements.  This is really fragile code that probably
 526  * won't work perfectly, esp as the kernel evolves. */
 527 int mon_measure(int argc, char **argv, struct hw_trapframe *hw_tf)
 528 {
 529         uint64_t begin = 0, diff = 0;
 530         uint32_t end_refcnt = 0;
 531
 532         if (argc < 2) {
 533                 printk("Usage: measure OPTION\n");
 534                 printk("\tkill PID : kill proc PID\n");
 535                 printk("\tpreempt PID : preempt proc PID (no delay)\n");
 536                 printk("\tpreempt PID [pcore] : preempt PID's pcore (no delay)\n");
 537                 printk("\tpreempt-warn PID : warn-preempt proc PID (pending)\n");
 538                 printk("\tpreempt-warn PID [pcore] : warn-preempt proc PID's pcore\n");
 539                 printk("\tpreempt-raw PID : raw-preempt proc PID\n");
 540                 printk("\tpreempt-raw PID [pcore] : raw-preempt proc PID's pcore\n");
 541                 return 1;
 542         }
 543         if (!strcmp(argv[1], "kill")) {
 544                 if (argc < 3) {
 545                         printk("Give me a pid number.\n");
 546                         return 1;
 547                 }
 548                 struct proc *p = pid2proc(strtol(argv[2], 0, 0));
 549                 if (!p) {
 550                         printk("No such proc\n");
 551                         return 1;
 552                 }
 553                 begin = start_timing();
 554 #ifdef CONFIG_APPSERVER
 555                 printk("Warning: this will be inaccurate due to the appserver.\n");
 556                 end_refcnt = kref_refcnt(&p->p_kref) - p->procinfo->num_vcores - 1;
 557 #endif /* CONFIG_APPSERVER */
 558                 proc_destroy(p);
 559                 proc_decref(p);
 560 #ifdef CONFIG_APPSERVER
 561                 /* Won't be that accurate, since it's not actually going through the
 562                  * __proc_free() path. */
 563                 spin_on(kref_refcnt(&p->p_kref) != end_refcnt);
 564 #else
 565                 /* this is a little ghetto. it's not fully free yet, but we are also
 566                  * slowing it down by messing with it, esp with the busy waiting on a
 567                  * hyperthreaded core. */
 568                 spin_on(p->env_cr3);
 569 #endif /* CONFIG_APPSERVER */
 570                 /* No noticeable difference using stop_timing instead of read_tsc() */
 571                 diff = stop_timing(begin);
 572         } else if (!strcmp(argv[1], "preempt")) {
 573                 if (argc < 3) {
 574                         printk("Give me a pid number.\n");
 575                         return 1;
 576                 }
 577                 struct proc *p = pid2proc(strtol(argv[2], 0, 0));
 578                 if (!p) {
 579                         printk("No such proc\n");
 580                         return 1;
 581                 }
 582                 if (argc == 4) { /* single core being preempted, warned but no delay */
 583                         uint32_t pcoreid = strtol(argv[3], 0, 0);
 584                         begin = start_timing();
 585                         if (proc_preempt_core(p, pcoreid, 1000000)) {
 586                                 __sched_put_idle_core(p, pcoreid);
 587                                 /* done when unmapped (right before abandoning) */
 588                                 spin_on(p->procinfo->pcoremap[pcoreid].valid);
 589                         } else {
 590                                 printk("Core %d was not mapped to proc\n", pcoreid);
 591                         }
 592                         diff = stop_timing(begin);
 593                 } else { /* preempt all cores, warned but no delay */
 594                         end_refcnt = kref_refcnt(&p->p_kref) - p->procinfo->num_vcores;
 595                         begin = start_timing();
 596                         proc_preempt_all(p, 1000000);
 597                         /* a little ghetto, implies no one is using p */
 598                         spin_on(kref_refcnt(&p->p_kref) != end_refcnt);
 599                         diff = stop_timing(begin);
 600                 }
 601                 proc_decref(p);
 602         } else if (!strcmp(argv[1], "preempt-warn")) {
 603                 if (argc < 3) {
 604                         printk("Give me a pid number.\n");
 605                         return 1;
 606                 }
 607                 struct proc *p = pid2proc(strtol(argv[2], 0, 0));
 608                 if (!p) {
 609                         printk("No such proc\n");
 610                         return 1;
 611                 }
 612                 printk("Careful: if this hangs, then the process isn't responding.\n");
 613                 if (argc == 4) { /* single core being preempted-warned */
 614                         uint32_t pcoreid = strtol(argv[3], 0, 0);
 615                         spin_lock(&p->proc_lock);
 616                         uint32_t vcoreid = p->procinfo->pcoremap[pcoreid].vcoreid;
 617                         if (!p->procinfo->pcoremap[pcoreid].valid) {
 618                                 printk("Pick a mapped pcore\n");
 619                                 spin_unlock(&p->proc_lock);
 620                                 return 1;
 621                         }
 622                         begin = start_timing();
 623                         __proc_preempt_warn(p, vcoreid, 1000000); // 1 sec
 624                         spin_unlock(&p->proc_lock);
 625                         /* done when unmapped (right before abandoning) */
 626                         spin_on(p->procinfo->pcoremap[pcoreid].valid);
 627                         diff = stop_timing(begin);
 628                 } else { /* preempt-warn all cores */
 629                         printk("Warning, this won't work if they can't yield their "
 630                                "last vcore, will stop at 1!\n");
 631                         spin_lock(&p->proc_lock);
 632                         begin = start_timing();
 633                         __proc_preempt_warnall(p, 1000000);
 634                         spin_unlock(&p->proc_lock);
 635                         /* target cores do the unmapping / changing of the num_vcores */
 636                         spin_on(p->procinfo->num_vcores > 1);
 637                         diff = stop_timing(begin);
 638                 }
 639                 proc_decref(p);
 640         } else if (!strcmp(argv[1], "preempt-raw")) {
 641                 if (argc < 3) {
 642                         printk("Give me a pid number.\n");
 643                         return 1;
 644                 }
 645                 struct proc *p = pid2proc(strtol(argv[2], 0, 0));
 646                 if (!p) {
 647                         printk("No such proc\n");
 648                         return 1;
 649                 }
 650                 if (argc == 4) { /* single core preempted, no warning or waiting */
 651                         uint32_t pcoreid = strtol(argv[3], 0, 0);
 652                         spin_lock(&p->proc_lock);
 653                         if (!p->procinfo->pcoremap[pcoreid].valid) {
 654                                 printk("Pick a mapped pcore\n");
 655                                 spin_unlock(&p->proc_lock);
 656                                 return 1;
 657                         }
 658                         begin = start_timing();
 659                         __proc_preempt_core(p, pcoreid);
 660                         if (!p->procinfo->num_vcores)
 661                                 __proc_set_state(p, PROC_RUNNABLE_M);
 662                         spin_unlock(&p->proc_lock);
 663                         /* ghetto, since the ksched should be calling all of this */
 664                         __sched_put_idle_core(p, pcoreid);
 665                         /* done when unmapped (right before abandoning) */
 666                         spin_on(p->procinfo->pcoremap[pcoreid].valid);
 667                         diff = stop_timing(begin);
 668                 } else { /* preempt all cores, no warning or waiting */
 669                         spin_lock(&p->proc_lock);
 670                         uint32_t pc_arr[p->procinfo->num_vcores];
 671                         uint32_t num_revoked;
 672                         end_refcnt = kref_refcnt(&p->p_kref) - p->procinfo->num_vcores;
 673                         begin = start_timing();
 674                         num_revoked = __proc_preempt_all(p, pc_arr);
 675                         __proc_set_state(p, PROC_RUNNABLE_M);
 676                         spin_unlock(&p->proc_lock);
 677                         if (num_revoked)
 678                                 __sched_put_idle_cores(p, pc_arr, num_revoked);
 679                         /* a little ghetto, implies no one else is using p */
 680                         spin_on(kref_refcnt(&p->p_kref) != end_refcnt);
 681                         diff = stop_timing(begin);
 682                 }
 683                 proc_decref(p);
 684         } else {
 685                 printk("Bad option\n");
 686                 return 1;
 687         }
 688         printk("[Tired Giraffe Accent] Took %llu usec (%llu nsec) to finish.\n",
 689                tsc2usec(diff), tsc2nsec(diff));
 690         return 0;
 691 }
 692
 693 static bool mon_verbose_trace = FALSE;
 694 static DEFINE_PERCPU(bool, mon_nmi_trace);
 695
 696 static void emit_hwtf_backtrace(struct hw_trapframe *hw_tf)
 697 {
 698         char *fn_name;
 699
 700         if (mon_verbose_trace) {
 701                 print_trapframe(hw_tf);
 702                 backtrace_hwtf(hw_tf);
 703         }
 704         fn_name = get_fn_name(get_hwtf_pc(hw_tf));
 705         printk("Core %d is at %p (%s)\n", core_id(), get_hwtf_pc(hw_tf),
 706                fn_name);
 707         kfree(fn_name);
 708 }
 709
 710 static void emit_vmtf_backtrace(struct vm_trapframe *vm_tf)
 711 {
 712         if (mon_verbose_trace)
 713                 print_vmtrapframe(vm_tf);
 714         printk("Core %d is at %p\n", core_id(), get_vmtf_pc(vm_tf));
 715 }
 716
 717 /* This is dangerous and could cause a deadlock, since it runs in NMI context.
 718  * It's only for monitor debugging, so YMMV.  We pass the type since the kernel
 719  * doesn't deal in contexts (yet) */
 720 void emit_monitor_backtrace(int type, void *tf)
 721 {
 722         struct per_cpu_info *pcpui = &per_cpu_info[core_id()];
 723
 724         if (!PERCPU_VAR(mon_nmi_trace))
 725                 return;
 726         /* To prevent a spew of output during a lot of perf NMIs, we'll turn off the
 727          * monitor output as soon as any NMI hits our core. */
 728         PERCPU_VAR(mon_nmi_trace) = FALSE;
 729         /* Temporarily disable deadlock detection when we print.  We could
 730          * deadlock if we were printing when we NMIed. */
 731         pcpui->__lock_checking_enabled--;
 732         if (type == ROS_HW_CTX)
 733                 emit_hwtf_backtrace((struct hw_trapframe*)tf);
 734         else
 735                 emit_vmtf_backtrace((struct vm_trapframe*)tf);
 736         print_kmsgs(core_id());
 737         pcpui->__lock_checking_enabled++;
 738 }
 739
 740
 741 int mon_trace(int argc, char **argv, struct hw_trapframe *hw_tf)
 742 {
 743         int core;
 744         if (argc < 2) {
 745                 printk("Usage: trace OPTION\n");
 746                 printk("\tsyscall start [silent (0 or non-zero, NOT the word silent)] [pid]: starts tracing\n");
 747                 printk("\tsyscall stop: stops tracing.\n");
 748                 printk("\tcoretf COREID: prints PC, -1 for all cores, verbose => TF\n");
 749                 printk("\tpcpui [type [coreid]]: runs pcpui trace ring handlers\n");
 750                 printk("\tpcpui-reset [noclear]: resets/clears pcpui trace ring\n");
 751                 printk("\tverbose: toggles verbosity, depends on trace command\n");
 752                 return 1;
 753         }
 754         if (!strcmp(argv[1], "syscall")) {
 755                 if (argc < 3) {
 756                         printk("Need a start or stop.\n");
 757                         return 1;
 758                 }
 759                 if (!strcmp(argv[2], "start")) {
 760                         systrace_loud = TRUE;
 761                 } else if (!strcmp(argv[2], "stop")) {
 762                         systrace_loud = FALSE;
 763                 } else {
 764                         printk("Need a start or stop.\n");
 765                         return 1;
 766                 }
 767         } else if (!strcmp(argv[1], "coretf")) {
 768                 if (argc != 3) {
 769                         printk("Need a coreid, fool.\n");
 770                         return 1;
 771                 }
 772                 core = strtol(argv[2], 0, 0);
 773                 if (core < 0) {
 774                         printk("Sending NMIs to all cores:\n");
 775                         for (int i = 0; i < num_cores; i++) {
 776                                 _PERCPU_VAR(mon_nmi_trace, i) = TRUE;
 777                                 send_nmi(i);
 778                                 udelay(1000000);
 779                         }
 780                 } else {
 781                         printk("Sending NMI core %d:\n", core);
 782                         if (core >= num_cores) {
 783                                 printk("No such core!  Maybe it's in another cell...\n");
 784                                 return 1;
 785                         }
 786                         _PERCPU_VAR(mon_nmi_trace, core) = TRUE;
 787                         send_nmi(core);
 788                 }
 789                 udelay(1000000);
 790         } else if (!strcmp(argv[1], "pcpui")) {
 791                 int pcpui_type, pcpui_coreid;
 792                 if (argc >= 3)
 793                         pcpui_type = strtol(argv[2], 0, 0);
 794                 else
 795                         pcpui_type = 0;
 796                 printk("\nRunning PCPUI Trace Ring handlers for type %d\n", pcpui_type);
 797                 if (argc >= 4) {
 798                         pcpui_coreid = strtol(argv[3], 0, 0);
 799                         pcpui_tr_foreach(pcpui_coreid, pcpui_type);
 800                 } else {
 801                         pcpui_tr_foreach_all(pcpui_type);
 802                 }
 803         } else if (!strcmp(argv[1], "pcpui-reset")) {
 804                 if (argc >= 3) {
 805                         printk("\nResetting all PCPUI Trace Rings\n");
 806                         pcpui_tr_reset_all();
 807                 } else {
 808                         printk("\nResetting and clearing all PCPUI Trace Rings\n");
 809                         pcpui_tr_reset_and_clear_all();
 810                 }
 811         } else if (!strcmp(argv[1], "verbose")) {
 812                 if (mon_verbose_trace) {
 813                         printk("Turning trace verbosity off\n");
 814                         mon_verbose_trace = FALSE;
 815                 } else {
 816                         printk("Turning trace verbosity on\n");
 817                         mon_verbose_trace = TRUE;
 818                 }
 819         } else if (!strcmp(argv[1], "opt2")) {
 820                 if (argc != 3) {
 821                         printk("ERRRRRRRRRR.\n");
 822                         return 1;
 823                 }
 824                 print_proc_info(strtol(argv[2], 0, 0), 0);
 825         } else {
 826                 printk("Bad option\n");
 827                 return 1;
 828         }
 829         return 0;
 830 }
 831
 832 int mon_monitor(int argc, char **argv, struct hw_trapframe *hw_tf)
 833 {
 834         if (argc < 2) {
 835                 printk("Usage: monitor COREID\n");
 836                 return 1;
 837         }
 838         uint32_t core = strtol(argv[1], 0, 0);
 839         if (core >= num_cores) {
 840                 printk("No such core!  Maybe it's in another cell...\n");
 841                 return 1;
 842         }
 843         send_kernel_message(core, __run_mon, 0, 0, 0, KMSG_ROUTINE);
 844         return 0;
 845 }
 846
 847 /***** Kernel monitor command interpreter *****/
 848
 849 #define WHITESPACE "\t\r\n "
 850 #define MAXARGS 16
 851
 852
 853 int onecmd(int argc, char *argv[], struct hw_trapframe *hw_tf) {
 854         int i;
 855         if (!argc)
 856                 return -1;
 857         for (i = 0; i < NCOMMANDS; i++) {
 858                 if (strcmp(argv[0], commands[i].name) == 0)
 859                         return commands[i].func(argc, argv, hw_tf);
 860         }
 861         return -1;
 862 }
 863
 864 void __run_mon(uint32_t srcid, long a0, long a1, long a2)
 865 {
 866         monitor(0);
 867 }
 868
 869 static int runcmd(char *real_buf, struct hw_trapframe *hw_tf) {
 870         char * buf = real_buf;
 871         int argc;
 872         char *argv[MAXARGS];
 873         int i;
 874
 875         // Parse the command buffer into whitespace-separated arguments
 876         argc = 0;
 877         argv[argc] = 0;
 878         while (1) {
 879                 // gobble whitespace
 880                 while (*buf && strchr(WHITESPACE, *buf))
 881                         *buf++ = 0;
 882                 if (*buf == 0)
 883                         break;
 884
 885                 // save and scan past next arg
 886                 if (argc == MAXARGS-1) {
 887                         cprintf("Too many arguments (max %d)\n", MAXARGS);
 888                         return 0;
 889                 }
 890                 //This will get fucked at runtime..... in the ASS
 891                 argv[argc++] = buf;
 892                 while (*buf && !strchr(WHITESPACE, *buf))
 893                         buf++;
 894         }
 895         argv[argc] = 0;
 896
 897         // Lookup and invoke the command
 898         if (argc == 0)
 899                 return 0;
 900         for (i = 0; i < NCOMMANDS; i++) {
 901                 if (strcmp(argv[0], commands[i].name) == 0)
 902                         return commands[i].func(argc, argv, hw_tf);
 903         }
 904         cprintf("Unknown command '%s'\n", argv[0]);
 905         return 0;
 906 }
 907
 908 void monitor(struct hw_trapframe *hw_tf)
 909 {
 910         #define MON_CMD_LENGTH 256
 911         char buf[MON_CMD_LENGTH];
 912         int cnt;
 913         int coreid = core_id_early();
 914
 915         /* they are always disabled, since we have this irqsave lock */
 916         if (irq_is_enabled())
 917                 printk("Entering Nanwan's Dungeon on Core %d (Ints on):\n", coreid);
 918         else
 919                 printk("Entering Nanwan's Dungeon on Core %d (Ints off):\n", coreid);
 920         printk("Type 'help' for a list of commands.\n");
 921
 922         if (hw_tf != NULL)
 923                 print_trapframe(hw_tf);
 924
 925         while (1) {
 926                 /* on occasion, the kernel monitor can migrate (like if you run
 927                  * something that blocks / syncs and wakes up on another core) */
 928                 cmb();
 929                 cnt = readline(buf, MON_CMD_LENGTH, "ROS(Core %d)> ", core_id_early());
 930                 if (cnt > 0) {
 931                         buf[cnt] = 0;
 932                         if (runcmd(buf, hw_tf) < 0)
 933                                 break;
 934                 }
 935         }
 936 }
 937
 938 static void pm_flusher(void *unused)
 939 {
 940         struct super_block *sb;
 941         struct inode *inode;
 942         unsigned long nr_pages;
 943
 944         /* could also put the delay between calls, or even within remove, during the
 945          * WB phase. */
 946         printk("GIANT WARNING: the pm_flusher is running and will never stop!\n");
 947         while (1) {
 948                 kthread_usleep(5000);
 949                 TAILQ_FOREACH(sb, &super_blocks, s_list) {
 950                         TAILQ_FOREACH(inode, &sb->s_inodes, i_sb_list) {
 951                                 nr_pages = ROUNDUP(inode->i_size, PGSIZE) >> PGSHIFT;
 952                                 if (nr_pages)
 953                                         pm_remove_contig(inode->i_mapping, 0, nr_pages);
 954                         }
 955                 }
 956         }
 957 }
 958
 959 int mon_fs(int argc, char **argv, struct hw_trapframe *hw_tf)
 960 {
 961         /* this assumes one mounted FS at the NS root */
 962         struct super_block *sb;
 963         struct file *file;
 964         struct inode *inode;
 965         struct dentry *dentry;
 966         if (argc < 2) {
 967                 printk("Usage: fs OPTION\n");
 968                 printk("\topen: show all open files\n");
 969                 printk("\tinodes: show all inodes\n");
 970                 printk("\tdentries [lru|prune]: show all dentries, opt LRU/prune\n");
 971                 printk("\tls DIR: print the dir tree starting with DIR\n");
 972                 printk("\tpid: proc PID's fs crap placeholder\n");
 973                 printk("\tpmflusher: start a ktask to keep flushing all PMs\n");
 974                 return 1;
 975         }
 976         if (!strcmp(argv[1], "open")) {
 977                 printk("Open Files:\n----------------------------\n");
 978                 TAILQ_FOREACH(sb, &super_blocks, s_list) {
 979                         printk("Superblock for %s\n", sb->s_name);
 980                         TAILQ_FOREACH(file, &sb->s_files, f_list)
 981                                 printk("File: %p, %s, Refs: %d, Drefs: %d, Irefs: %d PM: %p\n",
 982                                        file, file_name(file), kref_refcnt(&file->f_kref),
 983                                        kref_refcnt(&file->f_dentry->d_kref),
 984                                        kref_refcnt(&file->f_dentry->d_inode->i_kref),
 985                                            file->f_mapping);
 986                 }
 987         } else if (!strcmp(argv[1], "inodes")) {
 988                 printk("Mounted FS Inodes:\n----------------------------\n");
 989                 TAILQ_FOREACH(sb, &super_blocks, s_list) {
 990                         printk("Superblock for %s\n", sb->s_name);
 991                         TAILQ_FOREACH(inode, &sb->s_inodes, i_sb_list) {
 992                                 printk("Inode: %p, Refs: %d, Nlinks: %d, Size(B): %d\n",
 993                                        inode, kref_refcnt(&inode->i_kref), inode->i_nlink,
 994                                        inode->i_size);
 995                                 TAILQ_FOREACH(dentry, &inode->i_dentry, d_alias)
 996                                         printk("\t%s: Dentry: %p, Refs: %d\n",
 997                                                dentry->d_name.name, dentry,
 998                                                kref_refcnt(&dentry->d_kref));
 999                         }
1000                 }
1001         } else if (!strcmp(argv[1], "dentries")) {
1002                 printk("Dentry Cache:\n----------------------------\n");
1003                 TAILQ_FOREACH(sb, &super_blocks, s_list) {
1004                         printk("Superblock for %s\n", sb->s_name);
1005                         printk("DENTRY     FLAGS      REFCNT NAME\n");
1006                         printk("--------------------------------\n");
1007                         /* Hash helper */
1008                         void print_dcache_entry(void *item, void *opaque)
1009                         {
1010                                 struct dentry *d_i = (struct dentry*)item;
1011                                 printk("%p %p %02d     %s\n", d_i, d_i->d_flags,
1012                                        kref_refcnt(&d_i->d_kref), d_i->d_name.name);
1013                         }
1014                         hash_for_each(sb->s_dcache, print_dcache_entry, NULL);
1015                 }
1016                 if (argc < 3)
1017                         return 0;
1018                 if (!strcmp(argv[2], "lru")) {
1019                         printk("LRU lists:\n");
1020                         TAILQ_FOREACH(sb, &super_blocks, s_list) {
1021                                 printk("Superblock for %s\n", sb->s_name);
1022                                 TAILQ_FOREACH(dentry, &sb->s_lru_d, d_lru)
1023                                         printk("Dentry: %p, Name: %s\n", dentry,
1024                                                dentry->d_name.name);
1025                         }
1026                 } else if (!strcmp(argv[2], "prune")) {
1027                         printk("Pruning unused dentries\n");
1028                         TAILQ_FOREACH(sb, &super_blocks, s_list)
1029                                 dcache_prune(sb, FALSE);
1030                 }
1031         } else if (!strcmp(argv[1], "ls")) {
1032                 if (argc != 3) {
1033                         printk("Give me a dir.\n");
1034                         return 1;
1035                 }
1036                 if (argv[2][0] != '/') {
1037                         printk("Dear fellow giraffe lover, Use absolute paths.\n");
1038                         return 1;
1039                 }
1040                 ls_dash_r(argv[2]);
1041                 /* whatever.  placeholder. */
1042         } else if (!strcmp(argv[1], "pid")) {
1043                 if (argc != 3) {
1044                         printk("Give me a pid number.\n");
1045                         return 1;
1046                 }
1047                 /* whatever.  placeholder. */
1048         } else if (!strcmp(argv[1], "pmflusher")) {
1049                 ktask("pm_flusher", pm_flusher, 0);
1050         } else {
1051                 printk("Bad option\n");
1052                 return 1;
1053         }
1054         return 0;
1055 }
1056
1057 int mon_shell(int argc, char **argv, struct hw_trapframe *hw_tf)
1058 {
1059         char *l_argv[2] = {"/bin/bash", "bash"};
1060         return mon_bin_run(2, l_argv, hw_tf);
1061 }
1062
1063 int mon_alarm(int argc, char **argv, struct hw_trapframe *hw_tf)
1064 {
1065         if (argc < 2) {
1066                 printk("Usage: alarm OPTION\n");
1067                 printk("\tpcpu: print full alarm tchains from every core\n");
1068                 return 1;
1069         }
1070         if (!strcmp(argv[1], "pcpu")) {
1071                 print_pcpu_chains();
1072         } else {
1073                 printk("Bad option\n");
1074                 return 1;
1075         }
1076         return 0;
1077 }
1078
1079 static void show_msr(struct hw_trapframe *unused, void *v)
1080 {
1081         int core = core_id();
1082         uint64_t val;
1083         uint32_t msr = *(uint32_t *)v;
1084         val = read_msr(msr);
1085         printk("%d: %08x: %016llx\n", core, msr, val);
1086 }
1087
1088 struct set {
1089         uint32_t msr;
1090         uint64_t val;
1091 };
1092
1093 static void set_msr(struct hw_trapframe *unused, void *v)
1094 {
1095         int core = core_id();
1096         struct set *s = v;
1097         uint32_t msr = s->msr;
1098         uint64_t val = s->val;
1099         write_msr(msr, val);
1100         val = read_msr(msr);
1101         printk("%d: %08x: %016llx\n", core, msr, val);
1102 }
1103
1104 int mon_msr(int argc, char **argv, struct hw_trapframe *hw_tf)
1105 {
1106 #ifndef CONFIG_X86
1107         cprintf("Not on this architecture\n");
1108         return 1;
1109 #else
1110         uint64_t val;
1111         uint32_t msr;
1112         if (argc < 2 || argc > 3) {
1113                 printk("Usage: msr register [value]\n");
1114                 return 1;
1115         }
1116         msr = strtoul(argv[1], 0, 16);
1117         handler_wrapper_t *w;
1118         smp_call_function_all(show_msr, &msr, &w);
1119         smp_call_wait(w);
1120
1121         if (argc < 3)
1122                 return 0;
1123         /* somewhat bogus on 32 bit. */
1124         val = strtoul(argv[2], 0, 16);
1125
1126         struct set set;
1127         set.msr = msr;
1128         set.val = val;
1129         smp_call_function_all(set_msr, &set, &w);
1130         smp_call_wait(w);
1131         return 0;
1132 #endif
1133 }
1134
1135 int mon_db(int argc, char **argv, struct hw_trapframe *hw_tf)
1136 {
1137         pid_t pid = -1;
1138
1139         if (argc < 2) {
1140                 printk("Usage: db OPTION\n");
1141                 printk("\tsem [PID]: print all semaphore info\n");
1142                 printk("\taddr PID 0xADDR: for PID lookup ADDR's file/vmr info\n");
1143                 return 1;
1144         }
1145         if (!strcmp(argv[1], "sem")) {
1146                 if (argc > 2)
1147                         pid = strtol(argv[2], 0, 0);
1148                 print_all_sem_info(pid);
1149         } else if (!strcmp(argv[1], "addr")) {
1150                 if (argc < 4) {
1151                         printk("Usage: db addr PID 0xADDR\n");
1152                         return 1;
1153                 }
1154                 debug_addr_pid(strtol(argv[2], 0, 10), strtol(argv[3], 0, 16));
1155         } else {
1156                 printk("Bad option\n");
1157                 return 1;
1158         }
1159         return 0;
1160 }
1161
1162 int mon_px(int argc, char **argv, struct hw_trapframe *hw_tf)
1163 {
1164         set_printx(2);
1165         printk("Printxing is now %sabled\n", printx_on ? "en" : "dis");
1166         return 0;
1167 }
1168
1169 /* Super hack.  Given a kernel hw_tf, we hack the RIP to smp_idle, then return
1170  * to it.  Any locks or other stuff being done is completely lost, so you could
1171  * deadlock.  This gets out of the "we're totall screwed, but don't want to
1172  * reboot right now", typically caused by screw-ups from the monitor. */
1173 int mon_kpfret(int argc, char **argv, struct hw_trapframe *hw_tf)
1174 {
1175         struct per_cpu_info *pcpui = &per_cpu_info[core_id()];
1176
1177         /* if monitor had a TF, try to use that */
1178         if (!hw_tf) {
1179                 if (argc < 2) {
1180                         printk("Usage: kpfret HW_TF\n");
1181                         return 1;
1182                 }
1183                 /* the hw_tf passed in is the one we got from monitor, which is 0 from
1184                  * panics. */
1185                 hw_tf = (struct hw_trapframe*)strtol(argv[1], 0, 16);
1186         }
1187
1188         if (!in_kernel(hw_tf)) {
1189                 printk("hw_tf %p was not a kernel tf!\n", hw_tf);
1190                 return -1;
1191         }
1192
1193 #ifdef CONFIG_X86
1194         hw_tf->tf_rip = (uintptr_t)smp_idle;
1195         dec_ktrap_depth(pcpui);
1196
1197         asm volatile("mov %0, %%rsp;"
1198                      "addq $0x10, %%rsp;"
1199                      "popq %%rax;"
1200                      "popq %%rbx;"
1201                      "popq %%rcx;"
1202                      "popq %%rdx;"
1203                      "popq %%rbp;"
1204                      "popq %%rsi;"
1205                      "popq %%rdi;"
1206                      "popq %%r8;"
1207                      "popq %%r9;"
1208                      "popq %%r10;"
1209                      "popq %%r11;"
1210                      "popq %%r12;"
1211                      "popq %%r13;"
1212                      "popq %%r14;"
1213                      "popq %%r15;"
1214                      "addq $0x10, %%rsp;"
1215                      "iretq;"
1216                                  : : "r"(hw_tf));
1217         assert(0);
1218 #else
1219         printk("KPF return not supported\n");
1220         return -1;
1221 #endif /* CONFIG_X86 */
1222 }
1223
1224 int mon_ks(int argc, char **argv, struct hw_trapframe *hw_tf)
1225 {
1226         if (argc < 2) {
1227 usage:
1228                 printk("Usage: ks OPTION\n");
1229                 printk("\tidles: show idle core map\n");
1230                 printk("\tdiag: scheduler diagnostic report\n");
1231                 printk("\tresources: show resources wanted/granted for all procs\n");
1232                 printk("\tsort: sorts the idlecoremap, 1..n\n");
1233                 printk("\tnc PCOREID: sets the next CG core allocated\n");
1234                 return 1;
1235         }
1236         if (!strcmp(argv[1], "idles")) {
1237                 print_idle_core_map();
1238         } else if (!strcmp(argv[1], "diag")) {
1239                 sched_diag();
1240         } else if (!strcmp(argv[1], "resources")) {
1241                 print_all_resources();
1242         } else if (!strcmp(argv[1], "sort")) {
1243                 sort_idle_cores();
1244         } else if (!strcmp(argv[1], "nc")) {
1245                 if (argc != 3) {
1246                         printk("Need a pcore number.\n");
1247                         return 1;
1248                 }
1249                 next_core_to_alloc(strtol(argv[2], 0, 0));
1250         } else {
1251                 printk("Bad option %s\n", argv[1]);
1252                 goto usage;
1253         }
1254         return 0;
1255 }
1256
1257 /* Prints info about a core.  Optional first arg == coreid. */
1258 int mon_coreinfo(int argc, char **argv, struct hw_trapframe *hw_tf)
1259 {
1260         struct per_cpu_info *pcpui;
1261         struct kthread *kth;
1262         int coreid = core_id();
1263
1264         if (argc >= 2)
1265                 coreid = strtol(argv[1], 0, 0);
1266         pcpui = &per_cpu_info[coreid];
1267         printk("Core %d:\n\tcur_proc %d\n\towning proc %d, owning vc %d\n",
1268                coreid, pcpui->cur_proc ? pcpui->cur_proc->pid : 0,
1269                pcpui->owning_proc ? pcpui->owning_proc->pid : 0,
1270                pcpui->owning_vcoreid != 0xdeadbeef ? pcpui->owning_vcoreid : 0);
1271         kth = pcpui->cur_kthread;
1272         if (kth) {
1273                 /* kth->proc is only used when the kthread is sleeping.  when it's
1274                  * running, we care about cur_proc.  if we're here, proc should be 0
1275                  * unless the kth is concurrently sleeping (we called this remotely) */
1276                 printk("\tkthread %p (%s), sysc %p (%d)\n", kth, kth->name,
1277                        kth->sysc, kth->sysc ? kth->sysc->num : -1);
1278         } else {
1279                 /* Can happen during early boot */
1280                 printk("\tNo kthread!\n");
1281         }
1282         return 0;
1283 }