thread.c 25 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900
  1. /*
  2. * Copyright (c) 2006-2018, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2006-03-28 Bernard first version
  9. * 2006-04-29 Bernard implement thread timer
  10. * 2006-04-30 Bernard added THREAD_DEBUG
  11. * 2006-05-27 Bernard fixed the rt_thread_yield bug
  12. * 2006-06-03 Bernard fixed the thread timer init bug
  13. * 2006-08-10 Bernard fixed the timer bug in thread_sleep
  14. * 2006-09-03 Bernard changed rt_timer_delete to rt_timer_detach
  15. * 2006-09-03 Bernard implement rt_thread_detach
  16. * 2008-02-16 Bernard fixed the rt_thread_timeout bug
  17. * 2010-03-21 Bernard change the errno of rt_thread_delay/sleep to
  18. * RT_EOK.
  19. * 2010-11-10 Bernard add cleanup callback function in thread exit.
  20. * 2011-09-01 Bernard fixed rt_thread_exit issue when the current
  21. * thread preempted, which reported by Jiaxing Lee.
  22. * 2011-09-08 Bernard fixed the scheduling issue in rt_thread_startup.
  23. * 2012-12-29 Bernard fixed compiling warning.
  24. * 2016-08-09 ArdaFu add thread suspend and resume hook.
  25. * 2017-04-10 armink fixed the rt_thread_delete and rt_thread_detach
  26. * bug when thread has not startup.
  27. * 2018-11-22 Jesven yield is same to rt_schedule
  28. * add support for tasks bound to cpu
  29. */
  30. #include <rthw.h>
  31. #include <rtthread.h>
  32. extern rt_list_t rt_thread_defunct;
  33. #ifdef RT_USING_HOOK
  34. static void (*rt_thread_suspend_hook)(rt_thread_t thread);
  35. static void (*rt_thread_resume_hook) (rt_thread_t thread);
  36. static void (*rt_thread_inited_hook) (rt_thread_t thread);
  37. /**
  38. * @ingroup Hook
  39. * This function sets a hook function when the system suspend a thread.
  40. *
  41. * @param hook the specified hook function
  42. *
  43. * @note the hook function must be simple and never be blocked or suspend.
  44. */
  45. void rt_thread_suspend_sethook(void (*hook)(rt_thread_t thread))
  46. {
  47. rt_thread_suspend_hook = hook;
  48. }
  49. /**
  50. * @ingroup Hook
  51. * This function sets a hook function when the system resume a thread.
  52. *
  53. * @param hook the specified hook function
  54. *
  55. * @note the hook function must be simple and never be blocked or suspend.
  56. */
  57. void rt_thread_resume_sethook(void (*hook)(rt_thread_t thread))
  58. {
  59. rt_thread_resume_hook = hook;
  60. }
  61. /**
  62. * @ingroup Hook
  63. * This function sets a hook function when a thread is initialized.
  64. *
  65. * @param hook the specified hook function
  66. */
  67. void rt_thread_inited_sethook(void (*hook)(rt_thread_t thread))
  68. {
  69. rt_thread_inited_hook = hook;
  70. }
  71. #endif
  72. void rt_thread_exit(void)
  73. {
  74. struct rt_thread *thread;
  75. register rt_base_t level;
  76. /* get current thread */
  77. thread = rt_thread_self();
  78. /* disable interrupt */
  79. level = rt_hw_interrupt_disable();
  80. /* remove from schedule */
  81. rt_schedule_remove_thread(thread);
  82. /* change stat */
  83. thread->stat = RT_THREAD_CLOSE;
  84. /* remove it from timer list */
  85. rt_timer_detach(&thread->thread_timer);
  86. if ((rt_object_is_systemobject((rt_object_t)thread) == RT_TRUE) &&
  87. thread->cleanup == RT_NULL)
  88. {
  89. rt_object_detach((rt_object_t)thread);
  90. }
  91. else
  92. {
  93. /* insert to defunct thread list */
  94. rt_list_insert_after(&rt_thread_defunct, &(thread->tlist));
  95. }
  96. /* switch to next task */
  97. rt_schedule();
  98. /* enable interrupt */
  99. rt_hw_interrupt_enable(level);
  100. }
  101. static rt_err_t _rt_thread_init(struct rt_thread *thread,
  102. const char *name,
  103. void (*entry)(void *parameter),
  104. void *parameter,
  105. void *stack_start,
  106. rt_uint32_t stack_size,
  107. rt_uint8_t priority,
  108. rt_uint32_t tick)
  109. {
  110. /* init thread list */
  111. rt_list_init(&(thread->tlist));
  112. thread->entry = (void *)entry;
  113. thread->parameter = parameter;
  114. /* stack init */
  115. thread->stack_addr = stack_start;
  116. thread->stack_size = stack_size;
  117. /* init thread stack */
  118. rt_memset(thread->stack_addr, '#', thread->stack_size);
  119. #ifdef ARCH_CPU_STACK_GROWS_UPWARD
  120. thread->sp = (void *)rt_hw_stack_init(thread->entry, thread->parameter,
  121. (void *)((char *)thread->stack_addr),
  122. (void *)rt_thread_exit);
  123. #else
  124. thread->sp = (void *)rt_hw_stack_init(thread->entry, thread->parameter,
  125. (rt_uint8_t *)((char *)thread->stack_addr + thread->stack_size - sizeof(rt_ubase_t)),
  126. (void *)rt_thread_exit);
  127. #endif
  128. /* priority init */
  129. RT_ASSERT(priority < RT_THREAD_PRIORITY_MAX);
  130. thread->init_priority = priority;
  131. thread->current_priority = priority;
  132. thread->number_mask = 0;
  133. #if RT_THREAD_PRIORITY_MAX > 32
  134. thread->number = 0;
  135. thread->high_mask = 0;
  136. #endif
  137. /* tick init */
  138. thread->init_tick = tick;
  139. thread->remaining_tick = tick;
  140. /* error and flags */
  141. thread->error = RT_EOK;
  142. thread->stat = RT_THREAD_INIT;
  143. #ifdef RT_USING_SMP
  144. /* not bind on any cpu */
  145. thread->bind_cpu = RT_CPUS_NR;
  146. thread->oncpu = RT_CPU_DETACHED;
  147. /* lock init */
  148. thread->scheduler_lock_nest = 0;
  149. thread->cpus_lock_nest = 0;
  150. thread->critical_lock_nest = 0;
  151. #endif /*RT_USING_SMP*/
  152. /* initialize cleanup function and user data */
  153. thread->cleanup = 0;
  154. thread->user_data = 0;
  155. /* initialize thread timer */
  156. rt_timer_init(&(thread->thread_timer),
  157. thread->name,
  158. rt_thread_timeout,
  159. thread,
  160. 0,
  161. RT_TIMER_FLAG_ONE_SHOT);
  162. /* initialize signal */
  163. #ifdef RT_USING_SIGNALS
  164. thread->sig_mask = 0x00;
  165. thread->sig_pending = 0x00;
  166. #ifndef RT_USING_SMP
  167. thread->sig_ret = RT_NULL;
  168. #endif
  169. thread->sig_vectors = RT_NULL;
  170. thread->si_list = RT_NULL;
  171. #endif
  172. #ifdef RT_USING_LWP
  173. thread->lwp = RT_NULL;
  174. #endif
  175. RT_OBJECT_HOOK_CALL(rt_thread_inited_hook, (thread));
  176. return RT_EOK;
  177. }
  178. /**
  179. * @addtogroup Thread
  180. */
  181. /**@{*/
  182. /**
  183. * This function will initialize a thread, normally it's used to initialize a
  184. * static thread object.
  185. *
  186. * @param thread the static thread object
  187. * @param name the name of thread, which shall be unique
  188. * @param entry the entry function of thread
  189. * @param parameter the parameter of thread enter function
  190. * @param stack_start the start address of thread stack
  191. * @param stack_size the size of thread stack
  192. * @param priority the priority of thread
  193. * @param tick the time slice if there are same priority thread
  194. *
  195. * @return the operation status, RT_EOK on OK, -RT_ERROR on error
  196. */
  197. rt_err_t rt_thread_init(struct rt_thread *thread,
  198. const char *name,
  199. void (*entry)(void *parameter),
  200. void *parameter,
  201. void *stack_start,
  202. rt_uint32_t stack_size,
  203. rt_uint8_t priority,
  204. rt_uint32_t tick)
  205. {
  206. /* thread check */
  207. RT_ASSERT(thread != RT_NULL);
  208. RT_ASSERT(stack_start != RT_NULL);
  209. /* initialize thread object */
  210. rt_object_init((rt_object_t)thread, RT_Object_Class_Thread, name);
  211. return _rt_thread_init(thread,
  212. name,
  213. entry,
  214. parameter,
  215. stack_start,
  216. stack_size,
  217. priority,
  218. tick);
  219. }
  220. RTM_EXPORT(rt_thread_init);
  221. /**
  222. * This function will return self thread object
  223. *
  224. * @return the self thread object
  225. */
  226. rt_thread_t rt_thread_self(void)
  227. {
  228. #ifdef RT_USING_SMP
  229. rt_base_t lock;
  230. rt_thread_t self;
  231. lock = rt_hw_local_irq_disable();
  232. self = rt_cpu_self()->current_thread;
  233. rt_hw_local_irq_enable(lock);
  234. return self;
  235. #else
  236. extern rt_thread_t rt_current_thread;
  237. return rt_current_thread;
  238. #endif
  239. }
  240. RTM_EXPORT(rt_thread_self);
  241. /**
  242. * This function will start a thread and put it to system ready queue
  243. *
  244. * @param thread the thread to be started
  245. *
  246. * @return the operation status, RT_EOK on OK, -RT_ERROR on error
  247. */
  248. rt_err_t rt_thread_startup(rt_thread_t thread)
  249. {
  250. /* thread check */
  251. RT_ASSERT(thread != RT_NULL);
  252. RT_ASSERT((thread->stat & RT_THREAD_STAT_MASK) == RT_THREAD_INIT);
  253. RT_ASSERT(rt_object_get_type((rt_object_t)thread) == RT_Object_Class_Thread);
  254. /* set current priority to initialize priority */
  255. thread->current_priority = thread->init_priority;
  256. /* calculate priority attribute */
  257. #if RT_THREAD_PRIORITY_MAX > 32
  258. thread->number = thread->current_priority >> 3; /* 5bit */
  259. thread->number_mask = 1L << thread->number;
  260. thread->high_mask = 1L << (thread->current_priority & 0x07); /* 3bit */
  261. #else
  262. thread->number_mask = 1L << thread->current_priority;
  263. #endif
  264. RT_DEBUG_LOG(RT_DEBUG_THREAD, ("startup a thread:%s with priority:%d\n",
  265. thread->name, thread->init_priority));
  266. /* change thread stat */
  267. thread->stat = RT_THREAD_SUSPEND;
  268. /* then resume it */
  269. rt_thread_resume(thread);
  270. if (rt_thread_self() != RT_NULL)
  271. {
  272. /* do a scheduling */
  273. rt_schedule();
  274. }
  275. return RT_EOK;
  276. }
  277. RTM_EXPORT(rt_thread_startup);
  278. /**
  279. * This function will detach a thread. The thread object will be removed from
  280. * thread queue and detached/deleted from system object management.
  281. *
  282. * @param thread the thread to be deleted
  283. *
  284. * @return the operation status, RT_EOK on OK, -RT_ERROR on error
  285. */
  286. rt_err_t rt_thread_detach(rt_thread_t thread)
  287. {
  288. rt_base_t lock;
  289. /* thread check */
  290. RT_ASSERT(thread != RT_NULL);
  291. RT_ASSERT(rt_object_get_type((rt_object_t)thread) == RT_Object_Class_Thread);
  292. RT_ASSERT(rt_object_is_systemobject((rt_object_t)thread));
  293. if ((thread->stat & RT_THREAD_STAT_MASK) == RT_THREAD_CLOSE)
  294. return RT_EOK;
  295. if ((thread->stat & RT_THREAD_STAT_MASK) != RT_THREAD_INIT)
  296. {
  297. /* remove from schedule */
  298. rt_schedule_remove_thread(thread);
  299. }
  300. /* release thread timer */
  301. rt_timer_detach(&(thread->thread_timer));
  302. /* change stat */
  303. thread->stat = RT_THREAD_CLOSE;
  304. if ((rt_object_is_systemobject((rt_object_t)thread) == RT_TRUE) &&
  305. thread->cleanup == RT_NULL)
  306. {
  307. rt_object_detach((rt_object_t)thread);
  308. }
  309. else
  310. {
  311. /* disable interrupt */
  312. lock = rt_hw_interrupt_disable();
  313. /* insert to defunct thread list */
  314. rt_list_insert_after(&rt_thread_defunct, &(thread->tlist));
  315. /* enable interrupt */
  316. rt_hw_interrupt_enable(lock);
  317. }
  318. return RT_EOK;
  319. }
  320. RTM_EXPORT(rt_thread_detach);
  321. #ifdef RT_USING_HEAP
  322. /**
  323. * This function will create a thread object and allocate thread object memory
  324. * and stack.
  325. *
  326. * @param name the name of thread, which shall be unique
  327. * @param entry the entry function of thread
  328. * @param parameter the parameter of thread enter function
  329. * @param stack_size the size of thread stack
  330. * @param priority the priority of thread
  331. * @param tick the time slice if there are same priority thread
  332. *
  333. * @return the created thread object
  334. */
  335. rt_thread_t rt_thread_create(const char *name,
  336. void (*entry)(void *parameter),
  337. void *parameter,
  338. rt_uint32_t stack_size,
  339. rt_uint8_t priority,
  340. rt_uint32_t tick)
  341. {
  342. struct rt_thread *thread;
  343. void *stack_start;
  344. thread = (struct rt_thread *)rt_object_allocate(RT_Object_Class_Thread,
  345. name);
  346. if (thread == RT_NULL)
  347. return RT_NULL;
  348. stack_start = (void *)RT_KERNEL_MALLOC(stack_size);
  349. if (stack_start == RT_NULL)
  350. {
  351. /* allocate stack failure */
  352. rt_object_delete((rt_object_t)thread);
  353. return RT_NULL;
  354. }
  355. _rt_thread_init(thread,
  356. name,
  357. entry,
  358. parameter,
  359. stack_start,
  360. stack_size,
  361. priority,
  362. tick);
  363. return thread;
  364. }
  365. RTM_EXPORT(rt_thread_create);
  366. /**
  367. * This function will delete a thread. The thread object will be removed from
  368. * thread queue and deleted from system object management in the idle thread.
  369. *
  370. * @param thread the thread to be deleted
  371. *
  372. * @return the operation status, RT_EOK on OK, -RT_ERROR on error
  373. */
  374. rt_err_t rt_thread_delete(rt_thread_t thread)
  375. {
  376. rt_base_t lock;
  377. /* thread check */
  378. RT_ASSERT(thread != RT_NULL);
  379. RT_ASSERT(rt_object_get_type((rt_object_t)thread) == RT_Object_Class_Thread);
  380. RT_ASSERT(rt_object_is_systemobject((rt_object_t)thread) == RT_FALSE);
  381. if ((thread->stat & RT_THREAD_STAT_MASK) == RT_THREAD_CLOSE)
  382. return RT_EOK;
  383. if ((thread->stat & RT_THREAD_STAT_MASK) != RT_THREAD_INIT)
  384. {
  385. /* remove from schedule */
  386. rt_schedule_remove_thread(thread);
  387. }
  388. /* release thread timer */
  389. rt_timer_detach(&(thread->thread_timer));
  390. /* disable interrupt */
  391. lock = rt_hw_interrupt_disable();
  392. /* change stat */
  393. thread->stat = RT_THREAD_CLOSE;
  394. /* insert to defunct thread list */
  395. rt_list_insert_after(&rt_thread_defunct, &(thread->tlist));
  396. /* enable interrupt */
  397. rt_hw_interrupt_enable(lock);
  398. return RT_EOK;
  399. }
  400. RTM_EXPORT(rt_thread_delete);
  401. #endif
  402. /**
  403. * This function will let current thread yield processor, and scheduler will
  404. * choose a highest thread to run. After yield processor, the current thread
  405. * is still in READY state.
  406. *
  407. * @return RT_EOK
  408. */
  409. rt_err_t rt_thread_yield(void)
  410. {
  411. struct rt_thread *thread;
  412. rt_base_t lock;
  413. thread = rt_thread_self();
  414. lock = rt_hw_interrupt_disable();
  415. thread->remaining_tick = thread->init_tick;
  416. thread->stat |= RT_THREAD_STAT_YIELD;
  417. rt_schedule();
  418. rt_hw_interrupt_enable(lock);
  419. return RT_EOK;
  420. }
  421. RTM_EXPORT(rt_thread_yield);
  422. /**
  423. * This function will let current thread sleep for some ticks.
  424. *
  425. * @param tick the sleep ticks
  426. *
  427. * @return RT_EOK
  428. */
  429. rt_err_t rt_thread_sleep(rt_tick_t tick)
  430. {
  431. register rt_base_t temp;
  432. struct rt_thread *thread;
  433. /* set to current thread */
  434. thread = rt_thread_self();
  435. RT_ASSERT(thread != RT_NULL);
  436. RT_ASSERT(rt_object_get_type((rt_object_t)thread) == RT_Object_Class_Thread);
  437. /* disable interrupt */
  438. temp = rt_hw_interrupt_disable();
  439. /* suspend thread */
  440. rt_thread_suspend(thread);
  441. /* reset the timeout of thread timer and start it */
  442. rt_timer_control(&(thread->thread_timer), RT_TIMER_CTRL_SET_TIME, &tick);
  443. rt_timer_start(&(thread->thread_timer));
  444. /* enable interrupt */
  445. rt_hw_interrupt_enable(temp);
  446. rt_schedule();
  447. /* clear error number of this thread to RT_EOK */
  448. if (thread->error == -RT_ETIMEOUT)
  449. thread->error = RT_EOK;
  450. return RT_EOK;
  451. }
  452. /**
  453. * This function will let current thread delay for some ticks.
  454. *
  455. * @param tick the delay ticks
  456. *
  457. * @return RT_EOK
  458. */
  459. rt_err_t rt_thread_delay(rt_tick_t tick)
  460. {
  461. return rt_thread_sleep(tick);
  462. }
  463. RTM_EXPORT(rt_thread_delay);
  464. /**
  465. * This function will let current thread delay until (*tick + inc_tick).
  466. *
  467. * @param tick the tick of last wakeup.
  468. * @param inc_tick the increment tick
  469. *
  470. * @return RT_EOK
  471. */
  472. rt_err_t rt_thread_delay_until(rt_tick_t *tick, rt_tick_t inc_tick)
  473. {
  474. register rt_base_t level;
  475. struct rt_thread *thread;
  476. RT_ASSERT(tick != RT_NULL);
  477. /* set to current thread */
  478. thread = rt_thread_self();
  479. RT_ASSERT(thread != RT_NULL);
  480. RT_ASSERT(rt_object_get_type((rt_object_t)thread) == RT_Object_Class_Thread);
  481. /* disable interrupt */
  482. level = rt_hw_interrupt_disable();
  483. if (rt_tick_get() - *tick < inc_tick)
  484. {
  485. *tick = *tick + inc_tick - rt_tick_get();
  486. /* suspend thread */
  487. rt_thread_suspend(thread);
  488. /* reset the timeout of thread timer and start it */
  489. rt_timer_control(&(thread->thread_timer), RT_TIMER_CTRL_SET_TIME, tick);
  490. rt_timer_start(&(thread->thread_timer));
  491. /* enable interrupt */
  492. rt_hw_interrupt_enable(level);
  493. rt_schedule();
  494. /* clear error number of this thread to RT_EOK */
  495. if (thread->error == -RT_ETIMEOUT)
  496. {
  497. thread->error = RT_EOK;
  498. }
  499. }
  500. else
  501. {
  502. rt_hw_interrupt_enable(level);
  503. }
  504. /* get the wakeup tick */
  505. *tick = rt_tick_get();
  506. return RT_EOK;
  507. }
  508. RTM_EXPORT(rt_thread_delay_until);
  509. /**
  510. * This function will let current thread delay for some milliseconds.
  511. *
  512. * @param ms the delay ms time
  513. *
  514. * @return RT_EOK
  515. */
  516. rt_err_t rt_thread_mdelay(rt_int32_t ms)
  517. {
  518. rt_tick_t tick;
  519. tick = rt_tick_from_millisecond(ms);
  520. return rt_thread_sleep(tick);
  521. }
  522. RTM_EXPORT(rt_thread_mdelay);
  523. /**
  524. * This function will control thread behaviors according to control command.
  525. *
  526. * @param thread the specified thread to be controlled
  527. * @param cmd the control command, which includes
  528. * RT_THREAD_CTRL_CHANGE_PRIORITY for changing priority level of thread;
  529. * RT_THREAD_CTRL_STARTUP for starting a thread;
  530. * RT_THREAD_CTRL_CLOSE for delete a thread;
  531. * RT_THREAD_CTRL_BIND_CPU for bind the thread to a CPU.
  532. * @param arg the argument of control command
  533. *
  534. * @return RT_EOK
  535. */
  536. rt_err_t rt_thread_control(rt_thread_t thread, int cmd, void *arg)
  537. {
  538. register rt_base_t temp;
  539. /* thread check */
  540. RT_ASSERT(thread != RT_NULL);
  541. RT_ASSERT(rt_object_get_type((rt_object_t)thread) == RT_Object_Class_Thread);
  542. switch (cmd)
  543. {
  544. case RT_THREAD_CTRL_CHANGE_PRIORITY:
  545. /* disable interrupt */
  546. temp = rt_hw_interrupt_disable();
  547. /* for ready thread, change queue */
  548. if ((thread->stat & RT_THREAD_STAT_MASK) == RT_THREAD_READY)
  549. {
  550. /* remove thread from schedule queue first */
  551. rt_schedule_remove_thread(thread);
  552. /* change thread priority */
  553. thread->current_priority = *(rt_uint8_t *)arg;
  554. /* recalculate priority attribute */
  555. #if RT_THREAD_PRIORITY_MAX > 32
  556. thread->number = thread->current_priority >> 3; /* 5bit */
  557. thread->number_mask = 1 << thread->number;
  558. thread->high_mask = 1 << (thread->current_priority & 0x07); /* 3bit */
  559. #else
  560. thread->number_mask = 1 << thread->current_priority;
  561. #endif
  562. /* insert thread to schedule queue again */
  563. rt_schedule_insert_thread(thread);
  564. }
  565. else
  566. {
  567. thread->current_priority = *(rt_uint8_t *)arg;
  568. /* recalculate priority attribute */
  569. #if RT_THREAD_PRIORITY_MAX > 32
  570. thread->number = thread->current_priority >> 3; /* 5bit */
  571. thread->number_mask = 1 << thread->number;
  572. thread->high_mask = 1 << (thread->current_priority & 0x07); /* 3bit */
  573. #else
  574. thread->number_mask = 1 << thread->current_priority;
  575. #endif
  576. }
  577. /* enable interrupt */
  578. rt_hw_interrupt_enable(temp);
  579. break;
  580. case RT_THREAD_CTRL_STARTUP:
  581. return rt_thread_startup(thread);
  582. case RT_THREAD_CTRL_CLOSE:
  583. if (rt_object_is_systemobject((rt_object_t)thread) == RT_TRUE)
  584. {
  585. return rt_thread_detach(thread);
  586. }
  587. #ifdef RT_USING_HEAP
  588. else
  589. {
  590. return rt_thread_delete(thread);
  591. }
  592. #endif
  593. #ifdef RT_USING_SMP
  594. case RT_THREAD_CTRL_BIND_CPU:
  595. {
  596. rt_uint8_t cpu;
  597. if ((thread->stat & RT_THREAD_STAT_MASK) != RT_THREAD_INIT)
  598. {
  599. /* we only support bind cpu before started phase. */
  600. return RT_ERROR;
  601. }
  602. cpu = (rt_uint8_t)(size_t)arg;
  603. thread->bind_cpu = cpu > RT_CPUS_NR? RT_CPUS_NR : cpu;
  604. break;
  605. }
  606. #endif /*RT_USING_SMP*/
  607. default:
  608. break;
  609. }
  610. return RT_EOK;
  611. }
  612. RTM_EXPORT(rt_thread_control);
  613. /**
  614. * This function will suspend the specified thread.
  615. *
  616. * @param thread the thread to be suspended
  617. *
  618. * @return the operation status, RT_EOK on OK, -RT_ERROR on error
  619. *
  620. * @note if suspend self thread, after this function call, the
  621. * rt_schedule() must be invoked.
  622. */
  623. rt_err_t rt_thread_suspend(rt_thread_t thread)
  624. {
  625. register rt_base_t stat;
  626. register rt_base_t temp;
  627. /* thread check */
  628. RT_ASSERT(thread != RT_NULL);
  629. RT_ASSERT(rt_object_get_type((rt_object_t)thread) == RT_Object_Class_Thread);
  630. RT_DEBUG_LOG(RT_DEBUG_THREAD, ("thread suspend: %s\n", thread->name));
  631. stat = thread->stat & RT_THREAD_STAT_MASK;
  632. if ((stat != RT_THREAD_READY) && (stat != RT_THREAD_RUNNING))
  633. {
  634. RT_DEBUG_LOG(RT_DEBUG_THREAD, ("thread suspend: thread disorder, 0x%2x\n",
  635. thread->stat));
  636. return -RT_ERROR;
  637. }
  638. /* disable interrupt */
  639. temp = rt_hw_interrupt_disable();
  640. if (stat == RT_THREAD_RUNNING)
  641. {
  642. /* not suspend running status thread on other core */
  643. RT_ASSERT(thread == rt_thread_self());
  644. }
  645. /* change thread stat */
  646. rt_schedule_remove_thread(thread);
  647. thread->stat = RT_THREAD_SUSPEND | (thread->stat & ~RT_THREAD_STAT_MASK);
  648. /* stop thread timer anyway */
  649. rt_timer_stop(&(thread->thread_timer));
  650. /* enable interrupt */
  651. rt_hw_interrupt_enable(temp);
  652. RT_OBJECT_HOOK_CALL(rt_thread_suspend_hook, (thread));
  653. return RT_EOK;
  654. }
  655. RTM_EXPORT(rt_thread_suspend);
  656. /**
  657. * This function will resume a thread and put it to system ready queue.
  658. *
  659. * @param thread the thread to be resumed
  660. *
  661. * @return the operation status, RT_EOK on OK, -RT_ERROR on error
  662. */
  663. rt_err_t rt_thread_resume(rt_thread_t thread)
  664. {
  665. register rt_base_t temp;
  666. /* thread check */
  667. RT_ASSERT(thread != RT_NULL);
  668. RT_ASSERT(rt_object_get_type((rt_object_t)thread) == RT_Object_Class_Thread);
  669. RT_DEBUG_LOG(RT_DEBUG_THREAD, ("thread resume: %s\n", thread->name));
  670. if ((thread->stat & RT_THREAD_STAT_MASK) != RT_THREAD_SUSPEND)
  671. {
  672. RT_DEBUG_LOG(RT_DEBUG_THREAD, ("thread resume: thread disorder, %d\n",
  673. thread->stat));
  674. return -RT_ERROR;
  675. }
  676. /* disable interrupt */
  677. temp = rt_hw_interrupt_disable();
  678. /* remove from suspend list */
  679. rt_list_remove(&(thread->tlist));
  680. rt_timer_stop(&thread->thread_timer);
  681. /* enable interrupt */
  682. rt_hw_interrupt_enable(temp);
  683. /* insert to schedule ready list */
  684. rt_schedule_insert_thread(thread);
  685. RT_OBJECT_HOOK_CALL(rt_thread_resume_hook, (thread));
  686. return RT_EOK;
  687. }
  688. RTM_EXPORT(rt_thread_resume);
  689. /**
  690. * This function is the timeout function for thread, normally which is invoked
  691. * when thread is timeout to wait some resource.
  692. *
  693. * @param parameter the parameter of thread timeout function
  694. */
  695. void rt_thread_timeout(void *parameter)
  696. {
  697. struct rt_thread *thread;
  698. thread = (struct rt_thread *)parameter;
  699. /* thread check */
  700. RT_ASSERT(thread != RT_NULL);
  701. RT_ASSERT((thread->stat & RT_THREAD_STAT_MASK) == RT_THREAD_SUSPEND);
  702. RT_ASSERT(rt_object_get_type((rt_object_t)thread) == RT_Object_Class_Thread);
  703. /* set error number */
  704. thread->error = -RT_ETIMEOUT;
  705. /* remove from suspend list */
  706. rt_list_remove(&(thread->tlist));
  707. /* insert to schedule ready list */
  708. rt_schedule_insert_thread(thread);
  709. /* do schedule */
  710. rt_schedule();
  711. }
  712. RTM_EXPORT(rt_thread_timeout);
  713. /**
  714. * This function will find the specified thread.
  715. *
  716. * @param name the name of thread finding
  717. *
  718. * @return the found thread
  719. *
  720. * @note please don't invoke this function in interrupt status.
  721. */
  722. rt_thread_t rt_thread_find(char *name)
  723. {
  724. struct rt_object_information *information;
  725. struct rt_object *object;
  726. struct rt_list_node *node;
  727. /* enter critical */
  728. if (rt_thread_self() != RT_NULL)
  729. rt_enter_critical();
  730. /* try to find device object */
  731. information = rt_object_get_information(RT_Object_Class_Thread);
  732. RT_ASSERT(information != RT_NULL);
  733. for (node = information->object_list.next;
  734. node != &(information->object_list);
  735. node = node->next)
  736. {
  737. object = rt_list_entry(node, struct rt_object, list);
  738. if (rt_strncmp(object->name, name, RT_NAME_MAX) == 0)
  739. {
  740. /* leave critical */
  741. if (rt_thread_self() != RT_NULL)
  742. rt_exit_critical();
  743. return (rt_thread_t)object;
  744. }
  745. }
  746. /* leave critical */
  747. if (rt_thread_self() != RT_NULL)
  748. rt_exit_critical();
  749. /* not found */
  750. return RT_NULL;
  751. }
  752. RTM_EXPORT(rt_thread_find);
  753. /**@}*/