|
@@ -0,0 +1,128 @@
|
|
|
|
+#include <rtthread.h>
|
|
|
|
+#include "tc_comm.h"
|
|
|
|
+
|
|
|
|
+static rt_sem_t sem;
|
|
|
|
+static rt_uint8_t t1_count, t2_count;
|
|
|
|
+static rt_thread_t t1, t2, worker;
|
|
|
|
+static void thread1_entry(void* parameter)
|
|
|
|
+{
|
|
|
|
+ rt_err_t result;
|
|
|
|
+
|
|
|
|
+ while (1)
|
|
|
|
+ {
|
|
|
|
+ result = rt_sem_take(sem, RT_WAITING_FOREVER);
|
|
|
|
+ if (result != RT_EOK)
|
|
|
|
+ {
|
|
|
|
+ tc_done(TC_STAT_FAILED);
|
|
|
|
+ return;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ t1_count ++;
|
|
|
|
+ rt_kprintf("thread1: got semaphore, count: %d\n", t1_count);
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void thread2_entry(void* parameter)
|
|
|
|
+{
|
|
|
|
+ rt_err_t result;
|
|
|
|
+
|
|
|
|
+ while (1)
|
|
|
|
+ {
|
|
|
|
+ result = rt_sem_take(sem, RT_WAITING_FOREVER);
|
|
|
|
+ if (result != RT_EOK)
|
|
|
|
+ {
|
|
|
|
+ tc_done(TC_STAT_FAILED);
|
|
|
|
+ return;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ t2_count ++;
|
|
|
|
+ rt_kprintf("thread2: got semaphore, count: %d\n", t2_count);
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+static void worker_thread_entry(void* parameter)
|
|
|
|
+{
|
|
|
|
+ rt_thread_delay(10);
|
|
|
|
+
|
|
|
|
+ while (1)
|
|
|
|
+ {
|
|
|
|
+ rt_sem_release(sem);
|
|
|
|
+ rt_thread_delay(5);
|
|
|
|
+ }
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+int semaphore_priority_init()
|
|
|
|
+{
|
|
|
|
+ sem = rt_sem_create("sem", 0, RT_IPC_FLAG_PRIO);
|
|
|
|
+ if (sem == RT_NULL)
|
|
|
|
+ {
|
|
|
|
+ tc_stat(TC_STAT_END | TC_STAT_FAILED);
|
|
|
|
+ return 0;
|
|
|
|
+ }
|
|
|
|
+
|
|
|
|
+ t1_count = t2_count = 0;
|
|
|
|
+
|
|
|
|
+ t1 = rt_thread_create("t1",
|
|
|
|
+ thread1_entry, RT_NULL,
|
|
|
|
+ THREAD_STACK_SIZE, THREAD_PRIORITY + 1, THREAD_TIMESLICE);
|
|
|
|
+ if (t1 != RT_NULL)
|
|
|
|
+ rt_thread_startup(t1);
|
|
|
|
+ else
|
|
|
|
+ tc_stat(TC_STAT_END | TC_STAT_FAILED);
|
|
|
|
+
|
|
|
|
+ t2 = rt_thread_create("t2",
|
|
|
|
+ thread2_entry, RT_NULL,
|
|
|
|
+ THREAD_STACK_SIZE, THREAD_PRIORITY - 1, THREAD_TIMESLICE);
|
|
|
|
+ if (t2 != RT_NULL)
|
|
|
|
+ rt_thread_startup(t2);
|
|
|
|
+ else
|
|
|
|
+ tc_stat(TC_STAT_END | TC_STAT_FAILED);
|
|
|
|
+
|
|
|
|
+ worker = rt_thread_create("worker",
|
|
|
|
+ worker_thread_entry, RT_NULL,
|
|
|
|
+ THREAD_STACK_SIZE, THREAD_PRIORITY, THREAD_TIMESLICE);
|
|
|
|
+ if (worker != RT_NULL)
|
|
|
|
+ rt_thread_startup(worker);
|
|
|
|
+ else
|
|
|
|
+ tc_stat(TC_STAT_END | TC_STAT_FAILED);
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+#ifdef RT_USING_TC
|
|
|
|
+static void _tc_cleanup()
|
|
|
|
+{
|
|
|
|
+ /* lock scheduler */
|
|
|
|
+ rt_enter_critical();
|
|
|
|
+
|
|
|
|
+ /* delete t1, t2 and worker thread */
|
|
|
|
+ rt_thread_delete(t1);
|
|
|
|
+ rt_thread_delete(t2);
|
|
|
|
+ rt_thread_delete(worker);
|
|
|
|
+
|
|
|
|
+ if (t1_count > t2_count)
|
|
|
|
+ tc_stat(TC_STAT_FAILED);
|
|
|
|
+ else
|
|
|
|
+ tc_stat(TC_STAT_PASSED);
|
|
|
|
+
|
|
|
|
+ /* unlock scheduler */
|
|
|
|
+ rt_exit_critical();
|
|
|
|
+}
|
|
|
|
+
|
|
|
|
+int _tc_semaphore_priority()
|
|
|
|
+{
|
|
|
|
+ /* set tc cleanup */
|
|
|
|
+ tc_cleanup(_tc_cleanup);
|
|
|
|
+ semaphore_priority_init();
|
|
|
|
+
|
|
|
|
+ return 50;
|
|
|
|
+}
|
|
|
|
+FINSH_FUNCTION_EXPORT(_tc_semaphore_priority, a priority semaphore test);
|
|
|
|
+#else
|
|
|
|
+int rt_application_init()
|
|
|
|
+{
|
|
|
|
+ semaphore_priority_init();
|
|
|
|
+
|
|
|
|
+ return 0;
|
|
|
|
+}
|
|
|
|
+#endif
|