?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Patrick Welche <prlw1@cam.ac.uk>
[netbsd-mini2440.git] / usr.sbin / mrouted / prune.c
blob03cbea28bfbd5c1c03f67701fae27b62053c1408
1 /* $NetBSD: prune.c,v 1.17 2006/05/25 01:41:13 christos Exp $ */
2
3 /*
4 * The mrouted program is covered by the license in the accompanying file
5 * named "LICENSE". Use of the mrouted program represents acceptance of
6 * the terms and conditions listed in that file.
7 *
8 * The mrouted program is COPYRIGHT 1989 by The Board of Trustees of
9 * Leland Stanford Junior University.
10 */
11
12
13 #include "defs.h"
14
15 extern int cache_lifetime;
16 extern int max_prune_lifetime;
17 extern struct rtentry *routing_table;
18
19 extern int phys_vif;
20
21 /*
22 * dither cache lifetime to obtain a value between x and 2*x
23 */
24 #define CACHE_LIFETIME(x) ((x) + (arc4random() % (x)))
25
26 #define CHK_GS(x, y) { \
27 switch(x) { \
28 case 2: \
29 case 4: \
30 case 8: \
31 case 16: \
32 case 32: \
33 case 64: \
34 case 128: \
35 /*case 256:*/ y = 1; \
36 break; \
37 default: y = 0; \
38 } \
39 }
40
41 struct gtable *kernel_table; /* ptr to list of kernel grp entries*/
42 static struct gtable *kernel_no_route; /* list of grp entries w/o routes */
43 struct gtable *gtp; /* pointer for kernel rt entries */
44 unsigned int kroutes; /* current number of cache entries */
45
46 /****************************************************************************
47 Functions that are local to prune.c
48 ****************************************************************************/
49 static void prun_add_ttls(struct gtable *gt);
50 static int pruning_neighbor(vifi_t vifi, u_int32_t addr);
51 static int can_mtrace(vifi_t vifi, u_int32_t addr);
52 static struct ptable * find_prune_entry(u_int32_t vr, struct ptable *pt);
53 static void expire_prune(vifi_t vifi, struct gtable *gt);
54 static void send_prune(struct gtable *gt);
55 static void send_graft(struct gtable *gt);
56 static void send_graft_ack(u_int32_t src, u_int32_t dst,
57 u_int32_t origin, u_int32_t grp);
58 static void update_kernel(struct gtable *g);
59 static const char * scaletime(u_long t);
60
61 /*
62 * Updates the ttl values for each vif.
63 */
64 static void
65 prun_add_ttls(struct gtable *gt)
66 {
67 struct uvif *v;
68 vifi_t vifi;
69
70 for (vifi = 0, v = uvifs; vifi < numvifs; ++vifi, ++v) {
71 if (VIFM_ISSET(vifi, gt->gt_grpmems))
72 gt->gt_ttls[vifi] = v->uv_threshold;
73 else
74 gt->gt_ttls[vifi] = 0;
75 }
76 }
77
78 /*
79 * checks for scoped multicast addresses
80 */
81 #define GET_SCOPE(gt) { \
82 vifi_t _i; \
83 if ((ntohl((gt)->gt_mcastgrp) & 0xff000000) == 0xef000000) \
84 for (_i = 0; _i < numvifs; _i++) \
85 if (scoped_addr(_i, (gt)->gt_mcastgrp)) \
86 VIFM_SET(_i, (gt)->gt_scope); \
87 }
88
89 int
90 scoped_addr(vifi_t vifi, u_int32_t addr)
91 {
92 struct vif_acl *acl;
93
94 for (acl = uvifs[vifi].uv_acl; acl; acl = acl->acl_next)
95 if ((addr & acl->acl_mask) == acl->acl_addr)
96 return 1;
97
98 return 0;
99 }
100
101 /*
102 * Determine if mcastgrp has a listener on vifi
103 */
104 int
105 grplst_mem(vifi_t vifi, u_int32_t mcastgrp)
106 {
107 struct listaddr *g;
108 struct uvif *v;
109
110 v = &uvifs[vifi];
111
112 for (g = v->uv_groups; g != NULL; g = g->al_next)
113 if (mcastgrp == g->al_addr)
114 return 1;
115
116 return 0;
117 }
118
119 /*
120 * Finds the group entry with the specified source and netmask.
121 * If netmask is 0, it uses the route's netmask.
122 *
123 * Returns TRUE if found a match, and the global variable gtp is left
124 * pointing to entry before the found entry.
125 * Returns FALSE if no exact match found, gtp is left pointing to before
126 * the entry in question belongs, or is NULL if the it belongs at the
127 * head of the list.
128 */
129 int
130 find_src_grp(u_int32_t src, u_int32_t mask, u_int32_t grp)
131 {
132 struct gtable *gt;
133
134 gtp = NULL;
135 gt = kernel_table;
136 while (gt != NULL) {
137 if (grp == gt->gt_mcastgrp &&
138 (mask ? (gt->gt_route->rt_origin == src &&
139 gt->gt_route->rt_originmask == mask) :
140 ((src & gt->gt_route->rt_originmask) ==
141 gt->gt_route->rt_origin)))
142 return TRUE;
143 if (ntohl(grp) > ntohl(gt->gt_mcastgrp) ||
144 (grp == gt->gt_mcastgrp &&
145 (ntohl(mask) < ntohl(gt->gt_route->rt_originmask) ||
146 (mask == gt->gt_route->rt_originmask &&
147 (ntohl(src) > ntohl(gt->gt_route->rt_origin)))))) {
148 gtp = gt;
149 gt = gt->gt_gnext;
150 }
151 else break;
152 }
153 return FALSE;
154 }
155
156 /*
157 * Check if the neighbor supports pruning
158 */
159 static int
160 pruning_neighbor(vifi_t vifi, u_int32_t addr)
161 {
162 struct listaddr *n = neighbor_info(vifi, addr);
163 int vers;
164
165 if (n == NULL)
166 return 0;
167
168 if (n->al_flags & NF_PRUNE)
169 return 1;
170
171 /*
172 * Versions from 3.0 to 3.4 relied on the version number to identify
173 * that they could handle pruning.
174 */
175 vers = NBR_VERS(n);
176 return (vers >= 0x0300 && vers <= 0x0304);
177 }
178
179 /*
180 * Can the neighbor in question handle multicast traceroute?
181 */
182 static int
183 can_mtrace(vifi_t vifi, u_int32_t addr)
184 {
185 struct listaddr *n = neighbor_info(vifi, addr);
186 int vers;
187
188 if (n == NULL)
189 return 0;
190
191 if (n->al_flags & NF_MTRACE)
192 return 1;
193
194 /*
195 * Versions 3.3 and 3.4 relied on the version number to identify
196 * that they could handle traceroute.
197 */
198 vers = NBR_VERS(n);
199 return (vers >= 0x0303 && vers <= 0x0304);
200 }
201
202 /*
203 * Returns the prune entry of the router, or NULL if none exists
204 */
205 static struct ptable *
206 find_prune_entry(u_int32_t vr, struct ptable *pt)
207 {
208 while (pt) {
209 if (pt->pt_router == vr)
210 return pt;
211 pt = pt->pt_next;
212 }
213
214 return NULL;
215 }
216
217 /*
218 * Send a prune message to the dominant router for
219 * this source.
220 *
221 * Record an entry that a prune was sent for this group
222 */
223 static void
224 send_prune(struct gtable *gt)
225 {
226 struct ptable *pt;
227 char *p;
228 int i;
229 int datalen;
230 u_int32_t src;
231 u_int32_t dst;
232 u_int32_t tmp;
233
234 /* Don't process any prunes if router is not pruning */
235 if (pruning == 0)
236 return;
237
238 /* Can't process a prune if we don't have an associated route */
239 if (gt->gt_route == NULL)
240 return;
241
242 /* Don't send a prune to a non-pruning router */
243 if (!pruning_neighbor(gt->gt_route->rt_parent, gt->gt_route->rt_gateway))
244 return;
245
246 /*
247 * sends a prune message to the router upstream.
248 */
249 src = uvifs[gt->gt_route->rt_parent].uv_lcl_addr;
250 dst = gt->gt_route->rt_gateway;
251
252 p = send_buf + MIN_IP_HEADER_LEN + IGMP_MINLEN;
253 datalen = 0;
254
255 /*
256 * determine prune lifetime
257 */
258 gt->gt_prsent_timer = gt->gt_timer;
259 for (pt = gt->gt_pruntbl; pt; pt = pt->pt_next)
260 if (pt->pt_timer < gt->gt_prsent_timer)
261 gt->gt_prsent_timer = pt->pt_timer;
262
263 /*
264 * If we have a graft pending, cancel graft retransmission
265 */
266 gt->gt_grftsnt = 0;
267
268 for (i = 0; i < 4; i++)
269 *p++ = ((char *)&(gt->gt_route->rt_origin))[i];
270 for (i = 0; i < 4; i++)
271 *p++ = ((char *)&(gt->gt_mcastgrp))[i];
272 tmp = htonl(gt->gt_prsent_timer);
273 for (i = 0; i < 4; i++)
274 *p++ = ((char *)&(tmp))[i];
275 datalen += 12;
276
277 send_igmp(src, dst, IGMP_DVMRP, DVMRP_PRUNE,
278 htonl(MROUTED_LEVEL), datalen);
279
280 logit(LOG_DEBUG, 0, "sent prune for (%s %s)/%d on vif %d to %s",
281 inet_fmts(gt->gt_route->rt_origin, gt->gt_route->rt_originmask),
282 inet_fmt(gt->gt_mcastgrp),
283 gt->gt_prsent_timer, gt->gt_route->rt_parent,
284 inet_fmt(gt->gt_route->rt_gateway));
285 }
286
287 /*
288 * a prune was sent upstream
289 * so, a graft has to be sent to annul the prune
290 * set up a graft timer so that if an ack is not
291 * heard within that time, another graft request
292 * is sent out.
293 */
294 static void
295 send_graft(struct gtable *gt)
296 {
297 char *p;
298 int i;
299 int datalen;
300 u_int32_t src;
301 u_int32_t dst;
302
303 /* Can't send a graft without an associated route */
304 if (gt->gt_route == NULL)
305 return;
306
307 src = uvifs[gt->gt_route->rt_parent].uv_lcl_addr;
308 dst = gt->gt_route->rt_gateway;
309
310 p = send_buf + MIN_IP_HEADER_LEN + IGMP_MINLEN;
311 datalen = 0;
312
313 for (i = 0; i < 4; i++)
314 *p++ = ((char *)&(gt->gt_route->rt_origin))[i];
315 for (i = 0; i < 4; i++)
316 *p++ = ((char *)&(gt->gt_mcastgrp))[i];
317 datalen += 8;
318
319 if (datalen != 0) {
320 send_igmp(src, dst, IGMP_DVMRP, DVMRP_GRAFT,
321 htonl(MROUTED_LEVEL), datalen);
322 }
323 logit(LOG_DEBUG, 0, "sent graft for (%s %s) to %s on vif %d",
324 inet_fmts(gt->gt_route->rt_origin, gt->gt_route->rt_originmask),
325 inet_fmt(gt->gt_mcastgrp),
326 inet_fmt(gt->gt_route->rt_gateway),
327 gt->gt_route->rt_parent);
328 }
329
330 /*
331 * Send an ack that a graft was received
332 */
333 static void
334 send_graft_ack(u_int32_t src, u_int32_t dst, u_int32_t origin, u_int32_t grp)
335 {
336 char *p;
337 int i;
338 int datalen;
339
340 p = send_buf + MIN_IP_HEADER_LEN + IGMP_MINLEN;
341 datalen = 0;
342
343 for (i = 0; i < 4; i++)
344 *p++ = ((char *)&(origin))[i];
345 for (i = 0; i < 4; i++)
346 *p++ = ((char *)&(grp))[i];
347 datalen += 8;
348
349 send_igmp(src, dst, IGMP_DVMRP, DVMRP_GRAFT_ACK,
350 htonl(MROUTED_LEVEL), datalen);
351
352 logit(LOG_DEBUG, 0, "sent graft ack for (%s, %s) to %s",
353 inet_fmt(origin), inet_fmt(grp),
354 inet_fmt(dst));
355 }
356
357 /*
358 * Update the kernel cache with all the routes hanging off the group entry
359 */
360 static void
361 update_kernel(struct gtable *g)
362 {
363 struct stable *st;
364
365 for (st = g->gt_srctbl; st; st = st->st_next)
366 k_add_rg(st->st_origin, g);
367 }
368
369 /****************************************************************************
370 Functions that are used externally
371 ****************************************************************************/
372
373 #ifdef SNMP
374 #include <sys/types.h>
375 #include "snmp.h"
376
377 /*
378 * Find a specific group entry in the group table
379 */
380 struct gtable *
381 find_grp(u_long grp)
382 {
383 struct gtable *gt;
384
385 for (gt = kernel_table; gt; gt = gt->gt_gnext) {
386 if (ntohl(grp) < ntohl(gt->gt_mcastgrp))
387 break;
388 if (gt->gt_mcastgrp == grp)
389 return gt;
390 }
391 return NULL;
392 }
393
394 /*
395 * Given a group entry and source, find the corresponding source table
396 * entry
397 */
398 struct stable *
399 find_grp_src(struct gtable *gt, u_long src)
400 {
401 struct stable *st;
402 u_long grp = gt->gt_mcastgrp;
403 struct gtable *gtcurr;
404
405 for (gtcurr = gt; gtcurr->gt_mcastgrp == grp; gtcurr = gtcurr->gt_gnext) {
406 for (st = gtcurr->gt_srctbl; st; st = st->st_next)
407 if (st->st_origin == src)
408 return st;
409 }
410 return NULL;
411 }
412
413 /*
414 * Find next entry > specification
415 *
416 * gtpp: ordered by group
417 * stpp: ordered by source
418 */
419 int
420 next_grp_src_mask(struct gtable **gtpp, struct stable **stpp, u_long grp,
421 u_long src, u_long mask)
422 {
423 struct gtable *gt, *gbest = NULL;
424 struct stable *st, *sbest = NULL;
425
426 /* Find first group entry >= grp spec */
427 (*gtpp) = kernel_table;
428 while ((*gtpp) && ntohl((*gtpp)->gt_mcastgrp) < ntohl(grp))
429 (*gtpp)=(*gtpp)->gt_gnext;
430 if (!(*gtpp))
431 return 0; /* no more groups */
432
433 for (gt = kernel_table; gt; gt=gt->gt_gnext) {
434 /* Since grps are ordered, we can stop when group changes from gbest */
435 if (gbest && gbest->gt_mcastgrp != gt->gt_mcastgrp)
436 break;
437 for (st = gt->gt_srctbl; st; st=st->st_next) {
438
439 /* Among those entries > spec, find "lowest" one */
440 if (((ntohl(gt->gt_mcastgrp)> ntohl(grp))
441 || (ntohl(gt->gt_mcastgrp)==ntohl(grp)
442 && ntohl(st->st_origin)> ntohl(src))
443 || (ntohl(gt->gt_mcastgrp)==ntohl(grp)
444 && ntohl(st->st_origin)==src && 0xFFFFFFFF>ntohl(mask)))
445 && (!gbest
446 || (ntohl(gt->gt_mcastgrp)< ntohl(gbest->gt_mcastgrp))
447 || (ntohl(gt->gt_mcastgrp)==ntohl(gbest->gt_mcastgrp)
448 && ntohl(st->st_origin)< ntohl(sbest->st_origin)))) {
449 gbest = gt;
450 sbest = st;
451 }
452 }
453 }
454 (*gtpp) = gbest;
455 (*stpp) = sbest;
456 return (*gtpp)!=0;
457 }
458
459 /*
460 * Ensure that sg contains current information for the given group,source.
461 * This is fetched from the kernel as a unit so that counts for the entry
462 * are consistent, i.e. packet and byte counts for the same entry are
463 * read at the same time.
464 */
465 void
466 refresh_sg(struct sioc_sg_req *sg, struct gtable *gt, struct stable *st)
467 {
468 static int lastq = -1;
469
470 if (quantum != lastq || sg->src.s_addr!=st->st_origin
471 || sg->grp.s_addr!=gt->gt_mcastgrp) {
472 lastq = quantum;
473 sg->src.s_addr = st->st_origin;
474 sg->grp.s_addr = gt->gt_mcastgrp;
475 ioctl(igmp_socket, SIOCGETSGCNT, (char *)sg);
476 }
477 }
478
479 /*
480 * Return pointer to a specific route entry. This must be a separate
481 * function from find_route() which modifies rtp.
482 */
483 struct rtentry *
484 snmp_find_route(u_long src, u_long mask)
485 {
486 struct rtentry *rt;
487
488 for (rt = routing_table; rt; rt = rt->rt_next) {
489 if (src == rt->rt_origin && mask == rt->rt_originmask)
490 return rt;
491 }
492 return NULL;
493 }
494
495 /*
496 * Find next route entry > specification
497 */
498 int
499 next_route(struct rtentry **rtpp, u_long src, u_long mask)
500 {
501 struct rtentry *rt, *rbest = NULL;
502
503 /* Among all entries > spec, find "lowest" one in order */
504 for (rt = routing_table; rt; rt=rt->rt_next) {
505 if ((ntohl(rt->rt_origin) > ntohl(src)
506 || (ntohl(rt->rt_origin) == ntohl(src)
507 && ntohl(rt->rt_originmask) > ntohl(mask)))
508 && (!rbest || (ntohl(rt->rt_origin) < ntohl(rbest->rt_origin))
509 || (ntohl(rt->rt_origin) == ntohl(rbest->rt_origin)
510 && ntohl(rt->rt_originmask) < ntohl(rbest->rt_originmask))))
511 rbest = rt;
512 }
513 (*rtpp) = rbest;
514 return (*rtpp)!=0;
515 }
516
517 /*
518 * Given a routing table entry, and a vifi, find the next vifi/entry
519 *
520 * vifi: vifi at which to start looking
521 */
522 int
523 next_route_child(struct rtentry **rtpp, u_long src, u_long mask, vifi_t *vifi)
524 {
525 struct rtentry *rt;
526
527 /* Get (S,M) entry */
528 if (!((*rtpp) = snmp_find_route(src,mask)))
529 if (!next_route(rtpp, src, mask))
530 return 0;
531
532 /* Continue until we get one with a valid next vif */
533 do {
534 for (; (*rtpp)->rt_children && *vifi<numvifs; (*vifi)++)
535 if (VIFM_ISSET(*vifi, (*rtpp)->rt_children))
536 return 1;
537 *vifi = 0;
538 } while( next_route(rtpp, (*rtpp)->rt_origin, (*rtpp)->rt_originmask) );
539
540 return 0;
541 }
542
543 /*
544 * Given a routing table entry, and a vifi, find the next entry
545 * equal to or greater than those
546 *
547 * vifi: vifi at which to start looking
548 */
549 int
550 next_child(struct gtable **gtpp, struct stable **stpp, u_long grp, u_long src,
551 u_long mask, vifi_t *vifi)
552 {
553 struct stable *st;
554
555 /* Get (G,S,M) entry */
556 if (mask!=0xFFFFFFFF
557 || !((*gtpp) = find_grp(grp))
558 || !((*stpp) = find_grp_src((*gtpp),src)))
559 if (!next_grp_src_mask(gtpp, stpp, grp, src, mask))
560 return 0;
561
562 /* Continue until we get one with a valid next vif */
563 do {
564 for (; (*gtpp)->gt_route->rt_children && *vifi<numvifs; (*vifi)++)
565 if (VIFM_ISSET(*vifi, (*gtpp)->gt_route->rt_children))
566 return 1;
567 *vifi = 0;
568 } while (next_grp_src_mask(gtpp, stpp, (*gtpp)->gt_mcastgrp,
569 (*stpp)->st_origin, 0xFFFFFFFF) );
570
571 return 0;
572 }
573 #endif /* SNMP */
574
575 /*
576 * Initialize the kernel table structure
577 */
578 void
579 init_ktable(void)
580 {
581 kernel_table = NULL;
582 kernel_no_route = NULL;
583 kroutes = 0;
584 }
585
586 /*
587 * Add a new table entry for (origin, mcastgrp)
588 */
589 void
590 add_table_entry(u_int32_t origin, u_int32_t mcastgrp)
591 {
592 struct rtentry *r;
593 struct gtable *gt,**gtnp,*prev_gt;
594 struct stable *st,**stnp;
595 vifi_t i;
596
597 #ifdef DEBUG_MFC
598 md_log(MD_MISS, origin, mcastgrp);
599 #endif
600
601 r = determine_route(origin);
602 prev_gt = NULL;
603 if (r == NULL) {
604 /*
605 * Look for it on the no_route table; if it is found then
606 * it will be detected as a duplicate below.
607 */
608 for (gt = kernel_no_route; gt; gt = gt->gt_next)
609 if (mcastgrp == gt->gt_mcastgrp &&
610 gt->gt_srctbl && gt->gt_srctbl->st_origin == origin)
611 break;
612 gtnp = &kernel_no_route;
613 } else {
614 gtnp = &r->rt_groups;
615 while ((gt = *gtnp) != NULL) {
616 if (gt->gt_mcastgrp >= mcastgrp)
617 break;
618 gtnp = &gt->gt_next;
619 prev_gt = gt;
620 }
621 }
622
623 if (gt == NULL || gt->gt_mcastgrp != mcastgrp) {
624 gt = (struct gtable *)malloc(sizeof(struct gtable));
625 if (gt == NULL) {
626 logit(LOG_ERR, 0, "ran out of memory");
627 return;
628 }
629
630 gt->gt_mcastgrp = mcastgrp;
631 gt->gt_timer = CACHE_LIFETIME(cache_lifetime);
632 time(&gt->gt_ctime);
633 gt->gt_grpmems = 0;
634 gt->gt_scope = 0;
635 gt->gt_prsent_timer = 0;
636 gt->gt_grftsnt = 0;
637 gt->gt_srctbl = NULL;
638 gt->gt_pruntbl = NULL;
639 gt->gt_route = r;
640 #ifdef RSRR
641 gt->gt_rsrr_cache = NULL;
642 #endif
643
644 if (r != NULL) {
645 /* obtain the multicast group membership list */
646 for (i = 0; i < numvifs; i++) {
647 if (VIFM_ISSET(i, r->rt_children) &&
648 !(VIFM_ISSET(i, r->rt_leaves)))
649 VIFM_SET(i, gt->gt_grpmems);
650
651 if (VIFM_ISSET(i, r->rt_leaves) && grplst_mem(i, mcastgrp))
652 VIFM_SET(i, gt->gt_grpmems);
653 }
654 GET_SCOPE(gt);
655 if (VIFM_ISSET(r->rt_parent, gt->gt_scope))
656 gt->gt_scope = -1;
657 gt->gt_grpmems &= ~gt->gt_scope;
658 } else {
659 gt->gt_scope = -1;
660 gt->gt_grpmems = 0;
661 }
662
663 /* update ttls */
664 prun_add_ttls(gt);
665
666 gt->gt_next = *gtnp;
667 *gtnp = gt;
668 if (gt->gt_next)
669 gt->gt_next->gt_prev = gt;
670 gt->gt_prev = prev_gt;
671
672 if (r) {
673 if (find_src_grp(r->rt_origin, r->rt_originmask, gt->gt_mcastgrp)) {
674 struct gtable *g;
675
676 g = gtp ? gtp->gt_gnext : kernel_table;
677 logit(LOG_WARNING, 0, "Entry for (%s %s) (rt:%p) exists (rt:%p)",
678 inet_fmts(r->rt_origin, r->rt_originmask),
679 inet_fmt(g->gt_mcastgrp),
680 r, g->gt_route);
681 } else {
682 if (gtp) {
683 gt->gt_gnext = gtp->gt_gnext;
684 gt->gt_gprev = gtp;
685 gtp->gt_gnext = gt;
686 } else {
687 gt->gt_gnext = kernel_table;
688 gt->gt_gprev = NULL;
689 kernel_table = gt;
690 }
691 if (gt->gt_gnext)
692 gt->gt_gnext->gt_gprev = gt;
693 }
694 } else {
695 gt->gt_gnext = gt->gt_gprev = NULL;
696 }
697 }
698
699 stnp = &gt->gt_srctbl;
700 while ((st = *stnp) != NULL) {
701 if (ntohl(st->st_origin) >= ntohl(origin))
702 break;
703 stnp = &st->st_next;
704 }
705
706 if (st == NULL || st->st_origin != origin) {
707 st = (struct stable *)malloc(sizeof(struct stable));
708 if (st == NULL)
709 logit(LOG_ERR, 0, "ran out of memory");
710
711 st->st_origin = origin;
712 st->st_pktcnt = 0;
713 st->st_next = *stnp;
714 *stnp = st;
715 } else {
716 #ifdef DEBUG_MFC
717 md_log(MD_DUPE, origin, mcastgrp);
718 #endif
719 logit(LOG_WARNING, 0, "kernel entry already exists for (%s %s)",
720 inet_fmt(origin),
721 inet_fmt(mcastgrp));
722 /* XXX Doing this should cause no harm, and may ensure
723 * kernel<>mrouted synchronization */
724 k_add_rg(origin, gt);
725 return;
726 }
727
728 kroutes++;
729 k_add_rg(origin, gt);
730
731 logit(LOG_DEBUG, 0, "add cache entry (%s %s) gm:%x, parent-vif:%d",
732 inet_fmt(origin),
733 inet_fmt(mcastgrp),
734 gt->gt_grpmems, r ? r->rt_parent : -1);
735
736 /* If there are no leaf vifs
737 * which have this group, then
738 * mark this src-grp as a prune candidate.
739 */
740 if (!gt->gt_prsent_timer && !gt->gt_grpmems && r && r->rt_gateway)
741 send_prune(gt);
742 }
743
744 /*
745 * An mrouter has gone down and come up on an interface
746 * Forward on that interface immediately
747 */
748 void
749 reset_neighbor_state(vifi_t vifi, u_int32_t addr)
750 {
751 struct rtentry *r;
752 struct gtable *g;
753 struct ptable *pt, **ptnp;
754 struct stable *st;
755
756 for (g = kernel_table; g; g = g->gt_gnext) {
757 r = g->gt_route;
758
759 /*
760 * If neighbor was the parent, remove the prune sent state
761 * and all of the source cache info so that prunes get
762 * regenerated.
763 */
764 if (vifi == r->rt_parent) {
765 if (addr == r->rt_gateway) {
766 logit(LOG_DEBUG, 0, "reset_neighbor_state parent reset (%s %s)",
767 inet_fmts(r->rt_origin, r->rt_originmask),
768 inet_fmt(g->gt_mcastgrp));
769
770 g->gt_prsent_timer = 0;
771 g->gt_grftsnt = 0;
772 while ((st = g->gt_srctbl) != NULL) {
773 g->gt_srctbl = st->st_next;
774 k_del_rg(st->st_origin, g);
775 kroutes--;
776 free(st);
777 }
778 }
779 } else {
780 /*
781 * Neighbor was not the parent, send grafts to join the groups
782 */
783 if (g->gt_prsent_timer) {
784 g->gt_grftsnt = 1;
785 send_graft(g);
786 g->gt_prsent_timer = 0;
787 }
788
789 /*
790 * Remove any prunes that this router has sent us.
791 */
792 ptnp = &g->gt_pruntbl;
793 while ((pt = *ptnp) != NULL) {
794 if (pt->pt_vifi == vifi && pt->pt_router == addr) {
795 *ptnp = pt->pt_next;
796 free(pt);
797 } else
798 ptnp = &pt->pt_next;
799 }
800
801 /*
802 * And see if we want to forward again.
803 */
804 if (!VIFM_ISSET(vifi, g->gt_grpmems)) {
805 if (VIFM_ISSET(vifi, r->rt_children) &&
806 !(VIFM_ISSET(vifi, r->rt_leaves)))
807 VIFM_SET(vifi, g->gt_grpmems);
808
809 if (VIFM_ISSET(vifi, r->rt_leaves) &&
810 grplst_mem(vifi, g->gt_mcastgrp))
811 VIFM_SET(vifi, g->gt_grpmems);
812
813 g->gt_grpmems &= ~g->gt_scope;
814 prun_add_ttls(g);
815
816 /* Update kernel state */
817 update_kernel(g);
818 #ifdef RSRR
819 /* Send route change notification to reservation protocol. */
820 rsrr_cache_send(g,1);
821 #endif /* RSRR */
822
823 logit(LOG_DEBUG, 0, "reset member state (%s %s) gm:%x",
824 inet_fmts(r->rt_origin, r->rt_originmask),
825 inet_fmt(g->gt_mcastgrp), g->gt_grpmems);
826 }
827 }
828 }
829 }
830
831 /*
832 * Delete table entry from the kernel
833 * del_flag determines how many entries to delete
834 */
835 void
836 del_table_entry(struct rtentry *r, u_int32_t mcastgrp, u_int del_flag)
837 {
838 struct gtable *g, *prev_g;
839 struct stable *st, *prev_st;
840 struct ptable *pt, *prev_pt;
841
842 if (del_flag == DEL_ALL_ROUTES) {
843 g = r->rt_groups;
844 while (g) {
845 logit(LOG_DEBUG, 0, "del_table_entry deleting (%s %s)",
846 inet_fmts(r->rt_origin, r->rt_originmask),
847 inet_fmt(g->gt_mcastgrp));
848 st = g->gt_srctbl;
849 while (st) {
850 if (k_del_rg(st->st_origin, g) < 0) {
851 logit(LOG_WARNING, errno,
852 "del_table_entry trying to delete (%s, %s)",
853 inet_fmt(st->st_origin),
854 inet_fmt(g->gt_mcastgrp));
855 }
856 kroutes--;
857 prev_st = st;
858 st = st->st_next;
859 free(prev_st);
860 }
861 g->gt_srctbl = NULL;
862
863 pt = g->gt_pruntbl;
864 while (pt) {
865 prev_pt = pt;
866 pt = pt->pt_next;
867 free(prev_pt);
868 }
869 g->gt_pruntbl = NULL;
870
871 if (g->gt_gnext)
872 g->gt_gnext->gt_gprev = g->gt_gprev;
873 if (g->gt_gprev)
874 g->gt_gprev->gt_gnext = g->gt_gnext;
875 else
876 kernel_table = g->gt_gnext;
877
878 #ifdef RSRR
879 /* Send route change notification to reservation protocol. */
880 rsrr_cache_send(g,0);
881 rsrr_cache_clean(g);
882 #endif /* RSRR */
883 prev_g = g;
884 g = g->gt_next;
885 free(prev_g);
886 }
887 r->rt_groups = NULL;
888 }
889
890 /*
891 * Dummy routine - someday this may be needed, so it is just there
892 */
893 if (del_flag == DEL_RTE_GROUP) {
894 prev_g = (struct gtable *)&r->rt_groups;
895 for (g = r->rt_groups; g; g = g->gt_next) {
896 if (g->gt_mcastgrp == mcastgrp) {
897 logit(LOG_DEBUG, 0, "del_table_entry deleting (%s %s)",
898 inet_fmts(r->rt_origin, r->rt_originmask),
899 inet_fmt(g->gt_mcastgrp));
900 st = g->gt_srctbl;
901 while (st) {
902 if (k_del_rg(st->st_origin, g) < 0) {
903 logit(LOG_WARNING, errno,
904 "del_table_entry trying to delete (%s, %s)",
905 inet_fmt(st->st_origin),
906 inet_fmt(g->gt_mcastgrp));
907 }
908 kroutes--;
909 prev_st = st;
910 st = st->st_next;
911 free(prev_st);
912 }
913 g->gt_srctbl = NULL;
914
915 pt = g->gt_pruntbl;
916 while (pt) {
917 prev_pt = pt;
918 pt = pt->pt_next;
919 free(prev_pt);
920 }
921 g->gt_pruntbl = NULL;
922
923 if (g->gt_gnext)
924 g->gt_gnext->gt_gprev = g->gt_gprev;
925 if (g->gt_gprev)
926 g->gt_gprev->gt_gnext = g->gt_gnext;
927 else
928 kernel_table = g->gt_gnext;
929
930 if (prev_g != (struct gtable *)&r->rt_groups)
931 g->gt_next->gt_prev = prev_g;
932 else
933 g->gt_next->gt_prev = NULL;
934 prev_g->gt_next = g->gt_next;
935
936 #ifdef RSRR
937 /* Send route change notification to reservation protocol. */
938 rsrr_cache_send(g,0);
939 rsrr_cache_clean(g);
940 #endif /* RSRR */
941 free(g);
942 g = prev_g;
943 } else {
944 prev_g = g;
945 }
946 }
947 }
948 }
949
950 /*
951 * update kernel table entry when a route entry changes
952 */
953 void
954 update_table_entry(struct rtentry *r)
955 {
956 struct gtable *g;
957 struct ptable *pt, *prev_pt;
958 vifi_t i;
959
960 for (g = r->rt_groups; g; g = g->gt_next) {
961 pt = g->gt_pruntbl;
962 while (pt) {
963 prev_pt = pt->pt_next;
964 free(pt);
965 pt = prev_pt;
966 }
967 g->gt_pruntbl = NULL;
968
969 g->gt_grpmems = 0;
970
971 /* obtain the multicast group membership list */
972 for (i = 0; i < numvifs; i++) {
973 if (VIFM_ISSET(i, r->rt_children) &&
974 !(VIFM_ISSET(i, r->rt_leaves)))
975 VIFM_SET(i, g->gt_grpmems);
976
977 if (VIFM_ISSET(i, r->rt_leaves) && grplst_mem(i, g->gt_mcastgrp))
978 VIFM_SET(i, g->gt_grpmems);
979 }
980 if (VIFM_ISSET(r->rt_parent, g->gt_scope))
981 g->gt_scope = -1;
982 g->gt_grpmems &= ~g->gt_scope;
983
984 logit(LOG_DEBUG, 0, "updating cache entries (%s %s) gm:%x",
985 inet_fmts(r->rt_origin, r->rt_originmask),
986 inet_fmt(g->gt_mcastgrp),
987 g->gt_grpmems);
988
989 if (g->gt_grpmems && g->gt_prsent_timer) {
990 g->gt_grftsnt = 1;
991 send_graft(g);
992 g->gt_prsent_timer = 0;
993 }
994
995 /* update ttls and add entry into kernel */
996 prun_add_ttls(g);
997 update_kernel(g);
998 #ifdef RSRR
999 /* Send route change notification to reservation protocol. */
1000 rsrr_cache_send(g,1);
1001 #endif /* RSRR */
1002
1003 /* Check if we want to prune this group */
1004 if (!g->gt_prsent_timer && g->gt_grpmems == 0 && r->rt_gateway) {
1005 g->gt_timer = CACHE_LIFETIME(cache_lifetime);
1006 send_prune(g);
1007 }
1008 }
1009 }
1010
1011 /*
1012 * set the forwarding flag for all mcastgrps on this vifi
1013 */
1014 void
1015 update_lclgrp(vifi_t vifi, u_int32_t mcastgrp)
1016 {
1017 struct rtentry *r;
1018 struct gtable *g;
1019
1020 logit(LOG_DEBUG, 0, "group %s joined on vif %d",
1021 inet_fmt(mcastgrp), vifi);
1022
1023 for (g = kernel_table; g; g = g->gt_gnext) {
1024 if (ntohl(mcastgrp) < ntohl(g->gt_mcastgrp))
1025 break;
1026
1027 r = g->gt_route;
1028 if (g->gt_mcastgrp == mcastgrp &&
1029 VIFM_ISSET(vifi, r->rt_children)) {
1030
1031 VIFM_SET(vifi, g->gt_grpmems);
1032 g->gt_grpmems &= ~g->gt_scope;
1033 if (g->gt_grpmems == 0)
1034 continue;
1035
1036 prun_add_ttls(g);
1037 logit(LOG_DEBUG, 0, "update lclgrp (%s %s) gm:%x",
1038 inet_fmts(r->rt_origin, r->rt_originmask),
1039 inet_fmt(g->gt_mcastgrp), g->gt_grpmems);
1040
1041 update_kernel(g);
1042 #ifdef RSRR
1043 /* Send route change notification to reservation protocol. */
1044 rsrr_cache_send(g,1);
1045 #endif /* RSRR */
1046 }
1047 }
1048 }
1049
1050 /*
1051 * reset forwarding flag for all mcastgrps on this vifi
1052 */
1053 void
1054 delete_lclgrp(vifi_t vifi, u_int32_t mcastgrp)
1055 {
1056 struct rtentry *r;
1057 struct gtable *g;
1058
1059 logit(LOG_DEBUG, 0, "group %s left on vif %d",
1060 inet_fmt(mcastgrp), vifi);
1061
1062 for (g = kernel_table; g; g = g->gt_gnext) {
1063 if (ntohl(mcastgrp) < ntohl(g->gt_mcastgrp))
1064 break;
1065
1066 if (g->gt_mcastgrp == mcastgrp) {
1067 int stop_sending = 1;
1068
1069 r = g->gt_route;
1070 /*
1071 * If this is not a leaf, then we have router neighbors on this
1072 * vif. Only turn off forwarding if they have all pruned.
1073 */
1074 if (!VIFM_ISSET(vifi, r->rt_leaves)) {
1075 struct listaddr *vr;
1076
1077 for (vr = uvifs[vifi].uv_neighbors; vr; vr = vr->al_next)
1078 if (find_prune_entry(vr->al_addr, g->gt_pruntbl) == NULL) {
1079 stop_sending = 0;
1080 break;
1081 }
1082 }
1083
1084 if (stop_sending) {
1085 VIFM_CLR(vifi, g->gt_grpmems);
1086 logit(LOG_DEBUG, 0, "delete lclgrp (%s %s) gm:%x",
1087 inet_fmts(r->rt_origin, r->rt_originmask),
1088 inet_fmt(g->gt_mcastgrp), g->gt_grpmems);
1089
1090 prun_add_ttls(g);
1091 update_kernel(g);
1092 #ifdef RSRR
1093 /* Send route change notification to reservation protocol. */
1094 rsrr_cache_send(g,1);
1095 #endif /* RSRR */
1096
1097 /*
1098 * If there are no more members of this particular group,
1099 * send prune upstream
1100 */
1101 if (!g->gt_prsent_timer && g->gt_grpmems == 0 && r->rt_gateway)
1102 send_prune(g);
1103 }
1104 }
1105 }
1106 }
1107
1108 /*
1109 * Takes the prune message received and then strips it to
1110 * determine the (src, grp) pair to be pruned.
1111 *
1112 * Adds the router to the (src, grp) entry then.
1113 *
1114 * Determines if further packets have to be sent down that vif
1115 *
1116 * Determines if a corresponding prune message has to be generated
1117 */
1118 void
1119 accept_prune(u_int32_t src, u_int32_t dst, char *p, int datalen)
1120 {
1121 u_int32_t prun_src;
1122 u_int32_t prun_grp;
1123 u_int32_t prun_tmr;
1124 vifi_t vifi;
1125 int i;
1126 int stop_sending;
1127 struct rtentry *r;
1128 struct gtable *g;
1129 struct ptable *pt;
1130 struct listaddr *vr;
1131
1132 /* Don't process any prunes if router is not pruning */
1133 if (pruning == 0)
1134 return;
1135
1136 if ((vifi = find_vif(src, dst)) == NO_VIF) {
1137 logit(LOG_INFO, 0,
1138 "ignoring prune report from non-neighbor %s",
1139 inet_fmt(src));
1140 return;
1141 }
1142
1143 /* Check if enough data is present */
1144 if (datalen < 12)
1145 {
1146 logit(LOG_WARNING, 0,
1147 "non-decipherable prune from %s",
1148 inet_fmt(src));
1149 return;
1150 }
1151
1152 for (i = 0; i< 4; i++)
1153 ((char *)&prun_src)[i] = *p++;
1154 for (i = 0; i< 4; i++)
1155 ((char *)&prun_grp)[i] = *p++;
1156 for (i = 0; i< 4; i++)
1157 ((char *)&prun_tmr)[i] = *p++;
1158 prun_tmr = ntohl(prun_tmr);
1159
1160 logit(LOG_DEBUG, 0, "%s on vif %d prunes (%s %s)/%d",
1161 inet_fmt(src), vifi,
1162 inet_fmt(prun_src), inet_fmt(prun_grp), prun_tmr);
1163
1164 /*
1165 * Find the subnet for the prune
1166 */
1167 if (find_src_grp(prun_src, 0, prun_grp)) {
1168 g = gtp ? gtp->gt_gnext : kernel_table;
1169 r = g->gt_route;
1170
1171 if (!VIFM_ISSET(vifi, r->rt_children)) {
1172 logit(LOG_WARNING, 0, "prune received from non-child %s for (%s %s)",
1173 inet_fmt(src), inet_fmt(prun_src),
1174 inet_fmt(prun_grp));
1175 return;
1176 }
1177 if (VIFM_ISSET(vifi, g->gt_scope)) {
1178 logit(LOG_WARNING, 0, "prune received from %s on scoped grp (%s %s)",
1179 inet_fmt(src), inet_fmt(prun_src),
1180 inet_fmt(prun_grp));
1181 return;
1182 }
1183 if ((pt = find_prune_entry(src, g->gt_pruntbl)) != NULL) {
1184 /*
1185 * If it's about to expire, then it's only still around because
1186 * of timer granularity, so don't warn about it.
1187 */
1188 if (pt->pt_timer > 10) {
1189 logit(LOG_WARNING, 0, "%s %d from %s for (%s %s)/%d %s %d %s %x",
1190 "duplicate prune received on vif",
1191 vifi, inet_fmt(src), inet_fmt(prun_src),
1192 inet_fmt(prun_grp), prun_tmr,
1193 "old timer:", pt->pt_timer, "cur gm:", g->gt_grpmems);
1194 }
1195 pt->pt_timer = prun_tmr;
1196 } else {
1197 /* allocate space for the prune structure */
1198 pt = (struct ptable *)(malloc(sizeof(struct ptable)));
1199 if (pt == NULL) {
1200 logit(LOG_ERR, 0, "pt: ran out of memory");
1201 return;
1202 }
1203
1204 pt->pt_vifi = vifi;
1205 pt->pt_router = src;
1206 pt->pt_timer = prun_tmr;
1207
1208 pt->pt_next = g->gt_pruntbl;
1209 g->gt_pruntbl = pt;
1210 }
1211
1212 /* Refresh the group's lifetime */
1213 g->gt_timer = CACHE_LIFETIME(cache_lifetime);
1214 if ((u_int32_t)g->gt_timer < prun_tmr)
1215 g->gt_timer = prun_tmr;
1216
1217 /*
1218 * check if any more packets need to be sent on the
1219 * vif which sent this message
1220 */
1221 stop_sending = 1;
1222 for (vr = uvifs[vifi].uv_neighbors; vr; vr = vr->al_next)
1223 if (find_prune_entry(vr->al_addr, g->gt_pruntbl) == NULL) {
1224 stop_sending = 0;
1225 break;
1226 }
1227
1228 if (stop_sending && !grplst_mem(vifi, prun_grp)) {
1229 VIFM_CLR(vifi, g->gt_grpmems);
1230 logit(LOG_DEBUG, 0, "prune (%s %s), stop sending on vif %d, gm:%x",
1231 inet_fmts(r->rt_origin, r->rt_originmask),
1232 inet_fmt(g->gt_mcastgrp), vifi, g->gt_grpmems);
1233
1234 prun_add_ttls(g);
1235 update_kernel(g);
1236 #ifdef RSRR
1237 /* Send route change notification to reservation protocol. */
1238 rsrr_cache_send(g,1);
1239 #endif /* RSRR */
1240 }
1241
1242 /*
1243 * check if all the child routers have expressed no interest
1244 * in this group and if this group does not exist in the
1245 * interface
1246 * Send a prune message then upstream
1247 */
1248 if (!g->gt_prsent_timer && g->gt_grpmems == 0 && r->rt_gateway) {
1249 send_prune(g);
1250 }
1251 } else {
1252 /*
1253 * There is no kernel entry for this group. Therefore, we can
1254 * simply ignore the prune, as we are not forwarding this traffic
1255 * downstream.
1256 */
1257 logit(LOG_DEBUG, 0, "%s (%s %s)/%d from %s",
1258 "prune message received with no kernel entry for",
1259 inet_fmt(prun_src), inet_fmt(prun_grp),
1260 prun_tmr, inet_fmt(src));
1261 return;
1262 }
1263 }
1264
1265 /*
1266 * Checks if this mcastgrp is present in the kernel table
1267 * If so and if a prune was sent, it sends a graft upwards
1268 */
1269 void
1270 chkgrp_graft(vifi_t vifi, u_int32_t mcastgrp)
1271 {
1272 struct rtentry *r;
1273 struct gtable *g;
1274
1275 for (g = kernel_table; g; g = g->gt_gnext) {
1276 if (ntohl(mcastgrp) < ntohl(g->gt_mcastgrp))
1277 break;
1278
1279 r = g->gt_route;
1280 if (g->gt_mcastgrp == mcastgrp && VIFM_ISSET(vifi, r->rt_children))
1281 if (g->gt_prsent_timer) {
1282 VIFM_SET(vifi, g->gt_grpmems);
1283
1284 /*
1285 * If the vif that was joined was a scoped vif,
1286 * ignore it ; don't graft back
1287 */
1288 g->gt_grpmems &= ~g->gt_scope;
1289 if (g->gt_grpmems == 0)
1290 continue;
1291
1292 /* set the flag for graft retransmission */
1293 g->gt_grftsnt = 1;
1294
1295 /* send graft upwards */
1296 send_graft(g);
1297
1298 /* reset the prune timer and update cache timer*/
1299 g->gt_prsent_timer = 0;
1300 g->gt_timer = max_prune_lifetime;
1301
1302 logit(LOG_DEBUG, 0, "chkgrp graft (%s %s) gm:%x",
1303 inet_fmts(r->rt_origin, r->rt_originmask),
1304 inet_fmt(g->gt_mcastgrp), g->gt_grpmems);
1305
1306 prun_add_ttls(g);
1307 update_kernel(g);
1308 #ifdef RSRR
1309 /* Send route change notification to reservation protocol. */
1310 rsrr_cache_send(g,1);
1311 #endif /* RSRR */
1312 }
1313 }
1314 }
1315
1316 /* determine the multicast group and src
1317 *
1318 * if it does, then determine if a prune was sent
1319 * upstream.
1320 * if prune sent upstream, send graft upstream and send
1321 * ack downstream.
1322 *
1323 * if no prune sent upstream, change the forwarding bit
1324 * for this interface and send ack downstream.
1325 *
1326 * if no entry exists for this group send ack downstream.
1327 */
1328 void
1329 accept_graft(u_int32_t src, u_int32_t dst, char *p, int datalen)
1330 {
1331 vifi_t vifi;
1332 u_int32_t graft_src;
1333 u_int32_t graft_grp;
1334 int i;
1335 struct rtentry *r;
1336 struct gtable *g;
1337 struct ptable *pt, **ptnp;
1338
1339 if ((vifi = find_vif(src, dst)) == NO_VIF) {
1340 logit(LOG_INFO, 0,
1341 "ignoring graft from non-neighbor %s",
1342 inet_fmt(src));
1343 return;
1344 }
1345
1346 if (datalen < 8) {
1347 logit(LOG_WARNING, 0,
1348 "received non-decipherable graft from %s",
1349 inet_fmt(src));
1350 return;
1351 }
1352
1353 for (i = 0; i< 4; i++)
1354 ((char *)&graft_src)[i] = *p++;
1355 for (i = 0; i< 4; i++)
1356 ((char *)&graft_grp)[i] = *p++;
1357
1358 logit(LOG_DEBUG, 0, "%s on vif %d grafts (%s %s)",
1359 inet_fmt(src), vifi,
1360 inet_fmt(graft_src), inet_fmt(graft_grp));
1361
1362 /*
1363 * Find the subnet for the graft
1364 */
1365 if (find_src_grp(graft_src, 0, graft_grp)) {
1366 g = gtp ? gtp->gt_gnext : kernel_table;
1367 r = g->gt_route;
1368
1369 if (VIFM_ISSET(vifi, g->gt_scope)) {
1370 logit(LOG_WARNING, 0, "graft received from %s on scoped grp (%s %s)",
1371 inet_fmt(src), inet_fmt(graft_src),
1372 inet_fmt(graft_grp));
1373 return;
1374 }
1375
1376 ptnp = &g->gt_pruntbl;
1377 while ((pt = *ptnp) != NULL) {
1378 if ((pt->pt_vifi == vifi) && (pt->pt_router == src)) {
1379 *ptnp = pt->pt_next;
1380 free(pt);
1381
1382 VIFM_SET(vifi, g->gt_grpmems);
1383 logit(LOG_DEBUG, 0, "accept graft (%s %s) gm:%x",
1384 inet_fmts(r->rt_origin, r->rt_originmask),
1385 inet_fmt(g->gt_mcastgrp), g->gt_grpmems);
1386
1387 prun_add_ttls(g);
1388 update_kernel(g);
1389 #ifdef RSRR
1390 /* Send route change notification to reservation protocol. */
1391 rsrr_cache_send(g,1);
1392 #endif /* RSRR */
1393 break;
1394 } else {
1395 ptnp = &pt->pt_next;
1396 }
1397 }
1398
1399 /* send ack downstream */
1400 send_graft_ack(dst, src, graft_src, graft_grp);
1401 g->gt_timer = max_prune_lifetime;
1402
1403 if (g->gt_prsent_timer) {
1404 /* set the flag for graft retransmission */
1405 g->gt_grftsnt = 1;
1406
1407 /* send graft upwards */
1408 send_graft(g);
1409
1410 /* reset the prune sent timer */
1411 g->gt_prsent_timer = 0;
1412 }
1413 } else {
1414 /*
1415 * We have no state for the source and group in question.
1416 * We can simply acknowledge the graft, since we know
1417 * that we have no prune state, and grafts are requests
1418 * to remove prune state.
1419 */
1420 send_graft_ack(dst, src, graft_src, graft_grp);
1421 logit(LOG_DEBUG, 0, "%s (%s %s) from %s",
1422 "graft received with no kernel entry for",
1423 inet_fmt(graft_src), inet_fmt(graft_grp),
1424 inet_fmt(src));
1425 return;
1426 }
1427 }
1428
1429 /*
1430 * find out which group is involved first of all
1431 * then determine if a graft was sent.
1432 * if no graft sent, ignore the message
1433 * if graft was sent and the ack is from the right
1434 * source, remove the graft timer so that we don't
1435 * have send a graft again
1436 */
1437 void
1438 accept_g_ack(u_int32_t src, u_int32_t dst, char *p, int datalen)
1439 {
1440 struct gtable *g;
1441 vifi_t vifi;
1442 u_int32_t grft_src;
1443 u_int32_t grft_grp;
1444 int i;
1445
1446 if ((vifi = find_vif(src, dst)) == NO_VIF) {
1447 logit(LOG_INFO, 0,
1448 "ignoring graft ack from non-neighbor %s",
1449 inet_fmt(src));
1450 return;
1451 }
1452
1453 if (datalen < 0 || datalen > 8) {
1454 logit(LOG_WARNING, 0,
1455 "received non-decipherable graft ack from %s",
1456 inet_fmt(src));
1457 return;
1458 }
1459
1460 for (i = 0; i< 4; i++)
1461 ((char *)&grft_src)[i] = *p++;
1462 for (i = 0; i< 4; i++)
1463 ((char *)&grft_grp)[i] = *p++;
1464
1465 logit(LOG_DEBUG, 0, "%s on vif %d acks graft (%s, %s)",
1466 inet_fmt(src), vifi,
1467 inet_fmt(grft_src), inet_fmt(grft_grp));
1468
1469 /*
1470 * Find the subnet for the graft ack
1471 */
1472 if (find_src_grp(grft_src, 0, grft_grp)) {
1473 g = gtp ? gtp->gt_gnext : kernel_table;
1474 g->gt_grftsnt = 0;
1475 } else {
1476 logit(LOG_WARNING, 0, "%s (%s, %s) from %s",
1477 "rcvd graft ack with no kernel entry for",
1478 inet_fmt(grft_src), inet_fmt(grft_grp),
1479 inet_fmt(src));
1480 return;
1481 }
1482 }
1483
1484
1485 /*
1486 * free all prune entries and kernel routes
1487 * normally, this should inform the kernel that all of its routes
1488 * are going away, but this is only called by restart(), which is
1489 * about to call MRT_DONE which does that anyway.
1490 */
1491 void
1492 free_all_prunes(void)
1493 {
1494 struct rtentry *r;
1495 struct gtable *g, *prev_g;
1496 struct stable *s, *prev_s;
1497 struct ptable *p, *prev_p;
1498
1499 for (r = routing_table; r; r = r->rt_next) {
1500 g = r->rt_groups;
1501 while (g) {
1502 s = g->gt_srctbl;
1503 while (s) {
1504 prev_s = s;
1505 s = s->st_next;
1506 free(prev_s);
1507 }
1508
1509 p = g->gt_pruntbl;
1510 while (p) {
1511 prev_p = p;
1512 p = p->pt_next;
1513 free(prev_p);
1514 }
1515
1516 prev_g = g;
1517 g = g->gt_next;
1518 free(prev_g);
1519 }
1520 r->rt_groups = NULL;
1521 }
1522 kernel_table = NULL;
1523
1524 g = kernel_no_route;
1525 while (g) {
1526 if (g->gt_srctbl)
1527 free(g->gt_srctbl);
1528
1529 prev_g = g;
1530 g = g->gt_next;
1531 free(prev_g);
1532 }
1533 kernel_no_route = NULL;
1534 }
1535
1536 /*
1537 * When a new route is created, search
1538 * a) The less-specific part of the routing table
1539 * b) The route-less kernel table
1540 * for sources that the new route might want to handle.
1541 *
1542 * "Inheriting" these sources might be cleanest, but simply deleting
1543 * them is easier, and letting the kernel re-request them.
1544 */
1545 void
1546 steal_sources(struct rtentry *rt)
1547 {
1548 struct rtentry *rp;
1549 struct gtable *gt, **gtnp;
1550 struct stable *st, **stnp;
1551
1552 for (rp = rt->rt_next; rp; rp = rp->rt_next) {
1553 if ((rt->rt_origin & rp->rt_originmask) == rp->rt_origin) {
1554 logit(LOG_DEBUG, 0, "Route for %s stealing sources from %s",
1555 inet_fmts(rt->rt_origin, rt->rt_originmask),
1556 inet_fmts(rp->rt_origin, rp->rt_originmask));
1557 for (gt = rp->rt_groups; gt; gt = gt->gt_next) {
1558 stnp = &gt->gt_srctbl;
1559 while ((st = *stnp) != NULL) {
1560 if ((st->st_origin & rt->rt_originmask) == rt->rt_origin) {
1561 logit(LOG_DEBUG, 0, "%s stealing (%s %s) from %s",
1562 inet_fmts(rt->rt_origin, rt->rt_originmask),
1563 inet_fmt(st->st_origin),
1564 inet_fmt(gt->gt_mcastgrp),
1565 inet_fmts(rp->rt_origin, rp->rt_originmask));
1566 if (k_del_rg(st->st_origin, gt) < 0) {
1567 logit(LOG_WARNING, errno, "%s (%s, %s)",
1568 "steal_sources trying to delete",
1569 inet_fmt(st->st_origin),
1570 inet_fmt(gt->gt_mcastgrp));
1571 }
1572 *stnp = st->st_next;
1573 kroutes--;
1574 free(st);
1575 } else {
1576 stnp = &st->st_next;
1577 }
1578 }
1579 }
1580 }
1581 }
1582
1583 gtnp = &kernel_no_route;
1584 while ((gt = *gtnp) != NULL) {
1585 if (gt->gt_srctbl && ((gt->gt_srctbl->st_origin & rt->rt_originmask)
1586 == rt->rt_origin)) {
1587 logit(LOG_DEBUG, 0, "%s stealing (%s %s) from %s",
1588 inet_fmts(rt->rt_origin, rt->rt_originmask),
1589 inet_fmt(gt->gt_srctbl->st_origin),
1590 inet_fmt(gt->gt_mcastgrp),
1591 "no_route table");
1592 if (k_del_rg(gt->gt_srctbl->st_origin, gt) < 0) {
1593 logit(LOG_WARNING, errno, "%s (%s %s)",
1594 "steal_sources trying to delete",
1595 inet_fmt(gt->gt_srctbl->st_origin),
1596 inet_fmt(gt->gt_mcastgrp));
1597 }
1598 kroutes--;
1599 free(gt->gt_srctbl);
1600 *gtnp = gt->gt_next;
1601 if (gt->gt_next)
1602 gt->gt_next->gt_prev = gt->gt_prev;
1603 free(gt);
1604 } else {
1605 gtnp = &gt->gt_next;
1606 }
1607 }
1608 }
1609
1610 /*
1611 * Advance the timers on all the cache entries.
1612 * If there are any entries whose timers have expired,
1613 * remove these entries from the kernel cache.
1614 */
1615 void
1616 age_table_entry(void)
1617 {
1618 struct rtentry *r;
1619 struct gtable *gt, **gtnptr;
1620 struct stable *st, **stnp;
1621 struct ptable *pt, **ptnp;
1622 struct sioc_sg_req sg_req;
1623
1624 logit(LOG_DEBUG, 0, "ageing entries");
1625
1626 gtnptr = &kernel_table;
1627 while ((gt = *gtnptr) != NULL) {
1628 r = gt->gt_route;
1629
1630 /* advance the timer for the kernel entry */
1631 gt->gt_timer -= ROUTE_MAX_REPORT_DELAY;
1632
1633 /* decrement prune timer if need be */
1634 if (gt->gt_prsent_timer > 0) {
1635 gt->gt_prsent_timer -= ROUTE_MAX_REPORT_DELAY;
1636 if (gt->gt_prsent_timer <= 0) {
1637 logit(LOG_DEBUG, 0, "upstream prune tmo (%s %s)",
1638 inet_fmts(r->rt_origin, r->rt_originmask),
1639 inet_fmt(gt->gt_mcastgrp));
1640 gt->gt_prsent_timer = -1;
1641 }
1642 }
1643
1644 /* retransmit graft if graft sent flag is still set */
1645 if (gt->gt_grftsnt) {
1646 int y;
1647 CHK_GS(gt->gt_grftsnt++, y);
1648 if (y)
1649 send_graft(gt);
1650 }
1651
1652 /*
1653 * Age prunes
1654 *
1655 * If a prune expires, forward again on that vif.
1656 */
1657 ptnp = &gt->gt_pruntbl;
1658 while ((pt = *ptnp) != NULL) {
1659 if ((pt->pt_timer -= ROUTE_MAX_REPORT_DELAY) <= 0) {
1660 logit(LOG_DEBUG, 0, "expire prune (%s %s) from %s on vif %d",
1661 inet_fmts(r->rt_origin, r->rt_originmask),
1662 inet_fmt(gt->gt_mcastgrp),
1663 inet_fmt(pt->pt_router),
1664 pt->pt_vifi);
1665
1666 expire_prune(pt->pt_vifi, gt);
1667
1668 /* remove the router's prune entry and await new one */
1669 *ptnp = pt->pt_next;
1670 free(pt);
1671 } else {
1672 ptnp = &pt->pt_next;
1673 }
1674 }
1675
1676 /*
1677 * If the cache entry has expired, delete source table entries for
1678 * silent sources. If there are no source entries left, and there
1679 * are no downstream prunes, then the entry is deleted.
1680 * Otherwise, the cache entry's timer is refreshed.
1681 */
1682 if (gt->gt_timer <= 0) {
1683 /* Check for traffic before deleting source entries */
1684 sg_req.grp.s_addr = gt->gt_mcastgrp;
1685 stnp = &gt->gt_srctbl;
1686 while ((st = *stnp) != NULL) {
1687 sg_req.src.s_addr = st->st_origin;
1688 if (ioctl(igmp_socket, SIOCGETSGCNT, (char *)&sg_req) < 0) {
1689 logit(LOG_WARNING, errno, "%s (%s %s)",
1690 "age_table_entry: SIOCGETSGCNT failing for",
1691 inet_fmt(st->st_origin),
1692 inet_fmt(gt->gt_mcastgrp));
1693 /* Make sure it gets deleted below */
1694 sg_req.pktcnt = st->st_pktcnt;
1695 }
1696 if (sg_req.pktcnt == st->st_pktcnt) {
1697 *stnp = st->st_next;
1698 logit(LOG_DEBUG, 0, "age_table_entry deleting (%s %s)",
1699 inet_fmt(st->st_origin),
1700 inet_fmt(gt->gt_mcastgrp));
1701 if (k_del_rg(st->st_origin, gt) < 0) {
1702 logit(LOG_WARNING, errno,
1703 "age_table_entry trying to delete (%s %s)",
1704 inet_fmt(st->st_origin),
1705 inet_fmt(gt->gt_mcastgrp));
1706 }
1707 kroutes--;
1708 free(st);
1709 } else {
1710 st->st_pktcnt = sg_req.pktcnt;
1711 stnp = &st->st_next;
1712 }
1713 }
1714
1715 /*
1716 * Retain the group entry if we have downstream prunes or if
1717 * there is at least one source in the list that still has
1718 * traffic, or if our upstream prune timer is running.
1719 */
1720 if (gt->gt_pruntbl != NULL || gt->gt_srctbl != NULL ||
1721 gt->gt_prsent_timer > 0) {
1722 gt->gt_timer = CACHE_LIFETIME(cache_lifetime);
1723 if (gt->gt_prsent_timer == -1) {
1724 if (gt->gt_grpmems == 0)
1725 send_prune(gt);
1726 else
1727 gt->gt_prsent_timer = 0;
1728 }
1729 gtnptr = &gt->gt_gnext;
1730 continue;
1731 }
1732
1733 logit(LOG_DEBUG, 0, "timeout cache entry (%s, %s)",
1734 inet_fmts(r->rt_origin, r->rt_originmask),
1735 inet_fmt(gt->gt_mcastgrp));
1736
1737 if (gt->gt_prev)
1738 gt->gt_prev->gt_next = gt->gt_next;
1739 else
1740 gt->gt_route->rt_groups = gt->gt_next;
1741 if (gt->gt_next)
1742 gt->gt_next->gt_prev = gt->gt_prev;
1743
1744 if (gt->gt_gprev) {
1745 gt->gt_gprev->gt_gnext = gt->gt_gnext;
1746 gtnptr = &gt->gt_gprev->gt_gnext;
1747 } else {
1748 kernel_table = gt->gt_gnext;
1749 gtnptr = &kernel_table;
1750 }
1751 if (gt->gt_gnext)
1752 gt->gt_gnext->gt_gprev = gt->gt_gprev;
1753
1754 #ifdef RSRR
1755 /* Send route change notification to reservation protocol. */
1756 rsrr_cache_send(gt,0);
1757 rsrr_cache_clean(gt);
1758 #endif /* RSRR */
1759 free((char *)gt);
1760 } else {
1761 if (gt->gt_prsent_timer == -1) {
1762 if (gt->gt_grpmems == 0)
1763 send_prune(gt);
1764 else
1765 gt->gt_prsent_timer = 0;
1766 }
1767 gtnptr = &gt->gt_gnext;
1768 }
1769 }
1770
1771 /*
1772 * When traversing the no_route table, the decision is much easier.
1773 * Just delete it if it has timed out.
1774 */
1775 gtnptr = &kernel_no_route;
1776 while ((gt = *gtnptr) != NULL) {
1777 /* advance the timer for the kernel entry */
1778 gt->gt_timer -= ROUTE_MAX_REPORT_DELAY;
1779
1780 if (gt->gt_timer < 0) {
1781 if (gt->gt_srctbl) {
1782 if (k_del_rg(gt->gt_srctbl->st_origin, gt) < 0) {
1783 logit(LOG_WARNING, errno, "%s (%s %s)",
1784 "age_table_entry trying to delete no-route",
1785 inet_fmt(gt->gt_srctbl->st_origin),
1786 inet_fmt(gt->gt_mcastgrp));
1787 }
1788 free(gt->gt_srctbl);
1789 }
1790 *gtnptr = gt->gt_next;
1791 if (gt->gt_next)
1792 gt->gt_next->gt_prev = gt->gt_prev;
1793
1794 free((char *)gt);
1795 } else {
1796 gtnptr = &gt->gt_next;
1797 }
1798 }
1799 }
1800
1801 /*
1802 * Modify the kernel to forward packets when one or multiple prunes that
1803 * were received on the vif given by vifi, for the group given by gt,
1804 * have expired.
1805 */
1806 static void
1807 expire_prune(vifi_t vifi, struct gtable *gt)
1808 {
1809 /*
1810 * No need to send a graft, any prunes that we sent
1811 * will expire before any prunes that we have received.
1812 */
1813 if (gt->gt_prsent_timer > 0) {
1814 logit(LOG_DEBUG, 0, "prune expired with %d left on %s",
1815 gt->gt_prsent_timer, "prsent_timer");
1816 gt->gt_prsent_timer = 0;
1817 }
1818
1819 /* modify the kernel entry to forward packets */
1820 if (!VIFM_ISSET(vifi, gt->gt_grpmems)) {
1821 struct rtentry *rt = gt->gt_route;
1822 VIFM_SET(vifi, gt->gt_grpmems);
1823 logit(LOG_DEBUG, 0, "forw again (%s %s) gm:%x vif:%d",
1824 inet_fmts(rt->rt_origin, rt->rt_originmask),
1825 inet_fmt(gt->gt_mcastgrp), gt->gt_grpmems, vifi);
1826
1827 prun_add_ttls(gt);
1828 update_kernel(gt);
1829 #ifdef RSRR
1830 /* Send route change notification to reservation protocol. */
1831 rsrr_cache_send(gt,1);
1832 #endif /* RSRR */
1833 }
1834 }
1835
1836
1837 static const char *
1838 scaletime(u_long t)
1839 {
1840 static char buf1[5];
1841 static char buf2[5];
1842 static char *buf=buf1;
1843 char s;
1844 char *p;
1845
1846 p = buf;
1847 if (buf == buf1)
1848 buf = buf2;
1849 else
1850 buf = buf1;
1851
1852 if (t < 120) {
1853 s = 's';
1854 } else if (t < 3600) {
1855 t /= 60;
1856 s = 'm';
1857 } else if (t < 86400) {
1858 t /= 3600;
1859 s = 'h';
1860 } else if (t < 864000) {
1861 t /= 86400;
1862 s = 'd';
1863 } else {
1864 t /= 604800;
1865 s = 'w';
1866 }
1867 if (t > 999)
1868 return "*** ";
1869
1870 snprintf(p, 5, "%3d%c", (int)t, s);
1871
1872 return p;
1873 }
1874
1875 /*
1876 * Print the contents of the cache table on file 'fp2'.
1877 */
1878 void
1879 dump_cache(FILE *fp2)
1880 {
1881 struct rtentry *r;
1882 struct gtable *gt;
1883 struct stable *st;
1884 vifi_t i;
1885 time_t thyme = time(0);
1886
1887 fprintf(fp2,
1888 "Multicast Routing Cache Table (%d entries)\n%s", kroutes,
1889 " Origin Mcast-group CTmr Age Ptmr IVif Forwvifs\n");
1890
1891 for (gt = kernel_no_route; gt; gt = gt->gt_next) {
1892 if (gt->gt_srctbl) {
1893 fprintf(fp2, " %-18s %-15s %-4s %-4s - -1\n",
1894 inet_fmts(gt->gt_srctbl->st_origin, 0xffffffff),
1895 inet_fmt(gt->gt_mcastgrp), scaletime(gt->gt_timer),
1896 scaletime(thyme - gt->gt_ctime));
1897 fprintf(fp2, ">%s\n", inet_fmt(gt->gt_srctbl->st_origin));
1898 }
1899 }
1900
1901 for (gt = kernel_table; gt; gt = gt->gt_gnext) {
1902 r = gt->gt_route;
1903 fprintf(fp2, " %-18s %-15s",
1904 inet_fmts(r->rt_origin, r->rt_originmask),
1905 inet_fmt(gt->gt_mcastgrp));
1906
1907 fprintf(fp2, " %-4s", scaletime(gt->gt_timer));
1908
1909 fprintf(fp2, " %-4s %-4s ", scaletime(thyme - gt->gt_ctime),
1910 gt->gt_prsent_timer ? scaletime(gt->gt_prsent_timer) :
1911 " -");
1912
1913 fprintf(fp2, "%2u%c%c ", r->rt_parent,
1914 gt->gt_prsent_timer ? 'P' : ' ',
1915 VIFM_ISSET(r->rt_parent, gt->gt_scope) ? 'B' : ' ');
1916
1917 for (i = 0; i < numvifs; ++i) {
1918 if (VIFM_ISSET(i, gt->gt_grpmems))
1919 fprintf(fp2, " %u ", i);
1920 else if (VIFM_ISSET(i, r->rt_children) &&
1921 !VIFM_ISSET(i, r->rt_leaves))
1922 fprintf(fp2, " %u%c", i,
1923 VIFM_ISSET(i, gt->gt_scope) ? 'b' : 'p');
1924 }
1925 fprintf(fp2, "\n");
1926 for (st = gt->gt_srctbl; st; st = st->st_next) {
1927 fprintf(fp2, ">%s\n", inet_fmt(st->st_origin));
1928 }
1929 #ifdef DEBUG_PRUNES
1930 for (pt = gt->gt_pruntbl; pt; pt = pt->pt_next) {
1931 fprintf(fp2, "<r:%s v:%d t:%d\n", inet_fmt(pt->pt_router),
1932 pt->pt_vifi, pt->pt_timer);
1933 }
1934 #endif
1935 }
1936 }
1937
1938 /*
1939 * Traceroute function which returns traceroute replies to the requesting
1940 * router. Also forwards the request to downstream routers.
1941 *
1942 * no: promoted u_char
1943 */
1944 void
1945 accept_mtrace(u_int32_t src, u_int32_t dst, u_int32_t group, char *data,
1946 u_int no, int datalen)
1947 {
1948 u_char type;
1949 struct rtentry *rt;
1950 struct gtable *gt;
1951 struct tr_query *qry;
1952 struct tr_resp *resp;
1953 int vifi;
1954 char *p;
1955 int rcount;
1956 int errcode = TR_NO_ERR;
1957 int resptype;
1958 struct timeval tp;
1959 struct sioc_vif_req v_req;
1960 struct sioc_sg_req sg_req;
1961
1962 /* Remember qid across invocations */
1963 static u_int32_t oqid = 0;
1964
1965 /* timestamp the request/response */
1966 gettimeofday(&tp, 0);
1967
1968 /*
1969 * Check if it is a query or a response
1970 */
1971 if (datalen == QLEN) {
1972 type = QUERY;
1973 logit(LOG_DEBUG, 0, "Initial traceroute query rcvd from %s to %s",
1974 inet_fmt(src), inet_fmt(dst));
1975 }
1976 else if ((datalen - QLEN) % RLEN == 0) {
1977 type = RESP;
1978 logit(LOG_DEBUG, 0, "In-transit traceroute query rcvd from %s to %s",
1979 inet_fmt(src), inet_fmt(dst));
1980 if (IN_MULTICAST(ntohl(dst))) {
1981 logit(LOG_DEBUG, 0, "Dropping multicast response");
1982 return;
1983 }
1984 }
1985 else {
1986 logit(LOG_WARNING, 0, "%s from %s to %s",
1987 "Non decipherable traceroute request received",
1988 inet_fmt(src), inet_fmt(dst));
1989 return;
1990 }
1991
1992 qry = (struct tr_query *)data;
1993
1994 /*
1995 * if it is a packet with all reports filled, drop it
1996 */
1997 if ((u_int)(rcount = (datalen - QLEN)/RLEN) == no) {
1998 logit(LOG_DEBUG, 0, "packet with all reports filled in");
1999 return;
2000 }
2001
2002 logit(LOG_DEBUG, 0, "s: %s g: %s d: %s ",
2003 inet_fmt(qry->tr_src),
2004 inet_fmt(group),
2005 inet_fmt(qry->tr_dst));
2006 logit(LOG_DEBUG, 0, "rttl: %d rd: %s", qry->tr_rttl,
2007 inet_fmt(qry->tr_raddr));
2008 logit(LOG_DEBUG, 0, "rcount:%d, qid:%06x", rcount, qry->tr_qid);
2009
2010 /* determine the routing table entry for this traceroute */
2011 rt = determine_route(qry->tr_src);
2012 if (rt) {
2013 logit(LOG_DEBUG, 0, "rt parent vif: %d rtr: %s metric: %d",
2014 rt->rt_parent, inet_fmt(rt->rt_gateway),
2015 rt->rt_metric);
2016 logit(LOG_DEBUG, 0, "rt origin %s",
2017 inet_fmts(rt->rt_origin, rt->rt_originmask));
2018 } else
2019 logit(LOG_DEBUG, 0, "...no route");
2020
2021 /*
2022 * Query type packet - check if rte exists
2023 * Check if the query destination is a vif connected to me.
2024 * and if so, whether I should start response back
2025 */
2026 if (type == QUERY) {
2027 if (oqid == qry->tr_qid) {
2028 /*
2029 * If the multicast router is a member of the group being
2030 * queried, and the query is multicasted, then the router can
2031 * receive multiple copies of the same query. If we have already
2032 * replied to this traceroute, just ignore it this time.
2033 *
2034 * This is not a total solution, but since if this fails you
2035 * only get N copies, N <= the number of interfaces on the router,
2036 * it is not fatal.
2037 */
2038 logit(LOG_DEBUG, 0, "ignoring duplicate traceroute packet");
2039 return;
2040 }
2041
2042 if (rt == NULL) {
2043 logit(LOG_DEBUG, 0, "Mcast traceroute: no route entry %s",
2044 inet_fmt(qry->tr_src));
2045 if (IN_MULTICAST(ntohl(dst)))
2046 return;
2047 }
2048 vifi = find_vif(qry->tr_dst, 0);
2049
2050 if (vifi == NO_VIF) {
2051 /* The traceroute destination is not on one of my subnet vifs. */
2052 logit(LOG_DEBUG, 0, "Destination %s not an interface",
2053 inet_fmt(qry->tr_dst));
2054 if (IN_MULTICAST(ntohl(dst)))
2055 return;
2056 errcode = TR_WRONG_IF;
2057 } else if (rt != NULL && !VIFM_ISSET(vifi, rt->rt_children)) {
2058 logit(LOG_DEBUG, 0,
2059 "Destination %s not on forwarding tree for src %s",
2060 inet_fmt(qry->tr_dst),
2061 inet_fmt(qry->tr_src));
2062 if (IN_MULTICAST(ntohl(dst)))
2063 return;
2064 errcode = TR_WRONG_IF;
2065 }
2066 }
2067 else {
2068 /*
2069 * determine which interface the packet came in on
2070 * RESP packets travel hop-by-hop so this either traversed
2071 * a tunnel or came from a directly attached mrouter.
2072 */
2073 if ((vifi = find_vif(src, dst)) == NO_VIF) {
2074 logit(LOG_DEBUG, 0, "Wrong interface for packet");
2075 errcode = TR_WRONG_IF;
2076 }
2077 }
2078
2079 /* Now that we've decided to send a response, save the qid */
2080 oqid = qry->tr_qid;
2081
2082 logit(LOG_DEBUG, 0, "Sending traceroute response");
2083
2084 /* copy the packet to the sending buffer */
2085 p = send_buf + MIN_IP_HEADER_LEN + IGMP_MINLEN;
2086
2087 bcopy(data, p, datalen);
2088
2089 p += datalen;
2090
2091 /*
2092 * If there is no room to insert our reply, coopt the previous hop
2093 * error indication to relay this fact.
2094 */
2095 if (p + sizeof(struct tr_resp) > send_buf + RECV_BUF_SIZE) {
2096 resp = (struct tr_resp *)p - 1;
2097 resp->tr_rflags = TR_NO_SPACE;
2098 rt = NULL;
2099 goto sendit;
2100 }
2101
2102 /*
2103 * fill in initial response fields
2104 */
2105 resp = (struct tr_resp *)p;
2106 bzero(resp, sizeof(struct tr_resp));
2107 datalen += RLEN;
2108
2109 resp->tr_qarr = htonl((tp.tv_sec + JAN_1970) << 16) +
2110 ((tp.tv_usec >> 4) & 0xffff);
2111
2112 resp->tr_rproto = PROTO_DVMRP;
2113 if (errcode != TR_NO_ERR) {
2114 resp->tr_rflags = errcode;
2115 rt = NULL; /* hack to enforce send straight to requestor */
2116 goto sendit;
2117 }
2118 resp->tr_outaddr = uvifs[vifi].uv_lcl_addr;
2119 resp->tr_fttl = uvifs[vifi].uv_threshold;
2120 resp->tr_rflags = TR_NO_ERR;
2121
2122 /*
2123 * obtain # of packets out on interface
2124 */
2125 v_req.vifi = vifi;
2126 if (ioctl(igmp_socket, SIOCGETVIFCNT, (char *)&v_req) >= 0)
2127 resp->tr_vifout = htonl(v_req.ocount);
2128
2129 /*
2130 * fill in scoping & pruning information
2131 */
2132 if (rt)
2133 for (gt = rt->rt_groups; gt; gt = gt->gt_next) {
2134 if (gt->gt_mcastgrp >= group)
2135 break;
2136 }
2137 else
2138 gt = NULL;
2139
2140 if (gt && gt->gt_mcastgrp == group) {
2141 sg_req.src.s_addr = qry->tr_src;
2142 sg_req.grp.s_addr = group;
2143 if (ioctl(igmp_socket, SIOCGETSGCNT, (char *)&sg_req) >= 0)
2144 resp->tr_pktcnt = htonl(sg_req.pktcnt);
2145
2146 if (VIFM_ISSET(vifi, gt->gt_scope))
2147 resp->tr_rflags = TR_SCOPED;
2148 else if (gt->gt_prsent_timer)
2149 resp->tr_rflags = TR_PRUNED;
2150 else if (!VIFM_ISSET(vifi, gt->gt_grpmems)) {
2151 if (VIFM_ISSET(vifi, rt->rt_children) &&
2152 !VIFM_ISSET(vifi, rt->rt_leaves))
2153 resp->tr_rflags = TR_OPRUNED;
2154 else
2155 resp->tr_rflags = TR_NO_FWD;
2156 }
2157 } else {
2158 if (scoped_addr(vifi, group))
2159 resp->tr_rflags = TR_SCOPED;
2160 else if (rt && !VIFM_ISSET(vifi, rt->rt_children))
2161 resp->tr_rflags = TR_NO_FWD;
2162 }
2163
2164 /*
2165 * if no rte exists, set NO_RTE error
2166 */
2167 if (rt == NULL) {
2168 src = dst; /* the dst address of resp. pkt */
2169 resp->tr_inaddr = 0;
2170 resp->tr_rflags = TR_NO_RTE;
2171 resp->tr_rmtaddr = 0;
2172 } else {
2173 /* get # of packets in on interface */
2174 v_req.vifi = rt->rt_parent;
2175 if (ioctl(igmp_socket, SIOCGETVIFCNT, (char *)&v_req) >= 0)
2176 resp->tr_vifin = htonl(v_req.icount);
2177
2178 MASK_TO_VAL(rt->rt_originmask, resp->tr_smask);
2179 src = uvifs[rt->rt_parent].uv_lcl_addr;
2180 resp->tr_inaddr = src;
2181 resp->tr_rmtaddr = rt->rt_gateway;
2182 if (!VIFM_ISSET(vifi, rt->rt_children)) {
2183 logit(LOG_DEBUG, 0,
2184 "Destination %s not on forwarding tree for src %s",
2185 inet_fmt(qry->tr_dst),
2186 inet_fmt(qry->tr_src));
2187 resp->tr_rflags = TR_WRONG_IF;
2188 }
2189 if (rt->rt_metric >= UNREACHABLE) {
2190 resp->tr_rflags = TR_NO_RTE;
2191 /* Hack to send reply directly */
2192 rt = NULL;
2193 }
2194 }
2195
2196 sendit:
2197 /*
2198 * if metric is 1 or no. of reports is 1, send response to requestor
2199 * else send to upstream router. If the upstream router can't handle
2200 * mtrace, set an error code and send to requestor anyway.
2201 */
2202 logit(LOG_DEBUG, 0, "rcount:%d, no:%d", rcount, no);
2203
2204 if (((u_int)(rcount + 1) == no) || (rt == NULL) || (rt->rt_metric == 1)) {
2205 resptype = IGMP_MTRACE_REPLY;
2206 dst = qry->tr_raddr;
2207 } else
2208 if (!can_mtrace(rt->rt_parent, rt->rt_gateway)) {
2209 dst = qry->tr_raddr;
2210 resp->tr_rflags = TR_OLD_ROUTER;
2211 resptype = IGMP_MTRACE_REPLY;
2212 } else {
2213 dst = rt->rt_gateway;
2214 resptype = IGMP_MTRACE_QUERY;
2215 }
2216
2217 if (IN_MULTICAST(ntohl(dst))) {
2218 /*
2219 * Send the reply on a known multicast capable vif.
2220 * If we don't have one, we can't source any multicasts anyway.
2221 */
2222 if (phys_vif != -1) {
2223 logit(LOG_DEBUG, 0, "Sending reply to %s from %s",
2224 inet_fmt(dst), inet_fmt(uvifs[phys_vif].uv_lcl_addr));
2225 k_set_ttl(qry->tr_rttl);
2226 send_igmp(uvifs[phys_vif].uv_lcl_addr, dst,
2227 resptype, no, group,
2228 datalen);
2229 k_set_ttl(1);
2230 } else
2231 logit(LOG_INFO, 0, "No enabled phyints -- %s",
2232 "dropping traceroute reply");
2233 } else {
2234 logit(LOG_DEBUG, 0, "Sending %s to %s from %s",
2235 resptype == IGMP_MTRACE_REPLY ? "reply" : "request on",
2236 inet_fmt(dst), inet_fmt(src));
2237
2238 send_igmp(src, dst,
2239 resptype, no, group,
2240 datalen);
2241 }
2242 return;
2243 }
NetBSD on the FriendlyARM MINI2440