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

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

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