source: asp_wo_cfg/trunk/kernel/mempfix.c@ 70

Last change on this file since 70 was 70, checked in by ertl-hiro, 10 years ago

ASPカーネルの動的生成パッケージに追従。
  • Property svn:keywords set to Id
File size: 10.8 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-2014 by Embedded and Real-Time Systems Laboratory
9 * Graduate School of Information Science, Nagoya Univ., JAPAN
10 *
11 * 上記著作権者は，以下の(1)〜(4)の条件を満たす場合に限り，本ソフトウェ
12 * ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
13 * 変・再配布（以下，利用と呼ぶ）することを無償で許諾する．
14 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
15 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
16 * スコード中に含まれていること．
17 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
18 * 用できる形で再配布する場合には，再配布に伴うドキュメント（利用
19 * 者マニュアルなど）に，上記の著作権表示，この利用条件および下記
20 * の無保証規定を掲載すること．
21 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
22 * 用できない形で再配布する場合には，次のいずれかの条件を満たすこ
23 * と．
24 * (a) 再配布に伴うドキュメント（利用者マニュアルなど）に，上記の著
25 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
26 * (b) 再配布の形態を，別に定める方法によって，TOPPERSプロジェクトに
27 * 報告すること．
28 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
29 * 害からも，上記著作権者およびTOPPERSプロジェクトを免責すること．
30 * また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
31 * 由に基づく請求からも，上記著作権者およびTOPPERSプロジェクトを
32 * 免責すること．
33 *
34 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者お
35 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
36 * に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
37 * アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
38 * の責任を負わない．
39 *
40 * @(#) $Id: mempfix.c 70 2014-04-16 23:04:43Z ertl-hiro $
41 */
42
43/*
44 * 固定長メモリプール機能
45 */
46
47#include "kernel_impl.h"
48#include "check.h"
49#include "task.h"
50#include "wait.h"
51#include "mempfix.h"
52
53/*
54 * トレースログマクロのデフォルト定義
55 */
56#ifndef LOG_CRE_MPF_ENTER
57#define LOG_CRE_MPF_ENTER(mpfid, pk_cmpf)
58#endif /* LOG_CRE_MPF_ENTER */
59
60#ifndef LOG_CRE_MPF_LEAVE
61#define LOG_CRE_MPF_LEAVE(ercd)
62#endif /* LOG_CRE_MPF_LEAVE */
63
64#ifndef LOG_GET_MPF_ENTER
65#define LOG_GET_MPF_ENTER(mpfid, p_blk)
66#endif /* LOG_GET_MPF_ENTER */
67
68#ifndef LOG_GET_MPF_LEAVE
69#define LOG_GET_MPF_LEAVE(ercd, blk)
70#endif /* LOG_GET_MPF_LEAVE */
71
72#ifndef LOG_PGET_MPF_ENTER
73#define LOG_PGET_MPF_ENTER(mpfid, p_blk)
74#endif /* LOG_PGET_MPF_ENTER */
75
76#ifndef LOG_PGET_MPF_LEAVE
77#define LOG_PGET_MPF_LEAVE(ercd, blk)
78#endif /* LOG_PGET_MPF_LEAVE */
79
80#ifndef LOG_TGET_MPF_ENTER
81#define LOG_TGET_MPF_ENTER(mpfid, p_blk, tmout)
82#endif /* LOG_TGET_MPF_ENTER */
83
84#ifndef LOG_TGET_MPF_LEAVE
85#define LOG_TGET_MPF_LEAVE(ercd, blk)
86#endif /* LOG_TGET_MPF_LEAVE */
87
88#ifndef LOG_REL_MPF_ENTER
89#define LOG_REL_MPF_ENTER(mpfid, blk)
90#endif /* LOG_REL_MPF_ENTER */
91
92#ifndef LOG_REL_MPF_LEAVE
93#define LOG_REL_MPF_LEAVE(ercd)
94#endif /* LOG_REL_MPF_LEAVE */
95
96#ifndef LOG_INI_MPF_ENTER
97#define LOG_INI_MPF_ENTER(mpfid)
98#endif /* LOG_INI_MPF_ENTER */
99
100#ifndef LOG_INI_MPF_LEAVE
101#define LOG_INI_MPF_LEAVE(ercd)
102#endif /* LOG_INI_MPF_LEAVE */
103
104#ifndef LOG_REF_MPF_ENTER
105#define LOG_REF_MPF_ENTER(mpfid, pk_rmpf)
106#endif /* LOG_REF_MPF_ENTER */
107
108#ifndef LOG_REF_MPF_LEAVE
109#define LOG_REF_MPF_LEAVE(ercd, pk_rmpf)
110#endif /* LOG_REF_MPF_LEAVE */
111
112/*
113 * 固定長メモリプールの数
114 */
115#define tnum_mpf ((uint_t)(tmax_mpfid - TMIN_MPFID + 1))
116
117/*
118 * 固定長メモリプールIDから固定長メモリプール管理ブロックを取り出すた
119 * めのマクロ
120 */
121#define INDEX_MPF(mpfid) ((uint_t)((mpfid) - TMIN_MPFID))
122#define get_mpfcb(mpfid) (&(mpfcb_table[INDEX_MPF(mpfid)]))
123
124/*
125 * 特殊なインデックス値の定義
126 */
127#define INDEX_NULL (~0U) /* 空きブロックリストの最後 */
128#define INDEX_ALLOC (~1U) /* 割当て済みのブロック */
129
130/*
131 * 固定長メモリプール機能の初期化
132 */
133#ifdef TOPPERS_mpfini
134
135void
136initialize_mempfix(void)
137{
138 uint_t i;
139 MPFCB *p_mpfcb;
140 MPFINIB *p_mpfinib;
141
142 for (i = 0; i < tnum_mpf; i++) {
143 p_mpfcb = &(mpfcb_table[i]);
144 p_mpfinib = &(mpfinib_table[i]);
145 p_mpfinib->mpfatr = TA_NOEXS;
146 p_mpfcb->p_mpfinib = ((const MPFINIB *) p_mpfinib);
147 }
148}
149
150#endif /* TOPPERS_mpfini */
151
152/*
153 * 固定長メモリプールからブロックを獲得
154 */
155#ifdef TOPPERS_mpfget
156
157void
158get_mpf_block(MPFCB *p_mpfcb, void **p_blk)
159{
160 uint_t blkidx;
161
162 if (p_mpfcb->freelist != INDEX_NULL) {
163 blkidx = p_mpfcb->freelist;
164 p_mpfcb->freelist = (p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next;
165 }
166 else {
167 blkidx = p_mpfcb->unused;
168 p_mpfcb->unused++;
169 }
170 *p_blk = (void *)((char *)(p_mpfcb->p_mpfinib->mpf)
171 + p_mpfcb->p_mpfinib->blksz * blkidx);
172 p_mpfcb->fblkcnt--;
173 (p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next = INDEX_ALLOC;
174}
175
176#endif /* TOPPERS_mpfget */
177
178/*
179 * 固定長メモリプールの生成
180 */
181#ifdef TOPPERS_cre_mpf
182
183ER
184cre_mpf(ID mpfid, const T_CMPF *pk_cmpf)
185{
186 MPFCB *p_mpfcb;
187 MPFINIB *p_mpfinib;
188 ATR mpfatr;
189 void *mpf;
190 MPFMB *p_mpfmb;
191 ER ercd;
192
193 LOG_CRE_MPF_ENTER(mpfid, pk_cmpf);
194 CHECK_INIRTN();
195 CHECK_MPFID(mpfid);
196 CHECK_RSATR(pk_cmpf->mpfatr, TA_TPRI|TA_MPRI);
197 CHECK_PAR(pk_cmpf->blkcnt != 0);
198 CHECK_PAR(pk_cmpf->blksz != 0);
199 if (pk_cmpf->mpf != NULL) {
200 CHECK_ALIGN_MPF(pk_cmpf->mpf);
201 }
202 if (pk_cmpf->mpfmb != NULL) {
203 CHECK_ALIGN_MB(pk_cmpf->mpfmb);
204 }
205 mpfatr = pk_cmpf->mpfatr;
206 mpf = pk_cmpf->mpf;
207 p_mpfmb = pk_cmpf->mpfmb;
208 p_mpfcb = get_mpfcb(mpfid);
209
210 if (p_mpfcb->p_mpfinib->mpfatr != TA_NOEXS) {
211 ercd = E_OBJ;
212 }
213 else {
214 if (mpf == NULL) {
215 mpf = kernel_malloc(pk_cmpf->blkcnt * ROUND_MPF_T(pk_cmpf->blksz));
216 }
217 if (mpf == NULL) {
218 ercd = E_NOMEM;
219 }
220 else {
221 if (p_mpfmb == NULL) {
222 p_mpfmb = kernel_malloc(sizeof(MPFMB) * pk_cmpf->blkcnt);
223 }
224 if (p_mpfmb == NULL) {
225 if (pk_cmpf->mpf == NULL) {
226 kernel_free(mpf);
227 }
228 ercd = E_NOMEM;
229 }
230 else {
231 p_mpfinib = (MPFINIB *)(p_mpfcb->p_mpfinib);
232 p_mpfinib->mpfatr = mpfatr;
233 p_mpfinib->blkcnt = pk_cmpf->blkcnt;
234 p_mpfinib->blksz = ROUND_MPF_T(pk_cmpf->blksz);
235 p_mpfinib->mpf = mpf;
236 p_mpfinib->p_mpfmb = p_mpfmb;
237
238 queue_initialize(&(p_mpfcb->wait_queue));
239 p_mpfcb->fblkcnt = p_mpfcb->p_mpfinib->blkcnt;
240 p_mpfcb->unused = 0U;
241 p_mpfcb->freelist = INDEX_NULL;
242 ercd = E_OK;
243 }
244 }
245 }
246
247 error_exit:
248 LOG_CRE_MPF_LEAVE(ercd);
249 return(ercd);
250}
251
252#endif /* TOPPERS_cre_mpf */
253
254/*
255 * 固定長メモリブロックの獲得
256 */
257#ifdef TOPPERS_get_mpf
258
259ER
260get_mpf(ID mpfid, void **p_blk)
261{
262 MPFCB *p_mpfcb;
263 WINFO_MPF winfo_mpf;
264 ER ercd;
265
266 LOG_GET_MPF_ENTER(mpfid, p_blk);
267 CHECK_DISPATCH();
268 CHECK_MPFID(mpfid);
269 p_mpfcb = get_mpfcb(mpfid);
270 CHECK_NOEXS(p_mpfcb->p_mpfinib->mpfatr);
271
272 t_lock_cpu();
273 if (p_mpfcb->fblkcnt > 0) {
274 get_mpf_block(p_mpfcb, p_blk);
275 ercd = E_OK;
276 }
277 else {
278 p_runtsk->tstat = (TS_WAITING | TS_WAIT_MPF);
279 wobj_make_wait((WOBJCB *) p_mpfcb, (WINFO_WOBJ *) &winfo_mpf);
280 dispatch();
281 ercd = winfo_mpf.winfo.wercd;
282 if (ercd == E_OK) {
283 *p_blk = winfo_mpf.blk;
284 }
285 }
286 t_unlock_cpu();
287
288 error_exit:
289 LOG_GET_MPF_LEAVE(ercd, *p_blk);
290 return(ercd);
291}
292
293#endif /* TOPPERS_get_mpf */
294
295/*
296 * 固定長メモリブロックの獲得（ポーリング）
297 */
298#ifdef TOPPERS_pget_mpf
299
300ER
301pget_mpf(ID mpfid, void **p_blk)
302{
303 MPFCB *p_mpfcb;
304 ER ercd;
305
306 LOG_PGET_MPF_ENTER(mpfid, p_blk);
307 CHECK_TSKCTX_UNL();
308 CHECK_MPFID(mpfid);
309 p_mpfcb = get_mpfcb(mpfid);
310 CHECK_NOEXS(p_mpfcb->p_mpfinib->mpfatr);
311
312 t_lock_cpu();
313 if (p_mpfcb->fblkcnt > 0) {
314 get_mpf_block(p_mpfcb, p_blk);
315 ercd = E_OK;
316 }
317 else {
318 ercd = E_TMOUT;
319 }
320 t_unlock_cpu();
321
322 error_exit:
323 LOG_PGET_MPF_LEAVE(ercd, *p_blk);
324 return(ercd);
325}
326
327#endif /* TOPPERS_pget_mpf */
328
329/*
330 * 固定長メモリブロックの獲得（タイムアウトあり）
331 */
332#ifdef TOPPERS_tget_mpf
333
334ER
335tget_mpf(ID mpfid, void **p_blk, TMO tmout)
336{
337 MPFCB *p_mpfcb;
338 WINFO_MPF winfo_mpf;
339 TMEVTB tmevtb;
340 ER ercd;
341
342 LOG_TGET_MPF_ENTER(mpfid, p_blk, tmout);
343 CHECK_DISPATCH();
344 CHECK_MPFID(mpfid);
345 CHECK_TMOUT(tmout);
346 p_mpfcb = get_mpfcb(mpfid);
347 CHECK_NOEXS(p_mpfcb->p_mpfinib->mpfatr);
348
349 t_lock_cpu();
350 if (p_mpfcb->fblkcnt > 0) {
351 get_mpf_block(p_mpfcb, p_blk);
352 ercd = E_OK;
353 }
354 else if (tmout == TMO_POL) {
355 ercd = E_TMOUT;
356 }
357 else {
358 p_runtsk->tstat = (TS_WAITING | TS_WAIT_MPF);
359 wobj_make_wait_tmout((WOBJCB *) p_mpfcb, (WINFO_WOBJ *) &winfo_mpf,
360 &tmevtb, tmout);
361 dispatch();
362 ercd = winfo_mpf.winfo.wercd;
363 if (ercd == E_OK) {
364 *p_blk = winfo_mpf.blk;
365 }
366 }
367 t_unlock_cpu();
368
369 error_exit:
370 LOG_TGET_MPF_LEAVE(ercd, *p_blk);
371 return(ercd);
372}
373
374#endif /* TOPPERS_tget_mpf */
375
376/*
377 * 固定長メモリブロックの返却
378 */
379#ifdef TOPPERS_rel_mpf
380
381ER
382rel_mpf(ID mpfid, void *blk)
383{
384 MPFCB *p_mpfcb;
385 SIZE blkoffset;
386 uint_t blkidx;
387 TCB *p_tcb;
388 ER ercd;
389
390 LOG_REL_MPF_ENTER(mpfid, blk);
391 CHECK_TSKCTX_UNL();
392 CHECK_MPFID(mpfid);
393 p_mpfcb = get_mpfcb(mpfid);
394 CHECK_NOEXS(p_mpfcb->p_mpfinib->mpfatr);
395 CHECK_PAR(p_mpfcb->p_mpfinib->mpf <= blk);
396 blkoffset = ((char *) blk) - (char *)(p_mpfcb->p_mpfinib->mpf);
397 CHECK_PAR(blkoffset % p_mpfcb->p_mpfinib->blksz == 0U);
398 CHECK_PAR(blkoffset / p_mpfcb->p_mpfinib->blksz < p_mpfcb->unused);
399 blkidx = (uint_t)(blkoffset / p_mpfcb->p_mpfinib->blksz);
400 CHECK_PAR((p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next == INDEX_ALLOC);
401
402 t_lock_cpu();
403 if (!queue_empty(&(p_mpfcb->wait_queue))) {
404 p_tcb = (TCB *) queue_delete_next(&(p_mpfcb->wait_queue));
405 ((WINFO_MPF *)(p_tcb->p_winfo))->blk = blk;
406 if (wait_complete(p_tcb)) {
407 dispatch();
408 }
409 ercd = E_OK;
410 }
411 else {
412 p_mpfcb->fblkcnt++;
413 (p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next = p_mpfcb->freelist;
414 p_mpfcb->freelist = blkidx;
415 ercd = E_OK;
416 }
417 t_unlock_cpu();
418
419 error_exit:
420 LOG_REL_MPF_LEAVE(ercd);
421 return(ercd);
422}
423
424#endif /* TOPPERS_rel_mpf */
425
426/*
427 * 固定長メモリプールの再初期化
428 */
429#ifdef TOPPERS_ini_mpf
430
431ER
432ini_mpf(ID mpfid)
433{
434 MPFCB *p_mpfcb;
435 bool_t dspreq;
436 ER ercd;
437
438 LOG_INI_MPF_ENTER(mpfid);
439 CHECK_TSKCTX_UNL();
440 CHECK_MPFID(mpfid);
441 p_mpfcb = get_mpfcb(mpfid);
442 CHECK_NOEXS(p_mpfcb->p_mpfinib->mpfatr);
443
444 t_lock_cpu();
445 dspreq = init_wait_queue(&(p_mpfcb->wait_queue));
446 p_mpfcb->fblkcnt = p_mpfcb->p_mpfinib->blkcnt;
447 p_mpfcb->unused = 0U;
448 p_mpfcb->freelist = INDEX_NULL;
449 if (dspreq) {
450 dispatch();
451 }
452 ercd = E_OK;
453 t_unlock_cpu();
454
455 error_exit:
456 LOG_INI_MPF_LEAVE(ercd);
457 return(ercd);
458}
459
460#endif /* TOPPERS_ini_mpf */
461
462/*
463 * 固定長メモリプールの状態参照
464 */
465#ifdef TOPPERS_ref_mpf
466
467ER
468ref_mpf(ID mpfid, T_RMPF *pk_rmpf)
469{
470 MPFCB *p_mpfcb;
471 ER ercd;
472
473 LOG_REF_MPF_ENTER(mpfid, pk_rmpf);
474 CHECK_TSKCTX_UNL();
475 CHECK_MPFID(mpfid);
476 p_mpfcb = get_mpfcb(mpfid);
477 CHECK_NOEXS(p_mpfcb->p_mpfinib->mpfatr);
478
479 t_lock_cpu();
480 pk_rmpf->wtskid = wait_tskid(&(p_mpfcb->wait_queue));
481 pk_rmpf->fblkcnt = p_mpfcb->fblkcnt;
482 ercd = E_OK;
483 t_unlock_cpu();
484
485 error_exit:
486 LOG_REF_MPF_LEAVE(ercd, pk_rmpf);
487 return(ercd);
488}
489
490#endif /* TOPPERS_ref_mpf */
Note: See TracBrowser for help on using the repository browser.