[BACK]Return to udp_usrreq.c CVS log [TXT][DIR] Up to [cvs.NetBSD.org] / src / sys / netinet

Annotation of src/sys/netinet/udp_usrreq.c, Revision 1.61

1.61    ! itojun      1: /*     $NetBSD: udp_usrreq.c,v 1.60 2000/02/02 23:28:09 thorpej Exp $  */
1.48      itojun      2:
                      3: /*
                      4:  * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project.
                      5:  * All rights reserved.
                      6:  *
                      7:  * Redistribution and use in source and binary forms, with or without
                      8:  * modification, are permitted provided that the following conditions
                      9:  * are met:
                     10:  * 1. Redistributions of source code must retain the above copyright
                     11:  *    notice, this list of conditions and the following disclaimer.
                     12:  * 2. Redistributions in binary form must reproduce the above copyright
                     13:  *    notice, this list of conditions and the following disclaimer in the
                     14:  *    documentation and/or other materials provided with the distribution.
                     15:  * 3. Neither the name of the project nor the names of its contributors
                     16:  *    may be used to endorse or promote products derived from this software
                     17:  *    without specific prior written permission.
                     18:  *
                     19:  * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND
                     20:  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
                     21:  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
                     22:  * ARE DISCLAIMED.  IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE
                     23:  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
                     24:  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
                     25:  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
                     26:  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
                     27:  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
                     28:  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
                     29:  * SUCH DAMAGE.
                     30:  */
1.14      cgd        31:
1.1       cgd        32: /*
1.44      thorpej    33:  * Copyright (c) 1982, 1986, 1988, 1990, 1993, 1995
1.13      mycroft    34:  *     The Regents of the University of California.  All rights reserved.
1.1       cgd        35:  *
                     36:  * Redistribution and use in source and binary forms, with or without
                     37:  * modification, are permitted provided that the following conditions
                     38:  * are met:
                     39:  * 1. Redistributions of source code must retain the above copyright
                     40:  *    notice, this list of conditions and the following disclaimer.
                     41:  * 2. Redistributions in binary form must reproduce the above copyright
                     42:  *    notice, this list of conditions and the following disclaimer in the
                     43:  *    documentation and/or other materials provided with the distribution.
                     44:  * 3. All advertising materials mentioning features or use of this software
                     45:  *    must display the following acknowledgement:
                     46:  *     This product includes software developed by the University of
                     47:  *     California, Berkeley and its contributors.
                     48:  * 4. Neither the name of the University nor the names of its contributors
                     49:  *    may be used to endorse or promote products derived from this software
                     50:  *    without specific prior written permission.
                     51:  *
                     52:  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
                     53:  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
                     54:  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
                     55:  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
                     56:  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
                     57:  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
                     58:  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
                     59:  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
                     60:  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
                     61:  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
                     62:  * SUCH DAMAGE.
                     63:  *
1.44      thorpej    64:  *     @(#)udp_usrreq.c        8.6 (Berkeley) 5/23/95
1.1       cgd        65:  */
1.50      thorpej    66:
                     67: #include "opt_ipsec.h"
                     68:
1.38      ws         69: #include "ipkdb.h"
1.1       cgd        70:
1.5       mycroft    71: #include <sys/param.h>
                     72: #include <sys/malloc.h>
                     73: #include <sys/mbuf.h>
                     74: #include <sys/protosw.h>
                     75: #include <sys/socket.h>
                     76: #include <sys/socketvar.h>
1.13      mycroft    77: #include <sys/errno.h>
1.5       mycroft    78: #include <sys/stat.h>
1.27      christos   79: #include <sys/systm.h>
                     80: #include <sys/proc.h>
1.53      itojun     81: #include <sys/domain.h>
1.27      christos   82:
                     83: #include <vm/vm.h>
                     84: #include <sys/sysctl.h>
1.1       cgd        85:
1.5       mycroft    86: #include <net/if.h>
                     87: #include <net/route.h>
1.1       cgd        88:
1.5       mycroft    89: #include <netinet/in.h>
                     90: #include <netinet/in_systm.h>
1.15      cgd        91: #include <netinet/in_var.h>
1.5       mycroft    92: #include <netinet/ip.h>
                     93: #include <netinet/in_pcb.h>
                     94: #include <netinet/ip_var.h>
                     95: #include <netinet/ip_icmp.h>
                     96: #include <netinet/udp.h>
                     97: #include <netinet/udp_var.h>
1.1       cgd        98:
1.53      itojun     99: #ifdef INET6
                    100: #include <netinet/ip6.h>
                    101: #include <netinet/icmp6.h>
                    102: #include <netinet6/ip6_var.h>
                    103: #include <netinet6/in6_pcb.h>
                    104: #include <netinet6/udp6_var.h>
                    105: #endif
                    106:
                    107: #ifdef PULLDOWN_TEST
                    108: #ifndef INET6
                    109: /* always need ip6.h for IP6_EXTHDR_GET */
                    110: #include <netinet/ip6.h>
                    111: #endif
                    112: #endif
                    113:
1.27      christos  114: #include <machine/stdarg.h>
                    115:
1.48      itojun    116: #ifdef IPSEC
                    117: #include <netinet6/ipsec.h>
                    118: #include <netkey/key.h>
                    119: #include <netkey/key_debug.h>
                    120: #endif /*IPSEC*/
                    121:
1.8       mycroft   122: /*
                    123:  * UDP protocol implementation.
                    124:  * Per RFC 768, August, 1980.
                    125:  */
                    126: #ifndef        COMPAT_42
                    127: int    udpcksum = 1;
                    128: #else
                    129: int    udpcksum = 0;           /* XXX */
                    130: #endif
                    131:
1.53      itojun    132: static void udp4_sendup __P((struct mbuf *, int, struct sockaddr *,
                    133:        struct socket *));
                    134: static int udp4_realinput __P((struct sockaddr_in *, struct sockaddr_in *,
                    135:        struct mbuf *, int));
                    136: #ifdef INET6
                    137: static void udp6_sendup __P((struct mbuf *, int, struct sockaddr *,
                    138:        struct socket *));
                    139: static int in6_mcmatch __P((struct in6pcb *, struct in6_addr *,
                    140:        struct ifnet *));
                    141: static int udp6_realinput __P((int, struct sockaddr_in6 *,
                    142:        struct sockaddr_in6 *, struct mbuf *, int));
                    143: #endif
1.13      mycroft   144: static void udp_notify __P((struct inpcb *, int));
1.7       mycroft   145:
1.26      mycroft   146: #ifndef UDBHASHSIZE
                    147: #define        UDBHASHSIZE     128
                    148: #endif
                    149: int    udbhashsize = UDBHASHSIZE;
                    150:
1.7       mycroft   151: void
1.1       cgd       152: udp_init()
                    153: {
1.18      mycroft   154:
1.35      mycroft   155:        in_pcbinit(&udbtable, udbhashsize, udbhashsize);
1.1       cgd       156: }
                    157:
1.56      itojun    158: #ifndef UDP6
1.7       mycroft   159: void
1.27      christos  160: #if __STDC__
                    161: udp_input(struct mbuf *m, ...)
                    162: #else
                    163: udp_input(m, va_alist)
                    164:        struct mbuf *m;
                    165:        va_dcl
                    166: #endif
1.1       cgd       167: {
1.53      itojun    168:        va_list ap;
                    169:        struct sockaddr_in src, dst;
                    170:        struct ip *ip;
                    171:        struct udphdr *uh;
                    172:        int iphlen, proto;
                    173:        int len;
                    174:        int n;
                    175:
                    176:        va_start(ap, m);
                    177:        iphlen = va_arg(ap, int);
                    178:        proto = va_arg(ap, int);
                    179:        va_end(ap);
                    180:
                    181:        udpstat.udps_ipackets++;
                    182:
                    183: #ifndef PULLDOWN_TEST
                    184:        /*
                    185:         * Strip IP options, if any; should skip this,
                    186:         * make available to user, and use on returned packets,
                    187:         * but we don't yet have a way to check the checksum
                    188:         * with options still present.
                    189:         */
                    190:        if (iphlen > sizeof (struct ip)) {
                    191:                ip_stripoptions(m, (struct mbuf *)0);
                    192:                iphlen = sizeof(struct ip);
                    193:        }
                    194: #else
                    195:        /*
                    196:         * we may enable the above code if we save and pass IPv4 options
                    197:         * to the userland.
                    198:         */
                    199: #endif
                    200:
                    201:        /*
                    202:         * Get IP and UDP header together in first mbuf.
                    203:         */
                    204:        ip = mtod(m, struct ip *);
                    205: #ifndef PULLDOWN_TEST
                    206:        if (m->m_len < iphlen + sizeof(struct udphdr)) {
                    207:                if ((m = m_pullup(m, iphlen + sizeof(struct udphdr))) == 0) {
                    208:                        udpstat.udps_hdrops++;
                    209:                        return;
                    210:                }
                    211:                ip = mtod(m, struct ip *);
                    212:        }
                    213:        uh = (struct udphdr *)((caddr_t)ip + iphlen);
                    214: #else
                    215:        IP6_EXTHDR_GET(uh, struct udphdr *, m, iphlen, sizeof(struct udphdr));
                    216:        if (uh == NULL) {
                    217:                udpstat.udps_hdrops++;
                    218:                return;
                    219:        }
                    220: #endif
                    221:
1.57      itojun    222:        /* destination port of 0 is illegal, based on RFC768. */
                    223:        if (uh->uh_dport == 0)
                    224:                goto bad;
                    225:
1.53      itojun    226:        /*
                    227:         * Make mbuf data length reflect UDP length.
                    228:         * If not enough data to reflect UDP length, drop.
                    229:         */
                    230:        len = ntohs((u_int16_t)uh->uh_ulen);
                    231:        if (ip->ip_len != iphlen + len) {
                    232:                if (ip->ip_len < iphlen + len) {
                    233:                        udpstat.udps_badlen++;
                    234:                        goto bad;
                    235:                }
                    236:                m_adj(m, iphlen + len - ip->ip_len);
                    237:        }
                    238:
                    239:        /*
                    240:         * Checksum extended UDP header and data.
                    241:         */
                    242:        if (uh->uh_sum) {
                    243: #ifndef PULLDOWN_TEST
                    244:                struct ip save_ip;
                    245:
                    246:                /*
                    247:                 * Save a copy of the IP header in case we want restore it
                    248:                 * for sending an ICMP error message in response.
                    249:                 */
                    250:                save_ip = *ip;
                    251:
                    252:                bzero(((struct ipovly *)ip)->ih_x1,
                    253:                    sizeof ((struct ipovly *)ip)->ih_x1);
                    254:                ((struct ipovly *)ip)->ih_len = uh->uh_ulen;
                    255:                if (in_cksum(m, len + sizeof (struct ip)) != 0) {
                    256:                        udpstat.udps_badsum++;
                    257:                        m_freem(m);
                    258:                        return;
                    259:                }
                    260:
                    261:                *ip = save_ip;
                    262: #else
                    263:                if (in4_cksum(m, IPPROTO_UDP, iphlen, len) != 0) {
                    264:                        udpstat.udps_badsum++;
                    265:                        m_freem(m);
                    266:                        return;
                    267:                }
                    268: #endif
                    269:        }
                    270:
                    271:        /* construct source and dst sockaddrs. */
                    272:        bzero(&src, sizeof(src));
                    273:        src.sin_family = AF_INET;
                    274:        src.sin_len = sizeof(struct sockaddr_in);
                    275:        bcopy(&ip->ip_src, &src.sin_addr, sizeof(src.sin_addr));
                    276:        src.sin_port = uh->uh_sport;
                    277:        bzero(&dst, sizeof(dst));
                    278:        dst.sin_family = AF_INET;
                    279:        dst.sin_len = sizeof(struct sockaddr_in);
                    280:        bcopy(&ip->ip_dst, &dst.sin_addr, sizeof(dst.sin_addr));
                    281:        dst.sin_port = uh->uh_dport;
                    282:
                    283:        n = udp4_realinput(&src, &dst, m, iphlen);
                    284: #ifdef INET6
                    285:        if (IN_MULTICAST(ip->ip_dst.s_addr) || n == 0) {
                    286:                struct sockaddr_in6 src6, dst6;
                    287:
                    288:                bzero(&src6, sizeof(src6));
                    289:                src6.sin6_family = AF_INET6;
                    290:                src6.sin6_len = sizeof(struct sockaddr_in6);
                    291:                src6.sin6_addr.s6_addr[10] = src6.sin6_addr.s6_addr[11] = 0xff;
                    292:                bcopy(&ip->ip_src, &src6.sin6_addr.s6_addr[12],
                    293:                        sizeof(ip->ip_src));
                    294:                src6.sin6_port = uh->uh_sport;
                    295:                bzero(&dst6, sizeof(dst6));
                    296:                dst6.sin6_family = AF_INET6;
                    297:                dst6.sin6_len = sizeof(struct sockaddr_in6);
                    298:                dst6.sin6_addr.s6_addr[10] = dst6.sin6_addr.s6_addr[11] = 0xff;
                    299:                bcopy(&ip->ip_dst, &dst6.sin6_addr.s6_addr[12],
                    300:                        sizeof(ip->ip_dst));
                    301:                dst6.sin6_port = uh->uh_dport;
                    302:
                    303:                n += udp6_realinput(AF_INET, &src6, &dst6, m, iphlen);
                    304:        }
                    305: #endif
                    306:
                    307:        if (n == 0) {
                    308:                if (m->m_flags & (M_BCAST | M_MCAST)) {
                    309:                        udpstat.udps_noportbcast++;
                    310:                        goto bad;
                    311:                }
1.61    ! itojun    312:                udpstat.udps_noport++;
1.53      itojun    313: #if NIPKDB > 0
                    314:                if (checkipkdb(&ip->ip_src, uh->uh_sport, uh->uh_dport,
                    315:                                m, iphlen + sizeof(struct udphdr),
                    316:                                m->m_pkthdr.len - iphlen - sizeof(struct udphdr))) {
                    317:                        /*
                    318:                         * It was a debugger connect packet,
                    319:                         * just drop it now
                    320:                         */
                    321:                        goto bad;
                    322:                }
                    323: #endif
                    324:                icmp_error(m, ICMP_UNREACH, ICMP_UNREACH_PORT, 0, 0);
                    325:                m = NULL;
                    326:        }
                    327:
                    328: bad:
                    329:        if (m)
                    330:                m_freem(m);
                    331: }
                    332:
                    333: #ifdef INET6
                    334: int
                    335: udp6_input(mp, offp, proto)
                    336:        struct mbuf **mp;
                    337:        int *offp, proto;
                    338: {
                    339:        struct mbuf *m = *mp;
                    340:        int off = *offp;
                    341:        struct sockaddr_in6 src, dst;
                    342:        struct ip6_hdr *ip6;
                    343:        struct udphdr *uh;
                    344:        u_int32_t plen, ulen;
                    345:
                    346: #if defined(NFAITH) && 0 < NFAITH
                    347:        if (m->m_pkthdr.rcvif) {
                    348:                if (m->m_pkthdr.rcvif->if_type == IFT_FAITH) {
                    349:                        /* send icmp6 host unreach? */
                    350:                        m_freem(m);
                    351:                        return IPPROTO_DONE;
                    352:                }
                    353:        }
                    354: #endif
                    355:
                    356:        udp6stat.udp6s_ipackets++;
                    357:
                    358: #ifndef PULLDOWN_TEST
                    359:        IP6_EXTHDR_CHECK(m, off, sizeof(struct udphdr), IPPROTO_DONE);
                    360: #endif
                    361:
                    362:        ip6 = mtod(m, struct ip6_hdr *);
                    363:        /* check for jumbogram is done in ip6_input.  we can trust pkthdr.len */
                    364:        plen = m->m_pkthdr.len - off;
                    365: #ifndef PULLDOWN_TEST
                    366:        uh = (struct udphdr *)((caddr_t)ip6 + off);
                    367: #else
                    368:        IP6_EXTHDR_GET(uh, struct udphdr *, m, off, sizeof(struct udphdr));
                    369:        if (uh == NULL) {
                    370:                ip6stat.ip6s_tooshort++;
                    371:                return IPPROTO_DONE;
                    372:        }
                    373: #endif
                    374:        ulen = ntohs((u_short)uh->uh_ulen);
                    375:        if (ulen == 0 && plen > 0xffff)
                    376:                ulen = plen;
                    377:
                    378:        if (plen != ulen) {
                    379:                udp6stat.udp6s_badlen++;
1.54      itojun    380:                goto bad;
                    381:        }
                    382:
1.57      itojun    383:        /* destination port of 0 is illegal, based on RFC768. */
                    384:        if (uh->uh_dport == 0)
                    385:                goto bad;
                    386:
1.54      itojun    387:        /* Be proactive about malicious use of IPv4 mapped address */
                    388:        if (IN6_IS_ADDR_V4MAPPED(&ip6->ip6_src) ||
                    389:            IN6_IS_ADDR_V4MAPPED(&ip6->ip6_dst)) {
                    390:                /* XXX stat */
1.53      itojun    391:                goto bad;
                    392:        }
                    393:
                    394:        /*
                    395:         * Checksum extended UDP header and data.
                    396:         */
                    397:        if (uh->uh_sum == 0)
                    398:                udp6stat.udp6s_nosum++;
                    399:        else if (in6_cksum(m, IPPROTO_UDP, off, ulen) != 0) {
                    400:                udp6stat.udp6s_badsum++;
                    401:                goto bad;
                    402:        }
                    403:
                    404:        /*
                    405:         * Construct source and dst sockaddrs.
                    406:         * Note that ifindex (s6_addr16[1]) is already filled.
                    407:         */
                    408:        bzero(&src, sizeof(src));
                    409:        src.sin6_family = AF_INET6;
                    410:        src.sin6_len = sizeof(struct sockaddr_in6);
                    411:        bcopy(&ip6->ip6_src, &src.sin6_addr, sizeof(src.sin6_addr));
                    412:        if (IN6_IS_SCOPE_LINKLOCAL(&src.sin6_addr))
                    413:                src.sin6_addr.s6_addr16[1] = 0;
                    414:        if (m->m_pkthdr.rcvif) {
                    415:                if (IN6_IS_SCOPE_LINKLOCAL(&src.sin6_addr))
                    416:                        src.sin6_scope_id = m->m_pkthdr.rcvif->if_index;
                    417:                else
                    418:                        src.sin6_scope_id = 0;
                    419:        }
                    420:        src.sin6_port = uh->uh_sport;
                    421:        bzero(&dst, sizeof(dst));
                    422:        dst.sin6_family = AF_INET6;
                    423:        dst.sin6_len = sizeof(struct sockaddr_in6);
                    424:        bcopy(&ip6->ip6_dst, &dst.sin6_addr, sizeof(dst.sin6_addr));
                    425:        if (IN6_IS_SCOPE_LINKLOCAL(&dst.sin6_addr))
                    426:                dst.sin6_addr.s6_addr16[1] = 0;
                    427:        if (m->m_pkthdr.rcvif) {
                    428:                if (IN6_IS_SCOPE_LINKLOCAL(&dst.sin6_addr))
                    429:                        dst.sin6_scope_id = m->m_pkthdr.rcvif->if_index;
                    430:                else
                    431:                        dst.sin6_scope_id = 0;
                    432:        }
                    433:        dst.sin6_port = uh->uh_dport;
                    434:
                    435:        if (udp6_realinput(AF_INET6, &src, &dst, m, off) == 0) {
                    436:                if (m->m_flags & M_MCAST) {
                    437:                        udp6stat.udp6s_noportmcast++;
                    438:                        goto bad;
                    439:                }
1.61    ! itojun    440:                udp6stat.udp6s_noport++;
1.53      itojun    441:                icmp6_error(m, ICMP6_DST_UNREACH, ICMP6_DST_UNREACH_NOPORT, 0);
                    442:                m = NULL;
                    443:        }
                    444:
                    445: bad:
                    446:        if (m)
                    447:                m_freem(m);
                    448:        return IPPROTO_DONE;
                    449: }
                    450: #endif
                    451:
                    452: static void
                    453: udp4_sendup(m, off, src, so)
                    454:        struct mbuf *m;
                    455:        int off;        /* offset of data portion */
                    456:        struct sockaddr *src;
                    457:        struct socket *so;
                    458: {
                    459:        struct mbuf *opts = NULL;
                    460:        struct mbuf *n;
                    461:        struct inpcb *inp = NULL;
                    462: #ifdef INET6
                    463:        struct in6pcb *in6p = NULL;
                    464: #endif
                    465:
                    466:        if (!so)
                    467:                return;
                    468:        switch (so->so_proto->pr_domain->dom_family) {
                    469:        case AF_INET:
                    470:                inp = sotoinpcb(so);
                    471:                break;
                    472: #ifdef INET6
                    473:        case AF_INET6:
                    474:                in6p = sotoin6pcb(so);
                    475:                break;
                    476: #endif
                    477:        default:
                    478:                return;
                    479:        }
                    480:
                    481: #ifdef IPSEC
                    482:        /* check AH/ESP integrity. */
                    483:        if (so != NULL && ipsec4_in_reject_so(m, so)) {
                    484:                ipsecstat.in_polvio++;
                    485:                return;
                    486:        }
                    487: #endif /*IPSEC*/
                    488:
                    489:        if ((n = m_copy(m, 0, M_COPYALL)) != NULL) {
                    490:                if (inp && (inp->inp_flags & INP_CONTROLOPTS
                    491:                         || so->so_options & SO_TIMESTAMP)) {
                    492:                        struct ip *ip = mtod(n, struct ip *);
                    493:                        ip_savecontrol(inp, &opts, ip, n);
                    494:                }
                    495:
                    496:                m_adj(n, off);
                    497:                if (sbappendaddr(&so->so_rcv, src, n,
                    498:                                opts) == 0) {
                    499:                        m_freem(n);
                    500:                        if (opts)
                    501:                                m_freem(opts);
                    502:                } else
                    503:                        sorwakeup(so);
                    504:        }
                    505: }
                    506:
                    507: #ifdef INET6
                    508: static void
                    509: udp6_sendup(m, off, src, so)
                    510:        struct mbuf *m;
                    511:        int off;        /* offset of data portion */
                    512:        struct sockaddr *src;
                    513:        struct socket *so;
                    514: {
                    515:        struct mbuf *opts = NULL;
                    516:        struct mbuf *n;
                    517:        struct in6pcb *in6p = NULL;
                    518:
                    519:        if (!so)
                    520:                return;
                    521:        if (so->so_proto->pr_domain->dom_family != AF_INET6)
                    522:                return;
                    523:        in6p = sotoin6pcb(so);
                    524:
                    525: #ifdef IPSEC
                    526:        /* check AH/ESP integrity. */
                    527:        if (so != NULL && ipsec6_in_reject_so(m, so)) {
                    528:                ipsec6stat.in_polvio++;
                    529:                return;
                    530:        }
                    531: #endif /*IPSEC*/
                    532:
                    533:        if ((n = m_copy(m, 0, M_COPYALL)) != NULL) {
                    534:                if (in6p && (in6p->in6p_flags & IN6P_CONTROLOPTS
                    535:                          || in6p->in6p_socket->so_options & SO_TIMESTAMP)) {
                    536:                        struct ip6_hdr *ip6 = mtod(n, struct ip6_hdr *);
                    537:                        ip6_savecontrol(in6p, &opts, ip6, n);
                    538:                }
                    539:
                    540:                m_adj(n, off);
                    541:                if (sbappendaddr(&so->so_rcv, src, n, opts) == 0) {
                    542:                        m_freem(n);
                    543:                        if (opts)
                    544:                                m_freem(opts);
                    545:                        udp6stat.udp6s_fullsock++;
                    546:                } else
                    547:                        sorwakeup(so);
                    548:        }
                    549: }
                    550: #endif
                    551:
                    552: static int
                    553: udp4_realinput(src, dst, m, off)
                    554:        struct sockaddr_in *src;
                    555:        struct sockaddr_in *dst;
                    556:        struct mbuf *m;
                    557:        int off;        /* offset of udphdr */
                    558: {
                    559:        u_int16_t *sport, *dport;
                    560:        int rcvcnt;
                    561:        struct in_addr *src4, *dst4;
                    562:        struct inpcb *inp;
                    563:
                    564:        rcvcnt = 0;
                    565:        off += sizeof(struct udphdr);   /* now, offset of payload */
                    566:
                    567:        if (src->sin_family != AF_INET || dst->sin_family != AF_INET)
                    568:                goto bad;
                    569:
                    570:        src4 = &src->sin_addr;
                    571:        sport = &src->sin_port;
                    572:        dst4 = &dst->sin_addr;
                    573:        dport = &dst->sin_port;
                    574:
                    575:        if (IN_MULTICAST(src4->s_addr) ||
                    576:            in_broadcast(*dst4, m->m_pkthdr.rcvif)) {
                    577:                struct inpcb *last;
                    578:                /*
                    579:                 * Deliver a multicast or broadcast datagram to *all* sockets
                    580:                 * for which the local and remote addresses and ports match
                    581:                 * those of the incoming datagram.  This allows more than
                    582:                 * one process to receive multi/broadcasts on the same port.
                    583:                 * (This really ought to be done for unicast datagrams as
                    584:                 * well, but that would cause problems with existing
                    585:                 * applications that open both address-specific sockets and
                    586:                 * a wildcard socket listening to the same port -- they would
                    587:                 * end up receiving duplicates of every unicast datagram.
                    588:                 * Those applications open the multiple sockets to overcome an
                    589:                 * inadequacy of the UDP socket interface, but for backwards
                    590:                 * compatibility we avoid the problem here rather than
                    591:                 * fixing the interface.  Maybe 4.5BSD will remedy this?)
                    592:                 */
                    593:
                    594:                /*
                    595:                 * KAME note: usually we drop udpiphdr from mbuf here.
                    596:                 * we need udpiphdr for iPsec processing so we do that later.
                    597:                 */
                    598:                /*
                    599:                 * Locate pcb(s) for datagram.
                    600:                 */
                    601:                for (inp = udbtable.inpt_queue.cqh_first;
                    602:                    inp != (struct inpcb *)&udbtable.inpt_queue;
                    603:                    inp = inp->inp_queue.cqe_next) {
                    604:                        if (inp->inp_lport != *dport)
                    605:                                continue;
                    606:                        if (!in_nullhost(inp->inp_laddr)) {
                    607:                                if (!in_hosteq(inp->inp_laddr, *dst4))
                    608:                                        continue;
                    609:                        }
                    610:                        if (!in_nullhost(inp->inp_faddr)) {
                    611:                                if (!in_hosteq(inp->inp_faddr, *src4) ||
                    612:                                    inp->inp_fport != *sport)
                    613:                                        continue;
                    614:                        }
                    615:
                    616:                        last = inp;
                    617:                        udp4_sendup(m, off, (struct sockaddr *)src,
                    618:                                inp->inp_socket);
                    619:                        rcvcnt++;
                    620:
                    621:                        /*
                    622:                         * Don't look for additional matches if this one does
                    623:                         * not have either the SO_REUSEPORT or SO_REUSEADDR
                    624:                         * socket options set.  This heuristic avoids searching
                    625:                         * through all pcbs in the common case of a non-shared
                    626:                         * port.  It assumes that an application will never
                    627:                         * clear these options after setting them.
                    628:                         */
                    629:                        if ((inp->inp_socket->so_options &
                    630:                            (SO_REUSEPORT|SO_REUSEADDR)) == 0)
                    631:                                break;
                    632:                }
                    633:
                    634: #if 0
                    635:                if (last == NULL) {
                    636:                        /*
                    637:                         * No matching pcb found; discard datagram.
                    638:                         * (No need to send an ICMP Port Unreachable
                    639:                         * for a broadcast or multicast datgram.)
                    640:                         */
                    641:                        udpstat.udps_noportbcast++;
                    642:                        goto bad;
                    643:                }
                    644: #endif
                    645:        } else {
                    646:                /*
                    647:                 * Locate pcb for datagram.
                    648:                 */
                    649:                inp = in_pcblookup_connect(&udbtable, *src4, *sport, *dst4, *dport);
                    650:                if (inp == 0) {
                    651:                        ++udpstat.udps_pcbhashmiss;
                    652:                        inp = in_pcblookup_bind(&udbtable, *dst4, *dport);
                    653:                        if (inp == 0) {
                    654: #if 0
                    655:                                struct mbuf *n;
                    656:
                    657:                                if (m->m_flags & (M_BCAST | M_MCAST)) {
                    658:                                        udpstat.udps_noportbcast++;
                    659:                                        goto bad;
                    660:                                }
1.61    ! itojun    661:                                udpstat.udps_noport++;
1.53      itojun    662: #if NIPKDB > 0
                    663:                                if (checkipkdb(src4, *sport, *dport, m, off,
                    664:                                               m->m_pkthdr.len - off)) {
                    665:                                        /*
                    666:                                         * It was a debugger connect packet,
                    667:                                         * just drop it now
                    668:                                         */
                    669:                                        goto bad;
                    670:                                }
                    671: #endif
                    672:                                if ((n = m_copy(m, 0, M_COPYALL)) != NULL) {
                    673:                                        icmp_error(n, ICMP_UNREACH,
                    674:                                                ICMP_UNREACH_PORT, 0, 0);
                    675:                                }
                    676: #endif
                    677:                                return rcvcnt;
                    678:                        }
                    679:                }
                    680:
                    681:                udp4_sendup(m, off, (struct sockaddr *)src, inp->inp_socket);
                    682:                rcvcnt++;
                    683:        }
                    684:
                    685: bad:
                    686:        return rcvcnt;
                    687: }
                    688:
                    689: #ifdef INET6
                    690: static int
                    691: in6_mcmatch(in6p, ia6, ifp)
                    692:        struct in6pcb *in6p;
                    693:        register struct in6_addr *ia6;
                    694:        struct ifnet *ifp;
                    695: {
                    696:        struct ip6_moptions *im6o = in6p->in6p_moptions;
                    697:        struct in6_multi_mship *imm;
                    698:
                    699:        if (im6o == NULL)
                    700:                return 0;
                    701:
                    702:        for (imm = im6o->im6o_memberships.lh_first; imm != NULL;
                    703:             imm = imm->i6mm_chain.le_next) {
                    704:                if ((ifp == NULL ||
                    705:                     imm->i6mm_maddr->in6m_ifp == ifp) &&
                    706:                    IN6_ARE_ADDR_EQUAL(&imm->i6mm_maddr->in6m_addr,
                    707:                                       ia6))
                    708:                        return 1;
                    709:        }
                    710:        return 0;
                    711: }
                    712:
                    713: static int
                    714: udp6_realinput(af, src, dst, m, off)
                    715:        int af;         /* af on packet */
                    716:        struct sockaddr_in6 *src;
                    717:        struct sockaddr_in6 *dst;
                    718:        struct mbuf *m;
                    719:        int off;        /* offset of udphdr */
                    720: {
                    721:        u_int16_t *sport, *dport;
                    722:        int rcvcnt;
                    723:        struct in6_addr *src6, *dst6;
                    724:        struct in_addr *src4;
                    725:        struct in6pcb *in6p;
                    726:
                    727:        rcvcnt = 0;
                    728:        off += sizeof(struct udphdr);   /* now, offset of payload */
                    729:
                    730:        if (af != AF_INET && af != AF_INET6)
                    731:                goto bad;
                    732:        if (src->sin6_family != AF_INET6 || dst->sin6_family != AF_INET6)
                    733:                goto bad;
                    734:
                    735:        src6 = &src->sin6_addr;
                    736:        sport = &src->sin6_port;
                    737:        dst6 = &dst->sin6_addr;
                    738:        dport = &dst->sin6_port;
                    739:        src4 = (struct in_addr *)&src->sin6_addr.s6_addr32[12];
                    740:
                    741:        if (IN6_IS_ADDR_MULTICAST(dst6)
                    742:         || (af == AF_INET && IN_MULTICAST(src4->s_addr))) {
                    743:                struct in6pcb *last;
                    744:                /*
                    745:                 * Deliver a multicast or broadcast datagram to *all* sockets
                    746:                 * for which the local and remote addresses and ports match
                    747:                 * those of the incoming datagram.  This allows more than
                    748:                 * one process to receive multi/broadcasts on the same port.
                    749:                 * (This really ought to be done for unicast datagrams as
                    750:                 * well, but that would cause problems with existing
                    751:                 * applications that open both address-specific sockets and
                    752:                 * a wildcard socket listening to the same port -- they would
                    753:                 * end up receiving duplicates of every unicast datagram.
                    754:                 * Those applications open the multiple sockets to overcome an
                    755:                 * inadequacy of the UDP socket interface, but for backwards
                    756:                 * compatibility we avoid the problem here rather than
                    757:                 * fixing the interface.  Maybe 4.5BSD will remedy this?)
                    758:                 */
                    759:
                    760:                /*
                    761:                 * KAME note: usually we drop udpiphdr from mbuf here.
                    762:                 * we need udpiphdr for iPsec processing so we do that later.
                    763:                 */
                    764:                /*
                    765:                 * Locate pcb(s) for datagram.
                    766:                 */
                    767:                for (in6p = udb6.in6p_next; in6p != &udb6;
                    768:                     in6p = in6p->in6p_next) {
                    769:                        if (in6p->in6p_lport != *dport)
                    770:                                continue;
                    771:                        if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_laddr)) {
                    772:                                if (!IN6_ARE_ADDR_EQUAL(&in6p->in6p_laddr, dst6)
                    773:                                 && !in6_mcmatch(in6p, dst6, m->m_pkthdr.rcvif))
                    774:                                        continue;
                    775:                        }
1.55      itojun    776: #ifndef INET6_BINDV6ONLY
                    777:                        else {
                    778:                                if (IN6_IS_ADDR_V4MAPPED(dst6)
                    779:                                 && (in6p->in6p_flags & IN6P_BINDV6ONLY))
                    780:                                        continue;
                    781:                        }
                    782: #endif
1.53      itojun    783:                        if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->in6p_faddr)) {
                    784:                                if (!IN6_ARE_ADDR_EQUAL(&in6p->in6p_faddr, src6)
                    785:                                 || in6p->in6p_fport != *sport)
                    786:                                        continue;
                    787:                        }
1.55      itojun    788: #ifndef INET6_BINDV6ONLY
                    789:                        else {
                    790:                                if (IN6_IS_ADDR_V4MAPPED(src6)
                    791:                                 && (in6p->in6p_flags & IN6P_BINDV6ONLY))
                    792:                                        continue;
                    793:                        }
                    794: #endif
1.53      itojun    795:
                    796:                        last = in6p;
                    797:                        udp6_sendup(m, off, (struct sockaddr *)src,
                    798:                                in6p->in6p_socket);
                    799:                        rcvcnt++;
                    800:
                    801:                        /*
                    802:                         * Don't look for additional matches if this one does
                    803:                         * not have either the SO_REUSEPORT or SO_REUSEADDR
                    804:                         * socket options set.  This heuristic avoids searching
                    805:                         * through all pcbs in the common case of a non-shared
                    806:                         * port.  It assumes that an application will never
                    807:                         * clear these options after setting them.
                    808:                         */
                    809:                        if ((in6p->in6p_socket->so_options &
                    810:                            (SO_REUSEPORT|SO_REUSEADDR)) == 0)
                    811:                                break;
                    812:                }
                    813:
                    814: #if 0
                    815:                if (last == NULL) {
                    816:                        /*
                    817:                         * No matching pcb found; discard datagram.
                    818:                         * (No need to send an ICMP Port Unreachable
                    819:                         * for a broadcast or multicast datgram.)
                    820:                         */
                    821:                        switch (af) {
                    822:                        case AF_INET:
                    823:                                udpstat.udps_noportbcast++;
                    824:                                break;
                    825:                        case AF_INET6:
                    826:                                udp6stat.udp6s_noportmcast++;
                    827:                                break;
                    828:                        }
                    829:                        goto bad;
                    830:                }
                    831: #endif
                    832:        } else {
                    833:                /*
                    834:                 * Locate pcb for datagram.
                    835:                 */
                    836:                in6p = in6_pcblookup_connect(&udb6, src6, *sport,
                    837:                        dst6, *dport, 0);
                    838:                if (in6p == 0) {
                    839:                        ++udpstat.udps_pcbhashmiss;
                    840:                        in6p = in6_pcblookup_bind(&udb6, dst6, *dport, 0);
                    841:                        if (in6p == 0) {
                    842: #if 0
                    843:                                struct mbuf *n;
                    844:                                n = m_copy(m, 0, M_COPYALL);
                    845:                                switch (af) {
                    846:                                case AF_INET:
                    847:                                        if (m->m_flags & (M_BCAST | M_MCAST)) {
                    848:                                                udpstat.udps_noportbcast++;
                    849:                                                goto bad;
                    850:                                        }
1.61    ! itojun    851:                                        udpstat.udps_noport++;
1.53      itojun    852:                                        if (n != NULL)
                    853:                                                icmp_error(n, ICMP_UNREACH,
                    854:                                                    ICMP_UNREACH_PORT, 0, 0);
                    855:                                        break;
                    856:                                case AF_INET6:
                    857:                                        if (m->m_flags & M_MCAST) {
                    858:                                                udp6stat.udp6s_noportmcast++;
                    859:                                                goto bad;
                    860:                                        }
1.61    ! itojun    861:                                        udp6stat.udp6s_noport++;
1.53      itojun    862:                                        if (n != NULL)
                    863:                                                icmp6_error(n, ICMP6_DST_UNREACH,
                    864:                                                    ICMP6_DST_UNREACH_NOPORT, 0);
                    865:                                        break;
                    866:                                }
                    867: #endif
                    868:
                    869:                                return rcvcnt;
                    870:                        }
                    871:                }
                    872:
                    873:                udp6_sendup(m, off, (struct sockaddr *)src, in6p->in6p_socket);
                    874:                rcvcnt++;
                    875:        }
                    876:
                    877: bad:
                    878:        return rcvcnt;
                    879: }
                    880: #endif
                    881:
1.56      itojun    882: #else /*UDP6*/
                    883:
1.53      itojun    884: void
                    885: #if __STDC__
                    886: udp_input(struct mbuf *m, ...)
                    887: #else
                    888: udp_input(m, va_alist)
                    889:        struct mbuf *m;
                    890:        va_dcl
                    891: #endif
                    892: {
1.48      itojun    893:        int proto;
1.1       cgd       894:        register struct ip *ip;
                    895:        register struct udphdr *uh;
                    896:        register struct inpcb *inp;
                    897:        struct mbuf *opts = 0;
                    898:        int len;
                    899:        struct ip save_ip;
1.27      christos  900:        int iphlen;
                    901:        va_list ap;
1.34      mycroft   902:        struct sockaddr_in udpsrc;
1.48      itojun    903:        struct sockaddr *sa;
1.27      christos  904:
                    905:        va_start(ap, m);
                    906:        iphlen = va_arg(ap, int);
1.48      itojun    907:        proto = va_arg(ap, int);
1.27      christos  908:        va_end(ap);
1.1       cgd       909:
                    910:        udpstat.udps_ipackets++;
                    911:
                    912:        /*
                    913:         * Strip IP options, if any; should skip this,
                    914:         * make available to user, and use on returned packets,
                    915:         * but we don't yet have a way to check the checksum
                    916:         * with options still present.
                    917:         */
                    918:        if (iphlen > sizeof (struct ip)) {
                    919:                ip_stripoptions(m, (struct mbuf *)0);
                    920:                iphlen = sizeof(struct ip);
                    921:        }
                    922:
                    923:        /*
                    924:         * Get IP and UDP header together in first mbuf.
                    925:         */
                    926:        ip = mtod(m, struct ip *);
                    927:        if (m->m_len < iphlen + sizeof(struct udphdr)) {
                    928:                if ((m = m_pullup(m, iphlen + sizeof(struct udphdr))) == 0) {
                    929:                        udpstat.udps_hdrops++;
                    930:                        return;
                    931:                }
                    932:                ip = mtod(m, struct ip *);
                    933:        }
                    934:        uh = (struct udphdr *)((caddr_t)ip + iphlen);
1.57      itojun    935:
                    936:        /* destination port of 0 is illegal, based on RFC768. */
                    937:        if (uh->uh_dport == 0)
                    938:                goto bad;
1.1       cgd       939:
                    940:        /*
                    941:         * Make mbuf data length reflect UDP length.
                    942:         * If not enough data to reflect UDP length, drop.
                    943:         */
1.15      cgd       944:        len = ntohs((u_int16_t)uh->uh_ulen);
1.47      mycroft   945:        if (ip->ip_len != iphlen + len) {
                    946:                if (ip->ip_len < iphlen + len) {
1.1       cgd       947:                        udpstat.udps_badlen++;
                    948:                        goto bad;
                    949:                }
1.47      mycroft   950:                m_adj(m, iphlen + len - ip->ip_len);
1.1       cgd       951:        }
                    952:        /*
                    953:         * Save a copy of the IP header in case we want restore it
                    954:         * for sending an ICMP error message in response.
                    955:         */
                    956:        save_ip = *ip;
                    957:
                    958:        /*
                    959:         * Checksum extended UDP header and data.
                    960:         */
1.29      mrg       961:        if (uh->uh_sum) {
1.25      cgd       962:                bzero(((struct ipovly *)ip)->ih_x1,
                    963:                    sizeof ((struct ipovly *)ip)->ih_x1);
1.1       cgd       964:                ((struct ipovly *)ip)->ih_len = uh->uh_ulen;
1.46      mycroft   965:                if (in_cksum(m, len + sizeof (struct ip)) != 0) {
1.1       cgd       966:                        udpstat.udps_badsum++;
                    967:                        m_freem(m);
                    968:                        return;
                    969:                }
                    970:        }
1.13      mycroft   971:
1.48      itojun    972:        /*
                    973:         * Construct sockaddr format source address.
                    974:         */
                    975:        udpsrc.sin_family = AF_INET;
                    976:        udpsrc.sin_len = sizeof(struct sockaddr_in);
                    977:        udpsrc.sin_addr = ip->ip_src;
                    978:        udpsrc.sin_port = uh->uh_sport;
                    979:        bzero((caddr_t)udpsrc.sin_zero, sizeof(udpsrc.sin_zero));
                    980:
1.16      mycroft   981:        if (IN_MULTICAST(ip->ip_dst.s_addr) ||
1.13      mycroft   982:            in_broadcast(ip->ip_dst, m->m_pkthdr.rcvif)) {
1.40      thorpej   983:                struct inpcb *last;
1.4       hpeyerl   984:                /*
                    985:                 * Deliver a multicast or broadcast datagram to *all* sockets
                    986:                 * for which the local and remote addresses and ports match
                    987:                 * those of the incoming datagram.  This allows more than
                    988:                 * one process to receive multi/broadcasts on the same port.
                    989:                 * (This really ought to be done for unicast datagrams as
                    990:                 * well, but that would cause problems with existing
                    991:                 * applications that open both address-specific sockets and
                    992:                 * a wildcard socket listening to the same port -- they would
                    993:                 * end up receiving duplicates of every unicast datagram.
                    994:                 * Those applications open the multiple sockets to overcome an
                    995:                 * inadequacy of the UDP socket interface, but for backwards
                    996:                 * compatibility we avoid the problem here rather than
1.13      mycroft   997:                 * fixing the interface.  Maybe 4.5BSD will remedy this?)
1.4       hpeyerl   998:                 */
1.13      mycroft   999:
1.48      itojun   1000:                iphlen += sizeof(struct udphdr);
1.4       hpeyerl  1001:                /*
1.48      itojun   1002:                 * KAME note: usually we drop udpiphdr from mbuf here.
                   1003:                 * we need udpiphdr for iPsec processing so we do that later.
1.4       hpeyerl  1004:                 */
                   1005:                /*
                   1006:                 * Locate pcb(s) for datagram.
                   1007:                 * (Algorithm copied from raw_intr().)
                   1008:                 */
                   1009:                last = NULL;
1.22      cgd      1010:                for (inp = udbtable.inpt_queue.cqh_first;
                   1011:                    inp != (struct inpcb *)&udbtable.inpt_queue;
                   1012:                    inp = inp->inp_queue.cqe_next) {
1.4       hpeyerl  1013:                        if (inp->inp_lport != uh->uh_dport)
                   1014:                                continue;
1.34      mycroft  1015:                        if (!in_nullhost(inp->inp_laddr)) {
                   1016:                                if (!in_hosteq(inp->inp_laddr, ip->ip_dst))
1.4       hpeyerl  1017:                                        continue;
                   1018:                        }
1.34      mycroft  1019:                        if (!in_nullhost(inp->inp_faddr)) {
                   1020:                                if (!in_hosteq(inp->inp_faddr, ip->ip_src) ||
1.4       hpeyerl  1021:                                    inp->inp_fport != uh->uh_sport)
                   1022:                                        continue;
                   1023:                        }
                   1024:
                   1025:                        if (last != NULL) {
                   1026:                                struct mbuf *n;
                   1027:
1.48      itojun   1028: #ifdef IPSEC
                   1029:                                /* check AH/ESP integrity. */
                   1030:                                if (last != NULL && ipsec4_in_reject(m, last)) {
                   1031:                                        ipsecstat.in_polvio++;
                   1032:                                        /* do not inject data to pcb */
                   1033:                                } else
                   1034: #endif /*IPSEC*/
1.4       hpeyerl  1035:                                if ((n = m_copy(m, 0, M_COPYALL)) != NULL) {
1.40      thorpej  1036:                                        if (last->inp_flags & INP_CONTROLOPTS
                   1037:                                            || last->inp_socket->so_options &
                   1038:                                               SO_TIMESTAMP) {
                   1039:                                                ip_savecontrol(last, &opts,
                   1040:                                                    ip, n);
                   1041:                                        }
1.49      drochner 1042:                                        m_adj(n, iphlen);
1.48      itojun   1043:                                        sa = (struct sockaddr *)&udpsrc;
1.40      thorpej  1044:                                        if (sbappendaddr(
                   1045:                                            &last->inp_socket->so_rcv,
1.48      itojun   1046:                                            sa, n, opts) == 0) {
1.4       hpeyerl  1047:                                                m_freem(n);
1.40      thorpej  1048:                                                if (opts)
                   1049:                                                        m_freem(opts);
1.13      mycroft  1050:                                        } else
1.40      thorpej  1051:                                                sorwakeup(last->inp_socket);
                   1052:                                        opts = 0;
1.4       hpeyerl  1053:                                }
                   1054:                        }
1.40      thorpej  1055:                        last = inp;
1.4       hpeyerl  1056:                        /*
1.13      mycroft  1057:                         * Don't look for additional matches if this one does
                   1058:                         * not have either the SO_REUSEPORT or SO_REUSEADDR
                   1059:                         * socket options set.  This heuristic avoids searching
                   1060:                         * through all pcbs in the common case of a non-shared
                   1061:                         * port.  It * assumes that an application will never
                   1062:                         * clear these options after setting them.
1.4       hpeyerl  1063:                         */
1.40      thorpej  1064:                        if ((last->inp_socket->so_options &
                   1065:                            (SO_REUSEPORT|SO_REUSEADDR)) == 0)
1.4       hpeyerl  1066:                                break;
                   1067:                }
1.6       mycroft  1068:
1.4       hpeyerl  1069:                if (last == NULL) {
                   1070:                        /*
                   1071:                         * No matching pcb found; discard datagram.
                   1072:                         * (No need to send an ICMP Port Unreachable
                   1073:                         * for a broadcast or multicast datgram.)
                   1074:                         */
1.13      mycroft  1075:                        udpstat.udps_noportbcast++;
1.4       hpeyerl  1076:                        goto bad;
                   1077:                }
1.48      itojun   1078: #ifdef IPSEC
                   1079:                /* check AH/ESP integrity. */
                   1080:                if (last != NULL && ipsec4_in_reject(m, last)) {
                   1081:                        ipsecstat.in_polvio++;
                   1082:                        goto bad;
                   1083:                }
                   1084: #endif /*IPSEC*/
1.40      thorpej  1085:                if (last->inp_flags & INP_CONTROLOPTS ||
                   1086:                    last->inp_socket->so_options & SO_TIMESTAMP)
                   1087:                        ip_savecontrol(last, &opts, ip, m);
1.49      drochner 1088:                m->m_len -= iphlen;
                   1089:                m->m_pkthdr.len -= iphlen;
                   1090:                m->m_data += iphlen;
1.48      itojun   1091:                sa = (struct sockaddr *)&udpsrc;
                   1092:                if (sbappendaddr(&last->inp_socket->so_rcv, sa, m, opts) == 0) {
1.13      mycroft  1093:                        udpstat.udps_fullsock++;
1.4       hpeyerl  1094:                        goto bad;
1.13      mycroft  1095:                }
1.40      thorpej  1096:                sorwakeup(last->inp_socket);
1.4       hpeyerl  1097:                return;
                   1098:        }
1.1       cgd      1099:        /*
                   1100:         * Locate pcb for datagram.
                   1101:         */
1.35      mycroft  1102:        inp = in_pcblookup_connect(&udbtable, ip->ip_src, uh->uh_sport,
1.26      mycroft  1103:            ip->ip_dst, uh->uh_dport);
                   1104:        if (inp == 0) {
                   1105:                ++udpstat.udps_pcbhashmiss;
1.35      mycroft  1106:                inp = in_pcblookup_bind(&udbtable, ip->ip_dst, uh->uh_dport);
1.18      mycroft  1107:                if (inp == 0) {
                   1108:                        if (m->m_flags & (M_BCAST | M_MCAST)) {
                   1109:                                udpstat.udps_noportbcast++;
                   1110:                                goto bad;
                   1111:                        }
1.61    ! itojun   1112:                        udpstat.udps_noport++;
1.18      mycroft  1113:                        *ip = save_ip;
1.38      ws       1114: #if NIPKDB > 0
                   1115:                        if (checkipkdb(&ip->ip_src,
                   1116:                                       uh->uh_sport,
                   1117:                                       uh->uh_dport,
                   1118:                                       m,
                   1119:                                       iphlen + sizeof(struct udphdr),
                   1120:                                       len - sizeof(struct udphdr)))
1.37      ws       1121:                        /* It was a debugger connect packet, just drop it now */
                   1122:                                goto bad;
                   1123: #endif
1.18      mycroft  1124:                        icmp_error(m, ICMP_UNREACH, ICMP_UNREACH_PORT, 0, 0);
                   1125:                        return;
1.13      mycroft  1126:                }
1.1       cgd      1127:        }
1.48      itojun   1128: #ifdef IPSEC
                   1129:        if (inp != NULL && ipsec4_in_reject(m, inp)) {
                   1130:                ipsecstat.in_polvio++;
                   1131:                goto bad;
                   1132:        }
                   1133: #endif /*IPSEC*/
1.1       cgd      1134:
                   1135:        /*
                   1136:         * Stuff source address and datagram in user buffer.
                   1137:         */
1.40      thorpej  1138:        if (inp->inp_flags & INP_CONTROLOPTS ||
                   1139:            inp->inp_socket->so_options & SO_TIMESTAMP)
                   1140:                ip_savecontrol(inp, &opts, ip, m);
1.1       cgd      1141:        iphlen += sizeof(struct udphdr);
                   1142:        m->m_len -= iphlen;
                   1143:        m->m_pkthdr.len -= iphlen;
                   1144:        m->m_data += iphlen;
1.48      itojun   1145:        sa = (struct sockaddr *)&udpsrc;
                   1146:        if (sbappendaddr(&inp->inp_socket->so_rcv, sa, m, opts) == 0) {
1.1       cgd      1147:                udpstat.udps_fullsock++;
                   1148:                goto bad;
                   1149:        }
                   1150:        sorwakeup(inp->inp_socket);
                   1151:        return;
                   1152: bad:
                   1153:        m_freem(m);
                   1154:        if (opts)
                   1155:                m_freem(opts);
                   1156: }
1.56      itojun   1157: #endif /*UDP6*/
1.1       cgd      1158:
                   1159: /*
                   1160:  * Notify a udp user of an asynchronous error;
                   1161:  * just wake up so that he can collect error status.
                   1162:  */
1.7       mycroft  1163: static void
1.1       cgd      1164: udp_notify(inp, errno)
                   1165:        register struct inpcb *inp;
1.7       mycroft  1166:        int errno;
1.1       cgd      1167: {
1.34      mycroft  1168:
1.1       cgd      1169:        inp->inp_socket->so_error = errno;
                   1170:        sorwakeup(inp->inp_socket);
                   1171:        sowwakeup(inp->inp_socket);
                   1172: }
                   1173:
1.27      christos 1174: void *
                   1175: udp_ctlinput(cmd, sa, v)
1.1       cgd      1176:        int cmd;
                   1177:        struct sockaddr *sa;
1.27      christos 1178:        void *v;
1.1       cgd      1179: {
1.27      christos 1180:        register struct ip *ip = v;
1.1       cgd      1181:        register struct udphdr *uh;
1.21      mycroft  1182:        extern int inetctlerrmap[];
1.18      mycroft  1183:        void (*notify) __P((struct inpcb *, int)) = udp_notify;
1.21      mycroft  1184:        int errno;
1.1       cgd      1185:
1.53      itojun   1186:        if (sa->sa_family != AF_INET
                   1187:         || sa->sa_len != sizeof(struct sockaddr_in))
1.51      itojun   1188:                return NULL;
1.20      mycroft  1189:        if ((unsigned)cmd >= PRC_NCMDS)
1.27      christos 1190:                return NULL;
1.20      mycroft  1191:        errno = inetctlerrmap[cmd];
1.18      mycroft  1192:        if (PRC_IS_REDIRECT(cmd))
1.19      mycroft  1193:                notify = in_rtchange, ip = 0;
1.18      mycroft  1194:        else if (cmd == PRC_HOSTDEAD)
1.19      mycroft  1195:                ip = 0;
1.23      cgd      1196:        else if (errno == 0)
1.27      christos 1197:                return NULL;
1.19      mycroft  1198:        if (ip) {
1.1       cgd      1199:                uh = (struct udphdr *)((caddr_t)ip + (ip->ip_hl << 2));
1.34      mycroft  1200:                in_pcbnotify(&udbtable, satosin(sa)->sin_addr, uh->uh_dport,
                   1201:                    ip->ip_src, uh->uh_sport, errno, notify);
1.53      itojun   1202:
                   1203:                /* XXX mapped address case */
1.19      mycroft  1204:        } else
1.34      mycroft  1205:                in_pcbnotifyall(&udbtable, satosin(sa)->sin_addr, errno,
                   1206:                    notify);
1.27      christos 1207:        return NULL;
1.1       cgd      1208: }
                   1209:
1.7       mycroft  1210: int
1.27      christos 1211: #if __STDC__
                   1212: udp_output(struct mbuf *m, ...)
                   1213: #else
                   1214: udp_output(m, va_alist)
                   1215:        struct mbuf *m;
                   1216:        va_dcl
                   1217: #endif
                   1218: {
1.1       cgd      1219:        register struct inpcb *inp;
                   1220:        register struct udpiphdr *ui;
                   1221:        register int len = m->m_pkthdr.len;
1.31      mycroft  1222:        int error = 0;
1.27      christos 1223:        va_list ap;
                   1224:
                   1225:        va_start(ap, m);
                   1226:        inp = va_arg(ap, struct inpcb *);
                   1227:        va_end(ap);
1.1       cgd      1228:
                   1229:        /*
                   1230:         * Calculate data length and get a mbuf
                   1231:         * for UDP and IP headers.
                   1232:         */
1.13      mycroft  1233:        M_PREPEND(m, sizeof(struct udpiphdr), M_DONTWAIT);
                   1234:        if (m == 0) {
                   1235:                error = ENOBUFS;
1.39      thorpej  1236:                goto release;
                   1237:        }
                   1238:
                   1239:        /*
                   1240:         * Compute the packet length of the IP header, and
                   1241:         * punt if the length looks bogus.
                   1242:         */
                   1243:        if ((len + sizeof(struct udpiphdr)) > IP_MAXPACKET) {
                   1244:                error = EMSGSIZE;
1.13      mycroft  1245:                goto release;
                   1246:        }
1.1       cgd      1247:
                   1248:        /*
                   1249:         * Fill in mbuf with extended UDP header
                   1250:         * and addresses and length put into network format.
                   1251:         */
                   1252:        ui = mtod(m, struct udpiphdr *);
1.25      cgd      1253:        bzero(ui->ui_x1, sizeof ui->ui_x1);
1.1       cgd      1254:        ui->ui_pr = IPPROTO_UDP;
1.15      cgd      1255:        ui->ui_len = htons((u_int16_t)len + sizeof (struct udphdr));
1.1       cgd      1256:        ui->ui_src = inp->inp_laddr;
                   1257:        ui->ui_dst = inp->inp_faddr;
                   1258:        ui->ui_sport = inp->inp_lport;
                   1259:        ui->ui_dport = inp->inp_fport;
                   1260:        ui->ui_ulen = ui->ui_len;
                   1261:
                   1262:        /*
                   1263:         * Stuff checksum and output datagram.
                   1264:         */
                   1265:        ui->ui_sum = 0;
                   1266:        if (udpcksum) {
                   1267:            if ((ui->ui_sum = in_cksum(m, sizeof (struct udpiphdr) + len)) == 0)
                   1268:                ui->ui_sum = 0xffff;
                   1269:        }
                   1270:        ((struct ip *)ui)->ip_len = sizeof (struct udpiphdr) + len;
                   1271:        ((struct ip *)ui)->ip_ttl = inp->inp_ip.ip_ttl; /* XXX */
                   1272:        ((struct ip *)ui)->ip_tos = inp->inp_ip.ip_tos; /* XXX */
                   1273:        udpstat.udps_opackets++;
1.48      itojun   1274:
                   1275: #ifdef IPSEC
                   1276:        m->m_pkthdr.rcvif = (struct ifnet *)inp->inp_socket;
                   1277: #endif /*IPSEC*/
                   1278:
1.31      mycroft  1279:        return (ip_output(m, inp->inp_options, &inp->inp_route,
1.12      mycroft  1280:            inp->inp_socket->so_options & (SO_DONTROUTE | SO_BROADCAST),
1.31      mycroft  1281:            inp->inp_moptions));
1.1       cgd      1282:
                   1283: release:
                   1284:        m_freem(m);
                   1285:        return (error);
                   1286: }
                   1287:
1.42      thorpej  1288: int    udp_sendspace = 9216;           /* really max datagram size */
                   1289: int    udp_recvspace = 40 * (1024 + sizeof(struct sockaddr_in));
1.1       cgd      1290:                                        /* 40 1K datagrams */
                   1291:
                   1292: /*ARGSUSED*/
1.7       mycroft  1293: int
1.31      mycroft  1294: udp_usrreq(so, req, m, nam, control, p)
1.1       cgd      1295:        struct socket *so;
                   1296:        int req;
1.31      mycroft  1297:        struct mbuf *m, *nam, *control;
1.30      mycroft  1298:        struct proc *p;
1.1       cgd      1299: {
1.31      mycroft  1300:        register struct inpcb *inp;
1.1       cgd      1301:        int s;
1.31      mycroft  1302:        register int error = 0;
1.1       cgd      1303:
                   1304:        if (req == PRU_CONTROL)
1.31      mycroft  1305:                return (in_control(so, (long)m, (caddr_t)nam,
1.30      mycroft  1306:                    (struct ifnet *)control, p));
1.59      thorpej  1307:
1.60      thorpej  1308:        if (req == PRU_PURGEIF) {
                   1309:                in_purgeif((struct ifnet *)control);
                   1310:                in_pcbpurgeif(&udbtable, (struct ifnet *)control);
1.59      thorpej  1311:                return (0);
                   1312:        }
1.31      mycroft  1313:
                   1314:        s = splsoftnet();
                   1315:        inp = sotoinpcb(so);
1.32      mycroft  1316: #ifdef DIAGNOSTIC
                   1317:        if (req != PRU_SEND && req != PRU_SENDOOB && control)
                   1318:                panic("udp_usrreq: unexpected control mbuf");
                   1319: #endif
1.31      mycroft  1320:        if (inp == 0 && req != PRU_ATTACH) {
                   1321:                error = EINVAL;
                   1322:                goto release;
                   1323:        }
                   1324:
1.1       cgd      1325:        /*
                   1326:         * Note: need to block udp_input while changing
                   1327:         * the udp pcb queue and/or pcb addresses.
                   1328:         */
                   1329:        switch (req) {
                   1330:
                   1331:        case PRU_ATTACH:
1.31      mycroft  1332:                if (inp != 0) {
                   1333:                        error = EISCONN;
1.1       cgd      1334:                        break;
                   1335:                }
1.31      mycroft  1336:                if (so->so_snd.sb_hiwat == 0 || so->so_rcv.sb_hiwat == 0) {
                   1337:                        error = soreserve(so, udp_sendspace, udp_recvspace);
                   1338:                        if (error)
                   1339:                                break;
                   1340:                }
1.18      mycroft  1341:                error = in_pcballoc(so, &udbtable);
1.1       cgd      1342:                if (error)
                   1343:                        break;
1.31      mycroft  1344:                inp = sotoinpcb(so);
                   1345:                inp->inp_ip.ip_ttl = ip_defttl;
1.48      itojun   1346: #ifdef IPSEC
1.58      itojun   1347:                error = ipsec_init_policy(so, &inp->inp_sp);
1.53      itojun   1348:                if (error != 0) {
1.52      itojun   1349:                        in_pcbdetach(inp);
1.53      itojun   1350:                        break;
                   1351:                }
1.48      itojun   1352: #endif /*IPSEC*/
1.1       cgd      1353:                break;
                   1354:
                   1355:        case PRU_DETACH:
1.31      mycroft  1356:                in_pcbdetach(inp);
1.1       cgd      1357:                break;
                   1358:
                   1359:        case PRU_BIND:
1.31      mycroft  1360:                error = in_pcbbind(inp, nam, p);
1.1       cgd      1361:                break;
                   1362:
                   1363:        case PRU_LISTEN:
                   1364:                error = EOPNOTSUPP;
                   1365:                break;
                   1366:
                   1367:        case PRU_CONNECT:
1.31      mycroft  1368:                error = in_pcbconnect(inp, nam);
                   1369:                if (error)
1.1       cgd      1370:                        break;
1.31      mycroft  1371:                soisconnected(so);
1.1       cgd      1372:                break;
                   1373:
                   1374:        case PRU_CONNECT2:
                   1375:                error = EOPNOTSUPP;
                   1376:                break;
                   1377:
                   1378:        case PRU_DISCONNECT:
1.31      mycroft  1379:                /*soisdisconnected(so);*/
                   1380:                so->so_state &= ~SS_ISCONNECTED;        /* XXX */
1.1       cgd      1381:                in_pcbdisconnect(inp);
1.34      mycroft  1382:                inp->inp_laddr = zeroin_addr;           /* XXX */
1.35      mycroft  1383:                in_pcbstate(inp, INP_BOUND);            /* XXX */
1.1       cgd      1384:                break;
                   1385:
                   1386:        case PRU_SHUTDOWN:
                   1387:                socantsendmore(so);
                   1388:                break;
                   1389:
1.31      mycroft  1390:        case PRU_RCVD:
                   1391:                error = EOPNOTSUPP;
1.1       cgd      1392:                break;
                   1393:
1.31      mycroft  1394:        case PRU_SEND:
1.32      mycroft  1395:                if (control && control->m_len) {
                   1396:                        m_freem(control);
                   1397:                        m_freem(m);
                   1398:                        error = EINVAL;
                   1399:                        break;
                   1400:                }
1.31      mycroft  1401:        {
1.35      mycroft  1402:                struct in_addr laddr;                   /* XXX */
1.1       cgd      1403:
1.31      mycroft  1404:                if (nam) {
1.35      mycroft  1405:                        laddr = inp->inp_laddr;         /* XXX */
1.31      mycroft  1406:                        if ((so->so_state & SS_ISCONNECTED) != 0) {
                   1407:                                error = EISCONN;
1.32      mycroft  1408:                                goto die;
1.31      mycroft  1409:                        }
                   1410:                        error = in_pcbconnect(inp, nam);
1.32      mycroft  1411:                        if (error) {
                   1412:                        die:
                   1413:                                m_freem(m);
1.31      mycroft  1414:                                break;
1.32      mycroft  1415:                        }
1.31      mycroft  1416:                } else {
                   1417:                        if ((so->so_state & SS_ISCONNECTED) == 0) {
                   1418:                                error = ENOTCONN;
1.32      mycroft  1419:                                goto die;
1.31      mycroft  1420:                        }
                   1421:                }
1.33      mycroft  1422:                error = udp_output(m, inp);
1.31      mycroft  1423:                if (nam) {
                   1424:                        in_pcbdisconnect(inp);
1.35      mycroft  1425:                        inp->inp_laddr = laddr;         /* XXX */
                   1426:                        in_pcbstate(inp, INP_BOUND);    /* XXX */
1.31      mycroft  1427:                }
                   1428:        }
1.1       cgd      1429:                break;
                   1430:
                   1431:        case PRU_SENSE:
                   1432:                /*
                   1433:                 * stat: don't bother with a blocksize.
                   1434:                 */
1.31      mycroft  1435:                splx(s);
1.1       cgd      1436:                return (0);
                   1437:
1.31      mycroft  1438:        case PRU_RCVOOB:
                   1439:                error =  EOPNOTSUPP;
                   1440:                break;
                   1441:
1.1       cgd      1442:        case PRU_SENDOOB:
1.32      mycroft  1443:                m_freem(control);
1.31      mycroft  1444:                m_freem(m);
1.1       cgd      1445:                error =  EOPNOTSUPP;
                   1446:                break;
                   1447:
1.31      mycroft  1448:        case PRU_SOCKADDR:
                   1449:                in_setsockaddr(inp, nam);
                   1450:                break;
                   1451:
                   1452:        case PRU_PEERADDR:
                   1453:                in_setpeeraddr(inp, nam);
                   1454:                break;
1.1       cgd      1455:
                   1456:        default:
                   1457:                panic("udp_usrreq");
                   1458:        }
                   1459:
                   1460: release:
1.31      mycroft  1461:        splx(s);
1.1       cgd      1462:        return (error);
1.13      mycroft  1463: }
                   1464:
                   1465: /*
                   1466:  * Sysctl for udp variables.
                   1467:  */
1.27      christos 1468: int
1.13      mycroft  1469: udp_sysctl(name, namelen, oldp, oldlenp, newp, newlen)
                   1470:        int *name;
                   1471:        u_int namelen;
                   1472:        void *oldp;
                   1473:        size_t *oldlenp;
                   1474:        void *newp;
                   1475:        size_t newlen;
                   1476: {
                   1477:        /* All sysctl names at this level are terminal. */
                   1478:        if (namelen != 1)
                   1479:                return (ENOTDIR);
                   1480:
                   1481:        switch (name[0]) {
                   1482:        case UDPCTL_CHECKSUM:
                   1483:                return (sysctl_int(oldp, oldlenp, newp, newlen, &udpcksum));
1.42      thorpej  1484:        case UDPCTL_SENDSPACE:
                   1485:                return (sysctl_int(oldp, oldlenp, newp, newlen,
                   1486:                    &udp_sendspace));
                   1487:        case UDPCTL_RECVSPACE:
                   1488:                return (sysctl_int(oldp, oldlenp, newp, newlen,
                   1489:                    &udp_recvspace));
1.13      mycroft  1490:        default:
                   1491:                return (ENOPROTOOPT);
                   1492:        }
                   1493:        /* NOTREACHED */
1.1       cgd      1494: }

CVSweb <webmaster@jp.NetBSD.org>