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