summaryrefslogtreecommitdiff
path: root/examples/kernel/semaphore_priority.c
blob: c106a25d5e010d55624acbcbc5a8f42f996ae0fb (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
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_done(TC_STAT_FAILED);
	else
		tc_done(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