]>
Commit | Line | Data |
---|---|---|
3f9c7369 DS |
1 | /** |
2 | * bgp_updgrp_packet.c: BGP update group packet handling routines | |
3 | * | |
4 | * @copyright Copyright (C) 2014 Cumulus Networks, Inc. | |
5 | * | |
6 | * @author Avneesh Sachdev <avneesh@sproute.net> | |
7 | * @author Rajesh Varadarajan <rajesh@sproute.net> | |
8 | * @author Pradosh Mohapatra <pradosh@sproute.net> | |
9 | * | |
10 | * This file is part of GNU Zebra. | |
11 | * | |
12 | * GNU Zebra is free software; you can redistribute it and/or modify it | |
13 | * under the terms of the GNU General Public License as published by the | |
14 | * Free Software Foundation; either version 2, or (at your option) any | |
15 | * later version. | |
16 | * | |
17 | * GNU Zebra is distributed in the hope that it will be useful, but | |
18 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
19 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
20 | * General Public License for more details. | |
21 | * | |
22 | * You should have received a copy of the GNU General Public License | |
23 | * along with GNU Zebra; see the file COPYING. If not, write to the Free | |
24 | * Software Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA | |
25 | * 02111-1307, USA. | |
26 | */ | |
27 | ||
28 | #include <zebra.h> | |
29 | ||
30 | #include "prefix.h" | |
31 | #include "thread.h" | |
32 | #include "buffer.h" | |
33 | #include "stream.h" | |
34 | #include "command.h" | |
35 | #include "sockunion.h" | |
36 | #include "network.h" | |
37 | #include "memory.h" | |
38 | #include "filter.h" | |
39 | #include "routemap.h" | |
40 | #include "str.h" | |
41 | #include "log.h" | |
42 | #include "plist.h" | |
43 | #include "linklist.h" | |
44 | #include "workqueue.h" | |
45 | #include "hash.h" | |
46 | #include "queue.h" | |
47 | ||
48 | #include "bgpd/bgpd.h" | |
49 | #include "bgpd/bgp_debug.h" | |
50 | #include "bgpd/bgp_fsm.h" | |
51 | #include "bgpd/bgp_route.h" | |
52 | #include "bgpd/bgp_packet.h" | |
53 | #include "bgpd/bgp_advertise.h" | |
54 | #include "bgpd/bgp_updgrp.h" | |
55 | #include "bgpd/bgp_nexthop.h" | |
56 | #include "bgpd/bgp_nht.h" | |
57 | ||
58 | /******************** | |
59 | * PRIVATE FUNCTIONS | |
60 | ********************/ | |
61 | ||
62 | /******************** | |
63 | * PUBLIC FUNCTIONS | |
64 | ********************/ | |
65 | struct bpacket * | |
66 | bpacket_alloc () | |
67 | { | |
68 | struct bpacket *pkt; | |
69 | ||
70 | pkt = | |
71 | (struct bpacket *) XCALLOC (MTYPE_BGP_PACKET, sizeof (struct bpacket)); | |
72 | ||
73 | return pkt; | |
74 | } | |
75 | ||
76 | void | |
77 | bpacket_free (struct bpacket *pkt) | |
78 | { | |
79 | if (pkt->buffer) | |
80 | stream_free (pkt->buffer); | |
81 | pkt->buffer = NULL; | |
82 | XFREE (MTYPE_BGP_PACKET, pkt); | |
83 | } | |
84 | ||
85 | void | |
86 | bpacket_queue_init (struct bpacket_queue *q) | |
87 | { | |
88 | TAILQ_INIT (&(q->pkts)); | |
89 | } | |
90 | ||
91 | /* | |
92 | * bpacket_queue_sanity_check | |
93 | */ | |
94 | void | |
95 | bpacket_queue_sanity_check (struct bpacket_queue __attribute__ ((__unused__)) *q) | |
96 | { | |
97 | #if 0 | |
98 | struct bpacket *pkt; | |
99 | ||
100 | pkt = bpacket_queue_last (q); | |
101 | assert (pkt); | |
102 | assert (!pkt->buffer); | |
103 | ||
104 | /* | |
105 | * Make sure the count of packets is correct. | |
106 | */ | |
107 | int num_pkts = 0; | |
108 | ||
109 | pkt = bpacket_queue_first (q); | |
110 | while (pkt) | |
111 | { | |
112 | num_pkts++; | |
113 | ||
114 | if (num_pkts > q->curr_count) | |
115 | assert (0); | |
116 | ||
117 | pkt = TAILQ_NEXT (pkt, pkt_train); | |
118 | } | |
119 | ||
120 | assert (num_pkts == q->curr_count); | |
121 | #endif | |
122 | } | |
123 | ||
124 | /* | |
125 | * bpacket_queue_add_packet | |
126 | * | |
127 | * Internal function of bpacket_queue - and adds a | |
128 | * packet entry to the end of the list. | |
129 | * | |
130 | * Users of bpacket_queue should use bpacket_queue_add instead. | |
131 | */ | |
132 | static void | |
133 | bpacket_queue_add_packet (struct bpacket_queue *q, struct bpacket *pkt) | |
134 | { | |
135 | struct bpacket *last_pkt; | |
136 | ||
137 | if (TAILQ_EMPTY (&(q->pkts))) | |
138 | TAILQ_INSERT_TAIL (&(q->pkts), pkt, pkt_train); | |
139 | else | |
140 | { | |
141 | last_pkt = bpacket_queue_last (q); | |
142 | TAILQ_INSERT_AFTER (&(q->pkts), last_pkt, pkt, pkt_train); | |
143 | } | |
144 | q->curr_count++; | |
145 | if (q->hwm_count < q->curr_count) | |
146 | q->hwm_count = q->curr_count; | |
147 | } | |
148 | ||
149 | /* | |
150 | * Adds a packet to the bpacket_queue. | |
151 | * | |
152 | * The stream passed is consumed by this function. So, the caller should | |
153 | * not free or use the stream after | |
154 | * invoking this function. | |
155 | */ | |
156 | struct bpacket * | |
157 | bpacket_queue_add (struct bpacket_queue *q, struct stream *s, | |
158 | struct bpacket_attr_vec_arr *vecarrp) | |
159 | { | |
160 | struct bpacket *pkt; | |
161 | struct bpacket *last_pkt; | |
162 | ||
163 | ||
164 | pkt = bpacket_alloc (); | |
165 | if (TAILQ_EMPTY (&(q->pkts))) | |
166 | { | |
167 | pkt->ver = 1; | |
168 | pkt->buffer = s; | |
169 | if (vecarrp) | |
170 | memcpy (&pkt->arr, vecarrp, sizeof (struct bpacket_attr_vec_arr)); | |
171 | else | |
172 | bpacket_attr_vec_arr_reset (&pkt->arr); | |
173 | bpacket_queue_add_packet (q, pkt); | |
174 | bpacket_queue_sanity_check (q); | |
175 | return pkt; | |
176 | } | |
177 | ||
178 | /* | |
179 | * Fill in the new information into the current sentinel and create a | |
180 | * new sentinel. | |
181 | */ | |
182 | bpacket_queue_sanity_check (q); | |
183 | last_pkt = bpacket_queue_last (q); | |
184 | assert (last_pkt->buffer == NULL); | |
185 | last_pkt->buffer = s; | |
186 | if (vecarrp) | |
187 | memcpy (&last_pkt->arr, vecarrp, sizeof (struct bpacket_attr_vec_arr)); | |
188 | else | |
189 | bpacket_attr_vec_arr_reset (&last_pkt->arr); | |
190 | ||
191 | pkt->ver = last_pkt->ver; | |
192 | pkt->ver++; | |
193 | bpacket_queue_add_packet (q, pkt); | |
194 | ||
195 | bpacket_queue_sanity_check (q); | |
196 | return last_pkt; | |
197 | } | |
198 | ||
199 | struct bpacket * | |
200 | bpacket_queue_first (struct bpacket_queue *q) | |
201 | { | |
202 | return (TAILQ_FIRST (&(q->pkts))); | |
203 | } | |
204 | ||
205 | struct bpacket * | |
206 | bpacket_queue_last (struct bpacket_queue *q) | |
207 | { | |
208 | return TAILQ_LAST (&(q->pkts), pkt_queue); | |
209 | } | |
210 | ||
211 | struct bpacket * | |
212 | bpacket_queue_remove (struct bpacket_queue *q) | |
213 | { | |
214 | struct bpacket *first; | |
215 | ||
216 | first = bpacket_queue_first (q); | |
217 | if (first) | |
218 | { | |
219 | TAILQ_REMOVE (&(q->pkts), first, pkt_train); | |
220 | q->curr_count--; | |
221 | } | |
222 | return first; | |
223 | } | |
224 | ||
225 | unsigned int | |
226 | bpacket_queue_length (struct bpacket_queue *q) | |
227 | { | |
228 | return q->curr_count - 1; | |
229 | } | |
230 | ||
231 | unsigned int | |
232 | bpacket_queue_hwm_length (struct bpacket_queue *q) | |
233 | { | |
234 | return q->hwm_count - 1; | |
235 | } | |
236 | ||
237 | int | |
238 | bpacket_queue_is_full (struct bgp *bgp, struct bpacket_queue *q) | |
239 | { | |
240 | if (q->curr_count >= bgp->default_subgroup_pkt_queue_max) | |
241 | return 1; | |
242 | return 0; | |
243 | } | |
244 | ||
245 | void | |
246 | bpacket_add_peer (struct bpacket *pkt, struct peer_af *paf) | |
247 | { | |
248 | if (!pkt || !paf) | |
249 | return; | |
250 | ||
251 | LIST_INSERT_HEAD (&(pkt->peers), paf, pkt_train); | |
252 | paf->next_pkt_to_send = pkt; | |
253 | } | |
254 | ||
255 | /* | |
256 | * bpacket_queue_cleanup | |
257 | */ | |
258 | void | |
259 | bpacket_queue_cleanup (struct bpacket_queue *q) | |
260 | { | |
261 | struct bpacket *pkt; | |
262 | ||
263 | while ((pkt = bpacket_queue_remove (q))) | |
264 | { | |
265 | bpacket_free (pkt); | |
266 | } | |
267 | } | |
268 | ||
269 | /* | |
270 | * bpacket_queue_compact | |
271 | * | |
272 | * Delete packets that do not need to be transmitted to any peer from | |
273 | * the queue. | |
274 | * | |
275 | * @return the number of packets deleted. | |
276 | */ | |
277 | static int | |
278 | bpacket_queue_compact (struct bpacket_queue *q) | |
279 | { | |
280 | int num_deleted; | |
281 | struct bpacket *pkt, *removed_pkt; | |
282 | ||
283 | num_deleted = 0; | |
284 | ||
285 | while (1) | |
286 | { | |
287 | pkt = bpacket_queue_first (q); | |
288 | if (!pkt) | |
289 | break; | |
290 | ||
291 | /* | |
292 | * Don't delete the sentinel. | |
293 | */ | |
294 | if (!pkt->buffer) | |
295 | break; | |
296 | ||
297 | if (!LIST_EMPTY (&(pkt->peers))) | |
298 | break; | |
299 | ||
300 | removed_pkt = bpacket_queue_remove (q); | |
301 | assert (pkt == removed_pkt); | |
302 | bpacket_free (removed_pkt); | |
303 | ||
304 | num_deleted++; | |
305 | } | |
306 | ||
307 | bpacket_queue_sanity_check (q); | |
308 | return num_deleted; | |
309 | } | |
310 | ||
311 | void | |
312 | bpacket_queue_advance_peer (struct peer_af *paf) | |
313 | { | |
314 | struct bpacket *pkt; | |
315 | struct bpacket *old_pkt; | |
316 | ||
317 | old_pkt = paf->next_pkt_to_send; | |
318 | if (old_pkt->buffer == NULL) | |
319 | /* Already at end of list */ | |
320 | return; | |
321 | ||
322 | LIST_REMOVE (paf, pkt_train); | |
323 | pkt = TAILQ_NEXT (old_pkt, pkt_train); | |
324 | bpacket_add_peer (pkt, paf); | |
325 | ||
326 | if (!bpacket_queue_compact (PAF_PKTQ (paf))) | |
327 | return; | |
328 | ||
329 | /* | |
330 | * Deleted one or more packets. Check if we can now merge this | |
331 | * peer's subgroup into another subgroup. | |
332 | */ | |
333 | update_subgroup_check_merge (paf->subgroup, "advanced peer in queue"); | |
334 | } | |
335 | ||
336 | /* | |
337 | * bpacket_queue_remove_peer | |
338 | * | |
339 | * Remove the peer from the packet queue of the subgroup it belongs | |
340 | * to. | |
341 | */ | |
342 | void | |
343 | bpacket_queue_remove_peer (struct peer_af *paf) | |
344 | { | |
345 | struct bpacket_queue *q; | |
346 | ||
347 | q = PAF_PKTQ (paf); | |
348 | assert (q); | |
349 | if (!q) | |
350 | return; | |
351 | ||
352 | LIST_REMOVE (paf, pkt_train); | |
353 | paf->next_pkt_to_send = NULL; | |
354 | ||
355 | bpacket_queue_compact (q); | |
356 | } | |
357 | ||
358 | unsigned int | |
359 | bpacket_queue_virtual_length (struct peer_af *paf) | |
360 | { | |
361 | struct bpacket *pkt; | |
362 | struct bpacket *last; | |
363 | struct bpacket_queue *q; | |
364 | ||
365 | pkt = paf->next_pkt_to_send; | |
366 | if (!pkt || (pkt->buffer == NULL)) | |
367 | /* Already at end of list */ | |
368 | return 0; | |
369 | ||
370 | q = PAF_PKTQ (paf); | |
371 | if (TAILQ_EMPTY (&(q->pkts))) | |
372 | return 0; | |
373 | ||
374 | last = TAILQ_LAST (&(q->pkts), pkt_queue); | |
375 | if (last->ver >= pkt->ver) | |
376 | return last->ver - pkt->ver; | |
377 | ||
378 | /* sequence # rolled over */ | |
379 | return (UINT_MAX - pkt->ver + 1) + last->ver; | |
380 | } | |
381 | ||
382 | /* | |
383 | * Dump the bpacket queue | |
384 | */ | |
385 | void | |
386 | bpacket_queue_show_vty (struct bpacket_queue *q, struct vty *vty) | |
387 | { | |
388 | struct bpacket *pkt; | |
389 | struct peer_af *paf; | |
390 | ||
391 | pkt = bpacket_queue_first (q); | |
392 | while (pkt) | |
393 | { | |
394 | vty_out (vty, " Packet %p ver %u buffer %p%s", pkt, pkt->ver, | |
395 | pkt->buffer, VTY_NEWLINE); | |
396 | ||
397 | LIST_FOREACH (paf, &(pkt->peers), pkt_train) | |
398 | { | |
399 | vty_out (vty, " - %s%s", paf->peer->host, VTY_NEWLINE); | |
400 | } | |
401 | pkt = bpacket_next (pkt); | |
402 | } | |
403 | return; | |
404 | } | |
405 | ||
406 | struct stream * | |
407 | bpacket_reformat_for_peer (struct bpacket *pkt, struct peer_af *paf) | |
408 | { | |
409 | struct stream *s = NULL; | |
410 | bpacket_attr_vec *vec; | |
411 | ||
412 | s = stream_dup (pkt->buffer); | |
413 | ||
414 | vec = &pkt->arr.entries[BGP_ATTR_VEC_NH]; | |
415 | if (CHECK_FLAG (vec->flags, BPACKET_ATTRVEC_FLAGS_UPDATED)) | |
416 | { | |
417 | u_int8_t nhlen; | |
418 | int route_map_sets_nh; | |
419 | nhlen = stream_getc_from (s, vec->offset); | |
420 | ||
421 | route_map_sets_nh = CHECK_FLAG (vec->flags, | |
422 | BPACKET_ATTRVEC_FLAGS_RMAP_CHANGED); | |
423 | ||
424 | if (paf->afi == AFI_IP) | |
425 | { | |
426 | struct in_addr v4nh; | |
427 | ||
428 | stream_get_from (&v4nh, s, vec->offset + 1, 4); | |
429 | ||
430 | /* If NH unavailable from attribute or the route-map has set it to | |
431 | * be the peering address, use peer's NH. The "NH unavailable" case | |
432 | * also covers next-hop-self and some other scenarios -- see | |
433 | * subgroup_announce_check(). The only other case where we use the | |
434 | * peer's NH is if it is an EBGP multiaccess scenario and there is | |
435 | * no next-hop-unchanged setting. | |
436 | */ | |
437 | if (!v4nh.s_addr || | |
438 | (route_map_sets_nh && | |
439 | CHECK_FLAG(vec->flags, | |
440 | BPACKET_ATTRVEC_FLAGS_RMAP_NH_PEER_ADDRESS))) | |
441 | stream_put_in_addr_at (s, vec->offset + 1, &paf->peer->nexthop.v4); | |
442 | else if (paf->peer->sort == BGP_PEER_EBGP && | |
443 | !peer_af_flag_check (paf->peer, paf->afi, paf->safi, | |
444 | PEER_FLAG_NEXTHOP_UNCHANGED)) | |
445 | { | |
446 | if (bgp_multiaccess_check_v4 (v4nh, paf->peer) == 0) | |
447 | stream_put_in_addr_at (s, vec->offset + 1, | |
448 | &paf->peer->nexthop.v4); | |
449 | } | |
450 | ||
451 | #if 0 | |
452 | if (!v4nh.s_addr) | |
453 | nhtouse = paf->peer->nexthop.v4; | |
454 | ||
455 | /* | |
456 | * If NH is available from attribute (which is after outbound | |
457 | * policy application), always use it if it has been specified | |
458 | * by the policy. Otherwise, the decision to make is whether | |
459 | * we need to set ourselves as the next-hop or not. Here are | |
460 | * the conditions for that (1 OR 2): | |
461 | * | |
462 | * (1) if the configuration says: 'next-hop-self' | |
463 | * (2) if the peer is EBGP AND not a third-party-nexthop type | |
464 | * | |
465 | * There are some exceptions even if the above conditions apply. | |
466 | * Those are: | |
467 | * (a) if the configuration says: 'next-hop-unchanged'. Honor that | |
468 | * always. Not set 'self' as next-hop. | |
469 | * (b) if we are reflecting the routes (IBGP->IBGP) and the config | |
470 | * is _not_ forcing next-hop-self. We should pass on the | |
471 | * next-hop unchanged for reflected routes. | |
472 | */ | |
473 | if (route_map_sets_nh) | |
474 | { | |
475 | /* | |
476 | * If address is specified, nothing to do; if specified as | |
477 | * 'peer-address', compute the value to use. | |
478 | * | |
479 | * NOTE: If we are reflecting routes, the policy could have set | |
480 | * this only if outbound policy has been allowed for route | |
481 | * reflection -- handled in announce_check(). | |
482 | */ | |
483 | if (CHECK_FLAG(vec->flags, | |
484 | BPACKET_ATTRVEC_FLAGS_RMAP_NH_PEER_ADDRESS)) | |
485 | nhtouse = paf->peer->nexthop.v4; | |
486 | } | |
487 | else if (peer_af_flag_check (paf->peer, paf->afi, paf->safi, | |
488 | PEER_FLAG_NEXTHOP_SELF) | |
489 | || (paf->peer->sort == BGP_PEER_EBGP && | |
490 | (bgp_multiaccess_check_v4 (v4nh, paf->peer) == 0))) | |
491 | { | |
492 | if (!(peer_af_flag_check (paf->peer, paf->afi, paf->safi, | |
493 | PEER_FLAG_NEXTHOP_UNCHANGED) | |
494 | || (CHECK_FLAG(vec->flags, BPACKET_ATTRVEC_FLAGS_REFLECTED) && | |
495 | !peer_af_flag_check(paf->peer, paf->afi, paf->safi, | |
496 | PEER_FLAG_FORCE_NEXTHOP_SELF)))) | |
497 | nhtouse = paf->peer->nexthop.v4; | |
498 | } | |
499 | #endif | |
500 | ||
501 | } | |
502 | else if (paf->afi == AFI_IP6) | |
503 | { | |
504 | struct in6_addr v6nhglobal; | |
505 | struct in6_addr v6nhlocal; | |
506 | ||
507 | /* | |
508 | * The logic here is rather similar to that for IPv4, the | |
509 | * additional work being to handle 1 or 2 nexthops. | |
510 | */ | |
511 | stream_get_from (&v6nhglobal, s, vec->offset + 1, 16); | |
512 | if (IN6_IS_ADDR_UNSPECIFIED (&v6nhglobal) || | |
513 | (route_map_sets_nh && | |
514 | CHECK_FLAG(vec->flags, | |
515 | BPACKET_ATTRVEC_FLAGS_RMAP_NH_PEER_ADDRESS))) | |
516 | stream_put_in6_addr_at (s, vec->offset + 1, | |
517 | &paf->peer->nexthop.v6_global); | |
518 | else if (paf->peer->sort == BGP_PEER_EBGP && | |
519 | !peer_af_flag_check (paf->peer, paf->afi, paf->safi, | |
520 | PEER_FLAG_NEXTHOP_UNCHANGED)) | |
521 | { | |
522 | stream_put_in6_addr_at (s, vec->offset + 1, | |
523 | &paf->peer->nexthop.v6_global); | |
524 | } | |
525 | ||
526 | if (nhlen == 32) | |
527 | { | |
528 | stream_get_from (&v6nhlocal, s, vec->offset + 1 + 16, 16); | |
529 | if (IN6_IS_ADDR_UNSPECIFIED (&v6nhlocal)) | |
530 | stream_put_in6_addr_at (s, vec->offset + 1 + 16, | |
531 | &paf->peer->nexthop.v6_local); | |
532 | } | |
533 | } | |
534 | } | |
535 | ||
536 | bgp_packet_add (paf->peer, s); | |
537 | return s; | |
538 | } | |
539 | ||
540 | /* | |
541 | * Update the vecarr offsets to go beyond 'pos' bytes, i.e. add 'pos' | |
542 | * to each offset. | |
543 | */ | |
544 | static void | |
545 | bpacket_attr_vec_arr_update (struct bpacket_attr_vec_arr *vecarr, size_t pos) | |
546 | { | |
547 | int i; | |
548 | ||
549 | if (!vecarr) | |
550 | return; | |
551 | ||
552 | for (i = 0; i < BGP_ATTR_VEC_MAX; i++) | |
553 | vecarr->entries[i].offset += pos; | |
554 | } | |
555 | ||
556 | /* | |
557 | * Return if there are packets to build for this subgroup. | |
558 | */ | |
559 | int | |
560 | subgroup_packets_to_build (struct update_subgroup *subgrp) | |
561 | { | |
562 | struct bgp_advertise *adv; | |
563 | ||
564 | if (!subgrp) | |
565 | return 0; | |
566 | ||
567 | adv = BGP_ADV_FIFO_HEAD (&subgrp->sync->withdraw); | |
568 | if (adv) | |
569 | return 1; | |
570 | ||
571 | adv = BGP_ADV_FIFO_HEAD (&subgrp->sync->update); | |
572 | if (adv) | |
573 | return 1; | |
574 | ||
575 | return 0; | |
576 | } | |
577 | ||
578 | /* Make BGP update packet. */ | |
579 | struct bpacket * | |
580 | subgroup_update_packet (struct update_subgroup *subgrp) | |
581 | { | |
582 | struct bpacket_attr_vec_arr vecarr; | |
583 | struct bpacket *pkt; | |
584 | struct peer *peer; | |
585 | struct stream *s; | |
586 | struct stream *snlri; | |
587 | struct stream *packet; | |
588 | struct bgp_adj_out *adj; | |
589 | struct bgp_advertise *adv; | |
590 | struct bgp_node *rn = NULL; | |
591 | struct bgp_info *binfo = NULL; | |
592 | bgp_size_t total_attr_len = 0; | |
593 | unsigned long attrlen_pos = 0; | |
594 | size_t mpattrlen_pos = 0; | |
595 | size_t mpattr_pos = 0; | |
596 | afi_t afi; | |
597 | safi_t safi; | |
598 | int space_remaining = 0; | |
599 | int space_needed = 0; | |
600 | char send_attr_str[BUFSIZ]; | |
601 | int send_attr_printed; | |
602 | int num_pfx = 0; | |
603 | ||
604 | ||
605 | if (!subgrp) | |
606 | return NULL; | |
607 | ||
608 | if (bpacket_queue_is_full (SUBGRP_INST (subgrp), SUBGRP_PKTQ (subgrp))) | |
609 | return NULL; | |
610 | ||
611 | ||
612 | peer = SUBGRP_PEER (subgrp); | |
613 | afi = SUBGRP_AFI (subgrp); | |
614 | safi = SUBGRP_SAFI (subgrp); | |
615 | s = subgrp->work; | |
616 | stream_reset (s); | |
617 | snlri = subgrp->scratch; | |
618 | stream_reset (snlri); | |
619 | ||
620 | bpacket_attr_vec_arr_reset (&vecarr); | |
621 | ||
622 | adv = BGP_ADV_FIFO_HEAD (&subgrp->sync->update); | |
623 | while (adv) | |
624 | { | |
625 | assert (adv->rn); | |
626 | rn = adv->rn; | |
627 | adj = adv->adj; | |
628 | if (adv->binfo) | |
629 | binfo = adv->binfo; | |
630 | ||
631 | space_remaining = STREAM_CONCAT_REMAIN (s, snlri, STREAM_SIZE(s)) - | |
632 | BGP_MAX_PACKET_SIZE_OVERFLOW; | |
633 | space_needed = BGP_NLRI_LENGTH + PSIZE (rn->p.prefixlen); | |
634 | ||
635 | /* When remaining space can't include NLRI and it's length. */ | |
636 | if (space_remaining < space_needed) | |
637 | break; | |
638 | ||
639 | /* If packet is empty, set attribute. */ | |
640 | if (stream_empty (s)) | |
641 | { | |
642 | struct peer *from = NULL; | |
643 | ||
644 | if (binfo) | |
645 | from = binfo->peer; | |
646 | ||
647 | /* 1: Write the BGP message header - 16 bytes marker, 2 bytes length, | |
648 | * one byte message type. | |
649 | */ | |
650 | bgp_packet_set_marker (s, BGP_MSG_UPDATE); | |
651 | ||
652 | /* 2: withdrawn routes length */ | |
653 | stream_putw (s, 0); | |
654 | ||
655 | /* 3: total attributes length - attrlen_pos stores the position */ | |
656 | attrlen_pos = stream_get_endp (s); | |
657 | stream_putw (s, 0); | |
658 | ||
659 | /* 4: if there is MP_REACH_NLRI attribute, that should be the first | |
660 | * attribute, according to draft-ietf-idr-error-handling. Save the | |
661 | * position. | |
662 | */ | |
663 | mpattr_pos = stream_get_endp (s); | |
664 | ||
665 | /* 5: Encode all the attributes, except MP_REACH_NLRI attr. */ | |
666 | total_attr_len = bgp_packet_attribute (NULL, peer, s, | |
667 | adv->baa->attr, &vecarr, | |
668 | NULL, afi, safi, | |
669 | from, NULL, NULL); | |
670 | ||
671 | space_remaining = STREAM_CONCAT_REMAIN (s, snlri, STREAM_SIZE(s)) - | |
672 | BGP_MAX_PACKET_SIZE_OVERFLOW; | |
673 | space_needed = BGP_NLRI_LENGTH + PSIZE (rn->p.prefixlen); | |
674 | ||
675 | /* If the attributes alone do not leave any room for NLRI then | |
676 | * return */ | |
677 | if (space_remaining < space_needed) | |
678 | { | |
679 | zlog_err ("u%llu:s%llu attributes too long, cannot send UPDATE", | |
680 | subgrp->update_group->id, subgrp->id); | |
681 | ||
682 | /* Flush the FIFO update queue */ | |
683 | while (adv) | |
684 | adv = bgp_advertise_clean_subgroup (subgrp, adj); | |
685 | return NULL; | |
686 | } | |
687 | ||
688 | if (BGP_DEBUG (update, UPDATE_OUT) || | |
689 | BGP_DEBUG (update, UPDATE_PREFIX)) | |
690 | { | |
691 | memset (send_attr_str, 0, BUFSIZ); | |
692 | send_attr_printed = 0; | |
693 | bgp_dump_attr (peer, adv->baa->attr, send_attr_str, BUFSIZ); | |
694 | } | |
695 | } | |
696 | ||
697 | if (afi == AFI_IP && safi == SAFI_UNICAST) | |
698 | stream_put_prefix (s, &rn->p); | |
699 | else | |
700 | { | |
701 | /* Encode the prefix in MP_REACH_NLRI attribute */ | |
702 | struct prefix_rd *prd = NULL; | |
703 | u_char *tag = NULL; | |
704 | ||
705 | if (rn->prn) | |
706 | prd = (struct prefix_rd *) &rn->prn->p; | |
707 | if (binfo && binfo->extra) | |
708 | tag = binfo->extra->tag; | |
709 | ||
710 | if (stream_empty (snlri)) | |
711 | mpattrlen_pos = bgp_packet_mpattr_start (snlri, afi, safi, | |
712 | &vecarr, adv->baa->attr); | |
713 | bgp_packet_mpattr_prefix (snlri, afi, safi, &rn->p, prd, tag); | |
714 | } | |
715 | ||
716 | num_pfx++; | |
717 | ||
718 | if (bgp_debug_update(NULL, &rn->p, subgrp->update_group, 0)) | |
719 | { | |
720 | char buf[INET6_BUFSIZ]; | |
721 | ||
722 | if (!send_attr_printed) | |
723 | { | |
724 | zlog_debug ("u%llu:s%llu send UPDATE w/ attr: %s", | |
725 | subgrp->update_group->id, subgrp->id, send_attr_str); | |
726 | send_attr_printed = 1; | |
727 | } | |
728 | ||
729 | zlog_debug ("u%llu:s%llu send UPDATE %s/%d", | |
730 | subgrp->update_group->id, subgrp->id, | |
731 | inet_ntop (rn->p.family, &(rn->p.u.prefix), buf, | |
732 | INET6_BUFSIZ), rn->p.prefixlen); | |
733 | } | |
734 | ||
735 | /* Synchnorize attribute. */ | |
736 | if (adj->attr) | |
737 | bgp_attr_unintern (&adj->attr); | |
738 | else | |
739 | subgrp->scount++; | |
740 | ||
741 | adj->attr = bgp_attr_intern (adv->baa->attr); | |
742 | ||
743 | adv = bgp_advertise_clean_subgroup (subgrp, adj); | |
744 | } | |
745 | ||
746 | if (!stream_empty (s)) | |
747 | { | |
748 | if (!stream_empty (snlri)) | |
749 | { | |
750 | bgp_packet_mpattr_end (snlri, mpattrlen_pos); | |
751 | total_attr_len += stream_get_endp (snlri); | |
752 | } | |
753 | ||
754 | /* set the total attribute length correctly */ | |
755 | stream_putw_at (s, attrlen_pos, total_attr_len); | |
756 | ||
757 | if (!stream_empty (snlri)) | |
758 | { | |
759 | packet = stream_dupcat (s, snlri, mpattr_pos); | |
760 | bpacket_attr_vec_arr_update (&vecarr, mpattr_pos); | |
761 | } | |
762 | else | |
763 | packet = stream_dup (s); | |
764 | bgp_packet_set_size (packet); | |
765 | if (bgp_debug_update(NULL, NULL, subgrp->update_group, 0)) | |
766 | zlog_debug ("u%llu:s%llu UPDATE len %d numpfx %d", | |
767 | subgrp->update_group->id, subgrp->id, | |
768 | (stream_get_endp(packet) - stream_get_getp(packet)), num_pfx); | |
769 | pkt = bpacket_queue_add (SUBGRP_PKTQ (subgrp), packet, &vecarr); | |
770 | stream_reset (s); | |
771 | stream_reset (snlri); | |
772 | return pkt; | |
773 | } | |
774 | return NULL; | |
775 | } | |
776 | ||
777 | /* Make BGP withdraw packet. */ | |
778 | /* For ipv4 unicast: | |
779 | 16-octet marker | 2-octet length | 1-octet type | | |
780 | 2-octet withdrawn route length | withdrawn prefixes | 2-octet attrlen (=0) | |
781 | */ | |
782 | /* For other afi/safis: | |
783 | 16-octet marker | 2-octet length | 1-octet type | | |
784 | 2-octet withdrawn route length (=0) | 2-octet attrlen | | |
785 | mp_unreach attr type | attr len | afi | safi | withdrawn prefixes | |
786 | */ | |
787 | struct bpacket * | |
788 | subgroup_withdraw_packet (struct update_subgroup *subgrp) | |
789 | { | |
790 | struct bpacket *pkt; | |
791 | struct stream *s; | |
792 | struct bgp_adj_out *adj; | |
793 | struct bgp_advertise *adv; | |
794 | struct peer *peer; | |
795 | struct bgp_node *rn; | |
796 | bgp_size_t unfeasible_len; | |
797 | bgp_size_t total_attr_len; | |
798 | size_t mp_start = 0; | |
799 | size_t attrlen_pos = 0; | |
800 | size_t mplen_pos = 0; | |
801 | u_char first_time = 1; | |
802 | afi_t afi; | |
803 | safi_t safi; | |
804 | int space_remaining = 0; | |
805 | int space_needed = 0; | |
806 | int num_pfx = 0; | |
807 | ||
808 | if (!subgrp) | |
809 | return NULL; | |
810 | ||
811 | if (bpacket_queue_is_full (SUBGRP_INST (subgrp), SUBGRP_PKTQ (subgrp))) | |
812 | return NULL; | |
813 | ||
814 | ||
815 | peer = SUBGRP_PEER (subgrp); | |
816 | afi = SUBGRP_AFI (subgrp); | |
817 | safi = SUBGRP_SAFI (subgrp); | |
818 | s = subgrp->work; | |
819 | stream_reset (s); | |
820 | ||
821 | while ((adv = BGP_ADV_FIFO_HEAD (&subgrp->sync->withdraw)) != NULL) | |
822 | { | |
823 | assert (adv->rn); | |
824 | adj = adv->adj; | |
825 | rn = adv->rn; | |
826 | ||
827 | space_remaining = STREAM_REMAIN (s) - | |
828 | BGP_MAX_PACKET_SIZE_OVERFLOW; | |
829 | space_needed = (BGP_NLRI_LENGTH + BGP_TOTAL_ATTR_LEN + | |
830 | PSIZE (rn->p.prefixlen)); | |
831 | ||
832 | if (space_remaining < space_needed) | |
833 | break; | |
834 | ||
835 | if (stream_empty (s)) | |
836 | { | |
837 | bgp_packet_set_marker (s, BGP_MSG_UPDATE); | |
838 | stream_putw (s, 0); /* unfeasible routes length */ | |
839 | } | |
840 | else | |
841 | first_time = 0; | |
842 | ||
843 | if (afi == AFI_IP && safi == SAFI_UNICAST) | |
844 | stream_put_prefix (s, &rn->p); | |
845 | else | |
846 | { | |
847 | struct prefix_rd *prd = NULL; | |
848 | ||
849 | if (rn->prn) | |
850 | prd = (struct prefix_rd *) &rn->prn->p; | |
851 | ||
852 | /* If first time, format the MP_UNREACH header */ | |
853 | if (first_time) | |
854 | { | |
855 | attrlen_pos = stream_get_endp (s); | |
856 | /* total attr length = 0 for now. reevaluate later */ | |
857 | stream_putw (s, 0); | |
858 | mp_start = stream_get_endp (s); | |
859 | mplen_pos = bgp_packet_mpunreach_start (s, afi, safi); | |
860 | } | |
861 | ||
862 | bgp_packet_mpunreach_prefix (s, &rn->p, afi, safi, prd, NULL); | |
863 | } | |
864 | ||
865 | num_pfx++; | |
866 | ||
867 | if (bgp_debug_update(NULL, &rn->p, subgrp->update_group, 0)) | |
868 | { | |
869 | char buf[INET6_BUFSIZ]; | |
870 | ||
871 | zlog_debug ("u%llu:s%llu send UPDATE %s/%d -- unreachable", | |
872 | subgrp->update_group->id, subgrp->id, | |
873 | inet_ntop (rn->p.family, &(rn->p.u.prefix), buf, | |
874 | INET6_BUFSIZ), rn->p.prefixlen); | |
875 | } | |
876 | ||
877 | subgrp->scount--; | |
878 | ||
879 | bgp_adj_out_remove_subgroup (rn, adj, subgrp); | |
880 | bgp_unlock_node (rn); | |
881 | } | |
882 | ||
883 | if (!stream_empty (s)) | |
884 | { | |
885 | if (afi == AFI_IP && safi == SAFI_UNICAST) | |
886 | { | |
887 | unfeasible_len | |
888 | = stream_get_endp (s) - BGP_HEADER_SIZE - BGP_UNFEASIBLE_LEN; | |
889 | stream_putw_at (s, BGP_HEADER_SIZE, unfeasible_len); | |
890 | stream_putw (s, 0); | |
891 | } | |
892 | else | |
893 | { | |
894 | /* Set the mp_unreach attr's length */ | |
895 | bgp_packet_mpunreach_end (s, mplen_pos); | |
896 | ||
897 | /* Set total path attribute length. */ | |
898 | total_attr_len = stream_get_endp (s) - mp_start; | |
899 | stream_putw_at (s, attrlen_pos, total_attr_len); | |
900 | } | |
901 | bgp_packet_set_size (s); | |
902 | if (bgp_debug_update(NULL, NULL, subgrp->update_group, 0)) | |
903 | zlog_debug ("u%llu:s%llu UPDATE (withdraw) len %d numpfx %d", | |
904 | subgrp->update_group->id, subgrp->id, | |
905 | (stream_get_endp(s) - stream_get_getp(s)), num_pfx); | |
906 | pkt = bpacket_queue_add (SUBGRP_PKTQ (subgrp), stream_dup (s), NULL); | |
907 | stream_reset (s); | |
908 | return pkt; | |
909 | } | |
910 | ||
911 | return NULL; | |
912 | } | |
913 | ||
914 | void | |
915 | subgroup_default_update_packet (struct update_subgroup *subgrp, | |
916 | struct attr *attr, struct peer *from) | |
917 | { | |
918 | struct stream *s; | |
919 | struct stream *packet; | |
920 | struct peer *peer; | |
921 | struct prefix p; | |
922 | unsigned long pos; | |
923 | bgp_size_t total_attr_len; | |
924 | afi_t afi; | |
925 | safi_t safi; | |
926 | struct bpacket_attr_vec_arr vecarr; | |
927 | ||
928 | if (DISABLE_BGP_ANNOUNCE) | |
929 | return; | |
930 | ||
931 | if (!subgrp) | |
932 | return; | |
933 | ||
934 | peer = SUBGRP_PEER (subgrp); | |
935 | afi = SUBGRP_AFI (subgrp); | |
936 | safi = SUBGRP_SAFI (subgrp); | |
937 | bpacket_attr_vec_arr_reset (&vecarr); | |
938 | ||
939 | if (afi == AFI_IP) | |
940 | str2prefix ("0.0.0.0/0", &p); | |
941 | #ifdef HAVE_IPV6 | |
942 | else | |
943 | str2prefix ("::/0", &p); | |
944 | #endif /* HAVE_IPV6 */ | |
945 | ||
946 | /* Logging the attribute. */ | |
947 | if (bgp_debug_update(NULL, &p, subgrp->update_group, 0)) | |
948 | { | |
949 | char attrstr[BUFSIZ]; | |
950 | char buf[INET6_BUFSIZ]; | |
951 | attrstr[0] = '\0'; | |
952 | ||
953 | bgp_dump_attr (peer, attr, attrstr, BUFSIZ); | |
954 | zlog_debug ("u%llu:s%llu send UPDATE %s/%d %s", | |
955 | (SUBGRP_UPDGRP (subgrp))->id, subgrp->id, | |
956 | inet_ntop (p.family, &(p.u.prefix), buf, INET6_BUFSIZ), | |
957 | p.prefixlen, attrstr); | |
958 | } | |
959 | ||
960 | s = stream_new (BGP_MAX_PACKET_SIZE); | |
961 | ||
962 | /* Make BGP update packet. */ | |
963 | bgp_packet_set_marker (s, BGP_MSG_UPDATE); | |
964 | ||
965 | /* Unfeasible Routes Length. */ | |
966 | stream_putw (s, 0); | |
967 | ||
968 | /* Make place for total attribute length. */ | |
969 | pos = stream_get_endp (s); | |
970 | stream_putw (s, 0); | |
971 | total_attr_len = bgp_packet_attribute (NULL, peer, s, attr, &vecarr, &p, | |
972 | afi, safi, from, NULL, NULL); | |
973 | ||
974 | /* Set Total Path Attribute Length. */ | |
975 | stream_putw_at (s, pos, total_attr_len); | |
976 | ||
977 | /* NLRI set. */ | |
978 | if (p.family == AF_INET && safi == SAFI_UNICAST) | |
979 | stream_put_prefix (s, &p); | |
980 | ||
981 | /* Set size. */ | |
982 | bgp_packet_set_size (s); | |
983 | ||
984 | packet = stream_dup (s); | |
985 | stream_free (s); | |
986 | (void) bpacket_queue_add (SUBGRP_PKTQ (subgrp), packet, &vecarr); | |
987 | subgroup_trigger_write(subgrp); | |
988 | } | |
989 | ||
990 | void | |
991 | subgroup_default_withdraw_packet (struct update_subgroup *subgrp) | |
992 | { | |
993 | struct peer *peer; | |
994 | struct stream *s; | |
995 | struct stream *packet; | |
996 | struct prefix p; | |
997 | unsigned long attrlen_pos = 0; | |
998 | unsigned long cp; | |
999 | bgp_size_t unfeasible_len; | |
1000 | bgp_size_t total_attr_len; | |
1001 | size_t mp_start = 0; | |
1002 | size_t mplen_pos = 0; | |
1003 | afi_t afi; | |
1004 | safi_t safi; | |
1005 | ||
1006 | if (DISABLE_BGP_ANNOUNCE) | |
1007 | return; | |
1008 | ||
1009 | peer = SUBGRP_PEER (subgrp); | |
1010 | afi = SUBGRP_AFI (subgrp); | |
1011 | safi = SUBGRP_SAFI (subgrp); | |
1012 | ||
1013 | if (afi == AFI_IP) | |
1014 | str2prefix ("0.0.0.0/0", &p); | |
1015 | #ifdef HAVE_IPV6 | |
1016 | else | |
1017 | str2prefix ("::/0", &p); | |
1018 | #endif /* HAVE_IPV6 */ | |
1019 | ||
1020 | total_attr_len = 0; | |
1021 | ||
1022 | if (bgp_debug_update(NULL, &p, subgrp->update_group, 0)) | |
1023 | { | |
1024 | char buf[INET6_BUFSIZ]; | |
1025 | ||
1026 | zlog_debug ("u%llu:s%llu send UPDATE %s/%d -- unreachable", | |
1027 | (SUBGRP_UPDGRP (subgrp))->id, subgrp->id, inet_ntop (p.family, | |
1028 | &(p.u. | |
1029 | prefix), | |
1030 | buf, | |
1031 | INET6_BUFSIZ), | |
1032 | p.prefixlen); | |
1033 | } | |
1034 | ||
1035 | s = stream_new (BGP_MAX_PACKET_SIZE); | |
1036 | ||
1037 | /* Make BGP update packet. */ | |
1038 | bgp_packet_set_marker (s, BGP_MSG_UPDATE); | |
1039 | ||
1040 | /* Unfeasible Routes Length. */ ; | |
1041 | cp = stream_get_endp (s); | |
1042 | stream_putw (s, 0); | |
1043 | ||
1044 | /* Withdrawn Routes. */ | |
1045 | if (p.family == AF_INET && safi == SAFI_UNICAST) | |
1046 | { | |
1047 | stream_put_prefix (s, &p); | |
1048 | ||
1049 | unfeasible_len = stream_get_endp (s) - cp - 2; | |
1050 | ||
1051 | /* Set unfeasible len. */ | |
1052 | stream_putw_at (s, cp, unfeasible_len); | |
1053 | ||
1054 | /* Set total path attribute length. */ | |
1055 | stream_putw (s, 0); | |
1056 | } | |
1057 | else | |
1058 | { | |
1059 | attrlen_pos = stream_get_endp (s); | |
1060 | stream_putw (s, 0); | |
1061 | mp_start = stream_get_endp (s); | |
1062 | mplen_pos = bgp_packet_mpunreach_start (s, afi, safi); | |
1063 | bgp_packet_mpunreach_prefix (s, &p, afi, safi, NULL, NULL); | |
1064 | ||
1065 | /* Set the mp_unreach attr's length */ | |
1066 | bgp_packet_mpunreach_end (s, mplen_pos); | |
1067 | ||
1068 | /* Set total path attribute length. */ | |
1069 | total_attr_len = stream_get_endp (s) - mp_start; | |
1070 | stream_putw_at (s, attrlen_pos, total_attr_len); | |
1071 | } | |
1072 | ||
1073 | bgp_packet_set_size (s); | |
1074 | ||
1075 | packet = stream_dup (s); | |
1076 | stream_free (s); | |
1077 | ||
1078 | (void) bpacket_queue_add (SUBGRP_PKTQ (subgrp), packet, NULL); | |
1079 | subgroup_trigger_write(subgrp); | |
1080 | } | |
1081 | ||
1082 | static void | |
1083 | bpacket_vec_arr_inherit_attr_flags (struct bpacket_attr_vec_arr *vecarr, | |
1084 | bpacket_attr_vec_type type, | |
1085 | struct attr *attr) | |
1086 | { | |
1087 | if (CHECK_FLAG (attr->rmap_change_flags, | |
1088 | BATTR_RMAP_NEXTHOP_CHANGED)) | |
1089 | SET_FLAG (vecarr->entries[BGP_ATTR_VEC_NH].flags, | |
1090 | BPACKET_ATTRVEC_FLAGS_RMAP_CHANGED); | |
1091 | ||
1092 | if (CHECK_FLAG (attr->rmap_change_flags, | |
1093 | BATTR_RMAP_NEXTHOP_PEER_ADDRESS)) | |
1094 | SET_FLAG (vecarr->entries[BGP_ATTR_VEC_NH].flags, | |
1095 | BPACKET_ATTRVEC_FLAGS_RMAP_NH_PEER_ADDRESS); | |
1096 | ||
1097 | if (CHECK_FLAG (attr->rmap_change_flags, BATTR_REFLECTED)) | |
1098 | SET_FLAG (vecarr->entries[BGP_ATTR_VEC_NH].flags, | |
1099 | BPACKET_ATTRVEC_FLAGS_REFLECTED); | |
1100 | } | |
1101 | ||
1102 | /* Reset the Attributes vector array. The vector array is used to override | |
1103 | * certain output parameters in the packet for a particular peer | |
1104 | */ | |
1105 | void | |
1106 | bpacket_attr_vec_arr_reset (struct bpacket_attr_vec_arr *vecarr) | |
1107 | { | |
1108 | int i; | |
1109 | ||
1110 | if (!vecarr) | |
1111 | return; | |
1112 | ||
1113 | i = 0; | |
1114 | while (i < BGP_ATTR_VEC_MAX) | |
1115 | { | |
1116 | vecarr->entries[i].flags = 0; | |
1117 | vecarr->entries[i].offset = 0; | |
1118 | i++; | |
1119 | } | |
1120 | } | |
1121 | ||
1122 | /* Setup a particular node entry in the vecarr */ | |
1123 | void | |
1124 | bpacket_attr_vec_arr_set_vec (struct bpacket_attr_vec_arr *vecarr, | |
1125 | bpacket_attr_vec_type type, struct stream *s, | |
1126 | struct attr *attr) | |
1127 | { | |
1128 | if (!vecarr) | |
1129 | return; | |
1130 | assert (type < BGP_ATTR_VEC_MAX); | |
1131 | ||
1132 | SET_FLAG (vecarr->entries[type].flags, BPACKET_ATTRVEC_FLAGS_UPDATED); | |
1133 | vecarr->entries[type].offset = stream_get_endp (s); | |
1134 | if (attr) | |
1135 | bpacket_vec_arr_inherit_attr_flags(vecarr, type, attr); | |
1136 | } |