ip_output.c revision 1.60 1 1.60 mrg /* $NetBSD: ip_output.c,v 1.60 1999/06/07 01:26:04 mrg Exp $ */
2 1.54 thorpej
3 1.54 thorpej /*-
4 1.54 thorpej * Copyright (c) 1998 The NetBSD Foundation, Inc.
5 1.54 thorpej * All rights reserved.
6 1.54 thorpej *
7 1.54 thorpej * This code is derived from software contributed to The NetBSD Foundation
8 1.54 thorpej * by Public Access Networks Corporation ("Panix"). It was developed under
9 1.54 thorpej * contract to Panix by Eric Haszlakiewicz and Thor Lancelot Simon.
10 1.54 thorpej *
11 1.54 thorpej * Redistribution and use in source and binary forms, with or without
12 1.54 thorpej * modification, are permitted provided that the following conditions
13 1.54 thorpej * are met:
14 1.54 thorpej * 1. Redistributions of source code must retain the above copyright
15 1.54 thorpej * notice, this list of conditions and the following disclaimer.
16 1.54 thorpej * 2. Redistributions in binary form must reproduce the above copyright
17 1.54 thorpej * notice, this list of conditions and the following disclaimer in the
18 1.54 thorpej * documentation and/or other materials provided with the distribution.
19 1.54 thorpej * 3. All advertising materials mentioning features or use of this software
20 1.54 thorpej * must display the following acknowledgement:
21 1.54 thorpej * This product includes software developed by the NetBSD
22 1.54 thorpej * Foundation, Inc. and its contributors.
23 1.54 thorpej * 4. Neither the name of The NetBSD Foundation nor the names of its
24 1.54 thorpej * contributors may be used to endorse or promote products derived
25 1.54 thorpej * from this software without specific prior written permission.
26 1.54 thorpej *
27 1.54 thorpej * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
28 1.54 thorpej * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
29 1.54 thorpej * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
30 1.54 thorpej * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
31 1.54 thorpej * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
32 1.54 thorpej * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
33 1.54 thorpej * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
34 1.54 thorpej * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
35 1.54 thorpej * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
36 1.54 thorpej * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
37 1.54 thorpej * POSSIBILITY OF SUCH DAMAGE.
38 1.54 thorpej */
39 1.19 cgd
40 1.1 cgd /*
41 1.18 mycroft * Copyright (c) 1982, 1986, 1988, 1990, 1993
42 1.18 mycroft * The Regents of the University of California. All rights reserved.
43 1.1 cgd *
44 1.1 cgd * Redistribution and use in source and binary forms, with or without
45 1.1 cgd * modification, are permitted provided that the following conditions
46 1.1 cgd * are met:
47 1.1 cgd * 1. Redistributions of source code must retain the above copyright
48 1.1 cgd * notice, this list of conditions and the following disclaimer.
49 1.1 cgd * 2. Redistributions in binary form must reproduce the above copyright
50 1.1 cgd * notice, this list of conditions and the following disclaimer in the
51 1.1 cgd * documentation and/or other materials provided with the distribution.
52 1.1 cgd * 3. All advertising materials mentioning features or use of this software
53 1.1 cgd * must display the following acknowledgement:
54 1.1 cgd * This product includes software developed by the University of
55 1.1 cgd * California, Berkeley and its contributors.
56 1.1 cgd * 4. Neither the name of the University nor the names of its contributors
57 1.1 cgd * may be used to endorse or promote products derived from this software
58 1.1 cgd * without specific prior written permission.
59 1.1 cgd *
60 1.1 cgd * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
61 1.1 cgd * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
62 1.1 cgd * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
63 1.1 cgd * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
64 1.1 cgd * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
65 1.1 cgd * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
66 1.1 cgd * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
67 1.1 cgd * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
68 1.1 cgd * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
69 1.1 cgd * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
70 1.1 cgd * SUCH DAMAGE.
71 1.1 cgd *
72 1.19 cgd * @(#)ip_output.c 8.3 (Berkeley) 1/21/94
73 1.1 cgd */
74 1.42 scottr
75 1.50 mrg #include "opt_pfil_hooks.h"
76 1.42 scottr #include "opt_mrouting.h"
77 1.1 cgd
78 1.8 mycroft #include <sys/param.h>
79 1.8 mycroft #include <sys/malloc.h>
80 1.8 mycroft #include <sys/mbuf.h>
81 1.8 mycroft #include <sys/errno.h>
82 1.8 mycroft #include <sys/protosw.h>
83 1.8 mycroft #include <sys/socket.h>
84 1.8 mycroft #include <sys/socketvar.h>
85 1.28 christos #include <sys/systm.h>
86 1.1 cgd
87 1.8 mycroft #include <net/if.h>
88 1.8 mycroft #include <net/route.h>
89 1.38 mrg #include <net/pfil.h>
90 1.1 cgd
91 1.8 mycroft #include <netinet/in.h>
92 1.8 mycroft #include <netinet/in_systm.h>
93 1.8 mycroft #include <netinet/ip.h>
94 1.8 mycroft #include <netinet/in_pcb.h>
95 1.8 mycroft #include <netinet/in_var.h>
96 1.8 mycroft #include <netinet/ip_var.h>
97 1.32 mrg
98 1.52 matt #ifdef __vax__
99 1.8 mycroft #include <machine/mtpr.h>
100 1.1 cgd #endif
101 1.1 cgd
102 1.28 christos #include <machine/stdarg.h>
103 1.28 christos
104 1.12 mycroft static struct mbuf *ip_insertoptions __P((struct mbuf *, struct mbuf *, int *));
105 1.12 mycroft static void ip_mloopback
106 1.18 mycroft __P((struct ifnet *, struct mbuf *, struct sockaddr_in *));
107 1.1 cgd
108 1.1 cgd /*
109 1.1 cgd * IP output. The packet in mbuf chain m contains a skeletal IP
110 1.1 cgd * header (with len, off, ttl, proto, tos, src, dst).
111 1.1 cgd * The mbuf chain containing the packet will be freed.
112 1.1 cgd * The mbuf opt, if present, will not be freed.
113 1.1 cgd */
114 1.12 mycroft int
115 1.28 christos #if __STDC__
116 1.28 christos ip_output(struct mbuf *m0, ...)
117 1.28 christos #else
118 1.28 christos ip_output(m0, va_alist)
119 1.1 cgd struct mbuf *m0;
120 1.28 christos va_dcl
121 1.28 christos #endif
122 1.1 cgd {
123 1.1 cgd register struct ip *ip, *mhip;
124 1.1 cgd register struct ifnet *ifp;
125 1.1 cgd register struct mbuf *m = m0;
126 1.1 cgd register int hlen = sizeof (struct ip);
127 1.1 cgd int len, off, error = 0;
128 1.1 cgd struct route iproute;
129 1.1 cgd struct sockaddr_in *dst;
130 1.58 aidan #if IFA_STATS
131 1.58 aidan struct sockaddr_in src;
132 1.58 aidan #endif
133 1.1 cgd struct in_ifaddr *ia;
134 1.28 christos struct mbuf *opt;
135 1.28 christos struct route *ro;
136 1.28 christos int flags;
137 1.40 matt int *mtu_p;
138 1.48 matt int mtu;
139 1.28 christos struct ip_moptions *imo;
140 1.28 christos va_list ap;
141 1.32 mrg #ifdef PFIL_HOOKS
142 1.30 mrg struct packet_filter_hook *pfh;
143 1.30 mrg struct mbuf *m1;
144 1.36 mrg int rv;
145 1.32 mrg #endif /* PFIL_HOOKS */
146 1.28 christos
147 1.28 christos va_start(ap, m0);
148 1.28 christos opt = va_arg(ap, struct mbuf *);
149 1.28 christos ro = va_arg(ap, struct route *);
150 1.28 christos flags = va_arg(ap, int);
151 1.28 christos imo = va_arg(ap, struct ip_moptions *);
152 1.40 matt if (flags & IP_RETURNMTU)
153 1.40 matt mtu_p = va_arg(ap, int *);
154 1.40 matt else
155 1.40 matt mtu_p = NULL;
156 1.28 christos va_end(ap);
157 1.28 christos
158 1.1 cgd #ifdef DIAGNOSTIC
159 1.1 cgd if ((m->m_flags & M_PKTHDR) == 0)
160 1.1 cgd panic("ip_output no HDR");
161 1.1 cgd #endif
162 1.1 cgd if (opt) {
163 1.1 cgd m = ip_insertoptions(m, opt, &len);
164 1.1 cgd hlen = len;
165 1.1 cgd }
166 1.1 cgd ip = mtod(m, struct ip *);
167 1.1 cgd /*
168 1.1 cgd * Fill in IP header.
169 1.1 cgd */
170 1.18 mycroft if ((flags & (IP_FORWARDING|IP_RAWOUTPUT)) == 0) {
171 1.1 cgd ip->ip_v = IPVERSION;
172 1.1 cgd ip->ip_off &= IP_DF;
173 1.1 cgd ip->ip_id = htons(ip_id++);
174 1.1 cgd ip->ip_hl = hlen >> 2;
175 1.18 mycroft ipstat.ips_localout++;
176 1.1 cgd } else {
177 1.1 cgd hlen = ip->ip_hl << 2;
178 1.1 cgd }
179 1.1 cgd /*
180 1.1 cgd * Route packet.
181 1.1 cgd */
182 1.1 cgd if (ro == 0) {
183 1.1 cgd ro = &iproute;
184 1.1 cgd bzero((caddr_t)ro, sizeof (*ro));
185 1.1 cgd }
186 1.24 mycroft dst = satosin(&ro->ro_dst);
187 1.1 cgd /*
188 1.1 cgd * If there is a cached route,
189 1.1 cgd * check that it is to the same destination
190 1.1 cgd * and is still up. If not, free it and try again.
191 1.1 cgd */
192 1.1 cgd if (ro->ro_rt && ((ro->ro_rt->rt_flags & RTF_UP) == 0 ||
193 1.31 mycroft !in_hosteq(dst->sin_addr, ip->ip_dst))) {
194 1.1 cgd RTFREE(ro->ro_rt);
195 1.1 cgd ro->ro_rt = (struct rtentry *)0;
196 1.1 cgd }
197 1.1 cgd if (ro->ro_rt == 0) {
198 1.1 cgd dst->sin_family = AF_INET;
199 1.1 cgd dst->sin_len = sizeof(*dst);
200 1.1 cgd dst->sin_addr = ip->ip_dst;
201 1.1 cgd }
202 1.1 cgd /*
203 1.1 cgd * If routing to interface only,
204 1.1 cgd * short circuit routing lookup.
205 1.1 cgd */
206 1.1 cgd if (flags & IP_ROUTETOIF) {
207 1.29 mrg if ((ia = ifatoia(ifa_ifwithladdr(sintosa(dst)))) == 0) {
208 1.18 mycroft ipstat.ips_noroute++;
209 1.1 cgd error = ENETUNREACH;
210 1.1 cgd goto bad;
211 1.1 cgd }
212 1.1 cgd ifp = ia->ia_ifp;
213 1.48 matt mtu = ifp->if_mtu;
214 1.18 mycroft ip->ip_ttl = 1;
215 1.1 cgd } else {
216 1.1 cgd if (ro->ro_rt == 0)
217 1.1 cgd rtalloc(ro);
218 1.1 cgd if (ro->ro_rt == 0) {
219 1.18 mycroft ipstat.ips_noroute++;
220 1.1 cgd error = EHOSTUNREACH;
221 1.1 cgd goto bad;
222 1.1 cgd }
223 1.18 mycroft ia = ifatoia(ro->ro_rt->rt_ifa);
224 1.1 cgd ifp = ro->ro_rt->rt_ifp;
225 1.48 matt if ((mtu = ro->ro_rt->rt_rmx.rmx_mtu) == 0)
226 1.48 matt mtu = ifp->if_mtu;
227 1.1 cgd ro->ro_rt->rt_use++;
228 1.1 cgd if (ro->ro_rt->rt_flags & RTF_GATEWAY)
229 1.24 mycroft dst = satosin(ro->ro_rt->rt_gateway);
230 1.1 cgd }
231 1.23 mycroft if (IN_MULTICAST(ip->ip_dst.s_addr)) {
232 1.5 hpeyerl struct in_multi *inm;
233 1.5 hpeyerl
234 1.5 hpeyerl m->m_flags |= M_MCAST;
235 1.5 hpeyerl /*
236 1.5 hpeyerl * IP destination address is multicast. Make sure "dst"
237 1.5 hpeyerl * still points to the address in "ro". (It may have been
238 1.5 hpeyerl * changed to point to a gateway address, above.)
239 1.5 hpeyerl */
240 1.24 mycroft dst = satosin(&ro->ro_dst);
241 1.5 hpeyerl /*
242 1.5 hpeyerl * See if the caller provided any multicast options
243 1.5 hpeyerl */
244 1.13 mycroft if (imo != NULL) {
245 1.5 hpeyerl ip->ip_ttl = imo->imo_multicast_ttl;
246 1.48 matt if (imo->imo_multicast_ifp != NULL) {
247 1.5 hpeyerl ifp = imo->imo_multicast_ifp;
248 1.48 matt mtu = ifp->if_mtu;
249 1.48 matt }
250 1.18 mycroft } else
251 1.5 hpeyerl ip->ip_ttl = IP_DEFAULT_MULTICAST_TTL;
252 1.5 hpeyerl /*
253 1.5 hpeyerl * Confirm that the outgoing interface supports multicast.
254 1.5 hpeyerl */
255 1.5 hpeyerl if ((ifp->if_flags & IFF_MULTICAST) == 0) {
256 1.18 mycroft ipstat.ips_noroute++;
257 1.5 hpeyerl error = ENETUNREACH;
258 1.5 hpeyerl goto bad;
259 1.5 hpeyerl }
260 1.5 hpeyerl /*
261 1.44 tls * If source address not specified yet, use an address
262 1.5 hpeyerl * of outgoing interface.
263 1.5 hpeyerl */
264 1.31 mycroft if (in_nullhost(ip->ip_src)) {
265 1.5 hpeyerl register struct in_ifaddr *ia;
266 1.5 hpeyerl
267 1.44 tls IFP_TO_IA(ifp, ia);
268 1.44 tls ip->ip_src = ia->ia_addr.sin_addr;
269 1.5 hpeyerl }
270 1.5 hpeyerl
271 1.5 hpeyerl IN_LOOKUP_MULTI(ip->ip_dst, ifp, inm);
272 1.5 hpeyerl if (inm != NULL &&
273 1.5 hpeyerl (imo == NULL || imo->imo_multicast_loop)) {
274 1.5 hpeyerl /*
275 1.11 mycroft * If we belong to the destination multicast group
276 1.5 hpeyerl * on the outgoing interface, and the caller did not
277 1.5 hpeyerl * forbid loopback, loop back a copy.
278 1.5 hpeyerl */
279 1.5 hpeyerl ip_mloopback(ifp, m, dst);
280 1.5 hpeyerl }
281 1.5 hpeyerl #ifdef MROUTING
282 1.18 mycroft else {
283 1.5 hpeyerl /*
284 1.5 hpeyerl * If we are acting as a multicast router, perform
285 1.5 hpeyerl * multicast forwarding as if the packet had just
286 1.5 hpeyerl * arrived on the interface to which we are about
287 1.5 hpeyerl * to send. The multicast forwarding function
288 1.5 hpeyerl * recursively calls this function, using the
289 1.5 hpeyerl * IP_FORWARDING flag to prevent infinite recursion.
290 1.5 hpeyerl *
291 1.5 hpeyerl * Multicasts that are looped back by ip_mloopback(),
292 1.5 hpeyerl * above, will be forwarded by the ip_input() routine,
293 1.5 hpeyerl * if necessary.
294 1.5 hpeyerl */
295 1.18 mycroft extern struct socket *ip_mrouter;
296 1.22 cgd
297 1.18 mycroft if (ip_mrouter && (flags & IP_FORWARDING) == 0) {
298 1.18 mycroft if (ip_mforward(m, ifp) != 0) {
299 1.18 mycroft m_freem(m);
300 1.18 mycroft goto done;
301 1.18 mycroft }
302 1.5 hpeyerl }
303 1.5 hpeyerl }
304 1.5 hpeyerl #endif
305 1.5 hpeyerl /*
306 1.5 hpeyerl * Multicasts with a time-to-live of zero may be looped-
307 1.5 hpeyerl * back, above, but must not be transmitted on a network.
308 1.5 hpeyerl * Also, multicasts addressed to the loopback interface
309 1.5 hpeyerl * are not sent -- the above call to ip_mloopback() will
310 1.5 hpeyerl * loop back a copy if this host actually belongs to the
311 1.5 hpeyerl * destination group on the loopback interface.
312 1.5 hpeyerl */
313 1.20 mycroft if (ip->ip_ttl == 0 || (ifp->if_flags & IFF_LOOPBACK) != 0) {
314 1.5 hpeyerl m_freem(m);
315 1.5 hpeyerl goto done;
316 1.5 hpeyerl }
317 1.5 hpeyerl
318 1.5 hpeyerl goto sendit;
319 1.5 hpeyerl }
320 1.1 cgd #ifndef notdef
321 1.1 cgd /*
322 1.1 cgd * If source address not specified yet, use address
323 1.1 cgd * of outgoing interface.
324 1.1 cgd */
325 1.31 mycroft if (in_nullhost(ip->ip_src))
326 1.25 mycroft ip->ip_src = ia->ia_addr.sin_addr;
327 1.1 cgd #endif
328 1.59 hwr
329 1.59 hwr /*
330 1.59 hwr * packets with Class-D address as source are not valid per
331 1.59 hwr * RFC 1112
332 1.59 hwr */
333 1.59 hwr if (IN_MULTICAST(ip->ip_src.s_addr)) {
334 1.59 hwr ipstat.ips_odropped++;
335 1.59 hwr error = EADDRNOTAVAIL;
336 1.59 hwr goto bad;
337 1.59 hwr }
338 1.59 hwr
339 1.1 cgd /*
340 1.1 cgd * Look for broadcast address and
341 1.1 cgd * and verify user is allowed to send
342 1.1 cgd * such a packet.
343 1.1 cgd */
344 1.18 mycroft if (in_broadcast(dst->sin_addr, ifp)) {
345 1.1 cgd if ((ifp->if_flags & IFF_BROADCAST) == 0) {
346 1.1 cgd error = EADDRNOTAVAIL;
347 1.1 cgd goto bad;
348 1.1 cgd }
349 1.1 cgd if ((flags & IP_ALLOWBROADCAST) == 0) {
350 1.1 cgd error = EACCES;
351 1.1 cgd goto bad;
352 1.1 cgd }
353 1.1 cgd /* don't allow broadcast messages to be fragmented */
354 1.21 cgd if ((u_int16_t)ip->ip_len > ifp->if_mtu) {
355 1.1 cgd error = EMSGSIZE;
356 1.1 cgd goto bad;
357 1.1 cgd }
358 1.1 cgd m->m_flags |= M_BCAST;
359 1.18 mycroft } else
360 1.18 mycroft m->m_flags &= ~M_BCAST;
361 1.18 mycroft
362 1.60 mrg sendit:
363 1.32 mrg #ifdef PFIL_HOOKS
364 1.30 mrg /*
365 1.30 mrg * Run through list of hooks for output packets.
366 1.30 mrg */
367 1.30 mrg m1 = m;
368 1.46 mrg for (pfh = pfil_hook_get(PFIL_OUT); pfh; pfh = pfh->pfil_link.tqe_next)
369 1.30 mrg if (pfh->pfil_func) {
370 1.36 mrg rv = pfh->pfil_func(ip, hlen, ifp, 1, &m1);
371 1.36 mrg if (rv) {
372 1.30 mrg error = EHOSTUNREACH;
373 1.34 veego goto done;
374 1.30 mrg }
375 1.49 sommerfe m = m1;
376 1.49 sommerfe if (m == NULL)
377 1.49 sommerfe goto done;
378 1.49 sommerfe ip = mtod(m, struct ip *);
379 1.30 mrg }
380 1.32 mrg #endif /* PFIL_HOOKS */
381 1.1 cgd /*
382 1.48 matt * If small enough for mtu of path, can just send directly.
383 1.1 cgd */
384 1.48 matt if ((u_int16_t)ip->ip_len <= mtu) {
385 1.55 thorpej HTONS(ip->ip_len);
386 1.55 thorpej HTONS(ip->ip_off);
387 1.1 cgd ip->ip_sum = 0;
388 1.1 cgd ip->ip_sum = in_cksum(m, hlen);
389 1.24 mycroft error = (*ifp->if_output)(ifp, m, sintosa(dst), ro->ro_rt);
390 1.1 cgd goto done;
391 1.1 cgd }
392 1.1 cgd /*
393 1.1 cgd * Too large for interface; fragment if possible.
394 1.1 cgd * Must be able to put at least 8 bytes per fragment.
395 1.1 cgd */
396 1.1 cgd if (ip->ip_off & IP_DF) {
397 1.40 matt if (flags & IP_RETURNMTU)
398 1.48 matt *mtu_p = mtu;
399 1.1 cgd error = EMSGSIZE;
400 1.18 mycroft ipstat.ips_cantfrag++;
401 1.1 cgd goto bad;
402 1.1 cgd }
403 1.48 matt len = (mtu - hlen) &~ 7;
404 1.1 cgd if (len < 8) {
405 1.1 cgd error = EMSGSIZE;
406 1.1 cgd goto bad;
407 1.1 cgd }
408 1.1 cgd
409 1.1 cgd {
410 1.1 cgd int mhlen, firstlen = len;
411 1.1 cgd struct mbuf **mnext = &m->m_nextpkt;
412 1.48 matt int fragments = 0;
413 1.48 matt int s;
414 1.1 cgd
415 1.1 cgd /*
416 1.1 cgd * Loop through length of segment after first fragment,
417 1.1 cgd * make new header and copy data of each part and link onto chain.
418 1.1 cgd */
419 1.1 cgd m0 = m;
420 1.1 cgd mhlen = sizeof (struct ip);
421 1.21 cgd for (off = hlen + len; off < (u_int16_t)ip->ip_len; off += len) {
422 1.1 cgd MGETHDR(m, M_DONTWAIT, MT_HEADER);
423 1.1 cgd if (m == 0) {
424 1.1 cgd error = ENOBUFS;
425 1.18 mycroft ipstat.ips_odropped++;
426 1.1 cgd goto sendorfree;
427 1.1 cgd }
428 1.22 cgd *mnext = m;
429 1.22 cgd mnext = &m->m_nextpkt;
430 1.1 cgd m->m_data += max_linkhdr;
431 1.1 cgd mhip = mtod(m, struct ip *);
432 1.1 cgd *mhip = *ip;
433 1.1 cgd if (hlen > sizeof (struct ip)) {
434 1.1 cgd mhlen = ip_optcopy(ip, mhip) + sizeof (struct ip);
435 1.1 cgd mhip->ip_hl = mhlen >> 2;
436 1.1 cgd }
437 1.1 cgd m->m_len = mhlen;
438 1.1 cgd mhip->ip_off = ((off - hlen) >> 3) + (ip->ip_off & ~IP_MF);
439 1.1 cgd if (ip->ip_off & IP_MF)
440 1.1 cgd mhip->ip_off |= IP_MF;
441 1.21 cgd if (off + len >= (u_int16_t)ip->ip_len)
442 1.21 cgd len = (u_int16_t)ip->ip_len - off;
443 1.1 cgd else
444 1.1 cgd mhip->ip_off |= IP_MF;
445 1.21 cgd mhip->ip_len = htons((u_int16_t)(len + mhlen));
446 1.1 cgd m->m_next = m_copy(m0, off, len);
447 1.1 cgd if (m->m_next == 0) {
448 1.1 cgd error = ENOBUFS; /* ??? */
449 1.18 mycroft ipstat.ips_odropped++;
450 1.1 cgd goto sendorfree;
451 1.1 cgd }
452 1.1 cgd m->m_pkthdr.len = mhlen + len;
453 1.1 cgd m->m_pkthdr.rcvif = (struct ifnet *)0;
454 1.55 thorpej HTONS(mhip->ip_off);
455 1.1 cgd mhip->ip_sum = 0;
456 1.1 cgd mhip->ip_sum = in_cksum(m, mhlen);
457 1.1 cgd ipstat.ips_ofragments++;
458 1.48 matt fragments++;
459 1.1 cgd }
460 1.1 cgd /*
461 1.1 cgd * Update first fragment by trimming what's been copied out
462 1.1 cgd * and updating header, then send each fragment (in order).
463 1.1 cgd */
464 1.1 cgd m = m0;
465 1.21 cgd m_adj(m, hlen + firstlen - (u_int16_t)ip->ip_len);
466 1.1 cgd m->m_pkthdr.len = hlen + firstlen;
467 1.21 cgd ip->ip_len = htons((u_int16_t)m->m_pkthdr.len);
468 1.55 thorpej ip->ip_off |= IP_MF;
469 1.55 thorpej HTONS(ip->ip_off);
470 1.1 cgd ip->ip_sum = 0;
471 1.1 cgd ip->ip_sum = in_cksum(m, hlen);
472 1.1 cgd sendorfree:
473 1.48 matt /*
474 1.48 matt * If there is no room for all the fragments, don't queue
475 1.48 matt * any of them.
476 1.48 matt */
477 1.48 matt s = splimp();
478 1.48 matt if (ifp->if_snd.ifq_maxlen - ifp->if_snd.ifq_len < fragments)
479 1.48 matt error = ENOBUFS;
480 1.48 matt splx(s);
481 1.1 cgd for (m = m0; m; m = m0) {
482 1.1 cgd m0 = m->m_nextpkt;
483 1.1 cgd m->m_nextpkt = 0;
484 1.1 cgd if (error == 0)
485 1.24 mycroft error = (*ifp->if_output)(ifp, m, sintosa(dst),
486 1.24 mycroft ro->ro_rt);
487 1.1 cgd else
488 1.1 cgd m_freem(m);
489 1.1 cgd }
490 1.18 mycroft
491 1.18 mycroft if (error == 0)
492 1.18 mycroft ipstat.ips_fragmented++;
493 1.1 cgd }
494 1.1 cgd done:
495 1.31 mycroft if (ro == &iproute && (flags & IP_ROUTETOIF) == 0 && ro->ro_rt) {
496 1.1 cgd RTFREE(ro->ro_rt);
497 1.31 mycroft ro->ro_rt = 0;
498 1.31 mycroft }
499 1.58 aidan #if IFA_STATS
500 1.58 aidan if (error == 0) {
501 1.58 aidan /* search for the source address structure to maintain output
502 1.58 aidan * statistics. */
503 1.58 aidan bzero((caddr_t*) &src, sizeof(src));
504 1.58 aidan src.sin_family = AF_INET;
505 1.58 aidan src.sin_addr.s_addr = ip->ip_src.s_addr;
506 1.58 aidan src.sin_len = sizeof(src);
507 1.58 aidan ia = ifatoia(ifa_ifwithladdr(sintosa(&src)));
508 1.58 aidan if (ia)
509 1.58 aidan ia->ia_ifa.ifa_data.ifad_outbytes += ntohs(ip->ip_len);
510 1.58 aidan }
511 1.58 aidan #endif
512 1.1 cgd return (error);
513 1.1 cgd bad:
514 1.33 is m_freem(m);
515 1.1 cgd goto done;
516 1.1 cgd }
517 1.47 kml
518 1.47 kml /*
519 1.47 kml * Determine the maximum length of the options to be inserted;
520 1.47 kml * we would far rather allocate too much space rather than too little.
521 1.47 kml */
522 1.47 kml
523 1.47 kml u_int
524 1.47 kml ip_optlen(inp)
525 1.47 kml struct inpcb *inp;
526 1.47 kml {
527 1.47 kml struct mbuf *m = inp->inp_options;
528 1.47 kml
529 1.47 kml if (m && m->m_len > offsetof(struct ipoption, ipopt_dst))
530 1.47 kml return(m->m_len - offsetof(struct ipoption, ipopt_dst));
531 1.47 kml else
532 1.47 kml return 0;
533 1.47 kml }
534 1.47 kml
535 1.1 cgd
536 1.1 cgd /*
537 1.1 cgd * Insert IP options into preformed packet.
538 1.1 cgd * Adjust IP destination as required for IP source routing,
539 1.1 cgd * as indicated by a non-zero in_addr at the start of the options.
540 1.1 cgd */
541 1.12 mycroft static struct mbuf *
542 1.1 cgd ip_insertoptions(m, opt, phlen)
543 1.1 cgd register struct mbuf *m;
544 1.1 cgd struct mbuf *opt;
545 1.1 cgd int *phlen;
546 1.1 cgd {
547 1.1 cgd register struct ipoption *p = mtod(opt, struct ipoption *);
548 1.1 cgd struct mbuf *n;
549 1.1 cgd register struct ip *ip = mtod(m, struct ip *);
550 1.1 cgd unsigned optlen;
551 1.1 cgd
552 1.1 cgd optlen = opt->m_len - sizeof(p->ipopt_dst);
553 1.21 cgd if (optlen + (u_int16_t)ip->ip_len > IP_MAXPACKET)
554 1.1 cgd return (m); /* XXX should fail */
555 1.31 mycroft if (!in_nullhost(p->ipopt_dst))
556 1.1 cgd ip->ip_dst = p->ipopt_dst;
557 1.1 cgd if (m->m_flags & M_EXT || m->m_data - optlen < m->m_pktdat) {
558 1.1 cgd MGETHDR(n, M_DONTWAIT, MT_HEADER);
559 1.1 cgd if (n == 0)
560 1.1 cgd return (m);
561 1.1 cgd n->m_pkthdr.len = m->m_pkthdr.len + optlen;
562 1.1 cgd m->m_len -= sizeof(struct ip);
563 1.1 cgd m->m_data += sizeof(struct ip);
564 1.1 cgd n->m_next = m;
565 1.1 cgd m = n;
566 1.1 cgd m->m_len = optlen + sizeof(struct ip);
567 1.1 cgd m->m_data += max_linkhdr;
568 1.1 cgd bcopy((caddr_t)ip, mtod(m, caddr_t), sizeof(struct ip));
569 1.1 cgd } else {
570 1.1 cgd m->m_data -= optlen;
571 1.1 cgd m->m_len += optlen;
572 1.1 cgd m->m_pkthdr.len += optlen;
573 1.57 perry memmove(mtod(m, caddr_t), ip, sizeof(struct ip));
574 1.1 cgd }
575 1.1 cgd ip = mtod(m, struct ip *);
576 1.1 cgd bcopy((caddr_t)p->ipopt_list, (caddr_t)(ip + 1), (unsigned)optlen);
577 1.1 cgd *phlen = sizeof(struct ip) + optlen;
578 1.1 cgd ip->ip_len += optlen;
579 1.1 cgd return (m);
580 1.1 cgd }
581 1.1 cgd
582 1.1 cgd /*
583 1.1 cgd * Copy options from ip to jp,
584 1.1 cgd * omitting those not copied during fragmentation.
585 1.1 cgd */
586 1.12 mycroft int
587 1.1 cgd ip_optcopy(ip, jp)
588 1.1 cgd struct ip *ip, *jp;
589 1.1 cgd {
590 1.1 cgd register u_char *cp, *dp;
591 1.1 cgd int opt, optlen, cnt;
592 1.1 cgd
593 1.1 cgd cp = (u_char *)(ip + 1);
594 1.1 cgd dp = (u_char *)(jp + 1);
595 1.1 cgd cnt = (ip->ip_hl << 2) - sizeof (struct ip);
596 1.1 cgd for (; cnt > 0; cnt -= optlen, cp += optlen) {
597 1.1 cgd opt = cp[0];
598 1.1 cgd if (opt == IPOPT_EOL)
599 1.1 cgd break;
600 1.18 mycroft if (opt == IPOPT_NOP) {
601 1.18 mycroft /* Preserve for IP mcast tunnel's LSRR alignment. */
602 1.18 mycroft *dp++ = IPOPT_NOP;
603 1.1 cgd optlen = 1;
604 1.18 mycroft continue;
605 1.18 mycroft } else
606 1.1 cgd optlen = cp[IPOPT_OLEN];
607 1.1 cgd /* bogus lengths should have been caught by ip_dooptions */
608 1.1 cgd if (optlen > cnt)
609 1.1 cgd optlen = cnt;
610 1.1 cgd if (IPOPT_COPIED(opt)) {
611 1.1 cgd bcopy((caddr_t)cp, (caddr_t)dp, (unsigned)optlen);
612 1.1 cgd dp += optlen;
613 1.1 cgd }
614 1.1 cgd }
615 1.1 cgd for (optlen = dp - (u_char *)(jp+1); optlen & 0x3; optlen++)
616 1.1 cgd *dp++ = IPOPT_EOL;
617 1.1 cgd return (optlen);
618 1.1 cgd }
619 1.1 cgd
620 1.1 cgd /*
621 1.1 cgd * IP socket option processing.
622 1.1 cgd */
623 1.12 mycroft int
624 1.1 cgd ip_ctloutput(op, so, level, optname, mp)
625 1.1 cgd int op;
626 1.1 cgd struct socket *so;
627 1.1 cgd int level, optname;
628 1.1 cgd struct mbuf **mp;
629 1.1 cgd {
630 1.1 cgd register struct inpcb *inp = sotoinpcb(so);
631 1.16 brezak register struct mbuf *m = *mp;
632 1.28 christos register int optval = 0;
633 1.1 cgd int error = 0;
634 1.1 cgd
635 1.18 mycroft if (level != IPPROTO_IP) {
636 1.1 cgd error = EINVAL;
637 1.18 mycroft if (op == PRCO_SETOPT && *mp)
638 1.18 mycroft (void) m_free(*mp);
639 1.18 mycroft } else switch (op) {
640 1.1 cgd
641 1.1 cgd case PRCO_SETOPT:
642 1.1 cgd switch (optname) {
643 1.1 cgd case IP_OPTIONS:
644 1.1 cgd #ifdef notyet
645 1.1 cgd case IP_RETOPTS:
646 1.1 cgd return (ip_pcbopts(optname, &inp->inp_options, m));
647 1.1 cgd #else
648 1.1 cgd return (ip_pcbopts(&inp->inp_options, m));
649 1.1 cgd #endif
650 1.1 cgd
651 1.1 cgd case IP_TOS:
652 1.1 cgd case IP_TTL:
653 1.1 cgd case IP_RECVOPTS:
654 1.1 cgd case IP_RECVRETOPTS:
655 1.1 cgd case IP_RECVDSTADDR:
656 1.37 thorpej case IP_RECVIF:
657 1.27 cgd if (m == NULL || m->m_len != sizeof(int))
658 1.1 cgd error = EINVAL;
659 1.1 cgd else {
660 1.1 cgd optval = *mtod(m, int *);
661 1.1 cgd switch (optname) {
662 1.1 cgd
663 1.1 cgd case IP_TOS:
664 1.1 cgd inp->inp_ip.ip_tos = optval;
665 1.1 cgd break;
666 1.1 cgd
667 1.1 cgd case IP_TTL:
668 1.1 cgd inp->inp_ip.ip_ttl = optval;
669 1.1 cgd break;
670 1.1 cgd #define OPTSET(bit) \
671 1.1 cgd if (optval) \
672 1.1 cgd inp->inp_flags |= bit; \
673 1.1 cgd else \
674 1.1 cgd inp->inp_flags &= ~bit;
675 1.1 cgd
676 1.1 cgd case IP_RECVOPTS:
677 1.1 cgd OPTSET(INP_RECVOPTS);
678 1.1 cgd break;
679 1.1 cgd
680 1.1 cgd case IP_RECVRETOPTS:
681 1.1 cgd OPTSET(INP_RECVRETOPTS);
682 1.1 cgd break;
683 1.1 cgd
684 1.1 cgd case IP_RECVDSTADDR:
685 1.1 cgd OPTSET(INP_RECVDSTADDR);
686 1.1 cgd break;
687 1.37 thorpej
688 1.37 thorpej case IP_RECVIF:
689 1.37 thorpej OPTSET(INP_RECVIF);
690 1.37 thorpej break;
691 1.1 cgd }
692 1.1 cgd }
693 1.1 cgd break;
694 1.1 cgd #undef OPTSET
695 1.18 mycroft
696 1.18 mycroft case IP_MULTICAST_IF:
697 1.18 mycroft case IP_MULTICAST_TTL:
698 1.18 mycroft case IP_MULTICAST_LOOP:
699 1.18 mycroft case IP_ADD_MEMBERSHIP:
700 1.18 mycroft case IP_DROP_MEMBERSHIP:
701 1.18 mycroft error = ip_setmoptions(optname, &inp->inp_moptions, m);
702 1.18 mycroft break;
703 1.1 cgd
704 1.41 lukem case IP_PORTRANGE:
705 1.41 lukem if (m == 0 || m->m_len != sizeof(int))
706 1.41 lukem error = EINVAL;
707 1.41 lukem else {
708 1.41 lukem optval = *mtod(m, int *);
709 1.41 lukem
710 1.41 lukem switch (optval) {
711 1.41 lukem
712 1.41 lukem case IP_PORTRANGE_DEFAULT:
713 1.41 lukem case IP_PORTRANGE_HIGH:
714 1.41 lukem inp->inp_flags &= ~(INP_LOWPORT);
715 1.41 lukem break;
716 1.41 lukem
717 1.41 lukem case IP_PORTRANGE_LOW:
718 1.41 lukem inp->inp_flags |= INP_LOWPORT;
719 1.41 lukem break;
720 1.41 lukem
721 1.41 lukem default:
722 1.41 lukem error = EINVAL;
723 1.41 lukem break;
724 1.41 lukem }
725 1.41 lukem }
726 1.41 lukem break;
727 1.41 lukem
728 1.1 cgd default:
729 1.18 mycroft error = ENOPROTOOPT;
730 1.1 cgd break;
731 1.1 cgd }
732 1.1 cgd if (m)
733 1.1 cgd (void)m_free(m);
734 1.1 cgd break;
735 1.1 cgd
736 1.1 cgd case PRCO_GETOPT:
737 1.1 cgd switch (optname) {
738 1.1 cgd case IP_OPTIONS:
739 1.1 cgd case IP_RETOPTS:
740 1.1 cgd *mp = m = m_get(M_WAIT, MT_SOOPTS);
741 1.1 cgd if (inp->inp_options) {
742 1.1 cgd m->m_len = inp->inp_options->m_len;
743 1.1 cgd bcopy(mtod(inp->inp_options, caddr_t),
744 1.1 cgd mtod(m, caddr_t), (unsigned)m->m_len);
745 1.1 cgd } else
746 1.1 cgd m->m_len = 0;
747 1.1 cgd break;
748 1.1 cgd
749 1.1 cgd case IP_TOS:
750 1.1 cgd case IP_TTL:
751 1.1 cgd case IP_RECVOPTS:
752 1.1 cgd case IP_RECVRETOPTS:
753 1.1 cgd case IP_RECVDSTADDR:
754 1.37 thorpej case IP_RECVIF:
755 1.40 matt case IP_ERRORMTU:
756 1.1 cgd *mp = m = m_get(M_WAIT, MT_SOOPTS);
757 1.1 cgd m->m_len = sizeof(int);
758 1.1 cgd switch (optname) {
759 1.1 cgd
760 1.1 cgd case IP_TOS:
761 1.1 cgd optval = inp->inp_ip.ip_tos;
762 1.1 cgd break;
763 1.1 cgd
764 1.1 cgd case IP_TTL:
765 1.1 cgd optval = inp->inp_ip.ip_ttl;
766 1.40 matt break;
767 1.40 matt
768 1.40 matt case IP_ERRORMTU:
769 1.40 matt optval = inp->inp_errormtu;
770 1.1 cgd break;
771 1.1 cgd
772 1.1 cgd #define OPTBIT(bit) (inp->inp_flags & bit ? 1 : 0)
773 1.1 cgd
774 1.1 cgd case IP_RECVOPTS:
775 1.1 cgd optval = OPTBIT(INP_RECVOPTS);
776 1.1 cgd break;
777 1.1 cgd
778 1.1 cgd case IP_RECVRETOPTS:
779 1.1 cgd optval = OPTBIT(INP_RECVRETOPTS);
780 1.1 cgd break;
781 1.1 cgd
782 1.1 cgd case IP_RECVDSTADDR:
783 1.1 cgd optval = OPTBIT(INP_RECVDSTADDR);
784 1.37 thorpej break;
785 1.37 thorpej
786 1.37 thorpej case IP_RECVIF:
787 1.37 thorpej optval = OPTBIT(INP_RECVIF);
788 1.1 cgd break;
789 1.1 cgd }
790 1.1 cgd *mtod(m, int *) = optval;
791 1.1 cgd break;
792 1.18 mycroft
793 1.18 mycroft case IP_MULTICAST_IF:
794 1.18 mycroft case IP_MULTICAST_TTL:
795 1.18 mycroft case IP_MULTICAST_LOOP:
796 1.18 mycroft case IP_ADD_MEMBERSHIP:
797 1.18 mycroft case IP_DROP_MEMBERSHIP:
798 1.18 mycroft error = ip_getmoptions(optname, inp->inp_moptions, mp);
799 1.41 lukem break;
800 1.41 lukem
801 1.41 lukem case IP_PORTRANGE:
802 1.41 lukem *mp = m = m_get(M_WAIT, MT_SOOPTS);
803 1.41 lukem m->m_len = sizeof(int);
804 1.41 lukem
805 1.41 lukem if (inp->inp_flags & INP_LOWPORT)
806 1.41 lukem optval = IP_PORTRANGE_LOW;
807 1.41 lukem else
808 1.41 lukem optval = IP_PORTRANGE_DEFAULT;
809 1.41 lukem
810 1.41 lukem *mtod(m, int *) = optval;
811 1.18 mycroft break;
812 1.1 cgd
813 1.1 cgd default:
814 1.18 mycroft error = ENOPROTOOPT;
815 1.1 cgd break;
816 1.1 cgd }
817 1.1 cgd break;
818 1.1 cgd }
819 1.1 cgd return (error);
820 1.1 cgd }
821 1.1 cgd
822 1.1 cgd /*
823 1.1 cgd * Set up IP options in pcb for insertion in output packets.
824 1.1 cgd * Store in mbuf with pointer in pcbopt, adding pseudo-option
825 1.1 cgd * with destination address if source routed.
826 1.1 cgd */
827 1.12 mycroft int
828 1.1 cgd #ifdef notyet
829 1.1 cgd ip_pcbopts(optname, pcbopt, m)
830 1.1 cgd int optname;
831 1.1 cgd #else
832 1.1 cgd ip_pcbopts(pcbopt, m)
833 1.1 cgd #endif
834 1.1 cgd struct mbuf **pcbopt;
835 1.1 cgd register struct mbuf *m;
836 1.1 cgd {
837 1.43 kleink register int cnt, optlen;
838 1.1 cgd register u_char *cp;
839 1.1 cgd u_char opt;
840 1.1 cgd
841 1.1 cgd /* turn off any old options */
842 1.1 cgd if (*pcbopt)
843 1.1 cgd (void)m_free(*pcbopt);
844 1.1 cgd *pcbopt = 0;
845 1.1 cgd if (m == (struct mbuf *)0 || m->m_len == 0) {
846 1.1 cgd /*
847 1.1 cgd * Only turning off any previous options.
848 1.1 cgd */
849 1.1 cgd if (m)
850 1.1 cgd (void)m_free(m);
851 1.1 cgd return (0);
852 1.1 cgd }
853 1.1 cgd
854 1.1 cgd #ifndef vax
855 1.21 cgd if (m->m_len % sizeof(int32_t))
856 1.1 cgd goto bad;
857 1.1 cgd #endif
858 1.1 cgd /*
859 1.1 cgd * IP first-hop destination address will be stored before
860 1.1 cgd * actual options; move other options back
861 1.1 cgd * and clear it when none present.
862 1.1 cgd */
863 1.1 cgd if (m->m_data + m->m_len + sizeof(struct in_addr) >= &m->m_dat[MLEN])
864 1.1 cgd goto bad;
865 1.1 cgd cnt = m->m_len;
866 1.1 cgd m->m_len += sizeof(struct in_addr);
867 1.1 cgd cp = mtod(m, u_char *) + sizeof(struct in_addr);
868 1.57 perry memmove(cp, mtod(m, caddr_t), (unsigned)cnt);
869 1.1 cgd bzero(mtod(m, caddr_t), sizeof(struct in_addr));
870 1.1 cgd
871 1.1 cgd for (; cnt > 0; cnt -= optlen, cp += optlen) {
872 1.1 cgd opt = cp[IPOPT_OPTVAL];
873 1.1 cgd if (opt == IPOPT_EOL)
874 1.1 cgd break;
875 1.1 cgd if (opt == IPOPT_NOP)
876 1.1 cgd optlen = 1;
877 1.1 cgd else {
878 1.1 cgd optlen = cp[IPOPT_OLEN];
879 1.1 cgd if (optlen <= IPOPT_OLEN || optlen > cnt)
880 1.1 cgd goto bad;
881 1.1 cgd }
882 1.1 cgd switch (opt) {
883 1.1 cgd
884 1.1 cgd default:
885 1.1 cgd break;
886 1.1 cgd
887 1.1 cgd case IPOPT_LSRR:
888 1.1 cgd case IPOPT_SSRR:
889 1.1 cgd /*
890 1.1 cgd * user process specifies route as:
891 1.1 cgd * ->A->B->C->D
892 1.1 cgd * D must be our final destination (but we can't
893 1.1 cgd * check that since we may not have connected yet).
894 1.1 cgd * A is first hop destination, which doesn't appear in
895 1.1 cgd * actual IP option, but is stored before the options.
896 1.1 cgd */
897 1.1 cgd if (optlen < IPOPT_MINOFF - 1 + sizeof(struct in_addr))
898 1.1 cgd goto bad;
899 1.1 cgd m->m_len -= sizeof(struct in_addr);
900 1.1 cgd cnt -= sizeof(struct in_addr);
901 1.1 cgd optlen -= sizeof(struct in_addr);
902 1.1 cgd cp[IPOPT_OLEN] = optlen;
903 1.1 cgd /*
904 1.1 cgd * Move first hop before start of options.
905 1.1 cgd */
906 1.1 cgd bcopy((caddr_t)&cp[IPOPT_OFFSET+1], mtod(m, caddr_t),
907 1.1 cgd sizeof(struct in_addr));
908 1.1 cgd /*
909 1.1 cgd * Then copy rest of options back
910 1.1 cgd * to close up the deleted entry.
911 1.1 cgd */
912 1.57 perry memmove(&cp[IPOPT_OFFSET+1],
913 1.57 perry (caddr_t)(&cp[IPOPT_OFFSET+1] + sizeof(struct in_addr)),
914 1.1 cgd (unsigned)cnt + sizeof(struct in_addr));
915 1.1 cgd break;
916 1.1 cgd }
917 1.1 cgd }
918 1.1 cgd if (m->m_len > MAX_IPOPTLEN + sizeof(struct in_addr))
919 1.1 cgd goto bad;
920 1.1 cgd *pcbopt = m;
921 1.1 cgd return (0);
922 1.1 cgd
923 1.1 cgd bad:
924 1.1 cgd (void)m_free(m);
925 1.1 cgd return (EINVAL);
926 1.1 cgd }
927 1.5 hpeyerl
928 1.5 hpeyerl /*
929 1.5 hpeyerl * Set the IP multicast options in response to user setsockopt().
930 1.5 hpeyerl */
931 1.5 hpeyerl int
932 1.5 hpeyerl ip_setmoptions(optname, imop, m)
933 1.5 hpeyerl int optname;
934 1.5 hpeyerl struct ip_moptions **imop;
935 1.5 hpeyerl struct mbuf *m;
936 1.5 hpeyerl {
937 1.5 hpeyerl register int error = 0;
938 1.5 hpeyerl u_char loop;
939 1.5 hpeyerl register int i;
940 1.5 hpeyerl struct in_addr addr;
941 1.5 hpeyerl register struct ip_mreq *mreq;
942 1.5 hpeyerl register struct ifnet *ifp;
943 1.5 hpeyerl register struct ip_moptions *imo = *imop;
944 1.5 hpeyerl struct route ro;
945 1.5 hpeyerl register struct sockaddr_in *dst;
946 1.5 hpeyerl
947 1.5 hpeyerl if (imo == NULL) {
948 1.5 hpeyerl /*
949 1.5 hpeyerl * No multicast option buffer attached to the pcb;
950 1.5 hpeyerl * allocate one and initialize to default values.
951 1.5 hpeyerl */
952 1.22 cgd imo = (struct ip_moptions *)malloc(sizeof(*imo), M_IPMOPTS,
953 1.5 hpeyerl M_WAITOK);
954 1.5 hpeyerl
955 1.5 hpeyerl if (imo == NULL)
956 1.5 hpeyerl return (ENOBUFS);
957 1.5 hpeyerl *imop = imo;
958 1.5 hpeyerl imo->imo_multicast_ifp = NULL;
959 1.5 hpeyerl imo->imo_multicast_ttl = IP_DEFAULT_MULTICAST_TTL;
960 1.5 hpeyerl imo->imo_multicast_loop = IP_DEFAULT_MULTICAST_LOOP;
961 1.5 hpeyerl imo->imo_num_memberships = 0;
962 1.5 hpeyerl }
963 1.5 hpeyerl
964 1.5 hpeyerl switch (optname) {
965 1.5 hpeyerl
966 1.5 hpeyerl case IP_MULTICAST_IF:
967 1.5 hpeyerl /*
968 1.5 hpeyerl * Select the interface for outgoing multicast packets.
969 1.5 hpeyerl */
970 1.5 hpeyerl if (m == NULL || m->m_len != sizeof(struct in_addr)) {
971 1.5 hpeyerl error = EINVAL;
972 1.5 hpeyerl break;
973 1.5 hpeyerl }
974 1.5 hpeyerl addr = *(mtod(m, struct in_addr *));
975 1.5 hpeyerl /*
976 1.5 hpeyerl * INADDR_ANY is used to remove a previous selection.
977 1.11 mycroft * When no interface is selected, a default one is
978 1.5 hpeyerl * chosen every time a multicast packet is sent.
979 1.5 hpeyerl */
980 1.31 mycroft if (in_nullhost(addr)) {
981 1.5 hpeyerl imo->imo_multicast_ifp = NULL;
982 1.5 hpeyerl break;
983 1.5 hpeyerl }
984 1.5 hpeyerl /*
985 1.5 hpeyerl * The selected interface is identified by its local
986 1.5 hpeyerl * IP address. Find the interface and confirm that
987 1.11 mycroft * it supports multicasting.
988 1.5 hpeyerl */
989 1.5 hpeyerl INADDR_TO_IFP(addr, ifp);
990 1.5 hpeyerl if (ifp == NULL || (ifp->if_flags & IFF_MULTICAST) == 0) {
991 1.5 hpeyerl error = EADDRNOTAVAIL;
992 1.5 hpeyerl break;
993 1.5 hpeyerl }
994 1.5 hpeyerl imo->imo_multicast_ifp = ifp;
995 1.5 hpeyerl break;
996 1.5 hpeyerl
997 1.5 hpeyerl case IP_MULTICAST_TTL:
998 1.5 hpeyerl /*
999 1.5 hpeyerl * Set the IP time-to-live for outgoing multicast packets.
1000 1.5 hpeyerl */
1001 1.5 hpeyerl if (m == NULL || m->m_len != 1) {
1002 1.5 hpeyerl error = EINVAL;
1003 1.5 hpeyerl break;
1004 1.5 hpeyerl }
1005 1.5 hpeyerl imo->imo_multicast_ttl = *(mtod(m, u_char *));
1006 1.5 hpeyerl break;
1007 1.11 mycroft
1008 1.5 hpeyerl case IP_MULTICAST_LOOP:
1009 1.5 hpeyerl /*
1010 1.5 hpeyerl * Set the loopback flag for outgoing multicast packets.
1011 1.5 hpeyerl * Must be zero or one.
1012 1.5 hpeyerl */
1013 1.5 hpeyerl if (m == NULL || m->m_len != 1 ||
1014 1.5 hpeyerl (loop = *(mtod(m, u_char *))) > 1) {
1015 1.5 hpeyerl error = EINVAL;
1016 1.5 hpeyerl break;
1017 1.11 mycroft }
1018 1.5 hpeyerl imo->imo_multicast_loop = loop;
1019 1.5 hpeyerl break;
1020 1.5 hpeyerl
1021 1.5 hpeyerl case IP_ADD_MEMBERSHIP:
1022 1.5 hpeyerl /*
1023 1.5 hpeyerl * Add a multicast group membership.
1024 1.5 hpeyerl * Group must be a valid IP multicast address.
1025 1.5 hpeyerl */
1026 1.5 hpeyerl if (m == NULL || m->m_len != sizeof(struct ip_mreq)) {
1027 1.5 hpeyerl error = EINVAL;
1028 1.5 hpeyerl break;
1029 1.5 hpeyerl }
1030 1.5 hpeyerl mreq = mtod(m, struct ip_mreq *);
1031 1.23 mycroft if (!IN_MULTICAST(mreq->imr_multiaddr.s_addr)) {
1032 1.5 hpeyerl error = EINVAL;
1033 1.5 hpeyerl break;
1034 1.5 hpeyerl }
1035 1.5 hpeyerl /*
1036 1.5 hpeyerl * If no interface address was provided, use the interface of
1037 1.5 hpeyerl * the route to the given multicast address.
1038 1.5 hpeyerl */
1039 1.31 mycroft if (in_nullhost(mreq->imr_interface)) {
1040 1.53 ws bzero((caddr_t)&ro, sizeof(ro));
1041 1.5 hpeyerl ro.ro_rt = NULL;
1042 1.24 mycroft dst = satosin(&ro.ro_dst);
1043 1.5 hpeyerl dst->sin_len = sizeof(*dst);
1044 1.5 hpeyerl dst->sin_family = AF_INET;
1045 1.5 hpeyerl dst->sin_addr = mreq->imr_multiaddr;
1046 1.5 hpeyerl rtalloc(&ro);
1047 1.5 hpeyerl if (ro.ro_rt == NULL) {
1048 1.5 hpeyerl error = EADDRNOTAVAIL;
1049 1.5 hpeyerl break;
1050 1.5 hpeyerl }
1051 1.5 hpeyerl ifp = ro.ro_rt->rt_ifp;
1052 1.5 hpeyerl rtfree(ro.ro_rt);
1053 1.23 mycroft } else {
1054 1.5 hpeyerl INADDR_TO_IFP(mreq->imr_interface, ifp);
1055 1.5 hpeyerl }
1056 1.5 hpeyerl /*
1057 1.5 hpeyerl * See if we found an interface, and confirm that it
1058 1.5 hpeyerl * supports multicast.
1059 1.5 hpeyerl */
1060 1.11 mycroft if (ifp == NULL || (ifp->if_flags & IFF_MULTICAST) == 0) {
1061 1.5 hpeyerl error = EADDRNOTAVAIL;
1062 1.5 hpeyerl break;
1063 1.5 hpeyerl }
1064 1.5 hpeyerl /*
1065 1.5 hpeyerl * See if the membership already exists or if all the
1066 1.5 hpeyerl * membership slots are full.
1067 1.11 mycroft */
1068 1.5 hpeyerl for (i = 0; i < imo->imo_num_memberships; ++i) {
1069 1.5 hpeyerl if (imo->imo_membership[i]->inm_ifp == ifp &&
1070 1.31 mycroft in_hosteq(imo->imo_membership[i]->inm_addr,
1071 1.31 mycroft mreq->imr_multiaddr))
1072 1.5 hpeyerl break;
1073 1.11 mycroft }
1074 1.5 hpeyerl if (i < imo->imo_num_memberships) {
1075 1.5 hpeyerl error = EADDRINUSE;
1076 1.5 hpeyerl break;
1077 1.5 hpeyerl }
1078 1.5 hpeyerl if (i == IP_MAX_MEMBERSHIPS) {
1079 1.11 mycroft error = ETOOMANYREFS;
1080 1.5 hpeyerl break;
1081 1.5 hpeyerl }
1082 1.5 hpeyerl /*
1083 1.5 hpeyerl * Everything looks good; add a new record to the multicast
1084 1.5 hpeyerl * address list for the given interface.
1085 1.5 hpeyerl */
1086 1.5 hpeyerl if ((imo->imo_membership[i] =
1087 1.5 hpeyerl in_addmulti(&mreq->imr_multiaddr, ifp)) == NULL) {
1088 1.5 hpeyerl error = ENOBUFS;
1089 1.5 hpeyerl break;
1090 1.5 hpeyerl }
1091 1.5 hpeyerl ++imo->imo_num_memberships;
1092 1.5 hpeyerl break;
1093 1.5 hpeyerl
1094 1.5 hpeyerl case IP_DROP_MEMBERSHIP:
1095 1.5 hpeyerl /*
1096 1.5 hpeyerl * Drop a multicast group membership.
1097 1.5 hpeyerl * Group must be a valid IP multicast address.
1098 1.5 hpeyerl */
1099 1.5 hpeyerl if (m == NULL || m->m_len != sizeof(struct ip_mreq)) {
1100 1.5 hpeyerl error = EINVAL;
1101 1.5 hpeyerl break;
1102 1.5 hpeyerl }
1103 1.5 hpeyerl mreq = mtod(m, struct ip_mreq *);
1104 1.23 mycroft if (!IN_MULTICAST(mreq->imr_multiaddr.s_addr)) {
1105 1.5 hpeyerl error = EINVAL;
1106 1.5 hpeyerl break;
1107 1.5 hpeyerl }
1108 1.5 hpeyerl /*
1109 1.5 hpeyerl * If an interface address was specified, get a pointer
1110 1.5 hpeyerl * to its ifnet structure.
1111 1.5 hpeyerl */
1112 1.31 mycroft if (in_nullhost(mreq->imr_interface))
1113 1.5 hpeyerl ifp = NULL;
1114 1.5 hpeyerl else {
1115 1.5 hpeyerl INADDR_TO_IFP(mreq->imr_interface, ifp);
1116 1.5 hpeyerl if (ifp == NULL) {
1117 1.5 hpeyerl error = EADDRNOTAVAIL;
1118 1.5 hpeyerl break;
1119 1.5 hpeyerl }
1120 1.5 hpeyerl }
1121 1.5 hpeyerl /*
1122 1.5 hpeyerl * Find the membership in the membership array.
1123 1.5 hpeyerl */
1124 1.5 hpeyerl for (i = 0; i < imo->imo_num_memberships; ++i) {
1125 1.5 hpeyerl if ((ifp == NULL ||
1126 1.5 hpeyerl imo->imo_membership[i]->inm_ifp == ifp) &&
1127 1.31 mycroft in_hosteq(imo->imo_membership[i]->inm_addr,
1128 1.31 mycroft mreq->imr_multiaddr))
1129 1.5 hpeyerl break;
1130 1.5 hpeyerl }
1131 1.5 hpeyerl if (i == imo->imo_num_memberships) {
1132 1.5 hpeyerl error = EADDRNOTAVAIL;
1133 1.5 hpeyerl break;
1134 1.5 hpeyerl }
1135 1.5 hpeyerl /*
1136 1.5 hpeyerl * Give up the multicast address record to which the
1137 1.5 hpeyerl * membership points.
1138 1.5 hpeyerl */
1139 1.11 mycroft in_delmulti(imo->imo_membership[i]);
1140 1.5 hpeyerl /*
1141 1.5 hpeyerl * Remove the gap in the membership array.
1142 1.5 hpeyerl */
1143 1.5 hpeyerl for (++i; i < imo->imo_num_memberships; ++i)
1144 1.5 hpeyerl imo->imo_membership[i-1] = imo->imo_membership[i];
1145 1.5 hpeyerl --imo->imo_num_memberships;
1146 1.5 hpeyerl break;
1147 1.5 hpeyerl
1148 1.5 hpeyerl default:
1149 1.5 hpeyerl error = EOPNOTSUPP;
1150 1.5 hpeyerl break;
1151 1.5 hpeyerl }
1152 1.5 hpeyerl
1153 1.5 hpeyerl /*
1154 1.5 hpeyerl * If all options have default values, no need to keep the mbuf.
1155 1.5 hpeyerl */
1156 1.5 hpeyerl if (imo->imo_multicast_ifp == NULL &&
1157 1.5 hpeyerl imo->imo_multicast_ttl == IP_DEFAULT_MULTICAST_TTL &&
1158 1.5 hpeyerl imo->imo_multicast_loop == IP_DEFAULT_MULTICAST_LOOP &&
1159 1.5 hpeyerl imo->imo_num_memberships == 0) {
1160 1.5 hpeyerl free(*imop, M_IPMOPTS);
1161 1.5 hpeyerl *imop = NULL;
1162 1.5 hpeyerl }
1163 1.5 hpeyerl
1164 1.5 hpeyerl return (error);
1165 1.5 hpeyerl }
1166 1.5 hpeyerl
1167 1.5 hpeyerl /*
1168 1.5 hpeyerl * Return the IP multicast options in response to user getsockopt().
1169 1.5 hpeyerl */
1170 1.5 hpeyerl int
1171 1.5 hpeyerl ip_getmoptions(optname, imo, mp)
1172 1.5 hpeyerl int optname;
1173 1.5 hpeyerl register struct ip_moptions *imo;
1174 1.5 hpeyerl register struct mbuf **mp;
1175 1.5 hpeyerl {
1176 1.5 hpeyerl u_char *ttl;
1177 1.5 hpeyerl u_char *loop;
1178 1.5 hpeyerl struct in_addr *addr;
1179 1.5 hpeyerl struct in_ifaddr *ia;
1180 1.5 hpeyerl
1181 1.5 hpeyerl *mp = m_get(M_WAIT, MT_SOOPTS);
1182 1.5 hpeyerl
1183 1.5 hpeyerl switch (optname) {
1184 1.5 hpeyerl
1185 1.5 hpeyerl case IP_MULTICAST_IF:
1186 1.5 hpeyerl addr = mtod(*mp, struct in_addr *);
1187 1.5 hpeyerl (*mp)->m_len = sizeof(struct in_addr);
1188 1.5 hpeyerl if (imo == NULL || imo->imo_multicast_ifp == NULL)
1189 1.31 mycroft *addr = zeroin_addr;
1190 1.5 hpeyerl else {
1191 1.5 hpeyerl IFP_TO_IA(imo->imo_multicast_ifp, ia);
1192 1.31 mycroft *addr = ia ? ia->ia_addr.sin_addr : zeroin_addr;
1193 1.5 hpeyerl }
1194 1.5 hpeyerl return (0);
1195 1.5 hpeyerl
1196 1.5 hpeyerl case IP_MULTICAST_TTL:
1197 1.5 hpeyerl ttl = mtod(*mp, u_char *);
1198 1.5 hpeyerl (*mp)->m_len = 1;
1199 1.31 mycroft *ttl = imo ? imo->imo_multicast_ttl
1200 1.31 mycroft : IP_DEFAULT_MULTICAST_TTL;
1201 1.5 hpeyerl return (0);
1202 1.5 hpeyerl
1203 1.5 hpeyerl case IP_MULTICAST_LOOP:
1204 1.5 hpeyerl loop = mtod(*mp, u_char *);
1205 1.5 hpeyerl (*mp)->m_len = 1;
1206 1.31 mycroft *loop = imo ? imo->imo_multicast_loop
1207 1.31 mycroft : IP_DEFAULT_MULTICAST_LOOP;
1208 1.5 hpeyerl return (0);
1209 1.5 hpeyerl
1210 1.5 hpeyerl default:
1211 1.5 hpeyerl return (EOPNOTSUPP);
1212 1.5 hpeyerl }
1213 1.5 hpeyerl }
1214 1.5 hpeyerl
1215 1.5 hpeyerl /*
1216 1.5 hpeyerl * Discard the IP multicast options.
1217 1.5 hpeyerl */
1218 1.5 hpeyerl void
1219 1.5 hpeyerl ip_freemoptions(imo)
1220 1.5 hpeyerl register struct ip_moptions *imo;
1221 1.5 hpeyerl {
1222 1.5 hpeyerl register int i;
1223 1.5 hpeyerl
1224 1.5 hpeyerl if (imo != NULL) {
1225 1.5 hpeyerl for (i = 0; i < imo->imo_num_memberships; ++i)
1226 1.5 hpeyerl in_delmulti(imo->imo_membership[i]);
1227 1.5 hpeyerl free(imo, M_IPMOPTS);
1228 1.5 hpeyerl }
1229 1.5 hpeyerl }
1230 1.5 hpeyerl
1231 1.5 hpeyerl /*
1232 1.5 hpeyerl * Routine called from ip_output() to loop back a copy of an IP multicast
1233 1.5 hpeyerl * packet to the input queue of a specified interface. Note that this
1234 1.5 hpeyerl * calls the output routine of the loopback "driver", but with an interface
1235 1.5 hpeyerl * pointer that might NOT be &loif -- easier than replicating that code here.
1236 1.5 hpeyerl */
1237 1.12 mycroft static void
1238 1.5 hpeyerl ip_mloopback(ifp, m, dst)
1239 1.5 hpeyerl struct ifnet *ifp;
1240 1.5 hpeyerl register struct mbuf *m;
1241 1.5 hpeyerl register struct sockaddr_in *dst;
1242 1.5 hpeyerl {
1243 1.5 hpeyerl register struct ip *ip;
1244 1.5 hpeyerl struct mbuf *copym;
1245 1.5 hpeyerl
1246 1.5 hpeyerl copym = m_copy(m, 0, M_COPYALL);
1247 1.5 hpeyerl if (copym != NULL) {
1248 1.5 hpeyerl /*
1249 1.5 hpeyerl * We don't bother to fragment if the IP length is greater
1250 1.5 hpeyerl * than the interface's MTU. Can this possibly matter?
1251 1.5 hpeyerl */
1252 1.5 hpeyerl ip = mtod(copym, struct ip *);
1253 1.55 thorpej HTONS(ip->ip_len);
1254 1.55 thorpej HTONS(ip->ip_off);
1255 1.5 hpeyerl ip->ip_sum = 0;
1256 1.5 hpeyerl ip->ip_sum = in_cksum(copym, ip->ip_hl << 2);
1257 1.24 mycroft (void) looutput(ifp, copym, sintosa(dst), NULL);
1258 1.5 hpeyerl }
1259 1.5 hpeyerl }
1260