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

/*
 *  TINET (TCP/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 reproduce 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.
 */

#if (API_PROTO == API_PROTO_IPV6) || (TNUM_UDP4_CEPID > 0)

/*
 *  udp_input_select -- UDP のå…
¥åŠ›å‡¦ç†ã®é¸æŠž
 */

void
UDP_INPUT_SELECT (T_UDP_CEP *cep, T_NET_BUF *input, uint_t off)
{
        T_UDP_HDR       *udph;
        uint_t          len;

        udph = (T_UDP_HDR *)(input->buf + off);
        len  = (uint_t)(ntohs(udph->ulen) - UDP_HDR_SIZE);

        if (cep->rcv_tskid != TA_NULL) {        /* 非ノンブロッキングコールでペンディング中 */
                if (psnd_dtq(cep->rcvqid, (intptr_t)input) != E_OK) {
                        NET_COUNT_UDP(net_count_udp.in_err_packets, 1);
                        NET_COUNT_MIB(udp_stats.udpInErrors, 1);
                        syscall(rel_net_buf(input));
                        }
                }

#ifdef UDP_CFG_NON_BLOCKING

        else if (cep->rcv_p_dstaddr != NULL) {  /* ノンブロッキングコールでペンディング中 */

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

                /* データをバッファに移す。*/
                memcpy(cep->rcv_data, GET_UDP_SDU(input, off),
                       (size_t)(len < cep->rcv_len ? len : cep->rcv_len));
                syscall(rel_net_buf(input));

                if (IS_PTR_DEFINED(cep->callback))

#ifdef TCP_CFG_NON_BLOCKING_COMPAT14
                        (*cep->callback)(GET_UDP_CEPID(cep), TFN_UDP_RCV_DAT, (void*)(uint32_t)len);
#else
                        (*cep->callback)(GET_UDP_CEPID(cep), TFN_UDP_RCV_DAT, (void*)&len);
#endif
                else
                        syslog(LOG_WARNING, "[UDP] no call back, CEP: %d.", GET_UDP_CEPID(cep));
                cep->rcv_p_dstaddr = NULL;
                }

#endif/* of #ifdef UDP_CFG_NON_BLOCKING */

        else if (IS_PTR_DEFINED(cep->callback)) {

                /* コールバック関数を呼び出す。*/
                cep->cb_netbuf = input;

#ifdef TCP_CFG_NON_BLOCKING_COMPAT14
                (*cep->callback)(GET_UDP_CEPID(cep), TEV_UDP_RCV_DAT, (void*)(uint32_t)len);
#else
                (*cep->callback)(GET_UDP_CEPID(cep), TEV_UDP_RCV_DAT, (void*)&len);
#endif
                /*
                 *  ネットワークバッファがそのままであれば、コールバック関数内
で
                 *  データを読み出さなかったことになるので、捨てる。
                 */
                if (cep->cb_netbuf != NULL)
                        syscall(rel_net_buf(cep->cb_netbuf));
                }
        else {
                NET_COUNT_UDP(net_count_udp.in_err_packets, 1);
                NET_COUNT_MIB(udp_stats.udpInErrors, 1);
                syscall(rel_net_buf(input));
                }

        }

#endif  /* of #if (API_PROTO == API_PROTO_IPV6) || (TNUM_UDP4_CEPID > 0) */

/*
 *  udp_input -- UDP のå…
¥åŠ›é–¢æ•°
 */

uint_t
UDP_INPUT (T_NET_BUF **inputp, uint_t *offp, uint_t *nextp)
{
        T_NET_BUF       *input = *inputp;
        T_UDP_CEP       *cep;
        T_UDP_HDR       *udph;
        uint_t          hlen, ulen;

#if defined(_IP6_CFG) && defined(_IP4_CFG) && API_PROTO == API_PROTO_IPV4
        T_UDP6_CEP      *cep6;
#endif

        hlen = (uint_t)GET_IF_IP_HDR_SIZE(input);

        NET_COUNT_UDP(net_count_udp.in_octets,  input->len - hlen);
        NET_COUNT_UDP(net_count_udp.in_packets, 1);
        NET_COUNT_MIB(udp_stats.udpInDatagrams, 1);

        /* ヘッダ長をチェックする。*/
        if (input->len < hlen + UDP_HDR_SIZE)
                goto buf_rel;

        udph = (T_UDP_HDR *)(input->buf + *offp);

        /* データグラム長をチェックする */
        ulen  = ntohs(udph->ulen);
        if (ulen != input->len - hlen)
                goto buf_rel;

        /* 宛å…
ˆãƒãƒ¼ãƒˆãŒ 0 ã®ãƒ‡ãƒ¼ã‚¿ã‚°ãƒ©ãƒ ã¯ç ´æ£„ã™ã‚‹ã€‚RFC768 */
        if (udph->dport == 0)
                goto buf_rel;

#ifdef UDP_CFG_IN_CHECKSUM

        /* チェックサムをチェックする */
        if (udph->sum && IN_CKSUM(input, IPPROTO_UDP, *offp, ulen) != 0)
                goto buf_rel;

#endif  /* of #ifdef UDP_CFG_IN_CHECKSUM */

#if defined(_IP6_CFG) && defined(_IP4_CFG) && API_PROTO == API_PROTO_IPV4

#if TNUM_UDP4_CEPID > 0

        /* UDP 通信端点を得る。*/
        cep = udp4_find_cep(input, *offp);

        if (cep != NULL)
                udp4_input_select(cep, input, *offp);
        else if ((cep6 = udp6_find_cep(input, *offp)) != NULL)
                udp6_input_select(cep6, input, *offp);
        else
                udp4_reply_no_port(input, *offp);

        return IPPROTO_DONE;

#else   /* of #if TNUM_UDP4_CEPID > 0 */

        cep = 0;        /* warning 回避用のダミー */
        if ((cep6 = udp6_find_cep(input, *offp)) != NULL)
                udp6_input_select(cep6, input, *offp);
        else
                udp4_reply_no_port(input, *offp);

        return IPPROTO_DONE;

#endif  /* of #if TNUM_UDP4_CEPID > 0 */

#else   /* of #if defined(_IP6_CFG) && defined(_IP4_CFG) && API_PROTO == API_PROTO_IPV4 */

        /* UDP 通信端点を得る。*/
        cep = UDP_FIND_CEP(input, *offp);

        if (cep != NULL)
                UDP_INPUT_SELECT(cep, input, *offp);
        else
                UDP_REPLY_NO_PORT(input, *offp);

        return IPPROTO_DONE;

#endif  /* of #if defined(_IP6_CFG) && defined(_IP4_CFG) && API_PROTO == API_PROTO_IPV4 */

buf_rel:
        NET_COUNT_UDP(net_count_udp.in_err_packets, 1);
        NET_COUNT_MIB(udp_stats.udpInErrors, 1);
        syscall(rel_net_buf(input));
        return IPPROTO_DONE;
        }