1 /* $OpenBSD: udp6_output.c,v 1.53 2016/12/19 15:47:19 mpi Exp $ */ 2 /* $KAME: udp6_output.c,v 1.21 2001/02/07 11:51:54 itojun Exp $ */ 3 4 /* 5 * Copyright (C) 1995, 1996, 1997, and 1998 WIDE Project. 6 * All rights reserved. 7 * 8 * Redistribution and use in source and binary forms, with or without 9 * modification, are permitted provided that the following conditions 10 * are met: 11 * 1. Redistributions of source code must retain the above copyright 12 * notice, this list of conditions and the following disclaimer. 13 * 2. Redistributions in binary form must reproduce the above copyright 14 * notice, this list of conditions and the following disclaimer in the 15 * documentation and/or other materials provided with the distribution. 16 * 3. Neither the name of the project nor the names of its contributors 17 * may be used to endorse or promote products derived from this software 18 * without specific prior written permission. 19 * 20 * THIS SOFTWARE IS PROVIDED BY THE PROJECT AND CONTRIBUTORS ``AS IS'' AND 21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 22 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 23 * ARE DISCLAIMED. IN NO EVENT SHALL THE PROJECT OR CONTRIBUTORS BE LIABLE 24 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 25 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 26 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 27 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 28 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 29 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 30 * SUCH DAMAGE. 31 */ 32 33 /* 34 * Copyright (c) 1982, 1986, 1989, 1993 35 * The Regents of the University of California. All rights reserved. 36 * 37 * Redistribution and use in source and binary forms, with or without 38 * modification, are permitted provided that the following conditions 39 * are met: 40 * 1. Redistributions of source code must retain the above copyright 41 * notice, this list of conditions and the following disclaimer. 42 * 2. Redistributions in binary form must reproduce the above copyright 43 * notice, this list of conditions and the following disclaimer in the 44 * documentation and/or other materials provided with the distribution. 45 * 3. Neither the name of the University nor the names of its contributors 46 * may be used to endorse or promote products derived from this software 47 * without specific prior written permission. 48 * 49 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND 50 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 51 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 52 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE 53 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 54 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 55 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 56 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 57 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 58 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 59 * SUCH DAMAGE. 60 */ 61 62 #include "pf.h" 63 64 #include <sys/param.h> 65 #include <sys/mbuf.h> 66 #include <sys/protosw.h> 67 #include <sys/socket.h> 68 #include <sys/socketvar.h> 69 #include <sys/errno.h> 70 #include <sys/stat.h> 71 #include <sys/systm.h> 72 #include <sys/syslog.h> 73 74 #include <net/if.h> 75 #include <net/if_var.h> 76 #include <net/route.h> 77 78 #include <netinet/in.h> 79 #include <netinet6/in6_var.h> 80 #include <netinet/ip.h> 81 #include <netinet/ip_var.h> 82 #include <netinet/in_pcb.h> 83 #include <netinet/udp.h> 84 #include <netinet/udp_var.h> 85 #include <netinet/ip6.h> 86 #include <netinet6/ip6_var.h> 87 #include <netinet/icmp6.h> 88 #include <netinet6/ip6protosw.h> 89 90 /* 91 * UDP protocol inplementation. 92 * Per RFC 768, August, 1980. 93 */ 94 int 95 udp6_output(struct inpcb *in6p, struct mbuf *m, struct mbuf *addr6, 96 struct mbuf *control) 97 { 98 u_int32_t ulen = m->m_pkthdr.len; 99 u_int32_t plen = sizeof(struct udphdr) + ulen; 100 int error = 0, priv = 0, hlen, flags; 101 struct ip6_hdr *ip6; 102 struct udphdr *udp6; 103 struct in6_addr *laddr, *faddr; 104 struct ip6_pktopts *optp, opt; 105 struct sockaddr_in6 tmp, valid; 106 struct proc *p = curproc; /* XXX */ 107 u_short fport; 108 109 if ((in6p->inp_socket->so_state & SS_PRIV) != 0) 110 priv = 1; 111 if (control) { 112 if ((error = ip6_setpktopts(control, &opt, 113 in6p->inp_outputopts6, priv, IPPROTO_UDP)) != 0) 114 goto release; 115 optp = &opt; 116 } else 117 optp = in6p->inp_outputopts6; 118 119 if (addr6) { 120 struct sockaddr_in6 *sin6 = mtod(addr6, struct sockaddr_in6 *); 121 122 if (addr6->m_len != sizeof(*sin6)) { 123 error = EINVAL; 124 goto release; 125 } 126 if (sin6->sin6_family != AF_INET6) { 127 error = EAFNOSUPPORT; 128 goto release; 129 } 130 if (sin6->sin6_port == 0) { 131 error = EADDRNOTAVAIL; 132 goto release; 133 } 134 if (IN6_IS_ADDR_V4MAPPED(&sin6->sin6_addr)) { 135 error = EINVAL; 136 goto release; 137 } 138 139 if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->inp_faddr6)) { 140 error = EISCONN; 141 goto release; 142 } 143 144 /* protect *sin6 from overwrites */ 145 tmp = *sin6; 146 sin6 = &tmp; 147 148 faddr = &sin6->sin6_addr; 149 fport = sin6->sin6_port; /* allow 0 port */ 150 151 /* KAME hack: embed scopeid */ 152 if (in6_embedscope(&sin6->sin6_addr, sin6, in6p) != 0) { 153 error = EINVAL; 154 goto release; 155 } 156 157 error = in6_pcbselsrc(&laddr, sin6, in6p, optp); 158 if (error) 159 goto release; 160 161 if (in6p->inp_lport == 0){ 162 error = in_pcbbind(in6p, NULL, p); 163 if (error) 164 goto release; 165 } 166 167 if (!IN6_IS_ADDR_UNSPECIFIED(&in6p->inp_laddr6) && 168 !IN6_ARE_ADDR_EQUAL(&in6p->inp_laddr6, laddr)) { 169 valid.sin6_addr = *laddr; 170 valid.sin6_port = in6p->inp_lport; 171 valid.sin6_scope_id = 0; 172 valid.sin6_family = AF_INET6; 173 valid.sin6_len = sizeof(valid); 174 error = in6_pcbaddrisavail(in6p, &valid, 0, p); 175 if (error) 176 goto release; 177 } 178 } else { 179 if (IN6_IS_ADDR_UNSPECIFIED(&in6p->inp_faddr6)) { 180 error = ENOTCONN; 181 goto release; 182 } 183 laddr = &in6p->inp_laddr6; 184 faddr = &in6p->inp_faddr6; 185 fport = in6p->inp_fport; 186 } 187 188 hlen = sizeof(struct ip6_hdr); 189 190 /* 191 * Calculate data length and get a mbuf 192 * for UDP and IP6 headers. 193 */ 194 M_PREPEND(m, hlen + sizeof(struct udphdr), M_DONTWAIT); 195 if (m == NULL) { 196 error = ENOBUFS; 197 goto releaseopt; 198 } 199 200 /* 201 * Stuff checksum and output datagram. 202 */ 203 udp6 = (struct udphdr *)(mtod(m, caddr_t) + hlen); 204 udp6->uh_sport = in6p->inp_lport; /* lport is always set in the PCB */ 205 udp6->uh_dport = fport; 206 if (plen <= 0xffff) 207 udp6->uh_ulen = htons((u_short)plen); 208 else 209 udp6->uh_ulen = 0; 210 udp6->uh_sum = 0; 211 212 ip6 = mtod(m, struct ip6_hdr *); 213 ip6->ip6_flow = in6p->inp_flowinfo & IPV6_FLOWINFO_MASK; 214 ip6->ip6_vfc &= ~IPV6_VERSION_MASK; 215 ip6->ip6_vfc |= IPV6_VERSION; 216 #if 0 /* ip6_plen will be filled in ip6_output. */ 217 ip6->ip6_plen = htons((u_short)plen); 218 #endif 219 ip6->ip6_nxt = IPPROTO_UDP; 220 ip6->ip6_hlim = in6_selecthlim(in6p); 221 ip6->ip6_src = *laddr; 222 ip6->ip6_dst = *faddr; 223 224 m->m_pkthdr.csum_flags |= M_UDP_CSUM_OUT; 225 226 flags = 0; 227 if (in6p->inp_flags & IN6P_MINMTU) 228 flags |= IPV6_MINMTU; 229 230 udpstat_inc(udps_opackets); 231 232 /* force routing table */ 233 m->m_pkthdr.ph_rtableid = in6p->inp_rtableid; 234 235 #if NPF > 0 236 if (in6p->inp_socket->so_state & SS_ISCONNECTED) 237 m->m_pkthdr.pf.inp = in6p; 238 #endif 239 240 error = ip6_output(m, optp, &in6p->inp_route6, 241 flags, in6p->inp_moptions6, in6p); 242 goto releaseopt; 243 244 release: 245 m_freem(m); 246 247 releaseopt: 248 if (control) { 249 ip6_clearpktopts(&opt, -1); 250 m_freem(control); 251 } 252 return (error); 253 } 254