blob: 8bfdb3f8a52d6456b468fa5ddeeb5b872d1cec79 [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
Peter Zijlstra6f505b12008-01-25 21:08:30 +010048static inline struct task_struct *rt_task_of(struct sched_rt_entity *rt_se)
Peter Zijlstrafa85ae22008-01-25 21:08:29 +010049{
Peter Zijlstra6f505b12008-01-25 21:08:30 +010050 return container_of(rt_se, struct task_struct, rt);
51}
52
53static inline int on_rt_rq(struct sched_rt_entity *rt_se)
54{
55 return !list_empty(&rt_se->run_list);
56}
57
58#ifdef CONFIG_FAIR_GROUP_SCHED
59
60static inline unsigned int sched_rt_ratio(struct rt_rq *rt_rq)
61{
62 if (!rt_rq->tg)
63 return SCHED_RT_FRAC;
64
65 return rt_rq->tg->rt_ratio;
66}
67
68#define for_each_leaf_rt_rq(rt_rq, rq) \
69 list_for_each_entry(rt_rq, &rq->leaf_rt_rq_list, leaf_rt_rq_list)
70
71static inline struct rq *rq_of_rt_rq(struct rt_rq *rt_rq)
72{
73 return rt_rq->rq;
74}
75
76static inline struct rt_rq *rt_rq_of_se(struct sched_rt_entity *rt_se)
77{
78 return rt_se->rt_rq;
79}
80
81#define for_each_sched_rt_entity(rt_se) \
82 for (; rt_se; rt_se = rt_se->parent)
83
84static inline struct rt_rq *group_rt_rq(struct sched_rt_entity *rt_se)
85{
86 return rt_se->my_q;
87}
88
89static void enqueue_rt_entity(struct sched_rt_entity *rt_se);
90static void dequeue_rt_entity(struct sched_rt_entity *rt_se);
91
92static void sched_rt_ratio_enqueue(struct rt_rq *rt_rq)
93{
94 struct sched_rt_entity *rt_se = rt_rq->rt_se;
95
96 if (rt_se && !on_rt_rq(rt_se) && rt_rq->rt_nr_running) {
97 enqueue_rt_entity(rt_se);
98 resched_task(rq_of_rt_rq(rt_rq)->curr);
99 }
100}
101
102static void sched_rt_ratio_dequeue(struct rt_rq *rt_rq)
103{
104 struct sched_rt_entity *rt_se = rt_rq->rt_se;
105
106 if (rt_se && on_rt_rq(rt_se))
107 dequeue_rt_entity(rt_se);
108}
109
110#else
111
112static inline unsigned int sched_rt_ratio(struct rt_rq *rt_rq)
113{
114 return sysctl_sched_rt_ratio;
115}
116
117#define for_each_leaf_rt_rq(rt_rq, rq) \
118 for (rt_rq = &rq->rt; rt_rq; rt_rq = NULL)
119
120static inline struct rq *rq_of_rt_rq(struct rt_rq *rt_rq)
121{
122 return container_of(rt_rq, struct rq, rt);
123}
124
125static inline struct rt_rq *rt_rq_of_se(struct sched_rt_entity *rt_se)
126{
127 struct task_struct *p = rt_task_of(rt_se);
128 struct rq *rq = task_rq(p);
129
130 return &rq->rt;
131}
132
133#define for_each_sched_rt_entity(rt_se) \
134 for (; rt_se; rt_se = NULL)
135
136static inline struct rt_rq *group_rt_rq(struct sched_rt_entity *rt_se)
137{
138 return NULL;
139}
140
141static inline void sched_rt_ratio_enqueue(struct rt_rq *rt_rq)
142{
143}
144
145static inline void sched_rt_ratio_dequeue(struct rt_rq *rt_rq)
146{
147}
148
149#endif
150
151static inline int rt_se_prio(struct sched_rt_entity *rt_se)
152{
153#ifdef CONFIG_FAIR_GROUP_SCHED
154 struct rt_rq *rt_rq = group_rt_rq(rt_se);
155
156 if (rt_rq)
157 return rt_rq->highest_prio;
158#endif
159
160 return rt_task_of(rt_se)->prio;
161}
162
163static int sched_rt_ratio_exceeded(struct rt_rq *rt_rq)
164{
165 unsigned int rt_ratio = sched_rt_ratio(rt_rq);
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100166 u64 period, ratio;
167
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100168 if (rt_ratio == SCHED_RT_FRAC)
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100169 return 0;
170
171 if (rt_rq->rt_throttled)
172 return 1;
173
174 period = (u64)sysctl_sched_rt_period * NSEC_PER_MSEC;
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100175 ratio = (period * rt_ratio) >> SCHED_RT_FRAC_SHIFT;
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100176
177 if (rt_rq->rt_time > ratio) {
Peter Zijlstra48d5e252008-01-25 21:08:31 +0100178 struct rq *rq = rq_of_rt_rq(rt_rq);
179
180 rq->rt_throttled = 1;
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100181 rt_rq->rt_throttled = 1;
Peter Zijlstra48d5e252008-01-25 21:08:31 +0100182
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100183 sched_rt_ratio_dequeue(rt_rq);
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100184 return 1;
185 }
186
187 return 0;
188}
189
190static void update_sched_rt_period(struct rq *rq)
191{
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100192 struct rt_rq *rt_rq;
193 u64 period;
194
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100195 while (rq->clock > rq->rt_period_expire) {
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100196 period = (u64)sysctl_sched_rt_period * NSEC_PER_MSEC;
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100197 rq->rt_period_expire += period;
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100198
Peter Zijlstra48d5e252008-01-25 21:08:31 +0100199 for_each_leaf_rt_rq(rt_rq, rq) {
200 unsigned long rt_ratio = sched_rt_ratio(rt_rq);
201 u64 ratio = (period * rt_ratio) >> SCHED_RT_FRAC_SHIFT;
202
203 rt_rq->rt_time -= min(rt_rq->rt_time, ratio);
204 if (rt_rq->rt_throttled) {
205 rt_rq->rt_throttled = 0;
206 sched_rt_ratio_enqueue(rt_rq);
207 }
208 }
209
210 rq->rt_throttled = 0;
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100211 }
212}
213
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200214/*
215 * Update the current task's runtime statistics. Skip current tasks that
216 * are not in our scheduling class.
217 */
Alexey Dobriyana9957442007-10-15 17:00:13 +0200218static void update_curr_rt(struct rq *rq)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200219{
220 struct task_struct *curr = rq->curr;
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100221 struct sched_rt_entity *rt_se = &curr->rt;
222 struct rt_rq *rt_rq = rt_rq_of_se(rt_se);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200223 u64 delta_exec;
224
225 if (!task_has_rt_policy(curr))
226 return;
227
Ingo Molnard2819182007-08-09 11:16:47 +0200228 delta_exec = rq->clock - curr->se.exec_start;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200229 if (unlikely((s64)delta_exec < 0))
230 delta_exec = 0;
Ingo Molnar6cfb0d52007-08-02 17:41:40 +0200231
232 schedstat_set(curr->se.exec_max, max(curr->se.exec_max, delta_exec));
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200233
234 curr->se.sum_exec_runtime += delta_exec;
Ingo Molnard2819182007-08-09 11:16:47 +0200235 curr->se.exec_start = rq->clock;
Srivatsa Vaddagirid842de82007-12-02 20:04:49 +0100236 cpuacct_charge(curr, delta_exec);
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100237
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100238 rt_rq->rt_time += delta_exec;
239 /*
240 * might make it a tad more accurate:
241 *
242 * update_sched_rt_period(rq);
243 */
244 if (sched_rt_ratio_exceeded(rt_rq))
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100245 resched_task(curr);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200246}
247
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100248static inline
249void inc_rt_tasks(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)
Steven Rostedt63489e42008-01-25 21:08:03 +0100250{
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100251 WARN_ON(!rt_prio(rt_se_prio(rt_se)));
252 rt_rq->rt_nr_running++;
253#if defined CONFIG_SMP || defined CONFIG_FAIR_GROUP_SCHED
254 if (rt_se_prio(rt_se) < rt_rq->highest_prio)
255 rt_rq->highest_prio = rt_se_prio(rt_se);
256#endif
Steven Rostedt764a9d62008-01-25 21:08:04 +0100257#ifdef CONFIG_SMP
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100258 if (rt_se->nr_cpus_allowed > 1) {
259 struct rq *rq = rq_of_rt_rq(rt_rq);
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100260 rq->rt.rt_nr_migratory++;
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100261 }
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100262
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100263 update_rt_migration(rq_of_rt_rq(rt_rq));
264#endif
Steven Rostedt63489e42008-01-25 21:08:03 +0100265}
266
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100267static inline
268void dec_rt_tasks(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)
Steven Rostedt63489e42008-01-25 21:08:03 +0100269{
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100270 WARN_ON(!rt_prio(rt_se_prio(rt_se)));
271 WARN_ON(!rt_rq->rt_nr_running);
272 rt_rq->rt_nr_running--;
273#if defined CONFIG_SMP || defined CONFIG_FAIR_GROUP_SCHED
274 if (rt_rq->rt_nr_running) {
Steven Rostedt764a9d62008-01-25 21:08:04 +0100275 struct rt_prio_array *array;
276
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100277 WARN_ON(rt_se_prio(rt_se) < rt_rq->highest_prio);
278 if (rt_se_prio(rt_se) == rt_rq->highest_prio) {
Steven Rostedt764a9d62008-01-25 21:08:04 +0100279 /* recalculate */
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100280 array = &rt_rq->active;
281 rt_rq->highest_prio =
Steven Rostedt764a9d62008-01-25 21:08:04 +0100282 sched_find_first_bit(array->bitmap);
283 } /* otherwise leave rq->highest prio alone */
284 } else
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100285 rt_rq->highest_prio = MAX_RT_PRIO;
286#endif
287#ifdef CONFIG_SMP
288 if (rt_se->nr_cpus_allowed > 1) {
289 struct rq *rq = rq_of_rt_rq(rt_rq);
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100290 rq->rt.rt_nr_migratory--;
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100291 }
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100292
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100293 update_rt_migration(rq_of_rt_rq(rt_rq));
Steven Rostedt764a9d62008-01-25 21:08:04 +0100294#endif /* CONFIG_SMP */
Steven Rostedt63489e42008-01-25 21:08:03 +0100295}
296
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100297static void enqueue_rt_entity(struct sched_rt_entity *rt_se)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200298{
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100299 struct rt_rq *rt_rq = rt_rq_of_se(rt_se);
300 struct rt_prio_array *array = &rt_rq->active;
301 struct rt_rq *group_rq = group_rt_rq(rt_se);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200302
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100303 if (group_rq && group_rq->rt_throttled)
304 return;
Steven Rostedt63489e42008-01-25 21:08:03 +0100305
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100306 list_add_tail(&rt_se->run_list, array->queue + rt_se_prio(rt_se));
307 __set_bit(rt_se_prio(rt_se), array->bitmap);
Peter Zijlstra78f2c7d2008-01-25 21:08:27 +0100308
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100309 inc_rt_tasks(rt_se, rt_rq);
310}
311
312static void dequeue_rt_entity(struct sched_rt_entity *rt_se)
313{
314 struct rt_rq *rt_rq = rt_rq_of_se(rt_se);
315 struct rt_prio_array *array = &rt_rq->active;
316
317 list_del_init(&rt_se->run_list);
318 if (list_empty(array->queue + rt_se_prio(rt_se)))
319 __clear_bit(rt_se_prio(rt_se), array->bitmap);
320
321 dec_rt_tasks(rt_se, rt_rq);
322}
323
324/*
325 * Because the prio of an upper entry depends on the lower
326 * entries, we must remove entries top - down.
327 *
328 * XXX: O(1/2 h^2) because we can only walk up, not down the chain.
329 * doesn't matter much for now, as h=2 for GROUP_SCHED.
330 */
331static void dequeue_rt_stack(struct task_struct *p)
332{
333 struct sched_rt_entity *rt_se, *top_se;
334
335 /*
336 * dequeue all, top - down.
337 */
338 do {
339 rt_se = &p->rt;
340 top_se = NULL;
341 for_each_sched_rt_entity(rt_se) {
342 if (on_rt_rq(rt_se))
343 top_se = rt_se;
344 }
345 if (top_se)
346 dequeue_rt_entity(top_se);
347 } while (top_se);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200348}
349
350/*
351 * Adding/removing a task to/from a priority array:
352 */
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100353static void enqueue_task_rt(struct rq *rq, struct task_struct *p, int wakeup)
354{
355 struct sched_rt_entity *rt_se = &p->rt;
356
357 if (wakeup)
358 rt_se->timeout = 0;
359
360 dequeue_rt_stack(p);
361
362 /*
363 * enqueue everybody, bottom - up.
364 */
365 for_each_sched_rt_entity(rt_se)
366 enqueue_rt_entity(rt_se);
367
368 inc_cpu_load(rq, p->se.load.weight);
369}
370
Ingo Molnarf02231e2007-08-09 11:16:48 +0200371static void dequeue_task_rt(struct rq *rq, struct task_struct *p, int sleep)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200372{
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100373 struct sched_rt_entity *rt_se = &p->rt;
374 struct rt_rq *rt_rq;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200375
Ingo Molnarf1e14ef2007-08-09 11:16:48 +0200376 update_curr_rt(rq);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200377
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100378 dequeue_rt_stack(p);
Steven Rostedt63489e42008-01-25 21:08:03 +0100379
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100380 /*
381 * re-enqueue all non-empty rt_rq entities.
382 */
383 for_each_sched_rt_entity(rt_se) {
384 rt_rq = group_rt_rq(rt_se);
385 if (rt_rq && rt_rq->rt_nr_running)
386 enqueue_rt_entity(rt_se);
387 }
388
389 dec_cpu_load(rq, p->se.load.weight);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200390}
391
392/*
393 * Put task to the end of the run list without the overhead of dequeue
394 * followed by enqueue.
395 */
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100396static
397void requeue_rt_entity(struct rt_rq *rt_rq, struct sched_rt_entity *rt_se)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200398{
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100399 struct rt_prio_array *array = &rt_rq->active;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200400
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100401 list_move_tail(&rt_se->run_list, array->queue + rt_se_prio(rt_se));
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200402}
403
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100404static void requeue_task_rt(struct rq *rq, struct task_struct *p)
405{
406 struct sched_rt_entity *rt_se = &p->rt;
407 struct rt_rq *rt_rq;
408
409 for_each_sched_rt_entity(rt_se) {
410 rt_rq = rt_rq_of_se(rt_se);
411 requeue_rt_entity(rt_rq, rt_se);
412 }
413}
414
415static void yield_task_rt(struct rq *rq)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200416{
Dmitry Adamushko4530d7a2007-10-15 17:00:08 +0200417 requeue_task_rt(rq, rq->curr);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200418}
419
Gregory Haskinse7693a32008-01-25 21:08:09 +0100420#ifdef CONFIG_SMP
Gregory Haskins318e0892008-01-25 21:08:10 +0100421static int find_lowest_rq(struct task_struct *task);
422
Gregory Haskinse7693a32008-01-25 21:08:09 +0100423static int select_task_rq_rt(struct task_struct *p, int sync)
424{
Gregory Haskins318e0892008-01-25 21:08:10 +0100425 struct rq *rq = task_rq(p);
426
427 /*
Steven Rostedte1f47d82008-01-25 21:08:12 +0100428 * If the current task is an RT task, then
429 * try to see if we can wake this RT task up on another
430 * runqueue. Otherwise simply start this RT task
431 * on its current runqueue.
432 *
433 * We want to avoid overloading runqueues. Even if
434 * the RT task is of higher priority than the current RT task.
435 * RT tasks behave differently than other tasks. If
436 * one gets preempted, we try to push it off to another queue.
437 * So trying to keep a preempting RT task on the same
438 * cache hot CPU will force the running RT task to
439 * a cold CPU. So we waste all the cache for the lower
440 * RT task in hopes of saving some of a RT task
441 * that is just being woken and probably will have
442 * cold cache anyway.
Gregory Haskins318e0892008-01-25 21:08:10 +0100443 */
Gregory Haskins17b32792008-01-25 21:08:13 +0100444 if (unlikely(rt_task(rq->curr)) &&
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100445 (p->rt.nr_cpus_allowed > 1)) {
Gregory Haskins318e0892008-01-25 21:08:10 +0100446 int cpu = find_lowest_rq(p);
447
448 return (cpu == -1) ? task_cpu(p) : cpu;
449 }
450
451 /*
452 * Otherwise, just let it ride on the affined RQ and the
453 * post-schedule router will push the preempted task away
454 */
Gregory Haskinse7693a32008-01-25 21:08:09 +0100455 return task_cpu(p);
456}
457#endif /* CONFIG_SMP */
458
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200459/*
460 * Preempt the current task with a newly woken task if needed:
461 */
462static void check_preempt_curr_rt(struct rq *rq, struct task_struct *p)
463{
464 if (p->prio < rq->curr->prio)
465 resched_task(rq->curr);
466}
467
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100468static struct sched_rt_entity *pick_next_rt_entity(struct rq *rq,
469 struct rt_rq *rt_rq)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200470{
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100471 struct rt_prio_array *array = &rt_rq->active;
472 struct sched_rt_entity *next = NULL;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200473 struct list_head *queue;
474 int idx;
475
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100476 if (sched_rt_ratio_exceeded(rt_rq))
477 goto out;
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100478
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200479 idx = sched_find_first_bit(array->bitmap);
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100480 BUG_ON(idx >= MAX_RT_PRIO);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200481
482 queue = array->queue + idx;
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100483 next = list_entry(queue->next, struct sched_rt_entity, run_list);
484 out:
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200485 return next;
486}
487
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100488static struct task_struct *pick_next_task_rt(struct rq *rq)
489{
490 struct sched_rt_entity *rt_se;
491 struct task_struct *p;
492 struct rt_rq *rt_rq;
493
494 retry:
495 rt_rq = &rq->rt;
496
497 if (unlikely(!rt_rq->rt_nr_running))
498 return NULL;
499
500 if (sched_rt_ratio_exceeded(rt_rq))
501 return NULL;
502
503 do {
504 rt_se = pick_next_rt_entity(rq, rt_rq);
505 if (unlikely(!rt_se))
506 goto retry;
507 rt_rq = group_rt_rq(rt_se);
508 } while (rt_rq);
509
510 p = rt_task_of(rt_se);
511 p->se.exec_start = rq->clock;
512 return p;
513}
514
Ingo Molnar31ee5292007-08-09 11:16:49 +0200515static void put_prev_task_rt(struct rq *rq, struct task_struct *p)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200516{
Ingo Molnarf1e14ef2007-08-09 11:16:48 +0200517 update_curr_rt(rq);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200518 p->se.exec_start = 0;
519}
520
Peter Williams681f3e62007-10-24 18:23:51 +0200521#ifdef CONFIG_SMP
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100522
Steven Rostedte8fa1362008-01-25 21:08:05 +0100523/* Only try algorithms three times */
524#define RT_MAX_TRIES 3
525
526static int double_lock_balance(struct rq *this_rq, struct rq *busiest);
527static void deactivate_task(struct rq *rq, struct task_struct *p, int sleep);
528
Steven Rostedtf65eda42008-01-25 21:08:07 +0100529static int pick_rt_task(struct rq *rq, struct task_struct *p, int cpu)
530{
531 if (!task_running(rq, p) &&
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100532 (cpu < 0 || cpu_isset(cpu, p->cpus_allowed)) &&
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100533 (p->rt.nr_cpus_allowed > 1))
Steven Rostedtf65eda42008-01-25 21:08:07 +0100534 return 1;
535 return 0;
536}
537
Steven Rostedte8fa1362008-01-25 21:08:05 +0100538/* Return the second highest RT task, NULL otherwise */
Ingo Molnar79064fb2008-01-25 21:08:14 +0100539static struct task_struct *pick_next_highest_task_rt(struct rq *rq, int cpu)
Steven Rostedte8fa1362008-01-25 21:08:05 +0100540{
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100541 struct task_struct *next = NULL;
542 struct sched_rt_entity *rt_se;
543 struct rt_prio_array *array;
544 struct rt_rq *rt_rq;
Steven Rostedte8fa1362008-01-25 21:08:05 +0100545 int idx;
546
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100547 for_each_leaf_rt_rq(rt_rq, rq) {
548 array = &rt_rq->active;
549 idx = sched_find_first_bit(array->bitmap);
550 next_idx:
551 if (idx >= MAX_RT_PRIO)
552 continue;
553 if (next && next->prio < idx)
554 continue;
555 list_for_each_entry(rt_se, array->queue + idx, run_list) {
556 struct task_struct *p = rt_task_of(rt_se);
557 if (pick_rt_task(rq, p, cpu)) {
558 next = p;
559 break;
560 }
561 }
562 if (!next) {
563 idx = find_next_bit(array->bitmap, MAX_RT_PRIO, idx+1);
564 goto next_idx;
565 }
Steven Rostedte8fa1362008-01-25 21:08:05 +0100566 }
567
Steven Rostedte8fa1362008-01-25 21:08:05 +0100568 return next;
569}
570
571static DEFINE_PER_CPU(cpumask_t, local_cpu_mask);
572
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100573static int find_lowest_cpus(struct task_struct *task, cpumask_t *lowest_mask)
Gregory Haskins07b40322008-01-25 21:08:10 +0100574{
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100575 int lowest_prio = -1;
Steven Rostedt610bf052008-01-25 21:08:13 +0100576 int lowest_cpu = -1;
Gregory Haskins06f90db2008-01-25 21:08:13 +0100577 int count = 0;
Steven Rostedt610bf052008-01-25 21:08:13 +0100578 int cpu;
Gregory Haskins07b40322008-01-25 21:08:10 +0100579
Gregory Haskins637f5082008-01-25 21:08:18 +0100580 cpus_and(*lowest_mask, task_rq(task)->rd->online, task->cpus_allowed);
Gregory Haskins07b40322008-01-25 21:08:10 +0100581
582 /*
583 * Scan each rq for the lowest prio.
584 */
Steven Rostedt610bf052008-01-25 21:08:13 +0100585 for_each_cpu_mask(cpu, *lowest_mask) {
Gregory Haskins07b40322008-01-25 21:08:10 +0100586 struct rq *rq = cpu_rq(cpu);
587
Gregory Haskins07b40322008-01-25 21:08:10 +0100588 /* We look for lowest RT prio or non-rt CPU */
589 if (rq->rt.highest_prio >= MAX_RT_PRIO) {
Steven Rostedt610bf052008-01-25 21:08:13 +0100590 /*
591 * if we already found a low RT queue
592 * and now we found this non-rt queue
593 * clear the mask and set our bit.
594 * Otherwise just return the queue as is
595 * and the count==1 will cause the algorithm
596 * to use the first bit found.
597 */
598 if (lowest_cpu != -1) {
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100599 cpus_clear(*lowest_mask);
Steven Rostedt610bf052008-01-25 21:08:13 +0100600 cpu_set(rq->cpu, *lowest_mask);
601 }
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100602 return 1;
Gregory Haskins07b40322008-01-25 21:08:10 +0100603 }
604
605 /* no locking for now */
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100606 if ((rq->rt.highest_prio > task->prio)
607 && (rq->rt.highest_prio >= lowest_prio)) {
608 if (rq->rt.highest_prio > lowest_prio) {
609 /* new low - clear old data */
610 lowest_prio = rq->rt.highest_prio;
Steven Rostedt610bf052008-01-25 21:08:13 +0100611 lowest_cpu = cpu;
612 count = 0;
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100613 }
Gregory Haskins06f90db2008-01-25 21:08:13 +0100614 count++;
Steven Rostedt610bf052008-01-25 21:08:13 +0100615 } else
616 cpu_clear(cpu, *lowest_mask);
617 }
618
619 /*
620 * Clear out all the set bits that represent
621 * runqueues that were of higher prio than
622 * the lowest_prio.
623 */
624 if (lowest_cpu > 0) {
625 /*
626 * Perhaps we could add another cpumask op to
627 * zero out bits. Like cpu_zero_bits(cpumask, nrbits);
628 * Then that could be optimized to use memset and such.
629 */
630 for_each_cpu_mask(cpu, *lowest_mask) {
631 if (cpu >= lowest_cpu)
632 break;
633 cpu_clear(cpu, *lowest_mask);
Gregory Haskins07b40322008-01-25 21:08:10 +0100634 }
635 }
636
Gregory Haskins06f90db2008-01-25 21:08:13 +0100637 return count;
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100638}
639
640static inline int pick_optimal_cpu(int this_cpu, cpumask_t *mask)
641{
642 int first;
643
644 /* "this_cpu" is cheaper to preempt than a remote processor */
645 if ((this_cpu != -1) && cpu_isset(this_cpu, *mask))
646 return this_cpu;
647
648 first = first_cpu(*mask);
649 if (first != NR_CPUS)
650 return first;
651
652 return -1;
653}
654
655static int find_lowest_rq(struct task_struct *task)
656{
657 struct sched_domain *sd;
658 cpumask_t *lowest_mask = &__get_cpu_var(local_cpu_mask);
659 int this_cpu = smp_processor_id();
660 int cpu = task_cpu(task);
Gregory Haskins06f90db2008-01-25 21:08:13 +0100661 int count = find_lowest_cpus(task, lowest_mask);
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100662
Gregory Haskins06f90db2008-01-25 21:08:13 +0100663 if (!count)
664 return -1; /* No targets found */
665
666 /*
667 * There is no sense in performing an optimal search if only one
668 * target is found.
669 */
670 if (count == 1)
671 return first_cpu(*lowest_mask);
Gregory Haskins6e1254d2008-01-25 21:08:11 +0100672
673 /*
674 * At this point we have built a mask of cpus representing the
675 * lowest priority tasks in the system. Now we want to elect
676 * the best one based on our affinity and topology.
677 *
678 * We prioritize the last cpu that the task executed on since
679 * it is most likely cache-hot in that location.
680 */
681 if (cpu_isset(cpu, *lowest_mask))
682 return cpu;
683
684 /*
685 * Otherwise, we consult the sched_domains span maps to figure
686 * out which cpu is logically closest to our hot cache data.
687 */
688 if (this_cpu == cpu)
689 this_cpu = -1; /* Skip this_cpu opt if the same */
690
691 for_each_domain(cpu, sd) {
692 if (sd->flags & SD_WAKE_AFFINE) {
693 cpumask_t domain_mask;
694 int best_cpu;
695
696 cpus_and(domain_mask, sd->span, *lowest_mask);
697
698 best_cpu = pick_optimal_cpu(this_cpu,
699 &domain_mask);
700 if (best_cpu != -1)
701 return best_cpu;
702 }
703 }
704
705 /*
706 * And finally, if there were no matches within the domains
707 * just give the caller *something* to work with from the compatible
708 * locations.
709 */
710 return pick_optimal_cpu(this_cpu, lowest_mask);
Gregory Haskins07b40322008-01-25 21:08:10 +0100711}
712
Steven Rostedte8fa1362008-01-25 21:08:05 +0100713/* Will lock the rq it finds */
Ingo Molnar4df64c02008-01-25 21:08:15 +0100714static struct rq *find_lock_lowest_rq(struct task_struct *task, struct rq *rq)
Steven Rostedte8fa1362008-01-25 21:08:05 +0100715{
716 struct rq *lowest_rq = NULL;
Steven Rostedte8fa1362008-01-25 21:08:05 +0100717 int tries;
Ingo Molnar4df64c02008-01-25 21:08:15 +0100718 int cpu;
Steven Rostedte8fa1362008-01-25 21:08:05 +0100719
720 for (tries = 0; tries < RT_MAX_TRIES; tries++) {
Gregory Haskins07b40322008-01-25 21:08:10 +0100721 cpu = find_lowest_rq(task);
Steven Rostedte8fa1362008-01-25 21:08:05 +0100722
Gregory Haskins2de0b462008-01-25 21:08:10 +0100723 if ((cpu == -1) || (cpu == rq->cpu))
Steven Rostedte8fa1362008-01-25 21:08:05 +0100724 break;
725
Gregory Haskins07b40322008-01-25 21:08:10 +0100726 lowest_rq = cpu_rq(cpu);
727
Steven Rostedte8fa1362008-01-25 21:08:05 +0100728 /* if the prio of this runqueue changed, try again */
Gregory Haskins07b40322008-01-25 21:08:10 +0100729 if (double_lock_balance(rq, lowest_rq)) {
Steven Rostedte8fa1362008-01-25 21:08:05 +0100730 /*
731 * We had to unlock the run queue. In
732 * the mean time, task could have
733 * migrated already or had its affinity changed.
734 * Also make sure that it wasn't scheduled on its rq.
735 */
Gregory Haskins07b40322008-01-25 21:08:10 +0100736 if (unlikely(task_rq(task) != rq ||
Ingo Molnar4df64c02008-01-25 21:08:15 +0100737 !cpu_isset(lowest_rq->cpu,
738 task->cpus_allowed) ||
Gregory Haskins07b40322008-01-25 21:08:10 +0100739 task_running(rq, task) ||
Steven Rostedte8fa1362008-01-25 21:08:05 +0100740 !task->se.on_rq)) {
Ingo Molnar4df64c02008-01-25 21:08:15 +0100741
Steven Rostedte8fa1362008-01-25 21:08:05 +0100742 spin_unlock(&lowest_rq->lock);
743 lowest_rq = NULL;
744 break;
745 }
746 }
747
748 /* If this rq is still suitable use it. */
749 if (lowest_rq->rt.highest_prio > task->prio)
750 break;
751
752 /* try again */
753 spin_unlock(&lowest_rq->lock);
754 lowest_rq = NULL;
755 }
756
757 return lowest_rq;
758}
759
760/*
761 * If the current CPU has more than one RT task, see if the non
762 * running task can migrate over to a CPU that is running a task
763 * of lesser priority.
764 */
Gregory Haskins697f0a42008-01-25 21:08:09 +0100765static int push_rt_task(struct rq *rq)
Steven Rostedte8fa1362008-01-25 21:08:05 +0100766{
767 struct task_struct *next_task;
768 struct rq *lowest_rq;
769 int ret = 0;
770 int paranoid = RT_MAX_TRIES;
771
Gregory Haskinsa22d7fc2008-01-25 21:08:12 +0100772 if (!rq->rt.overloaded)
773 return 0;
774
Gregory Haskins697f0a42008-01-25 21:08:09 +0100775 next_task = pick_next_highest_task_rt(rq, -1);
Steven Rostedte8fa1362008-01-25 21:08:05 +0100776 if (!next_task)
777 return 0;
778
779 retry:
Gregory Haskins697f0a42008-01-25 21:08:09 +0100780 if (unlikely(next_task == rq->curr)) {
Steven Rostedtf65eda42008-01-25 21:08:07 +0100781 WARN_ON(1);
Steven Rostedte8fa1362008-01-25 21:08:05 +0100782 return 0;
Steven Rostedtf65eda42008-01-25 21:08:07 +0100783 }
Steven Rostedte8fa1362008-01-25 21:08:05 +0100784
785 /*
786 * It's possible that the next_task slipped in of
787 * higher priority than current. If that's the case
788 * just reschedule current.
789 */
Gregory Haskins697f0a42008-01-25 21:08:09 +0100790 if (unlikely(next_task->prio < rq->curr->prio)) {
791 resched_task(rq->curr);
Steven Rostedte8fa1362008-01-25 21:08:05 +0100792 return 0;
793 }
794
Gregory Haskins697f0a42008-01-25 21:08:09 +0100795 /* We might release rq lock */
Steven Rostedte8fa1362008-01-25 21:08:05 +0100796 get_task_struct(next_task);
797
798 /* find_lock_lowest_rq locks the rq if found */
Gregory Haskins697f0a42008-01-25 21:08:09 +0100799 lowest_rq = find_lock_lowest_rq(next_task, rq);
Steven Rostedte8fa1362008-01-25 21:08:05 +0100800 if (!lowest_rq) {
801 struct task_struct *task;
802 /*
Gregory Haskins697f0a42008-01-25 21:08:09 +0100803 * find lock_lowest_rq releases rq->lock
Steven Rostedte8fa1362008-01-25 21:08:05 +0100804 * so it is possible that next_task has changed.
805 * If it has, then try again.
806 */
Gregory Haskins697f0a42008-01-25 21:08:09 +0100807 task = pick_next_highest_task_rt(rq, -1);
Steven Rostedte8fa1362008-01-25 21:08:05 +0100808 if (unlikely(task != next_task) && task && paranoid--) {
809 put_task_struct(next_task);
810 next_task = task;
811 goto retry;
812 }
813 goto out;
814 }
815
Gregory Haskins697f0a42008-01-25 21:08:09 +0100816 deactivate_task(rq, next_task, 0);
Steven Rostedte8fa1362008-01-25 21:08:05 +0100817 set_task_cpu(next_task, lowest_rq->cpu);
818 activate_task(lowest_rq, next_task, 0);
819
820 resched_task(lowest_rq->curr);
821
822 spin_unlock(&lowest_rq->lock);
823
824 ret = 1;
825out:
826 put_task_struct(next_task);
827
828 return ret;
829}
830
831/*
832 * TODO: Currently we just use the second highest prio task on
833 * the queue, and stop when it can't migrate (or there's
834 * no more RT tasks). There may be a case where a lower
835 * priority RT task has a different affinity than the
836 * higher RT task. In this case the lower RT task could
837 * possibly be able to migrate where as the higher priority
838 * RT task could not. We currently ignore this issue.
839 * Enhancements are welcome!
840 */
841static void push_rt_tasks(struct rq *rq)
842{
843 /* push_rt_task will return true if it moved an RT */
844 while (push_rt_task(rq))
845 ;
846}
847
Steven Rostedtf65eda42008-01-25 21:08:07 +0100848static int pull_rt_task(struct rq *this_rq)
849{
Ingo Molnar80bf3172008-01-25 21:08:17 +0100850 int this_cpu = this_rq->cpu, ret = 0, cpu;
851 struct task_struct *p, *next;
Steven Rostedtf65eda42008-01-25 21:08:07 +0100852 struct rq *src_rq;
Steven Rostedtf65eda42008-01-25 21:08:07 +0100853
Gregory Haskins637f5082008-01-25 21:08:18 +0100854 if (likely(!rt_overloaded(this_rq)))
Steven Rostedtf65eda42008-01-25 21:08:07 +0100855 return 0;
856
857 next = pick_next_task_rt(this_rq);
858
Gregory Haskins637f5082008-01-25 21:08:18 +0100859 for_each_cpu_mask(cpu, this_rq->rd->rto_mask) {
Steven Rostedtf65eda42008-01-25 21:08:07 +0100860 if (this_cpu == cpu)
861 continue;
862
863 src_rq = cpu_rq(cpu);
Steven Rostedtf65eda42008-01-25 21:08:07 +0100864 /*
865 * We can potentially drop this_rq's lock in
866 * double_lock_balance, and another CPU could
867 * steal our next task - hence we must cause
868 * the caller to recalculate the next task
869 * in that case:
870 */
871 if (double_lock_balance(this_rq, src_rq)) {
872 struct task_struct *old_next = next;
Ingo Molnar80bf3172008-01-25 21:08:17 +0100873
Steven Rostedtf65eda42008-01-25 21:08:07 +0100874 next = pick_next_task_rt(this_rq);
875 if (next != old_next)
876 ret = 1;
877 }
878
879 /*
880 * Are there still pullable RT tasks?
881 */
Mike Galbraith614ee1f2008-01-25 21:08:30 +0100882 if (src_rq->rt.rt_nr_running <= 1)
883 goto skip;
Steven Rostedtf65eda42008-01-25 21:08:07 +0100884
Steven Rostedtf65eda42008-01-25 21:08:07 +0100885 p = pick_next_highest_task_rt(src_rq, this_cpu);
886
887 /*
888 * Do we have an RT task that preempts
889 * the to-be-scheduled task?
890 */
891 if (p && (!next || (p->prio < next->prio))) {
892 WARN_ON(p == src_rq->curr);
893 WARN_ON(!p->se.on_rq);
894
895 /*
896 * There's a chance that p is higher in priority
897 * than what's currently running on its cpu.
898 * This is just that p is wakeing up and hasn't
899 * had a chance to schedule. We only pull
900 * p if it is lower in priority than the
901 * current task on the run queue or
902 * this_rq next task is lower in prio than
903 * the current task on that rq.
904 */
905 if (p->prio < src_rq->curr->prio ||
906 (next && next->prio < src_rq->curr->prio))
Mike Galbraith614ee1f2008-01-25 21:08:30 +0100907 goto skip;
Steven Rostedtf65eda42008-01-25 21:08:07 +0100908
909 ret = 1;
910
911 deactivate_task(src_rq, p, 0);
912 set_task_cpu(p, this_cpu);
913 activate_task(this_rq, p, 0);
914 /*
915 * We continue with the search, just in
916 * case there's an even higher prio task
917 * in another runqueue. (low likelyhood
918 * but possible)
Ingo Molnar80bf3172008-01-25 21:08:17 +0100919 *
Steven Rostedtf65eda42008-01-25 21:08:07 +0100920 * Update next so that we won't pick a task
921 * on another cpu with a priority lower (or equal)
922 * than the one we just picked.
923 */
924 next = p;
925
926 }
Mike Galbraith614ee1f2008-01-25 21:08:30 +0100927 skip:
Steven Rostedtf65eda42008-01-25 21:08:07 +0100928 spin_unlock(&src_rq->lock);
929 }
930
931 return ret;
932}
933
Steven Rostedt9a897c52008-01-25 21:08:22 +0100934static void pre_schedule_rt(struct rq *rq, struct task_struct *prev)
Steven Rostedtf65eda42008-01-25 21:08:07 +0100935{
936 /* Try to pull RT tasks here if we lower this rq's prio */
Ingo Molnar7f51f292008-01-25 21:08:17 +0100937 if (unlikely(rt_task(prev)) && rq->rt.highest_prio > prev->prio)
Steven Rostedtf65eda42008-01-25 21:08:07 +0100938 pull_rt_task(rq);
939}
940
Steven Rostedt9a897c52008-01-25 21:08:22 +0100941static void post_schedule_rt(struct rq *rq)
Steven Rostedte8fa1362008-01-25 21:08:05 +0100942{
943 /*
944 * If we have more than one rt_task queued, then
945 * see if we can push the other rt_tasks off to other CPUS.
946 * Note we may release the rq lock, and since
947 * the lock was owned by prev, we need to release it
948 * first via finish_lock_switch and then reaquire it here.
949 */
Gregory Haskinsa22d7fc2008-01-25 21:08:12 +0100950 if (unlikely(rq->rt.overloaded)) {
Steven Rostedte8fa1362008-01-25 21:08:05 +0100951 spin_lock_irq(&rq->lock);
952 push_rt_tasks(rq);
953 spin_unlock_irq(&rq->lock);
954 }
955}
956
Steven Rostedt4642daf2008-01-25 21:08:07 +0100957
Steven Rostedt9a897c52008-01-25 21:08:22 +0100958static void task_wake_up_rt(struct rq *rq, struct task_struct *p)
Steven Rostedt4642daf2008-01-25 21:08:07 +0100959{
Steven Rostedt9a897c52008-01-25 21:08:22 +0100960 if (!task_running(rq, p) &&
Gregory Haskinsa22d7fc2008-01-25 21:08:12 +0100961 (p->prio >= rq->rt.highest_prio) &&
962 rq->rt.overloaded)
Steven Rostedt4642daf2008-01-25 21:08:07 +0100963 push_rt_tasks(rq);
964}
965
Peter Williams43010652007-08-09 11:16:46 +0200966static unsigned long
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200967load_balance_rt(struct rq *this_rq, int this_cpu, struct rq *busiest,
Peter Williamse1d14842007-10-24 18:23:51 +0200968 unsigned long max_load_move,
969 struct sched_domain *sd, enum cpu_idle_type idle,
970 int *all_pinned, int *this_best_prio)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200971{
Steven Rostedtc7a1e462008-01-25 21:08:07 +0100972 /* don't touch RT tasks */
973 return 0;
Peter Williamse1d14842007-10-24 18:23:51 +0200974}
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200975
Peter Williamse1d14842007-10-24 18:23:51 +0200976static int
977move_one_task_rt(struct rq *this_rq, int this_cpu, struct rq *busiest,
978 struct sched_domain *sd, enum cpu_idle_type idle)
979{
Steven Rostedtc7a1e462008-01-25 21:08:07 +0100980 /* don't touch RT tasks */
981 return 0;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200982}
Ingo Molnardeeeccd2008-01-25 21:08:15 +0100983
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100984static void set_cpus_allowed_rt(struct task_struct *p, cpumask_t *new_mask)
985{
986 int weight = cpus_weight(*new_mask);
987
988 BUG_ON(!rt_task(p));
989
990 /*
991 * Update the migration status of the RQ if we have an RT task
992 * which is running AND changing its weight value.
993 */
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100994 if (p->se.on_rq && (weight != p->rt.nr_cpus_allowed)) {
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100995 struct rq *rq = task_rq(p);
996
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100997 if ((p->rt.nr_cpus_allowed <= 1) && (weight > 1)) {
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100998 rq->rt.rt_nr_migratory++;
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100999 } else if ((p->rt.nr_cpus_allowed > 1) && (weight <= 1)) {
Gregory Haskins73fe6aa2008-01-25 21:08:07 +01001000 BUG_ON(!rq->rt.rt_nr_migratory);
1001 rq->rt.rt_nr_migratory--;
1002 }
1003
1004 update_rt_migration(rq);
1005 }
1006
1007 p->cpus_allowed = *new_mask;
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001008 p->rt.nr_cpus_allowed = weight;
Gregory Haskins73fe6aa2008-01-25 21:08:07 +01001009}
Ingo Molnardeeeccd2008-01-25 21:08:15 +01001010
Ingo Molnarbdd7c812008-01-25 21:08:18 +01001011/* Assumes rq->lock is held */
1012static void join_domain_rt(struct rq *rq)
1013{
1014 if (rq->rt.overloaded)
1015 rt_set_overload(rq);
1016}
1017
1018/* Assumes rq->lock is held */
1019static void leave_domain_rt(struct rq *rq)
1020{
1021 if (rq->rt.overloaded)
1022 rt_clear_overload(rq);
1023}
Steven Rostedtcb469842008-01-25 21:08:22 +01001024
1025/*
1026 * When switch from the rt queue, we bring ourselves to a position
1027 * that we might want to pull RT tasks from other runqueues.
1028 */
1029static void switched_from_rt(struct rq *rq, struct task_struct *p,
1030 int running)
1031{
1032 /*
1033 * If there are other RT tasks then we will reschedule
1034 * and the scheduling of the other RT tasks will handle
1035 * the balancing. But if we are the last RT task
1036 * we may need to handle the pulling of RT tasks
1037 * now.
1038 */
1039 if (!rq->rt.rt_nr_running)
1040 pull_rt_task(rq);
1041}
Steven Rostedte8fa1362008-01-25 21:08:05 +01001042#endif /* CONFIG_SMP */
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001043
Steven Rostedtcb469842008-01-25 21:08:22 +01001044/*
1045 * When switching a task to RT, we may overload the runqueue
1046 * with RT tasks. In this case we try to push them off to
1047 * other runqueues.
1048 */
1049static void switched_to_rt(struct rq *rq, struct task_struct *p,
1050 int running)
1051{
1052 int check_resched = 1;
1053
1054 /*
1055 * If we are already running, then there's nothing
1056 * that needs to be done. But if we are not running
1057 * we may need to preempt the current running task.
1058 * If that current running task is also an RT task
1059 * then see if we can move to another run queue.
1060 */
1061 if (!running) {
1062#ifdef CONFIG_SMP
1063 if (rq->rt.overloaded && push_rt_task(rq) &&
1064 /* Don't resched if we changed runqueues */
1065 rq != task_rq(p))
1066 check_resched = 0;
1067#endif /* CONFIG_SMP */
1068 if (check_resched && p->prio < rq->curr->prio)
1069 resched_task(rq->curr);
1070 }
1071}
1072
1073/*
1074 * Priority of the task has changed. This may cause
1075 * us to initiate a push or pull.
1076 */
1077static void prio_changed_rt(struct rq *rq, struct task_struct *p,
1078 int oldprio, int running)
1079{
1080 if (running) {
1081#ifdef CONFIG_SMP
1082 /*
1083 * If our priority decreases while running, we
1084 * may need to pull tasks to this runqueue.
1085 */
1086 if (oldprio < p->prio)
1087 pull_rt_task(rq);
1088 /*
1089 * If there's a higher priority task waiting to run
1090 * then reschedule.
1091 */
1092 if (p->prio > rq->rt.highest_prio)
1093 resched_task(p);
1094#else
1095 /* For UP simply resched on drop of prio */
1096 if (oldprio < p->prio)
1097 resched_task(p);
1098#endif /* CONFIG_SMP */
1099 } else {
1100 /*
1101 * This task is not running, but if it is
1102 * greater than the current running task
1103 * then reschedule.
1104 */
1105 if (p->prio < rq->curr->prio)
1106 resched_task(rq->curr);
1107 }
1108}
1109
Peter Zijlstra78f2c7d2008-01-25 21:08:27 +01001110static void watchdog(struct rq *rq, struct task_struct *p)
1111{
1112 unsigned long soft, hard;
1113
1114 if (!p->signal)
1115 return;
1116
1117 soft = p->signal->rlim[RLIMIT_RTTIME].rlim_cur;
1118 hard = p->signal->rlim[RLIMIT_RTTIME].rlim_max;
1119
1120 if (soft != RLIM_INFINITY) {
1121 unsigned long next;
1122
1123 p->rt.timeout++;
1124 next = DIV_ROUND_UP(min(soft, hard), USEC_PER_SEC/HZ);
1125 if (next > p->rt.timeout) {
1126 u64 next_time = p->se.sum_exec_runtime;
1127
1128 next_time += next * (NSEC_PER_SEC/HZ);
1129 if (p->it_sched_expires > next_time)
1130 p->it_sched_expires = next_time;
1131 } else
1132 p->it_sched_expires = p->se.sum_exec_runtime;
1133 }
1134}
Steven Rostedtcb469842008-01-25 21:08:22 +01001135
Peter Zijlstra8f4d37e2008-01-25 21:08:29 +01001136static void task_tick_rt(struct rq *rq, struct task_struct *p, int queued)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001137{
Peter Zijlstra67e2be02007-12-20 15:01:17 +01001138 update_curr_rt(rq);
1139
Peter Zijlstra78f2c7d2008-01-25 21:08:27 +01001140 watchdog(rq, p);
1141
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001142 /*
1143 * RR tasks need a special form of timeslice management.
1144 * FIFO tasks have no timeslices.
1145 */
1146 if (p->policy != SCHED_RR)
1147 return;
1148
Peter Zijlstrafa717062008-01-25 21:08:27 +01001149 if (--p->rt.time_slice)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001150 return;
1151
Peter Zijlstrafa717062008-01-25 21:08:27 +01001152 p->rt.time_slice = DEF_TIMESLICE;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001153
Dmitry Adamushko98fbc792007-08-24 20:39:10 +02001154 /*
1155 * Requeue to the end of queue if we are not the only element
1156 * on the queue:
1157 */
Peter Zijlstrafa717062008-01-25 21:08:27 +01001158 if (p->rt.run_list.prev != p->rt.run_list.next) {
Dmitry Adamushko98fbc792007-08-24 20:39:10 +02001159 requeue_task_rt(rq, p);
1160 set_tsk_need_resched(p);
1161 }
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001162}
1163
Srivatsa Vaddagiri83b699e2007-10-15 17:00:08 +02001164static void set_curr_task_rt(struct rq *rq)
1165{
1166 struct task_struct *p = rq->curr;
1167
1168 p->se.exec_start = rq->clock;
1169}
1170
Ingo Molnar5522d5d2007-10-15 17:00:12 +02001171const struct sched_class rt_sched_class = {
1172 .next = &fair_sched_class,
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001173 .enqueue_task = enqueue_task_rt,
1174 .dequeue_task = dequeue_task_rt,
1175 .yield_task = yield_task_rt,
Gregory Haskinse7693a32008-01-25 21:08:09 +01001176#ifdef CONFIG_SMP
1177 .select_task_rq = select_task_rq_rt,
1178#endif /* CONFIG_SMP */
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001179
1180 .check_preempt_curr = check_preempt_curr_rt,
1181
1182 .pick_next_task = pick_next_task_rt,
1183 .put_prev_task = put_prev_task_rt,
1184
Peter Williams681f3e62007-10-24 18:23:51 +02001185#ifdef CONFIG_SMP
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001186 .load_balance = load_balance_rt,
Peter Williamse1d14842007-10-24 18:23:51 +02001187 .move_one_task = move_one_task_rt,
Gregory Haskins73fe6aa2008-01-25 21:08:07 +01001188 .set_cpus_allowed = set_cpus_allowed_rt,
Ingo Molnarbdd7c812008-01-25 21:08:18 +01001189 .join_domain = join_domain_rt,
1190 .leave_domain = leave_domain_rt,
Steven Rostedt9a897c52008-01-25 21:08:22 +01001191 .pre_schedule = pre_schedule_rt,
1192 .post_schedule = post_schedule_rt,
1193 .task_wake_up = task_wake_up_rt,
Steven Rostedtcb469842008-01-25 21:08:22 +01001194 .switched_from = switched_from_rt,
Peter Williams681f3e62007-10-24 18:23:51 +02001195#endif
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001196
Srivatsa Vaddagiri83b699e2007-10-15 17:00:08 +02001197 .set_curr_task = set_curr_task_rt,
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001198 .task_tick = task_tick_rt,
Steven Rostedtcb469842008-01-25 21:08:22 +01001199
1200 .prio_changed = prio_changed_rt,
1201 .switched_to = switched_to_rt,
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001202};