source: mypx/extension/dcre/kernel/mempfix.c @ 7

/*
 *  TOPPERS/ASP Kernel
 *      Toyohashi Open Platform for Embedded Real-Time Systems/
 *      Advanced Standard Profile Kernel
 * 
 *  Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
 *                              Toyohashi Univ. of Technology, JAPAN
 *  Copyright (C) 2005-2014 by Embedded and Real-Time Systems Laboratory
 *              Graduate School of Information Science, Nagoya Univ., JAPAN
 * 
 *  Ÿåµ­Ãøºîž¢ŒÔ€Ï¡€°Ê²Œ€Î(1)¡Á(4)€ÎŸò·ï€òËþ€¿€¹Ÿì¹ç€ËžÂ€ê¡€ËÜ¥œ¥Õ¥È¥Š¥§
 *  ¥¢¡ÊËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò²þÊÑ€·€¿€â€Î€òŽÞ€à¡¥°Ê²ŒÆ±€ž¡Ë€ò»ÈÍÑ¡ŠÊ£Àœ¡Š²þ
 *  ÊÑ¡ŠºÆÇÛÉۡʰʲŒ¡€ÍøÍрȞƀ֡ˀ¹€ë€³€È€ò̵œþ€ÇµöÂú€¹€ë¡¥
 *  (1) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¥œ¡Œ¥¹¥³¡Œ¥É€Î·Á€ÇÍøÍÑ€¹€ëŸì¹ç€Ë€Ï¡€Ÿåµ­€ÎÃøºî
 *      ž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ­€Î̵ÊÝŸÚµ¬Äꀬ¡€€œ€Î€Þ€Þ€Î·Á€Ç¥œ¡Œ
 *      ¥¹¥³¡Œ¥ÉÃæ€ËŽÞ€Þ€ì€Æ€€€ë€³€È¡¥
 *  (2) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¡€¥é¥€¥Ö¥é¥ê·ÁŒ°€Ê€É¡€ÂŸ€Î¥œ¥Õ¥È¥Š¥§¥¢³«È¯€Ë»È
 *      Íрǀ­€ë·Á€ÇºÆÇÛÉÛ€¹€ëŸì¹ç€Ë€Ï¡€ºÆÇÛÉÛ€ËÈŒ€Š¥É¥­¥å¥á¥ó¥È¡ÊÍøÍÑ
 *      ŒÔ¥Þ¥Ë¥å¥¢¥ë€Ê€É¡Ë€Ë¡€Ÿåµ­€ÎÃøºîž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ­
 *      €Î̵ÊÝŸÚµ¬Äê€ò·ÇºÜ€¹€ë€³€È¡¥
 *  (3) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ò¡€µ¡Žï€ËÁȀ߹þ€à€Ê€É¡€ÂŸ€Î¥œ¥Õ¥È¥Š¥§¥¢³«È¯€Ë»È
 *      Íрǀ­€Ê€€·Á€ÇºÆÇÛÉÛ€¹€ëŸì¹ç€Ë€Ï¡€Œ¡€Î€€€º€ì€«€ÎŸò·ï€òËþ€¿€¹€³
 *      €È¡¥
 *    (a) ºÆÇÛÉÛ€ËÈŒ€Š¥É¥­¥å¥á¥ó¥È¡ÊÍøÍьԥޥ˥奢¥ë€Ê€É¡Ë€Ë¡€Ÿåµ­€ÎÃø
 *        ºîž¢ÉœŒš¡€€³€ÎÍøÍÑŸò·ï€ª€è€Ó²Œµ­€Î̵ÊÝŸÚµ¬Äê€ò·ÇºÜ€¹€ë€³€È¡¥
 *    (b) ºÆÇÛÉۀηÁÂÖ€ò¡€ÊÌ€ËÄê€á€ëÊýË¡€Ë€è€Ã€Æ¡€TOPPERS¥×¥í¥ž¥§¥¯¥È€Ë
 *        Êó¹ð€¹€ë€³€È¡¥
 *  (4) ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ÎÍøÍрˀè€êÄŸÀÜŪ€Þ€¿€ÏŽÖÀÜŪ€ËÀž€ž€ë€€€«€Ê€ë»
 *      ³²€«€é€â¡€Ÿåµ­Ãøºîž¢ŒÔ€ª€è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€òÌÈÀÕ€¹€ë€³€È¡¥
 *      €Þ€¿¡€ËÜ¥œ¥Õ¥È¥Š¥§¥¢€Î¥æ¡Œ¥¶€Þ€¿€Ï¥š¥ó¥É¥æ¡Œ¥¶€«€é€Î€€€«€Ê€ëÍý
 *      ͳ€ËŽð€Å€¯ÀÁµá€«€é€â¡€Ÿåµ­Ãøºîž¢ŒÔ€ª€è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€ò
 *      ÌÈÀÕ€¹€ë€³€È¡¥
 * 
 *  ËÜ¥œ¥Õ¥È¥Š¥§¥¢€Ï¡€ÌµÊÝŸÚ€ÇÄ󶡀µ€ì€Æ€€€ë€â€Î€Ç€¢€ë¡¥Ÿåµ­Ãøºîž¢ŒÔ€ª
 *  €è€ÓTOPPERS¥×¥í¥ž¥§¥¯¥È€Ï¡€ËÜ¥œ¥Õ¥È¥Š¥§¥¢€ËŽØ€·€Æ¡€ÆÃÄê€Î»ÈÍÑÌÜŪ
 *  €ËÂЀ¹€ëŬ¹çÀ­€âŽÞ€á€Æ¡€€€€«€Ê€ëÊÝŸÚ€â¹Ô€ï€Ê€€¡¥€Þ€¿¡€ËÜ¥œ¥Õ¥È¥Š¥§
 *  ¥¢€ÎÍøÍрˀè€êÄŸÀÜŪ€Þ€¿€ÏŽÖÀÜŪ€ËÀž€ž€¿€€€«€Ê€ë»³²€ËŽØ€·€Æ€â¡€€œ
 *  €ÎÀÕÇ€€òÉé€ï€Ê€€¡¥
 * 
 *  $Id$
 */

/*
 *              žÇÄêĹ¥á¥â¥ê¥×¡Œ¥ëµ¡Çœ
 */

#include "kernel_impl.h"
#include "check.h"
#include "task.h"
#include "wait.h"
#include "mempfix.h"

/*
 *  ¥È¥ì¡Œ¥¹¥í¥°¥Þ¥¯¥í€Î¥Ç¥Õ¥©¥ë¥ÈÄêµÁ
 */
#ifndef LOG_ACRE_MPF_ENTER
#define LOG_ACRE_MPF_ENTER(pk_cmpf)
#endif /* LOG_ACRE_MPF_ENTER */

#ifndef LOG_ACRE_MPF_LEAVE
#define LOG_ACRE_MPF_LEAVE(ercd)
#endif /* LOG_ACRE_MPF_LEAVE */

#ifndef LOG_DEL_MPF_ENTER
#define LOG_DEL_MPF_ENTER(mpfid)
#endif /* LOG_DEL_MPF_ENTER */

#ifndef LOG_DEL_MPF_LEAVE
#define LOG_DEL_MPF_LEAVE(ercd)
#endif /* LOG_DEL_MPF_LEAVE */

#ifndef LOG_GET_MPF_ENTER
#define LOG_GET_MPF_ENTER(mpfid, p_blk)
#endif /* LOG_GET_MPF_ENTER */

#ifndef LOG_GET_MPF_LEAVE
#define LOG_GET_MPF_LEAVE(ercd, blk)
#endif /* LOG_GET_MPF_LEAVE */

#ifndef LOG_PGET_MPF_ENTER
#define LOG_PGET_MPF_ENTER(mpfid, p_blk)
#endif /* LOG_PGET_MPF_ENTER */

#ifndef LOG_PGET_MPF_LEAVE
#define LOG_PGET_MPF_LEAVE(ercd, blk)
#endif /* LOG_PGET_MPF_LEAVE */

#ifndef LOG_TGET_MPF_ENTER
#define LOG_TGET_MPF_ENTER(mpfid, p_blk, tmout)
#endif /* LOG_TGET_MPF_ENTER */

#ifndef LOG_TGET_MPF_LEAVE
#define LOG_TGET_MPF_LEAVE(ercd, blk)
#endif /* LOG_TGET_MPF_LEAVE */

#ifndef LOG_REL_MPF_ENTER
#define LOG_REL_MPF_ENTER(mpfid, blk)
#endif /* LOG_REL_MPF_ENTER */

#ifndef LOG_REL_MPF_LEAVE
#define LOG_REL_MPF_LEAVE(ercd)
#endif /* LOG_REL_MPF_LEAVE */

#ifndef LOG_INI_MPF_ENTER
#define LOG_INI_MPF_ENTER(mpfid)
#endif /* LOG_INI_MPF_ENTER */

#ifndef LOG_INI_MPF_LEAVE
#define LOG_INI_MPF_LEAVE(ercd)
#endif /* LOG_INI_MPF_LEAVE */

#ifndef LOG_REF_MPF_ENTER
#define LOG_REF_MPF_ENTER(mpfid, pk_rmpf)
#endif /* LOG_REF_MPF_ENTER */

#ifndef LOG_REF_MPF_LEAVE
#define LOG_REF_MPF_LEAVE(ercd, pk_rmpf)
#endif /* LOG_REF_MPF_LEAVE */

/*
 *  žÇÄêĹ¥á¥â¥ê¥×¡Œ¥ë€Î¿ô
 */
#define tnum_mpf        ((uint_t)(tmax_mpfid - TMIN_MPFID + 1))
#define tnum_smpf       ((uint_t)(tmax_smpfid - TMIN_MPFID + 1))

/*
 *  žÇÄêĹ¥á¥â¥ê¥×¡Œ¥ëID€«€éžÇÄêĹ¥á¥â¥ê¥×¡Œ¥ëŽÉÍý¥Ö¥í¥Ã¥¯€òŒè€êœÐ€¹€¿
 *  €á€Î¥Þ¥¯¥í
 */
#define INDEX_MPF(mpfid)        ((uint_t)((mpfid) - TMIN_MPFID))
#define get_mpfcb(mpfid)        (&(mpfcb_table[INDEX_MPF(mpfid)]))

/*
 *  ÆÃŒì€Ê¥€¥ó¥Ç¥Ã¥¯¥¹ÃÍ€ÎÄêµÁ
 */
#define INDEX_NULL              (~0U)           /* ¶õ€­¥Ö¥í¥Ã¥¯¥ê¥¹¥È€ÎºÇžå */
#define INDEX_ALLOC             (~1U)           /* ³äÅö€ÆºÑ€ß€Î¥Ö¥í¥Ã¥¯ */

#ifdef TOPPERS_mpfini

/*
 *  »ÈÍÑ€·€Æ€€€Ê€€žÇÄêĹ¥á¥â¥ê¥×¡Œ¥ëŽÉÍý¥Ö¥í¥Ã¥¯€Î¥ê¥¹¥È
 */
QUEUE   free_mpfcb;

/*
 *  žÇÄêĹ¥á¥â¥ê¥×¡Œ¥ëµ¡Çœ€ÎœéŽü²œ
 */
void
initialize_mempfix(void)
{
        uint_t  i, j;
        MPFCB   *p_mpfcb;
        MPFINIB *p_mpfinib;

        for (i = 0; i < tnum_smpf; i++) {
                p_mpfcb = &(mpfcb_table[i]);
                queue_initialize(&(p_mpfcb->wait_queue));
                p_mpfcb->p_mpfinib = &(mpfinib_table[i]);
                p_mpfcb->fblkcnt = p_mpfcb->p_mpfinib->blkcnt;
                p_mpfcb->unused = 0U;
                p_mpfcb->freelist = INDEX_NULL;
        }
        queue_initialize(&free_mpfcb);
        for (j = 0; i < tnum_mpf; i++, j++) {
                p_mpfcb = &(mpfcb_table[i]);
                p_mpfinib = &(ampfinib_table[j]);
                p_mpfinib->mpfatr = TA_NOEXS;
                p_mpfcb->p_mpfinib = ((const MPFINIB *) p_mpfinib);
                queue_insert_prev(&free_mpfcb, &(p_mpfcb->wait_queue));
        }
}

#endif /* TOPPERS_mpfini */

/*
 *  žÇÄêĹ¥á¥â¥ê¥×¡Œ¥ë€«€é¥Ö¥í¥Ã¥¯€ò³ÍÆÀ
 */
#ifdef TOPPERS_mpfget

void
get_mpf_block(MPFCB *p_mpfcb, void **p_blk)
{
        uint_t  blkidx;

        if (p_mpfcb->freelist != INDEX_NULL) {
                blkidx = p_mpfcb->freelist;
                p_mpfcb->freelist = (p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next;
        }
        else {
                blkidx = p_mpfcb->unused;
                p_mpfcb->unused++;
        }
        *p_blk = (void *)((char *)(p_mpfcb->p_mpfinib->mpf)
                                                                + p_mpfcb->p_mpfinib->blksz * blkidx);
        p_mpfcb->fblkcnt--;
        (p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next = INDEX_ALLOC;
}

#endif /* TOPPERS_mpfget */

/*
 *  žÇÄêĹ¥á¥â¥ê¥×¡Œ¥ë€ÎÀžÀ®
 */
#ifdef TOPPERS_acre_mpf

ER_UINT
acre_mpf(const T_CMPF *pk_cmpf)
{
        MPFCB   *p_mpfcb;
        MPFINIB *p_mpfinib;
        ATR             mpfatr;
        void    *mpf;
        MPFMB   *p_mpfmb;
        ER              ercd;

        LOG_ACRE_MPF_ENTER(pk_cmpf);
        CHECK_TSKCTX_UNL();
        CHECK_RSATR(pk_cmpf->mpfatr, TA_TPRI);
        CHECK_PAR(pk_cmpf->blkcnt != 0);
        CHECK_PAR(pk_cmpf->blksz != 0);
        if (pk_cmpf->mpf != NULL) {
                CHECK_ALIGN_MPF(pk_cmpf->mpf);
        }
        if (pk_cmpf->mpfmb != NULL) {
                CHECK_ALIGN_MB(pk_cmpf->mpfmb);
        }
        mpfatr = pk_cmpf->mpfatr;
        mpf = pk_cmpf->mpf;
        p_mpfmb = pk_cmpf->mpfmb;

        t_lock_cpu();
        if (tnum_mpf == 0 || queue_empty(&free_mpfcb)) {
                ercd = E_NOID;
        }
        else {
                if (mpf == NULL) {
                        mpf = kernel_malloc(ROUND_MPF_T(pk_cmpf->blksz) * pk_cmpf->blkcnt);
                        mpfatr |= TA_MEMALLOC;
                }
                if (mpf == NULL) {
                        ercd = E_NOMEM;
                }
                else {
                        if (p_mpfmb == NULL) {
                                p_mpfmb = kernel_malloc(sizeof(MPFMB) * pk_cmpf->blkcnt);
                                mpfatr |= TA_MBALLOC;
                        }
                        if (p_mpfmb == NULL) {
                                if (pk_cmpf->mpf == NULL) {
                                        kernel_free(mpf);
                                }
                                ercd = E_NOMEM;
                        }
                        else {
                                p_mpfcb = ((MPFCB *) queue_delete_next(&free_mpfcb));
                                p_mpfinib = (MPFINIB *)(p_mpfcb->p_mpfinib);
                                p_mpfinib->mpfatr = mpfatr;
                                p_mpfinib->blkcnt = pk_cmpf->blkcnt;
                                p_mpfinib->blksz = ROUND_MPF_T(pk_cmpf->blksz);
                                p_mpfinib->mpf = mpf;
                                p_mpfinib->p_mpfmb = p_mpfmb;

                                queue_initialize(&(p_mpfcb->wait_queue));
                                p_mpfcb->fblkcnt = p_mpfcb->p_mpfinib->blkcnt;
                                p_mpfcb->unused = 0U;
                                p_mpfcb->freelist = INDEX_NULL;
                                ercd = MPFID(p_mpfcb);
                        }
                }
        }
        t_unlock_cpu();

  error_exit:
        LOG_ACRE_MPF_LEAVE(ercd);
        return(ercd);
}

#endif /* TOPPERS_acre_mpf */

/*
 *  žÇÄêĹ¥á¥â¥ê¥×¡Œ¥ë€Îºïœü
 */
#ifdef TOPPERS_del_mpf

ER
del_mpf(ID mpfid)
{
        MPFCB   *p_mpfcb;
        MPFINIB *p_mpfinib;
        bool_t  dspreq;
        ER              ercd;

        LOG_DEL_MPF_ENTER(mpfid);
        CHECK_TSKCTX_UNL();
        CHECK_MPFID(mpfid);
        p_mpfcb = get_mpfcb(mpfid);

        t_lock_cpu();
        if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else if (MPFID(p_mpfcb) > tmax_smpfid) {
                dspreq = init_wait_queue(&(p_mpfcb->wait_queue));
                p_mpfinib = (MPFINIB *)(p_mpfcb->p_mpfinib);
                if ((p_mpfinib->mpfatr & TA_MEMALLOC) != 0U) {
                        kernel_free(p_mpfinib->mpf);
                }
                if ((p_mpfinib->mpfatr & TA_MBALLOC) != 0U) {
                        kernel_free(p_mpfinib->p_mpfmb);
                }
                p_mpfinib->mpfatr = TA_NOEXS;
                queue_insert_prev(&free_mpfcb, &(p_mpfcb->wait_queue));
                if (dspreq) {
                        dispatch();
                }
                ercd = E_OK;
        }
        else {
                ercd = E_OBJ;
        }
        t_unlock_cpu();

  error_exit:
        LOG_DEL_MPF_LEAVE(ercd);
        return(ercd);
}

#endif /* TOPPERS_del_mpf */

/*
 *  žÇÄêĹ¥á¥â¥ê¥Ö¥í¥Ã¥¯€Î³ÍÆÀ
 */
#ifdef TOPPERS_get_mpf

ER
get_mpf(ID mpfid, void **p_blk)
{
        MPFCB   *p_mpfcb;
        WINFO_MPF winfo_mpf;
        ER              ercd;

        LOG_GET_MPF_ENTER(mpfid, p_blk);
        CHECK_DISPATCH();
        CHECK_MPFID(mpfid);
        p_mpfcb = get_mpfcb(mpfid);

        t_lock_cpu();
        if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else if (p_mpfcb->fblkcnt > 0) {
                get_mpf_block(p_mpfcb, p_blk);
                ercd = E_OK;
        }
        else {
                p_runtsk->tstat = (TS_WAITING | TS_WAIT_MPF);
                wobj_make_wait((WOBJCB *) p_mpfcb, (WINFO_WOBJ *) &winfo_mpf);
                dispatch();
                ercd = winfo_mpf.winfo.wercd;
                if (ercd == E_OK) {
                        *p_blk = winfo_mpf.blk;
                }
        }
        t_unlock_cpu();

  error_exit:
        LOG_GET_MPF_LEAVE(ercd, *p_blk);
        return(ercd);
}

#endif /* TOPPERS_get_mpf */

/*
 *  žÇÄêĹ¥á¥â¥ê¥Ö¥í¥Ã¥¯€Î³ÍÆÀ¡Ê¥Ý¡Œ¥ê¥ó¥°¡Ë
 */
#ifdef TOPPERS_pget_mpf

ER
pget_mpf(ID mpfid, void **p_blk)
{
        MPFCB   *p_mpfcb;
        ER              ercd;

        LOG_PGET_MPF_ENTER(mpfid, p_blk);
        CHECK_TSKCTX_UNL();
        CHECK_MPFID(mpfid);
        p_mpfcb = get_mpfcb(mpfid);

        t_lock_cpu();
        if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else if (p_mpfcb->fblkcnt > 0) {
                get_mpf_block(p_mpfcb, p_blk);
                ercd = E_OK;
        }
        else {
                ercd = E_TMOUT;
        }
        t_unlock_cpu();

  error_exit:
        LOG_PGET_MPF_LEAVE(ercd, *p_blk);
        return(ercd);
}

#endif /* TOPPERS_pget_mpf */

/*
 *  žÇÄêĹ¥á¥â¥ê¥Ö¥í¥Ã¥¯€Î³ÍÆÀ¡Ê¥¿¥€¥à¥¢¥Š¥È€¢€ê¡Ë
 */
#ifdef TOPPERS_tget_mpf

ER
tget_mpf(ID mpfid, void **p_blk, TMO tmout)
{
        MPFCB   *p_mpfcb;
        WINFO_MPF winfo_mpf;
        TMEVTB  tmevtb;
        ER              ercd;

        LOG_TGET_MPF_ENTER(mpfid, p_blk, tmout);
        CHECK_DISPATCH();
        CHECK_MPFID(mpfid);
        CHECK_TMOUT(tmout);
        p_mpfcb = get_mpfcb(mpfid);

        t_lock_cpu();
        if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else if (p_mpfcb->fblkcnt > 0) {
                get_mpf_block(p_mpfcb, p_blk);
                ercd = E_OK;
        }
        else if (tmout == TMO_POL) {
                ercd = E_TMOUT;
        }
        else {
                p_runtsk->tstat = (TS_WAITING | TS_WAIT_MPF);
                wobj_make_wait_tmout((WOBJCB *) p_mpfcb, (WINFO_WOBJ *) &winfo_mpf,
                                                                                                                &tmevtb, tmout);
                dispatch();
                ercd = winfo_mpf.winfo.wercd;
                if (ercd == E_OK) {
                        *p_blk = winfo_mpf.blk;
                }
        }
        t_unlock_cpu();

  error_exit:
        LOG_TGET_MPF_LEAVE(ercd, *p_blk);
        return(ercd);
}

#endif /* TOPPERS_tget_mpf */

/*
 *  žÇÄêĹ¥á¥â¥ê¥Ö¥í¥Ã¥¯€ÎÊÖµÑ
 */
#ifdef TOPPERS_rel_mpf

ER
rel_mpf(ID mpfid, void *blk)
{
        MPFCB   *p_mpfcb;
        SIZE    blkoffset;
        uint_t  blkidx;
        TCB             *p_tcb;
        ER              ercd;
    
        LOG_REL_MPF_ENTER(mpfid, blk);
        CHECK_TSKCTX_UNL();
        CHECK_MPFID(mpfid);
        p_mpfcb = get_mpfcb(mpfid);

        t_lock_cpu();
        if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else {
                blkoffset = ((char *) blk) - (char *)(p_mpfcb->p_mpfinib->mpf);
                blkidx = (uint_t)(blkoffset / p_mpfcb->p_mpfinib->blksz);
                if (!(p_mpfcb->p_mpfinib->mpf <= blk)
                                || !(blkoffset % p_mpfcb->p_mpfinib->blksz == 0U)
                                || !(blkoffset / p_mpfcb->p_mpfinib->blksz < p_mpfcb->unused)
                                || !((p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next
                                                                                                                        == INDEX_ALLOC)) {
                        ercd = E_PAR;
                }
                else if (!queue_empty(&(p_mpfcb->wait_queue))) {
                        p_tcb = (TCB *) queue_delete_next(&(p_mpfcb->wait_queue));
                        ((WINFO_MPF *)(p_tcb->p_winfo))->blk = blk;
                        if (wait_complete(p_tcb)) {
                                dispatch();
                        }
                        ercd = E_OK;
                }
                else {
                        p_mpfcb->fblkcnt++;
                        (p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next = p_mpfcb->freelist;
                        p_mpfcb->freelist = blkidx;
                        ercd = E_OK;
                }
        }
        t_unlock_cpu();

  error_exit:
        LOG_REL_MPF_LEAVE(ercd);
        return(ercd);
}

#endif /* TOPPERS_rel_mpf */

/*
 *  žÇÄêĹ¥á¥â¥ê¥×¡Œ¥ë€ÎºÆœéŽü²œ
 */
#ifdef TOPPERS_ini_mpf

ER
ini_mpf(ID mpfid)
{
        MPFCB   *p_mpfcb;
        bool_t  dspreq;
        ER              ercd;
    
        LOG_INI_MPF_ENTER(mpfid);
        CHECK_TSKCTX_UNL();
        CHECK_MPFID(mpfid);
        p_mpfcb = get_mpfcb(mpfid);

        t_lock_cpu();
        if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else {
                dspreq = init_wait_queue(&(p_mpfcb->wait_queue));
                p_mpfcb->fblkcnt = p_mpfcb->p_mpfinib->blkcnt;
                p_mpfcb->unused = 0U;
                p_mpfcb->freelist = INDEX_NULL;
                if (dspreq) {
                        dispatch();
                }
                ercd = E_OK;
        }
        t_unlock_cpu();

  error_exit:
        LOG_INI_MPF_LEAVE(ercd);
        return(ercd);
}

#endif /* TOPPERS_ini_mpf */

/*
 *  žÇÄêĹ¥á¥â¥ê¥×¡Œ¥ë€ÎŸõÂÖ»²ŸÈ
 */
#ifdef TOPPERS_ref_mpf

ER
ref_mpf(ID mpfid, T_RMPF *pk_rmpf)
{
        MPFCB   *p_mpfcb;
        ER              ercd;
    
        LOG_REF_MPF_ENTER(mpfid, pk_rmpf);
        CHECK_TSKCTX_UNL();
        CHECK_MPFID(mpfid);
        p_mpfcb = get_mpfcb(mpfid);

        t_lock_cpu();
        if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else {
                pk_rmpf->wtskid = wait_tskid(&(p_mpfcb->wait_queue));
                pk_rmpf->fblkcnt = p_mpfcb->fblkcnt;
                ercd = E_OK;
        }
        t_unlock_cpu();

  error_exit:
        LOG_REF_MPF_LEAVE(ercd, pk_rmpf);
        return(ercd);
}

#endif /* TOPPERS_ref_mpf */