diff options
author | Ralf Baechle <ralf@linux-mips.org> | 1997-04-29 21:13:14 +0000 |
---|---|---|
committer | <ralf@linux-mips.org> | 1997-04-29 21:13:14 +0000 |
commit | 19c9bba94152148523ba0f7ef7cffe3d45656b11 (patch) | |
tree | 40b1cb534496a7f1ca0f5c314a523c69f1fee464 /net/ipv6/udp.c | |
parent | 7206675c40394c78a90e74812bbdbf8cf3cca1be (diff) |
Import of Linux/MIPS 2.1.36
Diffstat (limited to 'net/ipv6/udp.c')
-rw-r--r-- | net/ipv6/udp.c | 494 |
1 files changed, 318 insertions, 176 deletions
diff --git a/net/ipv6/udp.c b/net/ipv6/udp.c index 380122210..1f0fb8ce5 100644 --- a/net/ipv6/udp.c +++ b/net/ipv6/udp.c @@ -7,7 +7,7 @@ * * Based on linux/ipv4/udp.c * - * $Id: udp.c,v 1.6 1996/10/16 18:34:16 roque Exp $ + * $Id: udp.c,v 1.16 1997/04/11 22:22:57 davem Exp $ * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License @@ -34,7 +34,7 @@ #include <net/ndisc.h> #include <net/protocol.h> #include <net/transp_v6.h> -#include <net/ipv6_route.h> +#include <net/ip6_route.h> #include <net/addrconf.h> #include <net/ip.h> #include <net/udp.h> @@ -43,6 +43,139 @@ struct udp_mib udp_stats_in6; +/* Grrr, addr_type already calculated by caller, but I don't want + * to add some silly "cookie" argument to this method just for that. + */ +static int udp_v6_verify_bind(struct sock *sk, unsigned short snum) +{ + struct sock *sk2; + int addr_type = ipv6_addr_type(&sk->net_pinfo.af_inet6.rcv_saddr); + int retval = 0, sk_reuse = sk->reuse; + + SOCKHASH_LOCK(); + for(sk2 = udp_hash[snum & (UDP_HTABLE_SIZE - 1)]; sk2 != NULL; sk2 = sk2->next) { + if((sk2->num == snum) && (sk2 != sk)) { + unsigned char state = sk2->state; + int sk2_reuse = sk2->reuse; + if(addr_type == IPV6_ADDR_ANY || (!sk2->rcv_saddr)) { + if((!sk2_reuse) || + (!sk_reuse) || + (state == TCP_LISTEN)) { + retval = 1; + break; + } + } else if(!ipv6_addr_cmp(&sk->net_pinfo.af_inet6.rcv_saddr, + &sk2->net_pinfo.af_inet6.rcv_saddr)) { + if((!sk_reuse) || + (!sk2_reuse) || + (state == TCP_LISTEN)) { + retval = 1; + break; + } + } + } + } + SOCKHASH_UNLOCK(); + return retval; +} + +static void udp_v6_hash(struct sock *sk) +{ + struct sock **skp; + int num = sk->num; + + num &= (UDP_HTABLE_SIZE - 1); + skp = &udp_hash[num]; + + SOCKHASH_LOCK(); + sk->next = *skp; + *skp = sk; + sk->hashent = num; + SOCKHASH_UNLOCK(); +} + +static void udp_v6_unhash(struct sock *sk) +{ + struct sock **skp; + int num = sk->num; + + num &= (UDP_HTABLE_SIZE - 1); + skp = &udp_hash[num]; + + SOCKHASH_LOCK(); + while(*skp != NULL) { + if(*skp == sk) { + *skp = sk->next; + break; + } + skp = &((*skp)->next); + } + SOCKHASH_UNLOCK(); +} + +static void udp_v6_rehash(struct sock *sk) +{ + struct sock **skp; + int num = sk->num; + int oldnum = sk->hashent; + + num &= (UDP_HTABLE_SIZE - 1); + skp = &udp_hash[oldnum]; + + SOCKHASH_LOCK(); + while(*skp != NULL) { + if(*skp == sk) { + *skp = sk->next; + break; + } + skp = &((*skp)->next); + } + sk->next = udp_hash[num]; + udp_hash[num] = sk; + sk->hashent = num; + SOCKHASH_UNLOCK(); +} + +static struct sock *udp_v6_lookup(struct in6_addr *saddr, u16 sport, + struct in6_addr *daddr, u16 dport) +{ + struct sock *sk, *result = NULL; + unsigned short hnum = ntohs(dport); + int badness = -1; + + for(sk = udp_hash[hnum & (UDP_HTABLE_SIZE - 1)]; sk != NULL; sk = sk->next) { + if((sk->num == hnum) && + (sk->family == AF_INET6) && + !(sk->dead && (sk->state == TCP_CLOSE))) { + struct ipv6_pinfo *np = &sk->net_pinfo.af_inet6; + int score = 0; + if(sk->dummy_th.dest) { + if(sk->dummy_th.dest != sport) + continue; + score++; + } + if(!ipv6_addr_any(&np->rcv_saddr)) { + if(ipv6_addr_cmp(&np->rcv_saddr, daddr)) + continue; + score++; + } + if(!ipv6_addr_any(&np->daddr)) { + if(ipv6_addr_cmp(&np->daddr, saddr)) + continue; + score++; + } + if(score == 3) { + result = sk; + break; + } else if(score > badness) { + result = sk; + badness = score; + } + } + } + return result; +} + /* * */ @@ -51,9 +184,10 @@ int udpv6_connect(struct sock *sk, struct sockaddr *uaddr, int addr_len) { struct sockaddr_in6 *usin = (struct sockaddr_in6 *) uaddr; struct in6_addr *daddr; - struct dest_entry *dest; + struct dst_entry *dst; struct ipv6_pinfo *np; struct inet6_ifaddr *ifa; + struct flowi fl; int addr_type; if (addr_len < sizeof(*usin)) @@ -65,8 +199,7 @@ int udpv6_connect(struct sock *sk, struct sockaddr *uaddr, int addr_len) addr_type = ipv6_addr_type(&usin->sin6_addr); np = &sk->net_pinfo.af_inet6; - if (addr_type == IPV6_ADDR_ANY) - { + if (addr_type == IPV6_ADDR_ANY) { /* * connect to self */ @@ -75,8 +208,7 @@ int udpv6_connect(struct sock *sk, struct sockaddr *uaddr, int addr_len) daddr = &usin->sin6_addr; - if (addr_type == IPV6_ADDR_MAPPED) - { + if (addr_type == IPV6_ADDR_MAPPED) { struct sockaddr_in sin; int err; @@ -86,22 +218,18 @@ int udpv6_connect(struct sock *sk, struct sockaddr *uaddr, int addr_len) err = udp_connect(sk, (struct sockaddr*) &sin, sizeof(sin)); if (err < 0) - { return err; - } ipv6_addr_copy(&np->daddr, daddr); - if(ipv6_addr_any(&np->saddr)) - { + if(ipv6_addr_any(&np->saddr)) { ipv6_addr_set(&np->saddr, 0, 0, __constant_htonl(0x0000ffff), sk->saddr); } - if(ipv6_addr_any(&np->rcv_saddr)) - { + if(ipv6_addr_any(&np->rcv_saddr)) { ipv6_addr_set(&np->rcv_saddr, 0, 0, __constant_htonl(0x0000ffff), sk->rcv_saddr); @@ -111,35 +239,41 @@ int udpv6_connect(struct sock *sk, struct sockaddr *uaddr, int addr_len) ipv6_addr_copy(&np->daddr, daddr); + sk->dummy_th.dest = usin->sin6_port; + /* * Check for a route to destination an obtain the * destination cache for it. */ - dest = ipv6_dst_route(daddr, NULL, sk->localroute ? RTI_GATEWAY : 0); - - np->dest = dest; + fl.proto = IPPROTO_UDP; + fl.nl_u.ip6_u.daddr = daddr; + fl.nl_u.ip6_u.saddr = NULL; + fl.dev = NULL; + fl.uli_u.ports.dport = sk->dummy_th.dest; + fl.uli_u.ports.sport = sk->dummy_th.source; + + dst = ip6_route_output(sk, &fl); + + if (dst->error) { + dst_release(dst); + return dst->error; + } - if (dest == NULL) - return -ENETUNREACH; + ip6_dst_store(sk, dst); /* get the source adddress used in the apropriate device */ - ifa = ipv6_get_saddr((struct rt6_info *) dest, daddr); + ifa = ipv6_get_saddr(dst, daddr); if(ipv6_addr_any(&np->saddr)) - { ipv6_addr_copy(&np->saddr, &ifa->addr); - } - if(ipv6_addr_any(&np->rcv_saddr)) - { + if(ipv6_addr_any(&np->rcv_saddr)) { ipv6_addr_copy(&np->rcv_saddr, &ifa->addr); sk->rcv_saddr = 0xffffffff; } - sk->dummy_th.dest = usin->sin6_port; - sk->state = TCP_ESTABLISHED; return(0); @@ -152,11 +286,11 @@ static void udpv6_close(struct sock *sk, unsigned long timeout) lock_sock(sk); sk->state = TCP_CLOSE; - if (np->dest) - { - ipv6_dst_unlock(np->dest); - } + if (np->dst) + dst_release(np->dst); + ipv6_sock_mc_close(sk); + udp_v6_unhash(sk); release_sock(sk); destroy_sock(sk); } @@ -173,7 +307,6 @@ int udpv6_recvmsg(struct sock *sk, struct msghdr *msg, int len, int truesize; struct sk_buff *skb; int err; - /* * Check any passed addresses @@ -191,11 +324,11 @@ int udpv6_recvmsg(struct sock *sk, struct msghdr *msg, int len, if(skb==NULL) return err; - truesize = skb->tail - skb->h.raw - sizeof(struct udphdr); + truesize=ntohs(((struct udphdr *)skb->h.raw)->len) - sizeof(struct udphdr); copied=truesize; - if(copied>len) - { + + if(copied>len) { copied=len; msg->msg_flags|=MSG_TRUNC; } @@ -212,8 +345,7 @@ int udpv6_recvmsg(struct sock *sk, struct msghdr *msg, int len, sk->stamp=skb->stamp; /* Copy the address. */ - if (msg->msg_name) - { + if (msg->msg_name) { struct sockaddr_in6 *sin6; sin6 = (struct sockaddr_in6 *) msg->msg_name; @@ -221,27 +353,15 @@ int udpv6_recvmsg(struct sock *sk, struct msghdr *msg, int len, sin6->sin6_family = AF_INET6; sin6->sin6_port = skb->h.uh->source; - if (skb->protocol == __constant_htons(ETH_P_IP)) - { + if (skb->protocol == __constant_htons(ETH_P_IP)) { ipv6_addr_set(&sin6->sin6_addr, 0, 0, - __constant_htonl(0xffff), skb->daddr); - } - else - { - memcpy(&sin6->sin6_addr, &skb->ipv6_hdr->saddr, + __constant_htonl(0xffff), skb->nh.iph->saddr); + } else { + memcpy(&sin6->sin6_addr, &skb->nh.ipv6h->saddr, sizeof(struct in6_addr)); - if (msg->msg_control) - { - int err; - - err = datagram_recv_ctl(sk, msg, skb); - - if (err < 0) - { - copied = err; - } - } + if (msg->msg_controllen) + datagram_recv_ctl(sk, msg, skb); } } @@ -259,24 +379,22 @@ void udpv6_err(int type, int code, unsigned char *buff, __u32 info, uh = (struct udphdr *) buff; - sk = inet6_get_sock(&udpv6_prot, daddr, saddr, uh->source, uh->dest); + sk = udp_v6_lookup(daddr, uh->dest, saddr, uh->source); - if (sk == NULL) - { - printk(KERN_DEBUG "icmp for unkown sock\n"); + if (sk == NULL) { + printk(KERN_DEBUG "icmp for unknown sock\n"); return; } - if (icmpv6_err_convert(type, code, &err)) - { + if (icmpv6_err_convert(type, code, &err)) { if(sk->bsdism && sk->state!=TCP_ESTABLISHED) return; sk->err = err; sk->error_report(sk); - } - else + } else { sk->err_soft = err; + } } static inline int udpv6_queue_rcv_skb(struct sock * sk, struct sk_buff *skb) @@ -294,6 +412,74 @@ static inline int udpv6_queue_rcv_skb(struct sock * sk, struct sk_buff *skb) return 0; } +static int __inline__ inet6_mc_check(struct sock *sk, struct in6_addr *addr) +{ + struct ipv6_mc_socklist *mc; + + for (mc = sk->net_pinfo.af_inet6.ipv6_mc_list; mc; mc=mc->next) { + if (ipv6_addr_cmp(&mc->addr, addr) == 0) + return 1; + } + + return 0; +} + +static struct sock *udp_v6_mcast_next(struct sock *sk, + u16 loc_port, struct in6_addr *loc_addr, + u16 rmt_port, struct in6_addr *rmt_addr) +{ + struct sock *s = sk; + unsigned short num = ntohs(loc_port); + for(; s; s = s->next) { + if((s->num == num) && + !(s->dead && (s->state == TCP_CLOSE))) { + struct ipv6_pinfo *np = &s->net_pinfo.af_inet6; + if(s->dummy_th.dest) { + if(s->dummy_th.dest != rmt_port) + continue; + } + if(!ipv6_addr_any(&np->daddr) && + ipv6_addr_cmp(&np->daddr, rmt_addr)) + continue; + + if(!ipv6_addr_any(&np->rcv_saddr)) { + if(ipv6_addr_cmp(&np->rcv_saddr, loc_addr) == 0) + return s; + } + if(!inet6_mc_check(s, loc_addr)) + continue; + return s; + } + } + return NULL; +} + +static void udpv6_mcast_deliver(struct udphdr *uh, + struct in6_addr *saddr, struct in6_addr *daddr, + struct sk_buff *skb) +{ + struct sock *sk, *sk2; + + sk = udp_hash[ntohs(uh->dest) & (UDP_HTABLE_SIZE - 1)]; + sk = udp_v6_mcast_next(sk, uh->dest, daddr, uh->source, saddr); + if(sk) { + sk2 = sk; + while((sk2 = udp_v6_mcast_next(sk2->next, + uh->dest, saddr, + uh->source, daddr))) { + struct sk_buff *buff = skb_clone(skb, GFP_ATOMIC); + if(sock_queue_rcv_skb(sk, buff) < 0) { + buff->sk = NULL; + kfree_skb(buff, FREE_READ); + } + } + } + if(!sk || sock_queue_rcv_skb(sk, skb) < 0) { + skb->sk = NULL; + kfree_skb(skb, FREE_READ); + } +} + int udpv6_rcv(struct sk_buff *skb, struct device *dev, struct in6_addr *saddr, struct in6_addr *daddr, struct ipv6_options *opt, unsigned short len, @@ -314,16 +500,14 @@ int udpv6_rcv(struct sk_buff *skb, struct device *dev, ulen = ntohs(uh->len); - if (ulen > len || len < sizeof(*uh)) - { + if (ulen > len || len < sizeof(*uh)) { printk(KERN_DEBUG "UDP: short packet: %d/%d\n", ulen, len); udp_stats_in6.UdpInErrors++; kfree_skb(skb, FREE_READ); return(0); } - if (uh->check == 0) - { + if (uh->check == 0) { printk(KERN_DEBUG "IPv6: udp checksum is 0\n"); goto discard; } @@ -332,53 +516,19 @@ int udpv6_rcv(struct sk_buff *skb, struct device *dev, case CHECKSUM_NONE: skb->csum = csum_partial((char*)uh, len, 0); case CHECKSUM_HW: - if (csum_ipv6_magic(saddr, daddr, len, IPPROTO_UDP, skb->csum)) - { + if (csum_ipv6_magic(saddr, daddr, len, IPPROTO_UDP, skb->csum)) { printk(KERN_DEBUG "IPv6: udp checksum error\n"); goto discard; } - } + }; len = ulen; /* * Multicast receive code */ - if (ipv6_addr_type(daddr) & IPV6_ADDR_MULTICAST) - { - struct sock *sk2; - int lport; - - lport = ntohs(uh->dest); - sk = udpv6_prot.sock_array[lport & (SOCK_ARRAY_SIZE-1)]; - - sk = inet6_get_sock_mcast(sk, lport, uh->source, - daddr, saddr); - - if (sk) - { - sk2 = sk; - - while ((sk2 = inet6_get_sock_mcast(sk2->next, lport, - uh->source, - daddr, saddr))) - { - struct sk_buff *buff; - - buff = skb_clone(skb, GFP_ATOMIC); - - if (sock_queue_rcv_skb(sk, buff) < 0) - { - buff->sk = NULL; - kfree_skb(buff, FREE_READ); - } - } - } - if (!sk || sock_queue_rcv_skb(sk, skb) < 0) - { - skb->sk = NULL; - kfree_skb(skb, FREE_READ); - } + if (ipv6_addr_type(daddr) & IPV6_ADDR_MULTICAST) { + udpv6_mcast_deliver(uh, saddr, daddr, skb); return 0; } @@ -389,14 +539,12 @@ int udpv6_rcv(struct sk_buff *skb, struct device *dev, * for sock caches... i'll skip this for now. */ - sk = inet6_get_sock(&udpv6_prot, daddr, saddr, uh->dest, uh->source); + sk = udp_v6_lookup(saddr, uh->source, daddr, uh->dest); - if (sk == NULL) - { + if (sk == NULL) { udp_stats_in6.UdpNoPorts++; - icmpv6_send(skb, ICMPV6_DEST_UNREACH, ICMPV6_PORT_UNREACH, - 0, dev); + icmpv6_send(skb, ICMPV6_DEST_UNREACH, ICMPV6_PORT_UNREACH, 0, dev); kfree_skb(skb, FREE_READ); return(0); @@ -404,18 +552,14 @@ int udpv6_rcv(struct sk_buff *skb, struct device *dev, /* deliver */ - if (sk->users) - { + if (sk->sock_readers) __skb_queue_tail(&sk->back_log, skb); - } else - { udpv6_queue_rcv_skb(sk, skb); - } return(0); - discard: +discard: udp_stats_in6.UdpInErrors++; kfree_skb(skb, FREE_READ); return(0); @@ -448,12 +592,9 @@ static int udpv6_getfrag(const void *data, struct in6_addr *addr, dst = buff; - if (offset) - { + if (offset) { offset -= sizeof(struct udphdr); - } - else - { + } else { dst += sizeof(struct udphdr); final = 1; clen -= sizeof(struct udphdr); @@ -462,19 +603,15 @@ static int udpv6_getfrag(const void *data, struct in6_addr *addr, udh->wcheck = csum_partial_copy_fromiovecend(dst, udh->iov, offset, clen, udh->wcheck); - if (final) - { + if (final) { struct in6_addr *daddr; udh->wcheck = csum_partial((char *)udh, sizeof(struct udphdr), udh->wcheck); - if (udh->daddr) - { + if (udh->daddr) { daddr = udh->daddr; - } - else - { + } else { /* * use packet destination address * this should improve cache locality @@ -492,29 +629,28 @@ static int udpv6_getfrag(const void *data, struct in6_addr *addr, return 0; } -static int udpv6_sendmsg(struct sock *sk, struct msghdr *msg, int ulen, - int noblock, int flags) +static int udpv6_sendmsg(struct sock *sk, struct msghdr *msg, int ulen) { - struct ipv6_options opt_space; struct udpv6fakehdr udh; struct ipv6_pinfo *np = &sk->net_pinfo.af_inet6; struct sockaddr_in6 *sin6 = (struct sockaddr_in6 *) msg->msg_name; struct ipv6_options *opt = NULL; struct device *dev = NULL; + struct flowi fl; int addr_len = msg->msg_namelen; struct in6_addr *daddr; struct in6_addr *saddr = NULL; int len = ulen + sizeof(struct udphdr); int addr_type; - int err; + int hlimit = -1; + int err; - if (flags & ~MSG_DONTROUTE) + if (msg->msg_flags & ~(MSG_DONTROUTE|MSG_DONTWAIT)) return(-EINVAL); - if (sin6) - { + if (sin6) { if (addr_len < sizeof(*sin6)) return(-EINVAL); @@ -527,14 +663,11 @@ static int udpv6_sendmsg(struct sock *sk, struct msghdr *msg, int ulen, udh.uh.dest = sin6->sin6_port; daddr = &sin6->sin6_addr; - if (np->dest && ipv6_addr_cmp(daddr, &np->daddr)) - { - ipv6_dst_unlock(np->dest); - np->dest = NULL; + if (np->dst && ipv6_addr_cmp(daddr, &np->daddr)) { + dst_release(np->dst); + np->dst = NULL; } - } - else - { + } else { if (sk->state != TCP_ESTABLISHED) return(-EINVAL); @@ -544,34 +677,29 @@ static int udpv6_sendmsg(struct sock *sk, struct msghdr *msg, int ulen, addr_type = ipv6_addr_type(daddr); - if (addr_type == IPV6_ADDR_MAPPED) - { + if (addr_type == IPV6_ADDR_MAPPED) { struct sockaddr_in sin; sin.sin_family = AF_INET; sin.sin_addr.s_addr = daddr->s6_addr32[3]; - return udp_sendmsg(sk, msg, len, noblock, flags); + return udp_sendmsg(sk, msg, len); } udh.daddr = NULL; - if (msg->msg_control) - { + if (msg->msg_controllen) { opt = &opt_space; memset(opt, 0, sizeof(struct ipv6_options)); - err = datagram_send_ctl(msg, &dev, &saddr, opt); - if (err < 0) - { + err = datagram_send_ctl(msg, &dev, &saddr, opt, &hlimit); + if (err < 0) { printk(KERN_DEBUG "invalid msg_control\n"); return err; } if (opt->srcrt) - { udh.daddr = daddr; - } } udh.uh.source = sk->dummy_th.source; @@ -580,10 +708,17 @@ static int udpv6_sendmsg(struct sock *sk, struct msghdr *msg, int ulen, udh.iov = msg->msg_iov; udh.wcheck = 0; udh.pl_len = len; - - err = ipv6_build_xmit(sk, udpv6_getfrag, &udh, daddr, len, - saddr, dev, opt, IPPROTO_UDP, noblock); - + + fl.proto = IPPROTO_UDP; + fl.nl_u.ip6_u.daddr = daddr; + fl.nl_u.ip6_u.saddr = saddr; + fl.dev = dev; + fl.uli_u.ports.dport = udh.uh.dest; + fl.uli_u.ports.sport = udh.uh.source; + + err = ip6_build_xmit(sk, udpv6_getfrag, &udh, &fl, len, opt, hlimit, + msg->msg_flags); + if (err < 0) return err; @@ -604,28 +739,35 @@ static struct inet6_protocol udpv6_protocol = struct proto udpv6_prot = { - udpv6_close, - udpv6_connect, - NULL, - NULL, - NULL, - NULL, - datagram_select, - udp_ioctl, - NULL, - NULL, - NULL, - ipv6_setsockopt, - ipv6_getsockopt, - udpv6_sendmsg, - udpv6_recvmsg, - NULL, /* No special bind function */ - udpv6_queue_rcv_skb, - 128, - 0, - "UDP", - 0, 0, - NULL + (struct sock *)&udpv6_prot, /* sklist_next */ + (struct sock *)&udpv6_prot, /* sklist_prev */ + udpv6_close, /* close */ + udpv6_connect, /* connect */ + NULL, /* accept */ + NULL, /* retransmit */ + NULL, /* write_wakeup */ + NULL, /* read_wakeup */ + datagram_poll, /* poll */ + udp_ioctl, /* ioctl */ + NULL, /* init */ + NULL, /* destroy */ + NULL, /* shutdown */ + ipv6_setsockopt, /* setsockopt */ + ipv6_getsockopt, /* getsockopt */ + udpv6_sendmsg, /* sendmsg */ + udpv6_recvmsg, /* recvmsg */ + NULL, /* bind */ + udpv6_queue_rcv_skb, /* backlog_rcv */ + udp_v6_hash, /* hash */ + udp_v6_unhash, /* unhash */ + udp_v6_rehash, /* rehash */ + udp_good_socknum, /* good_socknum */ + udp_v6_verify_bind, /* verify_bind */ + 128, /* max_header */ + 0, /* retransmits */ + "UDP", /* name */ + 0, /* inuse */ + 0 /* highestinuse */ }; void udpv6_init(void) |