source: mypx/extension/dcre/kernel/pridataq.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 "pridataq.h"

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

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

#ifndef LOG_DEL_PDQ_ENTER
#define LOG_DEL_PDQ_ENTER(pdqid)
#endif /* LOG_DEL_PDQ_ENTER */

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

#ifndef LOG_SND_PDQ_ENTER
#define LOG_SND_PDQ_ENTER(pdqid, data, datapri)
#endif /* LOG_SND_PDQ_ENTER */

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

#ifndef LOG_PSND_PDQ_ENTER
#define LOG_PSND_PDQ_ENTER(pdqid, data, datapri)
#endif /* LOG_PSND_PDQ_ENTER */

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

#ifndef LOG_IPSND_PDQ_ENTER
#define LOG_IPSND_PDQ_ENTER(pdqid, data, datapri)
#endif /* LOG_IPSND_PDQ_ENTER */

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

#ifndef LOG_TSND_PDQ_ENTER
#define LOG_TSND_PDQ_ENTER(pdqid, data, datapri, tmout)
#endif /* LOG_TSND_PDQ_ENTER */

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

#ifndef LOG_RCV_PDQ_ENTER
#define LOG_RCV_PDQ_ENTER(pdqid, p_data, p_datapri)
#endif /* LOG_RCV_PDQ_ENTER */

#ifndef LOG_RCV_PDQ_LEAVE
#define LOG_RCV_PDQ_LEAVE(ercd, data, datapri)
#endif /* LOG_RCV_PDQ_LEAVE */

#ifndef LOG_PRCV_PDQ_ENTER
#define LOG_PRCV_PDQ_ENTER(pdqid, p_data, p_datapri)
#endif /* LOG_PRCV_PDQ_ENTER */

#ifndef LOG_PRCV_PDQ_LEAVE
#define LOG_PRCV_PDQ_LEAVE(ercd, data, datapri)
#endif /* LOG_PRCV_PDQ_LEAVE */

#ifndef LOG_TRCV_PDQ_ENTER
#define LOG_TRCV_PDQ_ENTER(pdqid, p_data, p_datapri, tmout)
#endif /* LOG_TRCV_PDQ_ENTER */

#ifndef LOG_TRCV_PDQ_LEAVE
#define LOG_TRCV_PDQ_LEAVE(ercd, data, datapri)
#endif /* LOG_TRCV_PDQ_LEAVE */

#ifndef LOG_INI_PDQ_ENTER
#define LOG_INI_PDQ_ENTER(pdqid)
#endif /* LOG_INI_PDQ_ENTER */

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

#ifndef LOG_REF_PDQ_ENTER
#define LOG_REF_PDQ_ENTER(pdqid, pk_rpdq)
#endif /* LOG_REF_PDQ_ENTER */

#ifndef LOG_REF_PDQ_LEAVE
#define LOG_REF_PDQ_LEAVE(ercd, pk_rpdq)
#endif /* LOG_REF_PDQ_LEAVE */

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡Œ€Î¿ô
 */
#define tnum_pdq        ((uint_t)(tmax_pdqid - TMIN_PDQID + 1))
#define tnum_spdq       ((uint_t)(tmax_spdqid - TMIN_PDQID + 1))

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡ŒID€«€éÍ¥ÀèÅ٥ǡŒ¥¿¥­¥å¡ŒŽÉÍý¥Ö¥í¥Ã¥¯€òŒè€êœÐ€¹€¿
 *  €á€Î¥Þ¥¯¥í
 */
#define INDEX_PDQ(pdqid)        ((uint_t)((pdqid) - TMIN_PDQID))
#define get_pdqcb(pdqid)        (&(pdqcb_table[INDEX_PDQ(pdqid)]))

#ifdef TOPPERS_pdqini

/*
 *  »ÈÍÑ€·€Æ€€€Ê€€Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡ŒŽÉÍý¥Ö¥í¥Ã¥¯€Î¥ê¥¹¥È
 */
QUEUE   free_pdqcb;

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡Œµ¡Çœ€ÎœéŽü²œ
 */
void
initialize_pridataq(void)
{
        uint_t  i, j;
        PDQCB   *p_pdqcb;
        PDQINIB *p_pdqinib;

        for (i = 0; i < tnum_spdq; i++) {
                p_pdqcb = &(pdqcb_table[i]);
                queue_initialize(&(p_pdqcb->swait_queue));
                p_pdqcb->p_pdqinib = &(pdqinib_table[i]);
                queue_initialize(&(p_pdqcb->rwait_queue));
                p_pdqcb->count = 0U;
                p_pdqcb->p_head = NULL;
                p_pdqcb->unused = 0U;
                p_pdqcb->p_freelist = NULL;
        }
        queue_initialize(&free_pdqcb);
        for (j = 0; i < tnum_pdq; i++, j++) {
                p_pdqcb = &(pdqcb_table[i]);
                p_pdqinib = &(apdqinib_table[j]);
                p_pdqinib->pdqatr = TA_NOEXS;
                p_pdqcb->p_pdqinib = ((const PDQINIB *) p_pdqinib);
                queue_insert_prev(&free_pdqcb, &(p_pdqcb->swait_queue));
        }
}

#endif /* TOPPERS_pdqini */

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡ŒŽÉÍýÎΰè€Ø€Î¥Ç¡Œ¥¿€Î³ÊÇŒ
 */
#ifdef TOPPERS_pdqenq

void
enqueue_pridata(PDQCB *p_pdqcb, intptr_t data, PRI datapri)
{
        PDQMB   *p_pdqmb;
        PDQMB   **pp_prev_next, *p_next;

        if (p_pdqcb->p_freelist != NULL) {
                p_pdqmb = p_pdqcb->p_freelist;
                p_pdqcb->p_freelist = p_pdqmb->p_next;
        }
        else {
                p_pdqmb = p_pdqcb->p_pdqinib->p_pdqmb + p_pdqcb->unused;
                p_pdqcb->unused++;
        }

        p_pdqmb->data = data;
        p_pdqmb->datapri = datapri;

        pp_prev_next = &(p_pdqcb->p_head);
        while ((p_next = *pp_prev_next) != NULL) {
                if (p_next->datapri > datapri) {
                        break;
                }
                pp_prev_next = &(p_next->p_next);
        }
        p_pdqmb->p_next = p_next;
        *pp_prev_next = p_pdqmb;
        p_pdqcb->count++;
}

#endif /* TOPPERS_pdqenq */

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡ŒŽÉÍýÎΰ耫€é€Î¥Ç¡Œ¥¿€ÎŒèœÐ€·
 */
#ifdef TOPPERS_pdqdeq

void
dequeue_pridata(PDQCB *p_pdqcb, intptr_t *p_data, PRI *p_datapri)
{
        PDQMB   *p_pdqmb;

        p_pdqmb = p_pdqcb->p_head;
        p_pdqcb->p_head = p_pdqmb->p_next;
        p_pdqcb->count--;

        *p_data = p_pdqmb->data;
        *p_datapri = p_pdqmb->datapri;

        p_pdqmb->p_next = p_pdqcb->p_freelist;
        p_pdqcb->p_freelist = p_pdqmb;
}

#endif /* TOPPERS_pdqdeq */

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡Œ€Ø€Î¥Ç¡Œ¥¿Á÷¿®
 */
#ifdef TOPPERS_pdqsnd

bool_t
send_pridata(PDQCB *p_pdqcb, intptr_t data, PRI datapri, bool_t *p_dspreq)
{
        TCB             *p_tcb;

        if (!queue_empty(&(p_pdqcb->rwait_queue))) {
                p_tcb = (TCB *) queue_delete_next(&(p_pdqcb->rwait_queue));
                ((WINFO_PDQ *)(p_tcb->p_winfo))->data = data;
                ((WINFO_PDQ *)(p_tcb->p_winfo))->datapri = datapri;
                *p_dspreq = wait_complete(p_tcb);
                return(true);
        }
        else if (p_pdqcb->count < p_pdqcb->p_pdqinib->pdqcnt) {
                enqueue_pridata(p_pdqcb, data, datapri);
                *p_dspreq = false;
                return(true);
        }
        else {
                return(false);
        }
}

#endif /* TOPPERS_pdqsnd */

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡Œ€«€é€Î¥Ç¡Œ¥¿Œõ¿®
 */
#ifdef TOPPERS_pdqrcv

bool_t
receive_pridata(PDQCB *p_pdqcb, intptr_t *p_data,
                                                                        PRI *p_datapri, bool_t *p_dspreq)
{
        TCB             *p_tcb;
        intptr_t data;
        PRI             datapri;

        if (p_pdqcb->count > 0U) {
                dequeue_pridata(p_pdqcb, p_data, p_datapri);
                if (!queue_empty(&(p_pdqcb->swait_queue))) {
                        p_tcb = (TCB *) queue_delete_next(&(p_pdqcb->swait_queue));
                        data = ((WINFO_PDQ *)(p_tcb->p_winfo))->data;
                        datapri = ((WINFO_PDQ *)(p_tcb->p_winfo))->datapri;
                        enqueue_pridata(p_pdqcb, data, datapri);
                        *p_dspreq = wait_complete(p_tcb);
                }
                else {
                        *p_dspreq = false;
                }
                return(true);
        }
        else if (!queue_empty(&(p_pdqcb->swait_queue))) {
                p_tcb = (TCB *) queue_delete_next(&(p_pdqcb->swait_queue));
                *p_data = ((WINFO_PDQ *)(p_tcb->p_winfo))->data;
                *p_datapri = ((WINFO_PDQ *)(p_tcb->p_winfo))->datapri;
                *p_dspreq = wait_complete(p_tcb);
                return(true);
        }
        else {
                return(false);
        }
}

#endif /* TOPPERS_pdqrcv */

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡Œ€ÎÀžÀ®
 */
#ifdef TOPPERS_acre_pdq

ER_UINT
acre_pdq(const T_CPDQ *pk_cpdq)
{
        PDQCB   *p_pdqcb;
        PDQINIB *p_pdqinib;
        ATR             pdqatr;
        PDQMB   *p_pdqmb;
        ER              ercd;

        LOG_ACRE_PDQ_ENTER(pk_cpdq);
        CHECK_TSKCTX_UNL();
        CHECK_RSATR(pk_cpdq->pdqatr, TA_TPRI);
        CHECK_DPRI(pk_cpdq->maxdpri);
        if (pk_cpdq->pdqmb != NULL) {
                CHECK_ALIGN_MB(pk_cpdq->pdqmb);
        }
        pdqatr = pk_cpdq->pdqatr;
        p_pdqmb = pk_cpdq->pdqmb;

        t_lock_cpu();
        if (tnum_pdq == 0 || queue_empty(&free_pdqcb)) {
                ercd = E_NOID;
        }
        else {
                if (pk_cpdq->pdqcnt != 0 && p_pdqmb == NULL) {
                        p_pdqmb = kernel_malloc(sizeof(PDQMB) * pk_cpdq->pdqcnt);
                        pdqatr |= TA_MBALLOC;
                }
                if (pk_cpdq->pdqcnt != 0 && p_pdqmb == NULL) {
                        ercd = E_NOMEM;
                }
                else {
                        p_pdqcb = ((PDQCB *) queue_delete_next(&free_pdqcb));
                        p_pdqinib = (PDQINIB *)(p_pdqcb->p_pdqinib);
                        p_pdqinib->pdqatr = pdqatr;
                        p_pdqinib->pdqcnt = pk_cpdq->pdqcnt;
                        p_pdqinib->maxdpri = pk_cpdq->maxdpri;
                        p_pdqinib->p_pdqmb = p_pdqmb;

                        queue_initialize(&(p_pdqcb->swait_queue));
                        queue_initialize(&(p_pdqcb->rwait_queue));
                        p_pdqcb->count = 0U;
                        p_pdqcb->p_head = NULL;
                        p_pdqcb->unused = 0U;
                        p_pdqcb->p_freelist = NULL;
                        ercd = PDQID(p_pdqcb);
                }
        }
        t_unlock_cpu();

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

#endif /* TOPPERS_acre_pdq */

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡Œ€Îºïœü
 */
#ifdef TOPPERS_del_pdq

ER
del_pdq(ID pdqid)
{
        PDQCB   *p_pdqcb;
        PDQINIB *p_pdqinib;
        bool_t  dspreq;
        ER              ercd;

        LOG_DEL_PDQ_ENTER(pdqid);
        CHECK_TSKCTX_UNL();
        CHECK_PDQID(pdqid);
        p_pdqcb = get_pdqcb(pdqid);

        t_lock_cpu();
        if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else if (PDQID(p_pdqcb) > tmax_spdqid) {
                dspreq = init_wait_queue(&(p_pdqcb->swait_queue));
                if (init_wait_queue(&(p_pdqcb->rwait_queue))) {
                        dspreq = true;
                }
                p_pdqinib = (PDQINIB *)(p_pdqcb->p_pdqinib);
                if ((p_pdqinib->pdqatr & TA_MBALLOC) != 0U) {
                        kernel_free(p_pdqinib->p_pdqmb);
                }
                p_pdqinib->pdqatr = TA_NOEXS;
                queue_insert_prev(&free_pdqcb, &(p_pdqcb->swait_queue));
                if (dspreq) {
                        dispatch();
                }
                ercd = E_OK;
        }
        else {
                ercd = E_OBJ;
        }
        t_unlock_cpu();

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

#endif /* TOPPERS_del_pdq */

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡Œ€Ø€ÎÁ÷¿®
 */
#ifdef TOPPERS_snd_pdq

ER
snd_pdq(ID pdqid, intptr_t data, PRI datapri)
{
        PDQCB   *p_pdqcb;
        WINFO_PDQ winfo_pdq;
        bool_t  dspreq;
        ER              ercd;

        LOG_SND_PDQ_ENTER(pdqid, data, datapri);
        CHECK_DISPATCH();
        CHECK_PDQID(pdqid);
        p_pdqcb = get_pdqcb(pdqid);
        CHECK_PAR(TMIN_DPRI <= datapri);

        t_lock_cpu();
        if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else if (!(datapri <= p_pdqcb->p_pdqinib->maxdpri)) {
                ercd = E_PAR;
        }
        else if (send_pridata(p_pdqcb, data, datapri, &dspreq)) {
                if (dspreq) {
                        dispatch();
                }
                ercd = E_OK;
        }
        else {
                winfo_pdq.data = data;
                winfo_pdq.datapri = datapri;
                p_runtsk->tstat = (TS_WAITING | TS_WAIT_SPDQ);
                wobj_make_wait((WOBJCB *) p_pdqcb, (WINFO_WOBJ *) &winfo_pdq);
                dispatch();
                ercd = winfo_pdq.winfo.wercd;
        }
        t_unlock_cpu();

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

#endif /* TOPPERS_snd_pdq */

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡Œ€Ø€ÎÁ÷¿®¡Ê¥Ý¡Œ¥ê¥ó¥°¡Ë
 */
#ifdef TOPPERS_psnd_pdq

ER
psnd_pdq(ID pdqid, intptr_t data, PRI datapri)
{
        PDQCB   *p_pdqcb;
        bool_t  dspreq;
        ER              ercd;

        LOG_PSND_PDQ_ENTER(pdqid, data, datapri);
        CHECK_TSKCTX_UNL();
        CHECK_PDQID(pdqid);
        p_pdqcb = get_pdqcb(pdqid);
        CHECK_PAR(TMIN_DPRI <= datapri);

        t_lock_cpu();
        if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else if (!(datapri <= p_pdqcb->p_pdqinib->maxdpri)) {
                ercd = E_PAR;
        }
        else if (send_pridata(p_pdqcb, data, datapri, &dspreq)) {
                if (dspreq) {
                        dispatch();
                }
                ercd = E_OK;
        }
        else {
                ercd = E_TMOUT;
        }
        t_unlock_cpu();

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

#endif /* TOPPERS_psnd_pdq */

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡Œ€Ø€ÎÁ÷¿®¡Ê¥Ý¡Œ¥ê¥ó¥°¡€È󥿥¹¥¯¥³¥ó¥Æ¥­¥¹¥ÈÍÑ¡Ë
 */
#ifdef TOPPERS_ipsnd_pdq

ER
ipsnd_pdq(ID pdqid, intptr_t data, PRI datapri)
{
        PDQCB   *p_pdqcb;
        bool_t  dspreq;
        ER              ercd;

        LOG_IPSND_PDQ_ENTER(pdqid, data, datapri);
        CHECK_INTCTX_UNL();
        CHECK_PDQID(pdqid);
        p_pdqcb = get_pdqcb(pdqid);
        CHECK_PAR(TMIN_DPRI <= datapri);

        i_lock_cpu();
        if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else if (!(datapri <= p_pdqcb->p_pdqinib->maxdpri)) {
                ercd = E_PAR;
        }
        else if (send_pridata(p_pdqcb, data, datapri, &dspreq)) {
                if (dspreq) {
                        reqflg = true;
                }
                ercd = E_OK;
        }
        else {
                ercd = E_TMOUT;
        }
        i_unlock_cpu();

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

#endif /* TOPPERS_ipsnd_pdq */

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡Œ€Ø€ÎÁ÷¿®¡Ê¥¿¥€¥à¥¢¥Š¥È€¢€ê¡Ë
 */
#ifdef TOPPERS_tsnd_pdq

ER
tsnd_pdq(ID pdqid, intptr_t data, PRI datapri, TMO tmout)
{
        PDQCB   *p_pdqcb;
        WINFO_PDQ winfo_pdq;
        TMEVTB  tmevtb;
        bool_t  dspreq;
        ER              ercd;

        LOG_TSND_PDQ_ENTER(pdqid, data, datapri, tmout);
        CHECK_DISPATCH();
        CHECK_PDQID(pdqid);
        CHECK_TMOUT(tmout);
        p_pdqcb = get_pdqcb(pdqid);
        CHECK_PAR(TMIN_DPRI <= datapri);

        t_lock_cpu();
        if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else if (!(datapri <= p_pdqcb->p_pdqinib->maxdpri)) {
                ercd = E_PAR;
        }
        else if (send_pridata(p_pdqcb, data, datapri, &dspreq)) {
                if (dspreq) {
                        dispatch();
                }
                ercd = E_OK;
        }
        else if (tmout == TMO_POL) {
                ercd = E_TMOUT;
        }
        else {
                winfo_pdq.data = data;
                winfo_pdq.datapri = datapri;
                p_runtsk->tstat = (TS_WAITING | TS_WAIT_SPDQ);
                wobj_make_wait_tmout((WOBJCB *) p_pdqcb, (WINFO_WOBJ *) &winfo_pdq,
                                                                                                                &tmevtb, tmout);
                dispatch();
                ercd = winfo_pdq.winfo.wercd;
        }
        t_unlock_cpu();

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

#endif /* TOPPERS_tsnd_pdq */

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡Œ€«€é€ÎŒõ¿®
 */
#ifdef TOPPERS_rcv_pdq

ER
rcv_pdq(ID pdqid, intptr_t *p_data, PRI *p_datapri)
{
        PDQCB   *p_pdqcb;
        WINFO_PDQ winfo_pdq;
        bool_t  dspreq;
        ER              ercd;

        LOG_RCV_PDQ_ENTER(pdqid, p_data, p_datapri);
        CHECK_DISPATCH();
        CHECK_PDQID(pdqid);
        p_pdqcb = get_pdqcb(pdqid);

        t_lock_cpu();
        if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else if (receive_pridata(p_pdqcb, p_data, p_datapri, &dspreq)) {
                if (dspreq) {
                        dispatch();
                }
                ercd = E_OK;
        }
        else {
                p_runtsk->tstat = (TS_WAITING | TS_WAIT_RPDQ);
                make_wait(&(winfo_pdq.winfo));
                queue_insert_prev(&(p_pdqcb->rwait_queue), &(p_runtsk->task_queue));
                winfo_pdq.p_pdqcb = p_pdqcb;
                LOG_TSKSTAT(p_runtsk);
                dispatch();
                ercd = winfo_pdq.winfo.wercd;
                if (ercd == E_OK) {
                        *p_data = winfo_pdq.data;
                        *p_datapri = winfo_pdq.datapri;
                }
        }
        t_unlock_cpu();

  error_exit:
        LOG_RCV_PDQ_LEAVE(ercd, *p_data, *p_datapri);
        return(ercd);
}

#endif /* TOPPERS_rcv_pdq */

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡Œ€«€é€ÎŒõ¿®¡Ê¥Ý¡Œ¥ê¥ó¥°¡Ë
 */
#ifdef TOPPERS_prcv_pdq

ER
prcv_pdq(ID pdqid, intptr_t *p_data, PRI *p_datapri)
{
        PDQCB   *p_pdqcb;
        bool_t  dspreq;
        ER              ercd;

        LOG_PRCV_PDQ_ENTER(pdqid, p_data, p_datapri);
        CHECK_TSKCTX_UNL();
        CHECK_PDQID(pdqid);
        p_pdqcb = get_pdqcb(pdqid);

        t_lock_cpu();
        if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else if (receive_pridata(p_pdqcb, p_data, p_datapri, &dspreq)) {
                if (dspreq) {
                        dispatch();
                }
                ercd = E_OK;
        }
        else {
                ercd = E_TMOUT;
        }
        t_unlock_cpu();

  error_exit:
        LOG_PRCV_PDQ_LEAVE(ercd, *p_data, *p_datapri);
        return(ercd);
}

#endif /* TOPPERS_prcv_pdq */

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡Œ€«€é€ÎŒõ¿®¡Ê¥¿¥€¥à¥¢¥Š¥È€¢€ê¡Ë
 */
#ifdef TOPPERS_trcv_pdq

ER
trcv_pdq(ID pdqid, intptr_t *p_data, PRI *p_datapri, TMO tmout)
{
        PDQCB   *p_pdqcb;
        WINFO_PDQ winfo_pdq;
        TMEVTB  tmevtb;
        bool_t  dspreq;
        ER              ercd;

        LOG_TRCV_PDQ_ENTER(pdqid, p_data, p_datapri, tmout);
        CHECK_DISPATCH();
        CHECK_PDQID(pdqid);
        CHECK_TMOUT(tmout);
        p_pdqcb = get_pdqcb(pdqid);

        t_lock_cpu();
        if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else if (receive_pridata(p_pdqcb, p_data, p_datapri, &dspreq)) {
                if (dspreq) {
                        dispatch();
                }
                ercd = E_OK;
        }
        else if (tmout == TMO_POL) {
                ercd = E_TMOUT;
        }
        else {
                p_runtsk->tstat = (TS_WAITING | TS_WAIT_RPDQ);
                make_wait_tmout(&(winfo_pdq.winfo), &tmevtb, tmout);
                queue_insert_prev(&(p_pdqcb->rwait_queue), &(p_runtsk->task_queue));
                winfo_pdq.p_pdqcb = p_pdqcb;
                LOG_TSKSTAT(p_runtsk);
                dispatch();
                ercd = winfo_pdq.winfo.wercd;
                if (ercd == E_OK) {
                        *p_data = winfo_pdq.data;
                        *p_datapri = winfo_pdq.datapri;
                }
        }
        t_unlock_cpu();

  error_exit:
        LOG_TRCV_PDQ_LEAVE(ercd, *p_data, *p_datapri);
        return(ercd);
}

#endif /* TOPPERS_trcv_pdq */

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡Œ€ÎºÆœéŽü²œ
 */
#ifdef TOPPERS_ini_pdq

ER
ini_pdq(ID pdqid)
{
        PDQCB   *p_pdqcb;
        bool_t  dspreq;
        ER              ercd;
    
        LOG_INI_PDQ_ENTER(pdqid);
        CHECK_TSKCTX_UNL();
        CHECK_PDQID(pdqid);
        p_pdqcb = get_pdqcb(pdqid);

        t_lock_cpu();
        if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else {
                dspreq = init_wait_queue(&(p_pdqcb->swait_queue));
                if (init_wait_queue(&(p_pdqcb->rwait_queue))) {
                        dspreq = true;
                }
                p_pdqcb->count = 0U;
                p_pdqcb->p_head = NULL;
                p_pdqcb->unused = 0U;
                p_pdqcb->p_freelist = NULL;
                if (dspreq) {
                        dispatch();
                }
                ercd = E_OK;
        }
        t_unlock_cpu();

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

#endif /* TOPPERS_ini_pdq */

/*
 *  Í¥ÀèÅ٥ǡŒ¥¿¥­¥å¡Œ€ÎŸõÂÖ»²ŸÈ
 */
#ifdef TOPPERS_ref_pdq

ER
ref_pdq(ID pdqid, T_RPDQ *pk_rpdq)
{
        PDQCB   *p_pdqcb;
        ER              ercd;
    
        LOG_REF_PDQ_ENTER(pdqid, pk_rpdq);
        CHECK_TSKCTX_UNL();
        CHECK_PDQID(pdqid);
        p_pdqcb = get_pdqcb(pdqid);

        t_lock_cpu();
        if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
                ercd = E_NOEXS;
        }
        else {
                pk_rpdq->stskid = wait_tskid(&(p_pdqcb->swait_queue));
                pk_rpdq->rtskid = wait_tskid(&(p_pdqcb->rwait_queue));
                pk_rpdq->spdqcnt = p_pdqcb->count;
                ercd = E_OK;
        }
        t_unlock_cpu();

  error_exit:
        LOG_REF_PDQ_LEAVE(ercd, pk_rpdq);
        return(ercd);
}

#endif /* TOPPERS_ref_pdq */