source: rubycfg_asp/trunk/asp_dcre/kernel/mempfix.c@ 313

Last change on this file since 313 was 313, checked in by coas-nagasima, 7 years ago

ソースを追加
  • Property svn:eol-style set to native
  • Property svn:keywords set to Id
  • Property svn:mime-type set to text/x-csrc
File size: 13.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-2014 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 313 2017-07-23 04:50:32Z coas-nagasima $
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_ACRE_MPF_ENTER
72#define LOG_ACRE_MPF_ENTER(pk_cmpf)
73#endif /* LOG_ACRE_MPF_ENTER */
74
75#ifndef LOG_ACRE_MPF_LEAVE
76#define LOG_ACRE_MPF_LEAVE(ercd)
77#endif /* LOG_ACRE_MPF_LEAVE */
78
79#ifndef LOG_DEL_MPF_ENTER
80#define LOG_DEL_MPF_ENTER(mpfid)
81#endif /* LOG_DEL_MPF_ENTER */
82
83#ifndef LOG_DEL_MPF_LEAVE
84#define LOG_DEL_MPF_LEAVE(ercd)
85#endif /* LOG_DEL_MPF_LEAVE */
86
87#ifndef LOG_GET_MPF_ENTER
88#define LOG_GET_MPF_ENTER(mpfid, p_blk)
89#endif /* LOG_GET_MPF_ENTER */
90
91#ifndef LOG_GET_MPF_LEAVE
92#define LOG_GET_MPF_LEAVE(ercd, blk)
93#endif /* LOG_GET_MPF_LEAVE */
94
95#ifndef LOG_PGET_MPF_ENTER
96#define LOG_PGET_MPF_ENTER(mpfid, p_blk)
97#endif /* LOG_PGET_MPF_ENTER */
98
99#ifndef LOG_PGET_MPF_LEAVE
100#define LOG_PGET_MPF_LEAVE(ercd, blk)
101#endif /* LOG_PGET_MPF_LEAVE */
102
103#ifndef LOG_TGET_MPF_ENTER
104#define LOG_TGET_MPF_ENTER(mpfid, p_blk, tmout)
105#endif /* LOG_TGET_MPF_ENTER */
106
107#ifndef LOG_TGET_MPF_LEAVE
108#define LOG_TGET_MPF_LEAVE(ercd, blk)
109#endif /* LOG_TGET_MPF_LEAVE */
110
111#ifndef LOG_REL_MPF_ENTER
112#define LOG_REL_MPF_ENTER(mpfid, blk)
113#endif /* LOG_REL_MPF_ENTER */
114
115#ifndef LOG_REL_MPF_LEAVE
116#define LOG_REL_MPF_LEAVE(ercd)
117#endif /* LOG_REL_MPF_LEAVE */
118
119#ifndef LOG_INI_MPF_ENTER
120#define LOG_INI_MPF_ENTER(mpfid)
121#endif /* LOG_INI_MPF_ENTER */
122
123#ifndef LOG_INI_MPF_LEAVE
124#define LOG_INI_MPF_LEAVE(ercd)
125#endif /* LOG_INI_MPF_LEAVE */
126
127#ifndef LOG_REF_MPF_ENTER
128#define LOG_REF_MPF_ENTER(mpfid, pk_rmpf)
129#endif /* LOG_REF_MPF_ENTER */
130
131#ifndef LOG_REF_MPF_LEAVE
132#define LOG_REF_MPF_LEAVE(ercd, pk_rmpf)
133#endif /* LOG_REF_MPF_LEAVE */
134
135/*
136 * 固定長メモリプールの数
137 */
138#define tnum_mpf ((uint_t)(tmax_mpfid - TMIN_MPFID + 1))
139#define tnum_smpf ((uint_t)(tmax_smpfid - TMIN_MPFID + 1))
140
141/*
142 * 固定長メモリプールIDから固定長メモリプール管理ブロックを取り出すた
143 * めのマクロ
144 */
145#define INDEX_MPF(mpfid) ((uint_t)((mpfid) - TMIN_MPFID))
146#define get_mpfcb(mpfid) (&(mpfcb_table[INDEX_MPF(mpfid)]))
147
148/*
149 * 特殊なインデックス値の定義
150 */
151#define INDEX_NULL (~0U) /* 空きブロックリストの最後 */
152#define INDEX_ALLOC (~1U) /* 割当て済みのブロック */
153
154#ifdef TOPPERS_mpfini
155
156/*
157 * 使用していない固定長メモリプール管理ブロックのリスト
158 */
159QUEUE free_mpfcb;
160
161/*
162 * 固定長メモリプール機能の初期化
163 */
164void
165initialize_mempfix(void)
166{
167 uint_t i, j;
168 MPFCB *p_mpfcb;
169 MPFINIB *p_mpfinib;
170
171 for (i = 0; i < tnum_smpf; i++) {
172 p_mpfcb = &(mpfcb_table[i]);
173 queue_initialize(&(p_mpfcb->wait_queue));
174 p_mpfcb->p_mpfinib = &(mpfinib_table[i]);
175 p_mpfcb->fblkcnt = p_mpfcb->p_mpfinib->blkcnt;
176 p_mpfcb->unused = 0U;
177 p_mpfcb->freelist = INDEX_NULL;
178 }
179 queue_initialize(&free_mpfcb);
180 for (j = 0; i < tnum_mpf; i++, j++) {
181 p_mpfcb = &(mpfcb_table[i]);
182 p_mpfinib = &(ampfinib_table[j]);
183 p_mpfinib->mpfatr = TA_NOEXS;
184 p_mpfcb->p_mpfinib = ((const MPFINIB *) p_mpfinib);
185 queue_insert_prev(&free_mpfcb, &(p_mpfcb->wait_queue));
186 }
187}
188
189#endif /* TOPPERS_mpfini */
190
191/*
192 * 固定長メモリプールからブロックを獲得
193 */
194#ifdef TOPPERS_mpfget
195
196void
197get_mpf_block(MPFCB *p_mpfcb, void **p_blk)
198{
199 uint_t blkidx;
200
201 if (p_mpfcb->freelist != INDEX_NULL) {
202 blkidx = p_mpfcb->freelist;
203 p_mpfcb->freelist = (p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next;
204 }
205 else {
206 blkidx = p_mpfcb->unused;
207 p_mpfcb->unused++;
208 }
209 *p_blk = (void *)((char *)(p_mpfcb->p_mpfinib->mpf)
210 + p_mpfcb->p_mpfinib->blksz * blkidx);
211 p_mpfcb->fblkcnt--;
212 (p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next = INDEX_ALLOC;
213}
214
215#endif /* TOPPERS_mpfget */
216
217/*
218 * 固定長メモリプールの生成
219 */
220#ifdef TOPPERS_acre_mpf
221
222ER_UINT
223acre_mpf(const T_CMPF *pk_cmpf)
224{
225 MPFCB *p_mpfcb;
226 MPFINIB *p_mpfinib;
227 ATR mpfatr;
228 void *mpf;
229 MPFMB *p_mpfmb;
230 ER ercd;
231
232 LOG_ACRE_MPF_ENTER(pk_cmpf);
233 CHECK_TSKCTX_UNL();
234 CHECK_RSATR(pk_cmpf->mpfatr, TA_TPRI);
235 CHECK_PAR(pk_cmpf->blkcnt != 0);
236 CHECK_PAR(pk_cmpf->blksz != 0);
237 if (pk_cmpf->mpf != NULL) {
238 CHECK_ALIGN_MPF(pk_cmpf->mpf);
239 }
240 if (pk_cmpf->mpfmb != NULL) {
241 CHECK_ALIGN_MB(pk_cmpf->mpfmb);
242 }
243 mpfatr = pk_cmpf->mpfatr;
244 mpf = pk_cmpf->mpf;
245 p_mpfmb = pk_cmpf->mpfmb;
246
247 t_lock_cpu();
248 if (tnum_mpf == 0 || queue_empty(&free_mpfcb)) {
249 ercd = E_NOID;
250 }
251 else {
252 if (mpf == NULL) {
253 mpf = kernel_malloc(ROUND_MPF_T(pk_cmpf->blksz) * pk_cmpf->blkcnt);
254 mpfatr |= TA_MEMALLOC;
255 }
256 if (mpf == NULL) {
257 ercd = E_NOMEM;
258 }
259 else {
260 if (p_mpfmb == NULL) {
261 p_mpfmb = kernel_malloc(sizeof(MPFMB) * pk_cmpf->blkcnt);
262 mpfatr |= TA_MBALLOC;
263 }
264 if (p_mpfmb == NULL) {
265 if (pk_cmpf->mpf == NULL) {
266 kernel_free(mpf);
267 }
268 ercd = E_NOMEM;
269 }
270 else {
271 p_mpfcb = ((MPFCB *) queue_delete_next(&free_mpfcb));
272 p_mpfinib = (MPFINIB *)(p_mpfcb->p_mpfinib);
273 p_mpfinib->mpfatr = mpfatr;
274 p_mpfinib->blkcnt = pk_cmpf->blkcnt;
275 p_mpfinib->blksz = ROUND_MPF_T(pk_cmpf->blksz);
276 p_mpfinib->mpf = mpf;
277 p_mpfinib->p_mpfmb = p_mpfmb;
278
279 queue_initialize(&(p_mpfcb->wait_queue));
280 p_mpfcb->fblkcnt = p_mpfcb->p_mpfinib->blkcnt;
281 p_mpfcb->unused = 0U;
282 p_mpfcb->freelist = INDEX_NULL;
283 ercd = MPFID(p_mpfcb);
284 }
285 }
286 }
287 t_unlock_cpu();
288
289 error_exit:
290 LOG_ACRE_MPF_LEAVE(ercd);
291 return(ercd);
292}
293
294#endif /* TOPPERS_acre_mpf */
295
296/*
297 * 固定長メモリプールの削除
298 */
299#ifdef TOPPERS_del_mpf
300
301ER
302del_mpf(ID mpfid)
303{
304 MPFCB *p_mpfcb;
305 MPFINIB *p_mpfinib;
306 bool_t dspreq;
307 ER ercd;
308
309 LOG_DEL_MPF_ENTER(mpfid);
310 CHECK_TSKCTX_UNL();
311 CHECK_MPFID(mpfid);
312 p_mpfcb = get_mpfcb(mpfid);
313
314 t_lock_cpu();
315 if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
316 ercd = E_NOEXS;
317 }
318 else if (MPFID(p_mpfcb) > tmax_smpfid) {
319 dspreq = init_wait_queue(&(p_mpfcb->wait_queue));
320 p_mpfinib = (MPFINIB *)(p_mpfcb->p_mpfinib);
321 if ((p_mpfinib->mpfatr & TA_MEMALLOC) != 0U) {
322 kernel_free(p_mpfinib->mpf);
323 }
324 if ((p_mpfinib->mpfatr & TA_MBALLOC) != 0U) {
325 kernel_free(p_mpfinib->p_mpfmb);
326 }
327 p_mpfinib->mpfatr = TA_NOEXS;
328 queue_insert_prev(&free_mpfcb, &(p_mpfcb->wait_queue));
329 if (dspreq) {
330 dispatch();
331 }
332 ercd = E_OK;
333 }
334 else {
335 ercd = E_OBJ;
336 }
337 t_unlock_cpu();
338
339 error_exit:
340 LOG_DEL_MPF_LEAVE(ercd);
341 return(ercd);
342}
343
344#endif /* TOPPERS_del_mpf */
345
346/*
347 * 固定長メモリブロックの獲得
348 */
349#ifdef TOPPERS_get_mpf
350
351ER
352get_mpf(ID mpfid, void **p_blk)
353{
354 MPFCB *p_mpfcb;
355 WINFO_MPF winfo_mpf;
356 ER ercd;
357
358 LOG_GET_MPF_ENTER(mpfid, p_blk);
359 CHECK_DISPATCH();
360 CHECK_MPFID(mpfid);
361 p_mpfcb = get_mpfcb(mpfid);
362
363 t_lock_cpu();
364 if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
365 ercd = E_NOEXS;
366 }
367 else if (p_mpfcb->fblkcnt > 0) {
368 get_mpf_block(p_mpfcb, p_blk);
369 ercd = E_OK;
370 }
371 else {
372 p_runtsk->tstat = (TS_WAITING | TS_WAIT_MPF);
373 wobj_make_wait((WOBJCB *) p_mpfcb, (WINFO_WOBJ *) &winfo_mpf);
374 dispatch();
375 ercd = winfo_mpf.winfo.wercd;
376 if (ercd == E_OK) {
377 *p_blk = winfo_mpf.blk;
378 }
379 }
380 t_unlock_cpu();
381
382 error_exit:
383 LOG_GET_MPF_LEAVE(ercd, *p_blk);
384 return(ercd);
385}
386
387#endif /* TOPPERS_get_mpf */
388
389/*
390 * 固定長メモリブロックの獲得（ポーリング）
391 */
392#ifdef TOPPERS_pget_mpf
393
394ER
395pget_mpf(ID mpfid, void **p_blk)
396{
397 MPFCB *p_mpfcb;
398 ER ercd;
399
400 LOG_PGET_MPF_ENTER(mpfid, p_blk);
401 CHECK_TSKCTX_UNL();
402 CHECK_MPFID(mpfid);
403 p_mpfcb = get_mpfcb(mpfid);
404
405 t_lock_cpu();
406 if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
407 ercd = E_NOEXS;
408 }
409 else if (p_mpfcb->fblkcnt > 0) {
410 get_mpf_block(p_mpfcb, p_blk);
411 ercd = E_OK;
412 }
413 else {
414 ercd = E_TMOUT;
415 }
416 t_unlock_cpu();
417
418 error_exit:
419 LOG_PGET_MPF_LEAVE(ercd, *p_blk);
420 return(ercd);
421}
422
423#endif /* TOPPERS_pget_mpf */
424
425/*
426 * 固定長メモリブロックの獲得（タイムアウトあり）
427 */
428#ifdef TOPPERS_tget_mpf
429
430ER
431tget_mpf(ID mpfid, void **p_blk, TMO tmout)
432{
433 MPFCB *p_mpfcb;
434 WINFO_MPF winfo_mpf;
435 TMEVTB tmevtb;
436 ER ercd;
437
438 LOG_TGET_MPF_ENTER(mpfid, p_blk, tmout);
439 CHECK_DISPATCH();
440 CHECK_MPFID(mpfid);
441 CHECK_TMOUT(tmout);
442 p_mpfcb = get_mpfcb(mpfid);
443
444 t_lock_cpu();
445 if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
446 ercd = E_NOEXS;
447 }
448 else if (p_mpfcb->fblkcnt > 0) {
449 get_mpf_block(p_mpfcb, p_blk);
450 ercd = E_OK;
451 }
452 else if (tmout == TMO_POL) {
453 ercd = E_TMOUT;
454 }
455 else {
456 p_runtsk->tstat = (TS_WAITING | TS_WAIT_MPF);
457 wobj_make_wait_tmout((WOBJCB *) p_mpfcb, (WINFO_WOBJ *) &winfo_mpf,
458 &tmevtb, tmout);
459 dispatch();
460 ercd = winfo_mpf.winfo.wercd;
461 if (ercd == E_OK) {
462 *p_blk = winfo_mpf.blk;
463 }
464 }
465 t_unlock_cpu();
466
467 error_exit:
468 LOG_TGET_MPF_LEAVE(ercd, *p_blk);
469 return(ercd);
470}
471
472#endif /* TOPPERS_tget_mpf */
473
474/*
475 * 固定長メモリブロックの返却
476 */
477#ifdef TOPPERS_rel_mpf
478
479ER
480rel_mpf(ID mpfid, void *blk)
481{
482 MPFCB *p_mpfcb;
483 SIZE blkoffset;
484 uint_t blkidx;
485 TCB *p_tcb;
486 ER ercd;
487
488 LOG_REL_MPF_ENTER(mpfid, blk);
489 CHECK_TSKCTX_UNL();
490 CHECK_MPFID(mpfid);
491 p_mpfcb = get_mpfcb(mpfid);
492
493 t_lock_cpu();
494 if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
495 ercd = E_NOEXS;
496 }
497 else {
498 blkoffset = ((char *) blk) - (char *)(p_mpfcb->p_mpfinib->mpf);
499 blkidx = (uint_t)(blkoffset / p_mpfcb->p_mpfinib->blksz);
500 if (!(p_mpfcb->p_mpfinib->mpf <= blk)
501 || !(blkoffset % p_mpfcb->p_mpfinib->blksz == 0U)
502 || !(blkoffset / p_mpfcb->p_mpfinib->blksz < p_mpfcb->unused)
503 || !((p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next
504 == INDEX_ALLOC)) {
505 ercd = E_PAR;
506 }
507 else if (!queue_empty(&(p_mpfcb->wait_queue))) {
508 p_tcb = (TCB *) queue_delete_next(&(p_mpfcb->wait_queue));
509 ((WINFO_MPF *)(p_tcb->p_winfo))->blk = blk;
510 if (wait_complete(p_tcb)) {
511 dispatch();
512 }
513 ercd = E_OK;
514 }
515 else {
516 p_mpfcb->fblkcnt++;
517 (p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next = p_mpfcb->freelist;
518 p_mpfcb->freelist = blkidx;
519 ercd = E_OK;
520 }
521 }
522 t_unlock_cpu();
523
524 error_exit:
525 LOG_REL_MPF_LEAVE(ercd);
526 return(ercd);
527}
528
529#endif /* TOPPERS_rel_mpf */
530
531/*
532 * 固定長メモリプールの再初期化
533 */
534#ifdef TOPPERS_ini_mpf
535
536ER
537ini_mpf(ID mpfid)
538{
539 MPFCB *p_mpfcb;
540 bool_t dspreq;
541 ER ercd;
542
543 LOG_INI_MPF_ENTER(mpfid);
544 CHECK_TSKCTX_UNL();
545 CHECK_MPFID(mpfid);
546 p_mpfcb = get_mpfcb(mpfid);
547
548 t_lock_cpu();
549 if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
550 ercd = E_NOEXS;
551 }
552 else {
553 dspreq = init_wait_queue(&(p_mpfcb->wait_queue));
554 p_mpfcb->fblkcnt = p_mpfcb->p_mpfinib->blkcnt;
555 p_mpfcb->unused = 0U;
556 p_mpfcb->freelist = INDEX_NULL;
557 if (dspreq) {
558 dispatch();
559 }
560 ercd = E_OK;
561 }
562 t_unlock_cpu();
563
564 error_exit:
565 LOG_INI_MPF_LEAVE(ercd);
566 return(ercd);
567}
568
569#endif /* TOPPERS_ini_mpf */
570
571/*
572 * 固定長メモリプールの状æ…
573‹å‚ç…
574§
575 */
576#ifdef TOPPERS_ref_mpf
577
578ER
579ref_mpf(ID mpfid, T_RMPF *pk_rmpf)
580{
581 MPFCB *p_mpfcb;
582 ER ercd;
583
584 LOG_REF_MPF_ENTER(mpfid, pk_rmpf);
585 CHECK_TSKCTX_UNL();
586 CHECK_MPFID(mpfid);
587 p_mpfcb = get_mpfcb(mpfid);
588
589 t_lock_cpu();
590 if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
591 ercd = E_NOEXS;
592 }
593 else {
594 pk_rmpf->wtskid = wait_tskid(&(p_mpfcb->wait_queue));
595 pk_rmpf->fblkcnt = p_mpfcb->fblkcnt;
596 ercd = E_OK;
597 }
598 t_unlock_cpu();
599
600 error_exit:
601 LOG_REF_MPF_LEAVE(ercd, pk_rmpf);
602 return(ercd);
603}
604
605#endif /* TOPPERS_ref_mpf */
Note: See TracBrowser for help on using the repository browser.