blob: f350f7b15158ee966916d465edee23a4d50495d7 [file] [log] [blame]
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001/*
2 * Real-Time Scheduling Class (mapped to the SCHED_FIFO and SCHED_RR
3 * policies)
4 */
5
Steven Rostedt4fd29172008-01-25 21:08:06 +01006#ifdef CONFIG_SMP
Ingo Molnar84de4272008-01-25 21:08:15 +01007
Gregory Haskins637f5082008-01-25 21:08:18 +01008static inline int rt_overloaded(struct rq *rq)
Steven Rostedt4fd29172008-01-25 21:08:06 +01009{
Gregory Haskins637f5082008-01-25 21:08:18 +010010 return atomic_read(&rq->rd->rto_count);
Steven Rostedt4fd29172008-01-25 21:08:06 +010011}
Ingo Molnar84de4272008-01-25 21:08:15 +010012
Steven Rostedt4fd29172008-01-25 21:08:06 +010013static inline void rt_set_overload(struct rq *rq)
14{
Gregory Haskins637f5082008-01-25 21:08:18 +010015 cpu_set(rq->cpu, rq->rd->rto_mask);
Steven Rostedt4fd29172008-01-25 21:08:06 +010016 /*
17 * Make sure the mask is visible before we set
18 * the overload count. That is checked to determine
19 * if we should look at the mask. It would be a shame
20 * if we looked at the mask, but the mask was not
21 * updated yet.
22 */
23 wmb();
Gregory Haskins637f5082008-01-25 21:08:18 +010024 atomic_inc(&rq->rd->rto_count);
Steven Rostedt4fd29172008-01-25 21:08:06 +010025}
Ingo Molnar84de4272008-01-25 21:08:15 +010026
Steven Rostedt4fd29172008-01-25 21:08:06 +010027static inline void rt_clear_overload(struct rq *rq)
28{
29 /* the order here really doesn't matter */
Gregory Haskins637f5082008-01-25 21:08:18 +010030 atomic_dec(&rq->rd->rto_count);
31 cpu_clear(rq->cpu, rq->rd->rto_mask);
Steven Rostedt4fd29172008-01-25 21:08:06 +010032}
Gregory Haskins73fe6aa2008-01-25 21:08:07 +010033
34static void update_rt_migration(struct rq *rq)
35{
Gregory Haskins637f5082008-01-25 21:08:18 +010036 if (rq->rt.rt_nr_migratory && (rq->rt.rt_nr_running > 1)) {
Gregory Haskinscdc8eb92008-01-25 21:08:23 +010037 if (!rq->rt.overloaded) {
38 rt_set_overload(rq);
39 rq->rt.overloaded = 1;
40 }
41 } else if (rq->rt.overloaded) {
Gregory Haskins73fe6aa2008-01-25 21:08:07 +010042 rt_clear_overload(rq);
Gregory Haskins637f5082008-01-25 21:08:18 +010043 rq->rt.overloaded = 0;
44 }
Gregory Haskins73fe6aa2008-01-25 21:08:07 +010045}
Steven Rostedt4fd29172008-01-25 21:08:06 +010046#endif /* CONFIG_SMP */
47
Ingo Molnarbb44e5d2007-07-09 18:51:58 +020048/*
49 * Update the current task's runtime statistics. Skip current tasks that
50 * are not in our scheduling class.
51 */
Alexey Dobriyana9957442007-10-15 17:00:13 +020052static void update_curr_rt(struct rq *rq)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +020053{
54 struct task_struct *curr = rq->curr;
55 u64 delta_exec;
56
57 if (!task_has_rt_policy(curr))
58 return;
59
Ingo Molnard2819182007-08-09 11:16:47 +020060 delta_exec = rq->clock - curr->se.exec_start;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +020061 if (unlikely((s64)delta_exec < 0))
62 delta_exec = 0;
Ingo Molnar6cfb0d52007-08-02 17:41:40 +020063
64 schedstat_set(curr->se.exec_max, max(curr->se.exec_max, delta_exec));
Ingo Molnarbb44e5d2007-07-09 18:51:58 +020065
66 curr->se.sum_exec_runtime += delta_exec;
Ingo Molnard2819182007-08-09 11:16:47 +020067 curr->se.exec_start = rq->clock;
Srivatsa Vaddagirid842de82007-12-02 20:04:49 +010068 cpuacct_charge(curr, delta_exec);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +020069}
70
Steven Rostedt63489e42008-01-25 21:08:03 +010071static inline void inc_rt_tasks(struct task_struct *p, struct rq *rq)
72{
73 WARN_ON(!rt_task(p));
74 rq->rt.rt_nr_running++;
Steven Rostedt764a9d62008-01-25 21:08:04 +010075#ifdef CONFIG_SMP
76 if (p->prio < rq->rt.highest_prio)
77 rq->rt.highest_prio = p->prio;
Gregory Haskins73fe6aa2008-01-25 21:08:07 +010078 if (p->nr_cpus_allowed > 1)
79 rq->rt.rt_nr_migratory++;
80
81 update_rt_migration(rq);
Steven Rostedt764a9d62008-01-25 21:08:04 +010082#endif /* CONFIG_SMP */
Steven Rostedt63489e42008-01-25 21:08:03 +010083}
84
85static inline void dec_rt_tasks(struct task_struct *p, struct rq *rq)
86{
87 WARN_ON(!rt_task(p));
88 WARN_ON(!rq->rt.rt_nr_running);
89 rq->rt.rt_nr_running--;
Steven Rostedt764a9d62008-01-25 21:08:04 +010090#ifdef CONFIG_SMP
91 if (rq->rt.rt_nr_running) {
92 struct rt_prio_array *array;
93
94 WARN_ON(p->prio < rq->rt.highest_prio);
95 if (p->prio == rq->rt.highest_prio) {
96 /* recalculate */
97 array = &rq->rt.active;
98 rq->rt.highest_prio =
99 sched_find_first_bit(array->bitmap);
100 } /* otherwise leave rq->highest prio alone */
101 } else
102 rq->rt.highest_prio = MAX_RT_PRIO;
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100103 if (p->nr_cpus_allowed > 1)
104 rq->rt.rt_nr_migratory--;
105
106 update_rt_migration(rq);
Steven Rostedt764a9d62008-01-25 21:08:04 +0100107#endif /* CONFIG_SMP */
Steven Rostedt63489e42008-01-25 21:08:03 +0100108}
109
Ingo Molnarfd390f62007-08-09 11:16:48 +0200110static void enqueue_task_rt(struct rq *rq, struct task_struct *p, int wakeup)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200111{
112 struct rt_prio_array *array = &rq->rt.active;
113
Peter Zijlstrafa717062008-01-25 21:08:27 +0100114 list_add_tail(&p->rt.run_list, array->queue + p->prio);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200115 __set_bit(p->prio, array->bitmap);
Srivatsa Vaddagiri58e2d4c2008-01-25 21:08:00 +0100116 inc_cpu_load(rq, p->se.load.weight);
Steven Rostedt63489e42008-01-25 21:08:03 +0100117
118 inc_rt_tasks(p, rq);
Peter Zijlstra78f2c7d2008-01-25 21:08:27 +0100119
120 if (wakeup)
121 p->rt.timeout = 0;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200122}
123
124/*
125 * Adding/removing a task to/from a priority array:
126 */
Ingo Molnarf02231e2007-08-09 11:16:48 +0200127static void dequeue_task_rt(struct rq *rq, struct task_struct *p, int sleep)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200128{
129 struct rt_prio_array *array = &rq->rt.active;
130
Ingo Molnarf1e14ef2007-08-09 11:16:48 +0200131 update_curr_rt(rq);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200132
Peter Zijlstrafa717062008-01-25 21:08:27 +0100133 list_del(&p->rt.run_list);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200134 if (list_empty(array->queue + p->prio))
135 __clear_bit(p->prio, array->bitmap);
Srivatsa Vaddagiri58e2d4c2008-01-25 21:08:00 +0100136 dec_cpu_load(rq, p->se.load.weight);
Steven Rostedt63489e42008-01-25 21:08:03 +0100137
138 dec_rt_tasks(p, rq);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200139}
140
141/*
142 * Put task to the end of the run list without the overhead of dequeue
143 * followed by enqueue.
144 */
145static void requeue_task_rt(struct rq *rq, struct task_struct *p)
146{
147 struct rt_prio_array *array = &rq->rt.active;
148
Peter Zijlstrafa717062008-01-25 21:08:27 +0100149 list_move_tail(&p->rt.run_list, array->queue + p->prio);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200150}
151
152static void
Dmitry Adamushko4530d7a2007-10-15 17:00:08 +0200153yield_task_rt(struct rq *rq)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200154{
Dmitry Adamushko4530d7a2007-10-15 17:00:08 +0200155 requeue_task_rt(rq, rq->curr);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200156}
157
Gregory Haskinse7693a32008-01-25 21:08:09 +0100158#ifdef CONFIG_SMP
Gregory Haskins318e0892008-01-25 21:08:10 +0100159static int find_lowest_rq(struct task_struct *task);
160
Gregory Haskinse7693a32008-01-25 21:08:09 +0100161static int select_task_rq_rt(struct task_struct *p, int sync)
162{
Gregory Haskins318e0892008-01-25 21:08:10 +0100163 struct rq *rq = task_rq(p);
164
165 /*
Steven Rostedte1f47d82008-01-25 21:08:12 +0100166 * If the current task is an RT task, then
167 * try to see if we can wake this RT task up on another
168 * runqueue. Otherwise simply start this RT task
169 * on its current runqueue.
170 *
171 * We want to avoid overloading runqueues. Even if
172 * the RT task is of higher priority than the current RT task.
173 * RT tasks behave differently than other tasks. If
174 * one gets preempted, we try to push it off to another queue.
175 * So trying to keep a preempting RT task on the same
176 * cache hot CPU will force the running RT task to
177 * a cold CPU. So we waste all the cache for the lower
178 * RT task in hopes of saving some of a RT task
179 * that is just being woken and probably will have
180 * cold cache anyway.
Gregory Haskins318e0892008-01-25 21:08:10 +0100181 */
Gregory Haskins17b32792008-01-25 21:08:13 +0100182 if (unlikely(rt_task(rq->curr)) &&
183 (p->nr_cpus_allowed > 1)) {
Gregory Haskins318e0892008-01-25 21:08:10 +0100184 int cpu = find_lowest_rq(p);
185
186 return (cpu == -1) ? task_cpu(p) : cpu;
187 }
188
189 /*
190 * Otherwise, just let it ride on the affined RQ and the
191 * post-schedule router will push the preempted task away
192 */
Gregory Haskinse7693a32008-01-25 21:08:09 +0100193 return task_cpu(p);
194}
195#endif /* CONFIG_SMP */
196
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200197/*
198 * Preempt the current task with a newly woken task if needed:
199 */
200static void check_preempt_curr_rt(struct rq *rq, struct task_struct *p)
201{
202 if (p->prio < rq->curr->prio)
203 resched_task(rq->curr);
204}
205
Ingo Molnarfb8d4722007-08-09 11:16:48 +0200206static struct task_struct *pick_next_task_rt(struct rq *rq)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200207{
208 struct rt_prio_array *array = &rq->rt.active;
209 struct task_struct *next;
210 struct list_head *queue;
211 int idx;
212
213 idx = sched_find_first_bit(array->bitmap);
214 if (idx >= MAX_RT_PRIO)
215 return NULL;
216
217 queue = array->queue + idx;
Peter Zijlstrafa717062008-01-25 21:08:27 +0100218 next = list_entry(queue->next, struct task_struct, rt.run_list);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200219
Ingo Molnard2819182007-08-09 11:16:47 +0200220 next->se.exec_start = rq->clock;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200221
222 return next;
223}
224
Ingo Molnar31ee5292007-08-09 11:16:49 +0200225static void put_prev_task_rt(struct rq *rq, struct task_struct *p)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200226{
Ingo Molnarf1e14ef2007-08-09 11:16:48 +0200227 update_curr_rt(rq);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200228 p->se.exec_start = 0;
229}
230
Peter Williams681f3e62007-10-24 18:23:51 +0200231#ifdef CONFIG_SMP
Steven Rostedte8fa1362008-01-25 21:08:05 +0100232/* Only try algorithms three times */
233#define RT_MAX_TRIES 3
234
235static int double_lock_balance(struct rq *this_rq, struct rq *busiest);
236static void deactivate_task(struct rq *rq, struct task_struct *p, int sleep);
237
Steven Rostedtf65eda42008-01-25 21:08:07 +0100238static int pick_rt_task(struct rq *rq, struct task_struct *p, int cpu)
239{
240 if (!task_running(rq, p) &&
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100241 (cpu < 0 || cpu_isset(cpu, p->cpus_allowed)) &&
242 (p->nr_cpus_allowed > 1))
Steven Rostedtf65eda42008-01-25 21:08:07 +0100243 return 1;
244 return 0;
245}
246
Steven Rostedte8fa1362008-01-25 21:08:05 +0100247/* Return the second highest RT task, NULL otherwise */
Ingo Molnar79064fb2008-01-25 21:08:14 +0100248static struct task_struct *pick_next_highest_task_rt(struct rq *rq, int cpu)
Steven Rostedte8fa1362008-01-25 21:08:05 +0100249{
250 struct rt_prio_array *array = &rq->rt.active;
251 struct task_struct *next;
252 struct list_head *queue;
253 int idx;
254
Steven Rostedte8fa1362008-01-25 21:08:05 +0100255 if (likely(rq->rt.rt_nr_running < 2))
256 return NULL;
257
258 idx = sched_find_first_bit(array->bitmap);
259 if (unlikely(idx >= MAX_RT_PRIO)) {
260 WARN_ON(1); /* rt_nr_running is bad */
261 return NULL;
262 }
263
264 queue = array->queue + idx;
Steven Rostedtf65eda42008-01-25 21:08:07 +0100265 BUG_ON(list_empty(queue));
266
Peter Zijlstrafa717062008-01-25 21:08:27 +0100267 next = list_entry(queue->next, struct task_struct, rt.run_list);
Steven Rostedtf65eda42008-01-25 21:08:07 +0100268 if (unlikely(pick_rt_task(rq, next, cpu)))
269 goto out;
Steven Rostedte8fa1362008-01-25 21:08:05 +0100270
271 if (queue->next->next != queue) {
272 /* same prio task */
Ingo Molnar79064fb2008-01-25 21:08:14 +0100273 next = list_entry(queue->next->next, struct task_struct,
Peter Zijlstrafa717062008-01-25 21:08:27 +0100274 rt.run_list);
Steven Rostedtf65eda42008-01-25 21:08:07 +0100275 if (pick_rt_task(rq, next, cpu))
276 goto out;
Steven Rostedte8fa1362008-01-25 21:08:05 +0100277 }
278
Steven Rostedtf65eda42008-01-25 21:08:07 +0100279 retry:
Steven Rostedte8fa1362008-01-25 21:08:05 +0100280 /* slower, but more flexible */
281 idx = find_next_bit(array->bitmap, MAX_RT_PRIO, idx+1);
Steven Rostedtf65eda42008-01-25 21:08:07 +0100282 if (unlikely(idx >= MAX_RT_PRIO))
Steven Rostedte8fa1362008-01-25 21:08:05 +0100283 return NULL;
Steven Rostedte8fa1362008-01-25 21:08:05 +0100284
285 queue = array->queue + idx;
Steven Rostedtf65eda42008-01-25 21:08:07 +0100286 BUG_ON(list_empty(queue));
Steven Rostedte8fa1362008-01-25 21:08:05 +0100287
Peter Zijlstrafa717062008-01-25 21:08:27 +0100288 list_for_each_entry(next, queue, rt.run_list) {
Steven Rostedtf65eda42008-01-25 21:08:07 +0100289 if (pick_rt_task(rq, next, cpu))
290 goto out;
291 }
292
293 goto retry;
294
295 out:
Steven Rostedte8fa1362008-01-25 21:08:05 +0100296 return next;
297}
298
299static DEFINE_PER_CPU(cpumask_t, local_cpu_mask);
300
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100301static int find_lowest_cpus(struct task_struct *task, cpumask_t *lowest_mask)
Gregory Haskins07b40322008-01-25 21:08:10 +0100302{
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100303 int lowest_prio = -1;
Steven Rostedt610bf052008-01-25 21:08:13 +0100304 int lowest_cpu = -1;
Gregory Haskins06f90db2008-01-25 21:08:13 +0100305 int count = 0;
Steven Rostedt610bf052008-01-25 21:08:13 +0100306 int cpu;
Gregory Haskins07b40322008-01-25 21:08:10 +0100307
Gregory Haskins637f5082008-01-25 21:08:18 +0100308 cpus_and(*lowest_mask, task_rq(task)->rd->online, task->cpus_allowed);
Gregory Haskins07b40322008-01-25 21:08:10 +0100309
310 /*
311 * Scan each rq for the lowest prio.
312 */
Steven Rostedt610bf052008-01-25 21:08:13 +0100313 for_each_cpu_mask(cpu, *lowest_mask) {
Gregory Haskins07b40322008-01-25 21:08:10 +0100314 struct rq *rq = cpu_rq(cpu);
315
Gregory Haskins07b40322008-01-25 21:08:10 +0100316 /* We look for lowest RT prio or non-rt CPU */
317 if (rq->rt.highest_prio >= MAX_RT_PRIO) {
Steven Rostedt610bf052008-01-25 21:08:13 +0100318 /*
319 * if we already found a low RT queue
320 * and now we found this non-rt queue
321 * clear the mask and set our bit.
322 * Otherwise just return the queue as is
323 * and the count==1 will cause the algorithm
324 * to use the first bit found.
325 */
326 if (lowest_cpu != -1) {
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100327 cpus_clear(*lowest_mask);
Steven Rostedt610bf052008-01-25 21:08:13 +0100328 cpu_set(rq->cpu, *lowest_mask);
329 }
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100330 return 1;
Gregory Haskins07b40322008-01-25 21:08:10 +0100331 }
332
333 /* no locking for now */
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100334 if ((rq->rt.highest_prio > task->prio)
335 && (rq->rt.highest_prio >= lowest_prio)) {
336 if (rq->rt.highest_prio > lowest_prio) {
337 /* new low - clear old data */
338 lowest_prio = rq->rt.highest_prio;
Steven Rostedt610bf052008-01-25 21:08:13 +0100339 lowest_cpu = cpu;
340 count = 0;
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100341 }
Gregory Haskins06f90db2008-01-25 21:08:13 +0100342 count++;
Steven Rostedt610bf052008-01-25 21:08:13 +0100343 } else
344 cpu_clear(cpu, *lowest_mask);
345 }
346
347 /*
348 * Clear out all the set bits that represent
349 * runqueues that were of higher prio than
350 * the lowest_prio.
351 */
352 if (lowest_cpu > 0) {
353 /*
354 * Perhaps we could add another cpumask op to
355 * zero out bits. Like cpu_zero_bits(cpumask, nrbits);
356 * Then that could be optimized to use memset and such.
357 */
358 for_each_cpu_mask(cpu, *lowest_mask) {
359 if (cpu >= lowest_cpu)
360 break;
361 cpu_clear(cpu, *lowest_mask);
Gregory Haskins07b40322008-01-25 21:08:10 +0100362 }
363 }
364
Gregory Haskins06f90db2008-01-25 21:08:13 +0100365 return count;
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100366}
367
368static inline int pick_optimal_cpu(int this_cpu, cpumask_t *mask)
369{
370 int first;
371
372 /* "this_cpu" is cheaper to preempt than a remote processor */
373 if ((this_cpu != -1) && cpu_isset(this_cpu, *mask))
374 return this_cpu;
375
376 first = first_cpu(*mask);
377 if (first != NR_CPUS)
378 return first;
379
380 return -1;
381}
382
383static int find_lowest_rq(struct task_struct *task)
384{
385 struct sched_domain *sd;
386 cpumask_t *lowest_mask = &__get_cpu_var(local_cpu_mask);
387 int this_cpu = smp_processor_id();
388 int cpu = task_cpu(task);
Gregory Haskins06f90db2008-01-25 21:08:13 +0100389 int count = find_lowest_cpus(task, lowest_mask);
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100390
Gregory Haskins06f90db2008-01-25 21:08:13 +0100391 if (!count)
392 return -1; /* No targets found */
393
394 /*
395 * There is no sense in performing an optimal search if only one
396 * target is found.
397 */
398 if (count == 1)
399 return first_cpu(*lowest_mask);
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100400
401 /*
402 * At this point we have built a mask of cpus representing the
403 * lowest priority tasks in the system. Now we want to elect
404 * the best one based on our affinity and topology.
405 *
406 * We prioritize the last cpu that the task executed on since
407 * it is most likely cache-hot in that location.
408 */
409 if (cpu_isset(cpu, *lowest_mask))
410 return cpu;
411
412 /*
413 * Otherwise, we consult the sched_domains span maps to figure
414 * out which cpu is logically closest to our hot cache data.
415 */
416 if (this_cpu == cpu)
417 this_cpu = -1; /* Skip this_cpu opt if the same */
418
419 for_each_domain(cpu, sd) {
420 if (sd->flags & SD_WAKE_AFFINE) {
421 cpumask_t domain_mask;
422 int best_cpu;
423
424 cpus_and(domain_mask, sd->span, *lowest_mask);
425
426 best_cpu = pick_optimal_cpu(this_cpu,
427 &domain_mask);
428 if (best_cpu != -1)
429 return best_cpu;
430 }
431 }
432
433 /*
434 * And finally, if there were no matches within the domains
435 * just give the caller *something* to work with from the compatible
436 * locations.
437 */
438 return pick_optimal_cpu(this_cpu, lowest_mask);
Gregory Haskins07b40322008-01-25 21:08:10 +0100439}
440
Steven Rostedte8fa1362008-01-25 21:08:05 +0100441/* Will lock the rq it finds */
Ingo Molnar4df64c02008-01-25 21:08:15 +0100442static struct rq *find_lock_lowest_rq(struct task_struct *task, struct rq *rq)
Steven Rostedte8fa1362008-01-25 21:08:05 +0100443{
444 struct rq *lowest_rq = NULL;
Steven Rostedte8fa1362008-01-25 21:08:05 +0100445 int tries;
Ingo Molnar4df64c02008-01-25 21:08:15 +0100446 int cpu;
Steven Rostedte8fa1362008-01-25 21:08:05 +0100447
448 for (tries = 0; tries < RT_MAX_TRIES; tries++) {
Gregory Haskins07b40322008-01-25 21:08:10 +0100449 cpu = find_lowest_rq(task);
Steven Rostedte8fa1362008-01-25 21:08:05 +0100450
Gregory Haskins2de0b462008-01-25 21:08:10 +0100451 if ((cpu == -1) || (cpu == rq->cpu))
Steven Rostedte8fa1362008-01-25 21:08:05 +0100452 break;
453
Gregory Haskins07b40322008-01-25 21:08:10 +0100454 lowest_rq = cpu_rq(cpu);
455
Steven Rostedte8fa1362008-01-25 21:08:05 +0100456 /* if the prio of this runqueue changed, try again */
Gregory Haskins07b40322008-01-25 21:08:10 +0100457 if (double_lock_balance(rq, lowest_rq)) {
Steven Rostedte8fa1362008-01-25 21:08:05 +0100458 /*
459 * We had to unlock the run queue. In
460 * the mean time, task could have
461 * migrated already or had its affinity changed.
462 * Also make sure that it wasn't scheduled on its rq.
463 */
Gregory Haskins07b40322008-01-25 21:08:10 +0100464 if (unlikely(task_rq(task) != rq ||
Ingo Molnar4df64c02008-01-25 21:08:15 +0100465 !cpu_isset(lowest_rq->cpu,
466 task->cpus_allowed) ||
Gregory Haskins07b40322008-01-25 21:08:10 +0100467 task_running(rq, task) ||
Steven Rostedte8fa1362008-01-25 21:08:05 +0100468 !task->se.on_rq)) {
Ingo Molnar4df64c02008-01-25 21:08:15 +0100469
Steven Rostedte8fa1362008-01-25 21:08:05 +0100470 spin_unlock(&lowest_rq->lock);
471 lowest_rq = NULL;
472 break;
473 }
474 }
475
476 /* If this rq is still suitable use it. */
477 if (lowest_rq->rt.highest_prio > task->prio)
478 break;
479
480 /* try again */
481 spin_unlock(&lowest_rq->lock);
482 lowest_rq = NULL;
483 }
484
485 return lowest_rq;
486}
487
488/*
489 * If the current CPU has more than one RT task, see if the non
490 * running task can migrate over to a CPU that is running a task
491 * of lesser priority.
492 */
Gregory Haskins697f0a42008-01-25 21:08:09 +0100493static int push_rt_task(struct rq *rq)
Steven Rostedte8fa1362008-01-25 21:08:05 +0100494{
495 struct task_struct *next_task;
496 struct rq *lowest_rq;
497 int ret = 0;
498 int paranoid = RT_MAX_TRIES;
499
Gregory Haskinsa22d7fc2008-01-25 21:08:12 +0100500 if (!rq->rt.overloaded)
501 return 0;
502
Gregory Haskins697f0a42008-01-25 21:08:09 +0100503 next_task = pick_next_highest_task_rt(rq, -1);
Steven Rostedte8fa1362008-01-25 21:08:05 +0100504 if (!next_task)
505 return 0;
506
507 retry:
Gregory Haskins697f0a42008-01-25 21:08:09 +0100508 if (unlikely(next_task == rq->curr)) {
Steven Rostedtf65eda42008-01-25 21:08:07 +0100509 WARN_ON(1);
Steven Rostedte8fa1362008-01-25 21:08:05 +0100510 return 0;
Steven Rostedtf65eda42008-01-25 21:08:07 +0100511 }
Steven Rostedte8fa1362008-01-25 21:08:05 +0100512
513 /*
514 * It's possible that the next_task slipped in of
515 * higher priority than current. If that's the case
516 * just reschedule current.
517 */
Gregory Haskins697f0a42008-01-25 21:08:09 +0100518 if (unlikely(next_task->prio < rq->curr->prio)) {
519 resched_task(rq->curr);
Steven Rostedte8fa1362008-01-25 21:08:05 +0100520 return 0;
521 }
522
Gregory Haskins697f0a42008-01-25 21:08:09 +0100523 /* We might release rq lock */
Steven Rostedte8fa1362008-01-25 21:08:05 +0100524 get_task_struct(next_task);
525
526 /* find_lock_lowest_rq locks the rq if found */
Gregory Haskins697f0a42008-01-25 21:08:09 +0100527 lowest_rq = find_lock_lowest_rq(next_task, rq);
Steven Rostedte8fa1362008-01-25 21:08:05 +0100528 if (!lowest_rq) {
529 struct task_struct *task;
530 /*
Gregory Haskins697f0a42008-01-25 21:08:09 +0100531 * find lock_lowest_rq releases rq->lock
Steven Rostedte8fa1362008-01-25 21:08:05 +0100532 * so it is possible that next_task has changed.
533 * If it has, then try again.
534 */
Gregory Haskins697f0a42008-01-25 21:08:09 +0100535 task = pick_next_highest_task_rt(rq, -1);
Steven Rostedte8fa1362008-01-25 21:08:05 +0100536 if (unlikely(task != next_task) && task && paranoid--) {
537 put_task_struct(next_task);
538 next_task = task;
539 goto retry;
540 }
541 goto out;
542 }
543
Gregory Haskins697f0a42008-01-25 21:08:09 +0100544 deactivate_task(rq, next_task, 0);
Steven Rostedte8fa1362008-01-25 21:08:05 +0100545 set_task_cpu(next_task, lowest_rq->cpu);
546 activate_task(lowest_rq, next_task, 0);
547
548 resched_task(lowest_rq->curr);
549
550 spin_unlock(&lowest_rq->lock);
551
552 ret = 1;
553out:
554 put_task_struct(next_task);
555
556 return ret;
557}
558
559/*
560 * TODO: Currently we just use the second highest prio task on
561 * the queue, and stop when it can't migrate (or there's
562 * no more RT tasks). There may be a case where a lower
563 * priority RT task has a different affinity than the
564 * higher RT task. In this case the lower RT task could
565 * possibly be able to migrate where as the higher priority
566 * RT task could not. We currently ignore this issue.
567 * Enhancements are welcome!
568 */
569static void push_rt_tasks(struct rq *rq)
570{
571 /* push_rt_task will return true if it moved an RT */
572 while (push_rt_task(rq))
573 ;
574}
575
Steven Rostedtf65eda42008-01-25 21:08:07 +0100576static int pull_rt_task(struct rq *this_rq)
577{
Ingo Molnar80bf3172008-01-25 21:08:17 +0100578 int this_cpu = this_rq->cpu, ret = 0, cpu;
579 struct task_struct *p, *next;
Steven Rostedtf65eda42008-01-25 21:08:07 +0100580 struct rq *src_rq;
Steven Rostedtf65eda42008-01-25 21:08:07 +0100581
Gregory Haskins637f5082008-01-25 21:08:18 +0100582 if (likely(!rt_overloaded(this_rq)))
Steven Rostedtf65eda42008-01-25 21:08:07 +0100583 return 0;
584
585 next = pick_next_task_rt(this_rq);
586
Gregory Haskins637f5082008-01-25 21:08:18 +0100587 for_each_cpu_mask(cpu, this_rq->rd->rto_mask) {
Steven Rostedtf65eda42008-01-25 21:08:07 +0100588 if (this_cpu == cpu)
589 continue;
590
591 src_rq = cpu_rq(cpu);
Steven Rostedtf65eda42008-01-25 21:08:07 +0100592 /*
593 * We can potentially drop this_rq's lock in
594 * double_lock_balance, and another CPU could
595 * steal our next task - hence we must cause
596 * the caller to recalculate the next task
597 * in that case:
598 */
599 if (double_lock_balance(this_rq, src_rq)) {
600 struct task_struct *old_next = next;
Ingo Molnar80bf3172008-01-25 21:08:17 +0100601
Steven Rostedtf65eda42008-01-25 21:08:07 +0100602 next = pick_next_task_rt(this_rq);
603 if (next != old_next)
604 ret = 1;
605 }
606
607 /*
608 * Are there still pullable RT tasks?
609 */
610 if (src_rq->rt.rt_nr_running <= 1) {
611 spin_unlock(&src_rq->lock);
612 continue;
613 }
614
Steven Rostedtf65eda42008-01-25 21:08:07 +0100615 p = pick_next_highest_task_rt(src_rq, this_cpu);
616
617 /*
618 * Do we have an RT task that preempts
619 * the to-be-scheduled task?
620 */
621 if (p && (!next || (p->prio < next->prio))) {
622 WARN_ON(p == src_rq->curr);
623 WARN_ON(!p->se.on_rq);
624
625 /*
626 * There's a chance that p is higher in priority
627 * than what's currently running on its cpu.
628 * This is just that p is wakeing up and hasn't
629 * had a chance to schedule. We only pull
630 * p if it is lower in priority than the
631 * current task on the run queue or
632 * this_rq next task is lower in prio than
633 * the current task on that rq.
634 */
635 if (p->prio < src_rq->curr->prio ||
636 (next && next->prio < src_rq->curr->prio))
Ingo Molnar80bf3172008-01-25 21:08:17 +0100637 goto out;
Steven Rostedtf65eda42008-01-25 21:08:07 +0100638
639 ret = 1;
640
641 deactivate_task(src_rq, p, 0);
642 set_task_cpu(p, this_cpu);
643 activate_task(this_rq, p, 0);
644 /*
645 * We continue with the search, just in
646 * case there's an even higher prio task
647 * in another runqueue. (low likelyhood
648 * but possible)
Ingo Molnar80bf3172008-01-25 21:08:17 +0100649 *
Steven Rostedtf65eda42008-01-25 21:08:07 +0100650 * Update next so that we won't pick a task
651 * on another cpu with a priority lower (or equal)
652 * than the one we just picked.
653 */
654 next = p;
655
656 }
Ingo Molnar80bf3172008-01-25 21:08:17 +0100657 out:
Steven Rostedtf65eda42008-01-25 21:08:07 +0100658 spin_unlock(&src_rq->lock);
659 }
660
661 return ret;
662}
663
Steven Rostedt9a897c52008-01-25 21:08:22 +0100664static void pre_schedule_rt(struct rq *rq, struct task_struct *prev)
Steven Rostedtf65eda42008-01-25 21:08:07 +0100665{
666 /* Try to pull RT tasks here if we lower this rq's prio */
Ingo Molnar7f51f292008-01-25 21:08:17 +0100667 if (unlikely(rt_task(prev)) && rq->rt.highest_prio > prev->prio)
Steven Rostedtf65eda42008-01-25 21:08:07 +0100668 pull_rt_task(rq);
669}
670
Steven Rostedt9a897c52008-01-25 21:08:22 +0100671static void post_schedule_rt(struct rq *rq)
Steven Rostedte8fa1362008-01-25 21:08:05 +0100672{
673 /*
674 * If we have more than one rt_task queued, then
675 * see if we can push the other rt_tasks off to other CPUS.
676 * Note we may release the rq lock, and since
677 * the lock was owned by prev, we need to release it
678 * first via finish_lock_switch and then reaquire it here.
679 */
Gregory Haskinsa22d7fc2008-01-25 21:08:12 +0100680 if (unlikely(rq->rt.overloaded)) {
Steven Rostedte8fa1362008-01-25 21:08:05 +0100681 spin_lock_irq(&rq->lock);
682 push_rt_tasks(rq);
683 spin_unlock_irq(&rq->lock);
684 }
685}
686
Steven Rostedt4642daf2008-01-25 21:08:07 +0100687
Steven Rostedt9a897c52008-01-25 21:08:22 +0100688static void task_wake_up_rt(struct rq *rq, struct task_struct *p)
Steven Rostedt4642daf2008-01-25 21:08:07 +0100689{
Steven Rostedt9a897c52008-01-25 21:08:22 +0100690 if (!task_running(rq, p) &&
Gregory Haskinsa22d7fc2008-01-25 21:08:12 +0100691 (p->prio >= rq->rt.highest_prio) &&
692 rq->rt.overloaded)
Steven Rostedt4642daf2008-01-25 21:08:07 +0100693 push_rt_tasks(rq);
694}
695
Peter Williams43010652007-08-09 11:16:46 +0200696static unsigned long
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200697load_balance_rt(struct rq *this_rq, int this_cpu, struct rq *busiest,
Peter Williamse1d14842007-10-24 18:23:51 +0200698 unsigned long max_load_move,
699 struct sched_domain *sd, enum cpu_idle_type idle,
700 int *all_pinned, int *this_best_prio)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200701{
Steven Rostedtc7a1e462008-01-25 21:08:07 +0100702 /* don't touch RT tasks */
703 return 0;
Peter Williamse1d14842007-10-24 18:23:51 +0200704}
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200705
Peter Williamse1d14842007-10-24 18:23:51 +0200706static int
707move_one_task_rt(struct rq *this_rq, int this_cpu, struct rq *busiest,
708 struct sched_domain *sd, enum cpu_idle_type idle)
709{
Steven Rostedtc7a1e462008-01-25 21:08:07 +0100710 /* don't touch RT tasks */
711 return 0;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200712}
Ingo Molnardeeeccd2008-01-25 21:08:15 +0100713
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100714static void set_cpus_allowed_rt(struct task_struct *p, cpumask_t *new_mask)
715{
716 int weight = cpus_weight(*new_mask);
717
718 BUG_ON(!rt_task(p));
719
720 /*
721 * Update the migration status of the RQ if we have an RT task
722 * which is running AND changing its weight value.
723 */
724 if (p->se.on_rq && (weight != p->nr_cpus_allowed)) {
725 struct rq *rq = task_rq(p);
726
Ingo Molnardeeeccd2008-01-25 21:08:15 +0100727 if ((p->nr_cpus_allowed <= 1) && (weight > 1)) {
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100728 rq->rt.rt_nr_migratory++;
Ingo Molnardeeeccd2008-01-25 21:08:15 +0100729 } else if ((p->nr_cpus_allowed > 1) && (weight <= 1)) {
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100730 BUG_ON(!rq->rt.rt_nr_migratory);
731 rq->rt.rt_nr_migratory--;
732 }
733
734 update_rt_migration(rq);
735 }
736
737 p->cpus_allowed = *new_mask;
738 p->nr_cpus_allowed = weight;
739}
Ingo Molnardeeeccd2008-01-25 21:08:15 +0100740
Ingo Molnarbdd7c812008-01-25 21:08:18 +0100741/* Assumes rq->lock is held */
742static void join_domain_rt(struct rq *rq)
743{
744 if (rq->rt.overloaded)
745 rt_set_overload(rq);
746}
747
748/* Assumes rq->lock is held */
749static void leave_domain_rt(struct rq *rq)
750{
751 if (rq->rt.overloaded)
752 rt_clear_overload(rq);
753}
Steven Rostedtcb469842008-01-25 21:08:22 +0100754
755/*
756 * When switch from the rt queue, we bring ourselves to a position
757 * that we might want to pull RT tasks from other runqueues.
758 */
759static void switched_from_rt(struct rq *rq, struct task_struct *p,
760 int running)
761{
762 /*
763 * If there are other RT tasks then we will reschedule
764 * and the scheduling of the other RT tasks will handle
765 * the balancing. But if we are the last RT task
766 * we may need to handle the pulling of RT tasks
767 * now.
768 */
769 if (!rq->rt.rt_nr_running)
770 pull_rt_task(rq);
771}
Steven Rostedte8fa1362008-01-25 21:08:05 +0100772#endif /* CONFIG_SMP */
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200773
Steven Rostedtcb469842008-01-25 21:08:22 +0100774/*
775 * When switching a task to RT, we may overload the runqueue
776 * with RT tasks. In this case we try to push them off to
777 * other runqueues.
778 */
779static void switched_to_rt(struct rq *rq, struct task_struct *p,
780 int running)
781{
782 int check_resched = 1;
783
784 /*
785 * If we are already running, then there's nothing
786 * that needs to be done. But if we are not running
787 * we may need to preempt the current running task.
788 * If that current running task is also an RT task
789 * then see if we can move to another run queue.
790 */
791 if (!running) {
792#ifdef CONFIG_SMP
793 if (rq->rt.overloaded && push_rt_task(rq) &&
794 /* Don't resched if we changed runqueues */
795 rq != task_rq(p))
796 check_resched = 0;
797#endif /* CONFIG_SMP */
798 if (check_resched && p->prio < rq->curr->prio)
799 resched_task(rq->curr);
800 }
801}
802
803/*
804 * Priority of the task has changed. This may cause
805 * us to initiate a push or pull.
806 */
807static void prio_changed_rt(struct rq *rq, struct task_struct *p,
808 int oldprio, int running)
809{
810 if (running) {
811#ifdef CONFIG_SMP
812 /*
813 * If our priority decreases while running, we
814 * may need to pull tasks to this runqueue.
815 */
816 if (oldprio < p->prio)
817 pull_rt_task(rq);
818 /*
819 * If there's a higher priority task waiting to run
820 * then reschedule.
821 */
822 if (p->prio > rq->rt.highest_prio)
823 resched_task(p);
824#else
825 /* For UP simply resched on drop of prio */
826 if (oldprio < p->prio)
827 resched_task(p);
828#endif /* CONFIG_SMP */
829 } else {
830 /*
831 * This task is not running, but if it is
832 * greater than the current running task
833 * then reschedule.
834 */
835 if (p->prio < rq->curr->prio)
836 resched_task(rq->curr);
837 }
838}
839
Peter Zijlstra78f2c7d2008-01-25 21:08:27 +0100840static void watchdog(struct rq *rq, struct task_struct *p)
841{
842 unsigned long soft, hard;
843
844 if (!p->signal)
845 return;
846
847 soft = p->signal->rlim[RLIMIT_RTTIME].rlim_cur;
848 hard = p->signal->rlim[RLIMIT_RTTIME].rlim_max;
849
850 if (soft != RLIM_INFINITY) {
851 unsigned long next;
852
853 p->rt.timeout++;
854 next = DIV_ROUND_UP(min(soft, hard), USEC_PER_SEC/HZ);
855 if (next > p->rt.timeout) {
856 u64 next_time = p->se.sum_exec_runtime;
857
858 next_time += next * (NSEC_PER_SEC/HZ);
859 if (p->it_sched_expires > next_time)
860 p->it_sched_expires = next_time;
861 } else
862 p->it_sched_expires = p->se.sum_exec_runtime;
863 }
864}
Steven Rostedtcb469842008-01-25 21:08:22 +0100865
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200866static void task_tick_rt(struct rq *rq, struct task_struct *p)
867{
Peter Zijlstra67e2be02007-12-20 15:01:17 +0100868 update_curr_rt(rq);
869
Peter Zijlstra78f2c7d2008-01-25 21:08:27 +0100870 watchdog(rq, p);
871
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200872 /*
873 * RR tasks need a special form of timeslice management.
874 * FIFO tasks have no timeslices.
875 */
876 if (p->policy != SCHED_RR)
877 return;
878
Peter Zijlstrafa717062008-01-25 21:08:27 +0100879 if (--p->rt.time_slice)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200880 return;
881
Peter Zijlstrafa717062008-01-25 21:08:27 +0100882 p->rt.time_slice = DEF_TIMESLICE;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200883
Dmitry Adamushko98fbc792007-08-24 20:39:10 +0200884 /*
885 * Requeue to the end of queue if we are not the only element
886 * on the queue:
887 */
Peter Zijlstrafa717062008-01-25 21:08:27 +0100888 if (p->rt.run_list.prev != p->rt.run_list.next) {
Dmitry Adamushko98fbc792007-08-24 20:39:10 +0200889 requeue_task_rt(rq, p);
890 set_tsk_need_resched(p);
891 }
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200892}
893
Srivatsa Vaddagiri83b699e2007-10-15 17:00:08 +0200894static void set_curr_task_rt(struct rq *rq)
895{
896 struct task_struct *p = rq->curr;
897
898 p->se.exec_start = rq->clock;
899}
900
Ingo Molnar5522d5d2007-10-15 17:00:12 +0200901const struct sched_class rt_sched_class = {
902 .next = &fair_sched_class,
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200903 .enqueue_task = enqueue_task_rt,
904 .dequeue_task = dequeue_task_rt,
905 .yield_task = yield_task_rt,
Gregory Haskinse7693a32008-01-25 21:08:09 +0100906#ifdef CONFIG_SMP
907 .select_task_rq = select_task_rq_rt,
908#endif /* CONFIG_SMP */
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200909
910 .check_preempt_curr = check_preempt_curr_rt,
911
912 .pick_next_task = pick_next_task_rt,
913 .put_prev_task = put_prev_task_rt,
914
Peter Williams681f3e62007-10-24 18:23:51 +0200915#ifdef CONFIG_SMP
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200916 .load_balance = load_balance_rt,
Peter Williamse1d14842007-10-24 18:23:51 +0200917 .move_one_task = move_one_task_rt,
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100918 .set_cpus_allowed = set_cpus_allowed_rt,
Ingo Molnarbdd7c812008-01-25 21:08:18 +0100919 .join_domain = join_domain_rt,
920 .leave_domain = leave_domain_rt,
Steven Rostedt9a897c52008-01-25 21:08:22 +0100921 .pre_schedule = pre_schedule_rt,
922 .post_schedule = post_schedule_rt,
923 .task_wake_up = task_wake_up_rt,
Steven Rostedtcb469842008-01-25 21:08:22 +0100924 .switched_from = switched_from_rt,
Peter Williams681f3e62007-10-24 18:23:51 +0200925#endif
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200926
Srivatsa Vaddagiri83b699e2007-10-15 17:00:08 +0200927 .set_curr_task = set_curr_task_rt,
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200928 .task_tick = task_tick_rt,
Steven Rostedtcb469842008-01-25 21:08:22 +0100929
930 .prio_changed = prio_changed_rt,
931 .switched_to = switched_to_rt,
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200932};