Removes option for a dedicated monitor core
[akaros.git] / kern / src / schedule.c
1 /* Copyright (c) 2009, 2012 The Regents of the University of California
2  * Barret Rhoden <brho@cs.berkeley.edu>
3  * See LICENSE for details.
4  *
5  * Scheduling and dispatching. */
6
7 #ifdef __SHARC__
8 #pragma nosharc
9 #endif
10
11 #include <schedule.h>
12 #include <process.h>
13 #include <monitor.h>
14 #include <stdio.h>
15 #include <assert.h>
16 #include <atomic.h>
17 #include <smp.h>
18 #include <manager.h>
19 #include <alarm.h>
20 #include <sys/queue.h>
21 #include <kmalloc.h>
22
23 /* Process Lists.  'unrunnable' is a holding list for SCPs that are running or
24  * waiting or otherwise not considered for sched decisions. */
25 struct proc_list unrunnable_scps = TAILQ_HEAD_INITIALIZER(unrunnable_scps);
26 struct proc_list runnable_scps = TAILQ_HEAD_INITIALIZER(runnable_scps);
27 struct proc_list all_mcps = TAILQ_HEAD_INITIALIZER(all_mcps);
28 spinlock_t sched_lock = SPINLOCK_INITIALIZER;
29
30 /* The pcores in the system.  (array gets alloced in init()).  */
31 struct sched_pcore *all_pcores;
32
33 /* Tracks which cores are idle, similar to the vcoremap.  Each value is the
34  * physical coreid of an unallocated core.  These are all now protected by the
35  * sched_lock (they will change sooner or later). */
36 uint32_t idlecoremap[MAX_NUM_CPUS];
37 uint32_t num_idlecores = 0;
38 uint32_t num_mgmtcores = 1;
39
40 /* Helper, defined below */
41 static void __core_request(struct proc *p);
42 static void __put_idle_cores(struct proc *p, uint32_t *pc_arr, uint32_t num);
43 static void add_to_list(struct proc *p, struct proc_list *list);
44 static void remove_from_list(struct proc *p, struct proc_list *list);
45 static void switch_lists(struct proc *p, struct proc_list *old,
46                          struct proc_list *new);
47 static uint32_t schedpcore2pcoreid(struct sched_pcore *spc);
48 static bool is_ll_core(uint32_t pcoreid);
49 static void __prov_track_alloc(struct proc *p, uint32_t pcoreid);
50 static void __prov_track_dealloc(struct proc *p, uint32_t pcoreid);
51 static void __prov_track_dealloc_bulk(struct proc *p, uint32_t *pc_arr,
52                                       uint32_t nr_cores);
53
54 /* Alarm struct, for our example 'timer tick' */
55 struct alarm_waiter ksched_waiter;
56
57 #define TIMER_TICK_USEC 10000   /* 10msec */
58
59 /* Helper: Sets up a timer tick on the calling core to go off 10 msec from now.
60  * This assumes the calling core is an LL core, etc. */
61 static void set_ksched_alarm(void)
62 {
63         set_awaiter_rel(&ksched_waiter, TIMER_TICK_USEC);
64         set_alarm(&per_cpu_info[core_id()].tchain, &ksched_waiter);
65 }
66
67 /* Kmsg, to run the scheduler tick (not in interrupt context) and reset the
68  * alarm.  Note that interrupts will be disabled, but this is not the same as
69  * interrupt context.  We're a routine kmsg, which means the core is in a
70  * quiescent state. */
71 static void __ksched_tick(struct trapframe *tf, uint32_t srcid, long a0,
72                           long a1, long a2)
73 {
74         /* TODO: imagine doing some accounting here */
75         schedule();
76         /* Set our alarm to go off, incrementing from our last tick (instead of
77          * setting it relative to now, since some time has passed since the alarm
78          * first went off.  Note, this may be now or in the past! */
79         set_awaiter_inc(&ksched_waiter, TIMER_TICK_USEC);
80         set_alarm(&per_cpu_info[core_id()].tchain, &ksched_waiter);
81 }
82
83 /* Interrupt/alarm handler: tells our core to run the scheduler (out of
84  * interrupt context). */
85 static void __kalarm(struct alarm_waiter *waiter)
86 {
87         send_kernel_message(core_id(), __ksched_tick, 0, 0, 0, KMSG_ROUTINE);
88 }
89
90 void schedule_init(void)
91 {
92         /* init provisioning stuff */
93         all_pcores = kmalloc(sizeof(struct sched_pcore) * num_cpus, 0);
94         memset(all_pcores, 0, sizeof(struct sched_pcore) * num_cpus);
95         assert(!core_id());             /* want the alarm on core0 for now */
96         init_awaiter(&ksched_waiter, __kalarm);
97         set_ksched_alarm();
98         /* Ghetto old idle core init */
99         /* Init idle cores. Core 0 is the management core. */
100         spin_lock(&sched_lock);
101 #ifdef __CONFIG_DISABLE_SMT__
102         /* assumes core0 is the only management core (NIC and monitor functionality
103          * are run there too.  it just adds the odd cores to the idlecoremap */
104         assert(!(num_cpus % 2));
105         // TODO: consider checking x86 for machines that actually hyperthread
106         num_idlecores = num_cpus >> 1;
107  #ifdef __CONFIG_ARSC_SERVER__
108         // Dedicate one core (core 2) to sysserver, might be able to share wit NIC
109         num_mgmtcores++;
110         assert(num_cpus >= num_mgmtcores);
111         send_kernel_message(2, (amr_t)arsc_server, 0,0,0, KMSG_ROUTINE);
112  #endif
113         for (int i = 0; i < num_idlecores; i++)
114                 idlecoremap[i] = (i * 2) + 1;
115 #else
116         // __CONFIG_DISABLE_SMT__
117  #ifdef __CONFIG_ARSC_SERVER__
118         // Dedicate one core (core 2) to sysserver, might be able to share with NIC
119         num_mgmtcores++;
120         assert(num_cpus >= num_mgmtcores);
121         send_kernel_message(num_mgmtcores-1, (amr_t)arsc_server, 0,0,0, KMSG_ROUTINE);
122  #endif
123         num_idlecores = num_cpus - num_mgmtcores;
124         for (int i = 0; i < num_idlecores; i++)
125                 idlecoremap[i] = i + num_mgmtcores;
126 #endif /* __CONFIG_DISABLE_SMT__ */
127         spin_unlock(&sched_lock);
128         return;
129 }
130
131 /* Round-robins on whatever list it's on */
132 static void add_to_list(struct proc *p, struct proc_list *new)
133 {
134         TAILQ_INSERT_TAIL(new, p, ksched_data.proc_link);
135         p->ksched_data.cur_list = new;
136 }
137
138 static void remove_from_list(struct proc *p, struct proc_list *old)
139 {
140         assert(p->ksched_data.cur_list == old);
141         TAILQ_REMOVE(old, p, ksched_data.proc_link);
142 }
143
144 static void switch_lists(struct proc *p, struct proc_list *old,
145                          struct proc_list *new)
146 {
147         remove_from_list(p, old);
148         add_to_list(p, new);
149 }
150
151 static void __remove_from_any_list(struct proc *p)
152 {
153         if (p->ksched_data.cur_list)
154                 TAILQ_REMOVE(p->ksched_data.cur_list, p, ksched_data.proc_link);
155 }
156
157 /* Removes from whatever list p is on */
158 static void remove_from_any_list(struct proc *p)
159 {
160         assert(p->ksched_data.cur_list);
161         TAILQ_REMOVE(p->ksched_data.cur_list, p, ksched_data.proc_link);
162 }
163
164 void register_proc(struct proc *p)
165 {
166         /* one ref for the proc's existence, cradle-to-grave */
167         proc_incref(p, 1);      /* need at least this OR the 'one for existing' */
168         spin_lock(&sched_lock);
169         TAILQ_INIT(&p->ksched_data.prov_alloc_me);
170         TAILQ_INIT(&p->ksched_data.prov_not_alloc_me);
171         add_to_list(p, &unrunnable_scps);
172         spin_unlock(&sched_lock);
173 }
174
175 /* Returns 0 if it succeeded, an error code otherwise. */
176 int proc_change_to_m(struct proc *p)
177 {
178         int retval;
179         spin_lock(&sched_lock);
180         /* Should only be necessary to lock around the change_to_m call.  It's
181          * definitely necessary to hold the sched lock the whole time - need to
182          * atomically change the proc's state and have the ksched take action (and
183          * not squeeze a proc_destroy in there or something). */
184         spin_lock(&p->proc_lock);
185         retval = __proc_change_to_m(p);
186         spin_unlock(&p->proc_lock);
187         if (retval) {
188                 /* Failed for some reason. */
189                 spin_unlock(&sched_lock);
190                 return retval;
191         }
192         /* Catch user bugs */
193         if (!p->procdata->res_req[RES_CORES].amt_wanted) {
194                 printk("[kernel] process needs to specify amt_wanted\n");
195                 p->procdata->res_req[RES_CORES].amt_wanted = 1;
196         }
197         /* For now, this should only ever be called on an unrunnable.  It's
198          * probably a bug, at this stage in development, to do o/w. */
199         remove_from_list(p, &unrunnable_scps);
200         //remove_from_any_list(p);      /* ^^ instead of this */
201         add_to_list(p, &all_mcps);
202         spin_unlock(&sched_lock);
203         //poke_ksched(p, RES_CORES);
204         return retval;
205 }
206
207 /* Makes sure p is runnable.  Callers may spam this, so it needs to handle
208  * repeated calls for the same event.  Callers include event delivery, SCP
209  * yield, and new SCPs.  Most every scheduler should do something like this -
210  * grab whatever lock you have, then call the proc helper. */
211 void proc_wakeup(struct proc *p)
212 {
213         spin_lock(&sched_lock);
214         /* will trigger one of the __sched_.cp_wakeup()s */
215         __proc_wakeup(p);
216         spin_unlock(&sched_lock);
217 }
218
219 static uint32_t schedpcore2pcoreid(struct sched_pcore *spc)
220 {
221         return spc - all_pcores;
222 }
223
224 /* Helper for proc destroy: unprovisions any pcores for the given list */
225 static void unprov_pcore_list(struct sched_pcore_tailq *list_head)
226 {
227         struct sched_pcore *spc_i;
228         /* We can leave them connected within the tailq, since the scps don't have a
229          * default list (if they aren't on a proc's list, then we don't care about
230          * them), and since the INSERTs don't care what list you were on before
231          * (chummy with the implementation).  Pretty sure this is right.  If there's
232          * suspected list corruption, be safer here. */
233         TAILQ_FOREACH(spc_i, list_head, prov_next)
234                 spc_i->prov_proc = 0;
235         TAILQ_INIT(list_head);
236 }
237
238 /* Destroys the given process.  This may be called from another process, a light
239  * kernel thread (no real process context), asynchronously/cross-core, or from
240  * the process on its own core.
241  *
242  * An external, edible ref is passed in.  when we return and they decref,
243  * __proc_free will be called */
244 void proc_destroy(struct proc *p)
245 {
246         uint32_t nr_cores_revoked = 0;
247         spin_lock(&sched_lock);
248         spin_lock(&p->proc_lock);
249         /* storage for pc_arr is alloced at decl, which is after grabbing the lock*/
250         uint32_t pc_arr[p->procinfo->num_vcores];
251         /* If this returns true, it means we successfully destroyed the proc */
252         if (__proc_destroy(p, pc_arr, &nr_cores_revoked)) {
253                 /* Do our cleanup.  note that proc_free won't run since we have an
254                  * external reference, passed in */
255                 /* Unprovision any cores.  Note this is different than track_dealloc.
256                  * The latter does bookkeeping when an allocation changes.  This is a
257                  * bulk *provisioning* change. */
258                 unprov_pcore_list(&p->ksched_data.prov_alloc_me);
259                 unprov_pcore_list(&p->ksched_data.prov_not_alloc_me);
260                 /* Remove from whatever list we are on */
261                 remove_from_any_list(p);
262                 /* Drop the cradle-to-the-grave reference, jet-li */
263                 proc_decref(p);
264                 if (nr_cores_revoked) {
265                         __put_idle_cores(p, pc_arr, nr_cores_revoked);
266                         __prov_track_dealloc_bulk(p, pc_arr, nr_cores_revoked);
267                 }
268         }
269         spin_unlock(&p->proc_lock);
270         spin_unlock(&sched_lock);
271 }
272
273 /* mgmt/LL cores should call this to schedule the calling core and give it to an
274  * SCP.  will also prune the dead SCPs from the list.  hold the lock before
275  * calling.  returns TRUE if it scheduled a proc. */
276 static bool __schedule_scp(void)
277 {
278         struct proc *p;
279         uint32_t pcoreid = core_id();
280         struct per_cpu_info *pcpui = &per_cpu_info[pcoreid];
281         int8_t state = 0;
282         /* if there are any runnables, run them here and put any currently running
283          * SCP on the tail of the runnable queue. */
284         if ((p = TAILQ_FIRST(&runnable_scps))) {
285                 /* protect owning proc, cur_tf, etc.  note this nests with the
286                  * calls in proc_yield_s */
287                 disable_irqsave(&state);
288                 /* someone is currently running, dequeue them */
289                 if (pcpui->owning_proc) {
290                         printd("Descheduled %d in favor of %d\n", pcpui->owning_proc->pid,
291                                p->pid);
292                         /* locking just to be safe */
293                         spin_lock(&p->proc_lock);
294                         __proc_set_state(pcpui->owning_proc, PROC_RUNNABLE_S);
295                         __proc_save_context_s(pcpui->owning_proc, pcpui->cur_tf);
296                         spin_unlock(&p->proc_lock);
297                         /* round-robin the SCPs (inserts at the end of the queue) */
298                         switch_lists(pcpui->owning_proc, &unrunnable_scps, &runnable_scps);
299                         clear_owning_proc(pcoreid);
300                         /* Note we abandon core.  It's not strictly necessary.  If
301                          * we didn't, the TLB would still be loaded with the old
302                          * one, til we proc_run_s, and the various paths in
303                          * proc_run_s would pick it up.  This way is a bit safer for
304                          * future changes, but has an extra (empty) TLB flush.  */
305                         abandon_core();
306                 } 
307                 /* Run the new proc */
308                 switch_lists(p, &runnable_scps, &unrunnable_scps);
309                 printd("PID of the SCP i'm running: %d\n", p->pid);
310                 proc_run_s(p);  /* gives it core we're running on */
311                 enable_irqsave(&state);
312                 return TRUE;
313         }
314         return FALSE;
315 }
316
317 /* Something has changed, and for whatever reason the scheduler should
318  * reevaluate things. 
319  *
320  * Don't call this from interrupt context (grabs proclocks). */
321 void schedule(void)
322 {
323         struct proc *p, *temp;
324         spin_lock(&sched_lock);
325         /* trivially try to handle the needs of all our MCPS.  smarter schedulers
326          * would do something other than FCFS */
327         TAILQ_FOREACH_SAFE(p, &all_mcps, ksched_data.proc_link, temp) {
328                 printd("Ksched has MCP %08p (%d)\n", p, p->pid);
329                 if (!num_idlecores)
330                         break;
331                 /* TODO: might use amt_wanted as a proxy.  right now, they have
332                  * amt_wanted == 1, even though they are waiting.
333                  * TODO: this is RACY too - just like with DYING. */
334                 if (p->state == PROC_WAITING)
335                         continue;
336                 __core_request(p);
337         }
338         if (management_core())
339                 __schedule_scp();
340         spin_unlock(&sched_lock);
341 }
342
343 /* A process is asking the ksched to look at its resource desires.  The
344  * scheduler is free to ignore this, for its own reasons, so long as it
345  * eventually gets around to looking at resource desires. */
346 void poke_ksched(struct proc *p, int res_type)
347 {
348         /* TODO: probably want something to trigger all res_types */
349         spin_lock(&sched_lock);
350         switch (res_type) {
351                 case RES_CORES:
352                         /* ignore core requests from non-mcps (note we have races if we ever
353                          * allow procs to switch back). */
354                         if (!__proc_is_mcp(p))
355                                 break;
356                         __core_request(p);
357                         break;
358                 default:
359                         break;
360         }
361         spin_unlock(&sched_lock);
362 }
363
364 /* ksched callbacks.  p just woke up, is unlocked, and the ksched lock is held */
365 void __sched_mcp_wakeup(struct proc *p)
366 {
367         /* the essence of poke_ksched for RES_CORES */
368         __core_request(p);
369 }
370
371 /* ksched callbacks.  p just woke up, is unlocked, and the ksched lock is held */
372 void __sched_scp_wakeup(struct proc *p)
373 {
374         /* might not be on a list if it is new.  o/w, it should be unrunnable */
375         __remove_from_any_list(p);
376         add_to_list(p, &runnable_scps);
377 }
378
379 /* The calling cpu/core has nothing to do and plans to idle/halt.  This is an
380  * opportunity to pick the nature of that halting (low power state, etc), or
381  * provide some other work (_Ss on LL cores).  Note that interrupts are
382  * disabled, and if you return, the core will cpu_halt(). */
383 void cpu_bored(void)
384 {
385         bool new_proc = FALSE;
386         if (!management_core())
387                 return;
388         spin_lock(&sched_lock);
389         new_proc = __schedule_scp();
390         spin_unlock(&sched_lock);
391         /* if we just scheduled a proc, we need to manually restart it, instead of
392          * returning.  if we return, the core will halt. */
393         if (new_proc) {
394                 proc_restartcore();
395                 assert(0);
396         }
397         /* Could drop into the monitor if there are no processes at all.  For now,
398          * the 'call of the giraffe' suffices. */
399 }
400
401 /* Externally called function to return a core to the ksched, which tracks it as
402  * idle and deallocated from p.
403  *
404  * This also is a trigger, telling us we have more cores.  We could/should make
405  * a scheduling decision (or at least plan to). */
406 void put_idle_core(struct proc *p, uint32_t coreid)
407 {
408         spin_lock(&sched_lock);
409         idlecoremap[num_idlecores++] = coreid;
410         __prov_track_dealloc(p, coreid);
411         spin_unlock(&sched_lock);
412 }
413
414 /* Helper for put_idle and core_req.  Note this does not all track_dealloc */
415 static void __put_idle_cores(struct proc *p, uint32_t *pc_arr, uint32_t num)
416 {
417         for (int i = 0; i < num; i++)
418                 idlecoremap[num_idlecores++] = pc_arr[i];
419 }
420
421 /* External interface for put_idle.  Note this one also calls track_dealloc,
422  * which the internal version does not. */
423 void put_idle_cores(struct proc *p, uint32_t *pc_arr, uint32_t num)
424 {
425         spin_lock(&sched_lock);
426         __put_idle_cores(p, pc_arr, num);
427         __prov_track_dealloc_bulk(p, pc_arr, num);
428         spin_unlock(&sched_lock);
429         /* could trigger a sched decision here */
430 }
431
432 /* Available resources changed (plus or minus).  Some parts of the kernel may
433  * call this if a particular resource that is 'quantity-based' changes.  Things
434  * like available RAM to processes, bandwidth, etc.  Cores would probably be
435  * inappropriate, since we need to know which specific core is now free. */
436 void avail_res_changed(int res_type, long change)
437 {
438         printk("[kernel] ksched doesn't track any resources yet!\n");
439 }
440
441 /* Normally it'll be the max number of CG cores ever */
442 uint32_t max_vcores(struct proc *p)
443 {
444 #ifdef __CONFIG_DISABLE_SMT__
445         return num_cpus >> 1;
446 #else
447         return MAX(1, num_cpus - num_mgmtcores);
448 #endif /* __CONFIG_DISABLE_SMT__ */
449 }
450
451 /* Ghetto helper, just hands out up to 'amt_new' cores (no sense of locality or
452  * anything) */
453 static uint32_t __get_idle_cores(struct proc *p, uint32_t *pc_arr,
454                                  uint32_t amt_new)
455 {
456         uint32_t num_granted = 0;
457         for (int i = 0; i < num_idlecores && i < amt_new; i++) {
458                 /* grab the last one on the list */
459                 pc_arr[i] = idlecoremap[num_idlecores - 1];
460                 num_idlecores--;
461                 num_granted++;
462         }
463         return num_granted;
464 }
465
466 /* This deals with a request for more cores.  The request is already stored in
467  * the proc's amt_wanted (it is compared to amt_granted). */
468 static void __core_request(struct proc *p)
469 {
470         uint32_t num_granted, amt_wanted, amt_granted;
471         uint32_t corelist[num_cpus];
472
473         /* TODO: consider copy-in for amt_wanted too. */
474         amt_wanted = p->procdata->res_req[RES_CORES].amt_wanted;
475         amt_granted = p->procinfo->res_grant[RES_CORES];
476
477         /* Help them out - if they ask for something impossible, give them 1 so they
478          * can make some progress. (this is racy). */
479         if (amt_wanted > p->procinfo->max_vcores) {
480                 p->procdata->res_req[RES_CORES].amt_wanted = 1;
481         }
482         /* if they are satisfied, we're done.  There's a slight chance they have
483          * cores, but they aren't running (sched gave them cores while they were
484          * yielding, and now we see them on the run queue). */
485         if (amt_wanted <= amt_granted)
486                 return;
487         /* Otherwise, see what they want, and try to give out as many as possible.
488          * Current models are simple - it's just a raw number of cores, and we just
489          * give out what we can. */
490         num_granted = __get_idle_cores(p, corelist, amt_wanted - amt_granted);
491         /* Now, actually give them out */
492         if (num_granted) {
493                 /* give them the cores.  this will start up the extras if RUNNING_M. */
494                 spin_lock(&p->proc_lock);
495                 /* if they fail, it is because they are WAITING or DYING.  we could give
496                  * the cores to another proc or whatever.  for the current type of
497                  * ksched, we'll just put them back on the pile and return.  Note, the
498                  * ksched could check the states after locking, but it isn't necessary:
499                  * just need to check at some point in the ksched loop. */
500                 if (__proc_give_cores(p, corelist, num_granted)) {
501                         __put_idle_cores(p, corelist, num_granted);
502                 } else {
503                         /* track the (successful) allocation of the sched_pcores */
504                         for (int i = 0; i < num_granted; i++)
505                                 __prov_track_alloc(p, corelist[i]);
506                         /* at some point after giving cores, call proc_run_m() (harmless on
507                          * RUNNING_Ms).  You can give small groups of cores, then run them
508                          * (which is more efficient than interleaving runs with the gives
509                          * for bulk preempted processes). */
510                         __proc_run_m(p);
511                 }
512                 spin_unlock(&p->proc_lock);
513         }
514 }
515
516 /* TODO: need more thorough CG/LL management.  For now, core0 is the only LL
517  * core.  This won't play well with the ghetto shit in schedule_init() if you do
518  * anything like 'DEDICATED_MONITOR' or the ARSC server.  All that needs an
519  * overhaul. */
520 static bool is_ll_core(uint32_t pcoreid)
521 {
522         if (pcoreid == 0)
523                 return TRUE;
524         return FALSE;
525 }
526
527 /* Helper, makes sure the prov/alloc structures track the pcore properly when it
528  * is allocated to p.  Might make this take a sched_pcore * in the future. */
529 static void __prov_track_alloc(struct proc *p, uint32_t pcoreid)
530 {
531         struct sched_pcore *spc;
532         assert(pcoreid < num_cpus);             /* catch bugs */
533         spc = &all_pcores[pcoreid];
534         assert(spc->alloc_proc != p);   /* corruption or double-alloc */
535         spc->alloc_proc = p;
536         /* if the pcore is prov to them and now allocated, move lists */
537         if (spc->prov_proc == p) {
538                 TAILQ_REMOVE(&p->ksched_data.prov_not_alloc_me, spc, prov_next);
539                 TAILQ_INSERT_TAIL(&p->ksched_data.prov_alloc_me, spc, prov_next);
540         }
541 }
542
543 /* Helper, makes sure the prov/alloc structures track the pcore properly when it
544  * is deallocated from p. */
545 static void __prov_track_dealloc(struct proc *p, uint32_t pcoreid)
546 {
547         struct sched_pcore *spc;
548         assert(pcoreid < num_cpus);             /* catch bugs */
549         spc = &all_pcores[pcoreid];
550         spc->alloc_proc = 0;
551         /* if the pcore is prov to them and now deallocated, move lists */
552         if (spc->prov_proc == p) {
553                 TAILQ_REMOVE(&p->ksched_data.prov_alloc_me, spc, prov_next);
554                 /* this is the victim list, which can be sorted so that we pick the
555                  * right victim (sort by alloc_proc reverse priority, etc).  In this
556                  * case, the core isn't alloc'd by anyone, so it should be the first
557                  * victim. */
558                 TAILQ_INSERT_HEAD(&p->ksched_data.prov_not_alloc_me, spc, prov_next);
559         }
560 }
561
562 /* Bulk interface for __prov_track_dealloc */
563 static void __prov_track_dealloc_bulk(struct proc *p, uint32_t *pc_arr,
564                                       uint32_t nr_cores)
565 {
566         for (int i = 0; i < nr_cores; i++)
567                 __prov_track_dealloc(p, pc_arr[i]);
568 }
569
570 /* P will get pcore if it needs more cores next time we look at it */
571 void provision_core(struct proc *p, uint32_t pcoreid)
572 {
573         struct sched_pcore *spc;
574         struct sched_pcore_tailq *prov_list;
575         /* Make sure we aren't asking for something that doesn't exist (bounds check
576          * on the pcore array) */
577         if (!(pcoreid < num_cpus))
578                 return; /* could do an error code */
579         /* Don't allow the provisioning of LL cores */
580         if (is_ll_core(pcoreid))
581                 return;
582         spc = &all_pcores[pcoreid];
583         /* Note the sched lock protects the spc tailqs for all procs in this code.
584          * If we need a finer grained sched lock, this is one place where we could
585          * have a different lock */
586         spin_lock(&sched_lock);
587         /* If the core is already prov to someone else, take it away.  (last write
588          * wins, some other layer or new func can handle permissions). */
589         if (spc->prov_proc) {
590                 /* the list the spc is on depends on whether it is alloced to the
591                  * prov_proc or not */
592                 prov_list = (spc->alloc_proc == spc->prov_proc ?
593                              &spc->prov_proc->ksched_data.prov_alloc_me :
594                              &spc->prov_proc->ksched_data.prov_not_alloc_me);
595                 TAILQ_REMOVE(prov_list, spc, prov_next);
596         }
597         /* Now prov it to p.  Again, the list it goes on depends on whether it is
598          * alloced to p or not.  Callers can also send in 0 to de-provision. */
599         if (p) {
600                 if (spc->alloc_proc == p) {
601                         TAILQ_INSERT_TAIL(&p->ksched_data.prov_alloc_me, spc, prov_next);
602                 } else {
603                         /* this is be the victim list, which can be sorted so that we pick
604                          * the right victim (sort by alloc_proc reverse priority, etc). */
605                         TAILQ_INSERT_TAIL(&p->ksched_data.prov_not_alloc_me, spc,
606                                           prov_next);
607                 }
608         }
609         spc->prov_proc = p;
610         spin_unlock(&sched_lock);
611 }
612
613 /************** Debugging **************/
614 void sched_diag(void)
615 {
616         struct proc *p;
617         spin_lock(&sched_lock);
618         TAILQ_FOREACH(p, &runnable_scps, ksched_data.proc_link)
619                 printk("Runnable _S PID: %d\n", p->pid);
620         TAILQ_FOREACH(p, &unrunnable_scps, ksched_data.proc_link)
621                 printk("Unrunnable _S PID: %d\n", p->pid);
622         TAILQ_FOREACH(p, &all_mcps, ksched_data.proc_link)
623                 printk("MCP PID: %d\n", p->pid);
624         spin_unlock(&sched_lock);
625         return;
626 }
627
628 void print_idlecoremap(void)
629 {
630         printk("There are %d idle cores.\n", num_idlecores);
631         for (int i = 0; i < num_idlecores; i++)
632                 printk("idlecoremap[%d] = %d\n", i, idlecoremap[i]);
633 }
634
635 void print_resources(struct proc *p)
636 {
637         printk("--------------------\n");
638         printk("PID: %d\n", p->pid);
639         printk("--------------------\n");
640         for (int i = 0; i < MAX_NUM_RESOURCES; i++)
641                 printk("Res type: %02d, amt wanted: %08d, amt granted: %08d\n", i,
642                        p->procdata->res_req[i].amt_wanted, p->procinfo->res_grant[i]);
643 }
644
645 void print_all_resources(void)
646 {
647         /* Hash helper */
648         void __print_resources(void *item)
649         {
650                 print_resources((struct proc*)item);
651         }
652         spin_lock(&pid_hash_lock);
653         hash_for_each(pid_hash, __print_resources);
654         spin_unlock(&pid_hash_lock);
655 }
656
657 void print_prov_map(void)
658 {
659         struct sched_pcore *spc_i;
660         /* Doing this unlocked, which is dangerous, but won't deadlock */
661         printk("Which cores are provisioned to which procs:\n------------------\n");
662         for (int i = 0; i < num_cpus; i++) {
663                 spc_i = &all_pcores[i];
664                 printk("Core %02d, prov: %08p(%d) alloc: %08p(%d)\n", i,
665                        spc_i->prov_proc,  spc_i->prov_proc  ? spc_i->prov_proc->pid :0,
666                        spc_i->alloc_proc, spc_i->alloc_proc ? spc_i->alloc_proc->pid:0);
667         }
668 }
669
670 void print_proc_prov(struct proc *p)
671 {
672         struct sched_pcore *spc_i;
673         if (!p)
674                 return;
675         printk("Prov cores alloced to proc %08p (%d)\n----------\n", p, p->pid);
676         TAILQ_FOREACH(spc_i, &p->ksched_data.prov_alloc_me, prov_next)
677                 printk("Pcore %d\n", schedpcore2pcoreid(spc_i));
678         printk("Prov cores not alloced to proc %08p (%d)\n----------\n", p, p->pid);
679         TAILQ_FOREACH(spc_i, &p->ksched_data.prov_not_alloc_me, prov_next)
680                 printk("Pcore %d (alloced to %08p (%d))\n", schedpcore2pcoreid(spc_i),
681                        spc_i->alloc_proc, spc_i->alloc_proc ? spc_i->alloc_proc->pid:0);
682 }