pridataq.c

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

ソースコードを見る。

マクロ定義
#define	LOG_SND_PDQ_ENTER(pdqid, data, datapri)
#define	LOG_SND_PDQ_LEAVE(ercd)
#define	LOG_PSND_PDQ_ENTER(pdqid, data, datapri)
#define	LOG_PSND_PDQ_LEAVE(ercd)
#define	LOG_IPSND_PDQ_ENTER(pdqid, data, datapri)
#define	LOG_IPSND_PDQ_LEAVE(ercd)
#define	LOG_TSND_PDQ_ENTER(pdqid, data, datapri, tmout)
#define	LOG_TSND_PDQ_LEAVE(ercd)
#define	LOG_RCV_PDQ_ENTER(pdqid, p_data, p_datapri)
#define	LOG_RCV_PDQ_LEAVE(ercd, data, datapri)
#define	LOG_PRCV_PDQ_ENTER(pdqid, p_data, p_datapri)
#define	LOG_PRCV_PDQ_LEAVE(ercd, data, datapri)
#define	LOG_TRCV_PDQ_ENTER(pdqid, p_data, p_datapri, tmout)
#define	LOG_TRCV_PDQ_LEAVE(ercd, data, datapri)
#define	LOG_INI_PDQ_ENTER(pdqid)
#define	LOG_INI_PDQ_LEAVE(ercd)
#define	LOG_REF_PDQ_ENTER(pdqid, pk_rpdq)
#define	LOG_REF_PDQ_LEAVE(ercd, pk_rpdq)
#define	tnum_pdq   ((uint_t)(tmax_pdqid - TMIN_PDQID + 1))
#define	INDEX_PDQ(pdqid)   ((uint_t)((pdqid) - TMIN_PDQID))
#define	get_pdqcb(pdqid)   (&(pdqcb_table[INDEX_PDQ(pdqid)]))
関数
void	initialize_pridataq (void)
void	enqueue_pridata (PDQCB *p_pdqcb, intptr_t data, PRI datapri)
void	dequeue_pridata (PDQCB *p_pdqcb, intptr_t *p_data, PRI *p_datapri)
bool_t	send_pridata (PDQCB *p_pdqcb, intptr_t data, PRI datapri, bool_t *p_reqdsp)
bool_t	receive_pridata (PDQCB *p_pdqcb, intptr_t *p_data, PRI *p_datapri, bool_t *p_reqdsp)
ER	snd_pdq (ID pdqid, intptr_t data, PRI datapri)
ER	psnd_pdq (ID pdqid, intptr_t data, PRI datapri)
ER	ipsnd_pdq (ID pdqid, intptr_t data, PRI datapri)
ER	tsnd_pdq (ID pdqid, intptr_t data, PRI datapri, TMO tmout)
ER	rcv_pdq (ID pdqid, intptr_t *p_data, PRI *p_datapri)
ER	prcv_pdq (ID pdqid, intptr_t *p_data, PRI *p_datapri)
ER	trcv_pdq (ID pdqid, intptr_t *p_data, PRI *p_datapri, TMO tmout)
ER	ini_pdq (ID pdqid)
ER	ref_pdq (ID pdqid, T_RPDQ *pk_rpdq)

---

マクロ定義

#define get_pdqcb

(

pdqid

)

(&(pdqcb_table[INDEX_PDQ(pdqid)]))

pridataq.c の 138 行で定義されています。

参照元 ini_pdq(), ipsnd_pdq(), prcv_pdq(), psnd_pdq(), rcv_pdq(), ref_pdq(), snd_pdq(), trcv_pdq(), と tsnd_pdq().

#define INDEX_PDQ

(

pdqid

)

((uint_t)((pdqid) - TMIN_PDQID))

pridataq.c の 137 行で定義されています。

#define LOG_INI_PDQ_ENTER

(

pdqid

)

pridataq.c の 113 行で定義されています。

参照元 ini_pdq().

#define LOG_INI_PDQ_LEAVE

(

ercd

)

pridataq.c の 117 行で定義されています。

参照元 ini_pdq().

#define LOG_IPSND_PDQ_ENTER	(	pdqid,
		data,
		datapri		)

pridataq.c の 73 行で定義されています。

参照元 ipsnd_pdq().

#define LOG_IPSND_PDQ_LEAVE

(

ercd

)

pridataq.c の 77 行で定義されています。

参照元 ipsnd_pdq().

#define LOG_PRCV_PDQ_ENTER	(	pdqid,
		p_data,
		p_datapri		)

pridataq.c の 97 行で定義されています。

参照元 prcv_pdq().

#define LOG_PRCV_PDQ_LEAVE	(	ercd,
		data,
		datapri		)

pridataq.c の 101 行で定義されています。

参照元 prcv_pdq().

#define LOG_PSND_PDQ_ENTER	(	pdqid,
		data,
		datapri		)

pridataq.c の 65 行で定義されています。

参照元 psnd_pdq().

#define LOG_PSND_PDQ_LEAVE

(

ercd

)

pridataq.c の 69 行で定義されています。

参照元 psnd_pdq().

#define LOG_RCV_PDQ_ENTER	(	pdqid,
		p_data,
		p_datapri		)

pridataq.c の 89 行で定義されています。

参照元 rcv_pdq().

#define LOG_RCV_PDQ_LEAVE	(	ercd,
		data,
		datapri		)

pridataq.c の 93 行で定義されています。

参照元 rcv_pdq().

#define LOG_REF_PDQ_ENTER	(	pdqid,
		pk_rpdq		)

pridataq.c の 121 行で定義されています。

参照元 ref_pdq().

#define LOG_REF_PDQ_LEAVE	(	ercd,
		pk_rpdq		)

pridataq.c の 125 行で定義されています。

参照元 ref_pdq().

#define LOG_SND_PDQ_ENTER	(	pdqid,
		data,
		datapri		)

pridataq.c の 57 行で定義されています。

参照元 snd_pdq().

#define LOG_SND_PDQ_LEAVE

(

ercd

)

pridataq.c の 61 行で定義されています。

参照元 snd_pdq().

#define LOG_TRCV_PDQ_ENTER	(	pdqid,
		p_data,
		p_datapri,
		tmout		)

pridataq.c の 105 行で定義されています。

参照元 trcv_pdq().

#define LOG_TRCV_PDQ_LEAVE	(	ercd,
		data,
		datapri		)

pridataq.c の 109 行で定義されています。

参照元 trcv_pdq().

#define LOG_TSND_PDQ_ENTER	(	pdqid,
		data,
		datapri,
		tmout		)

pridataq.c の 81 行で定義されています。

参照元 tsnd_pdq().

#define LOG_TSND_PDQ_LEAVE

(

ercd

)

pridataq.c の 85 行で定義されています。

参照元 tsnd_pdq().

#define tnum_pdq   ((uint_t)(tmax_pdqid - TMIN_PDQID + 1))

pridataq.c の 131 行で定義されています。

参照元 initialize_pridataq().

---

関数

void dequeue_pridata	(	PDQCB *	p_pdqcb,
		intptr_t *	p_data,
		PRI *	p_datapri
	)

pridataq.c の 207 行で定義されています。

参照先 pridataq_control_block::count, pridata_management_block::data, pridata_management_block::datapri, pridataq_control_block::p_freelist, pridataq_control_block::p_head, と pridata_management_block::p_next.

{
    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;
}

void enqueue_pridata	(	PDQCB *	p_pdqcb,
		intptr_t	data,
		PRI	datapri
	)

pridataq.c の 170 行で定義されています。

参照先 pridataq_control_block::count, pridata_management_block::data, pridata_management_block::datapri, NULL, pridataq_control_block::p_freelist, pridataq_control_block::p_head, pridata_management_block::p_next, pridataq_control_block::p_pdqinib, pridataq_initialization_block::p_pdqmb, と pridataq_control_block::unused.

{
    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++;
}

ER ini_pdq

(

ID

pdqid

)

pridataq.c の 601 行で定義されています。

参照先 CHECK_PDQID, CHECK_TSKCTX_UNL, pridataq_control_block::count, dispatch, E_OK, get_pdqcb, init_wait_queue, LOG_INI_PDQ_ENTER, LOG_INI_PDQ_LEAVE, NULL, pridataq_control_block::p_freelist, pridataq_control_block::p_head, pridataq_control_block::rwait_queue, pridataq_control_block::swait_queue, t_lock_cpu, t_unlock_cpu, と pridataq_control_block::unused.

{
    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();
    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);
}

void initialize_pridataq

(

void

)

pridataq.c の 146 行で定義されています。

参照先 pridataq_control_block::count, NULL, pridataq_control_block::p_freelist, pridataq_control_block::p_head, pridataq_control_block::p_pdqinib, pdqcb_table, pdqinib_table, queue_initialize(), pridataq_control_block::rwait_queue, pridataq_control_block::swait_queue, tnum_pdq, と pridataq_control_block::unused.

{
    uint_t  i;
    PDQCB   *p_pdqcb;

    for (p_pdqcb = pdqcb_table, i = 0; i < tnum_pdq; p_pdqcb++, 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;
    }
}

ER ipsnd_pdq	(	ID	pdqid,
		intptr_t	data,
		PRI	datapri
	)

pridataq.c の 380 行で定義されています。

参照先 CHECK_INTCTX_UNL, CHECK_PAR, CHECK_PDQID, E_OK, E_TMOUT, get_pdqcb, i_lock_cpu, i_unlock_cpu, LOG_IPSND_PDQ_ENTER, LOG_IPSND_PDQ_LEAVE, reqflg, send_pridata, と TMIN_DPRI.

{
    PDQCB   *p_pdqcb;
    bool_t  reqdsp;
    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 && datapri <= p_pdqcb->p_pdqinib->maxdpri);

    i_lock_cpu();
    if (send_pridata(p_pdqcb, data, datapri, &reqdsp)) {
        if (reqdsp) {
            reqflg = true;
        }
        ercd = E_OK;
    }
    else {
        ercd = E_TMOUT;
    }
    i_unlock_cpu();

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

ER prcv_pdq	(	ID	pdqid,
		intptr_t *	p_data,
		PRI *	p_datapri
	)

pridataq.c の 513 行で定義されています。

参照先 CHECK_PDQID, CHECK_TSKCTX_UNL, dispatch, E_OK, E_TMOUT, get_pdqcb, LOG_PRCV_PDQ_ENTER, LOG_PRCV_PDQ_LEAVE, receive_pridata, t_lock_cpu, と t_unlock_cpu.

{
    PDQCB   *p_pdqcb;
    bool_t  reqdsp;
    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 (receive_pridata(p_pdqcb, p_data, p_datapri, &reqdsp)) {
        if (reqdsp) {
            dispatch();
        }
        ercd = E_OK;
    }
    else {
        ercd = E_TMOUT;
    }
    t_unlock_cpu();

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

ER psnd_pdq	(	ID	pdqid,
		intptr_t	data,
		PRI	datapri
	)

pridataq.c の 343 行で定義されています。

参照先 CHECK_PAR, CHECK_PDQID, CHECK_TSKCTX_UNL, dispatch, E_OK, E_TMOUT, get_pdqcb, LOG_PSND_PDQ_ENTER, LOG_PSND_PDQ_LEAVE, send_pridata, t_lock_cpu, t_unlock_cpu, と TMIN_DPRI.

{
    PDQCB   *p_pdqcb;
    bool_t  reqdsp;
    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 && datapri <= p_pdqcb->p_pdqinib->maxdpri);

    t_lock_cpu();
    if (send_pridata(p_pdqcb, data, datapri, &reqdsp)) {
        if (reqdsp) {
            dispatch();
        }
        ercd = E_OK;
    }
    else {
        ercd = E_TMOUT;
    }
    t_unlock_cpu();

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

ER rcv_pdq	(	ID	pdqid,
		intptr_t *	p_data,
		PRI *	p_datapri
	)

pridataq.c の 466 行で定義されています。

参照先 CHECK_DISPATCH, CHECK_PDQID, dispatch, E_OK, get_pdqcb, LOG_RCV_PDQ_ENTER, LOG_RCV_PDQ_LEAVE, LOG_TSKSTAT, make_wait(), p_runtsk, queue_insert_prev(), receive_pridata, pridataq_control_block::rwait_queue, t_lock_cpu, t_unlock_cpu, TS_WAIT_RPDQ, TS_WAITING, と waiting_information::wercd.

{
    PDQCB   *p_pdqcb;
    WINFO_PDQ winfo_pdq;
    bool_t  reqdsp;
    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 (receive_pridata(p_pdqcb, p_data, p_datapri, &reqdsp)) {
        if (reqdsp) {
            dispatch();
        }
        ercd = E_OK;
    }
    else {
        p_runtsk->tstat = (TS_WAITING | TS_WAIT_RPDQ);
        make_wait((WINFO *) &winfo_pdq);
        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);
}

bool_t receive_pridata	(	PDQCB *	p_pdqcb,
		intptr_t *	p_data,
		PRI *	p_datapri,
		bool_t *	p_reqdsp
	)

pridataq.c の 259 行で定義されています。

参照先 pridataq_control_block::count, dequeue_pridata, enqueue_pridata, task_control_block::p_winfo, queue_delete_next(), queue_empty(), pridataq_control_block::swait_queue, と wait_complete.

{
    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_reqdsp = wait_complete(p_tcb);
        }
        else {
            *p_reqdsp = 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_reqdsp = wait_complete(p_tcb);
        return(true);
    }
    else {
        return(false);
    }
}

ER ref_pdq	(	ID	pdqid,
		T_RPDQ *	pk_rpdq
	)

pridataq.c の 640 行で定義されています。

参照先 CHECK_PDQID, CHECK_TSKCTX_UNL, pridataq_control_block::count, E_OK, get_pdqcb, LOG_REF_PDQ_ENTER, LOG_REF_PDQ_LEAVE, t_rpdq::rtskid, pridataq_control_block::rwait_queue, t_rpdq::spdqcnt, t_rpdq::stskid, pridataq_control_block::swait_queue, t_lock_cpu, t_unlock_cpu, と wait_tskid().

{
    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();
    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);
}

bool_t send_pridata	(	PDQCB *	p_pdqcb,
		intptr_t	data,
		PRI	datapri,
		bool_t *	p_reqdsp
	)

pridataq.c の 230 行で定義されています。

参照先 pridataq_control_block::count, enqueue_pridata, pridataq_control_block::p_pdqinib, task_control_block::p_winfo, pridataq_initialization_block::pdqcnt, queue_delete_next(), queue_empty(), pridataq_control_block::rwait_queue, と wait_complete.

{
    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_reqdsp = wait_complete(p_tcb);
        return(true);
    }
    else if (p_pdqcb->count < p_pdqcb->p_pdqinib->pdqcnt) {
        enqueue_pridata(p_pdqcb, data, datapri);
        *p_reqdsp = false;
        return(true);
    }
    else {
        return(false);
    }
}

ER snd_pdq	(	ID	pdqid,
		intptr_t	data,
		PRI	datapri
	)

pridataq.c の 300 行で定義されています。

参照先 CHECK_DISPATCH, CHECK_PAR, CHECK_PDQID, pridataq_waiting_information::data, pridataq_waiting_information::datapri, dispatch, E_OK, get_pdqcb, LOG_SND_PDQ_ENTER, LOG_SND_PDQ_LEAVE, p_runtsk, send_pridata, t_lock_cpu, t_unlock_cpu, TMIN_DPRI, TS_WAIT_SPDQ, TS_WAITING, waiting_information::wercd, wait_object_waiting_information::winfo, と wobj_make_wait.

{
    PDQCB   *p_pdqcb;
    WINFO_PDQ winfo_pdq;
    bool_t  reqdsp;
    ER      ercd;

    LOG_SND_PDQ_ENTER(pdqid, data, datapri);
    CHECK_DISPATCH();
    CHECK_PDQID(pdqid);
    p_pdqcb = get_pdqcb(pdqid);
    CHECK_PAR(TMIN_DPRI <= datapri && datapri <= p_pdqcb->p_pdqinib->maxdpri);

    t_lock_cpu();
    if (send_pridata(p_pdqcb, data, datapri, &reqdsp)) {
        if (reqdsp) {
            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);
}

ER trcv_pdq	(	ID	pdqid,
		intptr_t *	p_data,
		PRI *	p_datapri,
		TMO	tmout
	)

pridataq.c の 549 行で定義されています。

参照先 CHECK_DISPATCH, CHECK_PDQID, CHECK_TMOUT, dispatch, E_OK, E_TMOUT, get_pdqcb, LOG_TRCV_PDQ_ENTER, LOG_TRCV_PDQ_LEAVE, LOG_TSKSTAT, make_wait_tmout, p_runtsk, queue_insert_prev(), receive_pridata, pridataq_control_block::rwait_queue, t_lock_cpu, t_unlock_cpu, TMO_POL, TS_WAIT_RPDQ, TS_WAITING, と waiting_information::wercd.

{
    PDQCB   *p_pdqcb;
    WINFO_PDQ winfo_pdq;
    TMEVTB  tmevtb;
    bool_t  reqdsp;
    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 (receive_pridata(p_pdqcb, p_data, p_datapri, &reqdsp)) {
        if (reqdsp) {
            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 *) &winfo_pdq, &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);
}

ER tsnd_pdq	(	ID	pdqid,
		intptr_t	data,
		PRI	datapri,
		TMO	tmout
	)

pridataq.c の 417 行で定義されています。

参照先 CHECK_DISPATCH, CHECK_PAR, CHECK_PDQID, CHECK_TMOUT, pridataq_waiting_information::data, pridataq_waiting_information::datapri, dispatch, E_OK, E_TMOUT, get_pdqcb, LOG_TSND_PDQ_ENTER, LOG_TSND_PDQ_LEAVE, p_runtsk, send_pridata, t_lock_cpu, t_unlock_cpu, TMIN_DPRI, TMO_POL, TS_WAIT_SPDQ, TS_WAITING, waiting_information::wercd, wait_object_waiting_information::winfo, と wobj_make_wait_tmout.

{
    PDQCB   *p_pdqcb;
    WINFO_PDQ winfo_pdq;
    TMEVTB  tmevtb;
    bool_t  reqdsp;
    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 && datapri <= p_pdqcb->p_pdqinib->maxdpri);

    t_lock_cpu();
    if (send_pridata(p_pdqcb, data, datapri, &reqdsp)) {
        if (reqdsp) {
            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);
}