Alias "e" to monitor's "exit"
[akaros.git] / kern / src / schedule.c
index eda43f2..8512851 100644 (file)
@@ -4,10 +4,6 @@
  *
  * Scheduling and dispatching. */
 
-#ifdef __SHARC__
-#pragma nosharc
-#endif
-
 #include <schedule.h>
 #include <process.h>
 #include <monitor.h>
@@ -19,6 +15,7 @@
 #include <alarm.h>
 #include <sys/queue.h>
 #include <kmalloc.h>
+#include <arsc_server.h>
 
 /* Process Lists.  'unrunnable' is a holding list for SCPs that are running or
  * waiting or otherwise not considered for sched decisions. */
@@ -39,7 +36,6 @@ struct sched_pcore_tailq idlecores = TAILQ_HEAD_INITIALIZER(idlecores);
 
 /* Helper, defined below */
 static void __core_request(struct proc *p, uint32_t amt_needed);
-static void __put_idle_cores(struct proc *p, uint32_t *pc_arr, uint32_t num);
 static void add_to_list(struct proc *p, struct proc_list *list);
 static void remove_from_list(struct proc *p, struct proc_list *list);
 static void switch_lists(struct proc *p, struct proc_list *old,
@@ -67,7 +63,7 @@ static uint32_t get_cores_needed(struct proc *p);
  *
  * As the ksched gets smarter, we'll probably embedd this poker in a bigger
  * struct that can handle the posting of different types of work. */
-struct poke_tracker ksched_poker = {0, 0, __run_mcp_ksched};
+struct poke_tracker ksched_poker = POKE_INITIALIZER(__run_mcp_ksched);
 
 /* this 'big ksched lock' protects a bunch of things, which i may make fine
  * grained: */
@@ -97,15 +93,20 @@ static void set_ksched_alarm(void)
        set_alarm(&per_cpu_info[core_id()].tchain, &ksched_waiter);
 }
 
-/* Kmsg, to run the scheduler tick (not in interrupt context) and reset the
+/* Need a kmsg to just run the sched, but not to rearm */
+static void __just_sched(uint32_t srcid, long a0, long a1, long a2)
+{
+       run_scheduler();
+}
+
+/* RKM alarm, to run the scheduler tick (not in interrupt context) and reset the
  * alarm.  Note that interrupts will be disabled, but this is not the same as
  * interrupt context.  We're a routine kmsg, which means the core is in a
  * quiescent state. */
-static void __ksched_tick(struct trapframe *tf, uint32_t srcid, long a0,
-                          long a1, long a2)
+static void __ksched_tick(struct alarm_waiter *waiter)
 {
        /* TODO: imagine doing some accounting here */
-       schedule();
+       run_scheduler();
        /* Set our alarm to go off, incrementing from our last tick (instead of
         * setting it relative to now, since some time has passed since the alarm
         * first went off.  Note, this may be now or in the past! */
@@ -113,44 +114,34 @@ static void __ksched_tick(struct trapframe *tf, uint32_t srcid, long a0,
        set_alarm(&per_cpu_info[core_id()].tchain, &ksched_waiter);
 }
 
-/* Interrupt/alarm handler: tells our core to run the scheduler (out of
- * interrupt context). */
-static void __kalarm(struct alarm_waiter *waiter)
-{
-       send_kernel_message(core_id(), __ksched_tick, 0, 0, 0, KMSG_ROUTINE);
-}
-
 void schedule_init(void)
 {
        spin_lock(&sched_lock);
        /* init provisioning stuff */
-       all_pcores = kmalloc(sizeof(struct sched_pcore) * num_cpus, 0);
-       memset(all_pcores, 0, sizeof(struct sched_pcore) * num_cpus);
+       all_pcores = kmalloc(sizeof(struct sched_pcore) * num_cores, 0);
+       memset(all_pcores, 0, sizeof(struct sched_pcore) * num_cores);
        assert(!core_id());             /* want the alarm on core0 for now */
-       init_awaiter(&ksched_waiter, __kalarm);
+       init_awaiter(&ksched_waiter, __ksched_tick);
        set_ksched_alarm();
        /* init the idlecore list.  if they turned off hyperthreading, give them the
         * odds from 1..max-1.  otherwise, give them everything by 0 (default mgmt
         * core).  TODO: (CG/LL) better LL/CG mgmt */
-#ifndef __CONFIG_DISABLE_SMT__
-       for (int i = 1; i < num_cpus; i++)
+#ifndef CONFIG_DISABLE_SMT
+       for (int i = 1; i < num_cores; i++)
                TAILQ_INSERT_TAIL(&idlecores, pcoreid2spc(i), alloc_next);
 #else
-       assert(!(num_cpus % 2));
-       for (int i = 1; i < num_cpus; i += 2)
+       assert(!(num_cores % 2));
+       for (int i = 1; i < num_cores; i += 2)
                TAILQ_INSERT_TAIL(&idlecores, pcoreid2spc(i), alloc_next);
-#endif /* __CONFIG_DISABLE_SMT__ */
-#ifdef __CONFIG_ARSC_SERVER__
-       struct sched_pcore *a_core = TAILQ_FIRST(&idlecores);
-       assert(a_core);
-       TAILQ_REMOVE(&idlecores, a_core, alloc_next);
-       send_kernel_message(spc2pcoreid(a_core), (amr_t)arsc_server, 0, 0, 0,
-                           KMSG_ROUTINE);
-       warn("Using core %d for the ARSCs - there are probably issues with this.",
-            spc2pcoreid(a_core));
-#endif /* __CONFIG_ARSC_SERVER__ */
+#endif /* CONFIG_DISABLE_SMT */
        spin_unlock(&sched_lock);
-       return;
+
+#ifdef CONFIG_ARSC_SERVER
+       int arsc_coreid = get_any_idle_core();
+       assert(arsc_coreid >= 0);
+       send_kernel_message(arsc_coreid, arsc_server, 0, 0, 0, KMSG_ROUTINE);
+       printk("Using core %d for the ARSC server\n", arsc_coreid);
+#endif /* CONFIG_ARSC_SERVER */
 }
 
 static uint32_t spc2pcoreid(struct sched_pcore *spc)
@@ -166,6 +157,7 @@ static struct sched_pcore *pcoreid2spc(uint32_t pcoreid)
 /* Round-robins on whatever list it's on */
 static void add_to_list(struct proc *p, struct proc_list *new)
 {
+       assert(!(p->ksched_data.cur_list));
        TAILQ_INSERT_TAIL(new, p, ksched_data.proc_link);
        p->ksched_data.cur_list = new;
 }
@@ -174,6 +166,7 @@ static void remove_from_list(struct proc *p, struct proc_list *old)
 {
        assert(p->ksched_data.cur_list == old);
        TAILQ_REMOVE(old, p, ksched_data.proc_link);
+       p->ksched_data.cur_list = 0;
 }
 
 static void switch_lists(struct proc *p, struct proc_list *old,
@@ -183,17 +176,13 @@ static void switch_lists(struct proc *p, struct proc_list *old,
        add_to_list(p, new);
 }
 
-static void __remove_from_any_list(struct proc *p)
-{
-       if (p->ksched_data.cur_list)
-               TAILQ_REMOVE(p->ksched_data.cur_list, p, ksched_data.proc_link);
-}
-
 /* Removes from whatever list p is on */
 static void remove_from_any_list(struct proc *p)
 {
-       assert(p->ksched_data.cur_list);
-       TAILQ_REMOVE(p->ksched_data.cur_list, p, ksched_data.proc_link);
+       if (p->ksched_data.cur_list) {
+               TAILQ_REMOVE(p->ksched_data.cur_list, p, ksched_data.proc_link);
+               p->ksched_data.cur_list = 0;
+       }
 }
 
 /************** Process Management Callbacks **************/
@@ -270,12 +259,11 @@ void __sched_proc_destroy(struct proc *p, uint32_t *pc_arr, uint32_t nr_cores)
         * bulk *provisioning* change. */
        unprov_pcore_list(&p->ksched_data.prov_alloc_me);
        unprov_pcore_list(&p->ksched_data.prov_not_alloc_me);
-       /* Remove from whatever list we are on */
+       /* Remove from whatever list we are on (if any - might not be on one if it
+        * was in the middle of __run_mcp_sched) */
        remove_from_any_list(p);
-       if (nr_cores) {
-               __put_idle_cores(p, pc_arr, nr_cores);
+       if (nr_cores)
                __prov_track_dealloc_bulk(p, pc_arr, nr_cores);
-       }
        spin_unlock(&sched_lock);
        /* Drop the cradle-to-the-grave reference, jet-li */
        proc_decref(p);
@@ -289,10 +277,7 @@ void __sched_mcp_wakeup(struct proc *p)
                spin_unlock(&sched_lock);
                return;
        }
-       /* could try and prioritize p somehow (move it to the front of the list).
-        * for now, just help them out a bit (mild help here, can remove this) */
-       if (!p->procdata->res_req[RES_CORES].amt_wanted)
-               p->procdata->res_req[RES_CORES].amt_wanted = 1;
+       /* could try and prioritize p somehow (move it to the front of the list). */
        spin_unlock(&sched_lock);
        /* note they could be dying at this point too. */
        poke(&ksched_poker, p);
@@ -307,9 +292,26 @@ void __sched_scp_wakeup(struct proc *p)
                return;
        }
        /* might not be on a list if it is new.  o/w, it should be unrunnable */
-       __remove_from_any_list(p);
+       remove_from_any_list(p);
        add_to_list(p, &runnable_scps);
        spin_unlock(&sched_lock);
+       /* we could be on a CG core, and all the mgmt cores could be halted.  if we
+        * don't tell one of them about the new proc, they will sleep until the
+        * timer tick goes off. */
+       if (!management_core()) {
+               /* TODO: pick a better core and only send if halted.
+                *
+                * FYI, a POKE on x86 might lose a rare race with halt code, since the
+                * poke handler does not abort halts.  if this happens, the next timer
+                * IRQ would wake up the core.
+                *
+                * ideally, we'd know if a specific mgmt core is sleeping and wake it
+                * up.  o/w, we could interrupt an already-running mgmt core that won't
+                * get to our new proc anytime soon.  also, by poking core 0, a
+                * different mgmt core could remain idle (and this process would sleep)
+                * until its tick goes off */
+               send_ipi(0, I_POKE_CORE);
+       }
 }
 
 /* Callback to return a core to the ksched, which tracks it as idle and
@@ -321,30 +323,14 @@ void __sched_put_idle_core(struct proc *p, uint32_t coreid)
 {
        struct sched_pcore *spc = pcoreid2spc(coreid);
        spin_lock(&sched_lock);
-       TAILQ_INSERT_TAIL(&idlecores, spc, alloc_next);
        __prov_track_dealloc(p, coreid);
        spin_unlock(&sched_lock);
 }
 
-/* Helper for put_idle and core_req.  Note this does not track_dealloc.  When we
- * get rid of / revise proc_preempt_all and put_idle_cores, we can get rid of
- * this.  (the ksched will never need it - only external callers). */
-static void __put_idle_cores(struct proc *p, uint32_t *pc_arr, uint32_t num)
-{
-       struct sched_pcore *spc_i;
-       for (int i = 0; i < num; i++) {
-               spc_i = pcoreid2spc(pc_arr[i]);
-               TAILQ_INSERT_TAIL(&idlecores, spc_i, alloc_next);
-       }
-}
-
-/* Callback, bulk interface for put_idle.  Note this one also calls track_dealloc,
- * which the internal version does not.  The proclock is held for this. */
+/* Callback, bulk interface for put_idle. The proclock is held for this. */
 void __sched_put_idle_cores(struct proc *p, uint32_t *pc_arr, uint32_t num)
 {
        spin_lock(&sched_lock);
-       /* TODO: when we revise this func, look at __put_idle */
-       __put_idle_cores(p, pc_arr, num);
        __prov_track_dealloc_bulk(p, pc_arr, num);
        spin_unlock(&sched_lock);
        /* could trigger a sched decision here */
@@ -363,18 +349,33 @@ static bool __schedule_scp(void)
        /* if there are any runnables, run them here and put any currently running
         * SCP on the tail of the runnable queue. */
        if ((p = TAILQ_FIRST(&runnable_scps))) {
-               /* protect owning proc, cur_tf, etc.  note this nests with the
+               /* protect owning proc, cur_ctx, etc.  note this nests with the
                 * calls in proc_yield_s */
                disable_irqsave(&state);
                /* someone is currently running, dequeue them */
                if (pcpui->owning_proc) {
+                       spin_lock(&pcpui->owning_proc->proc_lock);
+                       /* process might be dying, with a KMSG to clean it up waiting on
+                        * this core.  can't do much, so we'll attempt to restart */
+                       if (pcpui->owning_proc->state == PROC_DYING) {
+                               send_kernel_message(core_id(), __just_sched, 0, 0, 0,
+                                                   KMSG_ROUTINE);
+                               spin_unlock(&pcpui->owning_proc->proc_lock);
+                               enable_irqsave(&state);
+                               return FALSE;
+                       }
                        printd("Descheduled %d in favor of %d\n", pcpui->owning_proc->pid,
                               p->pid);
-                       /* locking just to be safe */
-                       spin_lock(&p->proc_lock);
                        __proc_set_state(pcpui->owning_proc, PROC_RUNNABLE_S);
-                       __proc_save_context_s(pcpui->owning_proc, pcpui->cur_tf);
-                       spin_unlock(&p->proc_lock);
+                       /* Saving FP state aggressively.  Odds are, the SCP was hit by an
+                        * IRQ and has a HW ctx, in which case we must save. */
+                       __proc_save_fpu_s(pcpui->owning_proc);
+                       __proc_save_context_s(pcpui->owning_proc, pcpui->cur_ctx);
+                       vcore_account_offline(pcpui->owning_proc, 0);
+                       __seq_start_write(&p->procinfo->coremap_seqctr);
+                       __unmap_vcore(p, 0);
+                       __seq_end_write(&p->procinfo->coremap_seqctr);
+                       spin_unlock(&pcpui->owning_proc->proc_lock);
                        /* round-robin the SCPs (inserts at the end of the queue) */
                        switch_lists(pcpui->owning_proc, &unrunnable_scps, &runnable_scps);
                        clear_owning_proc(pcoreid);
@@ -404,6 +405,18 @@ static uint32_t get_cores_needed(struct proc *p)
        /* Help them out - if they ask for something impossible, give them 1 so they
         * can make some progress. (this is racy, and unnecessary). */
        if (amt_wanted > p->procinfo->max_vcores) {
+               printk("[kernel] proc %d wanted more than max, wanted %d\n", p->pid,
+                      amt_wanted);
+               p->procdata->res_req[RES_CORES].amt_wanted = 1;
+               amt_wanted = 1;
+       }
+       /* There are a few cases where amt_wanted is 0, but they are still RUNNABLE
+        * (involving yields, events, and preemptions).  In these cases, give them
+        * at least 1, so they can make progress and yield properly.  If they are
+        * not WAITING, they did not yield and may have missed a message. */
+       if (!amt_wanted) {
+               /* could ++, but there could be a race and we don't want to give them
+                * more than they ever asked for (in case they haven't prepped) */
                p->procdata->res_req[RES_CORES].amt_wanted = 1;
                amt_wanted = 1;
        }
@@ -486,8 +499,11 @@ static void __run_mcp_ksched(void *arg)
 /* Something has changed, and for whatever reason the scheduler should
  * reevaluate things. 
  *
+ * Don't call this if you are processing a syscall or otherwise care about your
+ * kthread variables, cur_proc/owning_proc, etc.
+ *
  * Don't call this from interrupt context (grabs proclocks). */
-void schedule(void)
+void run_scheduler(void)
 {
        /* MCP scheduling: post work, then poke.  for now, i just want the func to
         * run again, so merely a poke is sufficient. */
@@ -502,7 +518,7 @@ void schedule(void)
 /* A process is asking the ksched to look at its resource desires.  The
  * scheduler is free to ignore this, for its own reasons, so long as it
  * eventually gets around to looking at resource desires. */
-void poke_ksched(struct proc *p, int res_type)
+void poke_ksched(struct proc *p, unsigned int res_type)
 {
        /* ignoring res_type for now.  could post that if we wanted (would need some
         * other structs/flags) */
@@ -542,15 +558,83 @@ void avail_res_changed(int res_type, long change)
        printk("[kernel] ksched doesn't track any resources yet!\n");
 }
 
+int get_any_idle_core(void)
+{
+       struct sched_pcore *spc;
+       int ret = -1;
+       spin_lock(&sched_lock);
+       while ((spc = TAILQ_FIRST(&idlecores))) {
+               /* Don't take cores that are provisioned to a process */
+               if (spc->prov_proc)
+                       continue;
+               assert(!spc->alloc_proc);
+               TAILQ_REMOVE(&idlecores, spc, alloc_next);
+               ret = spc2pcoreid(spc);
+               break;
+       }
+       spin_unlock(&sched_lock);
+       return ret;
+}
+
+/* TODO: if we end up using this a lot, track CG-idleness as a property of the
+ * SPC instead of doing a linear search. */
+static bool __spc_is_idle(struct sched_pcore *spc)
+{
+       struct sched_pcore *i;
+       TAILQ_FOREACH(i, &idlecores, alloc_next) {
+               if (spc == i)
+                       return TRUE;
+       }
+       return FALSE;
+}
+
+int get_specific_idle_core(int coreid)
+{
+       struct sched_pcore *spc = pcoreid2spc(coreid);
+       int ret = -1;
+       assert((0 <= coreid) && (coreid < num_cores));
+       spin_lock(&sched_lock);
+       if (__spc_is_idle(pcoreid2spc(coreid)) && !spc->prov_proc) {
+               assert(!spc->alloc_proc);
+               TAILQ_REMOVE(&idlecores, spc, alloc_next);
+               ret = coreid;
+       }
+       spin_unlock(&sched_lock);
+       return ret;
+}
+
+/* similar to __sched_put_idle_core, but without the prov tracking */
+void put_idle_core(int coreid)
+{
+       struct sched_pcore *spc = pcoreid2spc(coreid);
+       assert((0 <= coreid) && (coreid < num_cores));
+       spin_lock(&sched_lock);
+       TAILQ_INSERT_TAIL(&idlecores, spc, alloc_next);
+       spin_unlock(&sched_lock);
+}
+
 /* Normally it'll be the max number of CG cores ever */
 uint32_t max_vcores(struct proc *p)
 {
 /* TODO: (CG/LL) */
-#ifdef __CONFIG_DISABLE_SMT__
-       return num_cpus >> 1;
+#ifdef CONFIG_DISABLE_SMT
+       return num_cores >> 1;
 #else
-       return num_cpus - 1;    /* reserving core 0 */
-#endif /* __CONFIG_DISABLE_SMT__ */
+       return num_cores - 1;   /* reserving core 0 */
+#endif /* CONFIG_DISABLE_SMT */
+}
+
+/* Find the best core to give to p. First check p's list of cores
+ * provisioned to it, but not yet allocated. If no cores are found, try and
+ * pull from the idle list.  If no cores found on either list, return NULL.
+ * */
+struct sched_pcore *find_best_core(struct proc *p)
+{
+       struct sched_pcore *spc_i = NULL;
+       spc_i = TAILQ_FIRST(&p->ksched_data.prov_not_alloc_me);
+       if (!spc_i)
+               spc_i = TAILQ_FIRST(&idlecores);
+       return spc_i;
 }
 
 /* This deals with a request for more cores.  The amt of new cores needed is
@@ -565,7 +649,7 @@ uint32_t max_vcores(struct proc *p)
 static void __core_request(struct proc *p, uint32_t amt_needed)
 {
        uint32_t nr_to_grant = 0;
-       uint32_t corelist[num_cpus];
+       uint32_t corelist[num_cores];
        struct sched_pcore *spc_i, *temp;
        struct proc *proc_to_preempt;
        bool success;
@@ -574,14 +658,18 @@ static void __core_request(struct proc *p, uint32_t amt_needed)
        /* get all available cores from their prov_not_alloc list.  the list might
         * change when we unlock (new cores added to it, or the entire list emptied,
         * but no core allocations will happen (we hold the poke)). */
-       while (!TAILQ_EMPTY(&p->ksched_data.prov_not_alloc_me)) {
-               if (nr_to_grant == amt_needed)
+       while (nr_to_grant != amt_needed) {
+               /* Find the next best core to allocate to p. It may be a core
+                * provisioned to p, and it might not be. */
+               spc_i = find_best_core(p);
+               /* If no core is returned, we know that there are no more cores to give
+                * out, so we exit the loop. */
+               if (spc_i == NULL)
                        break;
-               /* picking the next victim (first on the not_alloc list) */
-               spc_i = TAILQ_FIRST(&p->ksched_data.prov_not_alloc_me);
-               /* someone else has this proc's pcore, so we need to try to preempt.
-                * after this block, the core will be tracked dealloc'd and on the idle
-                * list (regardless of whether we had to preempt or not) */
+               /* If the pcore chosen currently has a proc allocated to it, we know
+                * it must be provisioned to p, but not allocated to it. We need to try
+                * to preempt. After this block, the core will be track_dealloc'd and
+                * on the idle list (regardless of whether we had to preempt or not) */
                if (spc_i->alloc_proc) {
                        proc_to_preempt = spc_i->alloc_proc;
                        /* would break both preemption and maybe the later decref */
@@ -604,9 +692,6 @@ static void __core_request(struct proc *p, uint32_t amt_needed)
                                 * to note its dealloc.  we are doing some excessive checking of
                                 * p == prov_proc, but using this helper is a lot clearer. */
                                __prov_track_dealloc(proc_to_preempt, spc2pcoreid(spc_i));
-                               /* here, we rely on the fact that we are the only preemptor.  we
-                                * assume no one else preempted it, so we know it is available*/
-                               TAILQ_INSERT_TAIL(&idlecores, spc_i, alloc_next);
                        } else {
                                /* the preempt failed, which should only happen if the pcore was
                                 * unmapped (could be dying, could be yielding, but NOT
@@ -638,27 +723,15 @@ static void __core_request(struct proc *p, uint32_t amt_needed)
                        if (spc_i->prov_proc != p)
                                continue;
                }
-               /* at this point, the pcore is idle, regardless of how we got here
+               /* At this point, the pcore is idle, regardless of how we got here
                 * (successful preempt, failed preempt, or it was idle in the first
-                * place.  the core is still provisioned.  lets pull from the idle list
-                * and add it to the pc_arr for p.  here, we rely on the fact that we
-                * are the only allocator (spc_i is still idle, despite unlocking). */
-               TAILQ_REMOVE(&idlecores, spc_i, alloc_next);
-               /* At this point, we have the core, ready to try to give it to the proc.
-                * It is on no alloc lists, and is track_dealloc'd() (regardless of how
-                * we got here).
-                *
-                * We'll give p its cores via a bulk list, which is better for the proc
-                * mgmt code (when going from runnable to running). */
-               corelist[nr_to_grant] = spc2pcoreid(spc_i);
-               nr_to_grant++;
-               __prov_track_alloc(p, spc2pcoreid(spc_i));
-       }
-       /* Try to get cores from the idle list that aren't prov to me (FCFS) */
-       TAILQ_FOREACH_SAFE(spc_i, &idlecores, alloc_next, temp) {
-               if (nr_to_grant == amt_needed)
-                       break;
-               TAILQ_REMOVE(&idlecores, spc_i, alloc_next);
+                * place).  We also know the core is still provisioned to us.  Lets add
+                * it to the corelist for p (so we can give it to p in bulk later), and
+                * track its allocation with p (so our internal data structures stay in
+                * sync). We rely on the fact that we are the only allocator (spc_i is
+                * still idle, despite (potentially) unlocking during the preempt
+                * attempt above).  It is guaranteed to be track_dealloc'd()
+                * (regardless of how we got here). */
                corelist[nr_to_grant] = spc2pcoreid(spc_i);
                nr_to_grant++;
                __prov_track_alloc(p, spc2pcoreid(spc_i));
@@ -683,7 +756,6 @@ static void __core_request(struct proc *p, uint32_t amt_needed)
                        /* we failed, put the cores and track their dealloc.  lock is
                         * protecting those structures. */
                        spin_lock(&sched_lock);
-                       __put_idle_cores(p, corelist, nr_to_grant);
                        __prov_track_dealloc_bulk(p, corelist, nr_to_grant);
                } else {
                        /* at some point after giving cores, call proc_run_m() (harmless on
@@ -715,7 +787,7 @@ static bool is_ll_core(uint32_t pcoreid)
 static void __prov_track_alloc(struct proc *p, uint32_t pcoreid)
 {
        struct sched_pcore *spc;
-       assert(pcoreid < num_cpus);             /* catch bugs */
+       assert(pcoreid < num_cores);    /* catch bugs */
        spc = pcoreid2spc(pcoreid);
        assert(spc->alloc_proc != p);   /* corruption or double-alloc */
        spc->alloc_proc = p;
@@ -724,6 +796,8 @@ static void __prov_track_alloc(struct proc *p, uint32_t pcoreid)
                TAILQ_REMOVE(&p->ksched_data.prov_not_alloc_me, spc, prov_next);
                TAILQ_INSERT_TAIL(&p->ksched_data.prov_alloc_me, spc, prov_next);
        }
+       /* Actually allocate the core, removing it from the idle core list. */
+       TAILQ_REMOVE(&idlecores, spc, alloc_next);
 }
 
 /* Helper, makes sure the prov/alloc structures track the pcore properly when it
@@ -731,7 +805,7 @@ static void __prov_track_alloc(struct proc *p, uint32_t pcoreid)
 static void __prov_track_dealloc(struct proc *p, uint32_t pcoreid)
 {
        struct sched_pcore *spc;
-       assert(pcoreid < num_cpus);             /* catch bugs */
+       assert(pcoreid < num_cores);    /* catch bugs */
        spc = pcoreid2spc(pcoreid);
        spc->alloc_proc = 0;
        /* if the pcore is prov to them and now deallocated, move lists */
@@ -743,6 +817,8 @@ static void __prov_track_dealloc(struct proc *p, uint32_t pcoreid)
                 * victim. */
                TAILQ_INSERT_HEAD(&p->ksched_data.prov_not_alloc_me, spc, prov_next);
        }
+       /* Actually dealloc the core, putting it back on the idle core list. */
+       TAILQ_INSERT_TAIL(&idlecores, spc, alloc_next);
 }
 
 /* Bulk interface for __prov_track_dealloc */
@@ -754,17 +830,21 @@ static void __prov_track_dealloc_bulk(struct proc *p, uint32_t *pc_arr,
 }
 
 /* P will get pcore if it needs more cores next time we look at it */
-void provision_core(struct proc *p, uint32_t pcoreid)
+int provision_core(struct proc *p, uint32_t pcoreid)
 {
        struct sched_pcore *spc;
        struct sched_pcore_tailq *prov_list;
        /* Make sure we aren't asking for something that doesn't exist (bounds check
         * on the pcore array) */
-       if (!(pcoreid < num_cpus))
-               return; /* could do an error code */
+       if (!(pcoreid < num_cores)) {
+               set_errno(ENXIO);
+               return -1;
+       }
        /* Don't allow the provisioning of LL cores */
-       if (is_ll_core(pcoreid))
-               return;
+       if (is_ll_core(pcoreid)) {
+               set_errno(EBUSY);
+               return -1;
+       }
        spc = pcoreid2spc(pcoreid);
        /* Note the sched lock protects the spc tailqs for all procs in this code.
         * If we need a finer grained sched lock, this is one place where we could
@@ -794,6 +874,7 @@ void provision_core(struct proc *p, uint32_t pcoreid)
        }
        spc->prov_proc = p;
        spin_unlock(&sched_lock);
+       return 0;
 }
 
 /************** Debugging **************/
@@ -819,7 +900,7 @@ void print_idlecoremap(void)
        /* not locking, so we can look at this without deadlocking. */
        printk("Idle cores (unlocked!):\n");
        TAILQ_FOREACH(spc_i, &idlecores, alloc_next)
-               printk("Core %d, prov to %d (%08p)\n", spc2pcoreid(spc_i),
+               printk("Core %d, prov to %d (%p)\n", spc2pcoreid(spc_i),
                       spc_i->prov_proc ? spc_i->prov_proc->pid : 0, spc_i->prov_proc);
 }
 
@@ -850,9 +931,9 @@ void print_prov_map(void)
        struct sched_pcore *spc_i;
        /* Doing this unlocked, which is dangerous, but won't deadlock */
        printk("Which cores are provisioned to which procs:\n------------------\n");
-       for (int i = 0; i < num_cpus; i++) {
+       for (int i = 0; i < num_cores; i++) {
                spc_i = pcoreid2spc(i);
-               printk("Core %02d, prov: %d(%08p) alloc: %d(%08p)\n", i,
+               printk("Core %02d, prov: %d(%p) alloc: %d(%p)\n", i,
                       spc_i->prov_proc ? spc_i->prov_proc->pid : 0, spc_i->prov_proc,
                       spc_i->alloc_proc ? spc_i->alloc_proc->pid : 0,
                       spc_i->alloc_proc);
@@ -864,12 +945,55 @@ void print_proc_prov(struct proc *p)
        struct sched_pcore *spc_i;
        if (!p)
                return;
-       printk("Prov cores alloced to proc %d (%08p)\n----------\n", p->pid, p);
+       printk("Prov cores alloced to proc %d (%p)\n----------\n", p->pid, p);
        TAILQ_FOREACH(spc_i, &p->ksched_data.prov_alloc_me, prov_next)
                printk("Pcore %d\n", spc2pcoreid(spc_i));
-       printk("Prov cores not alloced to proc %d (%08p)\n----------\n", p->pid, p);
+       printk("Prov cores not alloced to proc %d (%p)\n----------\n", p->pid, p);
        TAILQ_FOREACH(spc_i, &p->ksched_data.prov_not_alloc_me, prov_next)
-               printk("Pcore %d (alloced to %d (%08p))\n", spc2pcoreid(spc_i),
+               printk("Pcore %d (alloced to %d (%p))\n", spc2pcoreid(spc_i),
                       spc_i->alloc_proc ? spc_i->alloc_proc->pid : 0,
                       spc_i->alloc_proc);
 }
+
+void next_core(uint32_t pcoreid)
+{
+       struct sched_pcore *spc_i;
+       bool match = FALSE;
+       spin_lock(&sched_lock);
+       TAILQ_FOREACH(spc_i, &idlecores, alloc_next) {
+               if (spc2pcoreid(spc_i) == pcoreid) {
+                       match = TRUE;
+                       break;
+               }
+       }
+       if (match) {
+               TAILQ_REMOVE(&idlecores, spc_i, alloc_next);
+               TAILQ_INSERT_HEAD(&idlecores, spc_i, alloc_next);
+               printk("Pcore %d will be given out next (from the idles)\n", pcoreid);
+       }
+       spin_unlock(&sched_lock);
+}
+
+void sort_idles(void)
+{
+       struct sched_pcore *spc_i, *spc_j, *temp;
+       struct sched_pcore_tailq sorter = TAILQ_HEAD_INITIALIZER(sorter);
+       bool added;
+       spin_lock(&sched_lock);
+       TAILQ_CONCAT(&sorter, &idlecores, alloc_next);
+       TAILQ_FOREACH_SAFE(spc_i, &sorter, alloc_next, temp) {
+               TAILQ_REMOVE(&sorter, spc_i, alloc_next);
+               added = FALSE;
+               /* don't need foreach_safe since we break after we muck with the list */
+               TAILQ_FOREACH(spc_j, &idlecores, alloc_next) {
+                       if (spc_i < spc_j) {
+                               TAILQ_INSERT_BEFORE(spc_j, spc_i, alloc_next);
+                               added = TRUE;
+                               break;
+                       }
+               }
+               if (!added)
+                       TAILQ_INSERT_TAIL(&idlecores, spc_i, alloc_next);
+       }
+       spin_unlock(&sched_lock);
+}