sched_rt.c 39 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682
  1. /*
  2. * Real-Time Scheduling Class (mapped to the SCHED_FIFO and SCHED_RR
  3. * policies)
  4. */
  5. #ifdef CONFIG_SMP
  6. static inline int rt_overloaded(struct rq *rq)
  7. {
  8. return atomic_read(&rq->rd->rto_count);
  9. }
  10. static inline void rt_set_overload(struct rq *rq)
  11. {
  12. if (!rq->online)
  13. return;
  14. cpumask_set_cpu(rq->cpu, rq->rd->rto_mask);
  15. /*
  16. * Make sure the mask is visible before we set
  17. * the overload count. That is checked to determine
  18. * if we should look at the mask. It would be a shame
  19. * if we looked at the mask, but the mask was not
  20. * updated yet.
  21. */
  22. wmb();
  23. atomic_inc(&rq->rd->rto_count);
  24. }
  25. static inline void rt_clear_overload(struct rq *rq)
  26. {
  27. if (!rq->online)
  28. return;
  29. /* the order here really doesn't matter */
  30. atomic_dec(&rq->rd->rto_count);
  31. cpumask_clear_cpu(rq->cpu, rq->rd->rto_mask);
  32. }
  33. static void update_rt_migration(struct rq *rq)
  34. {
  35. if (rq->rt.rt_nr_migratory && (rq->rt.rt_nr_running > 1)) {
  36. if (!rq->rt.overloaded) {
  37. rt_set_overload(rq);
  38. rq->rt.overloaded = 1;
  39. }
  40. } else if (rq->rt.overloaded) {
  41. rt_clear_overload(rq);
  42. rq->rt.overloaded = 0;
  43. }
  44. }
  45. static void enqueue_pushable_task(struct rq *rq, struct task_struct *p)
  46. {
  47. plist_del(&p->pushable_tasks, &rq->rt.pushable_tasks);
  48. plist_node_init(&p->pushable_tasks, p->prio);
  49. plist_add(&p->pushable_tasks, &rq->rt.pushable_tasks);
  50. }
  51. static void dequeue_pushable_task(struct rq *rq, struct task_struct *p)
  52. {
  53. plist_del(&p->pushable_tasks, &rq->rt.pushable_tasks);
  54. }
  55. #else
  56. #define enqueue_pushable_task(rq, p) do { } while (0)
  57. #define dequeue_pushable_task(rq, p) do { } while (0)
  58. #endif /* CONFIG_SMP */
  59. static inline struct task_struct *rt_task_of(struct sched_rt_entity *rt_se)
  60. {
  61. return container_of(rt_se, struct task_struct, rt);
  62. }
  63. static inline int on_rt_rq(struct sched_rt_entity *rt_se)
  64. {
  65. return !list_empty(&rt_se->run_list);
  66. }
  67. #ifdef CONFIG_RT_GROUP_SCHED
  68. static inline u64 sched_rt_runtime(struct rt_rq *rt_rq)
  69. {
  70. if (!rt_rq->tg)
  71. return RUNTIME_INF;
  72. return rt_rq->rt_runtime;
  73. }
  74. static inline u64 sched_rt_period(struct rt_rq *rt_rq)
  75. {
  76. return ktime_to_ns(rt_rq->tg->rt_bandwidth.rt_period);
  77. }
  78. #define for_each_leaf_rt_rq(rt_rq, rq) \
  79. list_for_each_entry(rt_rq, &rq->leaf_rt_rq_list, leaf_rt_rq_list)
  80. static inline struct rq *rq_of_rt_rq(struct rt_rq *rt_rq)
  81. {
  82. return rt_rq->rq;
  83. }
  84. static inline struct rt_rq *rt_rq_of_se(struct sched_rt_entity *rt_se)
  85. {
  86. return rt_se->rt_rq;
  87. }
  88. #define for_each_sched_rt_entity(rt_se) \
  89. for (; rt_se; rt_se = rt_se->parent)
  90. static inline struct rt_rq *group_rt_rq(struct sched_rt_entity *rt_se)
  91. {
  92. return rt_se->my_q;
  93. }
  94. static void enqueue_rt_entity(struct sched_rt_entity *rt_se);
  95. static void dequeue_rt_entity(struct sched_rt_entity *rt_se);
  96. static void sched_rt_rq_enqueue(struct rt_rq *rt_rq)
  97. {
  98. struct task_struct *curr = rq_of_rt_rq(rt_rq)->curr;
  99. struct sched_rt_entity *rt_se = rt_rq->rt_se;
  100. if (rt_rq->rt_nr_running) {
  101. if (rt_se && !on_rt_rq(rt_se))
  102. enqueue_rt_entity(rt_se);
  103. if (rt_rq->highest_prio.curr < curr->prio)
  104. resched_task(curr);
  105. }
  106. }
  107. static void sched_rt_rq_dequeue(struct rt_rq *rt_rq)
  108. {
  109. struct sched_rt_entity *rt_se = rt_rq->rt_se;
  110. if (rt_se && on_rt_rq(rt_se))
  111. dequeue_rt_entity(rt_se);
  112. }
  113. static inline int rt_rq_throttled(struct rt_rq *rt_rq)
  114. {
  115. return rt_rq->rt_throttled && !rt_rq->rt_nr_boosted;
  116. }
  117. static int rt_se_boosted(struct sched_rt_entity *rt_se)
  118. {
  119. struct rt_rq *rt_rq = group_rt_rq(rt_se);
  120. struct task_struct *p;
  121. if (rt_rq)
  122. return !!rt_rq->rt_nr_boosted;
  123. p = rt_task_of(rt_se);
  124. return p->prio != p->normal_prio;
  125. }
  126. #ifdef CONFIG_SMP
  127. static inline const struct cpumask *sched_rt_period_mask(void)
  128. {
  129. return cpu_rq(smp_processor_id())->rd->span;
  130. }
  131. #else
  132. static inline const struct cpumask *sched_rt_period_mask(void)
  133. {
  134. return cpu_online_mask;
  135. }
  136. #endif
  137. static inline
  138. struct rt_rq *sched_rt_period_rt_rq(struct rt_bandwidth *rt_b, int cpu)
  139. {
  140. return container_of(rt_b, struct task_group, rt_bandwidth)->rt_rq[cpu];
  141. }
  142. static inline struct rt_bandwidth *sched_rt_bandwidth(struct rt_rq *rt_rq)
  143. {
  144. return &rt_rq->tg->rt_bandwidth;
  145. }
  146. #else /* !CONFIG_RT_GROUP_SCHED */
  147. static inline u64 sched_rt_runtime(struct rt_rq *rt_rq)
  148. {
  149. return rt_rq->rt_runtime;
  150. }
  151. static inline u64 sched_rt_period(struct rt_rq *rt_rq)
  152. {
  153. return ktime_to_ns(def_rt_bandwidth.rt_period);
  154. }
  155. #define for_each_leaf_rt_rq(rt_rq, rq) \
  156. for (rt_rq = &rq->rt; rt_rq; rt_rq = NULL)
  157. static inline struct rq *rq_of_rt_rq(struct rt_rq *rt_rq)
  158. {
  159. return container_of(rt_rq, struct rq, rt);
  160. }
  161. static inline struct rt_rq *rt_rq_of_se(struct sched_rt_entity *rt_se)
  162. {
  163. struct task_struct *p = rt_task_of(rt_se);
  164. struct rq *rq = task_rq(p);
  165. return &rq->rt;
  166. }
  167. #define for_each_sched_rt_entity(rt_se) \
  168. for (; rt_se; rt_se = NULL)
  169. static inline struct rt_rq *group_rt_rq(struct sched_rt_entity *rt_se)
  170. {
  171. return NULL;
  172. }
  173. static inline void sched_rt_rq_enqueue(struct rt_rq *rt_rq)
  174. {
  175. if (rt_rq->rt_nr_running)
  176. resched_task(rq_of_rt_rq(rt_rq)->curr);
  177. }
  178. static inline void sched_rt_rq_dequeue(struct rt_rq *rt_rq)
  179. {
  180. }
  181. static inline int rt_rq_throttled(struct rt_rq *rt_rq)
  182. {
  183. return rt_rq->rt_throttled;
  184. }
  185. static inline const struct cpumask *sched_rt_period_mask(void)
  186. {
  187. return cpu_online_mask;
  188. }
  189. static inline
  190. struct rt_rq *sched_rt_period_rt_rq(struct rt_bandwidth *rt_b, int cpu)
  191. {
  192. return &cpu_rq(cpu)->rt;
  193. }
  194. static inline struct rt_bandwidth *sched_rt_bandwidth(struct rt_rq *rt_rq)
  195. {
  196. return &def_rt_bandwidth;
  197. }
  198. #endif /* CONFIG_RT_GROUP_SCHED */
  199. #ifdef CONFIG_SMP
  200. /*
  201. * We ran out of runtime, see if we can borrow some from our neighbours.
  202. */
  203. static int do_balance_runtime(struct rt_rq *rt_rq)
  204. {
  205. struct rt_bandwidth *rt_b = sched_rt_bandwidth(rt_rq);
  206. struct root_domain *rd = cpu_rq(smp_processor_id())->rd;
  207. int i, weight, more = 0;
  208. u64 rt_period;
  209. weight = cpumask_weight(rd->span);
  210. spin_lock(&rt_b->rt_runtime_lock);
  211. rt_period = ktime_to_ns(rt_b->rt_period);
  212. for_each_cpu(i, rd->span) {
  213. struct rt_rq *iter = sched_rt_period_rt_rq(rt_b, i);
  214. s64 diff;
  215. if (iter == rt_rq)
  216. continue;
  217. spin_lock(&iter->rt_runtime_lock);
  218. /*
  219. * Either all rqs have inf runtime and there's nothing to steal
  220. * or __disable_runtime() below sets a specific rq to inf to
  221. * indicate its been disabled and disalow stealing.
  222. */
  223. if (iter->rt_runtime == RUNTIME_INF)
  224. goto next;
  225. /*
  226. * From runqueues with spare time, take 1/n part of their
  227. * spare time, but no more than our period.
  228. */
  229. diff = iter->rt_runtime - iter->rt_time;
  230. if (diff > 0) {
  231. diff = div_u64((u64)diff, weight);
  232. if (rt_rq->rt_runtime + diff > rt_period)
  233. diff = rt_period - rt_rq->rt_runtime;
  234. iter->rt_runtime -= diff;
  235. rt_rq->rt_runtime += diff;
  236. more = 1;
  237. if (rt_rq->rt_runtime == rt_period) {
  238. spin_unlock(&iter->rt_runtime_lock);
  239. break;
  240. }
  241. }
  242. next:
  243. spin_unlock(&iter->rt_runtime_lock);
  244. }
  245. spin_unlock(&rt_b->rt_runtime_lock);
  246. return more;
  247. }
  248. /*
  249. * Ensure this RQ takes back all the runtime it lend to its neighbours.
  250. */
  251. static void __disable_runtime(struct rq *rq)
  252. {
  253. struct root_domain *rd = rq->rd;
  254. struct rt_rq *rt_rq;
  255. if (unlikely(!scheduler_running))
  256. return;
  257. for_each_leaf_rt_rq(rt_rq, rq) {
  258. struct rt_bandwidth *rt_b = sched_rt_bandwidth(rt_rq);
  259. s64 want;
  260. int i;
  261. spin_lock(&rt_b->rt_runtime_lock);
  262. spin_lock(&rt_rq->rt_runtime_lock);
  263. /*
  264. * Either we're all inf and nobody needs to borrow, or we're
  265. * already disabled and thus have nothing to do, or we have
  266. * exactly the right amount of runtime to take out.
  267. */
  268. if (rt_rq->rt_runtime == RUNTIME_INF ||
  269. rt_rq->rt_runtime == rt_b->rt_runtime)
  270. goto balanced;
  271. spin_unlock(&rt_rq->rt_runtime_lock);
  272. /*
  273. * Calculate the difference between what we started out with
  274. * and what we current have, that's the amount of runtime
  275. * we lend and now have to reclaim.
  276. */
  277. want = rt_b->rt_runtime - rt_rq->rt_runtime;
  278. /*
  279. * Greedy reclaim, take back as much as we can.
  280. */
  281. for_each_cpu(i, rd->span) {
  282. struct rt_rq *iter = sched_rt_period_rt_rq(rt_b, i);
  283. s64 diff;
  284. /*
  285. * Can't reclaim from ourselves or disabled runqueues.
  286. */
  287. if (iter == rt_rq || iter->rt_runtime == RUNTIME_INF)
  288. continue;
  289. spin_lock(&iter->rt_runtime_lock);
  290. if (want > 0) {
  291. diff = min_t(s64, iter->rt_runtime, want);
  292. iter->rt_runtime -= diff;
  293. want -= diff;
  294. } else {
  295. iter->rt_runtime -= want;
  296. want -= want;
  297. }
  298. spin_unlock(&iter->rt_runtime_lock);
  299. if (!want)
  300. break;
  301. }
  302. spin_lock(&rt_rq->rt_runtime_lock);
  303. /*
  304. * We cannot be left wanting - that would mean some runtime
  305. * leaked out of the system.
  306. */
  307. BUG_ON(want);
  308. balanced:
  309. /*
  310. * Disable all the borrow logic by pretending we have inf
  311. * runtime - in which case borrowing doesn't make sense.
  312. */
  313. rt_rq->rt_runtime = RUNTIME_INF;
  314. spin_unlock(&rt_rq->rt_runtime_lock);
  315. spin_unlock(&rt_b->rt_runtime_lock);
  316. }
  317. }
  318. static void disable_runtime(struct rq *rq)
  319. {
  320. unsigned long flags;
  321. spin_lock_irqsave(&rq->lock, flags);
  322. __disable_runtime(rq);
  323. spin_unlock_irqrestore(&rq->lock, flags);
  324. }
  325. static void __enable_runtime(struct rq *rq)
  326. {
  327. struct rt_rq *rt_rq;
  328. if (unlikely(!scheduler_running))
  329. return;
  330. /*
  331. * Reset each runqueue's bandwidth settings
  332. */
  333. for_each_leaf_rt_rq(rt_rq, rq) {
  334. struct rt_bandwidth *rt_b = sched_rt_bandwidth(rt_rq);
  335. spin_lock(&rt_b->rt_runtime_lock);
  336. spin_lock(&rt_rq->rt_runtime_lock);
  337. rt_rq->rt_runtime = rt_b->rt_runtime;
  338. rt_rq->rt_time = 0;
  339. rt_rq->rt_throttled = 0;
  340. spin_unlock(&rt_rq->rt_runtime_lock);
  341. spin_unlock(&rt_b->rt_runtime_lock);
  342. }
  343. }
  344. static void enable_runtime(struct rq *rq)
  345. {
  346. unsigned long flags;
  347. spin_lock_irqsave(&rq->lock, flags);
  348. __enable_runtime(rq);
  349. spin_unlock_irqrestore(&rq->lock, flags);
  350. }
  351. static int balance_runtime(struct rt_rq *rt_rq)
  352. {
  353. int more = 0;
  354. if (rt_rq->rt_time > rt_rq->rt_runtime) {
  355. spin_unlock(&rt_rq->rt_runtime_lock);
  356. more = do_balance_runtime(rt_rq);
  357. spin_lock(&rt_rq->rt_runtime_lock);
  358. }
  359. return more;
  360. }
  361. #else /* !CONFIG_SMP */
  362. static inline int balance_runtime(struct rt_rq *rt_rq)
  363. {
  364. return 0;
  365. }
  366. #endif /* CONFIG_SMP */
  367. static int do_sched_rt_period_timer(struct rt_bandwidth *rt_b, int overrun)
  368. {
  369. int i, idle = 1;
  370. const struct cpumask *span;
  371. if (!rt_bandwidth_enabled() || rt_b->rt_runtime == RUNTIME_INF)
  372. return 1;
  373. span = sched_rt_period_mask();
  374. for_each_cpu(i, span) {
  375. int enqueue = 0;
  376. struct rt_rq *rt_rq = sched_rt_period_rt_rq(rt_b, i);
  377. struct rq *rq = rq_of_rt_rq(rt_rq);
  378. spin_lock(&rq->lock);
  379. if (rt_rq->rt_time) {
  380. u64 runtime;
  381. spin_lock(&rt_rq->rt_runtime_lock);
  382. if (rt_rq->rt_throttled)
  383. balance_runtime(rt_rq);
  384. runtime = rt_rq->rt_runtime;
  385. rt_rq->rt_time -= min(rt_rq->rt_time, overrun*runtime);
  386. if (rt_rq->rt_throttled && rt_rq->rt_time < runtime) {
  387. rt_rq->rt_throttled = 0;
  388. enqueue = 1;
  389. }
  390. if (rt_rq->rt_time || rt_rq->rt_nr_running)
  391. idle = 0;
  392. spin_unlock(&rt_rq->rt_runtime_lock);
  393. } else if (rt_rq->rt_nr_running)
  394. idle = 0;
  395. if (enqueue)
  396. sched_rt_rq_enqueue(rt_rq);
  397. spin_unlock(&rq->lock);
  398. }
  399. return idle;
  400. }
  401. static inline int rt_se_prio(struct sched_rt_entity *rt_se)
  402. {
  403. #ifdef CONFIG_RT_GROUP_SCHED
  404. struct rt_rq *rt_rq = group_rt_rq(rt_se);
  405. if (rt_rq)
  406. return rt_rq->highest_prio.curr;
  407. #endif
  408. return rt_task_of(rt_se)->prio;
  409. }
  410. static int sched_rt_runtime_exceeded(struct rt_rq *rt_rq)
  411. {
  412. u64 runtime = sched_rt_runtime(rt_rq);
  413. if (rt_rq->rt_throttled)
  414. return rt_rq_throttled(rt_rq);
  415. if (sched_rt_runtime(rt_rq) >= sched_rt_period(rt_rq))
  416. return 0;
  417. balance_runtime(rt_rq);
  418. runtime = sched_rt_runtime(rt_rq);
  419. if (runtime == RUNTIME_INF)
  420. return 0;
  421. if (rt_rq->rt_time > runtime) {
  422. rt_rq->rt_throttled = 1;
  423. if (rt_rq_throttled(rt_rq)) {
  424. sched_rt_rq_dequeue(rt_rq);
  425. return 1;
  426. }
  427. }
  428. return 0;
  429. }
  430. /*
  431. * Update the current task's runtime statistics. Skip current tasks that
  432. * are not in our scheduling class.
  433. */
  434. static void update_curr_rt(struct rq *rq)
  435. {
  436. struct task_struct *curr = rq->curr;
  437. struct sched_rt_entity *rt_se = &curr->rt;
  438. struct rt_rq *rt_rq = rt_rq_of_se(rt_se);
  439. u64 delta_exec;
  440. if (!task_has_rt_policy(curr))
  441. return;
  442. delta_exec = rq->clock - curr->se.exec_start;
  443. if (unlikely((s64)delta_exec < 0))
  444. delta_exec = 0;
  445. schedstat_set(curr->se.exec_max, max(curr->se.exec_max, delta_exec));
  446. curr->se.sum_exec_runtime += delta_exec;
  447. account_group_exec_runtime(curr, delta_exec);
  448. curr->se.exec_start = rq->clock;
  449. cpuacct_charge(curr, delta_exec);
  450. if (!rt_bandwidth_enabled())
  451. return;
  452. for_each_sched_rt_entity(rt_se) {
  453. rt_rq = rt_rq_of_se(rt_se);
  454. if (sched_rt_runtime(rt_rq) != RUNTIME_INF) {
  455. spin_lock(&rt_rq->rt_runtime_lock);
  456. rt_rq->rt_time += delta_exec;
  457. if (sched_rt_runtime_exceeded(rt_rq))
  458. resched_task(curr);
  459. spin_unlock(&rt_rq->rt_runtime_lock);
  460. }
  461. }
  462. }
  463. #if defined CONFIG_SMP || defined CONFIG_RT_GROUP_SCHED
  464. static struct task_struct *pick_next_highest_task_rt(struct rq *rq, int cpu);
  465. static inline int next_prio(struct rq *rq)
  466. {
  467. struct task_struct *next = pick_next_highest_task_rt(rq, rq->cpu);
  468. if (next && rt_prio(next->prio))
  469. return next->prio;
  470. else
  471. return MAX_RT_PRIO;
  472. }
  473. #endif
  474. static inline
  475. void inc_rt_tasks(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)
  476. {
  477. int prio = rt_se_prio(rt_se);
  478. #ifdef CONFIG_SMP
  479. struct rq *rq = rq_of_rt_rq(rt_rq);
  480. #endif
  481. WARN_ON(!rt_prio(prio));
  482. rt_rq->rt_nr_running++;
  483. #if defined CONFIG_SMP || defined CONFIG_RT_GROUP_SCHED
  484. if (prio < rt_rq->highest_prio.curr) {
  485. /*
  486. * If the new task is higher in priority than anything on the
  487. * run-queue, we have a new high that must be published to
  488. * the world. We also know that the previous high becomes
  489. * our next-highest.
  490. */
  491. rt_rq->highest_prio.next = rt_rq->highest_prio.curr;
  492. rt_rq->highest_prio.curr = prio;
  493. #ifdef CONFIG_SMP
  494. if (rq->online)
  495. cpupri_set(&rq->rd->cpupri, rq->cpu, prio);
  496. #endif
  497. } else if (prio == rt_rq->highest_prio.curr)
  498. /*
  499. * If the next task is equal in priority to the highest on
  500. * the run-queue, then we implicitly know that the next highest
  501. * task cannot be any lower than current
  502. */
  503. rt_rq->highest_prio.next = prio;
  504. else if (prio < rt_rq->highest_prio.next)
  505. /*
  506. * Otherwise, we need to recompute next-highest
  507. */
  508. rt_rq->highest_prio.next = next_prio(rq);
  509. #endif
  510. #ifdef CONFIG_SMP
  511. if (rt_se->nr_cpus_allowed > 1)
  512. rq->rt.rt_nr_migratory++;
  513. update_rt_migration(rq);
  514. #endif
  515. #ifdef CONFIG_RT_GROUP_SCHED
  516. if (rt_se_boosted(rt_se))
  517. rt_rq->rt_nr_boosted++;
  518. if (rt_rq->tg)
  519. start_rt_bandwidth(&rt_rq->tg->rt_bandwidth);
  520. #else
  521. start_rt_bandwidth(&def_rt_bandwidth);
  522. #endif
  523. }
  524. static inline
  525. void dec_rt_tasks(struct sched_rt_entity *rt_se, struct rt_rq *rt_rq)
  526. {
  527. #ifdef CONFIG_SMP
  528. struct rq *rq = rq_of_rt_rq(rt_rq);
  529. int highest_prio = rt_rq->highest_prio.curr;
  530. #endif
  531. WARN_ON(!rt_prio(rt_se_prio(rt_se)));
  532. WARN_ON(!rt_rq->rt_nr_running);
  533. rt_rq->rt_nr_running--;
  534. #if defined CONFIG_SMP || defined CONFIG_RT_GROUP_SCHED
  535. if (rt_rq->rt_nr_running) {
  536. int prio = rt_se_prio(rt_se);
  537. WARN_ON(prio < rt_rq->highest_prio.curr);
  538. /*
  539. * This may have been our highest or next-highest priority
  540. * task and therefore we may have some recomputation to do
  541. */
  542. if (prio == rt_rq->highest_prio.curr) {
  543. struct rt_prio_array *array = &rt_rq->active;
  544. rt_rq->highest_prio.curr =
  545. sched_find_first_bit(array->bitmap);
  546. }
  547. if (prio <= rt_rq->highest_prio.next)
  548. rt_rq->highest_prio.next = next_prio(rq);
  549. } else
  550. rt_rq->highest_prio.curr = MAX_RT_PRIO;
  551. #endif
  552. #ifdef CONFIG_SMP
  553. if (rt_se->nr_cpus_allowed > 1)
  554. rq->rt.rt_nr_migratory--;
  555. if (rq->online && rt_rq->highest_prio.curr != highest_prio)
  556. cpupri_set(&rq->rd->cpupri, rq->cpu, rt_rq->highest_prio.curr);
  557. update_rt_migration(rq);
  558. #endif /* CONFIG_SMP */
  559. #ifdef CONFIG_RT_GROUP_SCHED
  560. if (rt_se_boosted(rt_se))
  561. rt_rq->rt_nr_boosted--;
  562. WARN_ON(!rt_rq->rt_nr_running && rt_rq->rt_nr_boosted);
  563. #endif
  564. }
  565. static void __enqueue_rt_entity(struct sched_rt_entity *rt_se)
  566. {
  567. struct rt_rq *rt_rq = rt_rq_of_se(rt_se);
  568. struct rt_prio_array *array = &rt_rq->active;
  569. struct rt_rq *group_rq = group_rt_rq(rt_se);
  570. struct list_head *queue = array->queue + rt_se_prio(rt_se);
  571. /*
  572. * Don't enqueue the group if its throttled, or when empty.
  573. * The latter is a consequence of the former when a child group
  574. * get throttled and the current group doesn't have any other
  575. * active members.
  576. */
  577. if (group_rq && (rt_rq_throttled(group_rq) || !group_rq->rt_nr_running))
  578. return;
  579. list_add_tail(&rt_se->run_list, queue);
  580. __set_bit(rt_se_prio(rt_se), array->bitmap);
  581. inc_rt_tasks(rt_se, rt_rq);
  582. }
  583. static void __dequeue_rt_entity(struct sched_rt_entity *rt_se)
  584. {
  585. struct rt_rq *rt_rq = rt_rq_of_se(rt_se);
  586. struct rt_prio_array *array = &rt_rq->active;
  587. list_del_init(&rt_se->run_list);
  588. if (list_empty(array->queue + rt_se_prio(rt_se)))
  589. __clear_bit(rt_se_prio(rt_se), array->bitmap);
  590. dec_rt_tasks(rt_se, rt_rq);
  591. }
  592. /*
  593. * Because the prio of an upper entry depends on the lower
  594. * entries, we must remove entries top - down.
  595. */
  596. static void dequeue_rt_stack(struct sched_rt_entity *rt_se)
  597. {
  598. struct sched_rt_entity *back = NULL;
  599. for_each_sched_rt_entity(rt_se) {
  600. rt_se->back = back;
  601. back = rt_se;
  602. }
  603. for (rt_se = back; rt_se; rt_se = rt_se->back) {
  604. if (on_rt_rq(rt_se))
  605. __dequeue_rt_entity(rt_se);
  606. }
  607. }
  608. static void enqueue_rt_entity(struct sched_rt_entity *rt_se)
  609. {
  610. dequeue_rt_stack(rt_se);
  611. for_each_sched_rt_entity(rt_se)
  612. __enqueue_rt_entity(rt_se);
  613. }
  614. static void dequeue_rt_entity(struct sched_rt_entity *rt_se)
  615. {
  616. dequeue_rt_stack(rt_se);
  617. for_each_sched_rt_entity(rt_se) {
  618. struct rt_rq *rt_rq = group_rt_rq(rt_se);
  619. if (rt_rq && rt_rq->rt_nr_running)
  620. __enqueue_rt_entity(rt_se);
  621. }
  622. }
  623. /*
  624. * Adding/removing a task to/from a priority array:
  625. */
  626. static void enqueue_task_rt(struct rq *rq, struct task_struct *p, int wakeup)
  627. {
  628. struct sched_rt_entity *rt_se = &p->rt;
  629. if (wakeup)
  630. rt_se->timeout = 0;
  631. enqueue_rt_entity(rt_se);
  632. if (!task_current(rq, p) && p->rt.nr_cpus_allowed > 1)
  633. enqueue_pushable_task(rq, p);
  634. inc_cpu_load(rq, p->se.load.weight);
  635. }
  636. static void dequeue_task_rt(struct rq *rq, struct task_struct *p, int sleep)
  637. {
  638. struct sched_rt_entity *rt_se = &p->rt;
  639. update_curr_rt(rq);
  640. dequeue_rt_entity(rt_se);
  641. dequeue_pushable_task(rq, p);
  642. dec_cpu_load(rq, p->se.load.weight);
  643. }
  644. /*
  645. * Put task to the end of the run list without the overhead of dequeue
  646. * followed by enqueue.
  647. */
  648. static void
  649. requeue_rt_entity(struct rt_rq *rt_rq, struct sched_rt_entity *rt_se, int head)
  650. {
  651. if (on_rt_rq(rt_se)) {
  652. struct rt_prio_array *array = &rt_rq->active;
  653. struct list_head *queue = array->queue + rt_se_prio(rt_se);
  654. if (head)
  655. list_move(&rt_se->run_list, queue);
  656. else
  657. list_move_tail(&rt_se->run_list, queue);
  658. }
  659. }
  660. static void requeue_task_rt(struct rq *rq, struct task_struct *p, int head)
  661. {
  662. struct sched_rt_entity *rt_se = &p->rt;
  663. struct rt_rq *rt_rq;
  664. for_each_sched_rt_entity(rt_se) {
  665. rt_rq = rt_rq_of_se(rt_se);
  666. requeue_rt_entity(rt_rq, rt_se, head);
  667. }
  668. }
  669. static void yield_task_rt(struct rq *rq)
  670. {
  671. requeue_task_rt(rq, rq->curr, 0);
  672. }
  673. #ifdef CONFIG_SMP
  674. static int find_lowest_rq(struct task_struct *task);
  675. static int select_task_rq_rt(struct task_struct *p, int sync)
  676. {
  677. struct rq *rq = task_rq(p);
  678. /*
  679. * If the current task is an RT task, then
  680. * try to see if we can wake this RT task up on another
  681. * runqueue. Otherwise simply start this RT task
  682. * on its current runqueue.
  683. *
  684. * We want to avoid overloading runqueues. Even if
  685. * the RT task is of higher priority than the current RT task.
  686. * RT tasks behave differently than other tasks. If
  687. * one gets preempted, we try to push it off to another queue.
  688. * So trying to keep a preempting RT task on the same
  689. * cache hot CPU will force the running RT task to
  690. * a cold CPU. So we waste all the cache for the lower
  691. * RT task in hopes of saving some of a RT task
  692. * that is just being woken and probably will have
  693. * cold cache anyway.
  694. */
  695. if (unlikely(rt_task(rq->curr)) &&
  696. (p->rt.nr_cpus_allowed > 1)) {
  697. int cpu = find_lowest_rq(p);
  698. return (cpu == -1) ? task_cpu(p) : cpu;
  699. }
  700. /*
  701. * Otherwise, just let it ride on the affined RQ and the
  702. * post-schedule router will push the preempted task away
  703. */
  704. return task_cpu(p);
  705. }
  706. static void check_preempt_equal_prio(struct rq *rq, struct task_struct *p)
  707. {
  708. cpumask_var_t mask;
  709. if (rq->curr->rt.nr_cpus_allowed == 1)
  710. return;
  711. if (!alloc_cpumask_var(&mask, GFP_ATOMIC))
  712. return;
  713. if (p->rt.nr_cpus_allowed != 1
  714. && cpupri_find(&rq->rd->cpupri, p, mask))
  715. goto free;
  716. if (!cpupri_find(&rq->rd->cpupri, rq->curr, mask))
  717. goto free;
  718. /*
  719. * There appears to be other cpus that can accept
  720. * current and none to run 'p', so lets reschedule
  721. * to try and push current away:
  722. */
  723. requeue_task_rt(rq, p, 1);
  724. resched_task(rq->curr);
  725. free:
  726. free_cpumask_var(mask);
  727. }
  728. #endif /* CONFIG_SMP */
  729. /*
  730. * Preempt the current task with a newly woken task if needed:
  731. */
  732. static void check_preempt_curr_rt(struct rq *rq, struct task_struct *p, int sync)
  733. {
  734. if (p->prio < rq->curr->prio) {
  735. resched_task(rq->curr);
  736. return;
  737. }
  738. #ifdef CONFIG_SMP
  739. /*
  740. * If:
  741. *
  742. * - the newly woken task is of equal priority to the current task
  743. * - the newly woken task is non-migratable while current is migratable
  744. * - current will be preempted on the next reschedule
  745. *
  746. * we should check to see if current can readily move to a different
  747. * cpu. If so, we will reschedule to allow the push logic to try
  748. * to move current somewhere else, making room for our non-migratable
  749. * task.
  750. */
  751. if (p->prio == rq->curr->prio && !need_resched())
  752. check_preempt_equal_prio(rq, p);
  753. #endif
  754. }
  755. static struct sched_rt_entity *pick_next_rt_entity(struct rq *rq,
  756. struct rt_rq *rt_rq)
  757. {
  758. struct rt_prio_array *array = &rt_rq->active;
  759. struct sched_rt_entity *next = NULL;
  760. struct list_head *queue;
  761. int idx;
  762. idx = sched_find_first_bit(array->bitmap);
  763. BUG_ON(idx >= MAX_RT_PRIO);
  764. queue = array->queue + idx;
  765. next = list_entry(queue->next, struct sched_rt_entity, run_list);
  766. return next;
  767. }
  768. static struct task_struct *_pick_next_task_rt(struct rq *rq)
  769. {
  770. struct sched_rt_entity *rt_se;
  771. struct task_struct *p;
  772. struct rt_rq *rt_rq;
  773. rt_rq = &rq->rt;
  774. if (unlikely(!rt_rq->rt_nr_running))
  775. return NULL;
  776. if (rt_rq_throttled(rt_rq))
  777. return NULL;
  778. do {
  779. rt_se = pick_next_rt_entity(rq, rt_rq);
  780. BUG_ON(!rt_se);
  781. rt_rq = group_rt_rq(rt_se);
  782. } while (rt_rq);
  783. p = rt_task_of(rt_se);
  784. p->se.exec_start = rq->clock;
  785. return p;
  786. }
  787. static struct task_struct *pick_next_task_rt(struct rq *rq)
  788. {
  789. struct task_struct *p = _pick_next_task_rt(rq);
  790. /* The running task is never eligible for pushing */
  791. if (p)
  792. dequeue_pushable_task(rq, p);
  793. return p;
  794. }
  795. static void put_prev_task_rt(struct rq *rq, struct task_struct *p)
  796. {
  797. update_curr_rt(rq);
  798. p->se.exec_start = 0;
  799. /*
  800. * The previous task needs to be made eligible for pushing
  801. * if it is still active
  802. */
  803. if (p->se.on_rq && p->rt.nr_cpus_allowed > 1)
  804. enqueue_pushable_task(rq, p);
  805. }
  806. #ifdef CONFIG_SMP
  807. /* Only try algorithms three times */
  808. #define RT_MAX_TRIES 3
  809. static void deactivate_task(struct rq *rq, struct task_struct *p, int sleep);
  810. static int pick_rt_task(struct rq *rq, struct task_struct *p, int cpu)
  811. {
  812. if (!task_running(rq, p) &&
  813. (cpu < 0 || cpumask_test_cpu(cpu, &p->cpus_allowed)) &&
  814. (p->rt.nr_cpus_allowed > 1))
  815. return 1;
  816. return 0;
  817. }
  818. /* Return the second highest RT task, NULL otherwise */
  819. static struct task_struct *pick_next_highest_task_rt(struct rq *rq, int cpu)
  820. {
  821. struct task_struct *next = NULL;
  822. struct sched_rt_entity *rt_se;
  823. struct rt_prio_array *array;
  824. struct rt_rq *rt_rq;
  825. int idx;
  826. for_each_leaf_rt_rq(rt_rq, rq) {
  827. array = &rt_rq->active;
  828. idx = sched_find_first_bit(array->bitmap);
  829. next_idx:
  830. if (idx >= MAX_RT_PRIO)
  831. continue;
  832. if (next && next->prio < idx)
  833. continue;
  834. list_for_each_entry(rt_se, array->queue + idx, run_list) {
  835. struct task_struct *p = rt_task_of(rt_se);
  836. if (pick_rt_task(rq, p, cpu)) {
  837. next = p;
  838. break;
  839. }
  840. }
  841. if (!next) {
  842. idx = find_next_bit(array->bitmap, MAX_RT_PRIO, idx+1);
  843. goto next_idx;
  844. }
  845. }
  846. return next;
  847. }
  848. static DEFINE_PER_CPU(cpumask_var_t, local_cpu_mask);
  849. static inline int pick_optimal_cpu(int this_cpu, cpumask_t *mask)
  850. {
  851. int first;
  852. /* "this_cpu" is cheaper to preempt than a remote processor */
  853. if ((this_cpu != -1) && cpu_isset(this_cpu, *mask))
  854. return this_cpu;
  855. first = first_cpu(*mask);
  856. if (first != NR_CPUS)
  857. return first;
  858. return -1;
  859. }
  860. static int find_lowest_rq(struct task_struct *task)
  861. {
  862. struct sched_domain *sd;
  863. struct cpumask *lowest_mask = __get_cpu_var(local_cpu_mask);
  864. int this_cpu = smp_processor_id();
  865. int cpu = task_cpu(task);
  866. if (task->rt.nr_cpus_allowed == 1)
  867. return -1; /* No other targets possible */
  868. if (!cpupri_find(&task_rq(task)->rd->cpupri, task, lowest_mask))
  869. return -1; /* No targets found */
  870. /*
  871. * Only consider CPUs that are usable for migration.
  872. * I guess we might want to change cpupri_find() to ignore those
  873. * in the first place.
  874. */
  875. cpumask_and(lowest_mask, lowest_mask, cpu_active_mask);
  876. /*
  877. * At this point we have built a mask of cpus representing the
  878. * lowest priority tasks in the system. Now we want to elect
  879. * the best one based on our affinity and topology.
  880. *
  881. * We prioritize the last cpu that the task executed on since
  882. * it is most likely cache-hot in that location.
  883. */
  884. if (cpumask_test_cpu(cpu, lowest_mask))
  885. return cpu;
  886. /*
  887. * Otherwise, we consult the sched_domains span maps to figure
  888. * out which cpu is logically closest to our hot cache data.
  889. */
  890. if (this_cpu == cpu)
  891. this_cpu = -1; /* Skip this_cpu opt if the same */
  892. for_each_domain(cpu, sd) {
  893. if (sd->flags & SD_WAKE_AFFINE) {
  894. cpumask_t domain_mask;
  895. int best_cpu;
  896. cpumask_and(&domain_mask, sched_domain_span(sd),
  897. lowest_mask);
  898. best_cpu = pick_optimal_cpu(this_cpu,
  899. &domain_mask);
  900. if (best_cpu != -1)
  901. return best_cpu;
  902. }
  903. }
  904. /*
  905. * And finally, if there were no matches within the domains
  906. * just give the caller *something* to work with from the compatible
  907. * locations.
  908. */
  909. return pick_optimal_cpu(this_cpu, lowest_mask);
  910. }
  911. /* Will lock the rq it finds */
  912. static struct rq *find_lock_lowest_rq(struct task_struct *task, struct rq *rq)
  913. {
  914. struct rq *lowest_rq = NULL;
  915. int tries;
  916. int cpu;
  917. for (tries = 0; tries < RT_MAX_TRIES; tries++) {
  918. cpu = find_lowest_rq(task);
  919. if ((cpu == -1) || (cpu == rq->cpu))
  920. break;
  921. lowest_rq = cpu_rq(cpu);
  922. /* if the prio of this runqueue changed, try again */
  923. if (double_lock_balance(rq, lowest_rq)) {
  924. /*
  925. * We had to unlock the run queue. In
  926. * the mean time, task could have
  927. * migrated already or had its affinity changed.
  928. * Also make sure that it wasn't scheduled on its rq.
  929. */
  930. if (unlikely(task_rq(task) != rq ||
  931. !cpumask_test_cpu(lowest_rq->cpu,
  932. &task->cpus_allowed) ||
  933. task_running(rq, task) ||
  934. !task->se.on_rq)) {
  935. spin_unlock(&lowest_rq->lock);
  936. lowest_rq = NULL;
  937. break;
  938. }
  939. }
  940. /* If this rq is still suitable use it. */
  941. if (lowest_rq->rt.highest_prio.curr > task->prio)
  942. break;
  943. /* try again */
  944. double_unlock_balance(rq, lowest_rq);
  945. lowest_rq = NULL;
  946. }
  947. return lowest_rq;
  948. }
  949. static inline int has_pushable_tasks(struct rq *rq)
  950. {
  951. return !plist_head_empty(&rq->rt.pushable_tasks);
  952. }
  953. static struct task_struct *pick_next_pushable_task(struct rq *rq)
  954. {
  955. struct task_struct *p;
  956. if (!has_pushable_tasks(rq))
  957. return NULL;
  958. p = plist_first_entry(&rq->rt.pushable_tasks,
  959. struct task_struct, pushable_tasks);
  960. BUG_ON(rq->cpu != task_cpu(p));
  961. BUG_ON(task_current(rq, p));
  962. BUG_ON(p->rt.nr_cpus_allowed <= 1);
  963. BUG_ON(!p->se.on_rq);
  964. BUG_ON(!rt_task(p));
  965. return p;
  966. }
  967. /*
  968. * If the current CPU has more than one RT task, see if the non
  969. * running task can migrate over to a CPU that is running a task
  970. * of lesser priority.
  971. */
  972. static int push_rt_task(struct rq *rq)
  973. {
  974. struct task_struct *next_task;
  975. struct rq *lowest_rq;
  976. if (!rq->rt.overloaded)
  977. return 0;
  978. next_task = pick_next_pushable_task(rq);
  979. if (!next_task)
  980. return 0;
  981. retry:
  982. if (unlikely(next_task == rq->curr)) {
  983. WARN_ON(1);
  984. return 0;
  985. }
  986. /*
  987. * It's possible that the next_task slipped in of
  988. * higher priority than current. If that's the case
  989. * just reschedule current.
  990. */
  991. if (unlikely(next_task->prio < rq->curr->prio)) {
  992. resched_task(rq->curr);
  993. return 0;
  994. }
  995. /* We might release rq lock */
  996. get_task_struct(next_task);
  997. /* find_lock_lowest_rq locks the rq if found */
  998. lowest_rq = find_lock_lowest_rq(next_task, rq);
  999. if (!lowest_rq) {
  1000. struct task_struct *task;
  1001. /*
  1002. * find lock_lowest_rq releases rq->lock
  1003. * so it is possible that next_task has migrated.
  1004. *
  1005. * We need to make sure that the task is still on the same
  1006. * run-queue and is also still the next task eligible for
  1007. * pushing.
  1008. */
  1009. task = pick_next_pushable_task(rq);
  1010. if (task_cpu(next_task) == rq->cpu && task == next_task) {
  1011. /*
  1012. * If we get here, the task hasnt moved at all, but
  1013. * it has failed to push. We will not try again,
  1014. * since the other cpus will pull from us when they
  1015. * are ready.
  1016. */
  1017. dequeue_pushable_task(rq, next_task);
  1018. goto out;
  1019. }
  1020. if (!task)
  1021. /* No more tasks, just exit */
  1022. goto out;
  1023. /*
  1024. * Something has shifted, try again.
  1025. */
  1026. put_task_struct(next_task);
  1027. next_task = task;
  1028. goto retry;
  1029. }
  1030. deactivate_task(rq, next_task, 0);
  1031. set_task_cpu(next_task, lowest_rq->cpu);
  1032. activate_task(lowest_rq, next_task, 0);
  1033. resched_task(lowest_rq->curr);
  1034. double_unlock_balance(rq, lowest_rq);
  1035. out:
  1036. put_task_struct(next_task);
  1037. return 1;
  1038. }
  1039. static void push_rt_tasks(struct rq *rq)
  1040. {
  1041. /* push_rt_task will return true if it moved an RT */
  1042. while (push_rt_task(rq))
  1043. ;
  1044. }
  1045. static int pull_rt_task(struct rq *this_rq)
  1046. {
  1047. int this_cpu = this_rq->cpu, ret = 0, cpu;
  1048. struct task_struct *p;
  1049. struct rq *src_rq;
  1050. if (likely(!rt_overloaded(this_rq)))
  1051. return 0;
  1052. for_each_cpu(cpu, this_rq->rd->rto_mask) {
  1053. if (this_cpu == cpu)
  1054. continue;
  1055. src_rq = cpu_rq(cpu);
  1056. /*
  1057. * Don't bother taking the src_rq->lock if the next highest
  1058. * task is known to be lower-priority than our current task.
  1059. * This may look racy, but if this value is about to go
  1060. * logically higher, the src_rq will push this task away.
  1061. * And if its going logically lower, we do not care
  1062. */
  1063. if (src_rq->rt.highest_prio.next >=
  1064. this_rq->rt.highest_prio.curr)
  1065. continue;
  1066. /*
  1067. * We can potentially drop this_rq's lock in
  1068. * double_lock_balance, and another CPU could
  1069. * alter this_rq
  1070. */
  1071. double_lock_balance(this_rq, src_rq);
  1072. /*
  1073. * Are there still pullable RT tasks?
  1074. */
  1075. if (src_rq->rt.rt_nr_running <= 1)
  1076. goto skip;
  1077. p = pick_next_highest_task_rt(src_rq, this_cpu);
  1078. /*
  1079. * Do we have an RT task that preempts
  1080. * the to-be-scheduled task?
  1081. */
  1082. if (p && (p->prio < this_rq->rt.highest_prio.curr)) {
  1083. WARN_ON(p == src_rq->curr);
  1084. WARN_ON(!p->se.on_rq);
  1085. /*
  1086. * There's a chance that p is higher in priority
  1087. * than what's currently running on its cpu.
  1088. * This is just that p is wakeing up and hasn't
  1089. * had a chance to schedule. We only pull
  1090. * p if it is lower in priority than the
  1091. * current task on the run queue
  1092. */
  1093. if (p->prio < src_rq->curr->prio)
  1094. goto skip;
  1095. ret = 1;
  1096. deactivate_task(src_rq, p, 0);
  1097. set_task_cpu(p, this_cpu);
  1098. activate_task(this_rq, p, 0);
  1099. /*
  1100. * We continue with the search, just in
  1101. * case there's an even higher prio task
  1102. * in another runqueue. (low likelyhood
  1103. * but possible)
  1104. */
  1105. }
  1106. skip:
  1107. double_unlock_balance(this_rq, src_rq);
  1108. }
  1109. return ret;
  1110. }
  1111. static void pre_schedule_rt(struct rq *rq, struct task_struct *prev)
  1112. {
  1113. /* Try to pull RT tasks here if we lower this rq's prio */
  1114. if (unlikely(rt_task(prev)) && rq->rt.highest_prio.curr > prev->prio)
  1115. pull_rt_task(rq);
  1116. }
  1117. /*
  1118. * assumes rq->lock is held
  1119. */
  1120. static int needs_post_schedule_rt(struct rq *rq)
  1121. {
  1122. return has_pushable_tasks(rq);
  1123. }
  1124. static void post_schedule_rt(struct rq *rq)
  1125. {
  1126. /*
  1127. * This is only called if needs_post_schedule_rt() indicates that
  1128. * we need to push tasks away
  1129. */
  1130. spin_lock_irq(&rq->lock);
  1131. push_rt_tasks(rq);
  1132. spin_unlock_irq(&rq->lock);
  1133. }
  1134. /*
  1135. * If we are not running and we are not going to reschedule soon, we should
  1136. * try to push tasks away now
  1137. */
  1138. static void task_wake_up_rt(struct rq *rq, struct task_struct *p)
  1139. {
  1140. if (!task_running(rq, p) &&
  1141. !test_tsk_need_resched(rq->curr) &&
  1142. has_pushable_tasks(rq) &&
  1143. p->rt.nr_cpus_allowed > 1)
  1144. push_rt_tasks(rq);
  1145. }
  1146. static unsigned long
  1147. load_balance_rt(struct rq *this_rq, int this_cpu, struct rq *busiest,
  1148. unsigned long max_load_move,
  1149. struct sched_domain *sd, enum cpu_idle_type idle,
  1150. int *all_pinned, int *this_best_prio)
  1151. {
  1152. /* don't touch RT tasks */
  1153. return 0;
  1154. }
  1155. static int
  1156. move_one_task_rt(struct rq *this_rq, int this_cpu, struct rq *busiest,
  1157. struct sched_domain *sd, enum cpu_idle_type idle)
  1158. {
  1159. /* don't touch RT tasks */
  1160. return 0;
  1161. }
  1162. static void set_cpus_allowed_rt(struct task_struct *p,
  1163. const struct cpumask *new_mask)
  1164. {
  1165. int weight = cpumask_weight(new_mask);
  1166. BUG_ON(!rt_task(p));
  1167. /*
  1168. * Update the migration status of the RQ if we have an RT task
  1169. * which is running AND changing its weight value.
  1170. */
  1171. if (p->se.on_rq && (weight != p->rt.nr_cpus_allowed)) {
  1172. struct rq *rq = task_rq(p);
  1173. if (!task_current(rq, p)) {
  1174. /*
  1175. * Make sure we dequeue this task from the pushable list
  1176. * before going further. It will either remain off of
  1177. * the list because we are no longer pushable, or it
  1178. * will be requeued.
  1179. */
  1180. if (p->rt.nr_cpus_allowed > 1)
  1181. dequeue_pushable_task(rq, p);
  1182. /*
  1183. * Requeue if our weight is changing and still > 1
  1184. */
  1185. if (weight > 1)
  1186. enqueue_pushable_task(rq, p);
  1187. }
  1188. if ((p->rt.nr_cpus_allowed <= 1) && (weight > 1)) {
  1189. rq->rt.rt_nr_migratory++;
  1190. } else if ((p->rt.nr_cpus_allowed > 1) && (weight <= 1)) {
  1191. BUG_ON(!rq->rt.rt_nr_migratory);
  1192. rq->rt.rt_nr_migratory--;
  1193. }
  1194. update_rt_migration(rq);
  1195. }
  1196. cpumask_copy(&p->cpus_allowed, new_mask);
  1197. p->rt.nr_cpus_allowed = weight;
  1198. }
  1199. /* Assumes rq->lock is held */
  1200. static void rq_online_rt(struct rq *rq)
  1201. {
  1202. if (rq->rt.overloaded)
  1203. rt_set_overload(rq);
  1204. __enable_runtime(rq);
  1205. cpupri_set(&rq->rd->cpupri, rq->cpu, rq->rt.highest_prio.curr);
  1206. }
  1207. /* Assumes rq->lock is held */
  1208. static void rq_offline_rt(struct rq *rq)
  1209. {
  1210. if (rq->rt.overloaded)
  1211. rt_clear_overload(rq);
  1212. __disable_runtime(rq);
  1213. cpupri_set(&rq->rd->cpupri, rq->cpu, CPUPRI_INVALID);
  1214. }
  1215. /*
  1216. * When switch from the rt queue, we bring ourselves to a position
  1217. * that we might want to pull RT tasks from other runqueues.
  1218. */
  1219. static void switched_from_rt(struct rq *rq, struct task_struct *p,
  1220. int running)
  1221. {
  1222. /*
  1223. * If there are other RT tasks then we will reschedule
  1224. * and the scheduling of the other RT tasks will handle
  1225. * the balancing. But if we are the last RT task
  1226. * we may need to handle the pulling of RT tasks
  1227. * now.
  1228. */
  1229. if (!rq->rt.rt_nr_running)
  1230. pull_rt_task(rq);
  1231. }
  1232. static inline void init_sched_rt_class(void)
  1233. {
  1234. unsigned int i;
  1235. for_each_possible_cpu(i)
  1236. alloc_cpumask_var(&per_cpu(local_cpu_mask, i), GFP_KERNEL);
  1237. }
  1238. #endif /* CONFIG_SMP */
  1239. /*
  1240. * When switching a task to RT, we may overload the runqueue
  1241. * with RT tasks. In this case we try to push them off to
  1242. * other runqueues.
  1243. */
  1244. static void switched_to_rt(struct rq *rq, struct task_struct *p,
  1245. int running)
  1246. {
  1247. int check_resched = 1;
  1248. /*
  1249. * If we are already running, then there's nothing
  1250. * that needs to be done. But if we are not running
  1251. * we may need to preempt the current running task.
  1252. * If that current running task is also an RT task
  1253. * then see if we can move to another run queue.
  1254. */
  1255. if (!running) {
  1256. #ifdef CONFIG_SMP
  1257. if (rq->rt.overloaded && push_rt_task(rq) &&
  1258. /* Don't resched if we changed runqueues */
  1259. rq != task_rq(p))
  1260. check_resched = 0;
  1261. #endif /* CONFIG_SMP */
  1262. if (check_resched && p->prio < rq->curr->prio)
  1263. resched_task(rq->curr);
  1264. }
  1265. }
  1266. /*
  1267. * Priority of the task has changed. This may cause
  1268. * us to initiate a push or pull.
  1269. */
  1270. static void prio_changed_rt(struct rq *rq, struct task_struct *p,
  1271. int oldprio, int running)
  1272. {
  1273. if (running) {
  1274. #ifdef CONFIG_SMP
  1275. /*
  1276. * If our priority decreases while running, we
  1277. * may need to pull tasks to this runqueue.
  1278. */
  1279. if (oldprio < p->prio)
  1280. pull_rt_task(rq);
  1281. /*
  1282. * If there's a higher priority task waiting to run
  1283. * then reschedule. Note, the above pull_rt_task
  1284. * can release the rq lock and p could migrate.
  1285. * Only reschedule if p is still on the same runqueue.
  1286. */
  1287. if (p->prio > rq->rt.highest_prio.curr && rq->curr == p)
  1288. resched_task(p);
  1289. #else
  1290. /* For UP simply resched on drop of prio */
  1291. if (oldprio < p->prio)
  1292. resched_task(p);
  1293. #endif /* CONFIG_SMP */
  1294. } else {
  1295. /*
  1296. * This task is not running, but if it is
  1297. * greater than the current running task
  1298. * then reschedule.
  1299. */
  1300. if (p->prio < rq->curr->prio)
  1301. resched_task(rq->curr);
  1302. }
  1303. }
  1304. static void watchdog(struct rq *rq, struct task_struct *p)
  1305. {
  1306. unsigned long soft, hard;
  1307. if (!p->signal)
  1308. return;
  1309. soft = p->signal->rlim[RLIMIT_RTTIME].rlim_cur;
  1310. hard = p->signal->rlim[RLIMIT_RTTIME].rlim_max;
  1311. if (soft != RLIM_INFINITY) {
  1312. unsigned long next;
  1313. p->rt.timeout++;
  1314. next = DIV_ROUND_UP(min(soft, hard), USEC_PER_SEC/HZ);
  1315. if (p->rt.timeout > next)
  1316. p->cputime_expires.sched_exp = p->se.sum_exec_runtime;
  1317. }
  1318. }
  1319. static void task_tick_rt(struct rq *rq, struct task_struct *p, int queued)
  1320. {
  1321. update_curr_rt(rq);
  1322. watchdog(rq, p);
  1323. /*
  1324. * RR tasks need a special form of timeslice management.
  1325. * FIFO tasks have no timeslices.
  1326. */
  1327. if (p->policy != SCHED_RR)
  1328. return;
  1329. if (--p->rt.time_slice)
  1330. return;
  1331. p->rt.time_slice = DEF_TIMESLICE;
  1332. /*
  1333. * Requeue to the end of queue if we are not the only element
  1334. * on the queue:
  1335. */
  1336. if (p->rt.run_list.prev != p->rt.run_list.next) {
  1337. requeue_task_rt(rq, p, 0);
  1338. set_tsk_need_resched(p);
  1339. }
  1340. }
  1341. static void set_curr_task_rt(struct rq *rq)
  1342. {
  1343. struct task_struct *p = rq->curr;
  1344. p->se.exec_start = rq->clock;
  1345. /* The running task is never eligible for pushing */
  1346. dequeue_pushable_task(rq, p);
  1347. }
  1348. static const struct sched_class rt_sched_class = {
  1349. .next = &fair_sched_class,
  1350. .enqueue_task = enqueue_task_rt,
  1351. .dequeue_task = dequeue_task_rt,
  1352. .yield_task = yield_task_rt,
  1353. .check_preempt_curr = check_preempt_curr_rt,
  1354. .pick_next_task = pick_next_task_rt,
  1355. .put_prev_task = put_prev_task_rt,
  1356. #ifdef CONFIG_SMP
  1357. .select_task_rq = select_task_rq_rt,
  1358. .load_balance = load_balance_rt,
  1359. .move_one_task = move_one_task_rt,
  1360. .set_cpus_allowed = set_cpus_allowed_rt,
  1361. .rq_online = rq_online_rt,
  1362. .rq_offline = rq_offline_rt,
  1363. .pre_schedule = pre_schedule_rt,
  1364. .needs_post_schedule = needs_post_schedule_rt,
  1365. .post_schedule = post_schedule_rt,
  1366. .task_wake_up = task_wake_up_rt,
  1367. .switched_from = switched_from_rt,
  1368. #endif
  1369. .set_curr_task = set_curr_task_rt,
  1370. .task_tick = task_tick_rt,
  1371. .prio_changed = prio_changed_rt,
  1372. .switched_to = switched_to_rt,
  1373. };
  1374. #ifdef CONFIG_SCHED_DEBUG
  1375. extern void print_rt_rq(struct seq_file *m, int cpu, struct rt_rq *rt_rq);
  1376. static void print_rt_stats(struct seq_file *m, int cpu)
  1377. {
  1378. struct rt_rq *rt_rq;
  1379. rcu_read_lock();
  1380. for_each_leaf_rt_rq(rt_rq, cpu_rq(cpu))
  1381. print_rt_rq(m, cpu, rt_rq);
  1382. rcu_read_unlock();
  1383. }
  1384. #endif /* CONFIG_SCHED_DEBUG */