113 #define rt_entity_is_task(rt_se) (!(rt_se)->my_q)  argument
115 static inline struct task_struct *rt_task_of(struct sched_rt_entity *rt_se)  in rt_task_of()  argument
118 	WARN_ON_ONCE(!rt_entity_is_task(rt_se));  in rt_task_of()
120 	return container_of(rt_se, struct task_struct, rt);  in rt_task_of()
128 static inline struct rt_rq *rt_rq_of_se(struct sched_rt_entity *rt_se)  in rt_rq_of_se()  argument
130 	return rt_se->rt_rq;  in rt_rq_of_se()
133 static inline struct rq *rq_of_rt_se(struct sched_rt_entity *rt_se)  in rq_of_rt_se()  argument
135 	struct rt_rq *rt_rq = rt_se->rt_rq;  in rq_of_rt_se()
144 	if (tg->rt_se)  in free_rt_sched_group()
150 		if (tg->rt_se)  in free_rt_sched_group()
151 			kfree(tg->rt_se[i]);  in free_rt_sched_group()
155 	kfree(tg->rt_se);  in free_rt_sched_group()
159 		struct sched_rt_entity *rt_se, int cpu,  in init_tg_rt_entry()  argument
170 	tg->rt_se[cpu] = rt_se;  in init_tg_rt_entry()
172 	if (!rt_se)  in init_tg_rt_entry()
176 		rt_se->rt_rq = &rq->rt;  in init_tg_rt_entry()
178 		rt_se->rt_rq = parent->my_q;  in init_tg_rt_entry()
180 	rt_se->my_q = rt_rq;  in init_tg_rt_entry()
181 	rt_se->parent = parent;  in init_tg_rt_entry()
182 	INIT_LIST_HEAD(&rt_se->run_list);  in init_tg_rt_entry()
188 	struct sched_rt_entity *rt_se;  in alloc_rt_sched_group()  local
194 	tg->rt_se = kcalloc(nr_cpu_ids, sizeof(rt_se), GFP_KERNEL);  in alloc_rt_sched_group()
195 	if (!tg->rt_se)  in alloc_rt_sched_group()
207 		rt_se = kzalloc_node(sizeof(struct sched_rt_entity),  in alloc_rt_sched_group()
209 		if (!rt_se)  in alloc_rt_sched_group()
214 		init_tg_rt_entry(tg, rt_rq, rt_se, i, parent->rt_se[i]);  in alloc_rt_sched_group()
227 #define rt_entity_is_task(rt_se) (1)  argument
229 static inline struct task_struct *rt_task_of(struct sched_rt_entity *rt_se)  in rt_task_of()  argument
231 	return container_of(rt_se, struct task_struct, rt);  in rt_task_of()
239 static inline struct rq *rq_of_rt_se(struct sched_rt_entity *rt_se)  in rq_of_rt_se()  argument
241 	struct task_struct *p = rt_task_of(rt_se);  in rq_of_rt_se()
246 static inline struct rt_rq *rt_rq_of_se(struct sched_rt_entity *rt_se)  in rt_rq_of_se()  argument
248 	struct rq *rq = rq_of_rt_se(rt_se);  in rt_rq_of_se()
318 static void inc_rt_migration(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)  in inc_rt_migration()  argument
322 	if (!rt_entity_is_task(rt_se))  in inc_rt_migration()
325 	p = rt_task_of(rt_se);  in inc_rt_migration()
335 static void dec_rt_migration(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)  in dec_rt_migration()  argument
339 	if (!rt_entity_is_task(rt_se))  in dec_rt_migration()
342 	p = rt_task_of(rt_se);  in dec_rt_migration()
411 void inc_rt_migration(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)  in inc_rt_migration()  argument
416 void dec_rt_migration(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)  in dec_rt_migration()  argument
437 static inline int on_rt_rq(struct sched_rt_entity *rt_se)  in on_rt_rq()  argument
439 	return rt_se->on_rq;  in on_rt_rq()
516 #define for_each_sched_rt_entity(rt_se) \  argument
517 	for (; rt_se; rt_se = rt_se->parent)
519 static inline struct rt_rq *group_rt_rq(struct sched_rt_entity *rt_se)  in group_rt_rq()  argument
521 	return rt_se->my_q;  in group_rt_rq()
524 static void enqueue_rt_entity(struct sched_rt_entity *rt_se, unsigned int flags);
525 static void dequeue_rt_entity(struct sched_rt_entity *rt_se, unsigned int flags);
531 	struct sched_rt_entity *rt_se;  in sched_rt_rq_enqueue()  local
535 	rt_se = rt_rq->tg->rt_se[cpu];  in sched_rt_rq_enqueue()
538 		if (!rt_se)  in sched_rt_rq_enqueue()
540 		else if (!on_rt_rq(rt_se))  in sched_rt_rq_enqueue()
541 			enqueue_rt_entity(rt_se, 0);  in sched_rt_rq_enqueue()
550 	struct sched_rt_entity *rt_se;  in sched_rt_rq_dequeue()  local
553 	rt_se = rt_rq->tg->rt_se[cpu];  in sched_rt_rq_dequeue()
555 	if (!rt_se) {  in sched_rt_rq_dequeue()
560 	else if (on_rt_rq(rt_se))  in sched_rt_rq_dequeue()
561 		dequeue_rt_entity(rt_se, 0);  in sched_rt_rq_dequeue()
569 static int rt_se_boosted(struct sched_rt_entity *rt_se)  in rt_se_boosted()  argument
571 	struct rt_rq *rt_rq = group_rt_rq(rt_se);  in rt_se_boosted()
577 	p = rt_task_of(rt_se);  in rt_se_boosted()
621 #define for_each_sched_rt_entity(rt_se) \  argument
622 	for (; rt_se; rt_se = NULL)
624 static inline struct rt_rq *group_rt_rq(struct sched_rt_entity *rt_se)  in group_rt_rq()  argument
937 static inline int rt_se_prio(struct sched_rt_entity *rt_se)  in rt_se_prio()  argument
940 	struct rt_rq *rt_rq = group_rt_rq(rt_se);  in rt_se_prio()
946 	return rt_task_of(rt_se)->prio;  in rt_se_prio()
999 	struct sched_rt_entity *rt_se = &curr->rt;  in update_curr_rt()  local
1023 	for_each_sched_rt_entity(rt_se) {  in update_curr_rt()
1024 		struct rt_rq *rt_rq = rt_rq_of_se(rt_se);  in update_curr_rt()
1166 inc_rt_group(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)  in inc_rt_group()  argument
1168 	if (rt_se_boosted(rt_se))  in inc_rt_group()
1176 dec_rt_group(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)  in dec_rt_group()  argument
1178 	if (rt_se_boosted(rt_se))  in dec_rt_group()
1187 inc_rt_group(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)  in inc_rt_group()  argument
1193 void dec_rt_group(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq) {}  in dec_rt_group()  argument
1198 unsigned int rt_se_nr_running(struct sched_rt_entity *rt_se)  in rt_se_nr_running()  argument
1200 	struct rt_rq *group_rq = group_rt_rq(rt_se);  in rt_se_nr_running()
1209 unsigned int rt_se_rr_nr_running(struct sched_rt_entity *rt_se)  in rt_se_rr_nr_running()  argument
1211 	struct rt_rq *group_rq = group_rt_rq(rt_se);  in rt_se_rr_nr_running()
1217 	tsk = rt_task_of(rt_se);  in rt_se_rr_nr_running()
1223 void inc_rt_tasks(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)  in inc_rt_tasks()  argument
1225 	int prio = rt_se_prio(rt_se);  in inc_rt_tasks()
1228 	rt_rq->rt_nr_running += rt_se_nr_running(rt_se);  in inc_rt_tasks()
1229 	rt_rq->rr_nr_running += rt_se_rr_nr_running(rt_se);  in inc_rt_tasks()
1232 	inc_rt_migration(rt_se, rt_rq);  in inc_rt_tasks()
1233 	inc_rt_group(rt_se, rt_rq);  in inc_rt_tasks()
1237 void dec_rt_tasks(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)  in dec_rt_tasks()  argument
1239 	WARN_ON(!rt_prio(rt_se_prio(rt_se)));  in dec_rt_tasks()
1241 	rt_rq->rt_nr_running -= rt_se_nr_running(rt_se);  in dec_rt_tasks()
1242 	rt_rq->rr_nr_running -= rt_se_rr_nr_running(rt_se);  in dec_rt_tasks()
1244 	dec_rt_prio(rt_rq, rt_se_prio(rt_se));  in dec_rt_tasks()
1245 	dec_rt_migration(rt_se, rt_rq);  in dec_rt_tasks()
1246 	dec_rt_group(rt_se, rt_rq);  in dec_rt_tasks()
1262 static void __delist_rt_entity(struct sched_rt_entity *rt_se, struct rt_prio_array *array)  in __delist_rt_entity()  argument
1264 	list_del_init(&rt_se->run_list);  in __delist_rt_entity()
1266 	if (list_empty(array->queue + rt_se_prio(rt_se)))  in __delist_rt_entity()
1267 		__clear_bit(rt_se_prio(rt_se), array->bitmap);  in __delist_rt_entity()
1269 	rt_se->on_list = 0;  in __delist_rt_entity()
1272 static void __enqueue_rt_entity(struct sched_rt_entity *rt_se, unsigned int flags)  in __enqueue_rt_entity()  argument
1274 	struct rt_rq *rt_rq = rt_rq_of_se(rt_se);  in __enqueue_rt_entity()
1276 	struct rt_rq *group_rq = group_rt_rq(rt_se);  in __enqueue_rt_entity()
1277 	struct list_head *queue = array->queue + rt_se_prio(rt_se);  in __enqueue_rt_entity()
1286 		if (rt_se->on_list)  in __enqueue_rt_entity()
1287 			__delist_rt_entity(rt_se, array);  in __enqueue_rt_entity()
1292 		WARN_ON_ONCE(rt_se->on_list);  in __enqueue_rt_entity()
1294 			list_add(&rt_se->run_list, queue);  in __enqueue_rt_entity()
1296 			list_add_tail(&rt_se->run_list, queue);  in __enqueue_rt_entity()
1298 		__set_bit(rt_se_prio(rt_se), array->bitmap);  in __enqueue_rt_entity()
1299 		rt_se->on_list = 1;  in __enqueue_rt_entity()
1301 	rt_se->on_rq = 1;  in __enqueue_rt_entity()
1303 	inc_rt_tasks(rt_se, rt_rq);  in __enqueue_rt_entity()
1306 static void __dequeue_rt_entity(struct sched_rt_entity *rt_se, unsigned int flags)  in __dequeue_rt_entity()  argument
1308 	struct rt_rq *rt_rq = rt_rq_of_se(rt_se);  in __dequeue_rt_entity()
1312 		WARN_ON_ONCE(!rt_se->on_list);  in __dequeue_rt_entity()
1313 		__delist_rt_entity(rt_se, array);  in __dequeue_rt_entity()
1315 	rt_se->on_rq = 0;  in __dequeue_rt_entity()
1317 	dec_rt_tasks(rt_se, rt_rq);  in __dequeue_rt_entity()
1324 static void dequeue_rt_stack(struct sched_rt_entity *rt_se, unsigned int flags)  in dequeue_rt_stack()  argument
1328 	for_each_sched_rt_entity(rt_se) {  in dequeue_rt_stack()
1329 		rt_se->back = back;  in dequeue_rt_stack()
1330 		back = rt_se;  in dequeue_rt_stack()
1335 	for (rt_se = back; rt_se; rt_se = rt_se->back) {  in dequeue_rt_stack()
1336 		if (on_rt_rq(rt_se))  in dequeue_rt_stack()
1337 			__dequeue_rt_entity(rt_se, flags);  in dequeue_rt_stack()
1341 static void enqueue_rt_entity(struct sched_rt_entity *rt_se, unsigned int flags)  in enqueue_rt_entity()  argument
1343 	struct rq *rq = rq_of_rt_se(rt_se);  in enqueue_rt_entity()
1345 	dequeue_rt_stack(rt_se, flags);  in enqueue_rt_entity()
1346 	for_each_sched_rt_entity(rt_se)  in enqueue_rt_entity()
1347 		__enqueue_rt_entity(rt_se, flags);  in enqueue_rt_entity()
1351 static void dequeue_rt_entity(struct sched_rt_entity *rt_se, unsigned int flags)  in dequeue_rt_entity()  argument
1353 	struct rq *rq = rq_of_rt_se(rt_se);  in dequeue_rt_entity()
1355 	dequeue_rt_stack(rt_se, flags);  in dequeue_rt_entity()
1357 	for_each_sched_rt_entity(rt_se) {  in dequeue_rt_entity()
1358 		struct rt_rq *rt_rq = group_rt_rq(rt_se);  in dequeue_rt_entity()
1361 			__enqueue_rt_entity(rt_se, flags);  in dequeue_rt_entity()
1372 	struct sched_rt_entity *rt_se = &p->rt;  in enqueue_task_rt()  local
1375 		rt_se->timeout = 0;  in enqueue_task_rt()
1377 	enqueue_rt_entity(rt_se, flags);  in enqueue_task_rt()
1385 	struct sched_rt_entity *rt_se = &p->rt;  in dequeue_task_rt()  local
1388 	dequeue_rt_entity(rt_se, flags);  in dequeue_task_rt()
1398 requeue_rt_entity(struct rt_rq *rt_rq, struct sched_rt_entity *rt_se, int head)  in requeue_rt_entity()  argument
1400 	if (on_rt_rq(rt_se)) {  in requeue_rt_entity()
1402 		struct list_head *queue = array->queue + rt_se_prio(rt_se);  in requeue_rt_entity()
1405 			list_move(&rt_se->run_list, queue);  in requeue_rt_entity()
1407 			list_move_tail(&rt_se->run_list, queue);  in requeue_rt_entity()
1413 	struct sched_rt_entity *rt_se = &p->rt;  in requeue_task_rt()  local
1416 	for_each_sched_rt_entity(rt_se) {  in requeue_task_rt()
1417 		rt_rq = rt_rq_of_se(rt_se);  in requeue_task_rt()
1418 		requeue_rt_entity(rt_rq, rt_se, head);  in requeue_task_rt()
1615 	struct sched_rt_entity *rt_se;  in _pick_next_task_rt()  local
1619 		rt_se = pick_next_rt_entity(rq, rt_rq);  in _pick_next_task_rt()
1620 		BUG_ON(!rt_se);  in _pick_next_task_rt()
1621 		rt_rq = group_rt_rq(rt_se);  in _pick_next_task_rt()
1624 	return rt_task_of(rt_se);  in _pick_next_task_rt()
2389 	struct sched_rt_entity *rt_se = &p->rt;  in task_tick_rt()  local
2412 	for_each_sched_rt_entity(rt_se) {  in task_tick_rt()
2413 		if (rt_se->run_list.prev != rt_se->run_list.next) {  in task_tick_rt()