source: EcnlProtoTool/trunk/asp3_dcre/tinet/netinet/udpn_usrreq_nblk.c@ 331

/*
 *  TINET (UDP/IP Protocol Stack)
 * 
 *  Copyright (C) 2001-2017 by Dep. of Computer Science and Engineering
 *                   Tomakomai National College of Technology, JAPAN
 *
 *  上記著作権者
は，以下の (1)～(4) の条件か，Free Software Foundation 
 *  によってå…
¬è¡¨ã•ã‚Œã¦ã„ã‚‹ GNU General Public License の Version 2 に記
 *  è¿°ã•ã‚Œã¦ã„ã‚‹æ¡ä»¶ã‚’æº€ãŸã™å ´åˆã«é™ã‚Šï¼Œæœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢ï¼ˆæœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢
 *  を改変したものを含む．以下同じ）を使用・複製・改変・再é…
å¸ƒï¼ˆä»¥ä¸‹ï¼Œ
 *  利用と呼ぶ）することを無償で許諾する．
 *  (1) æœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢ã‚’ã‚½ãƒ¼ã‚¹ã‚³ãƒ¼ãƒ‰ã®å½¢ã§åˆ©ç”¨ã™ã‚‹å ´åˆã«ã¯ï¼Œä¸Šè¨˜ã®è‘—ä½œ
 *      権表示，この利用条件および下記の無保証規定が，そのままの形でソー
 *      スコード中に含まれていること．
 *  (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
 *      用できる形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
 *      者
マニュアルなど）に，上記の著作権表示，この利用条件および下記
 *      の無保証規定を掲載すること．
 *  (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
 *      用できない形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®æ¡ä»¶ã‚’満たすこと．
 *    (a) 再é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
マニュアルなど）に，上記の著
 *        作権表示，この利用条件および下記の無保証規定を掲載すること．
 *  (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
 *      害からも，上記著作権者
およびTOPPERSプロジェクトをå…
è²¬ã™ã‚‹ã“と．
 *
 *  本ソフトウェアは，無保証で提供されているものである．上記著作権者
お
 *  よびTOPPERSプロジェクトは，本ソフトウェアに関して，その適用可能性も
 *  含めて，いかなる保証も行わない．また，本ソフトウェアの利用により直
 *  æŽ¥çš„ã¾ãŸã¯é–“æŽ¥çš„ã«ç”Ÿã˜ãŸã„ã‹ãªã‚‹æå®³ã«é–¢ã—ã¦ã‚‚ï¼Œãã®è²¬ä»»ã‚’è² ã‚ãªã„ï¼Ž
 * 
 *  @(#) $Id$
 */

/*
 * Copyright (c) 1982, 1986, 1988, 1990, 1993, 1995
 *      The Regents of the University of California.  All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must ceproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. All advertising materials mentioning features or use of this software
 *    must display the following acknowledgement:
 *      This product includes software developed by the University of
 *      California, Berkeley and its contributors.
 * 4. Neither the name of the University nor the names of its contributors
 *    may be used to endorse or promote products derived from this software
 *    without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
 * SUCH DAMAGE.
 *
 *      @(#)udp_usrreq.c        8.6 (Berkeley) 5/23/95
 * $FreeBSD: src/sys/netinet/udp_usrreq.c,v 1.49.2.2 1999/08/29 16:29:58 peter Exp $
 */

#ifdef __udp_can_snd_nblk

/*
 *  udp_can_snd -- ペンディングしている送信のキャンセル
 */

ER
UDP_CAN_SND (T_UDP_CEP *cep, ER error)
{
        if (cep->snd_p_dstaddr != NULL) {       /* ノンブロッキングコールでペンディング中 */
                if (IS_PTR_DEFINED(cep->callback))

#ifdef TCP_CFG_NON_BLOCKING_COMPAT14
                        (*cep->callback)(GET_UDP_CEPID(cep), TFN_UDP_SND_DAT, (void*)error);
#else
                        (*cep->callback)(GET_UDP_CEPID(cep), TFN_UDP_SND_DAT, (void*)&error);
#endif
                else
                        error = E_OBJ;
                cep->snd_p_dstaddr = NULL;
                }
        else if (cep->snd_tskid != TA_NULL) {   /* 非ノンブロッキングコールでペンディング中 */

#ifdef UDP_CFG_EXTENTIONS

                /* 待
ち中に発生したエラー情
å ±ã‚’è¨­å®šã™ã‚‹ã€‚*/
                cep->error = error;

#endif  /* of #ifdef UDP_CFG_EXTENTIONS */

                error = rel_wai(cep->snd_tskid);
                cep->snd_tskid = TA_NULL;
                }
        else                                    /* どちらでもないならペンディングしていない */
                error = EV_NOPND;

        return error;
        }

#endif  /* of #ifdef __udp_can_snd_nblk */

#ifdef __udp_can_rcv_nblk

/*
 *  udp_can_rcv -- ペンディングしている受信のキャンセル
 */

ER
UDP_CAN_RCV (T_UDP_CEP *cep, ER error)
{
        if (cep->rcv_p_dstaddr != NULL) {       /* ノンブロッキングコールでペンディング中 */
                if (IS_PTR_DEFINED(cep->callback))

#ifdef TCP_CFG_NON_BLOCKING_COMPAT14
                        (*cep->callback)(GET_UDP_CEPID(cep), TFN_UDP_RCV_DAT, (void*)error);
#else
                        (*cep->callback)(GET_UDP_CEPID(cep), TFN_UDP_RCV_DAT, (void*)&error);
#endif
                else
                        error = E_OBJ;
                cep->rcv_p_dstaddr = NULL;
                }
        else if (cep->rcv_tskid != TA_NULL) {   /* 非ノンブロッキングコールでペンディング中 */

#ifdef UDP_CFG_EXTENTIONS

                /* 待
ち中に発生したエラー情
å ±ã‚’è¨­å®šã™ã‚‹ã€‚*/
                cep->error = error;

#endif  /* of #ifdef UDP_CFG_EXTENTIONS */

                error = rel_wai(cep->rcv_tskid);
                cep->rcv_tskid = TA_NULL;
                }
        else                                    /* どちらでもないならペンディングしていない */
                error = EV_NOPND;

        return error;
        }

#endif  /* of #ifdef __udp_can_rcv_nblk */

#ifdef __udp_snd_dat_nblk

/*
 *  udp_snd_dat -- パケットの送信【標準機能】
 */

ER_UINT
UDP_SND_DAT (ID cepid, T_IPEP *p_dstaddr, void *data, int_t len, TMO tmout)
{
        T_UDP_CEP       *cep;
        ER              error;

        /* p_dstaddr または data が NULL ならエラー */
        if (p_dstaddr == NULL || data == NULL)
                return E_PAR;

        /* データ長をチェックする。*/
        if (len < 0 || len + IP_HDR_SIZE + UDP_HDR_SIZE > IF_MTU)
                return E_PAR;

#if (API_PROTO == API_PROTO_IPV6) && !defined(API_CFG_IP4MAPPED_ADDR)

        /*
         * API が IPv6 で IPv4 射影アドレスが認められていないのにもかかわらず、
         * IPv4 射影アドレスが指定されたらエラー
         */
        if (in6_is_addr_ipv4mapped(&p_dstaddr->ipaddr))
                return E_PAR;

#endif  /* of #if (API_PROTO == API_PROTO_IPV6) && !defined(DAPI_CFG_IP4MAPPED_ADDR) */

        /* UDP 通信端点 ID をチェックする。*/
        if (!VALID_UDP_CEPID(cepid))
                return E_ID;

        /* UDP 通信端点を得る。*/
        cep = GET_UDP_CEP(cepid);

        /* UDP 通信端点をチェックする。*/
        if (!VALID_UDP_CEP(cep))
                return E_NOEXS;

        /*
         *  自ポート番号が UDP_PORTANY なら、自動で割り当てる。
         */
        if (cep->myaddr.portno == UDP_PORTANY) {
                if ((error = UDP_ALLOC_AUTO_PORT(cep)) != E_OK)
                        return error;
                }

        /*
         * タイムアウトをチェックする。
         */
        if (tmout == TMO_NBLK) {        /* ノンブロッキングコール */

                /* 通信端点をロックする。*/
                syscall(wai_sem(cep->semid_lock));

                if (cep->snd_p_dstaddr != NULL) {

                        /* ノンブロッキングコールでペンディング中 */
                        error = E_QOVR;

                        /* 通信端点をロックを解除する。*/
                        syscall(sig_sem(cep->semid_lock));
                        }
                else if (cep->snd_tskid != TA_NULL) {

                        /* 非ノンブロッキングコールでペンディング中 */
                        error = E_OBJ;

                        /* 通信端点をロックを解除する。*/
                        syscall(sig_sem(cep->semid_lock));
                        }
                else {

                        cep->snd_p_dstaddr = p_dstaddr;
                        cep->snd_data   = data;
                        cep->snd_len    = len;

                        /* 通信端点をロックを解除する。*/
                        syscall(sig_sem(cep->semid_lock));

                        cep->flags |= UDP_CEP_FLG_POST_OUTPUT;
                        sig_sem(SEM_UDP_POST_OUTPUT);
                        error = E_WBLK;
                        }
                }
        else {                          /* 非ノンブロッキングコール */
        
                /* 通信端点をロックする。*/
                syscall(wai_sem(cep->semid_lock));

                if (cep->snd_p_dstaddr != NULL) {

                        /* ノンブロッキングコールでペンディング中 */
                        error = E_OBJ;

                        /* 通信端点をロックを解除する。*/
                        syscall(sig_sem(cep->semid_lock));
                        }
                else if (cep->snd_tskid != TA_NULL) {

                        /* 非ノンブロッキングコールでペンディング中 */
                        error = E_QOVR;

                        /* 通信端点をロックを解除する。*/
                        syscall(sig_sem(cep->semid_lock));
                        }
                else {

                        /* 現在のタスク識別子を記録する。*/
                        get_tid(&(cep->snd_tskid));

                        /* 通信端点をロックを解除する。*/
                        syscall(sig_sem(cep->semid_lock));

                        /* パケットを送信する。*/
                        error = UDP_SEND_DATA(cep, p_dstaddr, data, len, tmout);
                        }
                }

        return error;
        }

#endif  /* of #ifdef __udp_snd_dat_nblk */

#ifdef __udp_rcv_dat_nblk

/*
 *  udp_rcv_dat -- パケットの受信【標準機能】
 */

ER_UINT
UDP_RCV_DAT (ID cepid, T_IPEP *p_dstaddr, void *data, int_t len, TMO tmout)
{
        T_NET_BUF       *input;
        T_UDP_CEP       *cep;
        T_UDP_HDR       *udph;
        ER_UINT         error;
        uint_t          ulen, uhoff;

        /* p_dstaddr または data が NULL か、len < 0 ならエラー */
        if (p_dstaddr == NULL || data == NULL || len < 0)
                return E_PAR;

        /* UDP 通信端点 ID をチェックする。*/
        if (!VALID_UDP_CEPID(cepid))
                return E_ID;

        /* UDP 通信端点を得る。*/
        cep = GET_UDP_CEP(cepid);

        /* UDP 通信端点をチェックする。*/
        if (!VALID_UDP_CEP(cep))
                return E_NOEXS;

        /*
         * タイムアウトをチェックする。
         */

        if (tmout == TMO_NBLK) {        /* ノンブロッキングコール */

                /* 通信端点をロックする。*/
                syscall(wai_sem(cep->semid_lock));

                if (cep->rcv_p_dstaddr != NULL)

                        /* ノンブロッキングコールでペンディング中 */
                        error = E_QOVR;

                else if (cep->rcv_tskid != TA_NULL)

                        /* 非ノンブロッキングコールでペンディング中 */
                        error = E_OBJ;
                else {
                        cep->rcv_p_dstaddr = p_dstaddr;
                        cep->rcv_data   = data;
                        cep->rcv_len    = len;
                        error = E_WBLK;
                        }

                /* 通信端点をロックを解除する。*/
                syscall(sig_sem(cep->semid_lock));
                return error;
                }
        else {                          /* 非ノンブロッキングコール */

                /* 通信端点をロックする。*/
                syscall(wai_sem(cep->semid_lock));

                if (cep->rcv_p_dstaddr != NULL) {

                        /* ノンブロッキングコールでペンディング中 */
                        error = E_OBJ;

                        /* 通信端点をロックを解除する。*/
                        syscall(sig_sem(cep->semid_lock));
                        }
                else if (cep->rcv_tskid != TA_NULL) {

                        /* 非ノンブロッキングコールでペンディング中 */
                        error = E_QOVR;

                        /* 通信端点をロックを解除する。*/
                        syscall(sig_sem(cep->semid_lock));
                        }
                else {

                        /* 現在のタスク識別子を記録する。*/
                        get_tid(&(cep->rcv_tskid));

                        /* 通信端点をロックを解除する。*/
                        syscall(sig_sem(cep->semid_lock));

                        /* å…
¥åŠ›ãŒã‚るまで待
つ。*/
                        if (cep->cb_netbuf != NULL) {

                                /*
                                 *  ã“ã“ã«ãã‚‹å ´åˆã¯ã€ã‚³ãƒ¼ãƒ«ãƒãƒƒã‚¯é–¢æ•°ã®ä¸­ã‹ã‚‰
                                 *  udp_rcv_dat を呼び出していることになり、
                                 *  すでにå…
¥åŠ›æ¸ˆã¿ã§ã‚る。
                                 */
                                input = cep->cb_netbuf;
                                cep->cb_netbuf = NULL;
                                }
                        else if ((error = trcv_dtq(cep->rcvqid, (intptr_t*)&input, tmout)) != E_OK) {
                                cep->rcv_tskid = TA_NULL;
                                return error;
                                }

                        /* p_dstaddr を設定する。*/
                        uhoff = (uint_t)GET_UDP_HDR_OFFSET(input);
                        udph = GET_UDP_HDR(input, uhoff);
                        p_dstaddr->portno = ntohs(udph->sport);
                        IN_COPY_TO_HOST(&p_dstaddr->ipaddr, input);

                        /* データをバッファに移す。*/
                        ulen = ntohs(udph->ulen);
                        if (ulen - UDP_HDR_SIZE > len)
                                error = E_BOVR;
                        else {
                                len   =     (int_t)(ulen - UDP_HDR_SIZE);
                                error = (ER_UINT)(ulen - UDP_HDR_SIZE);
                                }

                        memcpy(data, GET_UDP_SDU(input, uhoff), (size_t)len);

                        syscall(rel_net_buf(input));

                        cep->rcv_tskid = TA_NULL;
                        }
                return error;
                }
        }

#endif  /* of #ifdef __udp_rcv_dat_nblk */