source: asp3_wo_tecs/trunk/kernel/mempfix.c@ 302

Last change on this file since 302 was 302, checked in by ertl-honda, 7 years ago

TECSレスのASP3の開発のため以下のtrunkからコピー
​http://dev.toppers.jp/svn/asp3/branches/WO_TECS-3.C.0
File size: 10.0 KB
Line 
1/*
2 * TOPPERS/ASP Kernel
3 * Toyohashi Open Platform for Embedded Real-Time Systems/
4 * Advanced Standard Profile Kernel
5 *
6 * Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
7 * Toyohashi Univ. of Technology, JAPAN
8 * Copyright (C) 2005-2015 by Embedded and Real-Time Systems Laboratory
9 * Graduate School of Information Science, Nagoya Univ., JAPAN
10 *
11 * 上記著作権者
12は，以下の(1)〜(4)の条件を満たす場合に限り，本ソフトウェ
13 * ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
14 * 変・再é…
15å¸ƒï¼ˆä»¥ä¸‹ï¼Œåˆ©ç”¨ã¨å‘¼ã¶ï¼‰ã™ã‚‹ã“とを無償で許諾する．
16 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
17 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
18 * スコード中に含まれていること．
19 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
20 * 用できる形で再é…
21å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
22å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
23 * 者
24マニュアルなど）に，上記の著作権表示，この利用条件および下記
25 * の無保証規定を掲載すること．
26 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
27 * 用できない形で再é…
28å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
29 * と．
30 * (a) 再é…
31å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
32マニュアルなど）に，上記の著
33 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
34 * (b) 再é…
35å¸ƒã®å½¢æ…
36‹ã‚’，別に定める方法によって，TOPPERSプロジェクトに
37 * 報告すること．
38 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
39 * 害からも，上記著作権者
40およびTOPPERSプロジェクトをå…
41è²¬ã™ã‚‹ã“と．
42 * また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
43 * 由に基づく請求からも，上記著作権者
44およびTOPPERSプロジェクトを
45 * å…
46è²¬ã™ã‚‹ã“と．
47 *
48 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者
49お
50 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
51 * に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
52 * アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
53 * の責任を負わない．
54 *
55 * $Id: mempfix.c 471 2015-12-30 10:03:16Z ertl-hiro $
56 */
57
58/*
59 * 固定長メモリプール機能
60 */
61
62#include "kernel_impl.h"
63#include "check.h"
64#include "task.h"
65#include "wait.h"
66#include "mempfix.h"
67
68/*
69 * トレースログマクロのデフォルト定義
70 */
71#ifndef LOG_GET_MPF_ENTER
72#define LOG_GET_MPF_ENTER(mpfid, p_blk)
73#endif /* LOG_GET_MPF_ENTER */
74
75#ifndef LOG_GET_MPF_LEAVE
76#define LOG_GET_MPF_LEAVE(ercd, p_blk)
77#endif /* LOG_GET_MPF_LEAVE */
78
79#ifndef LOG_PGET_MPF_ENTER
80#define LOG_PGET_MPF_ENTER(mpfid, p_blk)
81#endif /* LOG_PGET_MPF_ENTER */
82
83#ifndef LOG_PGET_MPF_LEAVE
84#define LOG_PGET_MPF_LEAVE(ercd, p_blk)
85#endif /* LOG_PGET_MPF_LEAVE */
86
87#ifndef LOG_TGET_MPF_ENTER
88#define LOG_TGET_MPF_ENTER(mpfid, p_blk, tmout)
89#endif /* LOG_TGET_MPF_ENTER */
90
91#ifndef LOG_TGET_MPF_LEAVE
92#define LOG_TGET_MPF_LEAVE(ercd, p_blk)
93#endif /* LOG_TGET_MPF_LEAVE */
94
95#ifndef LOG_REL_MPF_ENTER
96#define LOG_REL_MPF_ENTER(mpfid, blk)
97#endif /* LOG_REL_MPF_ENTER */
98
99#ifndef LOG_REL_MPF_LEAVE
100#define LOG_REL_MPF_LEAVE(ercd)
101#endif /* LOG_REL_MPF_LEAVE */
102
103#ifndef LOG_INI_MPF_ENTER
104#define LOG_INI_MPF_ENTER(mpfid)
105#endif /* LOG_INI_MPF_ENTER */
106
107#ifndef LOG_INI_MPF_LEAVE
108#define LOG_INI_MPF_LEAVE(ercd)
109#endif /* LOG_INI_MPF_LEAVE */
110
111#ifndef LOG_REF_MPF_ENTER
112#define LOG_REF_MPF_ENTER(mpfid, pk_rmpf)
113#endif /* LOG_REF_MPF_ENTER */
114
115#ifndef LOG_REF_MPF_LEAVE
116#define LOG_REF_MPF_LEAVE(ercd, pk_rmpf)
117#endif /* LOG_REF_MPF_LEAVE */
118
119/*
120 * 固定長メモリプールの数
121 */
122#define tnum_mpf ((uint_t)(tmax_mpfid - TMIN_MPFID + 1))
123
124/*
125 * 固定長メモリプールIDから固定長メモリプール管理ブロックを取り出すた
126 * めのマクロ
127 */
128#define INDEX_MPF(mpfid) ((uint_t)((mpfid) - TMIN_MPFID))
129#define get_mpfcb(mpfid) (&(mpfcb_table[INDEX_MPF(mpfid)]))
130
131/*
132 * 特殊なインデックス値の定義
133 */
134#define INDEX_NULL (~0U) /* 空きブロックリストの最後 */
135#define INDEX_ALLOC (~1U) /* 割当て済みのブロック */
136
137/*
138 * 固定長メモリプール機能の初期化
139 */
140#ifdef TOPPERS_mpfini
141
142void
143initialize_mempfix(void)
144{
145 uint_t i;
146 MPFCB *p_mpfcb;
147
148 for (i = 0; i < tnum_mpf; i++) {
149 p_mpfcb = &(mpfcb_table[i]);
150 queue_initialize(&(p_mpfcb->wait_queue));
151 p_mpfcb->p_mpfinib = &(mpfinib_table[i]);
152 p_mpfcb->fblkcnt = p_mpfcb->p_mpfinib->blkcnt;
153 p_mpfcb->unused = 0U;
154 p_mpfcb->freelist = INDEX_NULL;
155 }
156}
157
158#endif /* TOPPERS_mpfini */
159
160/*
161 * 固定長メモリプールからブロックを獲得
162 */
163#ifdef TOPPERS_mpfget
164
165void
166get_mpf_block(MPFCB *p_mpfcb, void **p_blk)
167{
168 uint_t blkidx;
169
170 if (p_mpfcb->freelist != INDEX_NULL) {
171 blkidx = p_mpfcb->freelist;
172 p_mpfcb->freelist = (p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next;
173 }
174 else {
175 blkidx = p_mpfcb->unused;
176 p_mpfcb->unused++;
177 }
178 *p_blk = (void *)((char *)(p_mpfcb->p_mpfinib->mpf)
179 + p_mpfcb->p_mpfinib->blksz * blkidx);
180 p_mpfcb->fblkcnt--;
181 (p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next = INDEX_ALLOC;
182}
183
184#endif /* TOPPERS_mpfget */
185
186/*
187 * 固定長メモリブロックの獲得
188 */
189#ifdef TOPPERS_get_mpf
190
191ER
192get_mpf(ID mpfid, void **p_blk)
193{
194 MPFCB *p_mpfcb;
195 WINFO_MPF winfo_mpf;
196 ER ercd;
197
198 LOG_GET_MPF_ENTER(mpfid, p_blk);
199 CHECK_DISPATCH();
200 CHECK_ID(VALID_MPFID(mpfid));
201 p_mpfcb = get_mpfcb(mpfid);
202
203 lock_cpu_dsp();
204 if (p_runtsk->raster) {
205 ercd = E_RASTER;
206 }
207 else if (p_mpfcb->fblkcnt > 0) {
208 get_mpf_block(p_mpfcb, p_blk);
209 ercd = E_OK;
210 }
211 else {
212 p_runtsk->tstat = TS_WAITING_MPF;
213 wobj_make_wait((WOBJCB *) p_mpfcb, (WINFO_WOBJ *) &winfo_mpf);
214 dispatch();
215 ercd = winfo_mpf.winfo.wercd;
216 if (ercd == E_OK) {
217 *p_blk = winfo_mpf.blk;
218 }
219 }
220 unlock_cpu_dsp();
221
222 error_exit:
223 LOG_GET_MPF_LEAVE(ercd, p_blk);
224 return(ercd);
225}
226
227#endif /* TOPPERS_get_mpf */
228
229/*
230 * 固定長メモリブロックの獲得（ポーリング）
231 */
232#ifdef TOPPERS_pget_mpf
233
234ER
235pget_mpf(ID mpfid, void **p_blk)
236{
237 MPFCB *p_mpfcb;
238 ER ercd;
239
240 LOG_PGET_MPF_ENTER(mpfid, p_blk);
241 CHECK_TSKCTX_UNL();
242 CHECK_ID(VALID_MPFID(mpfid));
243 p_mpfcb = get_mpfcb(mpfid);
244
245 lock_cpu();
246 if (p_mpfcb->fblkcnt > 0) {
247 get_mpf_block(p_mpfcb, p_blk);
248 ercd = E_OK;
249 }
250 else {
251 ercd = E_TMOUT;
252 }
253 unlock_cpu();
254
255 error_exit:
256 LOG_PGET_MPF_LEAVE(ercd, p_blk);
257 return(ercd);
258}
259
260#endif /* TOPPERS_pget_mpf */
261
262/*
263 * 固定長メモリブロックの獲得（タイムアウトあり）
264 */
265#ifdef TOPPERS_tget_mpf
266
267ER
268tget_mpf(ID mpfid, void **p_blk, TMO tmout)
269{
270 MPFCB *p_mpfcb;
271 WINFO_MPF winfo_mpf;
272 TMEVTB tmevtb;
273 ER ercd;
274
275 LOG_TGET_MPF_ENTER(mpfid, p_blk, tmout);
276 CHECK_DISPATCH();
277 CHECK_ID(VALID_MPFID(mpfid));
278 CHECK_PAR(VALID_TMOUT(tmout));
279 p_mpfcb = get_mpfcb(mpfid);
280
281 lock_cpu_dsp();
282 if (p_runtsk->raster) {
283 ercd = E_RASTER;
284 }
285 else if (p_mpfcb->fblkcnt > 0) {
286 get_mpf_block(p_mpfcb, p_blk);
287 ercd = E_OK;
288 }
289 else if (tmout == TMO_POL) {
290 ercd = E_TMOUT;
291 }
292 else {
293 p_runtsk->tstat = TS_WAITING_MPF;
294 wobj_make_wait_tmout((WOBJCB *) p_mpfcb, (WINFO_WOBJ *) &winfo_mpf,
295 &tmevtb, tmout);
296 dispatch();
297 ercd = winfo_mpf.winfo.wercd;
298 if (ercd == E_OK) {
299 *p_blk = winfo_mpf.blk;
300 }
301 }
302 unlock_cpu_dsp();
303
304 error_exit:
305 LOG_TGET_MPF_LEAVE(ercd, p_blk);
306 return(ercd);
307}
308
309#endif /* TOPPERS_tget_mpf */
310
311/*
312 * 固定長メモリブロックの返却
313 */
314#ifdef TOPPERS_rel_mpf
315
316ER
317rel_mpf(ID mpfid, void *blk)
318{
319 MPFCB *p_mpfcb;
320 size_t blkoffset;
321 uint_t blkidx;
322 TCB *p_tcb;
323 ER ercd;
324
325 LOG_REL_MPF_ENTER(mpfid, blk);
326 CHECK_TSKCTX_UNL();
327 CHECK_ID(VALID_MPFID(mpfid));
328 p_mpfcb = get_mpfcb(mpfid);
329 CHECK_PAR(p_mpfcb->p_mpfinib->mpf <= blk);
330 blkoffset = ((char *) blk) - (char *)(p_mpfcb->p_mpfinib->mpf);
331 CHECK_PAR(blkoffset % p_mpfcb->p_mpfinib->blksz == 0U);
332 CHECK_PAR(blkoffset / p_mpfcb->p_mpfinib->blksz < p_mpfcb->unused);
333 blkidx = (uint_t)(blkoffset / p_mpfcb->p_mpfinib->blksz);
334 CHECK_PAR((p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next == INDEX_ALLOC);
335
336 lock_cpu();
337 if (!queue_empty(&(p_mpfcb->wait_queue))) {
338 p_tcb = (TCB *) queue_delete_next(&(p_mpfcb->wait_queue));
339 ((WINFO_MPF *)(p_tcb->p_winfo))->blk = blk;
340 wait_complete(p_tcb);
341 if (p_runtsk != p_schedtsk) {
342 dispatch();
343 }
344 ercd = E_OK;
345 }
346 else {
347 p_mpfcb->fblkcnt++;
348 (p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next = p_mpfcb->freelist;
349 p_mpfcb->freelist = blkidx;
350 ercd = E_OK;
351 }
352 unlock_cpu();
353
354 error_exit:
355 LOG_REL_MPF_LEAVE(ercd);
356 return(ercd);
357}
358
359#endif /* TOPPERS_rel_mpf */
360
361/*
362 * 固定長メモリプールの再初期化
363 */
364#ifdef TOPPERS_ini_mpf
365
366ER
367ini_mpf(ID mpfid)
368{
369 MPFCB *p_mpfcb;
370 ER ercd;
371
372 LOG_INI_MPF_ENTER(mpfid);
373 CHECK_TSKCTX_UNL();
374 CHECK_ID(VALID_MPFID(mpfid));
375 p_mpfcb = get_mpfcb(mpfid);
376
377 lock_cpu();
378 init_wait_queue(&(p_mpfcb->wait_queue));
379 p_mpfcb->fblkcnt = p_mpfcb->p_mpfinib->blkcnt;
380 p_mpfcb->unused = 0U;
381 p_mpfcb->freelist = INDEX_NULL;
382 if (p_runtsk != p_schedtsk) {
383 dispatch();
384 }
385 ercd = E_OK;
386 unlock_cpu();
387
388 error_exit:
389 LOG_INI_MPF_LEAVE(ercd);
390 return(ercd);
391}
392
393#endif /* TOPPERS_ini_mpf */
394
395/*
396 * 固定長メモリプールの状æ…
397‹å‚ç…
398§
399 */
400#ifdef TOPPERS_ref_mpf
401
402ER
403ref_mpf(ID mpfid, T_RMPF *pk_rmpf)
404{
405 MPFCB *p_mpfcb;
406 ER ercd;
407
408 LOG_REF_MPF_ENTER(mpfid, pk_rmpf);
409 CHECK_TSKCTX_UNL();
410 CHECK_ID(VALID_MPFID(mpfid));
411 p_mpfcb = get_mpfcb(mpfid);
412
413 lock_cpu();
414 pk_rmpf->wtskid = wait_tskid(&(p_mpfcb->wait_queue));
415 pk_rmpf->fblkcnt = p_mpfcb->fblkcnt;
416 ercd = E_OK;
417 unlock_cpu();
418
419 error_exit:
420 LOG_REF_MPF_LEAVE(ercd, pk_rmpf);
421 return(ercd);
422}
423
424#endif /* TOPPERS_ref_mpf */
Note: See TracBrowser for help on using the repository browser.