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

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

asp_wo_kernelをコミット。
  • 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-2012 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 49 2012-09-06 04:41:53Z 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 CHECK_ALIGN_MPF(pk_cmpf->mpf);
200 CHECK_ALIGN_MB(pk_cmpf->mpfmb);
201 mpfatr = pk_cmpf->mpfatr;
202 mpf = pk_cmpf->mpf;
203 p_mpfmb = pk_cmpf->mpfmb;
204 p_mpfcb = get_mpfcb(mpfid);
205
206 if (p_mpfcb->p_mpfinib->mpfatr != TA_NOEXS) {
207 ercd = E_OBJ;
208 }
209 else {
210 if (mpf == NULL) {
211 mpf = kernel_malloc(pk_cmpf->blkcnt * ROUND_MPF_T(pk_cmpf->blksz));
212 mpfatr |= TA_MEMALLOC;
213 }
214 if (mpf == NULL) {
215 ercd = E_NOMEM;
216 }
217 else {
218 if (p_mpfmb == NULL) {
219 p_mpfmb = kernel_malloc(sizeof(MPFMB) * pk_cmpf->blkcnt);
220 mpfatr |= TA_MBALLOC;
221 }
222 if (p_mpfmb == NULL) {
223 if ((mpfatr & TA_MEMALLOC) != 0U) {
224 kernel_free(mpf);
225 }
226 ercd = E_NOMEM;
227 }
228 else {
229 p_mpfinib = (MPFINIB *)(p_mpfcb->p_mpfinib);
230 p_mpfinib->mpfatr = mpfatr;
231 p_mpfinib->blkcnt = pk_cmpf->blkcnt;
232 p_mpfinib->blksz = ROUND_MPF_T(pk_cmpf->blksz);
233 p_mpfinib->mpf = mpf;
234 p_mpfinib->p_mpfmb = p_mpfmb;
235
236 queue_initialize(&(p_mpfcb->wait_queue));
237 p_mpfcb->fblkcnt = p_mpfcb->p_mpfinib->blkcnt;
238 p_mpfcb->unused = 0U;
239 p_mpfcb->freelist = INDEX_NULL;
240 ercd = E_OK;
241 }
242 }
243 }
244
245 error_exit:
246 LOG_CRE_MPF_LEAVE(ercd);
247 return(ercd);
248}
249
250#endif /* TOPPERS_cre_mpf */
251
252/*
253 * 固定長メモリブロックの獲得
254 */
255#ifdef TOPPERS_get_mpf
256
257ER
258get_mpf(ID mpfid, void **p_blk)
259{
260 MPFCB *p_mpfcb;
261 WINFO_MPF winfo_mpf;
262 ER ercd;
263
264 LOG_GET_MPF_ENTER(mpfid, p_blk);
265 CHECK_DISPATCH();
266 CHECK_MPFID(mpfid);
267 p_mpfcb = get_mpfcb(mpfid);
268 CHECK_NOEXS(p_mpfcb->p_mpfinib->mpfatr);
269
270 t_lock_cpu();
271 if (p_mpfcb->fblkcnt > 0) {
272 get_mpf_block(p_mpfcb, p_blk);
273 ercd = E_OK;
274 }
275 else {
276 p_runtsk->tstat = (TS_WAITING | TS_WAIT_MPF);
277 wobj_make_wait((WOBJCB *) p_mpfcb, (WINFO_WOBJ *) &winfo_mpf);
278 dispatch();
279 ercd = winfo_mpf.winfo.wercd;
280 if (ercd == E_OK) {
281 *p_blk = winfo_mpf.blk;
282 }
283 }
284 t_unlock_cpu();
285
286 error_exit:
287 LOG_GET_MPF_LEAVE(ercd, *p_blk);
288 return(ercd);
289}
290
291#endif /* TOPPERS_get_mpf */
292
293/*
294 * 固定長メモリブロックの獲得（ポーリング）
295 */
296#ifdef TOPPERS_pget_mpf
297
298ER
299pget_mpf(ID mpfid, void **p_blk)
300{
301 MPFCB *p_mpfcb;
302 ER ercd;
303
304 LOG_PGET_MPF_ENTER(mpfid, p_blk);
305 CHECK_TSKCTX_UNL();
306 CHECK_MPFID(mpfid);
307 p_mpfcb = get_mpfcb(mpfid);
308 CHECK_NOEXS(p_mpfcb->p_mpfinib->mpfatr);
309
310 t_lock_cpu();
311 if (p_mpfcb->fblkcnt > 0) {
312 get_mpf_block(p_mpfcb, p_blk);
313 ercd = E_OK;
314 }
315 else {
316 ercd = E_TMOUT;
317 }
318 t_unlock_cpu();
319
320 error_exit:
321 LOG_PGET_MPF_LEAVE(ercd, *p_blk);
322 return(ercd);
323}
324
325#endif /* TOPPERS_pget_mpf */
326
327/*
328 * 固定長メモリブロックの獲得（タイムアウトあり）
329 */
330#ifdef TOPPERS_tget_mpf
331
332ER
333tget_mpf(ID mpfid, void **p_blk, TMO tmout)
334{
335 MPFCB *p_mpfcb;
336 WINFO_MPF winfo_mpf;
337 TMEVTB tmevtb;
338 ER ercd;
339
340 LOG_TGET_MPF_ENTER(mpfid, p_blk, tmout);
341 CHECK_DISPATCH();
342 CHECK_MPFID(mpfid);
343 CHECK_TMOUT(tmout);
344 p_mpfcb = get_mpfcb(mpfid);
345 CHECK_NOEXS(p_mpfcb->p_mpfinib->mpfatr);
346
347 t_lock_cpu();
348 if (p_mpfcb->fblkcnt > 0) {
349 get_mpf_block(p_mpfcb, p_blk);
350 ercd = E_OK;
351 }
352 else if (tmout == TMO_POL) {
353 ercd = E_TMOUT;
354 }
355 else {
356 p_runtsk->tstat = (TS_WAITING | TS_WAIT_MPF);
357 wobj_make_wait_tmout((WOBJCB *) p_mpfcb, (WINFO_WOBJ *) &winfo_mpf,
358 &tmevtb, tmout);
359 dispatch();
360 ercd = winfo_mpf.winfo.wercd;
361 if (ercd == E_OK) {
362 *p_blk = winfo_mpf.blk;
363 }
364 }
365 t_unlock_cpu();
366
367 error_exit:
368 LOG_TGET_MPF_LEAVE(ercd, *p_blk);
369 return(ercd);
370}
371
372#endif /* TOPPERS_tget_mpf */
373
374/*
375 * 固定長メモリブロックの返却
376 */
377#ifdef TOPPERS_rel_mpf
378
379ER
380rel_mpf(ID mpfid, void *blk)
381{
382 MPFCB *p_mpfcb;
383 SIZE blkoffset;
384 uint_t blkidx;
385 TCB *p_tcb;
386 ER ercd;
387
388 LOG_REL_MPF_ENTER(mpfid, blk);
389 CHECK_TSKCTX_UNL();
390 CHECK_MPFID(mpfid);
391 p_mpfcb = get_mpfcb(mpfid);
392 CHECK_NOEXS(p_mpfcb->p_mpfinib->mpfatr);
393 CHECK_PAR(p_mpfcb->p_mpfinib->mpf <= blk);
394 blkoffset = ((char *) blk) - (char *)(p_mpfcb->p_mpfinib->mpf);
395 CHECK_PAR(blkoffset % p_mpfcb->p_mpfinib->blksz == 0U);
396 CHECK_PAR(blkoffset / p_mpfcb->p_mpfinib->blksz < p_mpfcb->unused);
397 blkidx = (uint_t)(blkoffset / p_mpfcb->p_mpfinib->blksz);
398 CHECK_PAR((p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next == INDEX_ALLOC);
399
400 t_lock_cpu();
401 if (!queue_empty(&(p_mpfcb->wait_queue))) {
402 p_tcb = (TCB *) queue_delete_next(&(p_mpfcb->wait_queue));
403 ((WINFO_MPF *)(p_tcb->p_winfo))->blk = blk;
404 if (wait_complete(p_tcb)) {
405 dispatch();
406 }
407 ercd = E_OK;
408 }
409 else {
410 p_mpfcb->fblkcnt++;
411 (p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next = p_mpfcb->freelist;
412 p_mpfcb->freelist = blkidx;
413 ercd = E_OK;
414 }
415 t_unlock_cpu();
416
417 error_exit:
418 LOG_REL_MPF_LEAVE(ercd);
419 return(ercd);
420}
421
422#endif /* TOPPERS_rel_mpf */
423
424/*
425 * 固定長メモリプールの再初期化
426 */
427#ifdef TOPPERS_ini_mpf
428
429ER
430ini_mpf(ID mpfid)
431{
432 MPFCB *p_mpfcb;
433 bool_t dspreq;
434 ER ercd;
435
436 LOG_INI_MPF_ENTER(mpfid);
437 CHECK_TSKCTX_UNL();
438 CHECK_MPFID(mpfid);
439 p_mpfcb = get_mpfcb(mpfid);
440 CHECK_NOEXS(p_mpfcb->p_mpfinib->mpfatr);
441
442 t_lock_cpu();
443 dspreq = init_wait_queue(&(p_mpfcb->wait_queue));
444 p_mpfcb->fblkcnt = p_mpfcb->p_mpfinib->blkcnt;
445 p_mpfcb->unused = 0U;
446 p_mpfcb->freelist = INDEX_NULL;
447 if (dspreq) {
448 dispatch();
449 }
450 ercd = E_OK;
451 t_unlock_cpu();
452
453 error_exit:
454 LOG_INI_MPF_LEAVE(ercd);
455 return(ercd);
456}
457
458#endif /* TOPPERS_ini_mpf */
459
460/*
461 * 固定長メモリプールの状態参照
462 */
463#ifdef TOPPERS_ref_mpf
464
465ER
466ref_mpf(ID mpfid, T_RMPF *pk_rmpf)
467{
468 MPFCB *p_mpfcb;
469 ER ercd;
470
471 LOG_REF_MPF_ENTER(mpfid, pk_rmpf);
472 CHECK_TSKCTX_UNL();
473 CHECK_MPFID(mpfid);
474 p_mpfcb = get_mpfcb(mpfid);
475 CHECK_NOEXS(p_mpfcb->p_mpfinib->mpfatr);
476
477 t_lock_cpu();
478 pk_rmpf->wtskid = wait_tskid(&(p_mpfcb->wait_queue));
479 pk_rmpf->fblkcnt = p_mpfcb->fblkcnt;
480 ercd = E_OK;
481 t_unlock_cpu();
482
483 error_exit:
484 LOG_REF_MPF_LEAVE(ercd, pk_rmpf);
485 return(ercd);
486}
487
488#endif /* TOPPERS_ref_mpf */
Note: See TracBrowser for help on using the repository browser.