blob: a8c207ff3492d6dfda0d4b151aa34298e8bc982d [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
Gregory Haskins398a1532009-01-14 09:10:04 -05006#ifdef CONFIG_RT_GROUP_SCHED
7
Peter Zijlstraa1ba4d82009-04-01 18:40:15 +02008#define rt_entity_is_task(rt_se) (!(rt_se)->my_q)
9
Peter Zijlstra8f488942009-07-24 12:25:30 +020010static inline struct task_struct *rt_task_of(struct sched_rt_entity *rt_se)
11{
12#ifdef CONFIG_SCHED_DEBUG
13 WARN_ON_ONCE(!rt_entity_is_task(rt_se));
14#endif
15 return container_of(rt_se, struct task_struct, rt);
16}
17
Gregory Haskins398a1532009-01-14 09:10:04 -050018static inline struct rq *rq_of_rt_rq(struct rt_rq *rt_rq)
19{
20 return rt_rq->rq;
21}
22
23static inline struct rt_rq *rt_rq_of_se(struct sched_rt_entity *rt_se)
24{
25 return rt_se->rt_rq;
26}
27
28#else /* CONFIG_RT_GROUP_SCHED */
29
Peter Zijlstraa1ba4d82009-04-01 18:40:15 +020030#define rt_entity_is_task(rt_se) (1)
31
Peter Zijlstra8f488942009-07-24 12:25:30 +020032static inline struct task_struct *rt_task_of(struct sched_rt_entity *rt_se)
33{
34 return container_of(rt_se, struct task_struct, rt);
35}
36
Gregory Haskins398a1532009-01-14 09:10:04 -050037static inline struct rq *rq_of_rt_rq(struct rt_rq *rt_rq)
38{
39 return container_of(rt_rq, struct rq, rt);
40}
41
42static inline struct rt_rq *rt_rq_of_se(struct sched_rt_entity *rt_se)
43{
44 struct task_struct *p = rt_task_of(rt_se);
45 struct rq *rq = task_rq(p);
46
47 return &rq->rt;
48}
49
50#endif /* CONFIG_RT_GROUP_SCHED */
51
Steven Rostedt4fd29172008-01-25 21:08:06 +010052#ifdef CONFIG_SMP
Ingo Molnar84de4272008-01-25 21:08:15 +010053
Gregory Haskins637f5082008-01-25 21:08:18 +010054static inline int rt_overloaded(struct rq *rq)
Steven Rostedt4fd29172008-01-25 21:08:06 +010055{
Gregory Haskins637f5082008-01-25 21:08:18 +010056 return atomic_read(&rq->rd->rto_count);
Steven Rostedt4fd29172008-01-25 21:08:06 +010057}
Ingo Molnar84de4272008-01-25 21:08:15 +010058
Steven Rostedt4fd29172008-01-25 21:08:06 +010059static inline void rt_set_overload(struct rq *rq)
60{
Gregory Haskins1f11eb62008-06-04 15:04:05 -040061 if (!rq->online)
62 return;
63
Rusty Russellc6c49272008-11-25 02:35:05 +103064 cpumask_set_cpu(rq->cpu, rq->rd->rto_mask);
Steven Rostedt4fd29172008-01-25 21:08:06 +010065 /*
66 * Make sure the mask is visible before we set
67 * the overload count. That is checked to determine
68 * if we should look at the mask. It would be a shame
69 * if we looked at the mask, but the mask was not
70 * updated yet.
71 */
72 wmb();
Gregory Haskins637f5082008-01-25 21:08:18 +010073 atomic_inc(&rq->rd->rto_count);
Steven Rostedt4fd29172008-01-25 21:08:06 +010074}
Ingo Molnar84de4272008-01-25 21:08:15 +010075
Steven Rostedt4fd29172008-01-25 21:08:06 +010076static inline void rt_clear_overload(struct rq *rq)
77{
Gregory Haskins1f11eb62008-06-04 15:04:05 -040078 if (!rq->online)
79 return;
80
Steven Rostedt4fd29172008-01-25 21:08:06 +010081 /* the order here really doesn't matter */
Gregory Haskins637f5082008-01-25 21:08:18 +010082 atomic_dec(&rq->rd->rto_count);
Rusty Russellc6c49272008-11-25 02:35:05 +103083 cpumask_clear_cpu(rq->cpu, rq->rd->rto_mask);
Steven Rostedt4fd29172008-01-25 21:08:06 +010084}
Gregory Haskins73fe6aa2008-01-25 21:08:07 +010085
Gregory Haskins398a1532009-01-14 09:10:04 -050086static void update_rt_migration(struct rt_rq *rt_rq)
Gregory Haskins73fe6aa2008-01-25 21:08:07 +010087{
Peter Zijlstraa1ba4d82009-04-01 18:40:15 +020088 if (rt_rq->rt_nr_migratory && rt_rq->rt_nr_total > 1) {
Gregory Haskins398a1532009-01-14 09:10:04 -050089 if (!rt_rq->overloaded) {
90 rt_set_overload(rq_of_rt_rq(rt_rq));
91 rt_rq->overloaded = 1;
Gregory Haskinscdc8eb92008-01-25 21:08:23 +010092 }
Gregory Haskins398a1532009-01-14 09:10:04 -050093 } else if (rt_rq->overloaded) {
94 rt_clear_overload(rq_of_rt_rq(rt_rq));
95 rt_rq->overloaded = 0;
Gregory Haskins637f5082008-01-25 21:08:18 +010096 }
Gregory Haskins73fe6aa2008-01-25 21:08:07 +010097}
Steven Rostedt4fd29172008-01-25 21:08:06 +010098
Gregory Haskins398a1532009-01-14 09:10:04 -050099static void inc_rt_migration(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100100{
Peter Zijlstraa1ba4d82009-04-01 18:40:15 +0200101 if (!rt_entity_is_task(rt_se))
102 return;
103
104 rt_rq = &rq_of_rt_rq(rt_rq)->rt;
105
106 rt_rq->rt_nr_total++;
Gregory Haskins398a1532009-01-14 09:10:04 -0500107 if (rt_se->nr_cpus_allowed > 1)
108 rt_rq->rt_nr_migratory++;
109
110 update_rt_migration(rt_rq);
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100111}
112
Gregory Haskins398a1532009-01-14 09:10:04 -0500113static void dec_rt_migration(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)
114{
Peter Zijlstraa1ba4d82009-04-01 18:40:15 +0200115 if (!rt_entity_is_task(rt_se))
116 return;
117
118 rt_rq = &rq_of_rt_rq(rt_rq)->rt;
119
120 rt_rq->rt_nr_total--;
Gregory Haskins398a1532009-01-14 09:10:04 -0500121 if (rt_se->nr_cpus_allowed > 1)
122 rt_rq->rt_nr_migratory--;
123
124 update_rt_migration(rt_rq);
125}
126
Steven Rostedt5181f4a2011-06-16 21:55:23 -0400127static inline int has_pushable_tasks(struct rq *rq)
128{
129 return !plist_head_empty(&rq->rt.pushable_tasks);
130}
131
Gregory Haskins917b6272008-12-29 09:39:53 -0500132static void enqueue_pushable_task(struct rq *rq, struct task_struct *p)
133{
134 plist_del(&p->pushable_tasks, &rq->rt.pushable_tasks);
135 plist_node_init(&p->pushable_tasks, p->prio);
136 plist_add(&p->pushable_tasks, &rq->rt.pushable_tasks);
Steven Rostedt5181f4a2011-06-16 21:55:23 -0400137
138 /* Update the highest prio pushable task */
139 if (p->prio < rq->rt.highest_prio.next)
140 rq->rt.highest_prio.next = p->prio;
Gregory Haskins917b6272008-12-29 09:39:53 -0500141}
142
143static void dequeue_pushable_task(struct rq *rq, struct task_struct *p)
144{
145 plist_del(&p->pushable_tasks, &rq->rt.pushable_tasks);
Gregory Haskins917b6272008-12-29 09:39:53 -0500146
Steven Rostedt5181f4a2011-06-16 21:55:23 -0400147 /* Update the new highest prio pushable task */
148 if (has_pushable_tasks(rq)) {
149 p = plist_first_entry(&rq->rt.pushable_tasks,
150 struct task_struct, pushable_tasks);
151 rq->rt.highest_prio.next = p->prio;
152 } else
153 rq->rt.highest_prio.next = MAX_RT_PRIO;
Ingo Molnarbcf08df2008-04-19 12:11:10 +0200154}
155
Gregory Haskins917b6272008-12-29 09:39:53 -0500156#else
157
Peter Zijlstraceacc2c2009-01-16 14:46:40 +0100158static inline void enqueue_pushable_task(struct rq *rq, struct task_struct *p)
159{
160}
161
162static inline void dequeue_pushable_task(struct rq *rq, struct task_struct *p)
163{
164}
165
Gregory Haskinsb07430a2009-01-14 08:55:39 -0500166static inline
Peter Zijlstraceacc2c2009-01-16 14:46:40 +0100167void inc_rt_migration(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)
168{
169}
170
Gregory Haskinsb07430a2009-01-14 08:55:39 -0500171static inline
Peter Zijlstraceacc2c2009-01-16 14:46:40 +0100172void dec_rt_migration(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)
173{
174}
Gregory Haskins917b6272008-12-29 09:39:53 -0500175
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200176#endif /* CONFIG_SMP */
177
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100178static inline int on_rt_rq(struct sched_rt_entity *rt_se)
179{
180 return !list_empty(&rt_se->run_list);
181}
182
Peter Zijlstra052f1dc2008-02-13 15:45:40 +0100183#ifdef CONFIG_RT_GROUP_SCHED
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100184
Peter Zijlstra9f0c1e52008-02-13 15:45:39 +0100185static inline u64 sched_rt_runtime(struct rt_rq *rt_rq)
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100186{
187 if (!rt_rq->tg)
Peter Zijlstra9f0c1e52008-02-13 15:45:39 +0100188 return RUNTIME_INF;
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100189
Peter Zijlstraac086bc2008-04-19 19:44:58 +0200190 return rt_rq->rt_runtime;
191}
192
193static inline u64 sched_rt_period(struct rt_rq *rt_rq)
194{
195 return ktime_to_ns(rt_rq->tg->rt_bandwidth.rt_period);
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100196}
197
Cheng Xuec514c42011-05-14 14:20:02 +0800198typedef struct task_group *rt_rq_iter_t;
199
Yong Zhang1c09ab02011-06-28 10:51:31 +0800200static inline struct task_group *next_task_group(struct task_group *tg)
201{
202 do {
203 tg = list_entry_rcu(tg->list.next,
204 typeof(struct task_group), list);
205 } while (&tg->list != &task_groups && task_group_is_autogroup(tg));
206
207 if (&tg->list == &task_groups)
208 tg = NULL;
209
210 return tg;
211}
212
213#define for_each_rt_rq(rt_rq, iter, rq) \
214 for (iter = container_of(&task_groups, typeof(*iter), list); \
215 (iter = next_task_group(iter)) && \
216 (rt_rq = iter->rt_rq[cpu_of(rq)]);)
Cheng Xuec514c42011-05-14 14:20:02 +0800217
Peter Zijlstra3d4b47b2010-11-15 15:47:01 -0800218static inline void list_add_leaf_rt_rq(struct rt_rq *rt_rq)
219{
220 list_add_rcu(&rt_rq->leaf_rt_rq_list,
221 &rq_of_rt_rq(rt_rq)->leaf_rt_rq_list);
222}
223
224static inline void list_del_leaf_rt_rq(struct rt_rq *rt_rq)
225{
226 list_del_rcu(&rt_rq->leaf_rt_rq_list);
227}
228
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100229#define for_each_leaf_rt_rq(rt_rq, rq) \
Bharata B Rao80f40ee2008-12-15 11:56:48 +0530230 list_for_each_entry_rcu(rt_rq, &rq->leaf_rt_rq_list, leaf_rt_rq_list)
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100231
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100232#define for_each_sched_rt_entity(rt_se) \
233 for (; rt_se; rt_se = rt_se->parent)
234
235static inline struct rt_rq *group_rt_rq(struct sched_rt_entity *rt_se)
236{
237 return rt_se->my_q;
238}
239
Thomas Gleixner37dad3f2010-01-20 20:59:01 +0000240static void enqueue_rt_entity(struct sched_rt_entity *rt_se, bool head);
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100241static void dequeue_rt_entity(struct sched_rt_entity *rt_se);
242
Peter Zijlstra9f0c1e52008-02-13 15:45:39 +0100243static void sched_rt_rq_enqueue(struct rt_rq *rt_rq)
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100244{
Dario Faggiolif6121f42008-10-03 17:40:46 +0200245 struct task_struct *curr = rq_of_rt_rq(rt_rq)->curr;
Yong Zhang74b7eb52010-01-29 14:57:52 +0800246 struct sched_rt_entity *rt_se;
247
Balbir Singh0c3b9162011-03-03 17:04:35 +0530248 int cpu = cpu_of(rq_of_rt_rq(rt_rq));
249
250 rt_se = rt_rq->tg->rt_se[cpu];
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100251
Dario Faggiolif6121f42008-10-03 17:40:46 +0200252 if (rt_rq->rt_nr_running) {
253 if (rt_se && !on_rt_rq(rt_se))
Thomas Gleixner37dad3f2010-01-20 20:59:01 +0000254 enqueue_rt_entity(rt_se, false);
Gregory Haskinse864c492008-12-29 09:39:49 -0500255 if (rt_rq->highest_prio.curr < curr->prio)
Peter Zijlstra10203872008-01-25 21:08:32 +0100256 resched_task(curr);
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100257 }
258}
259
Peter Zijlstra9f0c1e52008-02-13 15:45:39 +0100260static void sched_rt_rq_dequeue(struct rt_rq *rt_rq)
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100261{
Yong Zhang74b7eb52010-01-29 14:57:52 +0800262 struct sched_rt_entity *rt_se;
Balbir Singh0c3b9162011-03-03 17:04:35 +0530263 int cpu = cpu_of(rq_of_rt_rq(rt_rq));
Yong Zhang74b7eb52010-01-29 14:57:52 +0800264
Balbir Singh0c3b9162011-03-03 17:04:35 +0530265 rt_se = rt_rq->tg->rt_se[cpu];
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100266
267 if (rt_se && on_rt_rq(rt_se))
268 dequeue_rt_entity(rt_se);
269}
270
Peter Zijlstra23b0fdf2008-02-13 15:45:39 +0100271static inline int rt_rq_throttled(struct rt_rq *rt_rq)
272{
273 return rt_rq->rt_throttled && !rt_rq->rt_nr_boosted;
274}
275
276static int rt_se_boosted(struct sched_rt_entity *rt_se)
277{
278 struct rt_rq *rt_rq = group_rt_rq(rt_se);
279 struct task_struct *p;
280
281 if (rt_rq)
282 return !!rt_rq->rt_nr_boosted;
283
284 p = rt_task_of(rt_se);
285 return p->prio != p->normal_prio;
286}
287
Peter Zijlstrad0b27fa2008-04-19 19:44:57 +0200288#ifdef CONFIG_SMP
Rusty Russellc6c49272008-11-25 02:35:05 +1030289static inline const struct cpumask *sched_rt_period_mask(void)
Peter Zijlstrad0b27fa2008-04-19 19:44:57 +0200290{
291 return cpu_rq(smp_processor_id())->rd->span;
292}
293#else
Rusty Russellc6c49272008-11-25 02:35:05 +1030294static inline const struct cpumask *sched_rt_period_mask(void)
Peter Zijlstrad0b27fa2008-04-19 19:44:57 +0200295{
Rusty Russellc6c49272008-11-25 02:35:05 +1030296 return cpu_online_mask;
Peter Zijlstrad0b27fa2008-04-19 19:44:57 +0200297}
298#endif
299
300static inline
301struct rt_rq *sched_rt_period_rt_rq(struct rt_bandwidth *rt_b, int cpu)
302{
303 return container_of(rt_b, struct task_group, rt_bandwidth)->rt_rq[cpu];
304}
305
Peter Zijlstraac086bc2008-04-19 19:44:58 +0200306static inline struct rt_bandwidth *sched_rt_bandwidth(struct rt_rq *rt_rq)
307{
308 return &rt_rq->tg->rt_bandwidth;
309}
310
Dhaval Giani55e12e52008-06-24 23:39:43 +0530311#else /* !CONFIG_RT_GROUP_SCHED */
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100312
Peter Zijlstra9f0c1e52008-02-13 15:45:39 +0100313static inline u64 sched_rt_runtime(struct rt_rq *rt_rq)
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100314{
Peter Zijlstraac086bc2008-04-19 19:44:58 +0200315 return rt_rq->rt_runtime;
316}
317
318static inline u64 sched_rt_period(struct rt_rq *rt_rq)
319{
320 return ktime_to_ns(def_rt_bandwidth.rt_period);
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100321}
322
Cheng Xuec514c42011-05-14 14:20:02 +0800323typedef struct rt_rq *rt_rq_iter_t;
324
325#define for_each_rt_rq(rt_rq, iter, rq) \
326 for ((void) iter, rt_rq = &rq->rt; rt_rq; rt_rq = NULL)
327
Peter Zijlstra3d4b47b2010-11-15 15:47:01 -0800328static inline void list_add_leaf_rt_rq(struct rt_rq *rt_rq)
329{
330}
331
332static inline void list_del_leaf_rt_rq(struct rt_rq *rt_rq)
333{
334}
335
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100336#define for_each_leaf_rt_rq(rt_rq, rq) \
337 for (rt_rq = &rq->rt; rt_rq; rt_rq = NULL)
338
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100339#define for_each_sched_rt_entity(rt_se) \
340 for (; rt_se; rt_se = NULL)
341
342static inline struct rt_rq *group_rt_rq(struct sched_rt_entity *rt_se)
343{
344 return NULL;
345}
346
Peter Zijlstra9f0c1e52008-02-13 15:45:39 +0100347static inline void sched_rt_rq_enqueue(struct rt_rq *rt_rq)
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100348{
John Blackwoodf3ade832008-08-26 15:09:43 -0400349 if (rt_rq->rt_nr_running)
350 resched_task(rq_of_rt_rq(rt_rq)->curr);
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100351}
352
Peter Zijlstra9f0c1e52008-02-13 15:45:39 +0100353static inline void sched_rt_rq_dequeue(struct rt_rq *rt_rq)
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100354{
355}
356
Peter Zijlstra23b0fdf2008-02-13 15:45:39 +0100357static inline int rt_rq_throttled(struct rt_rq *rt_rq)
358{
359 return rt_rq->rt_throttled;
360}
Peter Zijlstrad0b27fa2008-04-19 19:44:57 +0200361
Rusty Russellc6c49272008-11-25 02:35:05 +1030362static inline const struct cpumask *sched_rt_period_mask(void)
Peter Zijlstrad0b27fa2008-04-19 19:44:57 +0200363{
Rusty Russellc6c49272008-11-25 02:35:05 +1030364 return cpu_online_mask;
Peter Zijlstrad0b27fa2008-04-19 19:44:57 +0200365}
366
367static inline
368struct rt_rq *sched_rt_period_rt_rq(struct rt_bandwidth *rt_b, int cpu)
369{
370 return &cpu_rq(cpu)->rt;
371}
372
Peter Zijlstraac086bc2008-04-19 19:44:58 +0200373static inline struct rt_bandwidth *sched_rt_bandwidth(struct rt_rq *rt_rq)
374{
375 return &def_rt_bandwidth;
376}
377
Dhaval Giani55e12e52008-06-24 23:39:43 +0530378#endif /* CONFIG_RT_GROUP_SCHED */
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100379
Peter Zijlstrab79f3832008-06-19 14:22:25 +0200380#ifdef CONFIG_SMP
Peter Zijlstra78333cd2008-09-23 15:33:43 +0200381/*
382 * We ran out of runtime, see if we can borrow some from our neighbours.
383 */
Peter Zijlstrab79f3832008-06-19 14:22:25 +0200384static int do_balance_runtime(struct rt_rq *rt_rq)
Peter Zijlstraac086bc2008-04-19 19:44:58 +0200385{
386 struct rt_bandwidth *rt_b = sched_rt_bandwidth(rt_rq);
387 struct root_domain *rd = cpu_rq(smp_processor_id())->rd;
388 int i, weight, more = 0;
389 u64 rt_period;
390
Rusty Russellc6c49272008-11-25 02:35:05 +1030391 weight = cpumask_weight(rd->span);
Peter Zijlstraac086bc2008-04-19 19:44:58 +0200392
Thomas Gleixner0986b112009-11-17 15:32:06 +0100393 raw_spin_lock(&rt_b->rt_runtime_lock);
Peter Zijlstraac086bc2008-04-19 19:44:58 +0200394 rt_period = ktime_to_ns(rt_b->rt_period);
Rusty Russellc6c49272008-11-25 02:35:05 +1030395 for_each_cpu(i, rd->span) {
Peter Zijlstraac086bc2008-04-19 19:44:58 +0200396 struct rt_rq *iter = sched_rt_period_rt_rq(rt_b, i);
397 s64 diff;
398
399 if (iter == rt_rq)
400 continue;
401
Thomas Gleixner0986b112009-11-17 15:32:06 +0100402 raw_spin_lock(&iter->rt_runtime_lock);
Peter Zijlstra78333cd2008-09-23 15:33:43 +0200403 /*
404 * Either all rqs have inf runtime and there's nothing to steal
405 * or __disable_runtime() below sets a specific rq to inf to
406 * indicate its been disabled and disalow stealing.
407 */
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200408 if (iter->rt_runtime == RUNTIME_INF)
409 goto next;
410
Peter Zijlstra78333cd2008-09-23 15:33:43 +0200411 /*
412 * From runqueues with spare time, take 1/n part of their
413 * spare time, but no more than our period.
414 */
Peter Zijlstraac086bc2008-04-19 19:44:58 +0200415 diff = iter->rt_runtime - iter->rt_time;
416 if (diff > 0) {
Peter Zijlstra58838cf2008-07-24 12:43:13 +0200417 diff = div_u64((u64)diff, weight);
Peter Zijlstraac086bc2008-04-19 19:44:58 +0200418 if (rt_rq->rt_runtime + diff > rt_period)
419 diff = rt_period - rt_rq->rt_runtime;
420 iter->rt_runtime -= diff;
421 rt_rq->rt_runtime += diff;
422 more = 1;
423 if (rt_rq->rt_runtime == rt_period) {
Thomas Gleixner0986b112009-11-17 15:32:06 +0100424 raw_spin_unlock(&iter->rt_runtime_lock);
Peter Zijlstraac086bc2008-04-19 19:44:58 +0200425 break;
426 }
427 }
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200428next:
Thomas Gleixner0986b112009-11-17 15:32:06 +0100429 raw_spin_unlock(&iter->rt_runtime_lock);
Peter Zijlstraac086bc2008-04-19 19:44:58 +0200430 }
Thomas Gleixner0986b112009-11-17 15:32:06 +0100431 raw_spin_unlock(&rt_b->rt_runtime_lock);
Peter Zijlstraac086bc2008-04-19 19:44:58 +0200432
433 return more;
434}
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200435
Peter Zijlstra78333cd2008-09-23 15:33:43 +0200436/*
437 * Ensure this RQ takes back all the runtime it lend to its neighbours.
438 */
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200439static void __disable_runtime(struct rq *rq)
440{
441 struct root_domain *rd = rq->rd;
Cheng Xuec514c42011-05-14 14:20:02 +0800442 rt_rq_iter_t iter;
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200443 struct rt_rq *rt_rq;
444
445 if (unlikely(!scheduler_running))
446 return;
447
Cheng Xuec514c42011-05-14 14:20:02 +0800448 for_each_rt_rq(rt_rq, iter, rq) {
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200449 struct rt_bandwidth *rt_b = sched_rt_bandwidth(rt_rq);
450 s64 want;
451 int i;
452
Thomas Gleixner0986b112009-11-17 15:32:06 +0100453 raw_spin_lock(&rt_b->rt_runtime_lock);
454 raw_spin_lock(&rt_rq->rt_runtime_lock);
Peter Zijlstra78333cd2008-09-23 15:33:43 +0200455 /*
456 * Either we're all inf and nobody needs to borrow, or we're
457 * already disabled and thus have nothing to do, or we have
458 * exactly the right amount of runtime to take out.
459 */
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200460 if (rt_rq->rt_runtime == RUNTIME_INF ||
461 rt_rq->rt_runtime == rt_b->rt_runtime)
462 goto balanced;
Thomas Gleixner0986b112009-11-17 15:32:06 +0100463 raw_spin_unlock(&rt_rq->rt_runtime_lock);
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200464
Peter Zijlstra78333cd2008-09-23 15:33:43 +0200465 /*
466 * Calculate the difference between what we started out with
467 * and what we current have, that's the amount of runtime
468 * we lend and now have to reclaim.
469 */
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200470 want = rt_b->rt_runtime - rt_rq->rt_runtime;
471
Peter Zijlstra78333cd2008-09-23 15:33:43 +0200472 /*
473 * Greedy reclaim, take back as much as we can.
474 */
Rusty Russellc6c49272008-11-25 02:35:05 +1030475 for_each_cpu(i, rd->span) {
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200476 struct rt_rq *iter = sched_rt_period_rt_rq(rt_b, i);
477 s64 diff;
478
Peter Zijlstra78333cd2008-09-23 15:33:43 +0200479 /*
480 * Can't reclaim from ourselves or disabled runqueues.
481 */
Peter Zijlstraf1679d02008-08-14 15:49:00 +0200482 if (iter == rt_rq || iter->rt_runtime == RUNTIME_INF)
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200483 continue;
484
Thomas Gleixner0986b112009-11-17 15:32:06 +0100485 raw_spin_lock(&iter->rt_runtime_lock);
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200486 if (want > 0) {
487 diff = min_t(s64, iter->rt_runtime, want);
488 iter->rt_runtime -= diff;
489 want -= diff;
490 } else {
491 iter->rt_runtime -= want;
492 want -= want;
493 }
Thomas Gleixner0986b112009-11-17 15:32:06 +0100494 raw_spin_unlock(&iter->rt_runtime_lock);
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200495
496 if (!want)
497 break;
498 }
499
Thomas Gleixner0986b112009-11-17 15:32:06 +0100500 raw_spin_lock(&rt_rq->rt_runtime_lock);
Peter Zijlstra78333cd2008-09-23 15:33:43 +0200501 /*
502 * We cannot be left wanting - that would mean some runtime
503 * leaked out of the system.
504 */
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200505 BUG_ON(want);
506balanced:
Peter Zijlstra78333cd2008-09-23 15:33:43 +0200507 /*
508 * Disable all the borrow logic by pretending we have inf
509 * runtime - in which case borrowing doesn't make sense.
510 */
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200511 rt_rq->rt_runtime = RUNTIME_INF;
Thomas Gleixner0986b112009-11-17 15:32:06 +0100512 raw_spin_unlock(&rt_rq->rt_runtime_lock);
513 raw_spin_unlock(&rt_b->rt_runtime_lock);
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200514 }
515}
516
517static void disable_runtime(struct rq *rq)
518{
519 unsigned long flags;
520
Thomas Gleixner05fa7852009-11-17 14:28:38 +0100521 raw_spin_lock_irqsave(&rq->lock, flags);
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200522 __disable_runtime(rq);
Thomas Gleixner05fa7852009-11-17 14:28:38 +0100523 raw_spin_unlock_irqrestore(&rq->lock, flags);
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200524}
525
526static void __enable_runtime(struct rq *rq)
527{
Cheng Xuec514c42011-05-14 14:20:02 +0800528 rt_rq_iter_t iter;
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200529 struct rt_rq *rt_rq;
530
531 if (unlikely(!scheduler_running))
532 return;
533
Peter Zijlstra78333cd2008-09-23 15:33:43 +0200534 /*
535 * Reset each runqueue's bandwidth settings
536 */
Cheng Xuec514c42011-05-14 14:20:02 +0800537 for_each_rt_rq(rt_rq, iter, rq) {
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200538 struct rt_bandwidth *rt_b = sched_rt_bandwidth(rt_rq);
539
Thomas Gleixner0986b112009-11-17 15:32:06 +0100540 raw_spin_lock(&rt_b->rt_runtime_lock);
541 raw_spin_lock(&rt_rq->rt_runtime_lock);
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200542 rt_rq->rt_runtime = rt_b->rt_runtime;
543 rt_rq->rt_time = 0;
Zhang, Yanminbaf25732008-09-09 11:26:33 +0800544 rt_rq->rt_throttled = 0;
Thomas Gleixner0986b112009-11-17 15:32:06 +0100545 raw_spin_unlock(&rt_rq->rt_runtime_lock);
546 raw_spin_unlock(&rt_b->rt_runtime_lock);
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200547 }
548}
549
550static void enable_runtime(struct rq *rq)
551{
552 unsigned long flags;
553
Thomas Gleixner05fa7852009-11-17 14:28:38 +0100554 raw_spin_lock_irqsave(&rq->lock, flags);
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200555 __enable_runtime(rq);
Thomas Gleixner05fa7852009-11-17 14:28:38 +0100556 raw_spin_unlock_irqrestore(&rq->lock, flags);
Peter Zijlstra7def2be2008-06-05 14:49:58 +0200557}
558
Peter Zijlstraeff65492008-06-19 14:22:26 +0200559static int balance_runtime(struct rt_rq *rt_rq)
560{
561 int more = 0;
562
563 if (rt_rq->rt_time > rt_rq->rt_runtime) {
Thomas Gleixner0986b112009-11-17 15:32:06 +0100564 raw_spin_unlock(&rt_rq->rt_runtime_lock);
Peter Zijlstraeff65492008-06-19 14:22:26 +0200565 more = do_balance_runtime(rt_rq);
Thomas Gleixner0986b112009-11-17 15:32:06 +0100566 raw_spin_lock(&rt_rq->rt_runtime_lock);
Peter Zijlstraeff65492008-06-19 14:22:26 +0200567 }
568
569 return more;
570}
Dhaval Giani55e12e52008-06-24 23:39:43 +0530571#else /* !CONFIG_SMP */
Peter Zijlstraeff65492008-06-19 14:22:26 +0200572static inline int balance_runtime(struct rt_rq *rt_rq)
573{
574 return 0;
575}
Dhaval Giani55e12e52008-06-24 23:39:43 +0530576#endif /* CONFIG_SMP */
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100577
578static int do_sched_rt_period_timer(struct rt_bandwidth *rt_b, int overrun)
579{
580 int i, idle = 1;
Rusty Russellc6c49272008-11-25 02:35:05 +1030581 const struct cpumask *span;
Peter Zijlstrad0b27fa2008-04-19 19:44:57 +0200582
Peter Zijlstra0b148fa2008-08-19 12:33:04 +0200583 if (!rt_bandwidth_enabled() || rt_b->rt_runtime == RUNTIME_INF)
Peter Zijlstrad0b27fa2008-04-19 19:44:57 +0200584 return 1;
585
586 span = sched_rt_period_mask();
Rusty Russellc6c49272008-11-25 02:35:05 +1030587 for_each_cpu(i, span) {
Peter Zijlstrad0b27fa2008-04-19 19:44:57 +0200588 int enqueue = 0;
589 struct rt_rq *rt_rq = sched_rt_period_rt_rq(rt_b, i);
590 struct rq *rq = rq_of_rt_rq(rt_rq);
591
Thomas Gleixner05fa7852009-11-17 14:28:38 +0100592 raw_spin_lock(&rq->lock);
Peter Zijlstrad0b27fa2008-04-19 19:44:57 +0200593 if (rt_rq->rt_time) {
594 u64 runtime;
595
Thomas Gleixner0986b112009-11-17 15:32:06 +0100596 raw_spin_lock(&rt_rq->rt_runtime_lock);
Peter Zijlstraeff65492008-06-19 14:22:26 +0200597 if (rt_rq->rt_throttled)
598 balance_runtime(rt_rq);
Peter Zijlstrad0b27fa2008-04-19 19:44:57 +0200599 runtime = rt_rq->rt_runtime;
600 rt_rq->rt_time -= min(rt_rq->rt_time, overrun*runtime);
601 if (rt_rq->rt_throttled && rt_rq->rt_time < runtime) {
602 rt_rq->rt_throttled = 0;
603 enqueue = 1;
Mike Galbraith61eadef2011-04-29 08:36:50 +0200604
605 /*
606 * Force a clock update if the CPU was idle,
607 * lest wakeup -> unthrottle time accumulate.
608 */
609 if (rt_rq->rt_nr_running && rq->curr == rq->idle)
610 rq->skip_clock_update = -1;
Peter Zijlstrad0b27fa2008-04-19 19:44:57 +0200611 }
612 if (rt_rq->rt_time || rt_rq->rt_nr_running)
613 idle = 0;
Thomas Gleixner0986b112009-11-17 15:32:06 +0100614 raw_spin_unlock(&rt_rq->rt_runtime_lock);
Balbir Singh0c3b9162011-03-03 17:04:35 +0530615 } else if (rt_rq->rt_nr_running) {
Peter Zijlstra8a8cde12008-06-19 14:22:28 +0200616 idle = 0;
Balbir Singh0c3b9162011-03-03 17:04:35 +0530617 if (!rt_rq_throttled(rt_rq))
618 enqueue = 1;
619 }
Peter Zijlstrad0b27fa2008-04-19 19:44:57 +0200620
621 if (enqueue)
622 sched_rt_rq_enqueue(rt_rq);
Thomas Gleixner05fa7852009-11-17 14:28:38 +0100623 raw_spin_unlock(&rq->lock);
Peter Zijlstrad0b27fa2008-04-19 19:44:57 +0200624 }
625
626 return idle;
627}
628
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100629static inline int rt_se_prio(struct sched_rt_entity *rt_se)
630{
Peter Zijlstra052f1dc2008-02-13 15:45:40 +0100631#ifdef CONFIG_RT_GROUP_SCHED
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100632 struct rt_rq *rt_rq = group_rt_rq(rt_se);
633
634 if (rt_rq)
Gregory Haskinse864c492008-12-29 09:39:49 -0500635 return rt_rq->highest_prio.curr;
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100636#endif
637
638 return rt_task_of(rt_se)->prio;
639}
640
Peter Zijlstra9f0c1e52008-02-13 15:45:39 +0100641static int sched_rt_runtime_exceeded(struct rt_rq *rt_rq)
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100642{
Peter Zijlstra9f0c1e52008-02-13 15:45:39 +0100643 u64 runtime = sched_rt_runtime(rt_rq);
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100644
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100645 if (rt_rq->rt_throttled)
Peter Zijlstra23b0fdf2008-02-13 15:45:39 +0100646 return rt_rq_throttled(rt_rq);
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100647
Peter Zijlstraac086bc2008-04-19 19:44:58 +0200648 if (sched_rt_runtime(rt_rq) >= sched_rt_period(rt_rq))
649 return 0;
650
Peter Zijlstrab79f3832008-06-19 14:22:25 +0200651 balance_runtime(rt_rq);
652 runtime = sched_rt_runtime(rt_rq);
653 if (runtime == RUNTIME_INF)
654 return 0;
Peter Zijlstraac086bc2008-04-19 19:44:58 +0200655
Peter Zijlstra9f0c1e52008-02-13 15:45:39 +0100656 if (rt_rq->rt_time > runtime) {
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100657 rt_rq->rt_throttled = 1;
Peter Zijlstra23b0fdf2008-02-13 15:45:39 +0100658 if (rt_rq_throttled(rt_rq)) {
Peter Zijlstra9f0c1e52008-02-13 15:45:39 +0100659 sched_rt_rq_dequeue(rt_rq);
Peter Zijlstra23b0fdf2008-02-13 15:45:39 +0100660 return 1;
661 }
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100662 }
663
664 return 0;
665}
666
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200667/*
668 * Update the current task's runtime statistics. Skip current tasks that
669 * are not in our scheduling class.
670 */
Alexey Dobriyana9957442007-10-15 17:00:13 +0200671static void update_curr_rt(struct rq *rq)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200672{
673 struct task_struct *curr = rq->curr;
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100674 struct sched_rt_entity *rt_se = &curr->rt;
675 struct rt_rq *rt_rq = rt_rq_of_se(rt_se);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200676 u64 delta_exec;
677
Peter Zijlstra06c3bc62011-02-02 13:19:48 +0100678 if (curr->sched_class != &rt_sched_class)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200679 return;
680
Venkatesh Pallipadi305e6832010-10-04 17:03:21 -0700681 delta_exec = rq->clock_task - curr->se.exec_start;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200682 if (unlikely((s64)delta_exec < 0))
683 delta_exec = 0;
Ingo Molnar6cfb0d52007-08-02 17:41:40 +0200684
Lucas De Marchi41acab82010-03-10 23:37:45 -0300685 schedstat_set(curr->se.statistics.exec_max, max(curr->se.statistics.exec_max, delta_exec));
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200686
687 curr->se.sum_exec_runtime += delta_exec;
Frank Mayharf06febc2008-09-12 09:54:39 -0700688 account_group_exec_runtime(curr, delta_exec);
689
Venkatesh Pallipadi305e6832010-10-04 17:03:21 -0700690 curr->se.exec_start = rq->clock_task;
Srivatsa Vaddagirid842de82007-12-02 20:04:49 +0100691 cpuacct_charge(curr, delta_exec);
Peter Zijlstrafa85ae22008-01-25 21:08:29 +0100692
Peter Zijlstrae9e92502009-09-01 10:34:37 +0200693 sched_rt_avg_update(rq, delta_exec);
694
Peter Zijlstra0b148fa2008-08-19 12:33:04 +0200695 if (!rt_bandwidth_enabled())
696 return;
697
Dhaval Giani354d60c2008-04-19 19:44:59 +0200698 for_each_sched_rt_entity(rt_se) {
699 rt_rq = rt_rq_of_se(rt_se);
700
Peter Zijlstracc2991c2008-08-19 12:33:03 +0200701 if (sched_rt_runtime(rt_rq) != RUNTIME_INF) {
Thomas Gleixner0986b112009-11-17 15:32:06 +0100702 raw_spin_lock(&rt_rq->rt_runtime_lock);
Peter Zijlstracc2991c2008-08-19 12:33:03 +0200703 rt_rq->rt_time += delta_exec;
704 if (sched_rt_runtime_exceeded(rt_rq))
705 resched_task(curr);
Thomas Gleixner0986b112009-11-17 15:32:06 +0100706 raw_spin_unlock(&rt_rq->rt_runtime_lock);
Peter Zijlstracc2991c2008-08-19 12:33:03 +0200707 }
Dhaval Giani354d60c2008-04-19 19:44:59 +0200708 }
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200709}
710
Gregory Haskins398a1532009-01-14 09:10:04 -0500711#if defined CONFIG_SMP
Gregory Haskinse864c492008-12-29 09:39:49 -0500712
Gregory Haskins398a1532009-01-14 09:10:04 -0500713static void
714inc_rt_prio_smp(struct rt_rq *rt_rq, int prio, int prev_prio)
Steven Rostedt63489e42008-01-25 21:08:03 +0100715{
Gregory Haskins4d984272008-12-29 09:39:49 -0500716 struct rq *rq = rq_of_rt_rq(rt_rq);
Gregory Haskins4d984272008-12-29 09:39:49 -0500717
Steven Rostedt5181f4a2011-06-16 21:55:23 -0400718 if (rq->online && prio < prev_prio)
719 cpupri_set(&rq->rd->cpupri, rq->cpu, prio);
Steven Rostedt63489e42008-01-25 21:08:03 +0100720}
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100721
Gregory Haskins398a1532009-01-14 09:10:04 -0500722static void
723dec_rt_prio_smp(struct rt_rq *rt_rq, int prio, int prev_prio)
Steven Rostedt63489e42008-01-25 21:08:03 +0100724{
Gregory Haskins4d984272008-12-29 09:39:49 -0500725 struct rq *rq = rq_of_rt_rq(rt_rq);
Gregory Haskins6e0534f2008-05-12 21:21:01 +0200726
Gregory Haskins398a1532009-01-14 09:10:04 -0500727 if (rq->online && rt_rq->highest_prio.curr != prev_prio)
728 cpupri_set(&rq->rd->cpupri, rq->cpu, rt_rq->highest_prio.curr);
729}
730
731#else /* CONFIG_SMP */
732
733static inline
734void inc_rt_prio_smp(struct rt_rq *rt_rq, int prio, int prev_prio) {}
735static inline
736void dec_rt_prio_smp(struct rt_rq *rt_rq, int prio, int prev_prio) {}
737
738#endif /* CONFIG_SMP */
739
Steven Rostedt63489e42008-01-25 21:08:03 +0100740#if defined CONFIG_SMP || defined CONFIG_RT_GROUP_SCHED
Gregory Haskins398a1532009-01-14 09:10:04 -0500741static void
742inc_rt_prio(struct rt_rq *rt_rq, int prio)
743{
744 int prev_prio = rt_rq->highest_prio.curr;
Steven Rostedt63489e42008-01-25 21:08:03 +0100745
Gregory Haskins398a1532009-01-14 09:10:04 -0500746 if (prio < prev_prio)
747 rt_rq->highest_prio.curr = prio;
748
749 inc_rt_prio_smp(rt_rq, prio, prev_prio);
750}
751
752static void
753dec_rt_prio(struct rt_rq *rt_rq, int prio)
754{
755 int prev_prio = rt_rq->highest_prio.curr;
756
757 if (rt_rq->rt_nr_running) {
758
759 WARN_ON(prio < prev_prio);
Gregory Haskinse864c492008-12-29 09:39:49 -0500760
761 /*
Gregory Haskins398a1532009-01-14 09:10:04 -0500762 * This may have been our highest task, and therefore
763 * we may have some recomputation to do
Gregory Haskinse864c492008-12-29 09:39:49 -0500764 */
Gregory Haskins398a1532009-01-14 09:10:04 -0500765 if (prio == prev_prio) {
Gregory Haskinse864c492008-12-29 09:39:49 -0500766 struct rt_prio_array *array = &rt_rq->active;
767
768 rt_rq->highest_prio.curr =
Steven Rostedt764a9d62008-01-25 21:08:04 +0100769 sched_find_first_bit(array->bitmap);
Gregory Haskinse864c492008-12-29 09:39:49 -0500770 }
771
Steven Rostedt764a9d62008-01-25 21:08:04 +0100772 } else
Gregory Haskinse864c492008-12-29 09:39:49 -0500773 rt_rq->highest_prio.curr = MAX_RT_PRIO;
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100774
Gregory Haskins398a1532009-01-14 09:10:04 -0500775 dec_rt_prio_smp(rt_rq, prio, prev_prio);
776}
Gregory Haskins1f11eb62008-06-04 15:04:05 -0400777
Gregory Haskins398a1532009-01-14 09:10:04 -0500778#else
779
780static inline void inc_rt_prio(struct rt_rq *rt_rq, int prio) {}
781static inline void dec_rt_prio(struct rt_rq *rt_rq, int prio) {}
782
783#endif /* CONFIG_SMP || CONFIG_RT_GROUP_SCHED */
784
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100785#ifdef CONFIG_RT_GROUP_SCHED
Gregory Haskins398a1532009-01-14 09:10:04 -0500786
787static void
788inc_rt_group(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)
789{
Gregory Haskins73fe6aa2008-01-25 21:08:07 +0100790 if (rt_se_boosted(rt_se))
Steven Rostedt764a9d62008-01-25 21:08:04 +0100791 rt_rq->rt_nr_boosted++;
Peter Zijlstra052f1dc2008-02-13 15:45:40 +0100792
Peter Zijlstra23b0fdf2008-02-13 15:45:39 +0100793 if (rt_rq->tg)
794 start_rt_bandwidth(&rt_rq->tg->rt_bandwidth);
Gregory Haskins398a1532009-01-14 09:10:04 -0500795}
796
797static void
798dec_rt_group(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)
799{
Peter Zijlstra23b0fdf2008-02-13 15:45:39 +0100800 if (rt_se_boosted(rt_se))
801 rt_rq->rt_nr_boosted--;
802
803 WARN_ON(!rt_rq->rt_nr_running && rt_rq->rt_nr_boosted);
Gregory Haskins398a1532009-01-14 09:10:04 -0500804}
805
806#else /* CONFIG_RT_GROUP_SCHED */
807
808static void
809inc_rt_group(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)
810{
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200811 start_rt_bandwidth(&def_rt_bandwidth);
Gregory Haskins398a1532009-01-14 09:10:04 -0500812}
813
814static inline
815void dec_rt_group(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq) {}
816
817#endif /* CONFIG_RT_GROUP_SCHED */
818
819static inline
820void inc_rt_tasks(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)
821{
822 int prio = rt_se_prio(rt_se);
823
824 WARN_ON(!rt_prio(prio));
825 rt_rq->rt_nr_running++;
826
827 inc_rt_prio(rt_rq, prio);
828 inc_rt_migration(rt_se, rt_rq);
829 inc_rt_group(rt_se, rt_rq);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200830}
831
Peter Zijlstra23b0fdf2008-02-13 15:45:39 +0100832static inline
833void dec_rt_tasks(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)
834{
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200835 WARN_ON(!rt_prio(rt_se_prio(rt_se)));
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100836 WARN_ON(!rt_rq->rt_nr_running);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200837 rt_rq->rt_nr_running--;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200838
Gregory Haskins398a1532009-01-14 09:10:04 -0500839 dec_rt_prio(rt_rq, rt_se_prio(rt_se));
840 dec_rt_migration(rt_se, rt_rq);
841 dec_rt_group(rt_se, rt_rq);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200842}
843
Thomas Gleixner37dad3f2010-01-20 20:59:01 +0000844static void __enqueue_rt_entity(struct sched_rt_entity *rt_se, bool head)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200845{
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100846 struct rt_rq *rt_rq = rt_rq_of_se(rt_se);
847 struct rt_prio_array *array = &rt_rq->active;
848 struct rt_rq *group_rq = group_rt_rq(rt_se);
Dmitry Adamushko20b63312008-06-11 00:58:30 +0200849 struct list_head *queue = array->queue + rt_se_prio(rt_se);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200850
Peter Zijlstraad2a3f12008-06-19 09:06:57 +0200851 /*
852 * Don't enqueue the group if its throttled, or when empty.
853 * The latter is a consequence of the former when a child group
854 * get throttled and the current group doesn't have any other
855 * active members.
856 */
857 if (group_rq && (rt_rq_throttled(group_rq) || !group_rq->rt_nr_running))
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100858 return;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200859
Peter Zijlstra3d4b47b2010-11-15 15:47:01 -0800860 if (!rt_rq->rt_nr_running)
861 list_add_leaf_rt_rq(rt_rq);
862
Thomas Gleixner37dad3f2010-01-20 20:59:01 +0000863 if (head)
864 list_add(&rt_se->run_list, queue);
865 else
866 list_add_tail(&rt_se->run_list, queue);
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100867 __set_bit(rt_se_prio(rt_se), array->bitmap);
Peter Zijlstra78f2c7d2008-01-25 21:08:27 +0100868
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100869 inc_rt_tasks(rt_se, rt_rq);
870}
871
Peter Zijlstraad2a3f12008-06-19 09:06:57 +0200872static void __dequeue_rt_entity(struct sched_rt_entity *rt_se)
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100873{
874 struct rt_rq *rt_rq = rt_rq_of_se(rt_se);
875 struct rt_prio_array *array = &rt_rq->active;
876
877 list_del_init(&rt_se->run_list);
878 if (list_empty(array->queue + rt_se_prio(rt_se)))
879 __clear_bit(rt_se_prio(rt_se), array->bitmap);
880
881 dec_rt_tasks(rt_se, rt_rq);
Peter Zijlstra3d4b47b2010-11-15 15:47:01 -0800882 if (!rt_rq->rt_nr_running)
883 list_del_leaf_rt_rq(rt_rq);
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100884}
885
886/*
887 * Because the prio of an upper entry depends on the lower
888 * entries, we must remove entries top - down.
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100889 */
Peter Zijlstraad2a3f12008-06-19 09:06:57 +0200890static void dequeue_rt_stack(struct sched_rt_entity *rt_se)
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100891{
Peter Zijlstraad2a3f12008-06-19 09:06:57 +0200892 struct sched_rt_entity *back = NULL;
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100893
Peter Zijlstra58d6c2d2008-04-19 19:45:00 +0200894 for_each_sched_rt_entity(rt_se) {
895 rt_se->back = back;
896 back = rt_se;
897 }
898
899 for (rt_se = back; rt_se; rt_se = rt_se->back) {
900 if (on_rt_rq(rt_se))
Peter Zijlstraad2a3f12008-06-19 09:06:57 +0200901 __dequeue_rt_entity(rt_se);
902 }
903}
904
Thomas Gleixner37dad3f2010-01-20 20:59:01 +0000905static void enqueue_rt_entity(struct sched_rt_entity *rt_se, bool head)
Peter Zijlstraad2a3f12008-06-19 09:06:57 +0200906{
907 dequeue_rt_stack(rt_se);
908 for_each_sched_rt_entity(rt_se)
Thomas Gleixner37dad3f2010-01-20 20:59:01 +0000909 __enqueue_rt_entity(rt_se, head);
Peter Zijlstraad2a3f12008-06-19 09:06:57 +0200910}
911
912static void dequeue_rt_entity(struct sched_rt_entity *rt_se)
913{
914 dequeue_rt_stack(rt_se);
915
916 for_each_sched_rt_entity(rt_se) {
917 struct rt_rq *rt_rq = group_rt_rq(rt_se);
918
919 if (rt_rq && rt_rq->rt_nr_running)
Thomas Gleixner37dad3f2010-01-20 20:59:01 +0000920 __enqueue_rt_entity(rt_se, false);
Peter Zijlstra58d6c2d2008-04-19 19:45:00 +0200921 }
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200922}
923
924/*
925 * Adding/removing a task to/from a priority array:
926 */
Thomas Gleixnerea87bb72010-01-20 20:58:57 +0000927static void
Peter Zijlstra371fd7e2010-03-24 16:38:48 +0100928enqueue_task_rt(struct rq *rq, struct task_struct *p, int flags)
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100929{
930 struct sched_rt_entity *rt_se = &p->rt;
931
Peter Zijlstra371fd7e2010-03-24 16:38:48 +0100932 if (flags & ENQUEUE_WAKEUP)
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100933 rt_se->timeout = 0;
934
Peter Zijlstra371fd7e2010-03-24 16:38:48 +0100935 enqueue_rt_entity(rt_se, flags & ENQUEUE_HEAD);
Peter Zijlstrac09595f2008-06-27 13:41:14 +0200936
Gregory Haskins917b6272008-12-29 09:39:53 -0500937 if (!task_current(rq, p) && p->rt.nr_cpus_allowed > 1)
938 enqueue_pushable_task(rq, p);
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100939}
940
Peter Zijlstra371fd7e2010-03-24 16:38:48 +0100941static void dequeue_task_rt(struct rq *rq, struct task_struct *p, int flags)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200942{
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100943 struct sched_rt_entity *rt_se = &p->rt;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200944
945 update_curr_rt(rq);
Peter Zijlstraad2a3f12008-06-19 09:06:57 +0200946 dequeue_rt_entity(rt_se);
Peter Zijlstrac09595f2008-06-27 13:41:14 +0200947
Gregory Haskins917b6272008-12-29 09:39:53 -0500948 dequeue_pushable_task(rq, p);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200949}
950
951/*
952 * Put task to the end of the run list without the overhead of dequeue
953 * followed by enqueue.
954 */
Dmitry Adamushko7ebefa82008-07-01 23:32:15 +0200955static void
956requeue_rt_entity(struct rt_rq *rt_rq, struct sched_rt_entity *rt_se, int head)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200957{
Ingo Molnar1cdad712008-06-19 09:09:15 +0200958 if (on_rt_rq(rt_se)) {
Dmitry Adamushko7ebefa82008-07-01 23:32:15 +0200959 struct rt_prio_array *array = &rt_rq->active;
960 struct list_head *queue = array->queue + rt_se_prio(rt_se);
961
962 if (head)
963 list_move(&rt_se->run_list, queue);
964 else
965 list_move_tail(&rt_se->run_list, queue);
Ingo Molnar1cdad712008-06-19 09:09:15 +0200966 }
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200967}
968
Dmitry Adamushko7ebefa82008-07-01 23:32:15 +0200969static void requeue_task_rt(struct rq *rq, struct task_struct *p, int head)
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100970{
971 struct sched_rt_entity *rt_se = &p->rt;
972 struct rt_rq *rt_rq;
973
974 for_each_sched_rt_entity(rt_se) {
975 rt_rq = rt_rq_of_se(rt_se);
Dmitry Adamushko7ebefa82008-07-01 23:32:15 +0200976 requeue_rt_entity(rt_rq, rt_se, head);
Peter Zijlstra6f505b12008-01-25 21:08:30 +0100977 }
978}
979
980static void yield_task_rt(struct rq *rq)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200981{
Dmitry Adamushko7ebefa82008-07-01 23:32:15 +0200982 requeue_task_rt(rq, rq->curr, 0);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +0200983}
984
Gregory Haskinse7693a32008-01-25 21:08:09 +0100985#ifdef CONFIG_SMP
Gregory Haskins318e0892008-01-25 21:08:10 +0100986static int find_lowest_rq(struct task_struct *task);
987
Peter Zijlstra0017d732010-03-24 18:34:10 +0100988static int
Peter Zijlstra7608dec2011-04-05 17:23:46 +0200989select_task_rq_rt(struct task_struct *p, int sd_flag, int flags)
Gregory Haskinse7693a32008-01-25 21:08:09 +0100990{
Peter Zijlstra7608dec2011-04-05 17:23:46 +0200991 struct task_struct *curr;
992 struct rq *rq;
993 int cpu;
994
Peter Zijlstra7608dec2011-04-05 17:23:46 +0200995 cpu = task_cpu(p);
Steven Rostedtc37495f2011-06-16 21:55:22 -0400996
997 /* For anything but wake ups, just return the task_cpu */
998 if (sd_flag != SD_BALANCE_WAKE && sd_flag != SD_BALANCE_FORK)
999 goto out;
1000
Peter Zijlstra7608dec2011-04-05 17:23:46 +02001001 rq = cpu_rq(cpu);
1002
1003 rcu_read_lock();
1004 curr = ACCESS_ONCE(rq->curr); /* unlocked access */
1005
Gregory Haskins318e0892008-01-25 21:08:10 +01001006 /*
Peter Zijlstra7608dec2011-04-05 17:23:46 +02001007 * If the current task on @p's runqueue is an RT task, then
Steven Rostedte1f47d82008-01-25 21:08:12 +01001008 * try to see if we can wake this RT task up on another
1009 * runqueue. Otherwise simply start this RT task
1010 * on its current runqueue.
1011 *
Steven Rostedt43fa5462010-09-20 22:40:03 -04001012 * We want to avoid overloading runqueues. If the woken
1013 * task is a higher priority, then it will stay on this CPU
1014 * and the lower prio task should be moved to another CPU.
1015 * Even though this will probably make the lower prio task
1016 * lose its cache, we do not want to bounce a higher task
1017 * around just because it gave up its CPU, perhaps for a
1018 * lock?
1019 *
1020 * For equal prio tasks, we just let the scheduler sort it out.
Peter Zijlstra7608dec2011-04-05 17:23:46 +02001021 *
Gregory Haskins318e0892008-01-25 21:08:10 +01001022 * Otherwise, just let it ride on the affined RQ and the
1023 * post-schedule router will push the preempted task away
Peter Zijlstra7608dec2011-04-05 17:23:46 +02001024 *
1025 * This test is optimistic, if we get it wrong the load-balancer
1026 * will have to sort it out.
Gregory Haskins318e0892008-01-25 21:08:10 +01001027 */
Peter Zijlstra7608dec2011-04-05 17:23:46 +02001028 if (curr && unlikely(rt_task(curr)) &&
1029 (curr->rt.nr_cpus_allowed < 2 ||
1030 curr->prio < p->prio) &&
1031 (p->rt.nr_cpus_allowed > 1)) {
1032 int target = find_lowest_rq(p);
1033
1034 if (target != -1)
1035 cpu = target;
1036 }
1037 rcu_read_unlock();
1038
Steven Rostedtc37495f2011-06-16 21:55:22 -04001039out:
Peter Zijlstra7608dec2011-04-05 17:23:46 +02001040 return cpu;
Gregory Haskinse7693a32008-01-25 21:08:09 +01001041}
Dmitry Adamushko7ebefa82008-07-01 23:32:15 +02001042
1043static void check_preempt_equal_prio(struct rq *rq, struct task_struct *p)
1044{
Dmitry Adamushko7ebefa82008-07-01 23:32:15 +02001045 if (rq->curr->rt.nr_cpus_allowed == 1)
1046 return;
1047
Rusty Russell13b8bd02009-03-25 15:01:22 +10301048 if (p->rt.nr_cpus_allowed != 1
1049 && cpupri_find(&rq->rd->cpupri, p, NULL))
Dmitry Adamushko7ebefa82008-07-01 23:32:15 +02001050 return;
1051
Rusty Russell13b8bd02009-03-25 15:01:22 +10301052 if (!cpupri_find(&rq->rd->cpupri, rq->curr, NULL))
1053 return;
Dmitry Adamushko7ebefa82008-07-01 23:32:15 +02001054
1055 /*
1056 * There appears to be other cpus that can accept
1057 * current and none to run 'p', so lets reschedule
1058 * to try and push current away:
1059 */
1060 requeue_task_rt(rq, p, 1);
1061 resched_task(rq->curr);
1062}
1063
Gregory Haskinse7693a32008-01-25 21:08:09 +01001064#endif /* CONFIG_SMP */
1065
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001066/*
1067 * Preempt the current task with a newly woken task if needed:
1068 */
Peter Zijlstra7d478722009-09-14 19:55:44 +02001069static void check_preempt_curr_rt(struct rq *rq, struct task_struct *p, int flags)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001070{
Gregory Haskins45c01e82008-05-12 21:20:41 +02001071 if (p->prio < rq->curr->prio) {
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001072 resched_task(rq->curr);
Gregory Haskins45c01e82008-05-12 21:20:41 +02001073 return;
1074 }
1075
1076#ifdef CONFIG_SMP
1077 /*
1078 * If:
1079 *
1080 * - the newly woken task is of equal priority to the current task
1081 * - the newly woken task is non-migratable while current is migratable
1082 * - current will be preempted on the next reschedule
1083 *
1084 * we should check to see if current can readily move to a different
1085 * cpu. If so, we will reschedule to allow the push logic to try
1086 * to move current somewhere else, making room for our non-migratable
1087 * task.
1088 */
Hillf Danton8dd0de82011-06-14 18:36:24 -04001089 if (p->prio == rq->curr->prio && !test_tsk_need_resched(rq->curr))
Dmitry Adamushko7ebefa82008-07-01 23:32:15 +02001090 check_preempt_equal_prio(rq, p);
Gregory Haskins45c01e82008-05-12 21:20:41 +02001091#endif
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001092}
1093
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001094static struct sched_rt_entity *pick_next_rt_entity(struct rq *rq,
1095 struct rt_rq *rt_rq)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001096{
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001097 struct rt_prio_array *array = &rt_rq->active;
1098 struct sched_rt_entity *next = NULL;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001099 struct list_head *queue;
1100 int idx;
1101
1102 idx = sched_find_first_bit(array->bitmap);
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001103 BUG_ON(idx >= MAX_RT_PRIO);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001104
1105 queue = array->queue + idx;
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001106 next = list_entry(queue->next, struct sched_rt_entity, run_list);
Dmitry Adamushko326587b2008-01-25 21:08:34 +01001107
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001108 return next;
1109}
1110
Gregory Haskins917b6272008-12-29 09:39:53 -05001111static struct task_struct *_pick_next_task_rt(struct rq *rq)
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001112{
1113 struct sched_rt_entity *rt_se;
1114 struct task_struct *p;
1115 struct rt_rq *rt_rq;
1116
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001117 rt_rq = &rq->rt;
1118
Steven Rostedt8e54a2c2010-12-06 11:28:30 -05001119 if (!rt_rq->rt_nr_running)
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001120 return NULL;
1121
Peter Zijlstra23b0fdf2008-02-13 15:45:39 +01001122 if (rt_rq_throttled(rt_rq))
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001123 return NULL;
1124
1125 do {
1126 rt_se = pick_next_rt_entity(rq, rt_rq);
Dmitry Adamushko326587b2008-01-25 21:08:34 +01001127 BUG_ON(!rt_se);
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001128 rt_rq = group_rt_rq(rt_se);
1129 } while (rt_rq);
1130
1131 p = rt_task_of(rt_se);
Venkatesh Pallipadi305e6832010-10-04 17:03:21 -07001132 p->se.exec_start = rq->clock_task;
Gregory Haskins917b6272008-12-29 09:39:53 -05001133
1134 return p;
1135}
1136
1137static struct task_struct *pick_next_task_rt(struct rq *rq)
1138{
1139 struct task_struct *p = _pick_next_task_rt(rq);
1140
1141 /* The running task is never eligible for pushing */
1142 if (p)
1143 dequeue_pushable_task(rq, p);
1144
Ingo Molnarbcf08df2008-04-19 12:11:10 +02001145#ifdef CONFIG_SMP
Gregory Haskins3f029d32009-07-29 11:08:47 -04001146 /*
1147 * We detect this state here so that we can avoid taking the RQ
1148 * lock again later if there is no need to push
1149 */
1150 rq->post_schedule = has_pushable_tasks(rq);
Ingo Molnarbcf08df2008-04-19 12:11:10 +02001151#endif
Gregory Haskins3f029d32009-07-29 11:08:47 -04001152
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001153 return p;
1154}
1155
Ingo Molnar31ee5292007-08-09 11:16:49 +02001156static void put_prev_task_rt(struct rq *rq, struct task_struct *p)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001157{
Ingo Molnarf1e14ef2007-08-09 11:16:48 +02001158 update_curr_rt(rq);
Gregory Haskins917b6272008-12-29 09:39:53 -05001159
1160 /*
1161 * The previous task needs to be made eligible for pushing
1162 * if it is still active
1163 */
Peter Zijlstrafd2f4412011-04-05 17:23:44 +02001164 if (on_rt_rq(&p->rt) && p->rt.nr_cpus_allowed > 1)
Gregory Haskins917b6272008-12-29 09:39:53 -05001165 enqueue_pushable_task(rq, p);
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001166}
1167
Peter Williams681f3e62007-10-24 18:23:51 +02001168#ifdef CONFIG_SMP
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001169
Steven Rostedte8fa1362008-01-25 21:08:05 +01001170/* Only try algorithms three times */
1171#define RT_MAX_TRIES 3
1172
Steven Rostedte8fa1362008-01-25 21:08:05 +01001173static void deactivate_task(struct rq *rq, struct task_struct *p, int sleep);
1174
Steven Rostedtf65eda42008-01-25 21:08:07 +01001175static int pick_rt_task(struct rq *rq, struct task_struct *p, int cpu)
1176{
1177 if (!task_running(rq, p) &&
Rusty Russell96f874e2008-11-25 02:35:14 +10301178 (cpu < 0 || cpumask_test_cpu(cpu, &p->cpus_allowed)) &&
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001179 (p->rt.nr_cpus_allowed > 1))
Steven Rostedtf65eda42008-01-25 21:08:07 +01001180 return 1;
1181 return 0;
1182}
1183
Steven Rostedte8fa1362008-01-25 21:08:05 +01001184/* Return the second highest RT task, NULL otherwise */
Ingo Molnar79064fb2008-01-25 21:08:14 +01001185static struct task_struct *pick_next_highest_task_rt(struct rq *rq, int cpu)
Steven Rostedte8fa1362008-01-25 21:08:05 +01001186{
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001187 struct task_struct *next = NULL;
1188 struct sched_rt_entity *rt_se;
1189 struct rt_prio_array *array;
1190 struct rt_rq *rt_rq;
Steven Rostedte8fa1362008-01-25 21:08:05 +01001191 int idx;
1192
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001193 for_each_leaf_rt_rq(rt_rq, rq) {
1194 array = &rt_rq->active;
1195 idx = sched_find_first_bit(array->bitmap);
Peter Zijlstra49246272010-10-17 21:46:10 +02001196next_idx:
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001197 if (idx >= MAX_RT_PRIO)
1198 continue;
1199 if (next && next->prio < idx)
1200 continue;
1201 list_for_each_entry(rt_se, array->queue + idx, run_list) {
Peter Zijlstra3d074672010-03-10 17:07:24 +01001202 struct task_struct *p;
1203
1204 if (!rt_entity_is_task(rt_se))
1205 continue;
1206
1207 p = rt_task_of(rt_se);
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001208 if (pick_rt_task(rq, p, cpu)) {
1209 next = p;
1210 break;
1211 }
1212 }
1213 if (!next) {
1214 idx = find_next_bit(array->bitmap, MAX_RT_PRIO, idx+1);
1215 goto next_idx;
1216 }
Steven Rostedte8fa1362008-01-25 21:08:05 +01001217 }
1218
Steven Rostedte8fa1362008-01-25 21:08:05 +01001219 return next;
1220}
1221
Rusty Russell0e3900e2008-11-25 02:35:13 +10301222static DEFINE_PER_CPU(cpumask_var_t, local_cpu_mask);
Steven Rostedte8fa1362008-01-25 21:08:05 +01001223
Gregory Haskins6e1254d2008-01-25 21:08:11 +01001224static int find_lowest_rq(struct task_struct *task)
1225{
1226 struct sched_domain *sd;
Rusty Russell96f874e2008-11-25 02:35:14 +10301227 struct cpumask *lowest_mask = __get_cpu_var(local_cpu_mask);
Gregory Haskins6e1254d2008-01-25 21:08:11 +01001228 int this_cpu = smp_processor_id();
1229 int cpu = task_cpu(task);
1230
Steven Rostedt0da938c2011-06-14 18:36:25 -04001231 /* Make sure the mask is initialized first */
1232 if (unlikely(!lowest_mask))
1233 return -1;
1234
Gregory Haskins6e0534f2008-05-12 21:21:01 +02001235 if (task->rt.nr_cpus_allowed == 1)
1236 return -1; /* No other targets possible */
1237
1238 if (!cpupri_find(&task_rq(task)->rd->cpupri, task, lowest_mask))
Gregory Haskins06f90db2008-01-25 21:08:13 +01001239 return -1; /* No targets found */
1240
1241 /*
Gregory Haskins6e1254d2008-01-25 21:08:11 +01001242 * At this point we have built a mask of cpus representing the
1243 * lowest priority tasks in the system. Now we want to elect
1244 * the best one based on our affinity and topology.
1245 *
1246 * We prioritize the last cpu that the task executed on since
1247 * it is most likely cache-hot in that location.
1248 */
Rusty Russell96f874e2008-11-25 02:35:14 +10301249 if (cpumask_test_cpu(cpu, lowest_mask))
Gregory Haskins6e1254d2008-01-25 21:08:11 +01001250 return cpu;
1251
1252 /*
1253 * Otherwise, we consult the sched_domains span maps to figure
1254 * out which cpu is logically closest to our hot cache data.
1255 */
Rusty Russelle2c88062009-11-03 14:53:15 +10301256 if (!cpumask_test_cpu(this_cpu, lowest_mask))
1257 this_cpu = -1; /* Skip this_cpu opt if not among lowest */
Gregory Haskins6e1254d2008-01-25 21:08:11 +01001258
Xiaotian Fengcd4ae6a2011-04-22 18:53:54 +08001259 rcu_read_lock();
Rusty Russelle2c88062009-11-03 14:53:15 +10301260 for_each_domain(cpu, sd) {
1261 if (sd->flags & SD_WAKE_AFFINE) {
1262 int best_cpu;
Gregory Haskins6e1254d2008-01-25 21:08:11 +01001263
Rusty Russelle2c88062009-11-03 14:53:15 +10301264 /*
1265 * "this_cpu" is cheaper to preempt than a
1266 * remote processor.
1267 */
1268 if (this_cpu != -1 &&
Xiaotian Fengcd4ae6a2011-04-22 18:53:54 +08001269 cpumask_test_cpu(this_cpu, sched_domain_span(sd))) {
1270 rcu_read_unlock();
Rusty Russelle2c88062009-11-03 14:53:15 +10301271 return this_cpu;
Xiaotian Fengcd4ae6a2011-04-22 18:53:54 +08001272 }
Gregory Haskins6e1254d2008-01-25 21:08:11 +01001273
Rusty Russelle2c88062009-11-03 14:53:15 +10301274 best_cpu = cpumask_first_and(lowest_mask,
1275 sched_domain_span(sd));
Xiaotian Fengcd4ae6a2011-04-22 18:53:54 +08001276 if (best_cpu < nr_cpu_ids) {
1277 rcu_read_unlock();
Rusty Russelle2c88062009-11-03 14:53:15 +10301278 return best_cpu;
Xiaotian Fengcd4ae6a2011-04-22 18:53:54 +08001279 }
Gregory Haskins6e1254d2008-01-25 21:08:11 +01001280 }
1281 }
Xiaotian Fengcd4ae6a2011-04-22 18:53:54 +08001282 rcu_read_unlock();
Gregory Haskins6e1254d2008-01-25 21:08:11 +01001283
1284 /*
1285 * And finally, if there were no matches within the domains
1286 * just give the caller *something* to work with from the compatible
1287 * locations.
1288 */
Rusty Russelle2c88062009-11-03 14:53:15 +10301289 if (this_cpu != -1)
1290 return this_cpu;
1291
1292 cpu = cpumask_any(lowest_mask);
1293 if (cpu < nr_cpu_ids)
1294 return cpu;
1295 return -1;
Gregory Haskins07b40322008-01-25 21:08:10 +01001296}
1297
Steven Rostedte8fa1362008-01-25 21:08:05 +01001298/* Will lock the rq it finds */
Ingo Molnar4df64c02008-01-25 21:08:15 +01001299static struct rq *find_lock_lowest_rq(struct task_struct *task, struct rq *rq)
Steven Rostedte8fa1362008-01-25 21:08:05 +01001300{
1301 struct rq *lowest_rq = NULL;
Steven Rostedte8fa1362008-01-25 21:08:05 +01001302 int tries;
Ingo Molnar4df64c02008-01-25 21:08:15 +01001303 int cpu;
Steven Rostedte8fa1362008-01-25 21:08:05 +01001304
1305 for (tries = 0; tries < RT_MAX_TRIES; tries++) {
Gregory Haskins07b40322008-01-25 21:08:10 +01001306 cpu = find_lowest_rq(task);
Steven Rostedte8fa1362008-01-25 21:08:05 +01001307
Gregory Haskins2de0b462008-01-25 21:08:10 +01001308 if ((cpu == -1) || (cpu == rq->cpu))
Steven Rostedte8fa1362008-01-25 21:08:05 +01001309 break;
1310
Gregory Haskins07b40322008-01-25 21:08:10 +01001311 lowest_rq = cpu_rq(cpu);
1312
Steven Rostedte8fa1362008-01-25 21:08:05 +01001313 /* if the prio of this runqueue changed, try again */
Gregory Haskins07b40322008-01-25 21:08:10 +01001314 if (double_lock_balance(rq, lowest_rq)) {
Steven Rostedte8fa1362008-01-25 21:08:05 +01001315 /*
1316 * We had to unlock the run queue. In
1317 * the mean time, task could have
1318 * migrated already or had its affinity changed.
1319 * Also make sure that it wasn't scheduled on its rq.
1320 */
Gregory Haskins07b40322008-01-25 21:08:10 +01001321 if (unlikely(task_rq(task) != rq ||
Rusty Russell96f874e2008-11-25 02:35:14 +10301322 !cpumask_test_cpu(lowest_rq->cpu,
1323 &task->cpus_allowed) ||
Gregory Haskins07b40322008-01-25 21:08:10 +01001324 task_running(rq, task) ||
Peter Zijlstrafd2f4412011-04-05 17:23:44 +02001325 !task->on_rq)) {
Ingo Molnar4df64c02008-01-25 21:08:15 +01001326
Thomas Gleixner05fa7852009-11-17 14:28:38 +01001327 raw_spin_unlock(&lowest_rq->lock);
Steven Rostedte8fa1362008-01-25 21:08:05 +01001328 lowest_rq = NULL;
1329 break;
1330 }
1331 }
1332
1333 /* If this rq is still suitable use it. */
Gregory Haskinse864c492008-12-29 09:39:49 -05001334 if (lowest_rq->rt.highest_prio.curr > task->prio)
Steven Rostedte8fa1362008-01-25 21:08:05 +01001335 break;
1336
1337 /* try again */
Peter Zijlstra1b12bbc2008-08-11 09:30:22 +02001338 double_unlock_balance(rq, lowest_rq);
Steven Rostedte8fa1362008-01-25 21:08:05 +01001339 lowest_rq = NULL;
1340 }
1341
1342 return lowest_rq;
1343}
1344
Gregory Haskins917b6272008-12-29 09:39:53 -05001345static struct task_struct *pick_next_pushable_task(struct rq *rq)
1346{
1347 struct task_struct *p;
1348
1349 if (!has_pushable_tasks(rq))
1350 return NULL;
1351
1352 p = plist_first_entry(&rq->rt.pushable_tasks,
1353 struct task_struct, pushable_tasks);
1354
1355 BUG_ON(rq->cpu != task_cpu(p));
1356 BUG_ON(task_current(rq, p));
1357 BUG_ON(p->rt.nr_cpus_allowed <= 1);
1358
Peter Zijlstrafd2f4412011-04-05 17:23:44 +02001359 BUG_ON(!p->on_rq);
Gregory Haskins917b6272008-12-29 09:39:53 -05001360 BUG_ON(!rt_task(p));
1361
1362 return p;
1363}
1364
Steven Rostedte8fa1362008-01-25 21:08:05 +01001365/*
1366 * If the current CPU has more than one RT task, see if the non
1367 * running task can migrate over to a CPU that is running a task
1368 * of lesser priority.
1369 */
Gregory Haskins697f0a42008-01-25 21:08:09 +01001370static int push_rt_task(struct rq *rq)
Steven Rostedte8fa1362008-01-25 21:08:05 +01001371{
1372 struct task_struct *next_task;
1373 struct rq *lowest_rq;
Hillf Danton311e8002011-06-16 21:55:20 -04001374 int ret = 0;
Steven Rostedte8fa1362008-01-25 21:08:05 +01001375
Gregory Haskinsa22d7fc2008-01-25 21:08:12 +01001376 if (!rq->rt.overloaded)
1377 return 0;
1378
Gregory Haskins917b6272008-12-29 09:39:53 -05001379 next_task = pick_next_pushable_task(rq);
Steven Rostedte8fa1362008-01-25 21:08:05 +01001380 if (!next_task)
1381 return 0;
1382
Peter Zijlstra49246272010-10-17 21:46:10 +02001383retry:
Gregory Haskins697f0a42008-01-25 21:08:09 +01001384 if (unlikely(next_task == rq->curr)) {
Steven Rostedtf65eda42008-01-25 21:08:07 +01001385 WARN_ON(1);
Steven Rostedte8fa1362008-01-25 21:08:05 +01001386 return 0;
Steven Rostedtf65eda42008-01-25 21:08:07 +01001387 }
Steven Rostedte8fa1362008-01-25 21:08:05 +01001388
1389 /*
1390 * It's possible that the next_task slipped in of
1391 * higher priority than current. If that's the case
1392 * just reschedule current.
1393 */
Gregory Haskins697f0a42008-01-25 21:08:09 +01001394 if (unlikely(next_task->prio < rq->curr->prio)) {
1395 resched_task(rq->curr);
Steven Rostedte8fa1362008-01-25 21:08:05 +01001396 return 0;
1397 }
1398
Gregory Haskins697f0a42008-01-25 21:08:09 +01001399 /* We might release rq lock */
Steven Rostedte8fa1362008-01-25 21:08:05 +01001400 get_task_struct(next_task);
1401
1402 /* find_lock_lowest_rq locks the rq if found */
Gregory Haskins697f0a42008-01-25 21:08:09 +01001403 lowest_rq = find_lock_lowest_rq(next_task, rq);
Steven Rostedte8fa1362008-01-25 21:08:05 +01001404 if (!lowest_rq) {
1405 struct task_struct *task;
1406 /*
Hillf Danton311e8002011-06-16 21:55:20 -04001407 * find_lock_lowest_rq releases rq->lock
Gregory Haskins15635132008-12-29 09:39:53 -05001408 * so it is possible that next_task has migrated.
1409 *
1410 * We need to make sure that the task is still on the same
1411 * run-queue and is also still the next task eligible for
1412 * pushing.
Steven Rostedte8fa1362008-01-25 21:08:05 +01001413 */
Gregory Haskins917b6272008-12-29 09:39:53 -05001414 task = pick_next_pushable_task(rq);
Gregory Haskins15635132008-12-29 09:39:53 -05001415 if (task_cpu(next_task) == rq->cpu && task == next_task) {
1416 /*
Hillf Danton311e8002011-06-16 21:55:20 -04001417 * The task hasn't migrated, and is still the next
1418 * eligible task, but we failed to find a run-queue
1419 * to push it to. Do not retry in this case, since
1420 * other cpus will pull from us when ready.
Gregory Haskins15635132008-12-29 09:39:53 -05001421 */
Gregory Haskins15635132008-12-29 09:39:53 -05001422 goto out;
Steven Rostedte8fa1362008-01-25 21:08:05 +01001423 }
Gregory Haskins917b6272008-12-29 09:39:53 -05001424
Gregory Haskins15635132008-12-29 09:39:53 -05001425 if (!task)
1426 /* No more tasks, just exit */
1427 goto out;
1428
Gregory Haskins917b6272008-12-29 09:39:53 -05001429 /*
Gregory Haskins15635132008-12-29 09:39:53 -05001430 * Something has shifted, try again.
Gregory Haskins917b6272008-12-29 09:39:53 -05001431 */
Gregory Haskins15635132008-12-29 09:39:53 -05001432 put_task_struct(next_task);
1433 next_task = task;
1434 goto retry;
Steven Rostedte8fa1362008-01-25 21:08:05 +01001435 }
1436
Gregory Haskins697f0a42008-01-25 21:08:09 +01001437 deactivate_task(rq, next_task, 0);
Steven Rostedte8fa1362008-01-25 21:08:05 +01001438 set_task_cpu(next_task, lowest_rq->cpu);
1439 activate_task(lowest_rq, next_task, 0);
Hillf Danton311e8002011-06-16 21:55:20 -04001440 ret = 1;
Steven Rostedte8fa1362008-01-25 21:08:05 +01001441
1442 resched_task(lowest_rq->curr);
1443
Peter Zijlstra1b12bbc2008-08-11 09:30:22 +02001444 double_unlock_balance(rq, lowest_rq);
Steven Rostedte8fa1362008-01-25 21:08:05 +01001445
Steven Rostedte8fa1362008-01-25 21:08:05 +01001446out:
1447 put_task_struct(next_task);
1448
Hillf Danton311e8002011-06-16 21:55:20 -04001449 return ret;
Steven Rostedte8fa1362008-01-25 21:08:05 +01001450}
1451
Steven Rostedte8fa1362008-01-25 21:08:05 +01001452static void push_rt_tasks(struct rq *rq)
1453{
1454 /* push_rt_task will return true if it moved an RT */
1455 while (push_rt_task(rq))
1456 ;
1457}
1458
Steven Rostedtf65eda42008-01-25 21:08:07 +01001459static int pull_rt_task(struct rq *this_rq)
1460{
Ingo Molnar80bf3172008-01-25 21:08:17 +01001461 int this_cpu = this_rq->cpu, ret = 0, cpu;
Gregory Haskinsa8728942008-12-29 09:39:49 -05001462 struct task_struct *p;
Steven Rostedtf65eda42008-01-25 21:08:07 +01001463 struct rq *src_rq;
Steven Rostedtf65eda42008-01-25 21:08:07 +01001464
Gregory Haskins637f5082008-01-25 21:08:18 +01001465 if (likely(!rt_overloaded(this_rq)))
Steven Rostedtf65eda42008-01-25 21:08:07 +01001466 return 0;
1467
Rusty Russellc6c49272008-11-25 02:35:05 +10301468 for_each_cpu(cpu, this_rq->rd->rto_mask) {
Steven Rostedtf65eda42008-01-25 21:08:07 +01001469 if (this_cpu == cpu)
1470 continue;
1471
1472 src_rq = cpu_rq(cpu);
Gregory Haskins74ab8e42008-12-29 09:39:50 -05001473
1474 /*
1475 * Don't bother taking the src_rq->lock if the next highest
1476 * task is known to be lower-priority than our current task.
1477 * This may look racy, but if this value is about to go
1478 * logically higher, the src_rq will push this task away.
1479 * And if its going logically lower, we do not care
1480 */
1481 if (src_rq->rt.highest_prio.next >=
1482 this_rq->rt.highest_prio.curr)
1483 continue;
1484
Steven Rostedtf65eda42008-01-25 21:08:07 +01001485 /*
1486 * We can potentially drop this_rq's lock in
1487 * double_lock_balance, and another CPU could
Gregory Haskinsa8728942008-12-29 09:39:49 -05001488 * alter this_rq
Steven Rostedtf65eda42008-01-25 21:08:07 +01001489 */
Gregory Haskinsa8728942008-12-29 09:39:49 -05001490 double_lock_balance(this_rq, src_rq);
Steven Rostedtf65eda42008-01-25 21:08:07 +01001491
1492 /*
1493 * Are there still pullable RT tasks?
1494 */
Mike Galbraith614ee1f2008-01-25 21:08:30 +01001495 if (src_rq->rt.rt_nr_running <= 1)
1496 goto skip;
Steven Rostedtf65eda42008-01-25 21:08:07 +01001497
Steven Rostedtf65eda42008-01-25 21:08:07 +01001498 p = pick_next_highest_task_rt(src_rq, this_cpu);
1499
1500 /*
1501 * Do we have an RT task that preempts
1502 * the to-be-scheduled task?
1503 */
Gregory Haskinsa8728942008-12-29 09:39:49 -05001504 if (p && (p->prio < this_rq->rt.highest_prio.curr)) {
Steven Rostedtf65eda42008-01-25 21:08:07 +01001505 WARN_ON(p == src_rq->curr);
Peter Zijlstrafd2f4412011-04-05 17:23:44 +02001506 WARN_ON(!p->on_rq);
Steven Rostedtf65eda42008-01-25 21:08:07 +01001507
1508 /*
1509 * There's a chance that p is higher in priority
1510 * than what's currently running on its cpu.
1511 * This is just that p is wakeing up and hasn't
1512 * had a chance to schedule. We only pull
1513 * p if it is lower in priority than the
Gregory Haskinsa8728942008-12-29 09:39:49 -05001514 * current task on the run queue
Steven Rostedtf65eda42008-01-25 21:08:07 +01001515 */
Gregory Haskinsa8728942008-12-29 09:39:49 -05001516 if (p->prio < src_rq->curr->prio)
Mike Galbraith614ee1f2008-01-25 21:08:30 +01001517 goto skip;
Steven Rostedtf65eda42008-01-25 21:08:07 +01001518
1519 ret = 1;
1520
1521 deactivate_task(src_rq, p, 0);
1522 set_task_cpu(p, this_cpu);
1523 activate_task(this_rq, p, 0);
1524 /*
1525 * We continue with the search, just in
1526 * case there's an even higher prio task
Lucas De Marchi25985ed2011-03-30 22:57:33 -03001527 * in another runqueue. (low likelihood
Steven Rostedtf65eda42008-01-25 21:08:07 +01001528 * but possible)
Steven Rostedtf65eda42008-01-25 21:08:07 +01001529 */
Steven Rostedtf65eda42008-01-25 21:08:07 +01001530 }
Peter Zijlstra49246272010-10-17 21:46:10 +02001531skip:
Peter Zijlstra1b12bbc2008-08-11 09:30:22 +02001532 double_unlock_balance(this_rq, src_rq);
Steven Rostedtf65eda42008-01-25 21:08:07 +01001533 }
1534
1535 return ret;
1536}
1537
Steven Rostedt9a897c52008-01-25 21:08:22 +01001538static void pre_schedule_rt(struct rq *rq, struct task_struct *prev)
Steven Rostedtf65eda42008-01-25 21:08:07 +01001539{
1540 /* Try to pull RT tasks here if we lower this rq's prio */
Yong Zhang33c3d6c2010-02-09 14:43:59 -05001541 if (rq->rt.highest_prio.curr > prev->prio)
Steven Rostedtf65eda42008-01-25 21:08:07 +01001542 pull_rt_task(rq);
1543}
1544
Steven Rostedt9a897c52008-01-25 21:08:22 +01001545static void post_schedule_rt(struct rq *rq)
Steven Rostedte8fa1362008-01-25 21:08:05 +01001546{
Gregory Haskins967fc042008-12-29 09:39:52 -05001547 push_rt_tasks(rq);
Steven Rostedte8fa1362008-01-25 21:08:05 +01001548}
1549
Gregory Haskins8ae121a2008-04-23 07:13:29 -04001550/*
1551 * If we are not running and we are not going to reschedule soon, we should
1552 * try to push tasks away now
1553 */
Peter Zijlstraefbbd052009-12-16 18:04:40 +01001554static void task_woken_rt(struct rq *rq, struct task_struct *p)
Steven Rostedt4642daf2008-01-25 21:08:07 +01001555{
Steven Rostedt9a897c52008-01-25 21:08:22 +01001556 if (!task_running(rq, p) &&
Gregory Haskins8ae121a2008-04-23 07:13:29 -04001557 !test_tsk_need_resched(rq->curr) &&
Gregory Haskins917b6272008-12-29 09:39:53 -05001558 has_pushable_tasks(rq) &&
Steven Rostedtb3bc2112010-09-20 22:40:04 -04001559 p->rt.nr_cpus_allowed > 1 &&
Steven Rostedt43fa5462010-09-20 22:40:03 -04001560 rt_task(rq->curr) &&
Steven Rostedtb3bc2112010-09-20 22:40:04 -04001561 (rq->curr->rt.nr_cpus_allowed < 2 ||
1562 rq->curr->prio < p->prio))
Steven Rostedt4642daf2008-01-25 21:08:07 +01001563 push_rt_tasks(rq);
1564}
1565
Mike Traviscd8ba7c2008-03-26 14:23:49 -07001566static void set_cpus_allowed_rt(struct task_struct *p,
Rusty Russell96f874e2008-11-25 02:35:14 +10301567 const struct cpumask *new_mask)
Gregory Haskins73fe6aa2008-01-25 21:08:07 +01001568{
Rusty Russell96f874e2008-11-25 02:35:14 +10301569 int weight = cpumask_weight(new_mask);
Gregory Haskins73fe6aa2008-01-25 21:08:07 +01001570
1571 BUG_ON(!rt_task(p));
1572
1573 /*
1574 * Update the migration status of the RQ if we have an RT task
1575 * which is running AND changing its weight value.
1576 */
Peter Zijlstrafd2f4412011-04-05 17:23:44 +02001577 if (p->on_rq && (weight != p->rt.nr_cpus_allowed)) {
Gregory Haskins73fe6aa2008-01-25 21:08:07 +01001578 struct rq *rq = task_rq(p);
1579
Gregory Haskins917b6272008-12-29 09:39:53 -05001580 if (!task_current(rq, p)) {
1581 /*
1582 * Make sure we dequeue this task from the pushable list
1583 * before going further. It will either remain off of
1584 * the list because we are no longer pushable, or it
1585 * will be requeued.
1586 */
1587 if (p->rt.nr_cpus_allowed > 1)
1588 dequeue_pushable_task(rq, p);
1589
1590 /*
1591 * Requeue if our weight is changing and still > 1
1592 */
1593 if (weight > 1)
1594 enqueue_pushable_task(rq, p);
1595
1596 }
1597
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001598 if ((p->rt.nr_cpus_allowed <= 1) && (weight > 1)) {
Gregory Haskins73fe6aa2008-01-25 21:08:07 +01001599 rq->rt.rt_nr_migratory++;
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001600 } else if ((p->rt.nr_cpus_allowed > 1) && (weight <= 1)) {
Gregory Haskins73fe6aa2008-01-25 21:08:07 +01001601 BUG_ON(!rq->rt.rt_nr_migratory);
1602 rq->rt.rt_nr_migratory--;
1603 }
1604
Gregory Haskins398a1532009-01-14 09:10:04 -05001605 update_rt_migration(&rq->rt);
Gregory Haskins73fe6aa2008-01-25 21:08:07 +01001606 }
1607
Rusty Russell96f874e2008-11-25 02:35:14 +10301608 cpumask_copy(&p->cpus_allowed, new_mask);
Peter Zijlstra6f505b12008-01-25 21:08:30 +01001609 p->rt.nr_cpus_allowed = weight;
Gregory Haskins73fe6aa2008-01-25 21:08:07 +01001610}
Ingo Molnardeeeccd2008-01-25 21:08:15 +01001611
Ingo Molnarbdd7c812008-01-25 21:08:18 +01001612/* Assumes rq->lock is held */
Gregory Haskins1f11eb62008-06-04 15:04:05 -04001613static void rq_online_rt(struct rq *rq)
Ingo Molnarbdd7c812008-01-25 21:08:18 +01001614{
1615 if (rq->rt.overloaded)
1616 rt_set_overload(rq);
Gregory Haskins6e0534f2008-05-12 21:21:01 +02001617
Peter Zijlstra7def2be2008-06-05 14:49:58 +02001618 __enable_runtime(rq);
1619
Gregory Haskinse864c492008-12-29 09:39:49 -05001620 cpupri_set(&rq->rd->cpupri, rq->cpu, rq->rt.highest_prio.curr);
Ingo Molnarbdd7c812008-01-25 21:08:18 +01001621}
1622
1623/* Assumes rq->lock is held */
Gregory Haskins1f11eb62008-06-04 15:04:05 -04001624static void rq_offline_rt(struct rq *rq)
Ingo Molnarbdd7c812008-01-25 21:08:18 +01001625{
1626 if (rq->rt.overloaded)
1627 rt_clear_overload(rq);
Gregory Haskins6e0534f2008-05-12 21:21:01 +02001628
Peter Zijlstra7def2be2008-06-05 14:49:58 +02001629 __disable_runtime(rq);
1630
Gregory Haskins6e0534f2008-05-12 21:21:01 +02001631 cpupri_set(&rq->rd->cpupri, rq->cpu, CPUPRI_INVALID);
Ingo Molnarbdd7c812008-01-25 21:08:18 +01001632}
Steven Rostedtcb469842008-01-25 21:08:22 +01001633
1634/*
1635 * When switch from the rt queue, we bring ourselves to a position
1636 * that we might want to pull RT tasks from other runqueues.
1637 */
Peter Zijlstrada7a7352011-01-17 17:03:27 +01001638static void switched_from_rt(struct rq *rq, struct task_struct *p)
Steven Rostedtcb469842008-01-25 21:08:22 +01001639{
1640 /*
1641 * If there are other RT tasks then we will reschedule
1642 * and the scheduling of the other RT tasks will handle
1643 * the balancing. But if we are the last RT task
1644 * we may need to handle the pulling of RT tasks
1645 * now.
1646 */
Peter Zijlstrafd2f4412011-04-05 17:23:44 +02001647 if (p->on_rq && !rq->rt.rt_nr_running)
Steven Rostedtcb469842008-01-25 21:08:22 +01001648 pull_rt_task(rq);
1649}
Rusty Russell3d8cbdf2008-11-25 09:58:41 +10301650
1651static inline void init_sched_rt_class(void)
1652{
1653 unsigned int i;
1654
1655 for_each_possible_cpu(i)
Yinghai Lueaa95842009-06-06 14:51:36 -07001656 zalloc_cpumask_var_node(&per_cpu(local_cpu_mask, i),
Mike Travis6ca09df2008-12-31 18:08:45 -08001657 GFP_KERNEL, cpu_to_node(i));
Rusty Russell3d8cbdf2008-11-25 09:58:41 +10301658}
Steven Rostedte8fa1362008-01-25 21:08:05 +01001659#endif /* CONFIG_SMP */
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001660
Steven Rostedtcb469842008-01-25 21:08:22 +01001661/*
1662 * When switching a task to RT, we may overload the runqueue
1663 * with RT tasks. In this case we try to push them off to
1664 * other runqueues.
1665 */
Peter Zijlstrada7a7352011-01-17 17:03:27 +01001666static void switched_to_rt(struct rq *rq, struct task_struct *p)
Steven Rostedtcb469842008-01-25 21:08:22 +01001667{
1668 int check_resched = 1;
1669
1670 /*
1671 * If we are already running, then there's nothing
1672 * that needs to be done. But if we are not running
1673 * we may need to preempt the current running task.
1674 * If that current running task is also an RT task
1675 * then see if we can move to another run queue.
1676 */
Peter Zijlstrafd2f4412011-04-05 17:23:44 +02001677 if (p->on_rq && rq->curr != p) {
Steven Rostedtcb469842008-01-25 21:08:22 +01001678#ifdef CONFIG_SMP
1679 if (rq->rt.overloaded && push_rt_task(rq) &&
1680 /* Don't resched if we changed runqueues */
1681 rq != task_rq(p))
1682 check_resched = 0;
1683#endif /* CONFIG_SMP */
1684 if (check_resched && p->prio < rq->curr->prio)
1685 resched_task(rq->curr);
1686 }
1687}
1688
1689/*
1690 * Priority of the task has changed. This may cause
1691 * us to initiate a push or pull.
1692 */
Peter Zijlstrada7a7352011-01-17 17:03:27 +01001693static void
1694prio_changed_rt(struct rq *rq, struct task_struct *p, int oldprio)
Steven Rostedtcb469842008-01-25 21:08:22 +01001695{
Peter Zijlstrafd2f4412011-04-05 17:23:44 +02001696 if (!p->on_rq)
Peter Zijlstrada7a7352011-01-17 17:03:27 +01001697 return;
1698
1699 if (rq->curr == p) {
Steven Rostedtcb469842008-01-25 21:08:22 +01001700#ifdef CONFIG_SMP
1701 /*
1702 * If our priority decreases while running, we
1703 * may need to pull tasks to this runqueue.
1704 */
1705 if (oldprio < p->prio)
1706 pull_rt_task(rq);
1707 /*
1708 * If there's a higher priority task waiting to run
Steven Rostedt6fa46fa2008-03-05 10:00:12 -05001709 * then reschedule. Note, the above pull_rt_task
1710 * can release the rq lock and p could migrate.
1711 * Only reschedule if p is still on the same runqueue.
Steven Rostedtcb469842008-01-25 21:08:22 +01001712 */
Gregory Haskinse864c492008-12-29 09:39:49 -05001713 if (p->prio > rq->rt.highest_prio.curr && rq->curr == p)
Steven Rostedtcb469842008-01-25 21:08:22 +01001714 resched_task(p);
1715#else
1716 /* For UP simply resched on drop of prio */
1717 if (oldprio < p->prio)
1718 resched_task(p);
1719#endif /* CONFIG_SMP */
1720 } else {
1721 /*
1722 * This task is not running, but if it is
1723 * greater than the current running task
1724 * then reschedule.
1725 */
1726 if (p->prio < rq->curr->prio)
1727 resched_task(rq->curr);
1728 }
1729}
1730
Peter Zijlstra78f2c7d2008-01-25 21:08:27 +01001731static void watchdog(struct rq *rq, struct task_struct *p)
1732{
1733 unsigned long soft, hard;
1734
Jiri Slaby78d7d402010-03-05 13:42:54 -08001735 /* max may change after cur was read, this will be fixed next tick */
1736 soft = task_rlimit(p, RLIMIT_RTTIME);
1737 hard = task_rlimit_max(p, RLIMIT_RTTIME);
Peter Zijlstra78f2c7d2008-01-25 21:08:27 +01001738
1739 if (soft != RLIM_INFINITY) {
1740 unsigned long next;
1741
1742 p->rt.timeout++;
1743 next = DIV_ROUND_UP(min(soft, hard), USEC_PER_SEC/HZ);
Peter Zijlstra5a52dd52008-01-25 21:08:32 +01001744 if (p->rt.timeout > next)
Frank Mayharf06febc2008-09-12 09:54:39 -07001745 p->cputime_expires.sched_exp = p->se.sum_exec_runtime;
Peter Zijlstra78f2c7d2008-01-25 21:08:27 +01001746 }
1747}
Steven Rostedtcb469842008-01-25 21:08:22 +01001748
Peter Zijlstra8f4d37e2008-01-25 21:08:29 +01001749static void task_tick_rt(struct rq *rq, struct task_struct *p, int queued)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001750{
Peter Zijlstra67e2be02007-12-20 15:01:17 +01001751 update_curr_rt(rq);
1752
Peter Zijlstra78f2c7d2008-01-25 21:08:27 +01001753 watchdog(rq, p);
1754
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001755 /*
1756 * RR tasks need a special form of timeslice management.
1757 * FIFO tasks have no timeslices.
1758 */
1759 if (p->policy != SCHED_RR)
1760 return;
1761
Peter Zijlstrafa717062008-01-25 21:08:27 +01001762 if (--p->rt.time_slice)
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001763 return;
1764
Peter Zijlstrafa717062008-01-25 21:08:27 +01001765 p->rt.time_slice = DEF_TIMESLICE;
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001766
Dmitry Adamushko98fbc792007-08-24 20:39:10 +02001767 /*
1768 * Requeue to the end of queue if we are not the only element
1769 * on the queue:
1770 */
Peter Zijlstrafa717062008-01-25 21:08:27 +01001771 if (p->rt.run_list.prev != p->rt.run_list.next) {
Dmitry Adamushko7ebefa82008-07-01 23:32:15 +02001772 requeue_task_rt(rq, p, 0);
Dmitry Adamushko98fbc792007-08-24 20:39:10 +02001773 set_tsk_need_resched(p);
1774 }
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001775}
1776
Srivatsa Vaddagiri83b699e2007-10-15 17:00:08 +02001777static void set_curr_task_rt(struct rq *rq)
1778{
1779 struct task_struct *p = rq->curr;
1780
Venkatesh Pallipadi305e6832010-10-04 17:03:21 -07001781 p->se.exec_start = rq->clock_task;
Gregory Haskins917b6272008-12-29 09:39:53 -05001782
1783 /* The running task is never eligible for pushing */
1784 dequeue_pushable_task(rq, p);
Srivatsa Vaddagiri83b699e2007-10-15 17:00:08 +02001785}
1786
H Hartley Sweeten6d686f42010-01-13 20:21:52 -07001787static unsigned int get_rr_interval_rt(struct rq *rq, struct task_struct *task)
Peter Williams0d721ce2009-09-21 01:31:53 +00001788{
1789 /*
1790 * Time slice is 0 for SCHED_FIFO tasks
1791 */
1792 if (task->policy == SCHED_RR)
1793 return DEF_TIMESLICE;
1794 else
1795 return 0;
1796}
1797
Harvey Harrison2abdad02008-04-25 10:53:13 -07001798static const struct sched_class rt_sched_class = {
Ingo Molnar5522d5d2007-10-15 17:00:12 +02001799 .next = &fair_sched_class,
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001800 .enqueue_task = enqueue_task_rt,
1801 .dequeue_task = dequeue_task_rt,
1802 .yield_task = yield_task_rt,
1803
1804 .check_preempt_curr = check_preempt_curr_rt,
1805
1806 .pick_next_task = pick_next_task_rt,
1807 .put_prev_task = put_prev_task_rt,
1808
Peter Williams681f3e62007-10-24 18:23:51 +02001809#ifdef CONFIG_SMP
Li Zefan4ce72a22008-10-22 15:25:26 +08001810 .select_task_rq = select_task_rq_rt,
1811
Gregory Haskins73fe6aa2008-01-25 21:08:07 +01001812 .set_cpus_allowed = set_cpus_allowed_rt,
Gregory Haskins1f11eb62008-06-04 15:04:05 -04001813 .rq_online = rq_online_rt,
1814 .rq_offline = rq_offline_rt,
Steven Rostedt9a897c52008-01-25 21:08:22 +01001815 .pre_schedule = pre_schedule_rt,
1816 .post_schedule = post_schedule_rt,
Peter Zijlstraefbbd052009-12-16 18:04:40 +01001817 .task_woken = task_woken_rt,
Steven Rostedtcb469842008-01-25 21:08:22 +01001818 .switched_from = switched_from_rt,
Peter Williams681f3e62007-10-24 18:23:51 +02001819#endif
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001820
Srivatsa Vaddagiri83b699e2007-10-15 17:00:08 +02001821 .set_curr_task = set_curr_task_rt,
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001822 .task_tick = task_tick_rt,
Steven Rostedtcb469842008-01-25 21:08:22 +01001823
Peter Williams0d721ce2009-09-21 01:31:53 +00001824 .get_rr_interval = get_rr_interval_rt,
1825
Steven Rostedtcb469842008-01-25 21:08:22 +01001826 .prio_changed = prio_changed_rt,
1827 .switched_to = switched_to_rt,
Ingo Molnarbb44e5d2007-07-09 18:51:58 +02001828};
Peter Zijlstraada18de2008-06-19 14:22:24 +02001829
1830#ifdef CONFIG_SCHED_DEBUG
1831extern void print_rt_rq(struct seq_file *m, int cpu, struct rt_rq *rt_rq);
1832
1833static void print_rt_stats(struct seq_file *m, int cpu)
1834{
Cheng Xuec514c42011-05-14 14:20:02 +08001835 rt_rq_iter_t iter;
Peter Zijlstraada18de2008-06-19 14:22:24 +02001836 struct rt_rq *rt_rq;
1837
1838 rcu_read_lock();
Cheng Xuec514c42011-05-14 14:20:02 +08001839 for_each_rt_rq(rt_rq, iter, cpu_rq(cpu))
Peter Zijlstraada18de2008-06-19 14:22:24 +02001840 print_rt_rq(m, cpu, rt_rq);
1841 rcu_read_unlock();
1842}
Dhaval Giani55e12e52008-06-24 23:39:43 +05301843#endif /* CONFIG_SCHED_DEBUG */
Rusty Russell0e3900e2008-11-25 02:35:13 +10301844