ip_mroute.c revision 1.29 1 1.29 mycroft /* $NetBSD: ip_mroute.c,v 1.29 1996/09/09 14:51:17 mycroft Exp $ */
2 1.13 cgd
3 1.1 hpeyerl /*
4 1.15 mycroft * IP multicast forwarding procedures
5 1.1 hpeyerl *
6 1.1 hpeyerl * Written by David Waitzman, BBN Labs, August 1988.
7 1.1 hpeyerl * Modified by Steve Deering, Stanford, February 1989.
8 1.15 mycroft * Modified by Mark J. Steiglitz, Stanford, May, 1991
9 1.15 mycroft * Modified by Van Jacobson, LBL, January 1993
10 1.15 mycroft * Modified by Ajit Thyagarajan, PARC, August 1993
11 1.15 mycroft * Modified by Bill Fenner, PARC, April 1994
12 1.15 mycroft * Modified by Charles M. Hannum, NetBSD, May 1995.
13 1.1 hpeyerl *
14 1.15 mycroft * MROUTING Revision: 1.2
15 1.1 hpeyerl */
16 1.1 hpeyerl
17 1.1 hpeyerl #include <sys/param.h>
18 1.15 mycroft #include <sys/systm.h>
19 1.1 hpeyerl #include <sys/mbuf.h>
20 1.1 hpeyerl #include <sys/socket.h>
21 1.1 hpeyerl #include <sys/socketvar.h>
22 1.15 mycroft #include <sys/protosw.h>
23 1.15 mycroft #include <sys/errno.h>
24 1.1 hpeyerl #include <sys/time.h>
25 1.15 mycroft #include <sys/kernel.h>
26 1.15 mycroft #include <sys/ioctl.h>
27 1.15 mycroft #include <sys/syslog.h>
28 1.1 hpeyerl #include <net/if.h>
29 1.1 hpeyerl #include <net/route.h>
30 1.1 hpeyerl #include <net/raw_cb.h>
31 1.1 hpeyerl #include <netinet/in.h>
32 1.15 mycroft #include <netinet/in_var.h>
33 1.1 hpeyerl #include <netinet/in_systm.h>
34 1.1 hpeyerl #include <netinet/ip.h>
35 1.15 mycroft #include <netinet/ip_var.h>
36 1.1 hpeyerl #include <netinet/in_pcb.h>
37 1.15 mycroft #include <netinet/udp.h>
38 1.1 hpeyerl #include <netinet/igmp.h>
39 1.1 hpeyerl #include <netinet/igmp_var.h>
40 1.1 hpeyerl #include <netinet/ip_mroute.h>
41 1.1 hpeyerl
42 1.25 christos #include <machine/stdarg.h>
43 1.25 christos
44 1.15 mycroft #define IP_MULTICASTOPTS 0
45 1.15 mycroft #define M_PULLUP(m, len) \
46 1.15 mycroft do { \
47 1.15 mycroft if ((m) && ((m)->m_flags & M_EXT || (m)->m_len < (len))) \
48 1.15 mycroft (m) = m_pullup((m), (len)); \
49 1.15 mycroft } while (0)
50 1.1 hpeyerl
51 1.1 hpeyerl /*
52 1.1 hpeyerl * Globals. All but ip_mrouter and ip_mrtproto could be static,
53 1.1 hpeyerl * except for netstat or debugging purposes.
54 1.1 hpeyerl */
55 1.15 mycroft struct socket *ip_mrouter = NULL;
56 1.15 mycroft int ip_mrtproto = IGMP_DVMRP; /* for netstat only */
57 1.15 mycroft
58 1.15 mycroft #define NO_RTE_FOUND 0x1
59 1.15 mycroft #define RTE_FOUND 0x2
60 1.1 hpeyerl
61 1.15 mycroft #define MFCHASH(a, g) \
62 1.29 mycroft ((((a).s_addr >> 20) ^ ((a).s_addr >> 10) ^ (a).s_addr ^ \
63 1.29 mycroft ((g).s_addr >> 20) ^ ((g).s_addr >> 10) ^ (g).s_addr) & mfchash)
64 1.15 mycroft LIST_HEAD(mfchashhdr, mfc) *mfchashtbl;
65 1.15 mycroft u_long mfchash;
66 1.15 mycroft
67 1.15 mycroft u_char nexpire[MFCTBLSIZ];
68 1.15 mycroft struct vif viftable[MAXVIFS];
69 1.15 mycroft struct mrtstat mrtstat;
70 1.15 mycroft u_int mrtdebug = 0; /* debug level */
71 1.15 mycroft #define DEBUG_MFC 0x02
72 1.15 mycroft #define DEBUG_FORWARD 0x04
73 1.15 mycroft #define DEBUG_EXPIRE 0x08
74 1.15 mycroft #define DEBUG_XMIT 0x10
75 1.15 mycroft u_int tbfdebug = 0; /* tbf debug level */
76 1.15 mycroft #ifdef RSVP_ISI
77 1.15 mycroft u_int rsvpdebug = 0; /* rsvp debug level */
78 1.15 mycroft extern struct socket *ip_rsvpd;
79 1.15 mycroft extern int rsvp_on;
80 1.15 mycroft #endif /* RSVP_ISI */
81 1.15 mycroft
82 1.15 mycroft #define EXPIRE_TIMEOUT (hz / 4) /* 4x / second */
83 1.15 mycroft #define UPCALL_EXPIRE 6 /* number of timeouts */
84 1.15 mycroft
85 1.15 mycroft /*
86 1.15 mycroft * Define the token bucket filter structures
87 1.15 mycroft * qtable -> each interface has an associated queue of pkts
88 1.15 mycroft */
89 1.15 mycroft
90 1.15 mycroft struct pkt_queue qtable[MAXVIFS][MAXQSIZE];
91 1.15 mycroft
92 1.25 christos static int get_sg_cnt __P((struct sioc_sg_req *));
93 1.25 christos static int get_vif_cnt __P((struct sioc_vif_req *));
94 1.25 christos static int ip_mrouter_init __P((struct socket *, struct mbuf *));
95 1.25 christos static int get_version __P((struct mbuf *));
96 1.25 christos static int set_assert __P((struct mbuf *));
97 1.25 christos static int get_assert __P((struct mbuf *));
98 1.25 christos static int add_vif __P((struct mbuf *));
99 1.25 christos static int del_vif __P((struct mbuf *));
100 1.25 christos static void update_mfc __P((struct mfcctl *, struct mfc *));
101 1.25 christos static void expire_mfc __P((struct mfc *));
102 1.25 christos static int add_mfc __P((struct mbuf *));
103 1.25 christos #ifdef UPCALL_TIMING
104 1.25 christos static void collate __P((struct timeval *));
105 1.25 christos #endif
106 1.25 christos static int del_mfc __P((struct mbuf *));
107 1.25 christos static int socket_send __P((struct socket *, struct mbuf *,
108 1.25 christos struct sockaddr_in *));
109 1.25 christos static void expire_upcalls __P((void *));
110 1.25 christos #ifdef RSVP_ISI
111 1.25 christos static int ip_mdq __P((struct mbuf *, struct ifnet *, struct mfc *, vifi_t));
112 1.25 christos #else
113 1.25 christos static int ip_mdq __P((struct mbuf *, struct ifnet *, struct mfc *));
114 1.25 christos #endif
115 1.25 christos static void phyint_send __P((struct ip *, struct vif *, struct mbuf *));
116 1.25 christos static void encap_send __P((struct ip *, struct vif *, struct mbuf *));
117 1.25 christos static void tbf_control __P((struct vif *, struct mbuf *, struct ip *,
118 1.25 christos u_int32_t));
119 1.25 christos static void tbf_queue __P((struct vif *, struct mbuf *, struct ip *));
120 1.25 christos static void tbf_process_q __P((struct vif *));
121 1.25 christos static void tbf_dequeue __P((struct vif *, int));
122 1.25 christos static void tbf_reprocess_q __P((void *));
123 1.25 christos static int tbf_dq_sel __P((struct vif *, struct ip *));
124 1.25 christos static void tbf_send_packet __P((struct vif *, struct mbuf *));
125 1.25 christos static void tbf_update_tokens __P((struct vif *));
126 1.25 christos static int priority __P((struct vif *, struct ip *));
127 1.1 hpeyerl
128 1.1 hpeyerl /*
129 1.12 brezak * 'Interfaces' associated with decapsulator (so we can tell
130 1.12 brezak * packets that went through it from ones that get reflected
131 1.12 brezak * by a broken gateway). These interfaces are never linked into
132 1.12 brezak * the system ifnet list & no routes point to them. I.e., packets
133 1.12 brezak * can't be sent this way. They only exist as a placeholder for
134 1.12 brezak * multicast source verification.
135 1.12 brezak */
136 1.17 mycroft #if 0
137 1.12 brezak struct ifnet multicast_decap_if[MAXVIFS];
138 1.17 mycroft #endif
139 1.12 brezak
140 1.17 mycroft #define ENCAP_TTL 64
141 1.17 mycroft #define ENCAP_PROTO IPPROTO_IPIP /* 4 */
142 1.12 brezak
143 1.12 brezak /* prototype IP hdr for encapsulated packets */
144 1.12 brezak struct ip multicast_encap_iphdr = {
145 1.15 mycroft #if BYTE_ORDER == LITTLE_ENDIAN
146 1.12 brezak sizeof(struct ip) >> 2, IPVERSION,
147 1.12 brezak #else
148 1.12 brezak IPVERSION, sizeof(struct ip) >> 2,
149 1.12 brezak #endif
150 1.12 brezak 0, /* tos */
151 1.12 brezak sizeof(struct ip), /* total length */
152 1.12 brezak 0, /* id */
153 1.12 brezak 0, /* frag offset */
154 1.15 mycroft ENCAP_TTL, ENCAP_PROTO,
155 1.12 brezak 0, /* checksum */
156 1.12 brezak };
157 1.12 brezak
158 1.12 brezak /*
159 1.1 hpeyerl * Private variables.
160 1.1 hpeyerl */
161 1.15 mycroft static vifi_t numvifs = 0;
162 1.15 mycroft static int have_encap_tunnel = 0;
163 1.12 brezak
164 1.12 brezak /*
165 1.15 mycroft * one-back cache used by ipip_input to locate a tunnel's vif
166 1.12 brezak * given a datagram's src ip address.
167 1.12 brezak */
168 1.29 mycroft static struct in_addr last_encap_src;
169 1.12 brezak static struct vif *last_encap_vif;
170 1.12 brezak
171 1.12 brezak /*
172 1.15 mycroft * whether or not special PIM assert processing is enabled.
173 1.15 mycroft */
174 1.15 mycroft static int pim_assert;
175 1.15 mycroft /*
176 1.15 mycroft * Rate limit for assert notification messages, in usec
177 1.12 brezak */
178 1.15 mycroft #define ASSERT_MSG_TIME 3000000
179 1.12 brezak
180 1.15 mycroft /*
181 1.15 mycroft * Find a route for a given origin IP address and Multicast group address
182 1.15 mycroft * Type of service parameter to be added in the future!!!
183 1.15 mycroft */
184 1.15 mycroft
185 1.15 mycroft #define MFCFIND(o, g, rt) { \
186 1.15 mycroft register struct mfc *_rt; \
187 1.15 mycroft (rt) = NULL; \
188 1.15 mycroft ++mrtstat.mrts_mfc_lookups; \
189 1.15 mycroft for (_rt = mfchashtbl[MFCHASH(o, g)].lh_first; \
190 1.15 mycroft _rt; _rt = _rt->mfc_hash.le_next) { \
191 1.29 mycroft if (in_hosteq(_rt->mfc_origin, (o)) && \
192 1.29 mycroft in_hosteq(_rt->mfc_mcastgrp, (g)) && \
193 1.15 mycroft _rt->mfc_stall == NULL) { \
194 1.15 mycroft (rt) = _rt; \
195 1.15 mycroft break; \
196 1.15 mycroft } \
197 1.15 mycroft } \
198 1.15 mycroft if ((rt) == NULL) \
199 1.15 mycroft ++mrtstat.mrts_mfc_misses; \
200 1.12 brezak }
201 1.12 brezak
202 1.12 brezak /*
203 1.15 mycroft * Macros to compute elapsed time efficiently
204 1.15 mycroft * Borrowed from Van Jacobson's scheduling code
205 1.12 brezak */
206 1.15 mycroft #define TV_DELTA(a, b, delta) { \
207 1.15 mycroft register int xxs; \
208 1.15 mycroft delta = (a).tv_usec - (b).tv_usec; \
209 1.15 mycroft xxs = (a).tv_sec - (b).tv_sec; \
210 1.15 mycroft switch (xxs) { \
211 1.15 mycroft case 2: \
212 1.15 mycroft delta += 1000000; \
213 1.15 mycroft /* fall through */ \
214 1.15 mycroft case 1: \
215 1.15 mycroft delta += 1000000; \
216 1.15 mycroft /* fall through */ \
217 1.15 mycroft case 0: \
218 1.15 mycroft break; \
219 1.15 mycroft default: \
220 1.15 mycroft delta += (1000000 * xxs); \
221 1.15 mycroft break; \
222 1.15 mycroft } \
223 1.15 mycroft }
224 1.15 mycroft
225 1.15 mycroft #ifdef UPCALL_TIMING
226 1.15 mycroft u_int32_t upcall_data[51];
227 1.15 mycroft #endif /* UPCALL_TIMING */
228 1.15 mycroft
229 1.12 brezak /*
230 1.15 mycroft * Handle MRT setsockopt commands to modify the multicast routing tables.
231 1.12 brezak */
232 1.15 mycroft int
233 1.28 mycroft ip_mrouter_set(so, optname, m)
234 1.15 mycroft struct socket *so;
235 1.28 mycroft int optname;
236 1.15 mycroft struct mbuf **m;
237 1.15 mycroft {
238 1.15 mycroft int error;
239 1.15 mycroft
240 1.28 mycroft if (optname != MRT_INIT && so != ip_mrouter)
241 1.28 mycroft error = ENOPROTOOPT;
242 1.15 mycroft else
243 1.28 mycroft switch (optname) {
244 1.15 mycroft case MRT_INIT:
245 1.15 mycroft error = ip_mrouter_init(so, *m);
246 1.15 mycroft break;
247 1.15 mycroft case MRT_DONE:
248 1.15 mycroft error = ip_mrouter_done();
249 1.15 mycroft break;
250 1.15 mycroft case MRT_ADD_VIF:
251 1.15 mycroft error = add_vif(*m);
252 1.15 mycroft break;
253 1.15 mycroft case MRT_DEL_VIF:
254 1.15 mycroft error = del_vif(*m);
255 1.15 mycroft break;
256 1.15 mycroft case MRT_ADD_MFC:
257 1.15 mycroft error = add_mfc(*m);
258 1.15 mycroft break;
259 1.15 mycroft case MRT_DEL_MFC:
260 1.15 mycroft error = del_mfc(*m);
261 1.15 mycroft break;
262 1.15 mycroft case MRT_ASSERT:
263 1.15 mycroft error = set_assert(*m);
264 1.15 mycroft break;
265 1.15 mycroft default:
266 1.28 mycroft error = ENOPROTOOPT;
267 1.15 mycroft break;
268 1.15 mycroft }
269 1.15 mycroft
270 1.15 mycroft if (*m)
271 1.15 mycroft m_free(*m);
272 1.15 mycroft return (error);
273 1.12 brezak }
274 1.12 brezak
275 1.15 mycroft /*
276 1.15 mycroft * Handle MRT getsockopt commands
277 1.15 mycroft */
278 1.15 mycroft int
279 1.28 mycroft ip_mrouter_get(so, optname, m)
280 1.15 mycroft struct socket *so;
281 1.28 mycroft int optname;
282 1.15 mycroft struct mbuf **m;
283 1.12 brezak {
284 1.15 mycroft int error;
285 1.12 brezak
286 1.15 mycroft if (so != ip_mrouter)
287 1.28 mycroft error = ENOPROTOOPT;
288 1.15 mycroft else {
289 1.28 mycroft *m = m_get(M_WAIT, MT_SOOPTS);
290 1.12 brezak
291 1.28 mycroft switch (optname) {
292 1.15 mycroft case MRT_VERSION:
293 1.28 mycroft error = get_version(*m);
294 1.15 mycroft break;
295 1.15 mycroft case MRT_ASSERT:
296 1.28 mycroft error = get_assert(*m);
297 1.15 mycroft break;
298 1.15 mycroft default:
299 1.28 mycroft error = ENOPROTOOPT;
300 1.15 mycroft break;
301 1.15 mycroft }
302 1.15 mycroft
303 1.15 mycroft if (error)
304 1.28 mycroft m_free(*m);
305 1.12 brezak }
306 1.15 mycroft
307 1.15 mycroft return (error);
308 1.12 brezak }
309 1.12 brezak
310 1.1 hpeyerl /*
311 1.15 mycroft * Handle ioctl commands to obtain information from the cache
312 1.1 hpeyerl */
313 1.1 hpeyerl int
314 1.28 mycroft mrt_ioctl(so, cmd, data)
315 1.28 mycroft struct socket *so;
316 1.15 mycroft u_long cmd;
317 1.15 mycroft caddr_t data;
318 1.1 hpeyerl {
319 1.15 mycroft int error;
320 1.1 hpeyerl
321 1.28 mycroft if (so != ip_mrouter)
322 1.15 mycroft error = EINVAL;
323 1.28 mycroft else
324 1.28 mycroft switch (cmd) {
325 1.28 mycroft case SIOCGETVIFCNT:
326 1.28 mycroft error = get_vif_cnt((struct sioc_vif_req *)data);
327 1.28 mycroft break;
328 1.28 mycroft case SIOCGETSGCNT:
329 1.28 mycroft error = get_sg_cnt((struct sioc_sg_req *)data);
330 1.28 mycroft break;
331 1.28 mycroft default:
332 1.28 mycroft error = EINVAL;
333 1.28 mycroft break;
334 1.28 mycroft }
335 1.1 hpeyerl
336 1.15 mycroft return (error);
337 1.15 mycroft }
338 1.1 hpeyerl
339 1.15 mycroft /*
340 1.15 mycroft * returns the packet, byte, rpf-failure count for the source group provided
341 1.15 mycroft */
342 1.15 mycroft static int
343 1.15 mycroft get_sg_cnt(req)
344 1.15 mycroft register struct sioc_sg_req *req;
345 1.15 mycroft {
346 1.15 mycroft register struct mfc *rt;
347 1.15 mycroft int s;
348 1.1 hpeyerl
349 1.24 mycroft s = splsoftnet();
350 1.29 mycroft MFCFIND(req->src, req->grp, rt);
351 1.15 mycroft splx(s);
352 1.15 mycroft if (rt != NULL) {
353 1.15 mycroft req->pktcnt = rt->mfc_pkt_cnt;
354 1.15 mycroft req->bytecnt = rt->mfc_byte_cnt;
355 1.15 mycroft req->wrong_if = rt->mfc_wrong_if;
356 1.15 mycroft } else
357 1.15 mycroft req->pktcnt = req->bytecnt = req->wrong_if = 0xffffffff;
358 1.1 hpeyerl
359 1.15 mycroft return (0);
360 1.15 mycroft }
361 1.1 hpeyerl
362 1.15 mycroft /*
363 1.15 mycroft * returns the input and output packet and byte counts on the vif provided
364 1.15 mycroft */
365 1.15 mycroft static int
366 1.15 mycroft get_vif_cnt(req)
367 1.15 mycroft register struct sioc_vif_req *req;
368 1.15 mycroft {
369 1.15 mycroft register vifi_t vifi = req->vifi;
370 1.1 hpeyerl
371 1.15 mycroft if (vifi >= numvifs)
372 1.15 mycroft return (EINVAL);
373 1.1 hpeyerl
374 1.15 mycroft req->icount = viftable[vifi].v_pkt_in;
375 1.15 mycroft req->ocount = viftable[vifi].v_pkt_out;
376 1.15 mycroft req->ibytes = viftable[vifi].v_bytes_in;
377 1.15 mycroft req->obytes = viftable[vifi].v_bytes_out;
378 1.1 hpeyerl
379 1.15 mycroft return (0);
380 1.1 hpeyerl }
381 1.1 hpeyerl
382 1.1 hpeyerl /*
383 1.1 hpeyerl * Enable multicast routing
384 1.1 hpeyerl */
385 1.1 hpeyerl static int
386 1.15 mycroft ip_mrouter_init(so, m)
387 1.15 mycroft struct socket *so;
388 1.15 mycroft struct mbuf *m;
389 1.1 hpeyerl {
390 1.15 mycroft int *v;
391 1.15 mycroft
392 1.15 mycroft if (mrtdebug)
393 1.15 mycroft log(LOG_DEBUG,
394 1.15 mycroft "ip_mrouter_init: so_type = %d, pr_protocol = %d",
395 1.15 mycroft so->so_type, so->so_proto->pr_protocol);
396 1.15 mycroft
397 1.1 hpeyerl if (so->so_type != SOCK_RAW ||
398 1.1 hpeyerl so->so_proto->pr_protocol != IPPROTO_IGMP)
399 1.1 hpeyerl return (EOPNOTSUPP);
400 1.1 hpeyerl
401 1.15 mycroft if (m == 0 || m->m_len < sizeof(int))
402 1.15 mycroft return (EINVAL);
403 1.15 mycroft
404 1.15 mycroft v = mtod(m, int *);
405 1.15 mycroft if (*v != 1)
406 1.15 mycroft return (EINVAL);
407 1.15 mycroft
408 1.1 hpeyerl if (ip_mrouter != NULL)
409 1.1 hpeyerl return (EADDRINUSE);
410 1.1 hpeyerl
411 1.1 hpeyerl ip_mrouter = so;
412 1.1 hpeyerl
413 1.15 mycroft mfchashtbl = hashinit(MFCTBLSIZ, M_MRTABLE, &mfchash);
414 1.15 mycroft bzero((caddr_t)nexpire, sizeof(nexpire));
415 1.15 mycroft
416 1.15 mycroft pim_assert = 0;
417 1.15 mycroft
418 1.15 mycroft timeout(expire_upcalls, (caddr_t)0, EXPIRE_TIMEOUT);
419 1.15 mycroft
420 1.15 mycroft if (mrtdebug)
421 1.15 mycroft log(LOG_DEBUG, "ip_mrouter_init");
422 1.15 mycroft
423 1.1 hpeyerl return (0);
424 1.1 hpeyerl }
425 1.1 hpeyerl
426 1.1 hpeyerl /*
427 1.1 hpeyerl * Disable multicast routing
428 1.1 hpeyerl */
429 1.1 hpeyerl int
430 1.1 hpeyerl ip_mrouter_done()
431 1.1 hpeyerl {
432 1.15 mycroft vifi_t vifi;
433 1.15 mycroft register struct vif *vifp;
434 1.15 mycroft int i;
435 1.15 mycroft int s;
436 1.15 mycroft
437 1.24 mycroft s = splsoftnet();
438 1.1 hpeyerl
439 1.17 mycroft /* Clear out all the vifs currently in use. */
440 1.1 hpeyerl for (vifi = 0; vifi < numvifs; vifi++) {
441 1.15 mycroft vifp = &viftable[vifi];
442 1.29 mycroft if (!in_nullhost(vifp->v_lcl_addr))
443 1.17 mycroft reset_vif(vifp);
444 1.1 hpeyerl }
445 1.17 mycroft
446 1.15 mycroft bzero((caddr_t)qtable, sizeof(qtable));
447 1.1 hpeyerl numvifs = 0;
448 1.15 mycroft pim_assert = 0;
449 1.15 mycroft
450 1.15 mycroft untimeout(expire_upcalls, (caddr_t)NULL);
451 1.15 mycroft
452 1.15 mycroft /*
453 1.15 mycroft * Free all multicast forwarding cache entries.
454 1.15 mycroft */
455 1.15 mycroft for (i = 0; i < MFCTBLSIZ; i++) {
456 1.15 mycroft register struct mfc *rt, *nrt;
457 1.1 hpeyerl
458 1.15 mycroft for (rt = mfchashtbl[i].lh_first; rt; rt = nrt) {
459 1.15 mycroft nrt = rt->mfc_hash.le_next;
460 1.15 mycroft
461 1.15 mycroft expire_mfc(rt);
462 1.15 mycroft }
463 1.15 mycroft }
464 1.15 mycroft free(mfchashtbl, M_MRTABLE);
465 1.15 mycroft
466 1.17 mycroft /* Reset de-encapsulation cache. */
467 1.15 mycroft have_encap_tunnel = 0;
468 1.15 mycroft
469 1.15 mycroft ip_mrouter = NULL;
470 1.15 mycroft
471 1.15 mycroft splx(s);
472 1.15 mycroft
473 1.15 mycroft if (mrtdebug)
474 1.15 mycroft log(LOG_DEBUG, "ip_mrouter_done");
475 1.15 mycroft
476 1.15 mycroft return (0);
477 1.15 mycroft }
478 1.15 mycroft
479 1.15 mycroft static int
480 1.15 mycroft get_version(m)
481 1.15 mycroft struct mbuf *m;
482 1.15 mycroft {
483 1.15 mycroft int *v = mtod(m, int *);
484 1.15 mycroft
485 1.15 mycroft *v = 0x0305; /* XXX !!!! */
486 1.15 mycroft m->m_len = sizeof(int);
487 1.15 mycroft return (0);
488 1.15 mycroft }
489 1.15 mycroft
490 1.15 mycroft /*
491 1.15 mycroft * Set PIM assert processing global
492 1.15 mycroft */
493 1.15 mycroft static int
494 1.15 mycroft set_assert(m)
495 1.15 mycroft struct mbuf *m;
496 1.15 mycroft {
497 1.15 mycroft int *i;
498 1.15 mycroft
499 1.15 mycroft if (m == 0 || m->m_len < sizeof(int))
500 1.15 mycroft return (EINVAL);
501 1.1 hpeyerl
502 1.15 mycroft i = mtod(m, int *);
503 1.15 mycroft pim_assert = !!*i;
504 1.15 mycroft return (0);
505 1.15 mycroft }
506 1.15 mycroft
507 1.15 mycroft /*
508 1.15 mycroft * Get PIM assert processing global
509 1.15 mycroft */
510 1.15 mycroft static int
511 1.15 mycroft get_assert(m)
512 1.15 mycroft struct mbuf *m;
513 1.15 mycroft {
514 1.15 mycroft int *i = mtod(m, int *);
515 1.1 hpeyerl
516 1.15 mycroft *i = pim_assert;
517 1.15 mycroft m->m_len = sizeof(int);
518 1.1 hpeyerl return (0);
519 1.1 hpeyerl }
520 1.1 hpeyerl
521 1.15 mycroft static struct sockaddr_in sin = { sizeof(sin), AF_INET };
522 1.15 mycroft
523 1.1 hpeyerl /*
524 1.1 hpeyerl * Add a vif to the vif table
525 1.1 hpeyerl */
526 1.1 hpeyerl static int
527 1.15 mycroft add_vif(m)
528 1.15 mycroft struct mbuf *m;
529 1.15 mycroft {
530 1.1 hpeyerl register struct vifctl *vifcp;
531 1.15 mycroft register struct vif *vifp;
532 1.15 mycroft struct ifaddr *ifa;
533 1.15 mycroft struct ifnet *ifp;
534 1.1 hpeyerl struct ifreq ifr;
535 1.15 mycroft int error, s;
536 1.15 mycroft
537 1.15 mycroft if (m == 0 || m->m_len < sizeof(struct vifctl))
538 1.15 mycroft return (EINVAL);
539 1.1 hpeyerl
540 1.15 mycroft vifcp = mtod(m, struct vifctl *);
541 1.1 hpeyerl if (vifcp->vifc_vifi >= MAXVIFS)
542 1.1 hpeyerl return (EINVAL);
543 1.15 mycroft
544 1.15 mycroft vifp = &viftable[vifcp->vifc_vifi];
545 1.29 mycroft if (!in_nullhost(vifp->v_lcl_addr))
546 1.1 hpeyerl return (EADDRINUSE);
547 1.15 mycroft
548 1.15 mycroft /* Find the interface with an address in AF_INET family. */
549 1.1 hpeyerl sin.sin_addr = vifcp->vifc_lcl_addr;
550 1.18 mycroft ifa = ifa_ifwithaddr(sintosa(&sin));
551 1.1 hpeyerl if (ifa == 0)
552 1.1 hpeyerl return (EADDRNOTAVAIL);
553 1.15 mycroft
554 1.12 brezak if (vifcp->vifc_flags & VIFF_TUNNEL) {
555 1.17 mycroft if (vifcp->vifc_flags & VIFF_SRCRT) {
556 1.15 mycroft log(LOG_ERR, "Source routed tunnels not supported.");
557 1.15 mycroft return (EOPNOTSUPP);
558 1.12 brezak }
559 1.17 mycroft
560 1.17 mycroft /* Create a fake encapsulation interface. */
561 1.17 mycroft ifp = (struct ifnet *)malloc(sizeof(*ifp), M_MRTABLE, M_WAITOK);
562 1.17 mycroft bzero(ifp, sizeof(*ifp));
563 1.27 thorpej sprintf(ifp->if_xname, "mdecap%d", vifcp->vifc_vifi);
564 1.17 mycroft
565 1.17 mycroft /* Prepare cached route entry. */
566 1.17 mycroft bzero(&vifp->v_route, sizeof(vifp->v_route));
567 1.17 mycroft
568 1.17 mycroft /* Tell ipip_input() to start looking at encapsulated packets. */
569 1.17 mycroft have_encap_tunnel = 1;
570 1.12 brezak } else {
571 1.17 mycroft /* Use the physical interface associated with the address. */
572 1.17 mycroft ifp = ifa->ifa_ifp;
573 1.17 mycroft
574 1.15 mycroft /* Make sure the interface supports multicast. */
575 1.12 brezak if ((ifp->if_flags & IFF_MULTICAST) == 0)
576 1.15 mycroft return (EOPNOTSUPP);
577 1.15 mycroft
578 1.15 mycroft /* Enable promiscuous reception of all IP multicasts. */
579 1.19 mycroft satosin(&ifr.ifr_addr)->sin_len = sizeof(struct sockaddr_in);
580 1.15 mycroft satosin(&ifr.ifr_addr)->sin_family = AF_INET;
581 1.29 mycroft satosin(&ifr.ifr_addr)->sin_addr = zeroin_addr;
582 1.1 hpeyerl error = (*ifp->if_ioctl)(ifp, SIOCADDMULTI, (caddr_t)&ifr);
583 1.12 brezak if (error)
584 1.15 mycroft return (error);
585 1.1 hpeyerl }
586 1.15 mycroft
587 1.24 mycroft s = splsoftnet();
588 1.15 mycroft /* Define parameters for the tbf structure. */
589 1.15 mycroft vifp->v_tbf.q_len = 0;
590 1.15 mycroft vifp->v_tbf.n_tok = 0;
591 1.15 mycroft vifp->v_tbf.last_pkt_t = 0;
592 1.15 mycroft
593 1.1 hpeyerl vifp->v_flags = vifcp->vifc_flags;
594 1.1 hpeyerl vifp->v_threshold = vifcp->vifc_threshold;
595 1.1 hpeyerl vifp->v_lcl_addr = vifcp->vifc_lcl_addr;
596 1.15 mycroft vifp->v_rmt_addr = vifcp->vifc_rmt_addr;
597 1.12 brezak vifp->v_ifp = ifp;
598 1.15 mycroft vifp->v_rate_limit = vifcp->vifc_rate_limit;
599 1.15 mycroft #ifdef RSVP_ISI
600 1.15 mycroft vifp->v_rsvp_on = 0;
601 1.15 mycroft vifp->v_rsvpd = NULL;
602 1.15 mycroft #endif /* RSVP_ISI */
603 1.15 mycroft /* Initialize per vif pkt counters. */
604 1.15 mycroft vifp->v_pkt_in = 0;
605 1.15 mycroft vifp->v_pkt_out = 0;
606 1.15 mycroft vifp->v_bytes_in = 0;
607 1.15 mycroft vifp->v_bytes_out = 0;
608 1.12 brezak splx(s);
609 1.15 mycroft
610 1.15 mycroft /* Adjust numvifs up if the vifi is higher than numvifs. */
611 1.1 hpeyerl if (numvifs <= vifcp->vifc_vifi)
612 1.1 hpeyerl numvifs = vifcp->vifc_vifi + 1;
613 1.15 mycroft
614 1.15 mycroft if (mrtdebug)
615 1.15 mycroft log(LOG_DEBUG, "add_vif #%d, lcladdr %x, %s %x, thresh %x, rate %d",
616 1.15 mycroft vifcp->vifc_vifi,
617 1.15 mycroft ntohl(vifcp->vifc_lcl_addr.s_addr),
618 1.15 mycroft (vifcp->vifc_flags & VIFF_TUNNEL) ? "rmtaddr" : "mask",
619 1.15 mycroft ntohl(vifcp->vifc_rmt_addr.s_addr),
620 1.15 mycroft vifcp->vifc_threshold,
621 1.15 mycroft vifcp->vifc_rate_limit);
622 1.15 mycroft
623 1.1 hpeyerl return (0);
624 1.1 hpeyerl }
625 1.1 hpeyerl
626 1.17 mycroft void
627 1.17 mycroft reset_vif(vifp)
628 1.17 mycroft register struct vif *vifp;
629 1.17 mycroft {
630 1.17 mycroft struct ifnet *ifp;
631 1.17 mycroft struct ifreq ifr;
632 1.17 mycroft
633 1.17 mycroft if (vifp->v_flags & VIFF_TUNNEL) {
634 1.17 mycroft free(vifp->v_ifp, M_MRTABLE);
635 1.17 mycroft if (vifp == last_encap_vif) {
636 1.17 mycroft last_encap_vif = 0;
637 1.29 mycroft last_encap_src = zeroin_addr;
638 1.17 mycroft }
639 1.17 mycroft } else {
640 1.19 mycroft satosin(&ifr.ifr_addr)->sin_len = sizeof(struct sockaddr_in);
641 1.17 mycroft satosin(&ifr.ifr_addr)->sin_family = AF_INET;
642 1.29 mycroft satosin(&ifr.ifr_addr)->sin_addr = zeroin_addr;
643 1.17 mycroft ifp = vifp->v_ifp;
644 1.17 mycroft (*ifp->if_ioctl)(ifp, SIOCDELMULTI, (caddr_t)&ifr);
645 1.17 mycroft }
646 1.17 mycroft bzero((caddr_t)vifp, sizeof(*vifp));
647 1.17 mycroft }
648 1.17 mycroft
649 1.1 hpeyerl /*
650 1.1 hpeyerl * Delete a vif from the vif table
651 1.1 hpeyerl */
652 1.1 hpeyerl static int
653 1.15 mycroft del_vif(m)
654 1.15 mycroft struct mbuf *m;
655 1.1 hpeyerl {
656 1.15 mycroft vifi_t *vifip;
657 1.15 mycroft register struct vif *vifp;
658 1.15 mycroft register vifi_t vifi;
659 1.15 mycroft int s;
660 1.15 mycroft
661 1.15 mycroft if (m == 0 || m->m_len < sizeof(vifi_t))
662 1.15 mycroft return (EINVAL);
663 1.1 hpeyerl
664 1.15 mycroft vifip = mtod(m, vifi_t *);
665 1.1 hpeyerl if (*vifip >= numvifs)
666 1.1 hpeyerl return (EINVAL);
667 1.15 mycroft
668 1.15 mycroft vifp = &viftable[*vifip];
669 1.29 mycroft if (in_nullhost(vifp->v_lcl_addr))
670 1.1 hpeyerl return (EADDRNOTAVAIL);
671 1.15 mycroft
672 1.24 mycroft s = splsoftnet();
673 1.15 mycroft
674 1.17 mycroft reset_vif(vifp);
675 1.15 mycroft
676 1.15 mycroft bzero((caddr_t)qtable[*vifip], sizeof(qtable[*vifip]));
677 1.15 mycroft
678 1.1 hpeyerl /* Adjust numvifs down */
679 1.15 mycroft for (vifi = numvifs; vifi > 0; vifi--)
680 1.29 mycroft if (!in_nullhost(viftable[vifi-1].v_lcl_addr))
681 1.1 hpeyerl break;
682 1.15 mycroft numvifs = vifi;
683 1.15 mycroft
684 1.1 hpeyerl splx(s);
685 1.15 mycroft
686 1.15 mycroft if (mrtdebug)
687 1.15 mycroft log(LOG_DEBUG, "del_vif %d, numvifs %d", *vifip, numvifs);
688 1.15 mycroft
689 1.1 hpeyerl return (0);
690 1.1 hpeyerl }
691 1.1 hpeyerl
692 1.15 mycroft static void
693 1.15 mycroft update_mfc(mfccp, rt)
694 1.15 mycroft struct mfcctl *mfccp;
695 1.15 mycroft struct mfc *rt;
696 1.1 hpeyerl {
697 1.15 mycroft vifi_t vifi;
698 1.1 hpeyerl
699 1.15 mycroft rt->mfc_parent = mfccp->mfcc_parent;
700 1.15 mycroft for (vifi = 0; vifi < numvifs; vifi++)
701 1.15 mycroft rt->mfc_ttls[vifi] = mfccp->mfcc_ttls[vifi];
702 1.15 mycroft rt->mfc_expire = 0;
703 1.15 mycroft rt->mfc_stall = 0;
704 1.15 mycroft }
705 1.1 hpeyerl
706 1.15 mycroft static void
707 1.15 mycroft expire_mfc(rt)
708 1.15 mycroft struct mfc *rt;
709 1.15 mycroft {
710 1.15 mycroft struct rtdetq *rte, *nrte;
711 1.1 hpeyerl
712 1.15 mycroft for (rte = rt->mfc_stall; rte != NULL; rte = nrte) {
713 1.15 mycroft nrte = rte->next;
714 1.15 mycroft m_freem(rte->m);
715 1.15 mycroft free(rte, M_MRTABLE);
716 1.1 hpeyerl }
717 1.1 hpeyerl
718 1.15 mycroft LIST_REMOVE(rt, mfc_hash);
719 1.15 mycroft free(rt, M_MRTABLE);
720 1.1 hpeyerl }
721 1.1 hpeyerl
722 1.1 hpeyerl /*
723 1.15 mycroft * Add an mfc entry
724 1.1 hpeyerl */
725 1.1 hpeyerl static int
726 1.15 mycroft add_mfc(m)
727 1.15 mycroft struct mbuf *m;
728 1.1 hpeyerl {
729 1.15 mycroft struct mfcctl *mfccp;
730 1.25 christos struct mfc *rt;
731 1.25 christos u_int32_t hash = 0;
732 1.15 mycroft struct rtdetq *rte, *nrte;
733 1.15 mycroft register u_short nstl;
734 1.15 mycroft int s;
735 1.1 hpeyerl
736 1.15 mycroft if (m == 0 || m->m_len < sizeof(struct mfcctl))
737 1.1 hpeyerl return (EINVAL);
738 1.15 mycroft
739 1.15 mycroft mfccp = mtod(m, struct mfcctl *);
740 1.1 hpeyerl
741 1.24 mycroft s = splsoftnet();
742 1.29 mycroft MFCFIND(mfccp->mfcc_origin, mfccp->mfcc_mcastgrp, rt);
743 1.1 hpeyerl
744 1.15 mycroft /* If an entry already exists, just update the fields */
745 1.15 mycroft if (rt) {
746 1.15 mycroft if (mrtdebug & DEBUG_MFC)
747 1.15 mycroft log(LOG_DEBUG,"add_mfc update o %x g %x p %x",
748 1.15 mycroft ntohl(mfccp->mfcc_origin.s_addr),
749 1.15 mycroft ntohl(mfccp->mfcc_mcastgrp.s_addr),
750 1.15 mycroft mfccp->mfcc_parent);
751 1.1 hpeyerl
752 1.15 mycroft if (rt->mfc_expire)
753 1.15 mycroft nexpire[hash]--;
754 1.1 hpeyerl
755 1.15 mycroft update_mfc(mfccp, rt);
756 1.1 hpeyerl
757 1.15 mycroft splx(s);
758 1.15 mycroft return (0);
759 1.15 mycroft }
760 1.1 hpeyerl
761 1.15 mycroft /*
762 1.15 mycroft * Find the entry for which the upcall was made and update
763 1.15 mycroft */
764 1.15 mycroft nstl = 0;
765 1.29 mycroft hash = MFCHASH(mfccp->mfcc_origin, mfccp->mfcc_mcastgrp);
766 1.15 mycroft for (rt = mfchashtbl[hash].lh_first; rt; rt = rt->mfc_hash.le_next) {
767 1.29 mycroft if (in_hosteq(rt->mfc_origin, mfccp->mfcc_origin) &&
768 1.29 mycroft in_hosteq(rt->mfc_mcastgrp, mfccp->mfcc_mcastgrp) &&
769 1.15 mycroft rt->mfc_stall != NULL) {
770 1.15 mycroft if (nstl++)
771 1.26 christos log(LOG_ERR, "add_mfc %s o %x g %x p %x dbx %p",
772 1.15 mycroft "multiple kernel entries",
773 1.15 mycroft ntohl(mfccp->mfcc_origin.s_addr),
774 1.15 mycroft ntohl(mfccp->mfcc_mcastgrp.s_addr),
775 1.15 mycroft mfccp->mfcc_parent, rt->mfc_stall);
776 1.15 mycroft
777 1.15 mycroft if (mrtdebug & DEBUG_MFC)
778 1.26 christos log(LOG_DEBUG,"add_mfc o %x g %x p %x dbg %p",
779 1.15 mycroft ntohl(mfccp->mfcc_origin.s_addr),
780 1.15 mycroft ntohl(mfccp->mfcc_mcastgrp.s_addr),
781 1.15 mycroft mfccp->mfcc_parent, rt->mfc_stall);
782 1.15 mycroft
783 1.15 mycroft if (rt->mfc_expire)
784 1.15 mycroft nexpire[hash]--;
785 1.15 mycroft
786 1.15 mycroft /* free packets Qed at the end of this entry */
787 1.15 mycroft for (rte = rt->mfc_stall; rte != NULL; rte = nrte) {
788 1.15 mycroft nrte = rte->next;
789 1.15 mycroft #ifdef RSVP_ISI
790 1.15 mycroft ip_mdq(rte->m, rte->ifp, rt, -1);
791 1.15 mycroft #else
792 1.15 mycroft ip_mdq(rte->m, rte->ifp, rt);
793 1.15 mycroft #endif /* RSVP_ISI */
794 1.15 mycroft m_freem(rte->m);
795 1.15 mycroft #ifdef UPCALL_TIMING
796 1.15 mycroft collate(&rte->t);
797 1.15 mycroft #endif /* UPCALL_TIMING */
798 1.15 mycroft free(rte, M_MRTABLE);
799 1.15 mycroft }
800 1.1 hpeyerl
801 1.15 mycroft update_mfc(mfccp, rt);
802 1.15 mycroft }
803 1.15 mycroft }
804 1.1 hpeyerl
805 1.15 mycroft if (nstl == 0) {
806 1.15 mycroft /*
807 1.15 mycroft * No mfc; make a new one
808 1.15 mycroft */
809 1.15 mycroft if (mrtdebug & DEBUG_MFC)
810 1.15 mycroft log(LOG_DEBUG,"add_mfc no upcall o %x g %x p %x",
811 1.15 mycroft ntohl(mfccp->mfcc_origin.s_addr),
812 1.15 mycroft ntohl(mfccp->mfcc_mcastgrp.s_addr),
813 1.15 mycroft mfccp->mfcc_parent);
814 1.15 mycroft
815 1.15 mycroft rt = (struct mfc *)malloc(sizeof(*rt), M_MRTABLE, M_NOWAIT);
816 1.15 mycroft if (rt == NULL) {
817 1.1 hpeyerl splx(s);
818 1.15 mycroft return (ENOBUFS);
819 1.1 hpeyerl }
820 1.15 mycroft
821 1.15 mycroft rt->mfc_origin = mfccp->mfcc_origin;
822 1.15 mycroft rt->mfc_mcastgrp = mfccp->mfcc_mcastgrp;
823 1.15 mycroft /* initialize pkt counters per src-grp */
824 1.15 mycroft rt->mfc_pkt_cnt = 0;
825 1.15 mycroft rt->mfc_byte_cnt = 0;
826 1.15 mycroft rt->mfc_wrong_if = 0;
827 1.15 mycroft timerclear(&rt->mfc_last_assert);
828 1.15 mycroft update_mfc(mfccp, rt);
829 1.15 mycroft
830 1.15 mycroft /* insert new entry at head of hash chain */
831 1.15 mycroft LIST_INSERT_HEAD(&mfchashtbl[hash], rt, mfc_hash);
832 1.15 mycroft }
833 1.15 mycroft
834 1.1 hpeyerl splx(s);
835 1.1 hpeyerl return (0);
836 1.1 hpeyerl }
837 1.1 hpeyerl
838 1.15 mycroft #ifdef UPCALL_TIMING
839 1.15 mycroft /*
840 1.15 mycroft * collect delay statistics on the upcalls
841 1.15 mycroft */
842 1.15 mycroft static void collate(t)
843 1.15 mycroft register struct timeval *t;
844 1.15 mycroft {
845 1.15 mycroft register u_int32_t d;
846 1.15 mycroft register struct timeval tp;
847 1.15 mycroft register u_int32_t delta;
848 1.15 mycroft
849 1.15 mycroft microtime(&tp);
850 1.15 mycroft
851 1.15 mycroft if (timercmp(t, &tp, <)) {
852 1.15 mycroft TV_DELTA(tp, *t, delta);
853 1.15 mycroft
854 1.15 mycroft d = delta >> 10;
855 1.15 mycroft if (d > 50)
856 1.15 mycroft d = 50;
857 1.15 mycroft
858 1.15 mycroft ++upcall_data[d];
859 1.15 mycroft }
860 1.15 mycroft }
861 1.15 mycroft #endif /* UPCALL_TIMING */
862 1.15 mycroft
863 1.1 hpeyerl /*
864 1.15 mycroft * Delete an mfc entry
865 1.1 hpeyerl */
866 1.1 hpeyerl static int
867 1.15 mycroft del_mfc(m)
868 1.15 mycroft struct mbuf *m;
869 1.1 hpeyerl {
870 1.15 mycroft struct mfcctl *mfccp;
871 1.15 mycroft struct mfc *rt;
872 1.1 hpeyerl int s;
873 1.1 hpeyerl
874 1.15 mycroft if (m == 0 || m->m_len < sizeof(struct mfcctl))
875 1.15 mycroft return (EINVAL);
876 1.15 mycroft
877 1.15 mycroft mfccp = mtod(m, struct mfcctl *);
878 1.15 mycroft
879 1.15 mycroft if (mrtdebug & DEBUG_MFC)
880 1.15 mycroft log(LOG_DEBUG, "del_mfc origin %x mcastgrp %x",
881 1.29 mycroft ntohl(mfccp->mfcc_origin.s_addr),
882 1.29 mycroft ntohl(mfccp->mfcc_mcastgrp.s_addr));
883 1.1 hpeyerl
884 1.24 mycroft s = splsoftnet();
885 1.1 hpeyerl
886 1.29 mycroft MFCFIND(mfccp->mfcc_origin, mfccp->mfcc_mcastgrp, rt);
887 1.1 hpeyerl if (rt == NULL) {
888 1.1 hpeyerl splx(s);
889 1.15 mycroft return (EADDRNOTAVAIL);
890 1.1 hpeyerl }
891 1.1 hpeyerl
892 1.15 mycroft LIST_REMOVE(rt, mfc_hash);
893 1.15 mycroft free(rt, M_MRTABLE);
894 1.1 hpeyerl
895 1.1 hpeyerl splx(s);
896 1.1 hpeyerl return (0);
897 1.1 hpeyerl }
898 1.1 hpeyerl
899 1.1 hpeyerl static int
900 1.15 mycroft socket_send(s, mm, src)
901 1.15 mycroft struct socket *s;
902 1.15 mycroft struct mbuf *mm;
903 1.15 mycroft struct sockaddr_in *src;
904 1.1 hpeyerl {
905 1.15 mycroft if (s) {
906 1.18 mycroft if (sbappendaddr(&s->so_rcv, sintosa(src), mm, (struct mbuf *)0) != 0) {
907 1.15 mycroft sorwakeup(s);
908 1.15 mycroft return (0);
909 1.15 mycroft }
910 1.15 mycroft }
911 1.15 mycroft m_freem(mm);
912 1.15 mycroft return (-1);
913 1.1 hpeyerl }
914 1.1 hpeyerl
915 1.1 hpeyerl /*
916 1.1 hpeyerl * IP multicast forwarding function. This function assumes that the packet
917 1.1 hpeyerl * pointed to by "ip" has arrived on (or is about to be sent to) the interface
918 1.1 hpeyerl * pointed to by "ifp", and the packet is to be relayed to other networks
919 1.1 hpeyerl * that have members of the packet's destination IP multicast group.
920 1.1 hpeyerl *
921 1.15 mycroft * The packet is returned unscathed to the caller, unless it is
922 1.15 mycroft * erroneous, in which case a non-zero return value tells the caller to
923 1.1 hpeyerl * discard it.
924 1.1 hpeyerl */
925 1.1 hpeyerl
926 1.15 mycroft #define IP_HDR_LEN 20 /* # bytes of fixed IP header (excluding options) */
927 1.15 mycroft #define TUNNEL_LEN 12 /* # bytes of IP option for tunnel encapsulation */
928 1.1 hpeyerl
929 1.1 hpeyerl int
930 1.15 mycroft #ifdef RSVP_ISI
931 1.15 mycroft ip_mforward(m, ifp, imo)
932 1.15 mycroft #else
933 1.10 mycroft ip_mforward(m, ifp)
934 1.15 mycroft #endif /* RSVP_ISI */
935 1.15 mycroft struct mbuf *m;
936 1.15 mycroft struct ifnet *ifp;
937 1.15 mycroft #ifdef RSVP_ISI
938 1.15 mycroft struct ip_moptions *imo;
939 1.15 mycroft #endif /* RSVP_ISI */
940 1.1 hpeyerl {
941 1.15 mycroft register struct ip *ip = mtod(m, struct ip *);
942 1.15 mycroft register struct mfc *rt;
943 1.15 mycroft register u_char *ipoptions;
944 1.15 mycroft static int srctun = 0;
945 1.25 christos register struct mbuf *mm;
946 1.15 mycroft int s;
947 1.15 mycroft #ifdef RSVP_ISI
948 1.25 christos register struct vif *vifp;
949 1.15 mycroft vifi_t vifi;
950 1.15 mycroft #endif /* RSVP_ISI */
951 1.15 mycroft
952 1.15 mycroft if (mrtdebug & DEBUG_FORWARD)
953 1.26 christos log(LOG_DEBUG, "ip_mforward: src %x, dst %x, ifp %p",
954 1.15 mycroft ntohl(ip->ip_src.s_addr), ntohl(ip->ip_dst.s_addr), ifp);
955 1.1 hpeyerl
956 1.15 mycroft if (ip->ip_hl < (IP_HDR_LEN + TUNNEL_LEN) >> 2 ||
957 1.15 mycroft (ipoptions = (u_char *)(ip + 1))[1] != IPOPT_LSRR) {
958 1.1 hpeyerl /*
959 1.15 mycroft * Packet arrived via a physical interface or
960 1.15 mycroft * an encapuslated tunnel.
961 1.1 hpeyerl */
962 1.15 mycroft } else {
963 1.1 hpeyerl /*
964 1.15 mycroft * Packet arrived through a source-route tunnel.
965 1.15 mycroft * Source-route tunnels are no longer supported.
966 1.1 hpeyerl */
967 1.15 mycroft if ((srctun++ % 1000) == 0)
968 1.15 mycroft log(LOG_ERR, "ip_mforward: received source-routed packet from %x",
969 1.15 mycroft ntohl(ip->ip_src.s_addr));
970 1.15 mycroft
971 1.15 mycroft return (1);
972 1.15 mycroft }
973 1.15 mycroft
974 1.15 mycroft #ifdef RSVP_ISI
975 1.15 mycroft if (imo && ((vifi = imo->imo_multicast_vif) < numvifs)) {
976 1.15 mycroft if (ip->ip_ttl < 255)
977 1.15 mycroft ip->ip_ttl++; /* compensate for -1 in *_send routines */
978 1.15 mycroft if (rsvpdebug && ip->ip_p == IPPROTO_RSVP) {
979 1.15 mycroft vifp = viftable + vifi;
980 1.27 thorpej printf("Sending IPPROTO_RSVP from %x to %x on vif %d (%s%s)\n",
981 1.15 mycroft ntohl(ip->ip_src), ntohl(ip->ip_dst), vifi,
982 1.15 mycroft (vifp->v_flags & VIFF_TUNNEL) ? "tunnel on " : "",
983 1.27 thorpej vifp->v_ifp->if_xname);
984 1.15 mycroft }
985 1.15 mycroft return (ip_mdq(m, ifp, rt, vifi));
986 1.15 mycroft }
987 1.15 mycroft if (rsvpdebug && ip->ip_p == IPPROTO_RSVP) {
988 1.15 mycroft printf("Warning: IPPROTO_RSVP from %x to %x without vif option\n",
989 1.15 mycroft ntohl(ip->ip_src), ntohl(ip->ip_dst));
990 1.15 mycroft }
991 1.15 mycroft #endif /* RSVP_ISI */
992 1.15 mycroft
993 1.15 mycroft /*
994 1.15 mycroft * Don't forward a packet with time-to-live of zero or one,
995 1.15 mycroft * or a packet destined to a local-only group.
996 1.15 mycroft */
997 1.15 mycroft if (ip->ip_ttl <= 1 ||
998 1.16 mycroft IN_LOCAL_GROUP(ip->ip_dst.s_addr))
999 1.15 mycroft return (0);
1000 1.15 mycroft
1001 1.15 mycroft /*
1002 1.15 mycroft * Determine forwarding vifs from the forwarding cache table
1003 1.15 mycroft */
1004 1.24 mycroft s = splsoftnet();
1005 1.29 mycroft MFCFIND(ip->ip_src, ip->ip_dst, rt);
1006 1.1 hpeyerl
1007 1.15 mycroft /* Entry exists, so forward if necessary */
1008 1.15 mycroft if (rt != NULL) {
1009 1.15 mycroft splx(s);
1010 1.15 mycroft #ifdef RSVP_ISI
1011 1.15 mycroft return (ip_mdq(m, ifp, rt, -1));
1012 1.15 mycroft #else
1013 1.15 mycroft return (ip_mdq(m, ifp, rt));
1014 1.15 mycroft #endif /* RSVP_ISI */
1015 1.15 mycroft } else {
1016 1.1 hpeyerl /*
1017 1.15 mycroft * If we don't have a route for packet's origin,
1018 1.15 mycroft * Make a copy of the packet &
1019 1.15 mycroft * send message to routing daemon
1020 1.1 hpeyerl */
1021 1.15 mycroft
1022 1.15 mycroft register struct mbuf *mb0;
1023 1.15 mycroft register struct rtdetq *rte;
1024 1.15 mycroft register u_int32_t hash;
1025 1.15 mycroft #ifdef UPCALL_TIMING
1026 1.15 mycroft struct timeval tp;
1027 1.15 mycroft
1028 1.15 mycroft microtime(&tp);
1029 1.15 mycroft #endif /* UPCALL_TIMING */
1030 1.15 mycroft
1031 1.15 mycroft mrtstat.mrts_no_route++;
1032 1.15 mycroft if (mrtdebug & (DEBUG_FORWARD | DEBUG_MFC))
1033 1.15 mycroft log(LOG_DEBUG, "ip_mforward: no rte s %x g %x",
1034 1.15 mycroft ntohl(ip->ip_src.s_addr),
1035 1.15 mycroft ntohl(ip->ip_dst.s_addr));
1036 1.1 hpeyerl
1037 1.1 hpeyerl /*
1038 1.15 mycroft * Allocate mbufs early so that we don't do extra work if we are
1039 1.15 mycroft * just going to fail anyway.
1040 1.1 hpeyerl */
1041 1.15 mycroft rte = (struct rtdetq *)malloc(sizeof(*rte), M_MRTABLE, M_NOWAIT);
1042 1.15 mycroft if (rte == NULL) {
1043 1.15 mycroft splx(s);
1044 1.15 mycroft return (ENOBUFS);
1045 1.15 mycroft }
1046 1.15 mycroft mb0 = m_copy(m, 0, M_COPYALL);
1047 1.15 mycroft if (mb0 == NULL) {
1048 1.15 mycroft free(rte, M_MRTABLE);
1049 1.15 mycroft splx(s);
1050 1.15 mycroft return (ENOBUFS);
1051 1.15 mycroft }
1052 1.15 mycroft
1053 1.15 mycroft /* is there an upcall waiting for this packet? */
1054 1.29 mycroft hash = MFCHASH(ip->ip_src, ip->ip_dst);
1055 1.15 mycroft for (rt = mfchashtbl[hash].lh_first; rt; rt = rt->mfc_hash.le_next) {
1056 1.29 mycroft if (in_hosteq(ip->ip_src, rt->mfc_origin) &&
1057 1.29 mycroft in_hosteq(ip->ip_dst, rt->mfc_mcastgrp) &&
1058 1.15 mycroft rt->mfc_stall != NULL)
1059 1.15 mycroft break;
1060 1.1 hpeyerl }
1061 1.15 mycroft
1062 1.15 mycroft if (rt == NULL) {
1063 1.15 mycroft int hlen = ip->ip_hl << 2;
1064 1.15 mycroft int i;
1065 1.15 mycroft struct igmpmsg *im;
1066 1.15 mycroft
1067 1.15 mycroft /* no upcall, so make a new entry */
1068 1.15 mycroft rt = (struct mfc *)malloc(sizeof(*rt), M_MRTABLE, M_NOWAIT);
1069 1.15 mycroft if (rt == NULL) {
1070 1.15 mycroft free(rte, M_MRTABLE);
1071 1.15 mycroft m_free(mb0);
1072 1.15 mycroft splx(s);
1073 1.15 mycroft return (ENOBUFS);
1074 1.15 mycroft }
1075 1.15 mycroft /* Make a copy of the header to send to the user level process */
1076 1.15 mycroft mm = m_copy(m, 0, hlen);
1077 1.15 mycroft M_PULLUP(mm, hlen);
1078 1.15 mycroft if (mm == NULL) {
1079 1.15 mycroft free(rte, M_MRTABLE);
1080 1.15 mycroft m_free(mb0);
1081 1.15 mycroft free(rt, M_MRTABLE);
1082 1.15 mycroft splx(s);
1083 1.15 mycroft return (ENOBUFS);
1084 1.15 mycroft }
1085 1.15 mycroft
1086 1.15 mycroft /*
1087 1.15 mycroft * Send message to routing daemon to install
1088 1.15 mycroft * a route into the kernel table
1089 1.15 mycroft */
1090 1.15 mycroft sin.sin_addr = ip->ip_src;
1091 1.15 mycroft
1092 1.15 mycroft im = mtod(mm, struct igmpmsg *);
1093 1.15 mycroft im->im_msgtype = IGMPMSG_NOCACHE;
1094 1.15 mycroft im->im_mbz = 0;
1095 1.15 mycroft
1096 1.15 mycroft mrtstat.mrts_upcalls++;
1097 1.15 mycroft
1098 1.15 mycroft if (socket_send(ip_mrouter, mm, &sin) < 0) {
1099 1.15 mycroft log(LOG_WARNING, "ip_mforward: ip_mrouter socket queue full");
1100 1.15 mycroft ++mrtstat.mrts_upq_sockfull;
1101 1.15 mycroft free(rte, M_MRTABLE);
1102 1.15 mycroft m_free(mb0);
1103 1.15 mycroft free(rt, M_MRTABLE);
1104 1.15 mycroft splx(s);
1105 1.15 mycroft return (ENOBUFS);
1106 1.15 mycroft }
1107 1.15 mycroft
1108 1.15 mycroft /* insert new entry at head of hash chain */
1109 1.23 mycroft rt->mfc_origin = ip->ip_src;
1110 1.23 mycroft rt->mfc_mcastgrp = ip->ip_dst;
1111 1.23 mycroft rt->mfc_pkt_cnt = 0;
1112 1.23 mycroft rt->mfc_byte_cnt = 0;
1113 1.23 mycroft rt->mfc_wrong_if = 0;
1114 1.23 mycroft rt->mfc_expire = UPCALL_EXPIRE;
1115 1.15 mycroft nexpire[hash]++;
1116 1.15 mycroft for (i = 0; i < numvifs; i++)
1117 1.15 mycroft rt->mfc_ttls[i] = 0;
1118 1.15 mycroft rt->mfc_parent = -1;
1119 1.15 mycroft
1120 1.15 mycroft /* link into table */
1121 1.15 mycroft LIST_INSERT_HEAD(&mfchashtbl[hash], rt, mfc_hash);
1122 1.15 mycroft /* Add this entry to the end of the queue */
1123 1.15 mycroft rt->mfc_stall = rte;
1124 1.15 mycroft } else {
1125 1.15 mycroft /* determine if q has overflowed */
1126 1.15 mycroft struct rtdetq **p;
1127 1.15 mycroft register int npkts = 0;
1128 1.15 mycroft
1129 1.15 mycroft for (p = &rt->mfc_stall; *p != NULL; p = &(*p)->next)
1130 1.15 mycroft if (++npkts > MAX_UPQ) {
1131 1.15 mycroft mrtstat.mrts_upq_ovflw++;
1132 1.15 mycroft free(rte, M_MRTABLE);
1133 1.15 mycroft m_free(mb0);
1134 1.15 mycroft splx(s);
1135 1.15 mycroft return (0);
1136 1.15 mycroft }
1137 1.15 mycroft
1138 1.15 mycroft /* Add this entry to the end of the queue */
1139 1.15 mycroft *p = rte;
1140 1.15 mycroft }
1141 1.15 mycroft
1142 1.15 mycroft rte->next = NULL;
1143 1.15 mycroft rte->m = mb0;
1144 1.15 mycroft rte->ifp = ifp;
1145 1.15 mycroft #ifdef UPCALL_TIMING
1146 1.15 mycroft rte->t = tp;
1147 1.15 mycroft #endif /* UPCALL_TIMING */
1148 1.15 mycroft
1149 1.15 mycroft
1150 1.15 mycroft splx(s);
1151 1.15 mycroft
1152 1.15 mycroft return (0);
1153 1.15 mycroft }
1154 1.1 hpeyerl }
1155 1.1 hpeyerl
1156 1.15 mycroft
1157 1.25 christos /*ARGSUSED*/
1158 1.1 hpeyerl static void
1159 1.25 christos expire_upcalls(v)
1160 1.25 christos void *v;
1161 1.1 hpeyerl {
1162 1.15 mycroft int i;
1163 1.15 mycroft int s;
1164 1.15 mycroft
1165 1.24 mycroft s = splsoftnet();
1166 1.15 mycroft
1167 1.15 mycroft for (i = 0; i < MFCTBLSIZ; i++) {
1168 1.15 mycroft register struct mfc *rt, *nrt;
1169 1.15 mycroft
1170 1.15 mycroft if (nexpire[i] == 0)
1171 1.15 mycroft continue;
1172 1.15 mycroft
1173 1.15 mycroft for (rt = mfchashtbl[i].lh_first; rt; rt = nrt) {
1174 1.15 mycroft nrt = rt->mfc_hash.le_next;
1175 1.1 hpeyerl
1176 1.15 mycroft if (rt->mfc_expire == 0 ||
1177 1.15 mycroft --rt->mfc_expire > 0)
1178 1.15 mycroft continue;
1179 1.15 mycroft nexpire[i]--;
1180 1.15 mycroft
1181 1.15 mycroft ++mrtstat.mrts_cache_cleanups;
1182 1.15 mycroft if (mrtdebug & DEBUG_EXPIRE)
1183 1.15 mycroft log(LOG_DEBUG,
1184 1.15 mycroft "expire_upcalls: expiring (%x %x)",
1185 1.15 mycroft ntohl(rt->mfc_origin.s_addr),
1186 1.15 mycroft ntohl(rt->mfc_mcastgrp.s_addr));
1187 1.1 hpeyerl
1188 1.15 mycroft expire_mfc(rt);
1189 1.15 mycroft }
1190 1.15 mycroft }
1191 1.1 hpeyerl
1192 1.15 mycroft splx(s);
1193 1.15 mycroft timeout(expire_upcalls, (caddr_t)0, EXPIRE_TIMEOUT);
1194 1.1 hpeyerl }
1195 1.1 hpeyerl
1196 1.15 mycroft /*
1197 1.15 mycroft * Packet forwarding routine once entry in the cache is made
1198 1.15 mycroft */
1199 1.15 mycroft static int
1200 1.15 mycroft #ifdef RSVP_ISI
1201 1.15 mycroft ip_mdq(m, ifp, rt, xmt_vif)
1202 1.15 mycroft #else
1203 1.15 mycroft ip_mdq(m, ifp, rt)
1204 1.15 mycroft #endif /* RSVP_ISI */
1205 1.15 mycroft register struct mbuf *m;
1206 1.15 mycroft register struct ifnet *ifp;
1207 1.15 mycroft register struct mfc *rt;
1208 1.15 mycroft #ifdef RSVP_ISI
1209 1.15 mycroft register vifi_t xmt_vif;
1210 1.15 mycroft #endif /* RSVP_ISI */
1211 1.1 hpeyerl {
1212 1.15 mycroft register struct ip *ip = mtod(m, struct ip *);
1213 1.15 mycroft register vifi_t vifi;
1214 1.15 mycroft register struct vif *vifp;
1215 1.15 mycroft register int plen = ntohs(ip->ip_len);
1216 1.15 mycroft
1217 1.15 mycroft /*
1218 1.15 mycroft * Macro to send packet on vif. Since RSVP packets don't get counted on
1219 1.15 mycroft * input, they shouldn't get counted on output, so statistics keeping is
1220 1.15 mycroft * seperate.
1221 1.15 mycroft */
1222 1.15 mycroft #define MC_SEND(ip,vifp,m) { \
1223 1.15 mycroft if ((vifp)->v_flags & VIFF_TUNNEL) \
1224 1.15 mycroft encap_send((ip), (vifp), (m)); \
1225 1.15 mycroft else \
1226 1.15 mycroft phyint_send((ip), (vifp), (m)); \
1227 1.15 mycroft }
1228 1.1 hpeyerl
1229 1.15 mycroft #ifdef RSVP_ISI
1230 1.15 mycroft /*
1231 1.15 mycroft * If xmt_vif is not -1, send on only the requested vif.
1232 1.15 mycroft *
1233 1.15 mycroft * (since vifi_t is u_short, -1 becomes MAXUSHORT, which > numvifs.
1234 1.15 mycroft */
1235 1.15 mycroft if (xmt_vif < numvifs) {
1236 1.15 mycroft MC_SEND(ip, viftable + xmt_vif, m);
1237 1.15 mycroft return (1);
1238 1.15 mycroft }
1239 1.15 mycroft #endif /* RSVP_ISI */
1240 1.15 mycroft
1241 1.15 mycroft /*
1242 1.15 mycroft * Don't forward if it didn't arrive from the parent vif for its origin.
1243 1.15 mycroft */
1244 1.15 mycroft vifi = rt->mfc_parent;
1245 1.15 mycroft if ((vifi >= numvifs) || (viftable[vifi].v_ifp != ifp)) {
1246 1.15 mycroft /* came in the wrong interface */
1247 1.15 mycroft if (mrtdebug & DEBUG_FORWARD)
1248 1.26 christos log(LOG_DEBUG, "wrong if: ifp %p vifi %d vififp %p",
1249 1.15 mycroft ifp, vifi, viftable[vifi].v_ifp);
1250 1.15 mycroft ++mrtstat.mrts_wrong_if;
1251 1.15 mycroft ++rt->mfc_wrong_if;
1252 1.1 hpeyerl /*
1253 1.15 mycroft * If we are doing PIM assert processing, and we are forwarding
1254 1.15 mycroft * packets on this interface, and it is a broadcast medium
1255 1.15 mycroft * interface (and not a tunnel), send a message to the routing daemon.
1256 1.1 hpeyerl */
1257 1.15 mycroft if (pim_assert && rt->mfc_ttls[vifi] &&
1258 1.15 mycroft (ifp->if_flags & IFF_BROADCAST) &&
1259 1.15 mycroft !(viftable[vifi].v_flags & VIFF_TUNNEL)) {
1260 1.15 mycroft struct mbuf *mm;
1261 1.15 mycroft struct igmpmsg *im;
1262 1.15 mycroft int hlen = ip->ip_hl << 2;
1263 1.15 mycroft struct timeval now;
1264 1.15 mycroft register u_int32_t delta;
1265 1.15 mycroft
1266 1.15 mycroft microtime(&now);
1267 1.15 mycroft
1268 1.15 mycroft TV_DELTA(rt->mfc_last_assert, now, delta);
1269 1.15 mycroft
1270 1.15 mycroft if (delta > ASSERT_MSG_TIME) {
1271 1.15 mycroft mm = m_copy(m, 0, hlen);
1272 1.15 mycroft M_PULLUP(mm, hlen);
1273 1.15 mycroft if (mm == NULL) {
1274 1.15 mycroft return (ENOBUFS);
1275 1.15 mycroft }
1276 1.15 mycroft
1277 1.15 mycroft rt->mfc_last_assert = now;
1278 1.15 mycroft
1279 1.15 mycroft im = mtod(mm, struct igmpmsg *);
1280 1.15 mycroft im->im_msgtype = IGMPMSG_WRONGVIF;
1281 1.15 mycroft im->im_mbz = 0;
1282 1.15 mycroft im->im_vif = vifi;
1283 1.15 mycroft
1284 1.15 mycroft sin.sin_addr = im->im_src;
1285 1.15 mycroft
1286 1.15 mycroft socket_send(ip_mrouter, m, &sin);
1287 1.15 mycroft }
1288 1.15 mycroft }
1289 1.15 mycroft return (0);
1290 1.15 mycroft }
1291 1.15 mycroft
1292 1.15 mycroft /* If I sourced this packet, it counts as output, else it was input. */
1293 1.29 mycroft if (in_hosteq(ip->ip_src, viftable[vifi].v_lcl_addr)) {
1294 1.15 mycroft viftable[vifi].v_pkt_out++;
1295 1.15 mycroft viftable[vifi].v_bytes_out += plen;
1296 1.15 mycroft } else {
1297 1.15 mycroft viftable[vifi].v_pkt_in++;
1298 1.15 mycroft viftable[vifi].v_bytes_in += plen;
1299 1.15 mycroft }
1300 1.15 mycroft rt->mfc_pkt_cnt++;
1301 1.15 mycroft rt->mfc_byte_cnt += plen;
1302 1.15 mycroft
1303 1.15 mycroft /*
1304 1.15 mycroft * For each vif, decide if a copy of the packet should be forwarded.
1305 1.15 mycroft * Forward if:
1306 1.15 mycroft * - the ttl exceeds the vif's threshold
1307 1.15 mycroft * - there are group members downstream on interface
1308 1.15 mycroft */
1309 1.15 mycroft for (vifp = viftable, vifi = 0; vifi < numvifs; vifp++, vifi++)
1310 1.15 mycroft if ((rt->mfc_ttls[vifi] > 0) &&
1311 1.15 mycroft (ip->ip_ttl > rt->mfc_ttls[vifi])) {
1312 1.15 mycroft vifp->v_pkt_out++;
1313 1.15 mycroft vifp->v_bytes_out += plen;
1314 1.15 mycroft MC_SEND(ip, vifp, m);
1315 1.1 hpeyerl }
1316 1.1 hpeyerl
1317 1.15 mycroft return (0);
1318 1.15 mycroft }
1319 1.15 mycroft
1320 1.15 mycroft #ifdef RSVP_ISI
1321 1.15 mycroft /*
1322 1.15 mycroft * check if a vif number is legal/ok. This is used by ip_output, to export
1323 1.15 mycroft * numvifs there,
1324 1.15 mycroft */
1325 1.15 mycroft int
1326 1.15 mycroft legal_vif_num(vif)
1327 1.15 mycroft int vif;
1328 1.15 mycroft {
1329 1.15 mycroft if (vif >= 0 && vif < numvifs)
1330 1.15 mycroft return (1);
1331 1.15 mycroft else
1332 1.15 mycroft return (0);
1333 1.15 mycroft }
1334 1.15 mycroft #endif /* RSVP_ISI */
1335 1.15 mycroft
1336 1.15 mycroft static void
1337 1.15 mycroft phyint_send(ip, vifp, m)
1338 1.15 mycroft struct ip *ip;
1339 1.15 mycroft struct vif *vifp;
1340 1.15 mycroft struct mbuf *m;
1341 1.15 mycroft {
1342 1.15 mycroft register struct mbuf *mb_copy;
1343 1.15 mycroft register int hlen = ip->ip_hl << 2;
1344 1.15 mycroft
1345 1.15 mycroft /*
1346 1.15 mycroft * Make a new reference to the packet; make sure that
1347 1.15 mycroft * the IP header is actually copied, not just referenced,
1348 1.15 mycroft * so that ip_output() only scribbles on the copy.
1349 1.15 mycroft */
1350 1.12 brezak mb_copy = m_copy(m, 0, M_COPYALL);
1351 1.15 mycroft M_PULLUP(mb_copy, hlen);
1352 1.1 hpeyerl if (mb_copy == NULL)
1353 1.1 hpeyerl return;
1354 1.1 hpeyerl
1355 1.15 mycroft if (vifp->v_rate_limit <= 0)
1356 1.15 mycroft tbf_send_packet(vifp, mb_copy);
1357 1.15 mycroft else
1358 1.15 mycroft tbf_control(vifp, mb_copy, mtod(mb_copy, struct ip *), ip->ip_len);
1359 1.12 brezak }
1360 1.12 brezak
1361 1.12 brezak static void
1362 1.12 brezak encap_send(ip, vifp, m)
1363 1.12 brezak register struct ip *ip;
1364 1.12 brezak register struct vif *vifp;
1365 1.12 brezak register struct mbuf *m;
1366 1.12 brezak {
1367 1.12 brezak register struct mbuf *mb_copy;
1368 1.12 brezak register struct ip *ip_copy;
1369 1.15 mycroft register int i, len = ip->ip_len + sizeof(multicast_encap_iphdr);
1370 1.12 brezak
1371 1.12 brezak /*
1372 1.12 brezak * copy the old packet & pullup it's IP header into the
1373 1.12 brezak * new mbuf so we can modify it. Try to fill the new
1374 1.12 brezak * mbuf since if we don't the ethernet driver will.
1375 1.12 brezak */
1376 1.15 mycroft MGETHDR(mb_copy, M_DONTWAIT, MT_DATA);
1377 1.12 brezak if (mb_copy == NULL)
1378 1.12 brezak return;
1379 1.15 mycroft mb_copy->m_data += max_linkhdr;
1380 1.15 mycroft mb_copy->m_pkthdr.len = len;
1381 1.12 brezak mb_copy->m_len = sizeof(multicast_encap_iphdr);
1382 1.15 mycroft
1383 1.12 brezak if ((mb_copy->m_next = m_copy(m, 0, M_COPYALL)) == NULL) {
1384 1.12 brezak m_freem(mb_copy);
1385 1.12 brezak return;
1386 1.12 brezak }
1387 1.15 mycroft i = MHLEN - max_linkhdr;
1388 1.12 brezak if (i > len)
1389 1.12 brezak i = len;
1390 1.12 brezak mb_copy = m_pullup(mb_copy, i);
1391 1.12 brezak if (mb_copy == NULL)
1392 1.12 brezak return;
1393 1.15 mycroft
1394 1.12 brezak /*
1395 1.12 brezak * fill in the encapsulating IP header.
1396 1.12 brezak */
1397 1.12 brezak ip_copy = mtod(mb_copy, struct ip *);
1398 1.12 brezak *ip_copy = multicast_encap_iphdr;
1399 1.12 brezak ip_copy->ip_id = htons(ip_id++);
1400 1.15 mycroft ip_copy->ip_len = len;
1401 1.12 brezak ip_copy->ip_src = vifp->v_lcl_addr;
1402 1.12 brezak ip_copy->ip_dst = vifp->v_rmt_addr;
1403 1.15 mycroft
1404 1.12 brezak /*
1405 1.12 brezak * turn the encapsulated IP header back into a valid one.
1406 1.12 brezak */
1407 1.12 brezak ip = (struct ip *)((caddr_t)ip_copy + sizeof(multicast_encap_iphdr));
1408 1.12 brezak --ip->ip_ttl;
1409 1.12 brezak HTONS(ip->ip_len);
1410 1.12 brezak HTONS(ip->ip_off);
1411 1.12 brezak ip->ip_sum = 0;
1412 1.12 brezak #if defined(LBL) && !defined(ultrix) && !defined(i386)
1413 1.12 brezak ip->ip_sum = ~oc_cksum((caddr_t)ip, ip->ip_hl << 2, 0);
1414 1.12 brezak #else
1415 1.12 brezak mb_copy->m_data += sizeof(multicast_encap_iphdr);
1416 1.12 brezak ip->ip_sum = in_cksum(mb_copy, ip->ip_hl << 2);
1417 1.12 brezak mb_copy->m_data -= sizeof(multicast_encap_iphdr);
1418 1.12 brezak #endif
1419 1.15 mycroft
1420 1.15 mycroft if (vifp->v_rate_limit <= 0)
1421 1.15 mycroft tbf_send_packet(vifp, mb_copy);
1422 1.15 mycroft else
1423 1.15 mycroft tbf_control(vifp, mb_copy, ip, ip_copy->ip_len);
1424 1.12 brezak }
1425 1.12 brezak
1426 1.12 brezak /*
1427 1.12 brezak * De-encapsulate a packet and feed it back through ip input (this
1428 1.12 brezak * routine is called whenever IP gets a packet with proto type
1429 1.12 brezak * ENCAP_PROTO and a local destination address).
1430 1.12 brezak */
1431 1.15 mycroft void
1432 1.25 christos #if __STDC__
1433 1.25 christos ipip_input(struct mbuf *m, ...)
1434 1.25 christos #else
1435 1.25 christos ipip_input(m, va_alist)
1436 1.25 christos struct mbuf *m;
1437 1.25 christos va_dcl
1438 1.25 christos #endif
1439 1.25 christos {
1440 1.15 mycroft register int hlen;
1441 1.12 brezak register struct ip *ip = mtod(m, struct ip *);
1442 1.12 brezak register int s;
1443 1.12 brezak register struct ifqueue *ifq;
1444 1.12 brezak register struct vif *vifp;
1445 1.25 christos va_list ap;
1446 1.25 christos
1447 1.25 christos va_start(ap, m);
1448 1.25 christos hlen = va_arg(ap, int);
1449 1.25 christos va_end(ap);
1450 1.12 brezak
1451 1.15 mycroft if (!have_encap_tunnel) {
1452 1.15 mycroft rip_input(m);
1453 1.12 brezak return;
1454 1.12 brezak }
1455 1.22 mycroft
1456 1.12 brezak /*
1457 1.12 brezak * dump the packet if it's not to a multicast destination or if
1458 1.12 brezak * we don't have an encapsulating tunnel with the source.
1459 1.12 brezak * Note: This code assumes that the remote site IP address
1460 1.12 brezak * uniquely identifies the tunnel (i.e., that this site has
1461 1.12 brezak * at most one tunnel with the remote site).
1462 1.12 brezak */
1463 1.16 mycroft if (!IN_MULTICAST(((struct ip *)((char *)ip + hlen))->ip_dst.s_addr)) {
1464 1.12 brezak ++mrtstat.mrts_bad_tunnel;
1465 1.12 brezak m_freem(m);
1466 1.12 brezak return;
1467 1.12 brezak }
1468 1.22 mycroft
1469 1.29 mycroft if (!in_hosteq(ip->ip_src, last_encap_src)) {
1470 1.12 brezak register struct vif *vife;
1471 1.15 mycroft
1472 1.12 brezak vifp = viftable;
1473 1.12 brezak vife = vifp + numvifs;
1474 1.22 mycroft for (; vifp < vife; vifp++)
1475 1.22 mycroft if (vifp->v_flags & VIFF_TUNNEL &&
1476 1.29 mycroft in_hosteq(vifp->v_rmt_addr, ip->ip_src))
1477 1.22 mycroft break;
1478 1.22 mycroft if (vifp == vife) {
1479 1.22 mycroft mrtstat.mrts_cant_tunnel++; /*XXX*/
1480 1.22 mycroft m_freem(m);
1481 1.22 mycroft if (mrtdebug)
1482 1.22 mycroft log(LOG_DEBUG, "ip_mforward: no tunnel with %x",
1483 1.22 mycroft ntohl(ip->ip_src.s_addr));
1484 1.22 mycroft return;
1485 1.22 mycroft }
1486 1.22 mycroft last_encap_vif = vifp;
1487 1.29 mycroft last_encap_src = ip->ip_src;
1488 1.22 mycroft } else
1489 1.22 mycroft vifp = last_encap_vif;
1490 1.22 mycroft
1491 1.12 brezak m->m_data += hlen;
1492 1.12 brezak m->m_len -= hlen;
1493 1.12 brezak m->m_pkthdr.len -= hlen;
1494 1.15 mycroft m->m_pkthdr.rcvif = vifp->v_ifp;
1495 1.12 brezak ifq = &ipintrq;
1496 1.12 brezak s = splimp();
1497 1.12 brezak if (IF_QFULL(ifq)) {
1498 1.12 brezak IF_DROP(ifq);
1499 1.12 brezak m_freem(m);
1500 1.12 brezak } else {
1501 1.12 brezak IF_ENQUEUE(ifq, m);
1502 1.12 brezak /*
1503 1.12 brezak * normally we would need a "schednetisr(NETISR_IP)"
1504 1.12 brezak * here but we were called by ip_input and it is going
1505 1.12 brezak * to loop back & try to dequeue the packet we just
1506 1.12 brezak * queued as soon as we return so we avoid the
1507 1.12 brezak * unnecessary software interrrupt.
1508 1.12 brezak */
1509 1.12 brezak }
1510 1.12 brezak splx(s);
1511 1.1 hpeyerl }
1512 1.15 mycroft
1513 1.15 mycroft /*
1514 1.15 mycroft * Token bucket filter module
1515 1.15 mycroft */
1516 1.15 mycroft static void
1517 1.15 mycroft tbf_control(vifp, m, ip, p_len)
1518 1.21 mycroft register struct vif *vifp;
1519 1.21 mycroft register struct mbuf *m;
1520 1.21 mycroft register struct ip *ip;
1521 1.21 mycroft register u_int32_t p_len;
1522 1.15 mycroft {
1523 1.15 mycroft
1524 1.21 mycroft tbf_update_tokens(vifp);
1525 1.15 mycroft
1526 1.21 mycroft /*
1527 1.21 mycroft * If there are enough tokens, and the queue is empty, send this packet
1528 1.21 mycroft * out immediately. Otherwise, try to insert it on this vif's queue.
1529 1.21 mycroft */
1530 1.21 mycroft if (vifp->v_tbf.q_len == 0) {
1531 1.21 mycroft if (p_len <= vifp->v_tbf.n_tok) {
1532 1.21 mycroft vifp->v_tbf.n_tok -= p_len;
1533 1.21 mycroft tbf_send_packet(vifp, m);
1534 1.21 mycroft } else if (p_len > MAX_BKT_SIZE) {
1535 1.21 mycroft /* drop if packet is too large */
1536 1.21 mycroft mrtstat.mrts_pkt2large++;
1537 1.21 mycroft m_freem(m);
1538 1.21 mycroft } else {
1539 1.21 mycroft /* queue packet and timeout till later */
1540 1.21 mycroft tbf_queue(vifp, m, ip);
1541 1.21 mycroft timeout(tbf_reprocess_q, vifp, 1);
1542 1.21 mycroft }
1543 1.15 mycroft } else {
1544 1.21 mycroft if (vifp->v_tbf.q_len >= MAXQSIZE &&
1545 1.21 mycroft !tbf_dq_sel(vifp, ip)) {
1546 1.21 mycroft /* queue length too much, and couldn't make room */
1547 1.21 mycroft mrtstat.mrts_q_overflow++;
1548 1.21 mycroft m_freem(m);
1549 1.21 mycroft } else {
1550 1.21 mycroft /* queue length low enough, or made room */
1551 1.21 mycroft tbf_queue(vifp, m, ip);
1552 1.21 mycroft tbf_process_q(vifp);
1553 1.21 mycroft }
1554 1.15 mycroft }
1555 1.15 mycroft }
1556 1.15 mycroft
1557 1.15 mycroft /*
1558 1.15 mycroft * adds a packet to the queue at the interface
1559 1.15 mycroft */
1560 1.15 mycroft static void
1561 1.15 mycroft tbf_queue(vifp, m, ip)
1562 1.15 mycroft register struct vif *vifp;
1563 1.15 mycroft register struct mbuf *m;
1564 1.15 mycroft register struct ip *ip;
1565 1.15 mycroft {
1566 1.15 mycroft register u_int32_t ql;
1567 1.15 mycroft register int index = (vifp - viftable);
1568 1.24 mycroft register int s = splsoftnet();
1569 1.15 mycroft
1570 1.15 mycroft ql = vifp->v_tbf.q_len;
1571 1.15 mycroft
1572 1.15 mycroft qtable[index][ql].pkt_m = m;
1573 1.15 mycroft qtable[index][ql].pkt_len = (mtod(m, struct ip *))->ip_len;
1574 1.15 mycroft qtable[index][ql].pkt_ip = ip;
1575 1.15 mycroft
1576 1.15 mycroft vifp->v_tbf.q_len++;
1577 1.15 mycroft splx(s);
1578 1.15 mycroft }
1579 1.15 mycroft
1580 1.15 mycroft
1581 1.15 mycroft /*
1582 1.15 mycroft * processes the queue at the interface
1583 1.15 mycroft */
1584 1.15 mycroft static void
1585 1.15 mycroft tbf_process_q(vifp)
1586 1.15 mycroft register struct vif *vifp;
1587 1.15 mycroft {
1588 1.15 mycroft register struct pkt_queue pkt_1;
1589 1.15 mycroft register int index = (vifp - viftable);
1590 1.24 mycroft register int s = splsoftnet();
1591 1.15 mycroft
1592 1.15 mycroft /* loop through the queue at the interface and send as many packets
1593 1.15 mycroft * as possible
1594 1.15 mycroft */
1595 1.15 mycroft while (vifp->v_tbf.q_len > 0) {
1596 1.15 mycroft /* locate the first packet */
1597 1.15 mycroft pkt_1 = qtable[index][0];
1598 1.15 mycroft
1599 1.15 mycroft /* determine if the packet can be sent */
1600 1.15 mycroft if (pkt_1.pkt_len <= vifp->v_tbf.n_tok) {
1601 1.15 mycroft /* if so,
1602 1.15 mycroft * reduce no of tokens, dequeue the queue,
1603 1.15 mycroft * send the packet.
1604 1.15 mycroft */
1605 1.15 mycroft vifp->v_tbf.n_tok -= pkt_1.pkt_len;
1606 1.15 mycroft
1607 1.15 mycroft tbf_dequeue(vifp, 0);
1608 1.15 mycroft tbf_send_packet(vifp, pkt_1.pkt_m);
1609 1.15 mycroft } else
1610 1.15 mycroft break;
1611 1.15 mycroft }
1612 1.15 mycroft splx(s);
1613 1.15 mycroft }
1614 1.15 mycroft
1615 1.15 mycroft /*
1616 1.15 mycroft * removes the jth packet from the queue at the interface
1617 1.15 mycroft */
1618 1.15 mycroft static void
1619 1.15 mycroft tbf_dequeue(vifp, j)
1620 1.15 mycroft register struct vif *vifp;
1621 1.15 mycroft register int j;
1622 1.15 mycroft {
1623 1.15 mycroft register u_int32_t index = vifp - viftable;
1624 1.15 mycroft register int i;
1625 1.15 mycroft
1626 1.15 mycroft for (i=j+1; i <= vifp->v_tbf.q_len - 1; i++) {
1627 1.15 mycroft qtable[index][i-1] = qtable[index][i];
1628 1.15 mycroft }
1629 1.15 mycroft qtable[index][i-1].pkt_m = NULL;
1630 1.15 mycroft qtable[index][i-1].pkt_len = NULL;
1631 1.15 mycroft qtable[index][i-1].pkt_ip = NULL;
1632 1.15 mycroft
1633 1.15 mycroft vifp->v_tbf.q_len--;
1634 1.15 mycroft
1635 1.15 mycroft if (tbfdebug > 1)
1636 1.15 mycroft log(LOG_DEBUG, "tbf_dequeue: vif# %d qlen %d",vifp-viftable, i-1);
1637 1.15 mycroft }
1638 1.15 mycroft
1639 1.15 mycroft static void
1640 1.20 mycroft tbf_reprocess_q(arg)
1641 1.20 mycroft void *arg;
1642 1.15 mycroft {
1643 1.20 mycroft register struct vif *vifp = arg;
1644 1.15 mycroft
1645 1.20 mycroft if (ip_mrouter == NULL)
1646 1.20 mycroft return;
1647 1.15 mycroft
1648 1.20 mycroft tbf_update_tokens(vifp);
1649 1.20 mycroft tbf_process_q(vifp);
1650 1.15 mycroft
1651 1.20 mycroft if (vifp->v_tbf.q_len)
1652 1.20 mycroft timeout(tbf_reprocess_q, vifp, 1);
1653 1.15 mycroft }
1654 1.15 mycroft
1655 1.15 mycroft /* function that will selectively discard a member of the queue
1656 1.15 mycroft * based on the precedence value and the priority obtained through
1657 1.15 mycroft * a lookup table - not yet implemented accurately!
1658 1.15 mycroft */
1659 1.15 mycroft static int
1660 1.15 mycroft tbf_dq_sel(vifp, ip)
1661 1.15 mycroft register struct vif *vifp;
1662 1.15 mycroft register struct ip *ip;
1663 1.15 mycroft {
1664 1.15 mycroft register int i;
1665 1.24 mycroft register int s = splsoftnet();
1666 1.15 mycroft register u_int p;
1667 1.15 mycroft
1668 1.15 mycroft p = priority(vifp, ip);
1669 1.15 mycroft
1670 1.15 mycroft for(i=vifp->v_tbf.q_len-1;i >= 0;i--) {
1671 1.15 mycroft if (p > priority(vifp, qtable[vifp-viftable][i].pkt_ip)) {
1672 1.15 mycroft m_freem(qtable[vifp-viftable][i].pkt_m);
1673 1.15 mycroft tbf_dequeue(vifp, i);
1674 1.15 mycroft splx(s);
1675 1.15 mycroft mrtstat.mrts_drop_sel++;
1676 1.15 mycroft return (1);
1677 1.15 mycroft }
1678 1.15 mycroft }
1679 1.15 mycroft splx(s);
1680 1.15 mycroft return (0);
1681 1.15 mycroft }
1682 1.15 mycroft
1683 1.15 mycroft static void
1684 1.15 mycroft tbf_send_packet(vifp,m)
1685 1.15 mycroft register struct vif *vifp;
1686 1.15 mycroft register struct mbuf *m;
1687 1.15 mycroft {
1688 1.15 mycroft int error;
1689 1.24 mycroft int s = splsoftnet();
1690 1.15 mycroft
1691 1.15 mycroft if (vifp->v_flags & VIFF_TUNNEL) {
1692 1.15 mycroft /* If tunnel options */
1693 1.15 mycroft ip_output(m, (struct mbuf *)0, &vifp->v_route,
1694 1.15 mycroft IP_FORWARDING, NULL);
1695 1.15 mycroft } else {
1696 1.15 mycroft /* if physical interface option, extract the options and then send */
1697 1.15 mycroft struct ip *ip = mtod(m, struct ip *);
1698 1.15 mycroft struct ip_moptions imo;
1699 1.15 mycroft imo.imo_multicast_ifp = vifp->v_ifp;
1700 1.15 mycroft imo.imo_multicast_ttl = ip->ip_ttl - 1;
1701 1.15 mycroft imo.imo_multicast_loop = 1;
1702 1.15 mycroft #ifdef RSVP_ISI
1703 1.15 mycroft imo.imo_multicast_vif = -1;
1704 1.1 hpeyerl #endif
1705 1.15 mycroft
1706 1.15 mycroft error = ip_output(m, (struct mbuf *)0, (struct route *)0,
1707 1.15 mycroft IP_FORWARDING|IP_MULTICASTOPTS, &imo);
1708 1.15 mycroft if (mrtdebug & DEBUG_XMIT)
1709 1.15 mycroft log(LOG_DEBUG, "phyint_send on vif %d err %d", vifp-viftable, error);
1710 1.15 mycroft }
1711 1.15 mycroft splx(s);
1712 1.15 mycroft }
1713 1.15 mycroft
1714 1.15 mycroft /* determine the current time and then
1715 1.15 mycroft * the elapsed time (between the last time and time now)
1716 1.15 mycroft * in milliseconds & update the no. of tokens in the bucket
1717 1.15 mycroft */
1718 1.15 mycroft static void
1719 1.15 mycroft tbf_update_tokens(vifp)
1720 1.15 mycroft register struct vif *vifp;
1721 1.15 mycroft {
1722 1.15 mycroft struct timeval tp;
1723 1.15 mycroft register u_int32_t t;
1724 1.15 mycroft register u_int32_t elapsed;
1725 1.24 mycroft register int s = splsoftnet();
1726 1.15 mycroft
1727 1.15 mycroft microtime(&tp);
1728 1.15 mycroft
1729 1.15 mycroft t = tp.tv_sec*1000 + tp.tv_usec/1000;
1730 1.15 mycroft
1731 1.15 mycroft elapsed = (t - vifp->v_tbf.last_pkt_t) * vifp->v_rate_limit /8;
1732 1.15 mycroft vifp->v_tbf.n_tok += elapsed;
1733 1.15 mycroft vifp->v_tbf.last_pkt_t = t;
1734 1.15 mycroft
1735 1.15 mycroft if (vifp->v_tbf.n_tok > MAX_BKT_SIZE)
1736 1.15 mycroft vifp->v_tbf.n_tok = MAX_BKT_SIZE;
1737 1.15 mycroft
1738 1.15 mycroft splx(s);
1739 1.15 mycroft }
1740 1.15 mycroft
1741 1.15 mycroft static int
1742 1.15 mycroft priority(vifp, ip)
1743 1.15 mycroft register struct vif *vifp;
1744 1.15 mycroft register struct ip *ip;
1745 1.15 mycroft {
1746 1.15 mycroft register int prio;
1747 1.15 mycroft
1748 1.15 mycroft /* temporary hack; may add general packet classifier some day */
1749 1.15 mycroft
1750 1.15 mycroft /*
1751 1.15 mycroft * The UDP port space is divided up into four priority ranges:
1752 1.15 mycroft * [0, 16384) : unclassified - lowest priority
1753 1.15 mycroft * [16384, 32768) : audio - highest priority
1754 1.15 mycroft * [32768, 49152) : whiteboard - medium priority
1755 1.15 mycroft * [49152, 65536) : video - low priority
1756 1.15 mycroft */
1757 1.15 mycroft if (ip->ip_p == IPPROTO_UDP) {
1758 1.15 mycroft struct udphdr *udp = (struct udphdr *)(((char *)ip) + (ip->ip_hl << 2));
1759 1.15 mycroft
1760 1.15 mycroft switch (ntohs(udp->uh_dport) & 0xc000) {
1761 1.15 mycroft case 0x4000:
1762 1.15 mycroft prio = 70;
1763 1.15 mycroft break;
1764 1.15 mycroft case 0x8000:
1765 1.15 mycroft prio = 60;
1766 1.15 mycroft break;
1767 1.15 mycroft case 0xc000:
1768 1.15 mycroft prio = 55;
1769 1.15 mycroft break;
1770 1.15 mycroft default:
1771 1.15 mycroft prio = 50;
1772 1.15 mycroft break;
1773 1.15 mycroft }
1774 1.15 mycroft
1775 1.15 mycroft if (tbfdebug > 1) log(LOG_DEBUG, "port %x prio %d", ntohs(udp->uh_dport), prio);
1776 1.15 mycroft } else
1777 1.15 mycroft prio = 50;
1778 1.15 mycroft
1779 1.15 mycroft
1780 1.15 mycroft return (prio);
1781 1.15 mycroft }
1782 1.15 mycroft
1783 1.15 mycroft /*
1784 1.15 mycroft * End of token bucket filter modifications
1785 1.15 mycroft */
1786 1.15 mycroft
1787 1.15 mycroft #ifdef RSVP_ISI
1788 1.15 mycroft
1789 1.15 mycroft int
1790 1.15 mycroft ip_rsvp_vif_init(so, m)
1791 1.15 mycroft struct socket *so;
1792 1.15 mycroft struct mbuf *m;
1793 1.15 mycroft {
1794 1.15 mycroft int i;
1795 1.15 mycroft register int s;
1796 1.15 mycroft
1797 1.15 mycroft if (rsvpdebug)
1798 1.15 mycroft printf("ip_rsvp_vif_init: so_type = %d, pr_protocol = %d\n",
1799 1.15 mycroft so->so_type, so->so_proto->pr_protocol);
1800 1.15 mycroft
1801 1.15 mycroft if (so->so_type != SOCK_RAW || so->so_proto->pr_protocol != IPPROTO_RSVP)
1802 1.15 mycroft return (EOPNOTSUPP);
1803 1.15 mycroft
1804 1.15 mycroft /* Check mbuf. */
1805 1.15 mycroft if (m == NULL || m->m_len != sizeof(int)) {
1806 1.15 mycroft return (EINVAL);
1807 1.15 mycroft }
1808 1.15 mycroft i = *(mtod(m, int *));
1809 1.15 mycroft
1810 1.15 mycroft if (rsvpdebug)
1811 1.15 mycroft printf("ip_rsvp_vif_init: vif = %d rsvp_on = %d\n",i,rsvp_on);
1812 1.15 mycroft
1813 1.24 mycroft s = splsoftnet();
1814 1.15 mycroft
1815 1.15 mycroft /* Check vif. */
1816 1.15 mycroft if (!legal_vif_num(i)) {
1817 1.15 mycroft splx(s);
1818 1.15 mycroft return (EADDRNOTAVAIL);
1819 1.15 mycroft }
1820 1.15 mycroft
1821 1.15 mycroft /* Check if socket is available. */
1822 1.15 mycroft if (viftable[i].v_rsvpd != NULL) {
1823 1.15 mycroft splx(s);
1824 1.15 mycroft return (EADDRINUSE);
1825 1.15 mycroft }
1826 1.15 mycroft
1827 1.15 mycroft viftable[i].v_rsvpd = so;
1828 1.15 mycroft /* This may seem silly, but we need to be sure we don't over-increment
1829 1.15 mycroft * the RSVP counter, in case something slips up.
1830 1.15 mycroft */
1831 1.15 mycroft if (!viftable[i].v_rsvp_on) {
1832 1.15 mycroft viftable[i].v_rsvp_on = 1;
1833 1.15 mycroft rsvp_on++;
1834 1.15 mycroft }
1835 1.15 mycroft
1836 1.15 mycroft splx(s);
1837 1.15 mycroft return (0);
1838 1.15 mycroft }
1839 1.15 mycroft
1840 1.15 mycroft int
1841 1.15 mycroft ip_rsvp_vif_done(so, m)
1842 1.15 mycroft struct socket *so;
1843 1.15 mycroft struct mbuf *m;
1844 1.15 mycroft {
1845 1.15 mycroft int i;
1846 1.15 mycroft register int s;
1847 1.15 mycroft
1848 1.15 mycroft if (rsvpdebug)
1849 1.15 mycroft printf("ip_rsvp_vif_done: so_type = %d, pr_protocol = %d\n",
1850 1.15 mycroft so->so_type, so->so_proto->pr_protocol);
1851 1.15 mycroft
1852 1.15 mycroft if (so->so_type != SOCK_RAW || so->so_proto->pr_protocol != IPPROTO_RSVP)
1853 1.15 mycroft return (EOPNOTSUPP);
1854 1.15 mycroft
1855 1.15 mycroft /* Check mbuf. */
1856 1.15 mycroft if (m == NULL || m->m_len != sizeof(int)) {
1857 1.15 mycroft return (EINVAL);
1858 1.15 mycroft }
1859 1.15 mycroft i = *(mtod(m, int *));
1860 1.15 mycroft
1861 1.24 mycroft s = splsoftnet();
1862 1.15 mycroft
1863 1.15 mycroft /* Check vif. */
1864 1.15 mycroft if (!legal_vif_num(i)) {
1865 1.15 mycroft splx(s);
1866 1.15 mycroft return (EADDRNOTAVAIL);
1867 1.15 mycroft }
1868 1.15 mycroft
1869 1.15 mycroft if (rsvpdebug)
1870 1.15 mycroft printf("ip_rsvp_vif_done: v_rsvpd = %x so = %x\n",
1871 1.15 mycroft viftable[i].v_rsvpd, so);
1872 1.15 mycroft
1873 1.15 mycroft viftable[i].v_rsvpd = NULL;
1874 1.15 mycroft /* This may seem silly, but we need to be sure we don't over-decrement
1875 1.15 mycroft * the RSVP counter, in case something slips up.
1876 1.15 mycroft */
1877 1.15 mycroft if (viftable[i].v_rsvp_on) {
1878 1.15 mycroft viftable[i].v_rsvp_on = 0;
1879 1.15 mycroft rsvp_on--;
1880 1.15 mycroft }
1881 1.15 mycroft
1882 1.15 mycroft splx(s);
1883 1.15 mycroft return (0);
1884 1.15 mycroft }
1885 1.15 mycroft
1886 1.25 christos void
1887 1.15 mycroft ip_rsvp_force_done(so)
1888 1.15 mycroft struct socket *so;
1889 1.15 mycroft {
1890 1.15 mycroft int vifi;
1891 1.15 mycroft register int s;
1892 1.15 mycroft
1893 1.15 mycroft /* Don't bother if it is not the right type of socket. */
1894 1.15 mycroft if (so->so_type != SOCK_RAW || so->so_proto->pr_protocol != IPPROTO_RSVP)
1895 1.15 mycroft return;
1896 1.15 mycroft
1897 1.24 mycroft s = splsoftnet();
1898 1.15 mycroft
1899 1.15 mycroft /* The socket may be attached to more than one vif...this
1900 1.15 mycroft * is perfectly legal.
1901 1.15 mycroft */
1902 1.15 mycroft for (vifi = 0; vifi < numvifs; vifi++) {
1903 1.15 mycroft if (viftable[vifi].v_rsvpd == so) {
1904 1.15 mycroft viftable[vifi].v_rsvpd = NULL;
1905 1.15 mycroft /* This may seem silly, but we need to be sure we don't
1906 1.15 mycroft * over-decrement the RSVP counter, in case something slips up.
1907 1.15 mycroft */
1908 1.15 mycroft if (viftable[vifi].v_rsvp_on) {
1909 1.15 mycroft viftable[vifi].v_rsvp_on = 0;
1910 1.15 mycroft rsvp_on--;
1911 1.15 mycroft }
1912 1.15 mycroft }
1913 1.15 mycroft }
1914 1.15 mycroft
1915 1.15 mycroft splx(s);
1916 1.15 mycroft return;
1917 1.15 mycroft }
1918 1.15 mycroft
1919 1.25 christos void
1920 1.15 mycroft rsvp_input(m, ifp)
1921 1.15 mycroft struct mbuf *m;
1922 1.15 mycroft struct ifnet *ifp;
1923 1.15 mycroft {
1924 1.15 mycroft int vifi;
1925 1.15 mycroft register struct ip *ip = mtod(m, struct ip *);
1926 1.15 mycroft static struct sockaddr_in rsvp_src = { sizeof(sin), AF_INET };
1927 1.15 mycroft register int s;
1928 1.15 mycroft
1929 1.15 mycroft if (rsvpdebug)
1930 1.15 mycroft printf("rsvp_input: rsvp_on %d\n",rsvp_on);
1931 1.15 mycroft
1932 1.15 mycroft /* Can still get packets with rsvp_on = 0 if there is a local member
1933 1.15 mycroft * of the group to which the RSVP packet is addressed. But in this
1934 1.15 mycroft * case we want to throw the packet away.
1935 1.15 mycroft */
1936 1.15 mycroft if (!rsvp_on) {
1937 1.15 mycroft m_freem(m);
1938 1.15 mycroft return;
1939 1.15 mycroft }
1940 1.15 mycroft
1941 1.15 mycroft /* If the old-style non-vif-associated socket is set, then use
1942 1.15 mycroft * it and ignore the new ones.
1943 1.15 mycroft */
1944 1.15 mycroft if (ip_rsvpd != NULL) {
1945 1.15 mycroft if (rsvpdebug)
1946 1.15 mycroft printf("rsvp_input: Sending packet up old-style socket\n");
1947 1.15 mycroft rip_input(m);
1948 1.15 mycroft return;
1949 1.15 mycroft }
1950 1.15 mycroft
1951 1.24 mycroft s = splsoftnet();
1952 1.15 mycroft
1953 1.15 mycroft if (rsvpdebug)
1954 1.15 mycroft printf("rsvp_input: check vifs\n");
1955 1.15 mycroft
1956 1.15 mycroft /* Find which vif the packet arrived on. */
1957 1.15 mycroft for (vifi = 0; vifi < numvifs; vifi++) {
1958 1.15 mycroft if (viftable[vifi].v_ifp == ifp)
1959 1.15 mycroft break;
1960 1.15 mycroft }
1961 1.15 mycroft
1962 1.15 mycroft if (vifi == numvifs) {
1963 1.15 mycroft /* Can't find vif packet arrived on. Drop packet. */
1964 1.15 mycroft if (rsvpdebug)
1965 1.15 mycroft printf("rsvp_input: Can't find vif for packet...dropping it.\n");
1966 1.15 mycroft m_freem(m);
1967 1.15 mycroft splx(s);
1968 1.15 mycroft return;
1969 1.15 mycroft }
1970 1.15 mycroft
1971 1.15 mycroft if (rsvpdebug)
1972 1.15 mycroft printf("rsvp_input: check socket\n");
1973 1.15 mycroft
1974 1.15 mycroft if (viftable[vifi].v_rsvpd == NULL) {
1975 1.15 mycroft /* drop packet, since there is no specific socket for this
1976 1.15 mycroft * interface */
1977 1.15 mycroft if (rsvpdebug)
1978 1.15 mycroft printf("rsvp_input: No socket defined for vif %d\n",vifi);
1979 1.15 mycroft m_freem(m);
1980 1.15 mycroft splx(s);
1981 1.15 mycroft return;
1982 1.15 mycroft }
1983 1.15 mycroft
1984 1.15 mycroft rsvp_src.sin_addr = ip->ip_src;
1985 1.15 mycroft
1986 1.15 mycroft if (rsvpdebug && m)
1987 1.15 mycroft printf("rsvp_input: m->m_len = %d, sbspace() = %d\n",
1988 1.15 mycroft m->m_len,sbspace(&viftable[vifi].v_rsvpd->so_rcv));
1989 1.15 mycroft
1990 1.15 mycroft if (socket_send(viftable[vifi].v_rsvpd, m, &rsvp_src) < 0)
1991 1.15 mycroft if (rsvpdebug)
1992 1.15 mycroft printf("rsvp_input: Failed to append to socket\n");
1993 1.15 mycroft else
1994 1.15 mycroft if (rsvpdebug)
1995 1.15 mycroft printf("rsvp_input: send packet up\n");
1996 1.15 mycroft
1997 1.15 mycroft splx(s);
1998 1.15 mycroft }
1999 1.15 mycroft #endif /* RSVP_ISI */
2000