source: anotherchoice/tags/jsp-1.4.4-full-UTF8/kernel/semaphore.c@ 26

Last change on this file since 26 was 26, checked in by ykominami, 10 years ago

initial

File size: 6.4 KB
Line 
1/*
2 * TOPPERS/JSP Kernel
3 * Toyohashi Open Platform for Embedded Real-Time Systems/
4 * Just Standard Profile Kernel
5 *
6 * Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
7 * Toyohashi Univ. of Technology, JAPAN
8 *
9 * 上記著作権者
10は,以下の (1)〜(4) の条件か,Free Software Foundation
11 * によってå…
12¬è¡¨ã•ã‚Œã¦ã„ã‚‹ GNU General Public License の Version 2 に記
13 * 述されている条件を満たす場合に限り,本ソフトウェア(本ソフトウェア
14 * を改変したものを含む.以下同じ)を使用・複製・改変・再é…
15å¸ƒï¼ˆä»¥ä¸‹ï¼Œ
16 * 利用と呼ぶ)することを無償で許諾する.
17 * (1) 本ソフトウェアをソースコードの形で利用する場合には,上記の著作
18 * 権表示,この利用条件および下記の無保証規定が,そのままの形でソー
19 * スコード中に含まれていること.
20 * (2) 本ソフトウェアを,ライブラリ形式など,他のソフトウェア開発に使
21 * 用できる形で再é…
22å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
23å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
24 * 者
25マニュアルなど)に,上記の著作権表示,この利用条件および下記
26 * の無保証規定を掲載すること.
27 * (3) 本ソフトウェアを,機器に組み込むなど,他のソフトウェア開発に使
28 * 用できない形で再é…
29å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
30 * と.
31 * (a) 再é…
32å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
33マニュアルなど)に,上記の著
34 * 作権表示,この利用条件および下記の無保証規定を掲載すること.
35 * (b) 再é…
36å¸ƒã®å½¢æ…
37‹ã‚’,別に定める方法によって,TOPPERSプロジェクトに
38 * 報告すること.
39 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
40 * 害からも,上記著作権者
41およびTOPPERSプロジェクトをå…
42è²¬ã™ã‚‹ã“と.
43 *
44 * 本ソフトウェアは,無保証で提供されているものである.上記著作権者
45お
46 * よびTOPPERSプロジェクトは,本ソフトウェアに関して,その適用可能性も
47 * 含めて,いかなる保証も行わない.また,本ソフトウェアの利用により直
48 * 接的または間接的に生じたいかなる損害に関しても,その責任を負わない.
49 *
50 * @(#) $Id: semaphore.c,v 1.6 2003/06/04 01:46:16 hiro Exp $
51 */
52
53/*
54 * セマフォ機能
55 */
56
57#include "jsp_kernel.h"
58#include "check.h"
59#include "task.h"
60#include "wait.h"
61#include "semaphore.h"
62
63/*
64 * セマフォIDの最大値(kernel_cfg.c)
65 */
66extern const ID tmax_semid;
67
68/*
69 * セマフォ初期化ブロックのエリア(kernel_cfg.c)
70 */
71extern const SEMINIB seminib_table[];
72
73/*
74 * セマフォ管理ブロックのエリア(kernel_cfg.c)
75 */
76extern SEMCB semcb_table[];
77
78/*
79 * セマフォの数
80 */
81#define TNUM_SEM ((UINT)(tmax_semid - TMIN_SEMID + 1))
82
83/*
84 * セマフォIDからセマフォ管理ブロックを取り出すためのマクロ
85 */
86#define INDEX_SEM(semid) ((UINT)((semid) - TMIN_SEMID))
87#define get_semcb(semid) (&(semcb_table[INDEX_SEM(semid)]))
88
89/*
90 * セマフォ機能の初期化
91 */
92#ifdef __semini
93
94void
95semaphore_initialize()
96{
97 UINT i;
98 SEMCB *semcb;
99
100 for (semcb = semcb_table, i = 0; i < TNUM_SEM; semcb++, i++) {
101 queue_initialize(&(semcb->wait_queue));
102 semcb->seminib = &(seminib_table[i]);
103 semcb->semcnt = semcb->seminib->isemcnt;
104 }
105}
106
107#endif /* __semini */
108
109/*
110 * セマフォ資源の返却
111 */
112#ifdef __sig_sem
113
114SYSCALL ER
115sig_sem(ID semid)
116{
117 SEMCB *semcb;
118 TCB *tcb;
119 ER ercd;
120
121 LOG_SIG_SEM_ENTER(semid);
122 CHECK_TSKCTX_UNL();
123 CHECK_SEMID(semid);
124 semcb = get_semcb(semid);
125
126 t_lock_cpu();
127 if (!(queue_empty(&(semcb->wait_queue)))) {
128 tcb = (TCB *) queue_delete_next(&(semcb->wait_queue));
129 if (wait_complete(tcb)) {
130 dispatch();
131 }
132 ercd = E_OK;
133 }
134 else if (semcb->semcnt < semcb->seminib->maxsem) {
135 semcb->semcnt += 1;
136 ercd = E_OK;
137 }
138 else {
139 ercd = E_QOVR;
140 }
141 t_unlock_cpu();
142
143 exit:
144 LOG_SIG_SEM_LEAVE(ercd);
145 return(ercd);
146}
147
148#endif /* __sig_sem */
149
150/*
151 * セマフォ資源の返却(非タスクコンテキスト用)
152 */
153#ifdef __isig_sem
154
155SYSCALL ER
156isig_sem(ID semid)
157{
158 SEMCB *semcb;
159 TCB *tcb;
160 ER ercd;
161
162 LOG_ISIG_SEM_ENTER(semid);
163 CHECK_INTCTX_UNL();
164 CHECK_SEMID(semid);
165 semcb = get_semcb(semid);
166
167 i_lock_cpu();
168 if (!queue_empty(&(semcb->wait_queue))) {
169 tcb = (TCB *) queue_delete_next(&(semcb->wait_queue));
170 if (wait_complete(tcb)) {
171 reqflg = TRUE;
172 }
173 ercd = E_OK;
174 }
175 else if (semcb->semcnt < semcb->seminib->maxsem) {
176 semcb->semcnt += 1;
177 ercd = E_OK;
178 }
179 else {
180 ercd = E_QOVR;
181 }
182 i_unlock_cpu();
183
184 exit:
185 LOG_ISIG_SEM_LEAVE(ercd);
186 return(ercd);
187}
188
189#endif /* __isig_sem */
190
191/*
192 * セマフォ資源の獲得
193 */
194#ifdef __wai_sem
195
196SYSCALL ER
197wai_sem(ID semid)
198{
199 SEMCB *semcb;
200 WINFO_WOBJ winfo;
201 ER ercd;
202
203 LOG_WAI_SEM_ENTER(semid);
204 CHECK_DISPATCH();
205 CHECK_SEMID(semid);
206 semcb = get_semcb(semid);
207
208 t_lock_cpu();
209 if (semcb->semcnt >= 1) {
210 semcb->semcnt -= 1;
211 ercd = E_OK;
212 }
213 else {
214 wobj_make_wait((WOBJCB *) semcb, &winfo);
215 dispatch();
216 ercd = winfo.winfo.wercd;
217 }
218 t_unlock_cpu();
219
220 exit:
221 LOG_WAI_SEM_LEAVE(ercd);
222 return(ercd);
223}
224
225#endif /* __wai_sem */
226
227/*
228 * セマフォ資源の獲得(ポーリング)
229 */
230#ifdef __pol_sem
231
232SYSCALL ER
233pol_sem(ID semid)
234{
235 SEMCB *semcb;
236 ER ercd;
237
238 LOG_POL_SEM_ENTER(semid);
239 CHECK_TSKCTX_UNL();
240 CHECK_SEMID(semid);
241 semcb = get_semcb(semid);
242
243 t_lock_cpu();
244 if (semcb->semcnt >= 1) {
245 semcb->semcnt -= 1;
246 ercd = E_OK;
247 }
248 else {
249 ercd = E_TMOUT;
250 }
251 t_unlock_cpu();
252
253 exit:
254 LOG_POL_SEM_LEAVE(ercd);
255 return(ercd);
256}
257
258#endif /* __pol_sem */
259
260/*
261 * セマフォ資源の獲得(タイムアウトあり)
262 */
263#ifdef __twai_sem
264
265SYSCALL ER
266twai_sem(ID semid, TMO tmout)
267{
268 SEMCB *semcb;
269 WINFO_WOBJ winfo;
270 TMEVTB tmevtb;
271 ER ercd;
272
273 LOG_TWAI_SEM_ENTER(semid, tmout);
274 CHECK_DISPATCH();
275 CHECK_SEMID(semid);
276 CHECK_TMOUT(tmout);
277 semcb = get_semcb(semid);
278
279 t_lock_cpu();
280 if (semcb->semcnt >= 1) {
281 semcb->semcnt -= 1;
282 ercd = E_OK;
283 }
284 else if (tmout == TMO_POL) {
285 ercd = E_TMOUT;
286 }
287 else {
288 wobj_make_wait_tmout((WOBJCB *) semcb, &winfo, &tmevtb, tmout);
289 dispatch();
290 ercd = winfo.winfo.wercd;
291 }
292 t_unlock_cpu();
293
294 exit:
295 LOG_TWAI_SEM_LEAVE(ercd);
296 return(ercd);
297}
298
299#endif /* __twai_sem */
Note: See TracBrowser for help on using the repository browser.