xref: /linux/kernel/sched/deadline.c (revision 2cbf335f8ccc7a6418159858dc03e36df8e3e5cf)
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Deadline Scheduling Class (SCHED_DEADLINE)
4  *
5  * Earliest Deadline First (EDF) + Constant Bandwidth Server (CBS).
6  *
7  * Tasks that periodically executes their instances for less than their
8  * runtime won't miss any of their deadlines.
9  * Tasks that are not periodic or sporadic or that tries to execute more
10  * than their reserved bandwidth will be slowed down (and may potentially
11  * miss some of their deadlines), and won't affect any other task.
12  *
13  * Copyright (C) 2012 Dario Faggioli <raistlin@linux.it>,
14  *                    Juri Lelli <juri.lelli@gmail.com>,
15  *                    Michael Trimarchi <michael@amarulasolutions.com>,
16  *                    Fabio Checconi <fchecconi@gmail.com>
17  */
18 
19 #include <linux/cpuset.h>
20 #include <linux/sched/clock.h>
21 #include <linux/sched/deadline.h>
22 #include <uapi/linux/sched/types.h>
23 #include "sched.h"
24 #include "pelt.h"
25 
26 /*
27  * Default limits for DL period; on the top end we guard against small util
28  * tasks still getting ridiculously long effective runtimes, on the bottom end we
29  * guard against timer DoS.
30  */
31 static unsigned int sysctl_sched_dl_period_max = 1 << 22; /* ~4 seconds */
32 static unsigned int sysctl_sched_dl_period_min = 100;     /* 100 us */
33 #ifdef CONFIG_SYSCTL
34 static const struct ctl_table sched_dl_sysctls[] = {
35 	{
36 		.procname       = "sched_deadline_period_max_us",
37 		.data           = &sysctl_sched_dl_period_max,
38 		.maxlen         = sizeof(unsigned int),
39 		.mode           = 0644,
40 		.proc_handler   = proc_douintvec_minmax,
41 		.extra1         = (void *)&sysctl_sched_dl_period_min,
42 	},
43 	{
44 		.procname       = "sched_deadline_period_min_us",
45 		.data           = &sysctl_sched_dl_period_min,
46 		.maxlen         = sizeof(unsigned int),
47 		.mode           = 0644,
48 		.proc_handler   = proc_douintvec_minmax,
49 		.extra2         = (void *)&sysctl_sched_dl_period_max,
50 	},
51 };
52 
53 static int __init sched_dl_sysctl_init(void)
54 {
55 	register_sysctl_init("kernel", sched_dl_sysctls);
56 	return 0;
57 }
58 late_initcall(sched_dl_sysctl_init);
59 #endif /* CONFIG_SYSCTL */
60 
61 static inline struct rq *rq_of_dl_rq(struct dl_rq *dl_rq)
62 {
63 	return container_of(dl_rq, struct rq, dl);
64 }
65 
66 static inline struct rq *rq_of_dl_se(struct sched_dl_entity *dl_se)
67 {
68 	struct rq *rq = dl_se->rq;
69 
70 	if (!dl_server(dl_se))
71 		rq = task_rq(dl_task_of(dl_se));
72 
73 	return rq;
74 }
75 
76 static inline struct dl_rq *dl_rq_of_se(struct sched_dl_entity *dl_se)
77 {
78 	return &rq_of_dl_se(dl_se)->dl;
79 }
80 
81 static inline int on_dl_rq(struct sched_dl_entity *dl_se)
82 {
83 	return !RB_EMPTY_NODE(&dl_se->rb_node);
84 }
85 
86 #ifdef CONFIG_RT_MUTEXES
87 static inline struct sched_dl_entity *pi_of(struct sched_dl_entity *dl_se)
88 {
89 	return dl_se->pi_se;
90 }
91 
92 static inline bool is_dl_boosted(struct sched_dl_entity *dl_se)
93 {
94 	return pi_of(dl_se) != dl_se;
95 }
96 #else /* !CONFIG_RT_MUTEXES: */
97 static inline struct sched_dl_entity *pi_of(struct sched_dl_entity *dl_se)
98 {
99 	return dl_se;
100 }
101 
102 static inline bool is_dl_boosted(struct sched_dl_entity *dl_se)
103 {
104 	return false;
105 }
106 #endif /* !CONFIG_RT_MUTEXES */
107 
108 static inline u8 dl_get_type(struct sched_dl_entity *dl_se, struct rq *rq)
109 {
110 	if (!dl_server(dl_se))
111 		return DL_TASK;
112 	if (dl_se == &rq->fair_server)
113 		return DL_SERVER_FAIR;
114 #ifdef CONFIG_SCHED_CLASS_EXT
115 	if (dl_se == &rq->ext_server)
116 		return DL_SERVER_EXT;
117 #endif
118 	return DL_OTHER;
119 }
120 
121 static inline struct dl_bw *dl_bw_of(int i)
122 {
123 	RCU_LOCKDEP_WARN(!rcu_read_lock_sched_held(),
124 			 "sched RCU must be held");
125 	return &cpu_rq(i)->rd->dl_bw;
126 }
127 
128 static inline int dl_bw_cpus(int i)
129 {
130 	struct root_domain *rd = cpu_rq(i)->rd;
131 
132 	RCU_LOCKDEP_WARN(!rcu_read_lock_sched_held(),
133 			 "sched RCU must be held");
134 
135 	return cpumask_weight_and(rd->span, cpu_active_mask);
136 }
137 
138 static inline unsigned long __dl_bw_capacity(const struct cpumask *mask)
139 {
140 	unsigned long cap = 0;
141 	int i;
142 
143 	for_each_cpu_and(i, mask, cpu_active_mask)
144 		cap += arch_scale_cpu_capacity(i);
145 
146 	return cap;
147 }
148 
149 /*
150  * XXX Fix: If 'rq->rd == def_root_domain' perform AC against capacity
151  * of the CPU the task is running on rather rd's \Sum CPU capacity.
152  */
153 static inline unsigned long dl_bw_capacity(int i)
154 {
155 	if (!sched_asym_cpucap_active() &&
156 	    arch_scale_cpu_capacity(i) == SCHED_CAPACITY_SCALE) {
157 		return dl_bw_cpus(i) << SCHED_CAPACITY_SHIFT;
158 	} else {
159 		RCU_LOCKDEP_WARN(!rcu_read_lock_sched_held(),
160 				 "sched RCU must be held");
161 
162 		return __dl_bw_capacity(cpu_rq(i)->rd->span);
163 	}
164 }
165 
166 bool dl_bw_visited(int cpu, u64 cookie)
167 {
168 	struct root_domain *rd = cpu_rq(cpu)->rd;
169 
170 	if (rd->visit_cookie == cookie)
171 		return true;
172 
173 	rd->visit_cookie = cookie;
174 	return false;
175 }
176 
177 static inline
178 void __dl_update(struct dl_bw *dl_b, s64 bw)
179 {
180 	struct root_domain *rd = container_of(dl_b, struct root_domain, dl_bw);
181 	int i;
182 
183 	RCU_LOCKDEP_WARN(!rcu_read_lock_sched_held(),
184 			 "sched RCU must be held");
185 	for_each_cpu_and(i, rd->span, cpu_active_mask) {
186 		struct rq *rq = cpu_rq(i);
187 
188 		rq->dl.extra_bw += bw;
189 	}
190 }
191 
192 static inline
193 void __dl_sub(struct dl_bw *dl_b, u64 tsk_bw, int cpus)
194 {
195 	dl_b->total_bw -= tsk_bw;
196 	__dl_update(dl_b, (s32)tsk_bw / cpus);
197 }
198 
199 static inline
200 void __dl_add(struct dl_bw *dl_b, u64 tsk_bw, int cpus)
201 {
202 	dl_b->total_bw += tsk_bw;
203 	__dl_update(dl_b, -((s32)tsk_bw / cpus));
204 }
205 
206 static inline bool
207 __dl_overflow(struct dl_bw *dl_b, unsigned long cap, u64 old_bw, u64 new_bw)
208 {
209 	return dl_b->bw != -1 &&
210 	       cap_scale(dl_b->bw, cap) < dl_b->total_bw - old_bw + new_bw;
211 }
212 
213 static inline
214 void __add_running_bw(u64 dl_bw, struct dl_rq *dl_rq)
215 {
216 	u64 old = dl_rq->running_bw;
217 
218 	lockdep_assert_rq_held(rq_of_dl_rq(dl_rq));
219 	dl_rq->running_bw += dl_bw;
220 	WARN_ON_ONCE(dl_rq->running_bw < old); /* overflow */
221 	WARN_ON_ONCE(dl_rq->running_bw > dl_rq->this_bw);
222 	/* kick cpufreq (see the comment in kernel/sched/sched.h). */
223 	cpufreq_update_util(rq_of_dl_rq(dl_rq), 0);
224 }
225 
226 static inline
227 void __sub_running_bw(u64 dl_bw, struct dl_rq *dl_rq)
228 {
229 	u64 old = dl_rq->running_bw;
230 
231 	lockdep_assert_rq_held(rq_of_dl_rq(dl_rq));
232 	dl_rq->running_bw -= dl_bw;
233 	WARN_ON_ONCE(dl_rq->running_bw > old); /* underflow */
234 	if (dl_rq->running_bw > old)
235 		dl_rq->running_bw = 0;
236 	/* kick cpufreq (see the comment in kernel/sched/sched.h). */
237 	cpufreq_update_util(rq_of_dl_rq(dl_rq), 0);
238 }
239 
240 static inline
241 void __add_rq_bw(u64 dl_bw, struct dl_rq *dl_rq)
242 {
243 	u64 old = dl_rq->this_bw;
244 
245 	lockdep_assert_rq_held(rq_of_dl_rq(dl_rq));
246 	dl_rq->this_bw += dl_bw;
247 	WARN_ON_ONCE(dl_rq->this_bw < old); /* overflow */
248 }
249 
250 static inline
251 void __sub_rq_bw(u64 dl_bw, struct dl_rq *dl_rq)
252 {
253 	u64 old = dl_rq->this_bw;
254 
255 	lockdep_assert_rq_held(rq_of_dl_rq(dl_rq));
256 	dl_rq->this_bw -= dl_bw;
257 	WARN_ON_ONCE(dl_rq->this_bw > old); /* underflow */
258 	if (dl_rq->this_bw > old)
259 		dl_rq->this_bw = 0;
260 	WARN_ON_ONCE(dl_rq->running_bw > dl_rq->this_bw);
261 }
262 
263 static inline
264 void add_rq_bw(struct sched_dl_entity *dl_se, struct dl_rq *dl_rq)
265 {
266 	if (!dl_entity_is_special(dl_se))
267 		__add_rq_bw(dl_se->dl_bw, dl_rq);
268 }
269 
270 static inline
271 void sub_rq_bw(struct sched_dl_entity *dl_se, struct dl_rq *dl_rq)
272 {
273 	if (!dl_entity_is_special(dl_se))
274 		__sub_rq_bw(dl_se->dl_bw, dl_rq);
275 }
276 
277 static inline
278 void add_running_bw(struct sched_dl_entity *dl_se, struct dl_rq *dl_rq)
279 {
280 	if (!dl_entity_is_special(dl_se))
281 		__add_running_bw(dl_se->dl_bw, dl_rq);
282 }
283 
284 static inline
285 void sub_running_bw(struct sched_dl_entity *dl_se, struct dl_rq *dl_rq)
286 {
287 	if (!dl_entity_is_special(dl_se))
288 		__sub_running_bw(dl_se->dl_bw, dl_rq);
289 }
290 
291 static void dl_rq_change_utilization(struct rq *rq, struct sched_dl_entity *dl_se, u64 new_bw)
292 {
293 	if (dl_se->dl_non_contending) {
294 		sub_running_bw(dl_se, &rq->dl);
295 		dl_se->dl_non_contending = 0;
296 
297 		/*
298 		 * If the timer handler is currently running and the
299 		 * timer cannot be canceled, inactive_task_timer()
300 		 * will see that dl_not_contending is not set, and
301 		 * will not touch the rq's active utilization,
302 		 * so we are still safe.
303 		 */
304 		if (hrtimer_try_to_cancel(&dl_se->inactive_timer) == 1) {
305 			if (!dl_server(dl_se))
306 				put_task_struct(dl_task_of(dl_se));
307 		}
308 	}
309 	__sub_rq_bw(dl_se->dl_bw, &rq->dl);
310 	__add_rq_bw(new_bw, &rq->dl);
311 }
312 
313 static __always_inline
314 void cancel_dl_timer(struct sched_dl_entity *dl_se, struct hrtimer *timer)
315 {
316 	/*
317 	 * If the timer callback was running (hrtimer_try_to_cancel == -1),
318 	 * it will eventually call put_task_struct().
319 	 */
320 	if (hrtimer_try_to_cancel(timer) == 1 && !dl_server(dl_se))
321 		put_task_struct(dl_task_of(dl_se));
322 }
323 
324 static __always_inline
325 void cancel_replenish_timer(struct sched_dl_entity *dl_se)
326 {
327 	cancel_dl_timer(dl_se, &dl_se->dl_timer);
328 }
329 
330 static __always_inline
331 void cancel_inactive_timer(struct sched_dl_entity *dl_se)
332 {
333 	cancel_dl_timer(dl_se, &dl_se->inactive_timer);
334 }
335 
336 static void dl_change_utilization(struct task_struct *p, u64 new_bw)
337 {
338 	WARN_ON_ONCE(p->dl.flags & SCHED_FLAG_SUGOV);
339 
340 	if (task_on_rq_queued(p))
341 		return;
342 
343 	dl_rq_change_utilization(task_rq(p), &p->dl, new_bw);
344 }
345 
346 static void __dl_clear_params(struct sched_dl_entity *dl_se);
347 
348 /*
349  * The utilization of a task cannot be immediately removed from
350  * the rq active utilization (running_bw) when the task blocks.
351  * Instead, we have to wait for the so called "0-lag time".
352  *
353  * If a task blocks before the "0-lag time", a timer (the inactive
354  * timer) is armed, and running_bw is decreased when the timer
355  * fires.
356  *
357  * If the task wakes up again before the inactive timer fires,
358  * the timer is canceled, whereas if the task wakes up after the
359  * inactive timer fired (and running_bw has been decreased) the
360  * task's utilization has to be added to running_bw again.
361  * A flag in the deadline scheduling entity (dl_non_contending)
362  * is used to avoid race conditions between the inactive timer handler
363  * and task wakeups.
364  *
365  * The following diagram shows how running_bw is updated. A task is
366  * "ACTIVE" when its utilization contributes to running_bw; an
367  * "ACTIVE contending" task is in the TASK_RUNNING state, while an
368  * "ACTIVE non contending" task is a blocked task for which the "0-lag time"
369  * has not passed yet. An "INACTIVE" task is a task for which the "0-lag"
370  * time already passed, which does not contribute to running_bw anymore.
371  *                              +------------------+
372  *             wakeup           |    ACTIVE        |
373  *          +------------------>+   contending     |
374  *          | add_running_bw    |                  |
375  *          |                   +----+------+------+
376  *          |                        |      ^
377  *          |                dequeue |      |
378  * +--------+-------+                |      |
379  * |                |   t >= 0-lag   |      | wakeup
380  * |    INACTIVE    |<---------------+      |
381  * |                | sub_running_bw |      |
382  * +--------+-------+                |      |
383  *          ^                        |      |
384  *          |              t < 0-lag |      |
385  *          |                        |      |
386  *          |                        V      |
387  *          |                   +----+------+------+
388  *          | sub_running_bw    |    ACTIVE        |
389  *          +-------------------+                  |
390  *            inactive timer    |  non contending  |
391  *            fired             +------------------+
392  *
393  * The task_non_contending() function is invoked when a task
394  * blocks, and checks if the 0-lag time already passed or
395  * not (in the first case, it directly updates running_bw;
396  * in the second case, it arms the inactive timer).
397  *
398  * The task_contending() function is invoked when a task wakes
399  * up, and checks if the task is still in the "ACTIVE non contending"
400  * state or not (in the second case, it updates running_bw).
401  */
402 static void task_non_contending(struct sched_dl_entity *dl_se, bool dl_task)
403 {
404 	struct hrtimer *timer = &dl_se->inactive_timer;
405 	struct rq *rq = rq_of_dl_se(dl_se);
406 	struct dl_rq *dl_rq = &rq->dl;
407 	s64 zerolag_time;
408 
409 	/*
410 	 * If this is a non-deadline task that has been boosted,
411 	 * do nothing
412 	 */
413 	if (dl_se->dl_runtime == 0)
414 		return;
415 
416 	if (dl_entity_is_special(dl_se))
417 		return;
418 
419 	WARN_ON(dl_se->dl_non_contending);
420 
421 	zerolag_time = dl_se->deadline -
422 		 div64_long((dl_se->runtime * dl_se->dl_period),
423 			dl_se->dl_runtime);
424 
425 	/*
426 	 * Using relative times instead of the absolute "0-lag time"
427 	 * allows to simplify the code
428 	 */
429 	zerolag_time -= rq_clock(rq);
430 
431 	/*
432 	 * If the "0-lag time" already passed, decrease the active
433 	 * utilization now, instead of starting a timer
434 	 */
435 	if ((zerolag_time < 0) || hrtimer_active(&dl_se->inactive_timer)) {
436 		if (dl_server(dl_se)) {
437 			sub_running_bw(dl_se, dl_rq);
438 		} else {
439 			struct task_struct *p = dl_task_of(dl_se);
440 
441 			if (dl_task)
442 				sub_running_bw(dl_se, dl_rq);
443 
444 			if (!dl_task || READ_ONCE(p->__state) == TASK_DEAD) {
445 				struct dl_bw *dl_b = dl_bw_of(task_cpu(p));
446 
447 				if (READ_ONCE(p->__state) == TASK_DEAD)
448 					sub_rq_bw(dl_se, &rq->dl);
449 				raw_spin_lock(&dl_b->lock);
450 				__dl_sub(dl_b, dl_se->dl_bw, dl_bw_cpus(task_cpu(p)));
451 				raw_spin_unlock(&dl_b->lock);
452 				__dl_clear_params(dl_se);
453 			}
454 		}
455 
456 		return;
457 	}
458 
459 	dl_se->dl_non_contending = 1;
460 	if (!dl_server(dl_se))
461 		get_task_struct(dl_task_of(dl_se));
462 
463 	hrtimer_start(timer, ns_to_ktime(zerolag_time), HRTIMER_MODE_REL_HARD);
464 }
465 
466 static void task_contending(struct sched_dl_entity *dl_se, int flags)
467 {
468 	struct dl_rq *dl_rq = dl_rq_of_se(dl_se);
469 
470 	/*
471 	 * If this is a non-deadline task that has been boosted,
472 	 * do nothing
473 	 */
474 	if (dl_se->dl_runtime == 0)
475 		return;
476 
477 	if (flags & ENQUEUE_MIGRATED)
478 		add_rq_bw(dl_se, dl_rq);
479 
480 	if (dl_se->dl_non_contending) {
481 		dl_se->dl_non_contending = 0;
482 		/*
483 		 * If the timer handler is currently running and the
484 		 * timer cannot be canceled, inactive_task_timer()
485 		 * will see that dl_not_contending is not set, and
486 		 * will not touch the rq's active utilization,
487 		 * so we are still safe.
488 		 */
489 		cancel_inactive_timer(dl_se);
490 	} else {
491 		/*
492 		 * Since "dl_non_contending" is not set, the
493 		 * task's utilization has already been removed from
494 		 * active utilization (either when the task blocked,
495 		 * when the "inactive timer" fired).
496 		 * So, add it back.
497 		 */
498 		add_running_bw(dl_se, dl_rq);
499 	}
500 }
501 
502 static inline int is_leftmost(struct sched_dl_entity *dl_se, struct dl_rq *dl_rq)
503 {
504 	return rb_first_cached(&dl_rq->root) == &dl_se->rb_node;
505 }
506 
507 static void init_dl_rq_bw_ratio(struct dl_rq *dl_rq);
508 
509 void init_dl_bw(struct dl_bw *dl_b)
510 {
511 	raw_spin_lock_init(&dl_b->lock);
512 	if (global_rt_runtime() == RUNTIME_INF)
513 		dl_b->bw = -1;
514 	else
515 		dl_b->bw = to_ratio(global_rt_period(), global_rt_runtime());
516 	dl_b->total_bw = 0;
517 }
518 
519 void init_dl_rq(struct dl_rq *dl_rq)
520 {
521 	dl_rq->root = RB_ROOT_CACHED;
522 
523 	/* zero means no -deadline tasks */
524 	dl_rq->earliest_dl.curr = dl_rq->earliest_dl.next = 0;
525 
526 	dl_rq->overloaded = 0;
527 	dl_rq->pushable_dl_tasks_root = RB_ROOT_CACHED;
528 
529 	dl_rq->running_bw = 0;
530 	dl_rq->this_bw = 0;
531 	init_dl_rq_bw_ratio(dl_rq);
532 }
533 
534 static inline int dl_overloaded(struct rq *rq)
535 {
536 	return atomic_read(&rq->rd->dlo_count);
537 }
538 
539 static inline void dl_set_overload(struct rq *rq)
540 {
541 	if (!rq->online)
542 		return;
543 
544 	cpumask_set_cpu(rq->cpu, rq->rd->dlo_mask);
545 	/*
546 	 * Must be visible before the overload count is
547 	 * set (as in sched_rt.c).
548 	 *
549 	 * Matched by the barrier in pull_dl_task().
550 	 */
551 	smp_wmb();
552 	atomic_inc(&rq->rd->dlo_count);
553 }
554 
555 static inline void dl_clear_overload(struct rq *rq)
556 {
557 	if (!rq->online)
558 		return;
559 
560 	atomic_dec(&rq->rd->dlo_count);
561 	cpumask_clear_cpu(rq->cpu, rq->rd->dlo_mask);
562 }
563 
564 #define __node_2_pdl(node) \
565 	rb_entry((node), struct task_struct, pushable_dl_tasks)
566 
567 static inline bool __pushable_less(struct rb_node *a, const struct rb_node *b)
568 {
569 	return dl_entity_preempt(&__node_2_pdl(a)->dl, &__node_2_pdl(b)->dl);
570 }
571 
572 static inline int has_pushable_dl_tasks(struct rq *rq)
573 {
574 	return !RB_EMPTY_ROOT(&rq->dl.pushable_dl_tasks_root.rb_root);
575 }
576 
577 /*
578  * The list of pushable -deadline task is not a plist, like in
579  * sched_rt.c, it is an rb-tree with tasks ordered by deadline.
580  */
581 static void enqueue_pushable_dl_task(struct rq *rq, struct task_struct *p)
582 {
583 	struct rb_node *leftmost;
584 
585 	WARN_ON_ONCE(!RB_EMPTY_NODE(&p->pushable_dl_tasks));
586 
587 	leftmost = rb_add_cached(&p->pushable_dl_tasks,
588 				 &rq->dl.pushable_dl_tasks_root,
589 				 __pushable_less);
590 	if (leftmost)
591 		rq->dl.earliest_dl.next = p->dl.deadline;
592 
593 	if (!rq->dl.overloaded) {
594 		dl_set_overload(rq);
595 		rq->dl.overloaded = 1;
596 	}
597 }
598 
599 static void dequeue_pushable_dl_task(struct rq *rq, struct task_struct *p)
600 {
601 	struct dl_rq *dl_rq = &rq->dl;
602 	struct rb_root_cached *root = &dl_rq->pushable_dl_tasks_root;
603 	struct rb_node *leftmost;
604 
605 	if (RB_EMPTY_NODE(&p->pushable_dl_tasks))
606 		return;
607 
608 	leftmost = rb_erase_cached(&p->pushable_dl_tasks, root);
609 	if (leftmost)
610 		dl_rq->earliest_dl.next = __node_2_pdl(leftmost)->dl.deadline;
611 
612 	RB_CLEAR_NODE(&p->pushable_dl_tasks);
613 
614 	if (!has_pushable_dl_tasks(rq) && rq->dl.overloaded) {
615 		dl_clear_overload(rq);
616 		rq->dl.overloaded = 0;
617 	}
618 }
619 
620 static int push_dl_task(struct rq *rq);
621 
622 static inline bool need_pull_dl_task(struct rq *rq, struct task_struct *prev)
623 {
624 	return rq->online && dl_task(prev);
625 }
626 
627 static DEFINE_PER_CPU(struct balance_callback, dl_push_head);
628 static DEFINE_PER_CPU(struct balance_callback, dl_pull_head);
629 
630 static void push_dl_tasks(struct rq *);
631 static void pull_dl_task(struct rq *);
632 
633 static inline void deadline_queue_push_tasks(struct rq *rq)
634 {
635 	if (!has_pushable_dl_tasks(rq))
636 		return;
637 
638 	queue_balance_callback(rq, &per_cpu(dl_push_head, rq->cpu), push_dl_tasks);
639 }
640 
641 static inline void deadline_queue_pull_task(struct rq *rq)
642 {
643 	queue_balance_callback(rq, &per_cpu(dl_pull_head, rq->cpu), pull_dl_task);
644 }
645 
646 static struct rq *find_lock_later_rq(struct task_struct *task, struct rq *rq);
647 
648 static struct rq *dl_task_offline_migration(struct rq *rq, struct task_struct *p)
649 {
650 	struct rq *later_rq = NULL;
651 	struct dl_bw *dl_b;
652 
653 	later_rq = find_lock_later_rq(p, rq);
654 	if (!later_rq) {
655 		int cpu;
656 
657 		/*
658 		 * If we cannot preempt any rq, fall back to pick any
659 		 * online CPU:
660 		 */
661 		cpu = cpumask_any_and(cpu_active_mask, p->cpus_ptr);
662 		if (cpu >= nr_cpu_ids) {
663 			/*
664 			 * Failed to find any suitable CPU.
665 			 * The task will never come back!
666 			 */
667 			WARN_ON_ONCE(dl_bandwidth_enabled());
668 
669 			/*
670 			 * If admission control is disabled we
671 			 * try a little harder to let the task
672 			 * run.
673 			 */
674 			cpu = cpumask_any(cpu_active_mask);
675 		}
676 		later_rq = cpu_rq(cpu);
677 		double_lock_balance(rq, later_rq);
678 	}
679 
680 	if (p->dl.dl_non_contending || p->dl.dl_throttled) {
681 		/*
682 		 * Inactive timer is armed (or callback is running, but
683 		 * waiting for us to release rq locks). In any case, when it
684 		 * will fire (or continue), it will see running_bw of this
685 		 * task migrated to later_rq (and correctly handle it).
686 		 */
687 		sub_running_bw(&p->dl, &rq->dl);
688 		sub_rq_bw(&p->dl, &rq->dl);
689 
690 		add_rq_bw(&p->dl, &later_rq->dl);
691 		add_running_bw(&p->dl, &later_rq->dl);
692 	} else {
693 		sub_rq_bw(&p->dl, &rq->dl);
694 		add_rq_bw(&p->dl, &later_rq->dl);
695 	}
696 
697 	/*
698 	 * And we finally need to fix up root_domain(s) bandwidth accounting,
699 	 * since p is still hanging out in the old (now moved to default) root
700 	 * domain.
701 	 */
702 	dl_b = &rq->rd->dl_bw;
703 	raw_spin_lock(&dl_b->lock);
704 	__dl_sub(dl_b, p->dl.dl_bw, cpumask_weight(rq->rd->span));
705 	raw_spin_unlock(&dl_b->lock);
706 
707 	dl_b = &later_rq->rd->dl_bw;
708 	raw_spin_lock(&dl_b->lock);
709 	__dl_add(dl_b, p->dl.dl_bw, cpumask_weight(later_rq->rd->span));
710 	raw_spin_unlock(&dl_b->lock);
711 
712 	set_task_cpu(p, later_rq->cpu);
713 	double_unlock_balance(later_rq, rq);
714 
715 	return later_rq;
716 }
717 
718 static void
719 enqueue_dl_entity(struct sched_dl_entity *dl_se, int flags);
720 static void enqueue_task_dl(struct rq *rq, struct task_struct *p, int flags);
721 static void dequeue_dl_entity(struct sched_dl_entity *dl_se, int flags);
722 static void wakeup_preempt_dl(struct rq *rq, struct task_struct *p, int flags);
723 
724 static inline void replenish_dl_new_period(struct sched_dl_entity *dl_se,
725 					    struct rq *rq)
726 {
727 	/* for non-boosted task, pi_of(dl_se) == dl_se */
728 	dl_se->deadline = rq_clock(rq) + pi_of(dl_se)->dl_deadline;
729 	dl_se->runtime = pi_of(dl_se)->dl_runtime;
730 
731 	/*
732 	 * If it is a deferred reservation, and the server
733 	 * is not handling an starvation case, defer it.
734 	 */
735 	if (dl_se->dl_defer && !dl_se->dl_defer_running) {
736 		dl_se->dl_throttled = 1;
737 		dl_se->dl_defer_armed = 1;
738 	}
739 	trace_sched_dl_replenish_tp(dl_se, cpu_of(rq), dl_get_type(dl_se, rq));
740 }
741 
742 /*
743  * We are being explicitly informed that a new instance is starting,
744  * and this means that:
745  *  - the absolute deadline of the entity has to be placed at
746  *    current time + relative deadline;
747  *  - the runtime of the entity has to be set to the maximum value.
748  *
749  * The capability of specifying such event is useful whenever a -deadline
750  * entity wants to (try to!) synchronize its behaviour with the scheduler's
751  * one, and to (try to!) reconcile itself with its own scheduling
752  * parameters.
753  */
754 static inline void setup_new_dl_entity(struct sched_dl_entity *dl_se)
755 {
756 	struct dl_rq *dl_rq = dl_rq_of_se(dl_se);
757 	struct rq *rq = rq_of_dl_rq(dl_rq);
758 
759 	WARN_ON(is_dl_boosted(dl_se));
760 	WARN_ON(dl_time_before(rq_clock(rq), dl_se->deadline));
761 
762 	/*
763 	 * We are racing with the deadline timer. So, do nothing because
764 	 * the deadline timer handler will take care of properly recharging
765 	 * the runtime and postponing the deadline
766 	 */
767 	if (dl_se->dl_throttled)
768 		return;
769 
770 	/*
771 	 * We use the regular wall clock time to set deadlines in the
772 	 * future; in fact, we must consider execution overheads (time
773 	 * spent on hardirq context, etc.).
774 	 */
775 	replenish_dl_new_period(dl_se, rq);
776 }
777 
778 static int start_dl_timer(struct sched_dl_entity *dl_se);
779 static bool dl_entity_overflow(struct sched_dl_entity *dl_se, u64 t);
780 
781 /*
782  * Pure Earliest Deadline First (EDF) scheduling does not deal with the
783  * possibility of a entity lasting more than what it declared, and thus
784  * exhausting its runtime.
785  *
786  * Here we are interested in making runtime overrun possible, but we do
787  * not want a entity which is misbehaving to affect the scheduling of all
788  * other entities.
789  * Therefore, a budgeting strategy called Constant Bandwidth Server (CBS)
790  * is used, in order to confine each entity within its own bandwidth.
791  *
792  * This function deals exactly with that, and ensures that when the runtime
793  * of a entity is replenished, its deadline is also postponed. That ensures
794  * the overrunning entity can't interfere with other entity in the system and
795  * can't make them miss their deadlines. Reasons why this kind of overruns
796  * could happen are, typically, a entity voluntarily trying to overcome its
797  * runtime, or it just underestimated it during sched_setattr().
798  */
799 static void replenish_dl_entity(struct sched_dl_entity *dl_se)
800 {
801 	struct dl_rq *dl_rq = dl_rq_of_se(dl_se);
802 	struct rq *rq = rq_of_dl_rq(dl_rq);
803 
804 	WARN_ON_ONCE(pi_of(dl_se)->dl_runtime <= 0);
805 
806 	/*
807 	 * This could be the case for a !-dl task that is boosted.
808 	 * Just go with full inherited parameters.
809 	 *
810 	 * Or, it could be the case of a deferred reservation that
811 	 * was not able to consume its runtime in background and
812 	 * reached this point with current u > U.
813 	 *
814 	 * In both cases, set a new period.
815 	 */
816 	if (dl_se->dl_deadline == 0 ||
817 	    (dl_se->dl_defer_armed && dl_entity_overflow(dl_se, rq_clock(rq)))) {
818 		dl_se->deadline = rq_clock(rq) + pi_of(dl_se)->dl_deadline;
819 		dl_se->runtime = pi_of(dl_se)->dl_runtime;
820 	}
821 
822 	if (dl_se->dl_yielded && dl_se->runtime > 0)
823 		dl_se->runtime = 0;
824 
825 	/*
826 	 * We keep moving the deadline away until we get some
827 	 * available runtime for the entity. This ensures correct
828 	 * handling of situations where the runtime overrun is
829 	 * arbitrary large.
830 	 */
831 	while (dl_se->runtime <= 0) {
832 		dl_se->deadline += pi_of(dl_se)->dl_period;
833 		dl_se->runtime += pi_of(dl_se)->dl_runtime;
834 	}
835 
836 	/*
837 	 * At this point, the deadline really should be "in
838 	 * the future" with respect to rq->clock. If it's
839 	 * not, we are, for some reason, lagging too much!
840 	 * Anyway, after having warn userspace abut that,
841 	 * we still try to keep the things running by
842 	 * resetting the deadline and the budget of the
843 	 * entity.
844 	 */
845 	if (dl_time_before(dl_se->deadline, rq_clock(rq))) {
846 		printk_deferred_once("sched: DL replenish lagged too much\n");
847 		replenish_dl_new_period(dl_se, rq);
848 	}
849 
850 	if (dl_se->dl_yielded)
851 		dl_se->dl_yielded = 0;
852 	if (dl_se->dl_throttled)
853 		dl_se->dl_throttled = 0;
854 
855 	trace_sched_dl_replenish_tp(dl_se, cpu_of(rq), dl_get_type(dl_se, rq));
856 
857 	/*
858 	 * If this is the replenishment of a deferred reservation,
859 	 * clear the flag and return.
860 	 */
861 	if (dl_se->dl_defer_armed) {
862 		dl_se->dl_defer_armed = 0;
863 		return;
864 	}
865 
866 	/*
867 	 * A this point, if the deferred server is not armed, and the deadline
868 	 * is in the future, if it is not running already, throttle the server
869 	 * and arm the defer timer.
870 	 */
871 	if (dl_se->dl_defer && !dl_se->dl_defer_running &&
872 	    dl_time_before(rq_clock(dl_se->rq), dl_se->deadline - dl_se->runtime)) {
873 		if (!is_dl_boosted(dl_se)) {
874 
875 			/*
876 			 * Set dl_se->dl_defer_armed and dl_throttled variables to
877 			 * inform the start_dl_timer() that this is a deferred
878 			 * activation.
879 			 */
880 			dl_se->dl_defer_armed = 1;
881 			dl_se->dl_throttled = 1;
882 			if (!start_dl_timer(dl_se)) {
883 				/*
884 				 * If for whatever reason (delays), a previous timer was
885 				 * queued but not serviced, cancel it and clean the
886 				 * deferrable server variables intended for start_dl_timer().
887 				 */
888 				hrtimer_try_to_cancel(&dl_se->dl_timer);
889 				dl_se->dl_defer_armed = 0;
890 				dl_se->dl_throttled = 0;
891 			}
892 		}
893 	}
894 }
895 
896 /*
897  * Here we check if --at time t-- an entity (which is probably being
898  * [re]activated or, in general, enqueued) can use its remaining runtime
899  * and its current deadline _without_ exceeding the bandwidth it is
900  * assigned (function returns true if it can't). We are in fact applying
901  * one of the CBS rules: when a task wakes up, if the residual runtime
902  * over residual deadline fits within the allocated bandwidth, then we
903  * can keep the current (absolute) deadline and residual budget without
904  * disrupting the schedulability of the system. Otherwise, we should
905  * refill the runtime and set the deadline a period in the future,
906  * because keeping the current (absolute) deadline of the task would
907  * result in breaking guarantees promised to other tasks (refer to
908  * Documentation/scheduler/sched-deadline.rst for more information).
909  *
910  * This function returns true if:
911  *
912  *   runtime / (deadline - t) > dl_runtime / dl_deadline ,
913  *
914  * IOW we can't recycle current parameters.
915  *
916  * Notice that the bandwidth check is done against the deadline. For
917  * task with deadline equal to period this is the same of using
918  * dl_period instead of dl_deadline in the equation above.
919  */
920 static bool dl_entity_overflow(struct sched_dl_entity *dl_se, u64 t)
921 {
922 	u64 left, right;
923 
924 	/*
925 	 * left and right are the two sides of the equation above,
926 	 * after a bit of shuffling to use multiplications instead
927 	 * of divisions.
928 	 *
929 	 * Note that none of the time values involved in the two
930 	 * multiplications are absolute: dl_deadline and dl_runtime
931 	 * are the relative deadline and the maximum runtime of each
932 	 * instance, runtime is the runtime left for the last instance
933 	 * and (deadline - t), since t is rq->clock, is the time left
934 	 * to the (absolute) deadline. Even if overflowing the u64 type
935 	 * is very unlikely to occur in both cases, here we scale down
936 	 * as we want to avoid that risk at all. Scaling down by 10
937 	 * means that we reduce granularity to 1us. We are fine with it,
938 	 * since this is only a true/false check and, anyway, thinking
939 	 * of anything below microseconds resolution is actually fiction
940 	 * (but still we want to give the user that illusion >;).
941 	 */
942 	left = (pi_of(dl_se)->dl_deadline >> DL_SCALE) * (dl_se->runtime >> DL_SCALE);
943 	right = ((dl_se->deadline - t) >> DL_SCALE) *
944 		(pi_of(dl_se)->dl_runtime >> DL_SCALE);
945 
946 	return dl_time_before(right, left);
947 }
948 
949 /*
950  * Revised wakeup rule [1]: For self-suspending tasks, rather then
951  * re-initializing task's runtime and deadline, the revised wakeup
952  * rule adjusts the task's runtime to avoid the task to overrun its
953  * density.
954  *
955  * Reasoning: a task may overrun the density if:
956  *    runtime / (deadline - t) > dl_runtime / dl_deadline
957  *
958  * Therefore, runtime can be adjusted to:
959  *     runtime = (dl_runtime / dl_deadline) * (deadline - t)
960  *
961  * In such way that runtime will be equal to the maximum density
962  * the task can use without breaking any rule.
963  *
964  * [1] Luca Abeni, Giuseppe Lipari, and Juri Lelli. 2015. Constant
965  * bandwidth server revisited. SIGBED Rev. 11, 4 (January 2015), 19-24.
966  */
967 static void
968 update_dl_revised_wakeup(struct sched_dl_entity *dl_se, struct rq *rq)
969 {
970 	u64 laxity = dl_se->deadline - rq_clock(rq);
971 
972 	/*
973 	 * If the task has deadline < period, and the deadline is in the past,
974 	 * it should already be throttled before this check.
975 	 *
976 	 * See update_dl_entity() comments for further details.
977 	 */
978 	WARN_ON(dl_time_before(dl_se->deadline, rq_clock(rq)));
979 
980 	dl_se->runtime = (dl_se->dl_density * laxity) >> BW_SHIFT;
981 }
982 
983 /*
984  * When a deadline entity is placed in the runqueue, its runtime and deadline
985  * might need to be updated. This is done by a CBS wake up rule. There are two
986  * different rules: 1) the original CBS; and 2) the Revisited CBS.
987  *
988  * When the task is starting a new period, the Original CBS is used. In this
989  * case, the runtime is replenished and a new absolute deadline is set.
990  *
991  * When a task is queued before the begin of the next period, using the
992  * remaining runtime and deadline could make the entity to overflow, see
993  * dl_entity_overflow() to find more about runtime overflow. When such case
994  * is detected, the runtime and deadline need to be updated.
995  *
996  * If the task has an implicit deadline, i.e., deadline == period, the Original
997  * CBS is applied. The runtime is replenished and a new absolute deadline is
998  * set, as in the previous cases.
999  *
1000  * However, the Original CBS does not work properly for tasks with
1001  * deadline < period, which are said to have a constrained deadline. By
1002  * applying the Original CBS, a constrained deadline task would be able to run
1003  * runtime/deadline in a period. With deadline < period, the task would
1004  * overrun the runtime/period allowed bandwidth, breaking the admission test.
1005  *
1006  * In order to prevent this misbehave, the Revisited CBS is used for
1007  * constrained deadline tasks when a runtime overflow is detected. In the
1008  * Revisited CBS, rather than replenishing & setting a new absolute deadline,
1009  * the remaining runtime of the task is reduced to avoid runtime overflow.
1010  * Please refer to the comments update_dl_revised_wakeup() function to find
1011  * more about the Revised CBS rule.
1012  */
1013 static void update_dl_entity(struct sched_dl_entity *dl_se)
1014 {
1015 	struct rq *rq = rq_of_dl_se(dl_se);
1016 
1017 	if (dl_time_before(dl_se->deadline, rq_clock(rq)) ||
1018 	    dl_entity_overflow(dl_se, rq_clock(rq))) {
1019 
1020 		if (unlikely((!dl_is_implicit(dl_se) || dl_se->dl_defer) &&
1021 			     !dl_time_before(dl_se->deadline, rq_clock(rq)) &&
1022 			     !is_dl_boosted(dl_se))) {
1023 			update_dl_revised_wakeup(dl_se, rq);
1024 			return;
1025 		}
1026 
1027 		/*
1028 		 * When [4] D->A is followed by [1] A->B, dl_defer_running
1029 		 * needs to be cleared, otherwise it will fail to properly
1030 		 * start the zero-laxity timer.
1031 		 */
1032 		dl_se->dl_defer_running = 0;
1033 		replenish_dl_new_period(dl_se, rq);
1034 	} else if (dl_server(dl_se) && dl_se->dl_defer) {
1035 		/*
1036 		 * The server can still use its previous deadline, so check if
1037 		 * it left the dl_defer_running state.
1038 		 */
1039 		if (!dl_se->dl_defer_running) {
1040 			dl_se->dl_defer_armed = 1;
1041 			dl_se->dl_throttled = 1;
1042 		}
1043 	}
1044 }
1045 
1046 static inline u64 dl_next_period(struct sched_dl_entity *dl_se)
1047 {
1048 	return dl_se->deadline - dl_se->dl_deadline + dl_se->dl_period;
1049 }
1050 
1051 /*
1052  * If the entity depleted all its runtime, and if we want it to sleep
1053  * while waiting for some new execution time to become available, we
1054  * set the bandwidth replenishment timer to the replenishment instant
1055  * and try to activate it.
1056  *
1057  * Notice that it is important for the caller to know if the timer
1058  * actually started or not (i.e., the replenishment instant is in
1059  * the future or in the past).
1060  */
1061 static int start_dl_timer(struct sched_dl_entity *dl_se)
1062 {
1063 	struct hrtimer *timer = &dl_se->dl_timer;
1064 	struct dl_rq *dl_rq = dl_rq_of_se(dl_se);
1065 	struct rq *rq = rq_of_dl_rq(dl_rq);
1066 	ktime_t now, act;
1067 	s64 delta;
1068 
1069 	lockdep_assert_rq_held(rq);
1070 
1071 	/*
1072 	 * We want the timer to fire at the deadline, but considering
1073 	 * that it is actually coming from rq->clock and not from
1074 	 * hrtimer's time base reading.
1075 	 *
1076 	 * The deferred reservation will have its timer set to
1077 	 * (deadline - runtime). At that point, the CBS rule will decide
1078 	 * if the current deadline can be used, or if a replenishment is
1079 	 * required to avoid add too much pressure on the system
1080 	 * (current u > U).
1081 	 */
1082 	if (dl_se->dl_defer_armed) {
1083 		WARN_ON_ONCE(!dl_se->dl_throttled);
1084 		act = ns_to_ktime(dl_se->deadline - dl_se->runtime);
1085 	} else {
1086 		/* act = deadline - rel-deadline + period */
1087 		act = ns_to_ktime(dl_next_period(dl_se));
1088 	}
1089 
1090 	now = ktime_get();
1091 	delta = ktime_to_ns(now) - rq_clock(rq);
1092 	act = ktime_add_ns(act, delta);
1093 
1094 	/*
1095 	 * If the expiry time already passed, e.g., because the value
1096 	 * chosen as the deadline is too small, don't even try to
1097 	 * start the timer in the past!
1098 	 */
1099 	if (ktime_us_delta(act, now) < 0)
1100 		return 0;
1101 
1102 	/*
1103 	 * !enqueued will guarantee another callback; even if one is already in
1104 	 * progress. This ensures a balanced {get,put}_task_struct().
1105 	 *
1106 	 * The race against __run_timer() clearing the enqueued state is
1107 	 * harmless because we're holding task_rq()->lock, therefore the timer
1108 	 * expiring after we've done the check will wait on its task_rq_lock()
1109 	 * and observe our state.
1110 	 */
1111 	if (!hrtimer_is_queued(timer)) {
1112 		if (!dl_server(dl_se))
1113 			get_task_struct(dl_task_of(dl_se));
1114 		hrtimer_start(timer, act, HRTIMER_MODE_ABS_HARD);
1115 	}
1116 
1117 	return 1;
1118 }
1119 
1120 static void __push_dl_task(struct rq *rq, struct rq_flags *rf)
1121 {
1122 	/*
1123 	 * Queueing this task back might have overloaded rq, check if we need
1124 	 * to kick someone away.
1125 	 */
1126 	if (has_pushable_dl_tasks(rq)) {
1127 		/*
1128 		 * Nothing relies on rq->lock after this, so its safe to drop
1129 		 * rq->lock.
1130 		 */
1131 		rq_unpin_lock(rq, rf);
1132 		push_dl_task(rq);
1133 		rq_repin_lock(rq, rf);
1134 	}
1135 }
1136 
1137 /* a defer timer will not be reset if the runtime consumed was < dl_server_min_res */
1138 static const u64 dl_server_min_res = 1 * NSEC_PER_MSEC;
1139 
1140 static enum hrtimer_restart dl_server_timer(struct hrtimer *timer, struct sched_dl_entity *dl_se)
1141 {
1142 	struct rq *rq = rq_of_dl_se(dl_se);
1143 	u64 fw;
1144 
1145 	scoped_guard (rq_lock, rq) {
1146 		struct rq_flags *rf = &scope.rf;
1147 
1148 		if (!dl_se->dl_throttled || !dl_se->dl_runtime)
1149 			return HRTIMER_NORESTART;
1150 
1151 		sched_clock_tick();
1152 		update_rq_clock(rq);
1153 
1154 		/*
1155 		 * Make sure current has propagated its pending runtime into
1156 		 * any relevant server through calling dl_server_update() and
1157 		 * friends.
1158 		 */
1159 		rq->donor->sched_class->update_curr(rq);
1160 
1161 		if (dl_se->dl_defer_idle) {
1162 			dl_server_stop(dl_se);
1163 			return HRTIMER_NORESTART;
1164 		}
1165 
1166 		if (dl_se->dl_defer_armed) {
1167 			/*
1168 			 * First check if the server could consume runtime in background.
1169 			 * If so, it is possible to push the defer timer for this amount
1170 			 * of time. The dl_server_min_res serves as a limit to avoid
1171 			 * forwarding the timer for a too small amount of time.
1172 			 */
1173 			if (dl_time_before(rq_clock(dl_se->rq),
1174 					   (dl_se->deadline - dl_se->runtime - dl_server_min_res))) {
1175 
1176 				/* reset the defer timer */
1177 				fw = dl_se->deadline - rq_clock(dl_se->rq) - dl_se->runtime;
1178 
1179 				hrtimer_forward_now(timer, ns_to_ktime(fw));
1180 				return HRTIMER_RESTART;
1181 			}
1182 
1183 			dl_se->dl_defer_running = 1;
1184 		}
1185 
1186 		enqueue_dl_entity(dl_se, ENQUEUE_REPLENISH);
1187 
1188 		if (!dl_task(dl_se->rq->curr) || dl_entity_preempt(dl_se, &dl_se->rq->curr->dl))
1189 			resched_curr(rq);
1190 
1191 		__push_dl_task(rq, rf);
1192 	}
1193 
1194 	return HRTIMER_NORESTART;
1195 }
1196 
1197 /*
1198  * This is the bandwidth enforcement timer callback. If here, we know
1199  * a task is not on its dl_rq, since the fact that the timer was running
1200  * means the task is throttled and needs a runtime replenishment.
1201  *
1202  * However, what we actually do depends on the fact the task is active,
1203  * (it is on its rq) or has been removed from there by a call to
1204  * dequeue_task_dl(). In the former case we must issue the runtime
1205  * replenishment and add the task back to the dl_rq; in the latter, we just
1206  * do nothing but clearing dl_throttled, so that runtime and deadline
1207  * updating (and the queueing back to dl_rq) will be done by the
1208  * next call to enqueue_task_dl().
1209  */
1210 static enum hrtimer_restart dl_task_timer(struct hrtimer *timer)
1211 {
1212 	struct sched_dl_entity *dl_se = container_of(timer,
1213 						     struct sched_dl_entity,
1214 						     dl_timer);
1215 	struct task_struct *p;
1216 	struct rq_flags rf;
1217 	struct rq *rq;
1218 
1219 	if (dl_server(dl_se))
1220 		return dl_server_timer(timer, dl_se);
1221 
1222 	p = dl_task_of(dl_se);
1223 	rq = task_rq_lock(p, &rf);
1224 
1225 	/*
1226 	 * The task might have changed its scheduling policy to something
1227 	 * different than SCHED_DEADLINE (through switched_from_dl()).
1228 	 */
1229 	if (!dl_task(p))
1230 		goto unlock;
1231 
1232 	/*
1233 	 * The task might have been boosted by someone else and might be in the
1234 	 * boosting/deboosting path, its not throttled.
1235 	 */
1236 	if (is_dl_boosted(dl_se))
1237 		goto unlock;
1238 
1239 	/*
1240 	 * Spurious timer due to start_dl_timer() race; or we already received
1241 	 * a replenishment from rt_mutex_setprio().
1242 	 */
1243 	if (!dl_se->dl_throttled)
1244 		goto unlock;
1245 
1246 	sched_clock_tick();
1247 	update_rq_clock(rq);
1248 
1249 	/*
1250 	 * If the throttle happened during sched-out; like:
1251 	 *
1252 	 *   schedule()
1253 	 *     deactivate_task()
1254 	 *       dequeue_task_dl()
1255 	 *         update_curr_dl()
1256 	 *           start_dl_timer()
1257 	 *         __dequeue_task_dl()
1258 	 *     prev->on_rq = 0;
1259 	 *
1260 	 * We can be both throttled and !queued. Replenish the counter
1261 	 * but do not enqueue -- wait for our wakeup to do that.
1262 	 */
1263 	if (!task_on_rq_queued(p)) {
1264 		replenish_dl_entity(dl_se);
1265 		goto unlock;
1266 	}
1267 
1268 	if (unlikely(!rq->online)) {
1269 		/*
1270 		 * If the runqueue is no longer available, migrate the
1271 		 * task elsewhere. This necessarily changes rq.
1272 		 */
1273 		lockdep_unpin_lock(__rq_lockp(rq), rf.cookie);
1274 		rq = dl_task_offline_migration(rq, p);
1275 		rf.cookie = lockdep_pin_lock(__rq_lockp(rq));
1276 		update_rq_clock(rq);
1277 
1278 		/*
1279 		 * Now that the task has been migrated to the new RQ and we
1280 		 * have that locked, proceed as normal and enqueue the task
1281 		 * there.
1282 		 */
1283 	}
1284 
1285 	enqueue_task_dl(rq, p, ENQUEUE_REPLENISH);
1286 	if (dl_task(rq->donor))
1287 		wakeup_preempt_dl(rq, p, 0);
1288 	else
1289 		resched_curr(rq);
1290 
1291 	__push_dl_task(rq, &rf);
1292 
1293 unlock:
1294 	task_rq_unlock(rq, p, &rf);
1295 
1296 	/*
1297 	 * This can free the task_struct, including this hrtimer, do not touch
1298 	 * anything related to that after this.
1299 	 */
1300 	put_task_struct(p);
1301 
1302 	return HRTIMER_NORESTART;
1303 }
1304 
1305 static void init_dl_task_timer(struct sched_dl_entity *dl_se)
1306 {
1307 	struct hrtimer *timer = &dl_se->dl_timer;
1308 
1309 	hrtimer_setup(timer, dl_task_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL_HARD);
1310 }
1311 
1312 /*
1313  * During the activation, CBS checks if it can reuse the current task's
1314  * runtime and period. If the deadline of the task is in the past, CBS
1315  * cannot use the runtime, and so it replenishes the task. This rule
1316  * works fine for implicit deadline tasks (deadline == period), and the
1317  * CBS was designed for implicit deadline tasks. However, a task with
1318  * constrained deadline (deadline < period) might be awakened after the
1319  * deadline, but before the next period. In this case, replenishing the
1320  * task would allow it to run for runtime / deadline. As in this case
1321  * deadline < period, CBS enables a task to run for more than the
1322  * runtime / period. In a very loaded system, this can cause a domino
1323  * effect, making other tasks miss their deadlines.
1324  *
1325  * To avoid this problem, in the activation of a constrained deadline
1326  * task after the deadline but before the next period, throttle the
1327  * task and set the replenishing timer to the begin of the next period,
1328  * unless it is boosted.
1329  */
1330 static inline void dl_check_constrained_dl(struct sched_dl_entity *dl_se)
1331 {
1332 	struct rq *rq = rq_of_dl_se(dl_se);
1333 
1334 	if (dl_time_before(dl_se->deadline, rq_clock(rq)) &&
1335 	    dl_time_before(rq_clock(rq), dl_next_period(dl_se))) {
1336 		if (unlikely(is_dl_boosted(dl_se) || !start_dl_timer(dl_se)))
1337 			return;
1338 		trace_sched_dl_throttle_tp(dl_se, cpu_of(rq), dl_get_type(dl_se, rq));
1339 		dl_se->dl_throttled = 1;
1340 		if (dl_se->runtime > 0)
1341 			dl_se->runtime = 0;
1342 	}
1343 }
1344 
1345 static
1346 int dl_runtime_exceeded(struct sched_dl_entity *dl_se)
1347 {
1348 	return (dl_se->runtime <= 0);
1349 }
1350 
1351 /*
1352  * This function implements the GRUB accounting rule. According to the
1353  * GRUB reclaiming algorithm, the runtime is not decreased as "dq = -dt",
1354  * but as "dq = -(max{u, (Umax - Uinact - Uextra)} / Umax) dt",
1355  * where u is the utilization of the task, Umax is the maximum reclaimable
1356  * utilization, Uinact is the (per-runqueue) inactive utilization, computed
1357  * as the difference between the "total runqueue utilization" and the
1358  * "runqueue active utilization", and Uextra is the (per runqueue) extra
1359  * reclaimable utilization.
1360  * Since rq->dl.running_bw and rq->dl.this_bw contain utilizations multiplied
1361  * by 2^BW_SHIFT, the result has to be shifted right by BW_SHIFT.
1362  * Since rq->dl.bw_ratio contains 1 / Umax multiplied by 2^RATIO_SHIFT, dl_bw
1363  * is multiplied by rq->dl.bw_ratio and shifted right by RATIO_SHIFT.
1364  * Since delta is a 64 bit variable, to have an overflow its value should be
1365  * larger than 2^(64 - 20 - 8), which is more than 64 seconds. So, overflow is
1366  * not an issue here.
1367  */
1368 static u64 grub_reclaim(u64 delta, struct rq *rq, struct sched_dl_entity *dl_se)
1369 {
1370 	u64 u_act;
1371 	u64 u_inact = rq->dl.this_bw - rq->dl.running_bw; /* Utot - Uact */
1372 
1373 	/*
1374 	 * Instead of computing max{u, (u_max - u_inact - u_extra)}, we
1375 	 * compare u_inact + u_extra with u_max - u, because u_inact + u_extra
1376 	 * can be larger than u_max. So, u_max - u_inact - u_extra would be
1377 	 * negative leading to wrong results.
1378 	 */
1379 	if (u_inact + rq->dl.extra_bw > rq->dl.max_bw - dl_se->dl_bw)
1380 		u_act = dl_se->dl_bw;
1381 	else
1382 		u_act = rq->dl.max_bw - u_inact - rq->dl.extra_bw;
1383 
1384 	u_act = (u_act * rq->dl.bw_ratio) >> RATIO_SHIFT;
1385 	return (delta * u_act) >> BW_SHIFT;
1386 }
1387 
1388 s64 dl_scaled_delta_exec(struct rq *rq, struct sched_dl_entity *dl_se, s64 delta_exec)
1389 {
1390 	s64 scaled_delta_exec;
1391 
1392 	/*
1393 	 * For tasks that participate in GRUB, we implement GRUB-PA: the
1394 	 * spare reclaimed bandwidth is used to clock down frequency.
1395 	 *
1396 	 * For the others, we still need to scale reservation parameters
1397 	 * according to current frequency and CPU maximum capacity.
1398 	 */
1399 	if (unlikely(dl_se->flags & SCHED_FLAG_RECLAIM)) {
1400 		scaled_delta_exec = grub_reclaim(delta_exec, rq, dl_se);
1401 	} else {
1402 		int cpu = cpu_of(rq);
1403 		unsigned long scale_freq = arch_scale_freq_capacity(cpu);
1404 		unsigned long scale_cpu = arch_scale_cpu_capacity(cpu);
1405 
1406 		scaled_delta_exec = cap_scale(delta_exec, scale_freq);
1407 		scaled_delta_exec = cap_scale(scaled_delta_exec, scale_cpu);
1408 	}
1409 
1410 	return scaled_delta_exec;
1411 }
1412 
1413 static inline void
1414 update_stats_dequeue_dl(struct dl_rq *dl_rq, struct sched_dl_entity *dl_se, int flags);
1415 
1416 static void update_curr_dl_se(struct rq *rq, struct sched_dl_entity *dl_se, s64 delta_exec)
1417 {
1418 	bool idle = idle_rq(rq);
1419 	s64 scaled_delta_exec;
1420 
1421 	if (unlikely(delta_exec <= 0)) {
1422 		if (unlikely(dl_se->dl_yielded))
1423 			goto throttle;
1424 		return;
1425 	}
1426 
1427 	if (dl_server(dl_se) && dl_se->dl_throttled && !dl_se->dl_defer)
1428 		return;
1429 
1430 	if (dl_entity_is_special(dl_se))
1431 		return;
1432 
1433 	scaled_delta_exec = delta_exec;
1434 	if (!dl_server(dl_se))
1435 		scaled_delta_exec = dl_scaled_delta_exec(rq, dl_se, delta_exec);
1436 
1437 	dl_se->runtime -= scaled_delta_exec;
1438 
1439 	if (dl_se->dl_defer_idle && !idle)
1440 		dl_se->dl_defer_idle = 0;
1441 
1442 	/*
1443 	 * The DL server can consume its runtime while throttled (not
1444 	 * queued / running as regular CFS).
1445 	 *
1446 	 * If the server consumes its entire runtime in this state. The server
1447 	 * is not required for the current period. Thus, reset the server by
1448 	 * starting a new period, pushing the activation.
1449 	 */
1450 	if (dl_se->dl_defer && dl_se->dl_throttled && dl_runtime_exceeded(dl_se)) {
1451 		/*
1452 		 * Non-servers would never get time accounted while throttled.
1453 		 */
1454 		WARN_ON_ONCE(!dl_server(dl_se));
1455 
1456 		/*
1457 		 * While the server is marked idle, do not push out the
1458 		 * activation further, instead wait for the period timer
1459 		 * to lapse and stop the server.
1460 		 */
1461 		if (dl_se->dl_defer_idle && idle) {
1462 			/*
1463 			 * The timer is at the zero-laxity point, this means
1464 			 * dl_server_stop() / dl_server_start() can happen
1465 			 * while now < deadline. This means update_dl_entity()
1466 			 * will not replenish. Additionally start_dl_timer()
1467 			 * will be set for 'deadline - runtime'. Negative
1468 			 * runtime will not do.
1469 			 */
1470 			dl_se->runtime = 0;
1471 			return;
1472 		}
1473 
1474 		/*
1475 		 * If the server was previously activated - the starving condition
1476 		 * took place, it this point it went away because the fair scheduler
1477 		 * was able to get runtime in background. So return to the initial
1478 		 * state.
1479 		 */
1480 		dl_se->dl_defer_running = 0;
1481 
1482 		hrtimer_try_to_cancel(&dl_se->dl_timer);
1483 
1484 		replenish_dl_new_period(dl_se, dl_se->rq);
1485 
1486 		if (idle)
1487 			dl_se->dl_defer_idle = 1;
1488 
1489 		/*
1490 		 * Not being able to start the timer seems problematic. If it could not
1491 		 * be started for whatever reason, we need to "unthrottle" the DL server
1492 		 * and queue right away. Otherwise nothing might queue it. That's similar
1493 		 * to what enqueue_dl_entity() does on start_dl_timer==0. For now, just warn.
1494 		 */
1495 		WARN_ON_ONCE(!start_dl_timer(dl_se));
1496 
1497 		return;
1498 	}
1499 
1500 throttle:
1501 	if (dl_runtime_exceeded(dl_se) || dl_se->dl_yielded) {
1502 		trace_sched_dl_throttle_tp(dl_se, cpu_of(rq), dl_get_type(dl_se, rq));
1503 		dl_se->dl_throttled = 1;
1504 
1505 		/* If requested, inform the user about runtime overruns. */
1506 		if (dl_runtime_exceeded(dl_se) &&
1507 		    (dl_se->flags & SCHED_FLAG_DL_OVERRUN))
1508 			dl_se->dl_overrun = 1;
1509 
1510 		dequeue_dl_entity(dl_se, 0);
1511 		if (!dl_server(dl_se)) {
1512 			update_stats_dequeue_dl(&rq->dl, dl_se, 0);
1513 			dequeue_pushable_dl_task(rq, dl_task_of(dl_se));
1514 		}
1515 
1516 		if (unlikely(is_dl_boosted(dl_se) || !start_dl_timer(dl_se))) {
1517 			if (dl_server(dl_se)) {
1518 				if (dl_se->dl_defer) {
1519 					replenish_dl_new_period(dl_se, rq);
1520 					start_dl_timer(dl_se);
1521 				} else {
1522 					enqueue_dl_entity(dl_se, ENQUEUE_REPLENISH);
1523 				}
1524 			} else {
1525 				enqueue_task_dl(rq, dl_task_of(dl_se), ENQUEUE_REPLENISH);
1526 			}
1527 		}
1528 
1529 		if (!is_leftmost(dl_se, &rq->dl))
1530 			resched_curr(rq);
1531 	} else {
1532 		trace_sched_dl_update_tp(dl_se, cpu_of(rq), dl_get_type(dl_se, rq));
1533 	}
1534 
1535 	/*
1536 	 * The dl_server does not account for real-time workload because it
1537 	 * is running fair work.
1538 	 */
1539 	if (dl_se->dl_server)
1540 		return;
1541 
1542 #ifdef CONFIG_RT_GROUP_SCHED
1543 	/*
1544 	 * Because -- for now -- we share the rt bandwidth, we need to
1545 	 * account our runtime there too, otherwise actual rt tasks
1546 	 * would be able to exceed the shared quota.
1547 	 *
1548 	 * Account to the root rt group for now.
1549 	 *
1550 	 * The solution we're working towards is having the RT groups scheduled
1551 	 * using deadline servers -- however there's a few nasties to figure
1552 	 * out before that can happen.
1553 	 */
1554 	if (rt_bandwidth_enabled()) {
1555 		struct rt_rq *rt_rq = &rq->rt;
1556 
1557 		raw_spin_lock(&rt_rq->rt_runtime_lock);
1558 		/*
1559 		 * We'll let actual RT tasks worry about the overflow here, we
1560 		 * have our own CBS to keep us inline; only account when RT
1561 		 * bandwidth is relevant.
1562 		 */
1563 		if (sched_rt_bandwidth_account(rt_rq))
1564 			rt_rq->rt_time += delta_exec;
1565 		raw_spin_unlock(&rt_rq->rt_runtime_lock);
1566 	}
1567 #endif /* CONFIG_RT_GROUP_SCHED */
1568 }
1569 
1570 /*
1571  * In the non-defer mode, the idle time is not accounted, as the
1572  * server provides a guarantee.
1573  *
1574  * If the dl_server is in defer mode, the idle time is also considered as
1575  * time available for the dl_server, avoiding a penalty for the rt
1576  * scheduler that did not consumed that time.
1577  */
1578 void dl_server_update_idle(struct sched_dl_entity *dl_se, s64 delta_exec)
1579 {
1580 	if (dl_se->dl_server_active && dl_se->dl_runtime && dl_se->dl_defer)
1581 		update_curr_dl_se(dl_se->rq, dl_se, delta_exec);
1582 }
1583 
1584 void dl_server_update(struct sched_dl_entity *dl_se, s64 delta_exec)
1585 {
1586 	/* 0 runtime = fair server disabled */
1587 	if (dl_se->dl_server_active && dl_se->dl_runtime)
1588 		update_curr_dl_se(dl_se->rq, dl_se, delta_exec);
1589 }
1590 
1591 /*
1592  * dl_server && dl_defer:
1593  *
1594  *                                        6
1595  *                            +--------------------+
1596  *                            v                    |
1597  *     +-------------+  4   +-----------+  5     +------------------+
1598  * +-> |   A:init    | <--- | D:running | -----> | E:replenish-wait |
1599  * |   +-------------+      +-----------+        +------------------+
1600  * |     |         |    1     ^    ^               |
1601  * |     | 1       +----------+    | 3             |
1602  * |     v                         |               |
1603  * |   +--------------------------------+   2      |
1604  * |   |                                | ----+    |
1605  * | 8 |       B:zero_laxity-wait       |     |    |
1606  * |   |                                | <---+    |
1607  * |   +--------------------------------+          |
1608  * |     |              ^         ^       2        |
1609  * |     | 7            | 2, 1    +----------------+
1610  * |     v              |
1611  * |   +-------------+  |
1612  * +-- | C:idle-wait | -+
1613  *     +-------------+
1614  *       ^ 7       |
1615  *       +---------+
1616  *
1617  *
1618  * [A] - init
1619  *   dl_server_active = 0
1620  *   dl_throttled = 0
1621  *   dl_defer_armed = 0
1622  *   dl_defer_running = 0/1
1623  *   dl_defer_idle = 0
1624  *
1625  * [B] - zero_laxity-wait
1626  *   dl_server_active = 1
1627  *   dl_throttled = 1
1628  *   dl_defer_armed = 1
1629  *   dl_defer_running = 0
1630  *   dl_defer_idle = 0
1631  *
1632  * [C] - idle-wait
1633  *   dl_server_active = 1
1634  *   dl_throttled = 1
1635  *   dl_defer_armed = 1
1636  *   dl_defer_running = 0
1637  *   dl_defer_idle = 1
1638  *
1639  * [D] - running
1640  *   dl_server_active = 1
1641  *   dl_throttled = 0
1642  *   dl_defer_armed = 0
1643  *   dl_defer_running = 1
1644  *   dl_defer_idle = 0
1645  *
1646  * [E] - replenish-wait
1647  *   dl_server_active = 1
1648  *   dl_throttled = 1
1649  *   dl_defer_armed = 0
1650  *   dl_defer_running = 1
1651  *   dl_defer_idle = 0
1652  *
1653  *
1654  * [1] A->B, A->D, C->B
1655  * dl_server_start()
1656  *   dl_defer_idle = 0;
1657  *   if (dl_server_active)
1658  *     return; // [B]
1659  *   dl_server_active = 1;
1660  *   enqueue_dl_entity()
1661  *     update_dl_entity(WAKEUP)
1662  *       if (dl_time_before() || dl_entity_overflow())
1663  *         dl_defer_running = 0;
1664  *         replenish_dl_new_period();
1665  *           // fwd period
1666  *           dl_throttled = 1;
1667  *           dl_defer_armed = 1;
1668  *       if (!dl_defer_running)
1669  *         dl_defer_armed = 1;
1670  *         dl_throttled = 1;
1671  *     if (dl_throttled && start_dl_timer())
1672  *       return; // [B]
1673  *     __enqueue_dl_entity();
1674  *     // [D]
1675  *
1676  * // deplete server runtime from client-class
1677  * [2] B->B, C->B, E->B
1678  * dl_server_update()
1679  *   update_curr_dl_se() // idle = false
1680  *     if (dl_defer_idle)
1681  *       dl_defer_idle = 0;
1682  *     if (dl_defer && dl_throttled && dl_runtime_exceeded())
1683  *       dl_defer_running = 0;
1684  *       hrtimer_try_to_cancel();   // stop timer
1685  *       replenish_dl_new_period()
1686  *         // fwd period
1687  *         dl_throttled = 1;
1688  *         dl_defer_armed = 1;
1689  *       start_dl_timer();        // restart timer
1690  *       // [B]
1691  *
1692  * // timer actually fires means we have runtime
1693  * [3] B->D
1694  * dl_server_timer()
1695  *   if (dl_defer_armed)
1696  *     dl_defer_running = 1;
1697  *   enqueue_dl_entity(REPLENISH)
1698  *     replenish_dl_entity()
1699  *       // fwd period
1700  *       if (dl_throttled)
1701  *         dl_throttled = 0;
1702  *       if (dl_defer_armed)
1703  *         dl_defer_armed = 0;
1704  *     __enqueue_dl_entity();
1705  *     // [D]
1706  *
1707  * // schedule server
1708  * [4] D->A
1709  * pick_task_dl()
1710  *   p = server_pick_task();
1711  *   if (!p)
1712  *     dl_server_stop()
1713  *       dequeue_dl_entity();
1714  *       hrtimer_try_to_cancel();
1715  *       dl_defer_armed = 0;
1716  *       dl_throttled = 0;
1717  *       dl_server_active = 0;
1718  *       // [A]
1719  *   return p;
1720  *
1721  * // server running
1722  * [5] D->E
1723  * update_curr_dl_se()
1724  *   if (dl_runtime_exceeded())
1725  *     dl_throttled = 1;
1726  *     dequeue_dl_entity();
1727  *     start_dl_timer();
1728  *     // [E]
1729  *
1730  * // server replenished
1731  * [6] E->D
1732  * dl_server_timer()
1733  *   enqueue_dl_entity(REPLENISH)
1734  *     replenish_dl_entity()
1735  *       fwd-period
1736  *       if (dl_throttled)
1737  *         dl_throttled = 0;
1738  *     __enqueue_dl_entity();
1739  *     // [D]
1740  *
1741  * // deplete server runtime from idle
1742  * [7] B->C, C->C
1743  * dl_server_update_idle()
1744  *   update_curr_dl_se() // idle = true
1745  *     if (dl_defer && dl_throttled && dl_runtime_exceeded())
1746  *       if (dl_defer_idle)
1747  *         return;
1748  *       dl_defer_running = 0;
1749  *       hrtimer_try_to_cancel();
1750  *       replenish_dl_new_period()
1751  *         // fwd period
1752  *         dl_throttled = 1;
1753  *         dl_defer_armed = 1;
1754  *       dl_defer_idle = 1;
1755  *       start_dl_timer();        // restart timer
1756  *       // [C]
1757  *
1758  * // stop idle server
1759  * [8] C->A
1760  * dl_server_timer()
1761  *   if (dl_defer_idle)
1762  *     dl_server_stop();
1763  *     // [A]
1764  *
1765  *
1766  * digraph dl_server {
1767  *   "A:init" -> "B:zero_laxity-wait"             [label="1:dl_server_start"]
1768  *   "A:init" -> "D:running"                      [label="1:dl_server_start"]
1769  *   "B:zero_laxity-wait" -> "B:zero_laxity-wait" [label="2:dl_server_update"]
1770  *   "B:zero_laxity-wait" -> "C:idle-wait"        [label="7:dl_server_update_idle"]
1771  *   "B:zero_laxity-wait" -> "D:running"          [label="3:dl_server_timer"]
1772  *   "C:idle-wait" -> "A:init"                    [label="8:dl_server_timer"]
1773  *   "C:idle-wait" -> "B:zero_laxity-wait"        [label="1:dl_server_start"]
1774  *   "C:idle-wait" -> "B:zero_laxity-wait"        [label="2:dl_server_update"]
1775  *   "C:idle-wait" -> "C:idle-wait"               [label="7:dl_server_update_idle"]
1776  *   "D:running" -> "A:init"                      [label="4:pick_task_dl"]
1777  *   "D:running" -> "E:replenish-wait"            [label="5:update_curr_dl_se"]
1778  *   "E:replenish-wait" -> "B:zero_laxity-wait"   [label="2:dl_server_update"]
1779  *   "E:replenish-wait" -> "D:running"            [label="6:dl_server_timer"]
1780  * }
1781  *
1782  *
1783  * Notes:
1784  *
1785  *  - When there are fair tasks running the most likely loop is [2]->[2].
1786  *    the dl_server never actually runs, the timer never fires.
1787  *
1788  *  - When there is actual fair starvation; the timer fires and starts the
1789  *    dl_server. This will then throttle and replenish like a normal DL
1790  *    task. Notably it will not 'defer' again.
1791  *
1792  *  - When idle it will push the actication forward once, and then wait
1793  *    for the timer to hit or a non-idle update to restart things.
1794  */
1795 void dl_server_start(struct sched_dl_entity *dl_se)
1796 {
1797 	struct rq *rq = dl_se->rq;
1798 
1799 	dl_se->dl_defer_idle = 0;
1800 	if (!dl_server(dl_se) || dl_se->dl_server_active || !dl_se->dl_runtime ||
1801 	    !dl_se->dl_bw_attached)
1802 		return;
1803 
1804 	/*
1805 	 * Update the current task to 'now'.
1806 	 */
1807 	rq->donor->sched_class->update_curr(rq);
1808 
1809 	if (WARN_ON_ONCE(!cpu_online(cpu_of(rq))))
1810 		return;
1811 
1812 	trace_sched_dl_server_start_tp(dl_se, cpu_of(rq), dl_get_type(dl_se, rq));
1813 	dl_se->dl_server_active = 1;
1814 	enqueue_dl_entity(dl_se, ENQUEUE_WAKEUP);
1815 	if (!dl_task(dl_se->rq->curr) || dl_entity_preempt(dl_se, &rq->curr->dl))
1816 		resched_curr(dl_se->rq);
1817 }
1818 
1819 void dl_server_stop(struct sched_dl_entity *dl_se)
1820 {
1821 	if (!dl_server(dl_se) || !dl_server_active(dl_se))
1822 		return;
1823 
1824 	trace_sched_dl_server_stop_tp(dl_se, cpu_of(dl_se->rq),
1825 				      dl_get_type(dl_se, dl_se->rq));
1826 	dequeue_dl_entity(dl_se, DEQUEUE_SLEEP);
1827 	hrtimer_try_to_cancel(&dl_se->dl_timer);
1828 	dl_se->dl_defer_armed = 0;
1829 	dl_se->dl_throttled = 0;
1830 	dl_se->dl_defer_idle = 0;
1831 	dl_se->dl_server_active = 0;
1832 }
1833 
1834 void dl_server_init(struct sched_dl_entity *dl_se, struct rq *rq,
1835 		    dl_server_pick_f pick_task)
1836 {
1837 	dl_se->rq = rq;
1838 	dl_se->server_pick_task = pick_task;
1839 }
1840 
1841 void sched_init_dl_servers(void)
1842 {
1843 	int cpu;
1844 	struct rq *rq;
1845 	struct sched_dl_entity *dl_se;
1846 
1847 	for_each_online_cpu(cpu) {
1848 		u64 runtime =  50 * NSEC_PER_MSEC;
1849 		u64 period = 1000 * NSEC_PER_MSEC;
1850 
1851 		rq = cpu_rq(cpu);
1852 
1853 		guard(rq_lock_irq)(rq);
1854 		update_rq_clock(rq);
1855 
1856 		dl_se = &rq->fair_server;
1857 
1858 		WARN_ON(dl_server(dl_se));
1859 
1860 		dl_server_apply_params(dl_se, runtime, period, 1);
1861 
1862 		dl_se->dl_server = 1;
1863 		dl_se->dl_defer = 1;
1864 		setup_new_dl_entity(dl_se);
1865 
1866 #ifdef CONFIG_SCHED_CLASS_EXT
1867 		dl_se = &rq->ext_server;
1868 
1869 		WARN_ON(dl_server(dl_se));
1870 
1871 		dl_server_apply_params(dl_se, runtime, period, 1);
1872 
1873 		dl_se->dl_server = 1;
1874 		dl_se->dl_defer = 1;
1875 		setup_new_dl_entity(dl_se);
1876 
1877 		/*
1878 		 * No BPF scheduler is loaded at boot, so the ext_server has no
1879 		 * tasks to protect. Detach its bandwidth reservation, it will
1880 		 * be attached when a BPF scheduler is loaded.
1881 		 */
1882 		dl_server_detach_bw(dl_se);
1883 #endif
1884 	}
1885 }
1886 
1887 void __dl_server_attach_root(struct sched_dl_entity *dl_se, struct rq *rq)
1888 {
1889 	u64 new_bw = dl_se->dl_bw;
1890 	int cpu = cpu_of(rq);
1891 	struct dl_bw *dl_b;
1892 
1893 	if (!dl_se->dl_bw_attached)
1894 		return;
1895 
1896 	dl_b = dl_bw_of(cpu_of(rq));
1897 	guard(raw_spinlock)(&dl_b->lock);
1898 
1899 	if (!dl_bw_cpus(cpu))
1900 		return;
1901 
1902 	__dl_add(dl_b, new_bw, dl_bw_cpus(cpu));
1903 }
1904 
1905 int dl_server_apply_params(struct sched_dl_entity *dl_se, u64 runtime, u64 period, bool init)
1906 {
1907 	u64 old_bw = (init || !dl_se->dl_bw_attached) ? 0 :
1908 		     to_ratio(dl_se->dl_period, dl_se->dl_runtime);
1909 	u64 new_bw = to_ratio(period, runtime);
1910 	struct rq *rq = dl_se->rq;
1911 	int cpu = cpu_of(rq);
1912 	struct dl_bw *dl_b;
1913 	unsigned long cap;
1914 	int cpus;
1915 
1916 	dl_b = dl_bw_of(cpu);
1917 	guard(raw_spinlock)(&dl_b->lock);
1918 
1919 	cpus = dl_bw_cpus(cpu);
1920 	cap = dl_bw_capacity(cpu);
1921 
1922 	if (__dl_overflow(dl_b, cap, old_bw, new_bw))
1923 		return -EBUSY;
1924 
1925 	if (init) {
1926 		__add_rq_bw(new_bw, &rq->dl);
1927 		__dl_add(dl_b, new_bw, cpus);
1928 		dl_se->dl_bw_attached = 1;
1929 	} else if (dl_se->dl_bw_attached) {
1930 		__dl_sub(dl_b, dl_se->dl_bw, cpus);
1931 		__dl_add(dl_b, new_bw, cpus);
1932 
1933 		dl_rq_change_utilization(rq, dl_se, new_bw);
1934 	}
1935 
1936 	dl_se->dl_runtime = runtime;
1937 	dl_se->dl_deadline = period;
1938 	dl_se->dl_period = period;
1939 
1940 	dl_se->runtime = 0;
1941 	dl_se->deadline = 0;
1942 
1943 	dl_se->dl_bw = to_ratio(dl_se->dl_period, dl_se->dl_runtime);
1944 	dl_se->dl_density = to_ratio(dl_se->dl_deadline, dl_se->dl_runtime);
1945 
1946 	return 0;
1947 }
1948 
1949 /*
1950  * Add @dl_se's bw to the root-domain accounting.
1951  *
1952  * Return -EBUSY if attaching would overflow root domain capacity.
1953  */
1954 static int __dl_server_attach_bw_locked(struct sched_dl_entity *dl_se,
1955 					struct dl_bw *dl_b, int cpus)
1956 {
1957 	struct rq *rq = dl_se->rq;
1958 	unsigned long cap;
1959 
1960 	/*
1961 	 * Always update @rq->dl.this_bw, but only update @dl_b->total_bw
1962 	 * (and run the overflow check it gates) while this CPU is active.
1963 	 *
1964 	 * This mirrors dl_server_add_bw() during root-domain rebuilds, which
1965 	 * only publishes bandwidth from active CPUs into @dl_b.
1966 	 */
1967 	if (cpu_active(cpu_of(rq))) {
1968 		cap = dl_bw_capacity(cpu_of(rq));
1969 		if (__dl_overflow(dl_b, cap, 0, dl_se->dl_bw))
1970 			return -EBUSY;
1971 		__dl_add(dl_b, dl_se->dl_bw, cpus);
1972 	}
1973 	__add_rq_bw(dl_se->dl_bw, &rq->dl);
1974 	dl_se->dl_bw_attached = 1;
1975 
1976 	return 0;
1977 }
1978 
1979 /*
1980  * Drain @dl_se and remove its bw from the root-domain accounting.
1981  */
1982 static void __dl_server_detach_bw_locked(struct sched_dl_entity *dl_se,
1983 					 struct dl_bw *dl_b, int cpus)
1984 {
1985 	struct rq *rq = dl_se->rq;
1986 
1987 	/*
1988 	 * If the server is still active (on_rq), dequeue it via
1989 	 * dl_server_stop(); task_non_contending() will either subtract
1990 	 * @dl_bw from running_bw immediately (0-lag passed) or set
1991 	 * dl_non_contending and arm the inactive_timer.
1992 	 */
1993 	if (dl_se->dl_server_active)
1994 		dl_server_stop(dl_se);
1995 
1996 	/*
1997 	 * Drop @dl_se's contribution from this rq's bandwidth accounting,
1998 	 * mirroring the __add_rq_bw() done at attach time.
1999 	 */
2000 	dl_rq_change_utilization(rq, dl_se, 0);
2001 
2002 	/*
2003 	 * Update @dl_b only while this CPU is active, matching
2004 	 * dl_server_add_bw() during root-domain rebuilds.
2005 	 *
2006 	 * If this CPU is inactive, its bandwidth is not currently accounted in
2007 	 * @dl_b->total_bw: either attach skipped adding it, or a rebuild
2008 	 * already dropped it while re-publishing active CPUs only.
2009 	 *
2010 	 * In that case there is nothing to subtract from @dl_b. Just clear
2011 	 * @dl_se->dl_bw_attached; if the CPU becomes active again, the next
2012 	 * rebuild will re-publish its bandwidth.
2013 	 */
2014 	if (cpu_active(cpu_of(rq)))
2015 		__dl_sub(dl_b, dl_se->dl_bw, cpus);
2016 	dl_se->dl_bw_attached = 0;
2017 }
2018 
2019 /*
2020  * Attach @dl_se's bandwidth to the root domain's total_bw accounting.
2021  *
2022  * Use to dynamically register a dl_server's bandwidth reservation while
2023  * preserving its configured @dl_runtime / @dl_period. No-op if @dl_se is
2024  * already attached.
2025  *
2026  * Returns -EBUSY if attaching would overflow the root domain capacity.
2027  */
2028 int dl_server_attach_bw(struct sched_dl_entity *dl_se)
2029 {
2030 	struct rq *rq = dl_se->rq;
2031 	int cpu = cpu_of(rq);
2032 	struct dl_bw *dl_b;
2033 	int cpus, ret;
2034 
2035 	if (dl_se->dl_bw_attached)
2036 		return 0;
2037 
2038 	scoped_guard (raw_spinlock, &dl_bw_of(cpu)->lock) {
2039 		dl_b = dl_bw_of(cpu);
2040 		cpus = dl_bw_cpus(cpu);
2041 		ret = __dl_server_attach_bw_locked(dl_se, dl_b, cpus);
2042 	}
2043 	if (ret)
2044 		return ret;
2045 
2046 	/*
2047 	 * The natural 0->nr_running transition that triggers dl_server_start()
2048 	 * may have happened while @dl_se was still detached (e.g., between
2049 	 * scx_bypass(false) and the scx_enable() re-balance loop), so kick a
2050 	 * start here.
2051 	 *
2052 	 * dl_server_start() bails out cleanly if there's nothing to schedule or
2053 	 * it's already active. Skip if @cpu is offline; the server will be
2054 	 * started naturally on the first enqueue once @cpu comes back.
2055 	 */
2056 	if (cpu_online(cpu))
2057 		dl_server_start(dl_se);
2058 
2059 	return 0;
2060 }
2061 
2062 /*
2063  * Detach @dl_se's bandwidth from the root domain's total_bw accounting.
2064  *
2065  * Use to dynamically unregister a dl_server's bandwidth reservation while
2066  * preserving its configured @dl_runtime / @dl_period. No-op if @dl_se is
2067  * not currently attached.
2068  */
2069 void dl_server_detach_bw(struct sched_dl_entity *dl_se)
2070 {
2071 	int cpu = cpu_of(dl_se->rq);
2072 	struct dl_bw *dl_b;
2073 	int cpus;
2074 
2075 	if (!dl_se->dl_bw_attached)
2076 		return;
2077 
2078 	dl_b = dl_bw_of(cpu);
2079 	guard(raw_spinlock)(&dl_b->lock);
2080 	cpus = dl_bw_cpus(cpu);
2081 	__dl_server_detach_bw_locked(dl_se, dl_b, cpus);
2082 }
2083 
2084 /*
2085  * Atomically detach @detach_se and attach @attach_se on the same rq, holding
2086  * @dl_b->lock across both operations so a concurrent sched_setattr() cannot
2087  * steal the bandwidth freed by the detach before the attach can claim it.
2088  *
2089  * Both entities must live on the same rq (same root domain). Returns the
2090  * result of the attach: -EBUSY if attaching @attach_se would overflow root
2091  * domain capacity (in which case both servers end up detached).
2092  */
2093 int dl_server_swap_bw(struct sched_dl_entity *detach_se,
2094 		      struct sched_dl_entity *attach_se)
2095 {
2096 	struct rq *rq = detach_se->rq;
2097 	int cpu = cpu_of(rq);
2098 	struct dl_bw *dl_b;
2099 	int cpus, ret;
2100 
2101 	WARN_ON_ONCE(attach_se->rq != rq);
2102 
2103 	scoped_guard (raw_spinlock, &dl_bw_of(cpu)->lock) {
2104 		dl_b = dl_bw_of(cpu);
2105 		cpus = dl_bw_cpus(cpu);
2106 
2107 		if (detach_se->dl_bw_attached)
2108 			__dl_server_detach_bw_locked(detach_se, dl_b, cpus);
2109 
2110 		if (attach_se->dl_bw_attached)
2111 			ret = 0;
2112 		else
2113 			ret = __dl_server_attach_bw_locked(attach_se, dl_b, cpus);
2114 	}
2115 	if (ret)
2116 		return ret;
2117 
2118 	if (cpu_online(cpu))
2119 		dl_server_start(attach_se);
2120 
2121 	return 0;
2122 }
2123 
2124 /*
2125  * Update the current task's runtime statistics (provided it is still
2126  * a -deadline task and has not been removed from the dl_rq).
2127  */
2128 static void update_curr_dl(struct rq *rq)
2129 {
2130 	struct task_struct *donor = rq->donor;
2131 	struct sched_dl_entity *dl_se = &donor->dl;
2132 	s64 delta_exec;
2133 
2134 	if (!dl_task(donor) || !on_dl_rq(dl_se))
2135 		return;
2136 
2137 	/*
2138 	 * Consumed budget is computed considering the time as
2139 	 * observed by schedulable tasks (excluding time spent
2140 	 * in hardirq context, etc.). Deadlines are instead
2141 	 * computed using hard walltime. This seems to be the more
2142 	 * natural solution, but the full ramifications of this
2143 	 * approach need further study.
2144 	 */
2145 	delta_exec = update_curr_common(rq);
2146 	update_curr_dl_se(rq, dl_se, delta_exec);
2147 }
2148 
2149 static enum hrtimer_restart inactive_task_timer(struct hrtimer *timer)
2150 {
2151 	struct sched_dl_entity *dl_se = container_of(timer,
2152 						     struct sched_dl_entity,
2153 						     inactive_timer);
2154 	struct task_struct *p = NULL;
2155 	struct rq_flags rf;
2156 	struct rq *rq;
2157 
2158 	if (!dl_server(dl_se)) {
2159 		p = dl_task_of(dl_se);
2160 		rq = task_rq_lock(p, &rf);
2161 	} else {
2162 		rq = dl_se->rq;
2163 		rq_lock(rq, &rf);
2164 	}
2165 
2166 	sched_clock_tick();
2167 	update_rq_clock(rq);
2168 
2169 	if (dl_server(dl_se))
2170 		goto no_task;
2171 
2172 	if (!dl_task(p) || READ_ONCE(p->__state) == TASK_DEAD) {
2173 		struct dl_bw *dl_b = dl_bw_of(task_cpu(p));
2174 
2175 		if (READ_ONCE(p->__state) == TASK_DEAD && dl_se->dl_non_contending) {
2176 			sub_running_bw(&p->dl, dl_rq_of_se(&p->dl));
2177 			sub_rq_bw(&p->dl, dl_rq_of_se(&p->dl));
2178 			dl_se->dl_non_contending = 0;
2179 		}
2180 
2181 		raw_spin_lock(&dl_b->lock);
2182 		__dl_sub(dl_b, p->dl.dl_bw, dl_bw_cpus(task_cpu(p)));
2183 		raw_spin_unlock(&dl_b->lock);
2184 		__dl_clear_params(dl_se);
2185 
2186 		goto unlock;
2187 	}
2188 
2189 no_task:
2190 	if (dl_se->dl_non_contending == 0)
2191 		goto unlock;
2192 
2193 	sub_running_bw(dl_se, &rq->dl);
2194 	dl_se->dl_non_contending = 0;
2195 unlock:
2196 
2197 	if (!dl_server(dl_se)) {
2198 		task_rq_unlock(rq, p, &rf);
2199 		put_task_struct(p);
2200 	} else {
2201 		rq_unlock(rq, &rf);
2202 	}
2203 
2204 	return HRTIMER_NORESTART;
2205 }
2206 
2207 static void init_dl_inactive_task_timer(struct sched_dl_entity *dl_se)
2208 {
2209 	struct hrtimer *timer = &dl_se->inactive_timer;
2210 
2211 	hrtimer_setup(timer, inactive_task_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL_HARD);
2212 }
2213 
2214 #define __node_2_dle(node) \
2215 	rb_entry((node), struct sched_dl_entity, rb_node)
2216 
2217 static void inc_dl_deadline(struct dl_rq *dl_rq, u64 deadline)
2218 {
2219 	struct rq *rq = rq_of_dl_rq(dl_rq);
2220 
2221 	if (dl_rq->earliest_dl.curr == 0 ||
2222 	    dl_time_before(deadline, dl_rq->earliest_dl.curr)) {
2223 		if (dl_rq->earliest_dl.curr == 0)
2224 			cpupri_set(&rq->rd->cpupri, rq->cpu, CPUPRI_HIGHER);
2225 		dl_rq->earliest_dl.curr = deadline;
2226 		cpudl_set(&rq->rd->cpudl, rq->cpu, deadline);
2227 	}
2228 }
2229 
2230 static void dec_dl_deadline(struct dl_rq *dl_rq, u64 deadline)
2231 {
2232 	struct rq *rq = rq_of_dl_rq(dl_rq);
2233 
2234 	/*
2235 	 * Since we may have removed our earliest (and/or next earliest)
2236 	 * task we must recompute them.
2237 	 */
2238 	if (!dl_rq->dl_nr_running) {
2239 		dl_rq->earliest_dl.curr = 0;
2240 		dl_rq->earliest_dl.next = 0;
2241 		cpudl_clear(&rq->rd->cpudl, rq->cpu, rq->online);
2242 		cpupri_set(&rq->rd->cpupri, rq->cpu, rq->rt.highest_prio.curr);
2243 	} else {
2244 		struct rb_node *leftmost = rb_first_cached(&dl_rq->root);
2245 		struct sched_dl_entity *entry = __node_2_dle(leftmost);
2246 
2247 		dl_rq->earliest_dl.curr = entry->deadline;
2248 		cpudl_set(&rq->rd->cpudl, rq->cpu, entry->deadline);
2249 	}
2250 }
2251 
2252 static inline
2253 void inc_dl_tasks(struct sched_dl_entity *dl_se, struct dl_rq *dl_rq)
2254 {
2255 	u64 deadline = dl_se->deadline;
2256 
2257 	dl_rq->dl_nr_running++;
2258 
2259 	if (!dl_server(dl_se))
2260 		add_nr_running(rq_of_dl_rq(dl_rq), 1);
2261 
2262 	inc_dl_deadline(dl_rq, deadline);
2263 }
2264 
2265 static inline
2266 void dec_dl_tasks(struct sched_dl_entity *dl_se, struct dl_rq *dl_rq)
2267 {
2268 	WARN_ON(!dl_rq->dl_nr_running);
2269 	dl_rq->dl_nr_running--;
2270 
2271 	if (!dl_server(dl_se))
2272 		sub_nr_running(rq_of_dl_rq(dl_rq), 1);
2273 
2274 	dec_dl_deadline(dl_rq, dl_se->deadline);
2275 }
2276 
2277 static inline bool __dl_less(struct rb_node *a, const struct rb_node *b)
2278 {
2279 	return dl_time_before(__node_2_dle(a)->deadline, __node_2_dle(b)->deadline);
2280 }
2281 
2282 static __always_inline struct sched_statistics *
2283 __schedstats_from_dl_se(struct sched_dl_entity *dl_se)
2284 {
2285 	if (!schedstat_enabled())
2286 		return NULL;
2287 
2288 	if (dl_server(dl_se))
2289 		return NULL;
2290 
2291 	return &dl_task_of(dl_se)->stats;
2292 }
2293 
2294 static inline void
2295 update_stats_wait_start_dl(struct dl_rq *dl_rq, struct sched_dl_entity *dl_se)
2296 {
2297 	struct sched_statistics *stats = __schedstats_from_dl_se(dl_se);
2298 	if (stats)
2299 		__update_stats_wait_start(rq_of_dl_rq(dl_rq), dl_task_of(dl_se), stats);
2300 }
2301 
2302 static inline void
2303 update_stats_wait_end_dl(struct dl_rq *dl_rq, struct sched_dl_entity *dl_se)
2304 {
2305 	struct sched_statistics *stats = __schedstats_from_dl_se(dl_se);
2306 	if (stats)
2307 		__update_stats_wait_end(rq_of_dl_rq(dl_rq), dl_task_of(dl_se), stats);
2308 }
2309 
2310 static inline void
2311 update_stats_enqueue_sleeper_dl(struct dl_rq *dl_rq, struct sched_dl_entity *dl_se)
2312 {
2313 	struct sched_statistics *stats = __schedstats_from_dl_se(dl_se);
2314 	if (stats)
2315 		__update_stats_enqueue_sleeper(rq_of_dl_rq(dl_rq), dl_task_of(dl_se), stats);
2316 }
2317 
2318 static inline void
2319 update_stats_enqueue_dl(struct dl_rq *dl_rq, struct sched_dl_entity *dl_se,
2320 			int flags)
2321 {
2322 	if (!schedstat_enabled())
2323 		return;
2324 
2325 	if (flags & ENQUEUE_WAKEUP)
2326 		update_stats_enqueue_sleeper_dl(dl_rq, dl_se);
2327 }
2328 
2329 static inline void
2330 update_stats_dequeue_dl(struct dl_rq *dl_rq, struct sched_dl_entity *dl_se,
2331 			int flags)
2332 {
2333 	struct task_struct *p = dl_task_of(dl_se);
2334 	struct rq *rq = rq_of_dl_rq(dl_rq);
2335 
2336 	if (!schedstat_enabled())
2337 		return;
2338 
2339 	if (p != rq->curr)
2340 		update_stats_wait_end_dl(dl_rq, dl_se);
2341 
2342 	if ((flags & DEQUEUE_SLEEP)) {
2343 		unsigned int state;
2344 
2345 		state = READ_ONCE(p->__state);
2346 		if (state & TASK_INTERRUPTIBLE)
2347 			__schedstat_set(p->stats.sleep_start,
2348 					rq_clock(rq_of_dl_rq(dl_rq)));
2349 
2350 		if (state & TASK_UNINTERRUPTIBLE)
2351 			__schedstat_set(p->stats.block_start,
2352 					rq_clock(rq_of_dl_rq(dl_rq)));
2353 	}
2354 }
2355 
2356 static void __enqueue_dl_entity(struct sched_dl_entity *dl_se)
2357 {
2358 	struct dl_rq *dl_rq = dl_rq_of_se(dl_se);
2359 
2360 	WARN_ON_ONCE(!RB_EMPTY_NODE(&dl_se->rb_node));
2361 
2362 	rb_add_cached(&dl_se->rb_node, &dl_rq->root, __dl_less);
2363 
2364 	inc_dl_tasks(dl_se, dl_rq);
2365 }
2366 
2367 static void __dequeue_dl_entity(struct sched_dl_entity *dl_se)
2368 {
2369 	struct dl_rq *dl_rq = dl_rq_of_se(dl_se);
2370 
2371 	if (RB_EMPTY_NODE(&dl_se->rb_node))
2372 		return;
2373 
2374 	rb_erase_cached(&dl_se->rb_node, &dl_rq->root);
2375 
2376 	RB_CLEAR_NODE(&dl_se->rb_node);
2377 
2378 	dec_dl_tasks(dl_se, dl_rq);
2379 }
2380 
2381 static void
2382 enqueue_dl_entity(struct sched_dl_entity *dl_se, int flags)
2383 {
2384 	WARN_ON_ONCE(on_dl_rq(dl_se));
2385 
2386 	update_stats_enqueue_dl(dl_rq_of_se(dl_se), dl_se, flags);
2387 
2388 	/*
2389 	 * Check if a constrained deadline task was activated
2390 	 * after the deadline but before the next period.
2391 	 * If that is the case, the task will be throttled and
2392 	 * the replenishment timer will be set to the next period.
2393 	 */
2394 	if (!dl_se->dl_throttled && !dl_is_implicit(dl_se))
2395 		dl_check_constrained_dl(dl_se);
2396 
2397 	if (flags & (ENQUEUE_RESTORE|ENQUEUE_MIGRATING)) {
2398 		struct dl_rq *dl_rq = dl_rq_of_se(dl_se);
2399 
2400 		add_rq_bw(dl_se, dl_rq);
2401 		add_running_bw(dl_se, dl_rq);
2402 	}
2403 
2404 	/*
2405 	 * If p is throttled, we do not enqueue it. In fact, if it exhausted
2406 	 * its budget it needs a replenishment and, since it now is on
2407 	 * its rq, the bandwidth timer callback (which clearly has not
2408 	 * run yet) will take care of this.
2409 	 * However, the active utilization does not depend on the fact
2410 	 * that the task is on the runqueue or not (but depends on the
2411 	 * task's state - in GRUB parlance, "inactive" vs "active contending").
2412 	 * In other words, even if a task is throttled its utilization must
2413 	 * be counted in the active utilization; hence, we need to call
2414 	 * add_running_bw().
2415 	 */
2416 	if (!dl_se->dl_defer && dl_se->dl_throttled && !(flags & ENQUEUE_REPLENISH)) {
2417 		if (flags & ENQUEUE_WAKEUP)
2418 			task_contending(dl_se, flags);
2419 
2420 		return;
2421 	}
2422 
2423 	/*
2424 	 * If this is a wakeup or a new instance, the scheduling
2425 	 * parameters of the task might need updating. Otherwise,
2426 	 * we want a replenishment of its runtime.
2427 	 */
2428 	if (flags & ENQUEUE_WAKEUP) {
2429 		task_contending(dl_se, flags);
2430 		update_dl_entity(dl_se);
2431 	} else if (flags & ENQUEUE_REPLENISH) {
2432 		replenish_dl_entity(dl_se);
2433 	} else if ((flags & ENQUEUE_MOVE) &&
2434 		   !is_dl_boosted(dl_se) &&
2435 		   dl_time_before(dl_se->deadline, rq_clock(rq_of_dl_se(dl_se)))) {
2436 		setup_new_dl_entity(dl_se);
2437 	}
2438 
2439 	/*
2440 	 * If the reservation is still throttled, e.g., it got replenished but is a
2441 	 * deferred task and still got to wait, don't enqueue.
2442 	 */
2443 	if (dl_se->dl_throttled && start_dl_timer(dl_se))
2444 		return;
2445 
2446 	/*
2447 	 * We're about to enqueue, make sure we're not ->dl_throttled!
2448 	 * In case the timer was not started, say because the defer time
2449 	 * has passed, mark as not throttled and mark unarmed.
2450 	 * Also cancel earlier timers, since letting those run is pointless.
2451 	 */
2452 	if (dl_se->dl_throttled) {
2453 		hrtimer_try_to_cancel(&dl_se->dl_timer);
2454 		dl_se->dl_defer_armed = 0;
2455 		dl_se->dl_throttled = 0;
2456 	}
2457 
2458 	__enqueue_dl_entity(dl_se);
2459 }
2460 
2461 static void dequeue_dl_entity(struct sched_dl_entity *dl_se, int flags)
2462 {
2463 	__dequeue_dl_entity(dl_se);
2464 
2465 	if (flags & (DEQUEUE_SAVE|DEQUEUE_MIGRATING)) {
2466 		struct dl_rq *dl_rq = dl_rq_of_se(dl_se);
2467 
2468 		sub_running_bw(dl_se, dl_rq);
2469 		sub_rq_bw(dl_se, dl_rq);
2470 	}
2471 
2472 	/*
2473 	 * This check allows to start the inactive timer (or to immediately
2474 	 * decrease the active utilization, if needed) in two cases:
2475 	 * when the task blocks and when it is terminating
2476 	 * (p->state == TASK_DEAD). We can handle the two cases in the same
2477 	 * way, because from GRUB's point of view the same thing is happening
2478 	 * (the task moves from "active contending" to "active non contending"
2479 	 * or "inactive")
2480 	 */
2481 	if (flags & DEQUEUE_SLEEP)
2482 		task_non_contending(dl_se, true);
2483 }
2484 
2485 static void enqueue_task_dl(struct rq *rq, struct task_struct *p, int flags)
2486 {
2487 	struct sched_dl_entity *dl_se = &p->dl;
2488 	struct dl_rq *dl_rq = &rq->dl;
2489 
2490 	if (is_dl_boosted(dl_se)) {
2491 		/*
2492 		 * Because of delays in the detection of the overrun of a
2493 		 * thread's runtime, it might be the case that a thread
2494 		 * goes to sleep in a rt mutex with negative runtime. As
2495 		 * a consequence, the thread will be throttled.
2496 		 *
2497 		 * While waiting for the mutex, this thread can also be
2498 		 * boosted via PI, resulting in a thread that is throttled
2499 		 * and boosted at the same time.
2500 		 *
2501 		 * In this case, the boost overrides the throttle.
2502 		 */
2503 		if (dl_se->dl_throttled) {
2504 			/*
2505 			 * The replenish timer needs to be canceled. No
2506 			 * problem if it fires concurrently: boosted threads
2507 			 * are ignored in dl_task_timer().
2508 			 */
2509 			cancel_replenish_timer(dl_se);
2510 			dl_se->dl_throttled = 0;
2511 		}
2512 	} else if (!dl_prio(p->normal_prio)) {
2513 		/*
2514 		 * Special case in which we have a !SCHED_DEADLINE task that is going
2515 		 * to be deboosted, but exceeds its runtime while doing so. No point in
2516 		 * replenishing it, as it's going to return back to its original
2517 		 * scheduling class after this. If it has been throttled, we need to
2518 		 * clear the flag, otherwise the task may wake up as throttled after
2519 		 * being boosted again with no means to replenish the runtime and clear
2520 		 * the throttle.
2521 		 */
2522 		dl_se->dl_throttled = 0;
2523 		if (!(flags & ENQUEUE_REPLENISH))
2524 			printk_deferred_once("sched: DL de-boosted task PID %d: REPLENISH flag missing\n",
2525 					     task_pid_nr(p));
2526 
2527 		return;
2528 	}
2529 
2530 	check_schedstat_required();
2531 	update_stats_wait_start_dl(dl_rq, dl_se);
2532 
2533 	if (task_on_rq_migrating(p))
2534 		flags |= ENQUEUE_MIGRATING;
2535 
2536 	enqueue_dl_entity(dl_se, flags);
2537 
2538 	if (dl_server(dl_se))
2539 		return;
2540 
2541 	if (task_is_blocked(p))
2542 		return;
2543 
2544 	if (dl_rq->curr == dl_se)
2545 		return;
2546 
2547 	if (!task_current(rq, p) && !dl_se->dl_throttled && p->nr_cpus_allowed > 1)
2548 		enqueue_pushable_dl_task(rq, p);
2549 }
2550 
2551 static bool dequeue_task_dl(struct rq *rq, struct task_struct *p, int flags)
2552 {
2553 	update_curr_dl(rq);
2554 
2555 	if (task_on_rq_migrating(p))
2556 		flags |= DEQUEUE_MIGRATING;
2557 
2558 	dequeue_dl_entity(&p->dl, flags);
2559 	if (!p->dl.dl_throttled && !dl_server(&p->dl))
2560 		dequeue_pushable_dl_task(rq, p);
2561 
2562 	return true;
2563 }
2564 
2565 /*
2566  * Yield task semantic for -deadline tasks is:
2567  *
2568  *   get off from the CPU until our next instance, with
2569  *   a new runtime. This is of little use now, since we
2570  *   don't have a bandwidth reclaiming mechanism. Anyway,
2571  *   bandwidth reclaiming is planned for the future, and
2572  *   yield_task_dl will indicate that some spare budget
2573  *   is available for other task instances to use it.
2574  */
2575 static void yield_task_dl(struct rq *rq)
2576 {
2577 	/*
2578 	 * We make the task go to sleep until its current deadline by
2579 	 * forcing its runtime to zero. This way, update_curr_dl() stops
2580 	 * it and the bandwidth timer will wake it up and will give it
2581 	 * new scheduling parameters (thanks to dl_yielded=1).
2582 	 */
2583 	rq->donor->dl.dl_yielded = 1;
2584 
2585 	update_rq_clock(rq);
2586 	update_curr_dl(rq);
2587 	/*
2588 	 * Tell update_rq_clock() that we've just updated,
2589 	 * so we don't do microscopic update in schedule()
2590 	 * and double the fastpath cost.
2591 	 */
2592 	rq_clock_skip_update(rq);
2593 }
2594 
2595 static inline bool dl_task_is_earliest_deadline(struct task_struct *p,
2596 						 struct rq *rq)
2597 {
2598 	return (!rq->dl.dl_nr_running ||
2599 		dl_time_before(p->dl.deadline,
2600 			       rq->dl.earliest_dl.curr));
2601 }
2602 
2603 static int find_later_rq(struct task_struct *task);
2604 
2605 static int
2606 select_task_rq_dl(struct task_struct *p, int cpu, int flags)
2607 {
2608 	struct task_struct *curr, *donor;
2609 	bool select_rq;
2610 	struct rq *rq;
2611 
2612 	if (!(flags & WF_TTWU))
2613 		return cpu;
2614 
2615 	rq = cpu_rq(cpu);
2616 
2617 	rcu_read_lock();
2618 	curr = READ_ONCE(rq->curr); /* unlocked access */
2619 	donor = READ_ONCE(rq->donor);
2620 
2621 	/*
2622 	 * If we are dealing with a -deadline task, we must
2623 	 * decide where to wake it up.
2624 	 * If it has a later deadline and the current task
2625 	 * on this rq can't move (provided the waking task
2626 	 * can!) we prefer to send it somewhere else. On the
2627 	 * other hand, if it has a shorter deadline, we
2628 	 * try to make it stay here, it might be important.
2629 	 */
2630 	select_rq = unlikely(dl_task(donor)) &&
2631 		    (curr->nr_cpus_allowed < 2 ||
2632 		     !dl_entity_preempt(&p->dl, &donor->dl)) &&
2633 		    p->nr_cpus_allowed > 1;
2634 
2635 	/*
2636 	 * Take the capacity of the CPU into account to
2637 	 * ensure it fits the requirement of the task.
2638 	 */
2639 	if (sched_asym_cpucap_active())
2640 		select_rq |= !dl_task_fits_capacity(p, cpu);
2641 
2642 	if (select_rq) {
2643 		int target = find_later_rq(p);
2644 
2645 		if (target != -1 &&
2646 		    dl_task_is_earliest_deadline(p, cpu_rq(target)))
2647 			cpu = target;
2648 	}
2649 	rcu_read_unlock();
2650 
2651 	return cpu;
2652 }
2653 
2654 static void migrate_task_rq_dl(struct task_struct *p, int new_cpu __maybe_unused)
2655 {
2656 	struct rq_flags rf;
2657 	struct rq *rq;
2658 
2659 	if (READ_ONCE(p->__state) != TASK_WAKING)
2660 		return;
2661 
2662 	rq = task_rq(p);
2663 	/*
2664 	 * Since p->state == TASK_WAKING, set_task_cpu() has been called
2665 	 * from try_to_wake_up(). Hence, p->pi_lock is locked, but
2666 	 * rq->lock is not... So, lock it
2667 	 */
2668 	rq_lock(rq, &rf);
2669 	if (p->dl.dl_non_contending) {
2670 		update_rq_clock(rq);
2671 		sub_running_bw(&p->dl, &rq->dl);
2672 		p->dl.dl_non_contending = 0;
2673 		/*
2674 		 * If the timer handler is currently running and the
2675 		 * timer cannot be canceled, inactive_task_timer()
2676 		 * will see that dl_not_contending is not set, and
2677 		 * will not touch the rq's active utilization,
2678 		 * so we are still safe.
2679 		 */
2680 		cancel_inactive_timer(&p->dl);
2681 	}
2682 	sub_rq_bw(&p->dl, &rq->dl);
2683 	rq_unlock(rq, &rf);
2684 }
2685 
2686 static void check_preempt_equal_dl(struct rq *rq, struct task_struct *p)
2687 {
2688 	/*
2689 	 * Current can't be migrated, useless to reschedule,
2690 	 * let's hope p can move out.
2691 	 */
2692 	if (rq->curr->nr_cpus_allowed == 1 ||
2693 	    !cpudl_find(&rq->rd->cpudl, rq->donor, NULL))
2694 		return;
2695 
2696 	/*
2697 	 * p is migratable, so let's not schedule it and
2698 	 * see if it is pushed or pulled somewhere else.
2699 	 */
2700 	if (p->nr_cpus_allowed != 1 &&
2701 	    cpudl_find(&rq->rd->cpudl, p, NULL))
2702 		return;
2703 
2704 	resched_curr(rq);
2705 }
2706 
2707 static int balance_dl(struct rq *rq, struct rq_flags *rf)
2708 {
2709 	/*
2710 	 * Note, rq->donor may change during rq lock drops,
2711 	 * so don't re-use prev across lock drops
2712 	 */
2713 	struct task_struct *p = rq->donor;
2714 
2715 	if (!on_dl_rq(&p->dl) && need_pull_dl_task(rq, p)) {
2716 		/*
2717 		 * This is OK, because current is on_cpu, which avoids it being
2718 		 * picked for load-balance and preemption/IRQs are still
2719 		 * disabled avoiding further scheduler activity on it and we've
2720 		 * not yet started the picking loop.
2721 		 */
2722 		rq_unpin_lock(rq, rf);
2723 		pull_dl_task(rq);
2724 		rq_repin_lock(rq, rf);
2725 	}
2726 
2727 	return sched_stop_runnable(rq) || sched_dl_runnable(rq);
2728 }
2729 
2730 /*
2731  * Only called when both the current and waking task are -deadline
2732  * tasks.
2733  */
2734 static void wakeup_preempt_dl(struct rq *rq, struct task_struct *p, int flags)
2735 {
2736 	/*
2737 	 * Can only get preempted by stop-class, and those should be
2738 	 * few and short lived, doesn't really make sense to push
2739 	 * anything away for that.
2740 	 */
2741 	if (p->sched_class != &dl_sched_class)
2742 		return;
2743 
2744 	if (dl_entity_preempt(&p->dl, &rq->donor->dl)) {
2745 		resched_curr(rq);
2746 		return;
2747 	}
2748 
2749 	/*
2750 	 * In the unlikely case current and p have the same deadline
2751 	 * let us try to decide what's the best thing to do...
2752 	 */
2753 	if ((p->dl.deadline == rq->donor->dl.deadline) &&
2754 	    !test_tsk_need_resched(rq->curr))
2755 		check_preempt_equal_dl(rq, p);
2756 }
2757 
2758 #ifdef CONFIG_SCHED_HRTICK
2759 static void start_hrtick_dl(struct rq *rq, struct sched_dl_entity *dl_se)
2760 {
2761 	hrtick_start(rq, dl_se->runtime);
2762 }
2763 #else /* !CONFIG_SCHED_HRTICK: */
2764 static void start_hrtick_dl(struct rq *rq, struct sched_dl_entity *dl_se)
2765 {
2766 }
2767 #endif /* !CONFIG_SCHED_HRTICK */
2768 
2769 /*
2770  * DL keeps current in tree, because ->deadline is not typically changed while
2771  * a task is runnable.
2772  */
2773 static void set_next_task_dl(struct rq *rq, struct task_struct *p, bool first)
2774 {
2775 	struct sched_dl_entity *dl_se = &p->dl;
2776 	struct dl_rq *dl_rq = &rq->dl;
2777 
2778 	p->se.exec_start = rq_clock_task(rq);
2779 	if (on_dl_rq(&p->dl))
2780 		update_stats_wait_end_dl(dl_rq, dl_se);
2781 
2782 	/* You can't push away the running task */
2783 	dequeue_pushable_dl_task(rq, p);
2784 
2785 	WARN_ON_ONCE(dl_rq->curr);
2786 	dl_rq->curr = dl_se;
2787 
2788 	if (!first)
2789 		return;
2790 
2791 	if (rq->donor->sched_class != &dl_sched_class)
2792 		update_dl_rq_load_avg(rq_clock_pelt(rq), rq, 0);
2793 
2794 	deadline_queue_push_tasks(rq);
2795 
2796 	if (hrtick_enabled_dl(rq))
2797 		start_hrtick_dl(rq, &p->dl);
2798 }
2799 
2800 static struct sched_dl_entity *pick_next_dl_entity(struct dl_rq *dl_rq)
2801 {
2802 	struct rb_node *left = rb_first_cached(&dl_rq->root);
2803 
2804 	if (!left)
2805 		return NULL;
2806 
2807 	return __node_2_dle(left);
2808 }
2809 
2810 /*
2811  * __pick_next_task_dl - Helper to pick the next -deadline task to run.
2812  * @rq: The runqueue to pick the next task from.
2813  */
2814 static struct task_struct *__pick_task_dl(struct rq *rq, struct rq_flags *rf)
2815 {
2816 	struct sched_dl_entity *dl_se;
2817 	struct dl_rq *dl_rq = &rq->dl;
2818 	struct task_struct *p;
2819 
2820 again:
2821 	if (!sched_dl_runnable(rq))
2822 		return NULL;
2823 
2824 	dl_se = pick_next_dl_entity(dl_rq);
2825 	WARN_ON_ONCE(!dl_se);
2826 
2827 	if (dl_server(dl_se)) {
2828 		p = dl_se->server_pick_task(dl_se, rf);
2829 		if (!p) {
2830 			dl_server_stop(dl_se);
2831 			goto again;
2832 		}
2833 		rq->dl_server = dl_se;
2834 	} else {
2835 		p = dl_task_of(dl_se);
2836 	}
2837 
2838 	return p;
2839 }
2840 
2841 static struct task_struct *pick_task_dl(struct rq *rq, struct rq_flags *rf)
2842 {
2843 	return __pick_task_dl(rq, rf);
2844 }
2845 
2846 static void put_prev_task_dl(struct rq *rq, struct task_struct *p, struct task_struct *next)
2847 {
2848 	struct sched_dl_entity *dl_se = &p->dl;
2849 	struct dl_rq *dl_rq = &rq->dl;
2850 
2851 	if (on_dl_rq(dl_se))
2852 		update_stats_wait_start_dl(dl_rq, dl_se);
2853 
2854 	update_curr_dl(rq);
2855 
2856 	update_dl_rq_load_avg(rq_clock_pelt(rq), rq, 1);
2857 
2858 	WARN_ON_ONCE(dl_rq->curr != dl_se);
2859 	dl_rq->curr = NULL;
2860 
2861 	if (task_is_blocked(p))
2862 		return;
2863 
2864 	if (on_dl_rq(dl_se) && p->nr_cpus_allowed > 1)
2865 		enqueue_pushable_dl_task(rq, p);
2866 }
2867 
2868 /*
2869  * scheduler tick hitting a task of our scheduling class.
2870  *
2871  * NOTE: This function can be called remotely by the tick offload that
2872  * goes along full dynticks. Therefore no local assumption can be made
2873  * and everything must be accessed through the @rq and @curr passed in
2874  * parameters.
2875  */
2876 static void task_tick_dl(struct rq *rq, struct task_struct *p, int queued)
2877 {
2878 	update_curr_dl(rq);
2879 
2880 	update_dl_rq_load_avg(rq_clock_pelt(rq), rq, 1);
2881 	/*
2882 	 * Even when we have runtime, update_curr_dl() might have resulted in us
2883 	 * not being the leftmost task anymore. In that case NEED_RESCHED will
2884 	 * be set and schedule() will start a new hrtick for the next task.
2885 	 */
2886 	if (hrtick_enabled_dl(rq) && queued && p->dl.runtime > 0 &&
2887 	    is_leftmost(&p->dl, &rq->dl))
2888 		start_hrtick_dl(rq, &p->dl);
2889 }
2890 
2891 static void task_fork_dl(struct task_struct *p)
2892 {
2893 	/*
2894 	 * SCHED_DEADLINE tasks cannot fork and this is achieved through
2895 	 * sched_fork()
2896 	 */
2897 }
2898 
2899 /* Only try algorithms three times */
2900 #define DL_MAX_TRIES 3
2901 
2902 /*
2903  * Return the earliest pushable rq's task, which is suitable to be executed
2904  * on the CPU, NULL otherwise:
2905  */
2906 static struct task_struct *pick_earliest_pushable_dl_task(struct rq *rq, int cpu)
2907 {
2908 	struct task_struct *p = NULL;
2909 	struct rb_node *next_node;
2910 
2911 	if (!has_pushable_dl_tasks(rq))
2912 		return NULL;
2913 
2914 	next_node = rb_first_cached(&rq->dl.pushable_dl_tasks_root);
2915 	while (next_node) {
2916 		p = __node_2_pdl(next_node);
2917 
2918 		if (task_is_pushable(rq, p, cpu))
2919 			return p;
2920 
2921 		next_node = rb_next(next_node);
2922 	}
2923 
2924 	return NULL;
2925 }
2926 
2927 /* Access rule: must be called on local CPU with preemption disabled */
2928 static DEFINE_PER_CPU(cpumask_var_t, local_cpu_mask_dl);
2929 
2930 static int find_later_rq(struct task_struct *task)
2931 {
2932 	struct sched_domain *sd;
2933 	struct cpumask *later_mask = this_cpu_cpumask_var_ptr(local_cpu_mask_dl);
2934 	int this_cpu = smp_processor_id();
2935 	int cpu = task_cpu(task);
2936 
2937 	/* Make sure the mask is initialized first */
2938 	if (unlikely(!later_mask))
2939 		return -1;
2940 
2941 	if (task->nr_cpus_allowed == 1)
2942 		return -1;
2943 
2944 	/*
2945 	 * We have to consider system topology and task affinity
2946 	 * first, then we can look for a suitable CPU.
2947 	 */
2948 	if (!cpudl_find(&task_rq(task)->rd->cpudl, task, later_mask))
2949 		return -1;
2950 
2951 	/*
2952 	 * If we are here, some targets have been found, including
2953 	 * the most suitable which is, among the runqueues where the
2954 	 * current tasks have later deadlines than the task's one, the
2955 	 * rq with the latest possible one.
2956 	 *
2957 	 * Now we check how well this matches with task's
2958 	 * affinity and system topology.
2959 	 *
2960 	 * The last CPU where the task run is our first
2961 	 * guess, since it is most likely cache-hot there.
2962 	 */
2963 	if (cpumask_test_cpu(cpu, later_mask))
2964 		return cpu;
2965 	/*
2966 	 * Check if this_cpu is to be skipped (i.e., it is
2967 	 * not in the mask) or not.
2968 	 */
2969 	if (!cpumask_test_cpu(this_cpu, later_mask))
2970 		this_cpu = -1;
2971 
2972 	rcu_read_lock();
2973 	for_each_domain(cpu, sd) {
2974 		if (sd->flags & SD_WAKE_AFFINE) {
2975 			int best_cpu;
2976 
2977 			/*
2978 			 * If possible, preempting this_cpu is
2979 			 * cheaper than migrating.
2980 			 */
2981 			if (this_cpu != -1 &&
2982 			    cpumask_test_cpu(this_cpu, sched_domain_span(sd))) {
2983 				rcu_read_unlock();
2984 				return this_cpu;
2985 			}
2986 
2987 			best_cpu = cpumask_any_and_distribute(later_mask,
2988 							      sched_domain_span(sd));
2989 			/*
2990 			 * Last chance: if a CPU being in both later_mask
2991 			 * and current sd span is valid, that becomes our
2992 			 * choice. Of course, the latest possible CPU is
2993 			 * already under consideration through later_mask.
2994 			 */
2995 			if (best_cpu < nr_cpu_ids) {
2996 				rcu_read_unlock();
2997 				return best_cpu;
2998 			}
2999 		}
3000 	}
3001 	rcu_read_unlock();
3002 
3003 	/*
3004 	 * At this point, all our guesses failed, we just return
3005 	 * 'something', and let the caller sort the things out.
3006 	 */
3007 	if (this_cpu != -1)
3008 		return this_cpu;
3009 
3010 	cpu = cpumask_any_distribute(later_mask);
3011 	if (cpu < nr_cpu_ids)
3012 		return cpu;
3013 
3014 	return -1;
3015 }
3016 
3017 static struct task_struct *pick_next_pushable_dl_task(struct rq *rq)
3018 {
3019 	struct task_struct *i, *p = NULL;
3020 	struct rb_node *next_node;
3021 
3022 	if (!has_pushable_dl_tasks(rq))
3023 		return NULL;
3024 
3025 	next_node = rb_first_cached(&rq->dl.pushable_dl_tasks_root);
3026 	while (next_node) {
3027 		i = __node_2_pdl(next_node);
3028 		/* make sure task isn't on_cpu (possible with proxy-exec) */
3029 		if (!task_on_cpu(rq, i)) {
3030 			p = i;
3031 			break;
3032 		}
3033 
3034 		next_node = rb_next(next_node);
3035 	}
3036 
3037 	if (!p)
3038 		return NULL;
3039 
3040 	WARN_ON_ONCE(rq->cpu != task_cpu(p));
3041 	WARN_ON_ONCE(task_current(rq, p));
3042 	WARN_ON_ONCE(p->nr_cpus_allowed <= 1);
3043 
3044 	WARN_ON_ONCE(!task_on_rq_queued(p));
3045 	WARN_ON_ONCE(!dl_task(p));
3046 
3047 	return p;
3048 }
3049 
3050 /* Locks the rq it finds */
3051 static struct rq *find_lock_later_rq(struct task_struct *task, struct rq *rq)
3052 {
3053 	struct rq *later_rq = NULL;
3054 	int tries;
3055 	int cpu;
3056 
3057 	for (tries = 0; tries < DL_MAX_TRIES; tries++) {
3058 		cpu = find_later_rq(task);
3059 
3060 		if ((cpu == -1) || (cpu == rq->cpu))
3061 			break;
3062 
3063 		later_rq = cpu_rq(cpu);
3064 
3065 		if (!dl_task_is_earliest_deadline(task, later_rq)) {
3066 			/*
3067 			 * Target rq has tasks of equal or earlier deadline,
3068 			 * retrying does not release any lock and is unlikely
3069 			 * to yield a different result.
3070 			 */
3071 			later_rq = NULL;
3072 			break;
3073 		}
3074 
3075 		/* Retry if something changed. */
3076 		if (double_lock_balance(rq, later_rq)) {
3077 			/*
3078 			 * double_lock_balance had to release rq->lock, in the
3079 			 * meantime, task may no longer be fit to be migrated.
3080 			 * Check the following to ensure that the task is
3081 			 * still suitable for migration:
3082 			 * 1. It is possible the task was scheduled,
3083 			 *    migrate_disabled was set and then got preempted,
3084 			 *    so we must check the task migration disable
3085 			 *    flag.
3086 			 * 2. The CPU picked is in the task's affinity.
3087 			 * 3. For throttled task (dl_task_offline_migration),
3088 			 *    check the following:
3089 			 *    - the task is not on the rq anymore (it was
3090 			 *      migrated)
3091 			 *    - the task is not on CPU anymore
3092 			 *    - the task is still a dl task
3093 			 *    - the task is not queued on the rq anymore
3094 			 * 4. For the non-throttled task (push_dl_task), the
3095 			 *    check to ensure that this task is still at the
3096 			 *    head of the pushable tasks list is enough.
3097 			 */
3098 			if (unlikely(is_migration_disabled(task) ||
3099 				     !cpumask_test_cpu(later_rq->cpu, &task->cpus_mask) ||
3100 				     (task->dl.dl_throttled &&
3101 				      (task_rq(task) != rq ||
3102 				       task_on_cpu(rq, task) ||
3103 				       !dl_task(task) ||
3104 				       !task_on_rq_queued(task))) ||
3105 				     (!task->dl.dl_throttled &&
3106 				      task != pick_next_pushable_dl_task(rq)))) {
3107 
3108 				double_unlock_balance(rq, later_rq);
3109 				later_rq = NULL;
3110 				break;
3111 			}
3112 		}
3113 
3114 		/*
3115 		 * If the rq we found has no -deadline task, or
3116 		 * its earliest one has a later deadline than our
3117 		 * task, the rq is a good one.
3118 		 */
3119 		if (dl_task_is_earliest_deadline(task, later_rq))
3120 			break;
3121 
3122 		/* Otherwise we try again. */
3123 		double_unlock_balance(rq, later_rq);
3124 		later_rq = NULL;
3125 	}
3126 
3127 	return later_rq;
3128 }
3129 
3130 /*
3131  * See if the non running -deadline tasks on this rq
3132  * can be sent to some other CPU where they can preempt
3133  * and start executing.
3134  */
3135 static int push_dl_task(struct rq *rq)
3136 {
3137 	struct task_struct *next_task;
3138 	struct rq *later_rq;
3139 	int ret = 0;
3140 
3141 	next_task = pick_next_pushable_dl_task(rq);
3142 	if (!next_task)
3143 		return 0;
3144 
3145 retry:
3146 	/*
3147 	 * If next_task preempts rq->curr, and rq->curr
3148 	 * can move away, it makes sense to just reschedule
3149 	 * without going further in pushing next_task.
3150 	 */
3151 	if (dl_task(rq->donor) &&
3152 	    dl_time_before(next_task->dl.deadline, rq->donor->dl.deadline) &&
3153 	    rq->curr->nr_cpus_allowed > 1) {
3154 		resched_curr(rq);
3155 		return 0;
3156 	}
3157 
3158 	if (is_migration_disabled(next_task))
3159 		return 0;
3160 
3161 	if (WARN_ON(next_task == rq->curr))
3162 		return 0;
3163 
3164 	/* We might release rq lock */
3165 	get_task_struct(next_task);
3166 
3167 	/* Will lock the rq it'll find */
3168 	later_rq = find_lock_later_rq(next_task, rq);
3169 	if (!later_rq) {
3170 		struct task_struct *task;
3171 
3172 		/*
3173 		 * We must check all this again, since
3174 		 * find_lock_later_rq releases rq->lock and it is
3175 		 * then possible that next_task has migrated.
3176 		 */
3177 		task = pick_next_pushable_dl_task(rq);
3178 		if (task == next_task) {
3179 			/*
3180 			 * The task is still there. We don't try
3181 			 * again, some other CPU will pull it when ready.
3182 			 */
3183 			goto out;
3184 		}
3185 
3186 		if (!task)
3187 			/* No more tasks */
3188 			goto out;
3189 
3190 		put_task_struct(next_task);
3191 		next_task = task;
3192 		goto retry;
3193 	}
3194 
3195 	move_queued_task_locked(rq, later_rq, next_task);
3196 	ret = 1;
3197 
3198 	resched_curr(later_rq);
3199 
3200 	double_unlock_balance(rq, later_rq);
3201 
3202 out:
3203 	put_task_struct(next_task);
3204 
3205 	return ret;
3206 }
3207 
3208 static void push_dl_tasks(struct rq *rq)
3209 {
3210 	/* push_dl_task() will return true if it moved a -deadline task */
3211 	while (push_dl_task(rq))
3212 		;
3213 }
3214 
3215 static void pull_dl_task(struct rq *this_rq)
3216 {
3217 	int this_cpu = this_rq->cpu, cpu;
3218 	struct task_struct *p, *push_task;
3219 	bool resched = false;
3220 	struct rq *src_rq;
3221 	u64 dmin = LONG_MAX;
3222 
3223 	if (likely(!dl_overloaded(this_rq)))
3224 		return;
3225 
3226 	/*
3227 	 * Match the barrier from dl_set_overloaded; this guarantees that if we
3228 	 * see overloaded we must also see the dlo_mask bit.
3229 	 */
3230 	smp_rmb();
3231 
3232 	for_each_cpu(cpu, this_rq->rd->dlo_mask) {
3233 		if (this_cpu == cpu)
3234 			continue;
3235 
3236 		src_rq = cpu_rq(cpu);
3237 
3238 		/*
3239 		 * It looks racy, and it is! However, as in sched_rt.c,
3240 		 * we are fine with this.
3241 		 */
3242 		if (this_rq->dl.dl_nr_running &&
3243 		    dl_time_before(this_rq->dl.earliest_dl.curr,
3244 				   src_rq->dl.earliest_dl.next))
3245 			continue;
3246 
3247 		/* Might drop this_rq->lock */
3248 		push_task = NULL;
3249 		double_lock_balance(this_rq, src_rq);
3250 
3251 		/*
3252 		 * If there are no more pullable tasks on the
3253 		 * rq, we're done with it.
3254 		 */
3255 		if (src_rq->dl.dl_nr_running <= 1)
3256 			goto skip;
3257 
3258 		p = pick_earliest_pushable_dl_task(src_rq, this_cpu);
3259 
3260 		/*
3261 		 * We found a task to be pulled if:
3262 		 *  - it preempts our current (if there's one),
3263 		 *  - it will preempt the last one we pulled (if any).
3264 		 */
3265 		if (p && dl_time_before(p->dl.deadline, dmin) &&
3266 		    dl_task_is_earliest_deadline(p, this_rq)) {
3267 			WARN_ON(p == src_rq->curr);
3268 			WARN_ON(!task_on_rq_queued(p));
3269 
3270 			/*
3271 			 * Then we pull iff p has actually an earlier
3272 			 * deadline than the current task of its runqueue.
3273 			 */
3274 			if (dl_time_before(p->dl.deadline,
3275 					   src_rq->donor->dl.deadline))
3276 				goto skip;
3277 
3278 			if (is_migration_disabled(p)) {
3279 				push_task = get_push_task(src_rq);
3280 			} else {
3281 				move_queued_task_locked(src_rq, this_rq, p);
3282 				dmin = p->dl.deadline;
3283 				resched = true;
3284 			}
3285 
3286 			/* Is there any other task even earlier? */
3287 		}
3288 skip:
3289 		double_unlock_balance(this_rq, src_rq);
3290 
3291 		if (push_task) {
3292 			preempt_disable();
3293 			raw_spin_rq_unlock(this_rq);
3294 			stop_one_cpu_nowait(src_rq->cpu, push_cpu_stop,
3295 					    push_task, &src_rq->push_work);
3296 			preempt_enable();
3297 			raw_spin_rq_lock(this_rq);
3298 		}
3299 	}
3300 
3301 	if (resched)
3302 		resched_curr(this_rq);
3303 }
3304 
3305 /*
3306  * Since the task is not running and a reschedule is not going to happen
3307  * anytime soon on its runqueue, we try pushing it away now.
3308  */
3309 static void task_woken_dl(struct rq *rq, struct task_struct *p)
3310 {
3311 	if (!task_on_cpu(rq, p) &&
3312 	    !test_tsk_need_resched(rq->curr) &&
3313 	    p->nr_cpus_allowed > 1 &&
3314 	    dl_task(rq->donor) &&
3315 	    (rq->curr->nr_cpus_allowed < 2 ||
3316 	     !dl_entity_preempt(&p->dl, &rq->donor->dl))) {
3317 		push_dl_tasks(rq);
3318 	}
3319 }
3320 
3321 static void set_cpus_allowed_dl(struct task_struct *p,
3322 				struct affinity_context *ctx)
3323 {
3324 	struct rq *rq;
3325 
3326 	WARN_ON_ONCE(!dl_task(p));
3327 
3328 	rq = task_rq(p);
3329 	/*
3330 	 * Migrating a SCHED_DEADLINE task between exclusive
3331 	 * cpusets (different root_domains) entails a bandwidth
3332 	 * update. We already made space for us in the destination
3333 	 * domain (see cpuset_can_attach()).
3334 	 */
3335 	if (dl_task_needs_bw_move(p, ctx->new_mask)) {
3336 		struct dl_bw *src_dl_b;
3337 
3338 		src_dl_b = dl_bw_of(cpu_of(rq));
3339 		/*
3340 		 * We now free resources of the root_domain we are migrating
3341 		 * off. In the worst case, sched_setattr() may temporary fail
3342 		 * until we complete the update.
3343 		 */
3344 		raw_spin_lock(&src_dl_b->lock);
3345 		__dl_sub(src_dl_b, p->dl.dl_bw, dl_bw_cpus(task_cpu(p)));
3346 		raw_spin_unlock(&src_dl_b->lock);
3347 	}
3348 
3349 	set_cpus_allowed_common(p, ctx);
3350 }
3351 
3352 bool dl_task_needs_bw_move(struct task_struct *p,
3353 			   const struct cpumask *new_mask)
3354 {
3355 	if (!dl_task(p))
3356 		return false;
3357 
3358 	return !cpumask_intersects(task_rq(p)->rd->span, new_mask);
3359 }
3360 
3361 /* Assumes rq->lock is held */
3362 static void rq_online_dl(struct rq *rq)
3363 {
3364 	if (rq->dl.overloaded)
3365 		dl_set_overload(rq);
3366 
3367 	if (rq->dl.dl_nr_running > 0)
3368 		cpudl_set(&rq->rd->cpudl, rq->cpu, rq->dl.earliest_dl.curr);
3369 	else
3370 		cpudl_clear(&rq->rd->cpudl, rq->cpu, true);
3371 }
3372 
3373 /* Assumes rq->lock is held */
3374 static void rq_offline_dl(struct rq *rq)
3375 {
3376 	if (rq->dl.overloaded)
3377 		dl_clear_overload(rq);
3378 
3379 	cpudl_clear(&rq->rd->cpudl, rq->cpu, false);
3380 }
3381 
3382 void __init init_sched_dl_class(void)
3383 {
3384 	unsigned int i;
3385 
3386 	for_each_possible_cpu(i)
3387 		zalloc_cpumask_var_node(&per_cpu(local_cpu_mask_dl, i),
3388 					GFP_KERNEL, cpu_to_node(i));
3389 }
3390 
3391 /*
3392  * This function always returns a non-empty bitmap in @cpus. This is because
3393  * if a root domain has reserved bandwidth for DL tasks, the DL bandwidth
3394  * check will prevent CPU hotplug from deactivating all CPUs in that domain.
3395  */
3396 static void dl_get_task_effective_cpus(struct task_struct *p, struct cpumask *cpus)
3397 {
3398 	const struct cpumask *hk_msk;
3399 
3400 	hk_msk = housekeeping_cpumask(HK_TYPE_DOMAIN);
3401 	if (housekeeping_enabled(HK_TYPE_DOMAIN)) {
3402 		if (!cpumask_intersects(p->cpus_ptr, hk_msk)) {
3403 			/*
3404 			 * CPUs isolated by isolcpu="domain" always belong to
3405 			 * def_root_domain.
3406 			 */
3407 			cpumask_andnot(cpus, cpu_active_mask, hk_msk);
3408 			return;
3409 		}
3410 	}
3411 
3412 	/*
3413 	 * If a root domain holds a DL task, it must have active CPUs. So
3414 	 * active CPUs can always be found by walking up the task's cpuset
3415 	 * hierarchy up to the partition root.
3416 	 */
3417 	cpuset_cpus_allowed_locked(p, cpus);
3418 }
3419 
3420 /* The caller should hold cpuset_mutex */
3421 void dl_add_task_root_domain(struct task_struct *p)
3422 {
3423 	struct rq_flags rf;
3424 	struct rq *rq;
3425 	struct dl_bw *dl_b;
3426 	unsigned int cpu;
3427 	struct cpumask *msk;
3428 
3429 	raw_spin_lock_irqsave(&p->pi_lock, rf.flags);
3430 	if (!dl_task(p) || dl_entity_is_special(&p->dl)) {
3431 		raw_spin_unlock_irqrestore(&p->pi_lock, rf.flags);
3432 		return;
3433 	}
3434 
3435 	msk = this_cpu_cpumask_var_ptr(local_cpu_mask_dl);
3436 	dl_get_task_effective_cpus(p, msk);
3437 	cpu = cpumask_first_and(cpu_active_mask, msk);
3438 	BUG_ON(cpu >= nr_cpu_ids);
3439 	rq = cpu_rq(cpu);
3440 	dl_b = &rq->rd->dl_bw;
3441 
3442 	raw_spin_lock(&dl_b->lock);
3443 	__dl_add(dl_b, p->dl.dl_bw, cpumask_weight(rq->rd->span));
3444 	raw_spin_unlock(&dl_b->lock);
3445 	raw_spin_unlock_irqrestore(&p->pi_lock, rf.flags);
3446 }
3447 
3448 static void dl_server_add_bw(struct root_domain *rd, int cpu)
3449 {
3450 	struct sched_dl_entity *dl_se;
3451 
3452 	dl_se = &cpu_rq(cpu)->fair_server;
3453 	if (dl_server(dl_se) && dl_se->dl_bw_attached && cpu_active(cpu))
3454 		__dl_add(&rd->dl_bw, dl_se->dl_bw, dl_bw_cpus(cpu));
3455 
3456 #ifdef CONFIG_SCHED_CLASS_EXT
3457 	dl_se = &cpu_rq(cpu)->ext_server;
3458 	if (dl_server(dl_se) && dl_se->dl_bw_attached && cpu_active(cpu))
3459 		__dl_add(&rd->dl_bw, dl_se->dl_bw, dl_bw_cpus(cpu));
3460 #endif
3461 }
3462 
3463 static u64 dl_server_read_bw(int cpu)
3464 {
3465 	u64 dl_bw = 0;
3466 
3467 	if (cpu_rq(cpu)->fair_server.dl_server &&
3468 	    cpu_rq(cpu)->fair_server.dl_bw_attached)
3469 		dl_bw += cpu_rq(cpu)->fair_server.dl_bw;
3470 
3471 #ifdef CONFIG_SCHED_CLASS_EXT
3472 	if (cpu_rq(cpu)->ext_server.dl_server &&
3473 	    cpu_rq(cpu)->ext_server.dl_bw_attached)
3474 		dl_bw += cpu_rq(cpu)->ext_server.dl_bw;
3475 #endif
3476 
3477 	return dl_bw;
3478 }
3479 
3480 void dl_clear_root_domain(struct root_domain *rd)
3481 {
3482 	int i;
3483 
3484 	guard(raw_spinlock_irqsave)(&rd->dl_bw.lock);
3485 
3486 	/*
3487 	 * Reset total_bw to zero and extra_bw to max_bw so that next
3488 	 * loop will add dl-servers contributions back properly,
3489 	 */
3490 	rd->dl_bw.total_bw = 0;
3491 	for_each_cpu(i, rd->span)
3492 		cpu_rq(i)->dl.extra_bw = cpu_rq(i)->dl.max_bw;
3493 
3494 	/*
3495 	 * dl_servers are not tasks. Since dl_add_task_root_domain ignores
3496 	 * them, we need to account for them here explicitly.
3497 	 */
3498 	for_each_cpu(i, rd->span)
3499 		dl_server_add_bw(rd, i);
3500 }
3501 
3502 void dl_clear_root_domain_cpu(int cpu)
3503 {
3504 	dl_clear_root_domain(cpu_rq(cpu)->rd);
3505 }
3506 
3507 static void switched_from_dl(struct rq *rq, struct task_struct *p)
3508 {
3509 	/*
3510 	 * task_non_contending() can start the "inactive timer" (if the 0-lag
3511 	 * time is in the future). If the task switches back to dl before
3512 	 * the "inactive timer" fires, it can continue to consume its current
3513 	 * runtime using its current deadline. If it stays outside of
3514 	 * SCHED_DEADLINE until the 0-lag time passes, inactive_task_timer()
3515 	 * will reset the task parameters.
3516 	 */
3517 	if (task_on_rq_queued(p) && p->dl.dl_runtime)
3518 		task_non_contending(&p->dl, false);
3519 
3520 	/*
3521 	 * In case a task is setscheduled out from SCHED_DEADLINE we need to
3522 	 * keep track of that on its cpuset (for correct bandwidth tracking).
3523 	 */
3524 	dec_dl_tasks_cs(p);
3525 
3526 	if (!task_on_rq_queued(p)) {
3527 		/*
3528 		 * Inactive timer is armed. However, p is leaving DEADLINE and
3529 		 * might migrate away from this rq while continuing to run on
3530 		 * some other class. We need to remove its contribution from
3531 		 * this rq running_bw now, or sub_rq_bw (below) will complain.
3532 		 */
3533 		if (p->dl.dl_non_contending)
3534 			sub_running_bw(&p->dl, &rq->dl);
3535 		sub_rq_bw(&p->dl, &rq->dl);
3536 	}
3537 
3538 	/*
3539 	 * We cannot use inactive_task_timer() to invoke sub_running_bw()
3540 	 * at the 0-lag time, because the task could have been migrated
3541 	 * while SCHED_OTHER in the meanwhile.
3542 	 */
3543 	if (p->dl.dl_non_contending)
3544 		p->dl.dl_non_contending = 0;
3545 
3546 	/*
3547 	 * Since this might be the only -deadline task on the rq,
3548 	 * this is the right place to try to pull some other one
3549 	 * from an overloaded CPU, if any.
3550 	 */
3551 	if (!task_on_rq_queued(p) || rq->dl.dl_nr_running)
3552 		return;
3553 
3554 	deadline_queue_pull_task(rq);
3555 }
3556 
3557 /*
3558  * When switching to -deadline, we may overload the rq, then
3559  * we try to push someone off, if possible.
3560  */
3561 static void switched_to_dl(struct rq *rq, struct task_struct *p)
3562 {
3563 	cancel_inactive_timer(&p->dl);
3564 
3565 	/*
3566 	 * In case a task is setscheduled to SCHED_DEADLINE we need to keep
3567 	 * track of that on its cpuset (for correct bandwidth tracking).
3568 	 */
3569 	inc_dl_tasks_cs(p);
3570 
3571 	/* If p is not queued we will update its parameters at next wakeup. */
3572 	if (!task_on_rq_queued(p)) {
3573 		add_rq_bw(&p->dl, &rq->dl);
3574 
3575 		return;
3576 	}
3577 
3578 	if (rq->donor != p) {
3579 		if (p->nr_cpus_allowed > 1 && rq->dl.overloaded)
3580 			deadline_queue_push_tasks(rq);
3581 		if (dl_task(rq->donor))
3582 			wakeup_preempt_dl(rq, p, 0);
3583 		else
3584 			resched_curr(rq);
3585 	} else {
3586 		update_dl_rq_load_avg(rq_clock_pelt(rq), rq, 0);
3587 	}
3588 }
3589 
3590 static u64 get_prio_dl(struct rq *rq, struct task_struct *p)
3591 {
3592 	/*
3593 	 * Make sure to update current so we don't return a stale value.
3594 	 */
3595 	if (task_current_donor(rq, p))
3596 		update_curr_dl(rq);
3597 
3598 	return p->dl.deadline;
3599 }
3600 
3601 /*
3602  * If the scheduling parameters of a -deadline task changed,
3603  * a push or pull operation might be needed.
3604  */
3605 static void prio_changed_dl(struct rq *rq, struct task_struct *p, u64 old_deadline)
3606 {
3607 	if (!task_on_rq_queued(p))
3608 		return;
3609 
3610 	if (p->dl.deadline == old_deadline)
3611 		return;
3612 
3613 	if (dl_time_before(old_deadline, p->dl.deadline))
3614 		deadline_queue_pull_task(rq);
3615 
3616 	if (task_current_donor(rq, p)) {
3617 		/*
3618 		 * If we now have a earlier deadline task than p,
3619 		 * then reschedule, provided p is still on this
3620 		 * runqueue.
3621 		 */
3622 		if (dl_time_before(rq->dl.earliest_dl.curr, p->dl.deadline))
3623 			resched_curr(rq);
3624 	} else {
3625 		/*
3626 		 * Current may not be deadline in case p was throttled but we
3627 		 * have just replenished it (e.g. rt_mutex_setprio()).
3628 		 *
3629 		 * Otherwise, if p was given an earlier deadline, reschedule.
3630 		 */
3631 		if (!dl_task(rq->curr) ||
3632 		    dl_time_before(p->dl.deadline, rq->curr->dl.deadline))
3633 			resched_curr(rq);
3634 	}
3635 }
3636 
3637 #ifdef CONFIG_SCHED_CORE
3638 static int task_is_throttled_dl(struct task_struct *p, int cpu)
3639 {
3640 	return p->dl.dl_throttled;
3641 }
3642 #endif
3643 
3644 DEFINE_SCHED_CLASS(dl) = {
3645 	.enqueue_task		= enqueue_task_dl,
3646 	.dequeue_task		= dequeue_task_dl,
3647 	.yield_task		= yield_task_dl,
3648 
3649 	.wakeup_preempt		= wakeup_preempt_dl,
3650 
3651 	.pick_task		= pick_task_dl,
3652 	.put_prev_task		= put_prev_task_dl,
3653 	.set_next_task		= set_next_task_dl,
3654 
3655 	.balance		= balance_dl,
3656 	.select_task_rq		= select_task_rq_dl,
3657 	.migrate_task_rq	= migrate_task_rq_dl,
3658 	.set_cpus_allowed       = set_cpus_allowed_dl,
3659 	.rq_online              = rq_online_dl,
3660 	.rq_offline             = rq_offline_dl,
3661 	.task_woken		= task_woken_dl,
3662 	.find_lock_rq		= find_lock_later_rq,
3663 
3664 	.task_tick		= task_tick_dl,
3665 	.task_fork              = task_fork_dl,
3666 
3667 	.get_prio		= get_prio_dl,
3668 	.prio_changed           = prio_changed_dl,
3669 	.switched_from		= switched_from_dl,
3670 	.switched_to		= switched_to_dl,
3671 
3672 	.update_curr		= update_curr_dl,
3673 #ifdef CONFIG_SCHED_CORE
3674 	.task_is_throttled	= task_is_throttled_dl,
3675 #endif
3676 };
3677 
3678 /*
3679  * Used for dl_bw check and update, used under sched_rt_handler()::mutex and
3680  * sched_domains_mutex.
3681  */
3682 u64 dl_cookie;
3683 
3684 int sched_dl_global_validate(void)
3685 {
3686 	u64 runtime = global_rt_runtime();
3687 	u64 period = global_rt_period();
3688 	u64 new_bw = to_ratio(period, runtime);
3689 	u64 cookie = ++dl_cookie;
3690 	struct dl_bw *dl_b;
3691 	int cpu, cpus, ret = 0;
3692 	unsigned long flags;
3693 
3694 	/*
3695 	 * Here we want to check the bandwidth not being set to some
3696 	 * value smaller than the currently allocated bandwidth in
3697 	 * any of the root_domains.
3698 	 */
3699 	for_each_online_cpu(cpu) {
3700 		rcu_read_lock_sched();
3701 
3702 		if (dl_bw_visited(cpu, cookie))
3703 			goto next;
3704 
3705 		dl_b = dl_bw_of(cpu);
3706 		cpus = dl_bw_cpus(cpu);
3707 
3708 		raw_spin_lock_irqsave(&dl_b->lock, flags);
3709 		if (new_bw * cpus < dl_b->total_bw)
3710 			ret = -EBUSY;
3711 		raw_spin_unlock_irqrestore(&dl_b->lock, flags);
3712 
3713 next:
3714 		rcu_read_unlock_sched();
3715 
3716 		if (ret)
3717 			break;
3718 	}
3719 
3720 	return ret;
3721 }
3722 
3723 static void init_dl_rq_bw_ratio(struct dl_rq *dl_rq)
3724 {
3725 	if (global_rt_runtime() == RUNTIME_INF) {
3726 		dl_rq->bw_ratio = 1 << RATIO_SHIFT;
3727 		dl_rq->max_bw = dl_rq->extra_bw = 1 << BW_SHIFT;
3728 	} else {
3729 		dl_rq->bw_ratio = to_ratio(global_rt_runtime(),
3730 			  global_rt_period()) >> (BW_SHIFT - RATIO_SHIFT);
3731 		dl_rq->max_bw = dl_rq->extra_bw =
3732 			to_ratio(global_rt_period(), global_rt_runtime());
3733 	}
3734 }
3735 
3736 void sched_dl_do_global(void)
3737 {
3738 	u64 new_bw = -1;
3739 	u64 cookie = ++dl_cookie;
3740 	struct dl_bw *dl_b;
3741 	int cpu;
3742 	unsigned long flags;
3743 
3744 	if (global_rt_runtime() != RUNTIME_INF)
3745 		new_bw = to_ratio(global_rt_period(), global_rt_runtime());
3746 
3747 	for_each_possible_cpu(cpu)
3748 		init_dl_rq_bw_ratio(&cpu_rq(cpu)->dl);
3749 
3750 	for_each_possible_cpu(cpu) {
3751 		rcu_read_lock_sched();
3752 
3753 		if (dl_bw_visited(cpu, cookie)) {
3754 			rcu_read_unlock_sched();
3755 			continue;
3756 		}
3757 
3758 		dl_b = dl_bw_of(cpu);
3759 
3760 		raw_spin_lock_irqsave(&dl_b->lock, flags);
3761 		dl_b->bw = new_bw;
3762 		raw_spin_unlock_irqrestore(&dl_b->lock, flags);
3763 
3764 		rcu_read_unlock_sched();
3765 	}
3766 }
3767 
3768 /*
3769  * We must be sure that accepting a new task (or allowing changing the
3770  * parameters of an existing one) is consistent with the bandwidth
3771  * constraints. If yes, this function also accordingly updates the currently
3772  * allocated bandwidth to reflect the new situation.
3773  *
3774  * This function is called while holding p's rq->lock.
3775  */
3776 int sched_dl_overflow(struct task_struct *p, int policy,
3777 		      const struct sched_attr *attr)
3778 {
3779 	u64 period = attr->sched_period ?: attr->sched_deadline;
3780 	u64 runtime = attr->sched_runtime;
3781 	u64 new_bw = dl_policy(policy) ? to_ratio(period, runtime) : 0;
3782 	int cpus, err = -1, cpu = task_cpu(p);
3783 	struct dl_bw *dl_b = dl_bw_of(cpu);
3784 	unsigned long cap;
3785 
3786 	if (attr->sched_flags & SCHED_FLAG_SUGOV)
3787 		return 0;
3788 
3789 	/* !deadline task may carry old deadline bandwidth */
3790 	if (new_bw == p->dl.dl_bw && task_has_dl_policy(p))
3791 		return 0;
3792 
3793 	/*
3794 	 * Either if a task, enters, leave, or stays -deadline but changes
3795 	 * its parameters, we may need to update accordingly the total
3796 	 * allocated bandwidth of the container.
3797 	 */
3798 	raw_spin_lock(&dl_b->lock);
3799 	cpus = dl_bw_cpus(cpu);
3800 	cap = dl_bw_capacity(cpu);
3801 
3802 	if (dl_policy(policy) && !task_has_dl_policy(p) &&
3803 	    !__dl_overflow(dl_b, cap, 0, new_bw)) {
3804 		if (hrtimer_active(&p->dl.inactive_timer))
3805 			__dl_sub(dl_b, p->dl.dl_bw, cpus);
3806 		__dl_add(dl_b, new_bw, cpus);
3807 		err = 0;
3808 	} else if (dl_policy(policy) && task_has_dl_policy(p) &&
3809 		   !__dl_overflow(dl_b, cap, p->dl.dl_bw, new_bw)) {
3810 		/*
3811 		 * XXX this is slightly incorrect: when the task
3812 		 * utilization decreases, we should delay the total
3813 		 * utilization change until the task's 0-lag point.
3814 		 * But this would require to set the task's "inactive
3815 		 * timer" when the task is not inactive.
3816 		 */
3817 		__dl_sub(dl_b, p->dl.dl_bw, cpus);
3818 		__dl_add(dl_b, new_bw, cpus);
3819 		dl_change_utilization(p, new_bw);
3820 		err = 0;
3821 	} else if (!dl_policy(policy) && task_has_dl_policy(p)) {
3822 		/*
3823 		 * Do not decrease the total deadline utilization here,
3824 		 * switched_from_dl() will take care to do it at the correct
3825 		 * (0-lag) time.
3826 		 */
3827 		err = 0;
3828 	}
3829 	raw_spin_unlock(&dl_b->lock);
3830 
3831 	return err;
3832 }
3833 
3834 /*
3835  * This function initializes the sched_dl_entity of a newly becoming
3836  * SCHED_DEADLINE task.
3837  *
3838  * Only the static values are considered here, the actual runtime and the
3839  * absolute deadline will be properly calculated when the task is enqueued
3840  * for the first time with its new policy.
3841  */
3842 void __setparam_dl(struct task_struct *p, const struct sched_attr *attr)
3843 {
3844 	struct sched_dl_entity *dl_se = &p->dl;
3845 
3846 	dl_se->dl_runtime = attr->sched_runtime;
3847 	dl_se->dl_deadline = attr->sched_deadline;
3848 	dl_se->dl_period = attr->sched_period ?: dl_se->dl_deadline;
3849 	dl_se->flags = attr->sched_flags & SCHED_DL_FLAGS;
3850 	dl_se->dl_bw = to_ratio(dl_se->dl_period, dl_se->dl_runtime);
3851 	dl_se->dl_density = to_ratio(dl_se->dl_deadline, dl_se->dl_runtime);
3852 }
3853 
3854 void __getparam_dl(struct task_struct *p, struct sched_attr *attr, unsigned int flags)
3855 {
3856 	struct sched_dl_entity *dl_se = &p->dl;
3857 	struct rq *rq = task_rq(p);
3858 	u64 adj_deadline;
3859 
3860 	attr->sched_priority = p->rt_priority;
3861 	if (flags & SCHED_GETATTR_FLAG_DL_DYNAMIC) {
3862 		guard(raw_spinlock_irq)(&rq->__lock);
3863 		update_rq_clock(rq);
3864 		if (task_current(rq, p))
3865 			update_curr_dl(rq);
3866 
3867 		attr->sched_runtime = dl_se->runtime;
3868 		adj_deadline = dl_se->deadline - rq_clock(rq) + ktime_get_ns();
3869 		attr->sched_deadline = adj_deadline;
3870 	} else {
3871 		attr->sched_runtime = dl_se->dl_runtime;
3872 		attr->sched_deadline = dl_se->dl_deadline;
3873 	}
3874 	attr->sched_period = dl_se->dl_period;
3875 	attr->sched_flags &= ~SCHED_DL_FLAGS;
3876 	attr->sched_flags |= dl_se->flags;
3877 }
3878 
3879 /*
3880  * This function validates the new parameters of a -deadline task.
3881  * We ask for the deadline not being zero, and greater or equal
3882  * than the runtime, as well as the period of being zero or
3883  * greater than deadline. Furthermore, we have to be sure that
3884  * user parameters are above the internal resolution of 1us (we
3885  * check sched_runtime only since it is always the smaller one) and
3886  * below 2^63 ns (we have to check both sched_deadline and
3887  * sched_period, as the latter can be zero).
3888  */
3889 bool __checkparam_dl(const struct sched_attr *attr)
3890 {
3891 	u64 period, max, min;
3892 
3893 	/* special dl tasks don't actually use any parameter */
3894 	if (attr->sched_flags & SCHED_FLAG_SUGOV)
3895 		return true;
3896 
3897 	/* deadline != 0 */
3898 	if (attr->sched_deadline == 0)
3899 		return false;
3900 
3901 	/*
3902 	 * Since we truncate DL_SCALE bits, make sure we're at least
3903 	 * that big.
3904 	 */
3905 	if (attr->sched_runtime < (1ULL << DL_SCALE))
3906 		return false;
3907 
3908 	/*
3909 	 * Since we use the MSB for wrap-around and sign issues, make
3910 	 * sure it's not set (mind that period can be equal to zero).
3911 	 */
3912 	if (attr->sched_deadline & (1ULL << 63) ||
3913 	    attr->sched_period & (1ULL << 63))
3914 		return false;
3915 
3916 	period = attr->sched_period;
3917 	if (!period)
3918 		period = attr->sched_deadline;
3919 
3920 	/* runtime <= deadline <= period (if period != 0) */
3921 	if (period < attr->sched_deadline ||
3922 	    attr->sched_deadline < attr->sched_runtime)
3923 		return false;
3924 
3925 	max = (u64)READ_ONCE(sysctl_sched_dl_period_max) * NSEC_PER_USEC;
3926 	min = (u64)READ_ONCE(sysctl_sched_dl_period_min) * NSEC_PER_USEC;
3927 
3928 	if (period < min || period > max)
3929 		return false;
3930 
3931 	return true;
3932 }
3933 
3934 /*
3935  * This function clears the sched_dl_entity static params.
3936  */
3937 static void __dl_clear_params(struct sched_dl_entity *dl_se)
3938 {
3939 	dl_se->dl_runtime		= 0;
3940 	dl_se->dl_deadline		= 0;
3941 	dl_se->dl_period		= 0;
3942 	dl_se->flags			= 0;
3943 	dl_se->dl_bw			= 0;
3944 	dl_se->dl_density		= 0;
3945 
3946 	dl_se->dl_throttled		= 0;
3947 	dl_se->dl_yielded		= 0;
3948 	dl_se->dl_non_contending	= 0;
3949 	dl_se->dl_overrun		= 0;
3950 	dl_se->dl_server		= 0;
3951 	dl_se->dl_defer			= 0;
3952 	dl_se->dl_defer_running		= 0;
3953 	dl_se->dl_defer_armed		= 0;
3954 
3955 #ifdef CONFIG_RT_MUTEXES
3956 	dl_se->pi_se			= dl_se;
3957 #endif
3958 }
3959 
3960 void init_dl_entity(struct sched_dl_entity *dl_se)
3961 {
3962 	RB_CLEAR_NODE(&dl_se->rb_node);
3963 	init_dl_task_timer(dl_se);
3964 	init_dl_inactive_task_timer(dl_se);
3965 	__dl_clear_params(dl_se);
3966 }
3967 
3968 bool dl_param_changed(struct task_struct *p, const struct sched_attr *attr)
3969 {
3970 	struct sched_dl_entity *dl_se = &p->dl;
3971 
3972 	if (dl_se->dl_runtime != attr->sched_runtime ||
3973 	    dl_se->dl_deadline != attr->sched_deadline ||
3974 	    dl_se->dl_period != attr->sched_period ||
3975 	    dl_se->flags != (attr->sched_flags & SCHED_DL_FLAGS))
3976 		return true;
3977 
3978 	return false;
3979 }
3980 
3981 int dl_cpuset_cpumask_can_shrink(const struct cpumask *cur,
3982 				 const struct cpumask *trial)
3983 {
3984 	unsigned long flags, cap;
3985 	struct dl_bw *cur_dl_b;
3986 	int ret = 1;
3987 
3988 	rcu_read_lock_sched();
3989 	cur_dl_b = dl_bw_of(cpumask_any(cur));
3990 	cap = __dl_bw_capacity(trial);
3991 	raw_spin_lock_irqsave(&cur_dl_b->lock, flags);
3992 	if (__dl_overflow(cur_dl_b, cap, 0, 0))
3993 		ret = 0;
3994 	raw_spin_unlock_irqrestore(&cur_dl_b->lock, flags);
3995 	rcu_read_unlock_sched();
3996 
3997 	return ret;
3998 }
3999 
4000 enum dl_bw_request {
4001 	dl_bw_req_deactivate = 0,
4002 	dl_bw_req_alloc,
4003 	dl_bw_req_free
4004 };
4005 
4006 static int dl_bw_manage(enum dl_bw_request req, int cpu, u64 dl_bw)
4007 {
4008 	unsigned long flags, cap;
4009 	struct dl_bw *dl_b;
4010 	bool overflow = 0;
4011 	u64 dl_server_bw = 0;
4012 
4013 	rcu_read_lock_sched();
4014 	dl_b = dl_bw_of(cpu);
4015 	raw_spin_lock_irqsave(&dl_b->lock, flags);
4016 
4017 	cap = dl_bw_capacity(cpu);
4018 	switch (req) {
4019 	case dl_bw_req_free:
4020 		__dl_sub(dl_b, dl_bw, dl_bw_cpus(cpu));
4021 		break;
4022 	case dl_bw_req_alloc:
4023 		overflow = __dl_overflow(dl_b, cap, 0, dl_bw);
4024 
4025 		if (!overflow) {
4026 			/*
4027 			 * We reserve space in the destination
4028 			 * root_domain, as we can't fail after this point.
4029 			 * We will free resources in the source root_domain
4030 			 * later on (see set_cpus_allowed_dl()).
4031 			 */
4032 			__dl_add(dl_b, dl_bw, dl_bw_cpus(cpu));
4033 		}
4034 		break;
4035 	case dl_bw_req_deactivate:
4036 		/*
4037 		 * cpu is not off yet, but we need to do the math by
4038 		 * considering it off already (i.e., what would happen if we
4039 		 * turn cpu off?).
4040 		 */
4041 		cap -= arch_scale_cpu_capacity(cpu);
4042 
4043 		/*
4044 		 * cpu is going offline and NORMAL and EXT tasks will be
4045 		 * moved away from it. We can thus discount dl_server
4046 		 * bandwidth contribution as it won't need to be servicing
4047 		 * tasks after the cpu is off.
4048 		 */
4049 		dl_server_bw = dl_server_read_bw(cpu);
4050 
4051 		/*
4052 		 * Not much to check if no DEADLINE bandwidth is present.
4053 		 * dl_servers we can discount, as tasks will be moved out the
4054 		 * offlined CPUs anyway.
4055 		 */
4056 		if (dl_b->total_bw - dl_server_bw > 0) {
4057 			/*
4058 			 * Leaving at least one CPU for DEADLINE tasks seems a
4059 			 * wise thing to do. As said above, cpu is not offline
4060 			 * yet, so account for that.
4061 			 */
4062 			if (dl_bw_cpus(cpu) - 1)
4063 				overflow = __dl_overflow(dl_b, cap, dl_server_bw, 0);
4064 			else
4065 				overflow = 1;
4066 		}
4067 
4068 		break;
4069 	}
4070 
4071 	raw_spin_unlock_irqrestore(&dl_b->lock, flags);
4072 	rcu_read_unlock_sched();
4073 
4074 	return overflow ? -EBUSY : 0;
4075 }
4076 
4077 int dl_bw_deactivate(int cpu)
4078 {
4079 	return dl_bw_manage(dl_bw_req_deactivate, cpu, 0);
4080 }
4081 
4082 int dl_bw_alloc(int cpu, u64 dl_bw)
4083 {
4084 	return dl_bw_manage(dl_bw_req_alloc, cpu, dl_bw);
4085 }
4086 
4087 void dl_bw_free(int cpu, u64 dl_bw)
4088 {
4089 	dl_bw_manage(dl_bw_req_free, cpu, dl_bw);
4090 }
4091 
4092 void print_dl_stats(struct seq_file *m, int cpu)
4093 {
4094 	print_dl_rq(m, cpu, &cpu_rq(cpu)->dl);
4095 }
4096