]>
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; | |
3811f1e2 | 411 | struct peer *peer; |
325671b7 DS |
412 | char buf[BUFSIZ]; |
413 | char buf2[BUFSIZ]; | |
3f9c7369 DS |
414 | |
415 | s = stream_dup (pkt->buffer); | |
3811f1e2 | 416 | peer = PAF_PEER(paf); |
3f9c7369 DS |
417 | |
418 | vec = &pkt->arr.entries[BGP_ATTR_VEC_NH]; | |
3811f1e2 | 419 | if (CHECK_FLAG (vec->flags, BPKT_ATTRVEC_FLAGS_UPDATED)) |
3f9c7369 DS |
420 | { |
421 | u_int8_t nhlen; | |
422 | int route_map_sets_nh; | |
423 | nhlen = stream_getc_from (s, vec->offset); | |
424 | ||
3811f1e2 | 425 | if (paf->afi == AFI_IP && !peer_cap_enhe(peer)) |
3f9c7369 | 426 | { |
3811f1e2 DS |
427 | struct in_addr v4nh, *mod_v4nh; |
428 | int nh_modified = 0; | |
429 | ||
430 | route_map_sets_nh = | |
431 | (CHECK_FLAG (vec->flags, BPKT_ATTRVEC_FLAGS_RMAP_IPV4_NH_CHANGED) || | |
432 | CHECK_FLAG (vec->flags, BPKT_ATTRVEC_FLAGS_RMAP_NH_PEER_ADDRESS)); | |
3f9c7369 DS |
433 | |
434 | stream_get_from (&v4nh, s, vec->offset + 1, 4); | |
3811f1e2 | 435 | mod_v4nh = &v4nh; |
3f9c7369 | 436 | |
3811f1e2 DS |
437 | /* |
438 | * If route-map has set the nexthop, that is always used; if it is | |
439 | * specified as peer-address, the peering address is picked up. | |
440 | * Otherwise, if NH is unavailable from attribute, the peering addr | |
441 | * is picked up; the "NH unavailable" case also covers next-hop-self | |
442 | * and some other scenarios -- see subgroup_announce_check(). In | |
443 | * all other cases, use the nexthop carried in the attribute unless | |
444 | * it is EBGP non-multiaccess and there is no next-hop-unchanged setting. | |
445 | * Note: It is assumed route-map cannot set the nexthop to an | |
446 | * invalid value. | |
3f9c7369 | 447 | */ |
3f9c7369 DS |
448 | if (route_map_sets_nh) |
449 | { | |
3811f1e2 DS |
450 | if (CHECK_FLAG(vec->flags, |
451 | BPKT_ATTRVEC_FLAGS_RMAP_NH_PEER_ADDRESS)) | |
452 | { | |
453 | mod_v4nh = &peer->nexthop.v4; | |
454 | nh_modified = 1; | |
455 | } | |
456 | } | |
457 | else if (!v4nh.s_addr) | |
458 | { | |
459 | mod_v4nh = &peer->nexthop.v4; | |
460 | nh_modified = 1; | |
461 | } | |
462 | else if (peer->sort == BGP_PEER_EBGP && | |
463 | (bgp_multiaccess_check_v4 (v4nh, peer) == 0) && | |
464 | !CHECK_FLAG(vec->flags, | |
465 | BPKT_ATTRVEC_FLAGS_RMAP_NH_UNCHANGED) && | |
466 | !peer_af_flag_check (peer, paf->afi, paf->safi, | |
467 | PEER_FLAG_NEXTHOP_UNCHANGED)) | |
468 | { | |
469 | mod_v4nh = &peer->nexthop.v4; | |
470 | nh_modified = 1; | |
3f9c7369 | 471 | } |
3811f1e2 DS |
472 | |
473 | if (nh_modified) | |
474 | stream_put_in_addr_at (s, vec->offset + 1, mod_v4nh); | |
3f9c7369 | 475 | |
325671b7 | 476 | if (bgp_debug_update(peer, NULL, NULL, 0)) |
88177fe3 | 477 | zlog_debug ("u%" PRIu64 ":s%" PRIu64 " %s send UPDATE w/ nexthop %s", |
325671b7 DS |
478 | PAF_SUBGRP(paf)->update_group->id, PAF_SUBGRP(paf)->id, |
479 | peer->host, inet_ntoa (*mod_v4nh)); | |
480 | ||
3f9c7369 | 481 | } |
3811f1e2 | 482 | else if (paf->afi == AFI_IP6 || peer_cap_enhe(peer)) |
3f9c7369 | 483 | { |
3811f1e2 DS |
484 | struct in6_addr v6nhglobal, *mod_v6nhg; |
485 | struct in6_addr v6nhlocal, *mod_v6nhl; | |
486 | int gnh_modified, lnh_modified; | |
487 | ||
488 | gnh_modified = lnh_modified = 0; | |
489 | mod_v6nhg = &v6nhglobal; | |
490 | mod_v6nhl = &v6nhlocal; | |
491 | ||
492 | route_map_sets_nh = | |
493 | (CHECK_FLAG (vec->flags, BPKT_ATTRVEC_FLAGS_RMAP_IPV6_GNH_CHANGED) || | |
494 | CHECK_FLAG (vec->flags, BPKT_ATTRVEC_FLAGS_RMAP_NH_PEER_ADDRESS)); | |
3f9c7369 DS |
495 | |
496 | /* | |
497 | * The logic here is rather similar to that for IPv4, the | |
3811f1e2 DS |
498 | * additional work being to handle 1 or 2 nexthops. Also, 3rd |
499 | * party nexthop is not propagated for EBGP right now. | |
3f9c7369 DS |
500 | */ |
501 | stream_get_from (&v6nhglobal, s, vec->offset + 1, 16); | |
3811f1e2 DS |
502 | if (route_map_sets_nh) |
503 | { | |
504 | if (CHECK_FLAG(vec->flags, | |
505 | BPKT_ATTRVEC_FLAGS_RMAP_NH_PEER_ADDRESS)) | |
506 | { | |
507 | mod_v6nhg = &peer->nexthop.v6_global; | |
508 | gnh_modified = 1; | |
509 | } | |
510 | } | |
511 | else if (IN6_IS_ADDR_UNSPECIFIED (&v6nhglobal)) | |
512 | { | |
513 | mod_v6nhg = &peer->nexthop.v6_global; | |
514 | gnh_modified = 1; | |
515 | } | |
516 | else if (peer->sort == BGP_PEER_EBGP && | |
517 | !CHECK_FLAG(vec->flags, | |
518 | BPKT_ATTRVEC_FLAGS_RMAP_NH_UNCHANGED) && | |
519 | !peer_af_flag_check (peer, paf->afi, paf->safi, | |
3f9c7369 | 520 | PEER_FLAG_NEXTHOP_UNCHANGED)) |
3811f1e2 DS |
521 | { |
522 | mod_v6nhg = &peer->nexthop.v6_global; | |
523 | gnh_modified = 1; | |
524 | } | |
525 | ||
3f9c7369 DS |
526 | |
527 | if (nhlen == 32) | |
528 | { | |
529 | stream_get_from (&v6nhlocal, s, vec->offset + 1 + 16, 16); | |
530 | if (IN6_IS_ADDR_UNSPECIFIED (&v6nhlocal)) | |
3811f1e2 DS |
531 | { |
532 | mod_v6nhl = &peer->nexthop.v6_local; | |
533 | lnh_modified = 1; | |
534 | } | |
3f9c7369 | 535 | } |
3811f1e2 DS |
536 | |
537 | if (gnh_modified) | |
538 | stream_put_in6_addr_at (s, vec->offset + 1, mod_v6nhg); | |
539 | if (lnh_modified) | |
540 | stream_put_in6_addr_at (s, vec->offset + 1 + 16, mod_v6nhl); | |
325671b7 DS |
541 | |
542 | if (bgp_debug_update(peer, NULL, NULL, 0)) | |
543 | { | |
544 | if (nhlen == 32) | |
88177fe3 | 545 | zlog_debug ("u%" PRIu64 ":s%" PRIu64 " %s send UPDATE w/ mp_nexthops %s, %s", |
325671b7 DS |
546 | PAF_SUBGRP(paf)->update_group->id, |
547 | PAF_SUBGRP(paf)->id, | |
548 | peer->host, | |
549 | inet_ntop (AF_INET6, mod_v6nhg, buf, BUFSIZ), | |
550 | inet_ntop (AF_INET6, mod_v6nhl, buf2, BUFSIZ)); | |
551 | else | |
88177fe3 | 552 | zlog_debug ("u%" PRIu64 ":s%" PRIu64 " %s send UPDATE w/ mp_nexthop %s", |
325671b7 DS |
553 | PAF_SUBGRP(paf)->update_group->id, |
554 | PAF_SUBGRP(paf)->id, | |
555 | peer->host, | |
556 | inet_ntop (AF_INET6, mod_v6nhg, buf, BUFSIZ)); | |
557 | } | |
3f9c7369 DS |
558 | } |
559 | } | |
560 | ||
3811f1e2 | 561 | bgp_packet_add (peer, s); |
3f9c7369 DS |
562 | return s; |
563 | } | |
564 | ||
565 | /* | |
566 | * Update the vecarr offsets to go beyond 'pos' bytes, i.e. add 'pos' | |
567 | * to each offset. | |
568 | */ | |
569 | static void | |
570 | bpacket_attr_vec_arr_update (struct bpacket_attr_vec_arr *vecarr, size_t pos) | |
571 | { | |
572 | int i; | |
573 | ||
574 | if (!vecarr) | |
575 | return; | |
576 | ||
577 | for (i = 0; i < BGP_ATTR_VEC_MAX; i++) | |
578 | vecarr->entries[i].offset += pos; | |
579 | } | |
580 | ||
581 | /* | |
582 | * Return if there are packets to build for this subgroup. | |
583 | */ | |
584 | int | |
585 | subgroup_packets_to_build (struct update_subgroup *subgrp) | |
586 | { | |
587 | struct bgp_advertise *adv; | |
588 | ||
589 | if (!subgrp) | |
590 | return 0; | |
591 | ||
592 | adv = BGP_ADV_FIFO_HEAD (&subgrp->sync->withdraw); | |
593 | if (adv) | |
594 | return 1; | |
595 | ||
596 | adv = BGP_ADV_FIFO_HEAD (&subgrp->sync->update); | |
597 | if (adv) | |
598 | return 1; | |
599 | ||
600 | return 0; | |
601 | } | |
602 | ||
adbac85e DW |
603 | static void |
604 | bgp_info_addpath_tx_str (int addpath_encode, u_int32_t addpath_tx_id, | |
605 | char *buf) | |
606 | { | |
607 | if (addpath_encode) | |
608 | sprintf(buf, " with addpath ID %d", addpath_tx_id); | |
609 | } | |
610 | ||
3f9c7369 DS |
611 | /* Make BGP update packet. */ |
612 | struct bpacket * | |
613 | subgroup_update_packet (struct update_subgroup *subgrp) | |
614 | { | |
615 | struct bpacket_attr_vec_arr vecarr; | |
616 | struct bpacket *pkt; | |
617 | struct peer *peer; | |
618 | struct stream *s; | |
619 | struct stream *snlri; | |
620 | struct stream *packet; | |
621 | struct bgp_adj_out *adj; | |
622 | struct bgp_advertise *adv; | |
623 | struct bgp_node *rn = NULL; | |
624 | struct bgp_info *binfo = NULL; | |
625 | bgp_size_t total_attr_len = 0; | |
626 | unsigned long attrlen_pos = 0; | |
627 | size_t mpattrlen_pos = 0; | |
628 | size_t mpattr_pos = 0; | |
629 | afi_t afi; | |
630 | safi_t safi; | |
631 | int space_remaining = 0; | |
632 | int space_needed = 0; | |
633 | char send_attr_str[BUFSIZ]; | |
ffd0c037 | 634 | int send_attr_printed = 0; |
3f9c7369 | 635 | int num_pfx = 0; |
adbac85e DW |
636 | int addpath_encode = 0; |
637 | u_int32_t addpath_tx_id = 0; | |
3f9c7369 DS |
638 | |
639 | if (!subgrp) | |
640 | return NULL; | |
641 | ||
642 | if (bpacket_queue_is_full (SUBGRP_INST (subgrp), SUBGRP_PKTQ (subgrp))) | |
643 | return NULL; | |
644 | ||
645 | ||
646 | peer = SUBGRP_PEER (subgrp); | |
647 | afi = SUBGRP_AFI (subgrp); | |
648 | safi = SUBGRP_SAFI (subgrp); | |
649 | s = subgrp->work; | |
650 | stream_reset (s); | |
651 | snlri = subgrp->scratch; | |
652 | stream_reset (snlri); | |
653 | ||
654 | bpacket_attr_vec_arr_reset (&vecarr); | |
655 | ||
adbac85e DW |
656 | addpath_encode = bgp_addpath_encode_tx (peer, afi, safi); |
657 | ||
3f9c7369 DS |
658 | adv = BGP_ADV_FIFO_HEAD (&subgrp->sync->update); |
659 | while (adv) | |
660 | { | |
661 | assert (adv->rn); | |
662 | rn = adv->rn; | |
663 | adj = adv->adj; | |
adbac85e DW |
664 | addpath_tx_id = adj->addpath_tx_id; |
665 | binfo = adv->binfo; | |
3f9c7369 DS |
666 | |
667 | space_remaining = STREAM_CONCAT_REMAIN (s, snlri, STREAM_SIZE(s)) - | |
668 | BGP_MAX_PACKET_SIZE_OVERFLOW; | |
93b73dfa LB |
669 | space_needed = BGP_NLRI_LENGTH + |
670 | bgp_packet_mpattr_prefix_size (afi, safi, &rn->p); | |
3f9c7369 DS |
671 | |
672 | /* When remaining space can't include NLRI and it's length. */ | |
673 | if (space_remaining < space_needed) | |
674 | break; | |
675 | ||
676 | /* If packet is empty, set attribute. */ | |
677 | if (stream_empty (s)) | |
678 | { | |
679 | struct peer *from = NULL; | |
680 | ||
681 | if (binfo) | |
6407da5a | 682 | from = binfo->peer; |
3f9c7369 DS |
683 | |
684 | /* 1: Write the BGP message header - 16 bytes marker, 2 bytes length, | |
685 | * one byte message type. | |
686 | */ | |
687 | bgp_packet_set_marker (s, BGP_MSG_UPDATE); | |
688 | ||
689 | /* 2: withdrawn routes length */ | |
690 | stream_putw (s, 0); | |
691 | ||
692 | /* 3: total attributes length - attrlen_pos stores the position */ | |
693 | attrlen_pos = stream_get_endp (s); | |
694 | stream_putw (s, 0); | |
695 | ||
696 | /* 4: if there is MP_REACH_NLRI attribute, that should be the first | |
697 | * attribute, according to draft-ietf-idr-error-handling. Save the | |
698 | * position. | |
699 | */ | |
700 | mpattr_pos = stream_get_endp (s); | |
701 | ||
702 | /* 5: Encode all the attributes, except MP_REACH_NLRI attr. */ | |
703 | total_attr_len = bgp_packet_attribute (NULL, peer, s, | |
704 | adv->baa->attr, &vecarr, | |
6407da5a | 705 | NULL, afi, safi, |
706 | from, NULL, NULL, 0, 0); | |
3f9c7369 DS |
707 | |
708 | space_remaining = STREAM_CONCAT_REMAIN (s, snlri, STREAM_SIZE(s)) - | |
709 | BGP_MAX_PACKET_SIZE_OVERFLOW; | |
6407da5a | 710 | space_needed = BGP_NLRI_LENGTH + |
711 | bgp_packet_mpattr_prefix_size (afi, safi, &rn->p); | |
3f9c7369 DS |
712 | |
713 | /* If the attributes alone do not leave any room for NLRI then | |
714 | * return */ | |
715 | if (space_remaining < space_needed) | |
716 | { | |
ffd0c037 | 717 | zlog_err ("u%" PRIu64 ":s%" PRIu64 " attributes too long, cannot send UPDATE", |
3f9c7369 DS |
718 | subgrp->update_group->id, subgrp->id); |
719 | ||
720 | /* Flush the FIFO update queue */ | |
721 | while (adv) | |
722 | adv = bgp_advertise_clean_subgroup (subgrp, adj); | |
723 | return NULL; | |
724 | } | |
725 | ||
726 | if (BGP_DEBUG (update, UPDATE_OUT) || | |
727 | BGP_DEBUG (update, UPDATE_PREFIX)) | |
728 | { | |
729 | memset (send_attr_str, 0, BUFSIZ); | |
730 | send_attr_printed = 0; | |
731 | bgp_dump_attr (peer, adv->baa->attr, send_attr_str, BUFSIZ); | |
732 | } | |
733 | } | |
734 | ||
8a92a8a0 DS |
735 | if ((afi == AFI_IP && safi == SAFI_UNICAST) && |
736 | !peer_cap_enhe(peer)) | |
adbac85e | 737 | stream_put_prefix_addpath (s, &rn->p, addpath_encode, addpath_tx_id); |
3f9c7369 DS |
738 | else |
739 | { | |
740 | /* Encode the prefix in MP_REACH_NLRI attribute */ | |
741 | struct prefix_rd *prd = NULL; | |
742 | u_char *tag = NULL; | |
743 | ||
744 | if (rn->prn) | |
745 | prd = (struct prefix_rd *) &rn->prn->p; | |
746 | if (binfo && binfo->extra) | |
747 | tag = binfo->extra->tag; | |
748 | ||
749 | if (stream_empty (snlri)) | |
750 | mpattrlen_pos = bgp_packet_mpattr_start (snlri, afi, safi, | |
8a92a8a0 DS |
751 | (peer_cap_enhe(peer) ? AFI_IP6 : afi), |
752 | &vecarr, adv->baa->attr); | |
adbac85e DW |
753 | bgp_packet_mpattr_prefix (snlri, afi, safi, &rn->p, prd, tag, |
754 | addpath_encode, addpath_tx_id); | |
3f9c7369 DS |
755 | } |
756 | ||
757 | num_pfx++; | |
758 | ||
759 | if (bgp_debug_update(NULL, &rn->p, subgrp->update_group, 0)) | |
760 | { | |
adbac85e DW |
761 | char buf[INET6_BUFSIZ]; |
762 | char tx_id_buf[30]; | |
3f9c7369 DS |
763 | |
764 | if (!send_attr_printed) | |
765 | { | |
ffd0c037 | 766 | zlog_debug ("u%" PRIu64 ":s%" PRIu64 " send UPDATE w/ attr: %s", |
3f9c7369 DS |
767 | subgrp->update_group->id, subgrp->id, send_attr_str); |
768 | send_attr_printed = 1; | |
769 | } | |
770 | ||
adbac85e DW |
771 | bgp_info_addpath_tx_str (addpath_encode, addpath_tx_id, tx_id_buf); |
772 | zlog_debug ("u%" PRIu64 ":s%" PRIu64 " send UPDATE %s/%d%s", | |
773 | subgrp->update_group->id, subgrp->id, | |
774 | inet_ntop (rn->p.family, &(rn->p.u.prefix), buf, INET6_BUFSIZ), | |
775 | rn->p.prefixlen, tx_id_buf); | |
3f9c7369 DS |
776 | } |
777 | ||
778 | /* Synchnorize attribute. */ | |
779 | if (adj->attr) | |
780 | bgp_attr_unintern (&adj->attr); | |
781 | else | |
782 | subgrp->scount++; | |
783 | ||
784 | adj->attr = bgp_attr_intern (adv->baa->attr); | |
785 | ||
786 | adv = bgp_advertise_clean_subgroup (subgrp, adj); | |
787 | } | |
788 | ||
789 | if (!stream_empty (s)) | |
790 | { | |
791 | if (!stream_empty (snlri)) | |
792 | { | |
793 | bgp_packet_mpattr_end (snlri, mpattrlen_pos); | |
794 | total_attr_len += stream_get_endp (snlri); | |
795 | } | |
796 | ||
797 | /* set the total attribute length correctly */ | |
798 | stream_putw_at (s, attrlen_pos, total_attr_len); | |
799 | ||
800 | if (!stream_empty (snlri)) | |
801 | { | |
802 | packet = stream_dupcat (s, snlri, mpattr_pos); | |
803 | bpacket_attr_vec_arr_update (&vecarr, mpattr_pos); | |
804 | } | |
805 | else | |
806 | packet = stream_dup (s); | |
807 | bgp_packet_set_size (packet); | |
808 | if (bgp_debug_update(NULL, NULL, subgrp->update_group, 0)) | |
ffd0c037 | 809 | zlog_debug ("u%" PRIu64 ":s%" PRIu64 " UPDATE len %zd numpfx %d", |
3f9c7369 DS |
810 | subgrp->update_group->id, subgrp->id, |
811 | (stream_get_endp(packet) - stream_get_getp(packet)), num_pfx); | |
812 | pkt = bpacket_queue_add (SUBGRP_PKTQ (subgrp), packet, &vecarr); | |
813 | stream_reset (s); | |
814 | stream_reset (snlri); | |
815 | return pkt; | |
816 | } | |
817 | return NULL; | |
818 | } | |
819 | ||
820 | /* Make BGP withdraw packet. */ | |
821 | /* For ipv4 unicast: | |
822 | 16-octet marker | 2-octet length | 1-octet type | | |
823 | 2-octet withdrawn route length | withdrawn prefixes | 2-octet attrlen (=0) | |
824 | */ | |
825 | /* For other afi/safis: | |
826 | 16-octet marker | 2-octet length | 1-octet type | | |
827 | 2-octet withdrawn route length (=0) | 2-octet attrlen | | |
828 | mp_unreach attr type | attr len | afi | safi | withdrawn prefixes | |
829 | */ | |
830 | struct bpacket * | |
831 | subgroup_withdraw_packet (struct update_subgroup *subgrp) | |
832 | { | |
833 | struct bpacket *pkt; | |
834 | struct stream *s; | |
835 | struct bgp_adj_out *adj; | |
836 | struct bgp_advertise *adv; | |
8a92a8a0 | 837 | struct peer *peer; |
3f9c7369 DS |
838 | struct bgp_node *rn; |
839 | bgp_size_t unfeasible_len; | |
840 | bgp_size_t total_attr_len; | |
841 | size_t mp_start = 0; | |
842 | size_t attrlen_pos = 0; | |
843 | size_t mplen_pos = 0; | |
844 | u_char first_time = 1; | |
845 | afi_t afi; | |
846 | safi_t safi; | |
847 | int space_remaining = 0; | |
848 | int space_needed = 0; | |
849 | int num_pfx = 0; | |
adbac85e DW |
850 | int addpath_encode = 0; |
851 | u_int32_t addpath_tx_id = 0; | |
3f9c7369 DS |
852 | |
853 | if (!subgrp) | |
854 | return NULL; | |
855 | ||
856 | if (bpacket_queue_is_full (SUBGRP_INST (subgrp), SUBGRP_PKTQ (subgrp))) | |
857 | return NULL; | |
858 | ||
8a92a8a0 | 859 | peer = SUBGRP_PEER (subgrp); |
3f9c7369 DS |
860 | afi = SUBGRP_AFI (subgrp); |
861 | safi = SUBGRP_SAFI (subgrp); | |
862 | s = subgrp->work; | |
863 | stream_reset (s); | |
adbac85e | 864 | addpath_encode = bgp_addpath_encode_tx (peer, afi, safi); |
3f9c7369 DS |
865 | |
866 | while ((adv = BGP_ADV_FIFO_HEAD (&subgrp->sync->withdraw)) != NULL) | |
867 | { | |
868 | assert (adv->rn); | |
869 | adj = adv->adj; | |
870 | rn = adv->rn; | |
adbac85e | 871 | addpath_tx_id = adj->addpath_tx_id; |
3f9c7369 DS |
872 | |
873 | space_remaining = STREAM_REMAIN (s) - | |
874 | BGP_MAX_PACKET_SIZE_OVERFLOW; | |
6407da5a | 875 | space_needed = BGP_NLRI_LENGTH + BGP_TOTAL_ATTR_LEN + |
876 | bgp_packet_mpattr_prefix_size (afi, safi, &rn->p); | |
3f9c7369 DS |
877 | |
878 | if (space_remaining < space_needed) | |
879 | break; | |
880 | ||
881 | if (stream_empty (s)) | |
882 | { | |
883 | bgp_packet_set_marker (s, BGP_MSG_UPDATE); | |
884 | stream_putw (s, 0); /* unfeasible routes length */ | |
885 | } | |
886 | else | |
887 | first_time = 0; | |
888 | ||
8a92a8a0 DS |
889 | if (afi == AFI_IP && safi == SAFI_UNICAST && |
890 | !peer_cap_enhe(peer)) | |
adbac85e | 891 | stream_put_prefix_addpath (s, &rn->p, addpath_encode, addpath_tx_id); |
3f9c7369 DS |
892 | else |
893 | { | |
894 | struct prefix_rd *prd = NULL; | |
895 | ||
896 | if (rn->prn) | |
897 | prd = (struct prefix_rd *) &rn->prn->p; | |
898 | ||
899 | /* If first time, format the MP_UNREACH header */ | |
900 | if (first_time) | |
901 | { | |
902 | attrlen_pos = stream_get_endp (s); | |
903 | /* total attr length = 0 for now. reevaluate later */ | |
904 | stream_putw (s, 0); | |
905 | mp_start = stream_get_endp (s); | |
906 | mplen_pos = bgp_packet_mpunreach_start (s, afi, safi); | |
907 | } | |
908 | ||
adbac85e DW |
909 | bgp_packet_mpunreach_prefix (s, &rn->p, afi, safi, prd, NULL, |
910 | addpath_encode, addpath_tx_id); | |
3f9c7369 DS |
911 | } |
912 | ||
913 | num_pfx++; | |
914 | ||
915 | if (bgp_debug_update(NULL, &rn->p, subgrp->update_group, 0)) | |
916 | { | |
adbac85e DW |
917 | char buf[INET6_BUFSIZ]; |
918 | char tx_id_buf[30]; | |
919 | bgp_info_addpath_tx_str (addpath_encode, addpath_tx_id, tx_id_buf); | |
920 | zlog_debug ("u%" PRIu64 ":s%" PRIu64 " send UPDATE %s/%d%s -- unreachable", | |
921 | subgrp->update_group->id, subgrp->id, | |
922 | inet_ntop (rn->p.family, &(rn->p.u.prefix), buf, INET6_BUFSIZ), | |
923 | rn->p.prefixlen, tx_id_buf); | |
3f9c7369 DS |
924 | } |
925 | ||
926 | subgrp->scount--; | |
927 | ||
928 | bgp_adj_out_remove_subgroup (rn, adj, subgrp); | |
929 | bgp_unlock_node (rn); | |
930 | } | |
931 | ||
932 | if (!stream_empty (s)) | |
933 | { | |
8a92a8a0 DS |
934 | if (afi == AFI_IP && safi == SAFI_UNICAST && |
935 | !peer_cap_enhe(peer)) | |
3f9c7369 DS |
936 | { |
937 | unfeasible_len | |
938 | = stream_get_endp (s) - BGP_HEADER_SIZE - BGP_UNFEASIBLE_LEN; | |
939 | stream_putw_at (s, BGP_HEADER_SIZE, unfeasible_len); | |
940 | stream_putw (s, 0); | |
941 | } | |
942 | else | |
943 | { | |
944 | /* Set the mp_unreach attr's length */ | |
945 | bgp_packet_mpunreach_end (s, mplen_pos); | |
946 | ||
947 | /* Set total path attribute length. */ | |
948 | total_attr_len = stream_get_endp (s) - mp_start; | |
949 | stream_putw_at (s, attrlen_pos, total_attr_len); | |
950 | } | |
951 | bgp_packet_set_size (s); | |
952 | if (bgp_debug_update(NULL, NULL, subgrp->update_group, 0)) | |
ffd0c037 | 953 | zlog_debug ("u%" PRIu64 ":s%" PRIu64 " UPDATE (withdraw) len %zd numpfx %d", |
3f9c7369 DS |
954 | subgrp->update_group->id, subgrp->id, |
955 | (stream_get_endp(s) - stream_get_getp(s)), num_pfx); | |
956 | pkt = bpacket_queue_add (SUBGRP_PKTQ (subgrp), stream_dup (s), NULL); | |
957 | stream_reset (s); | |
958 | return pkt; | |
959 | } | |
960 | ||
961 | return NULL; | |
962 | } | |
963 | ||
964 | void | |
965 | subgroup_default_update_packet (struct update_subgroup *subgrp, | |
966 | struct attr *attr, struct peer *from) | |
967 | { | |
968 | struct stream *s; | |
3f9c7369 DS |
969 | struct peer *peer; |
970 | struct prefix p; | |
971 | unsigned long pos; | |
972 | bgp_size_t total_attr_len; | |
973 | afi_t afi; | |
974 | safi_t safi; | |
975 | struct bpacket_attr_vec_arr vecarr; | |
adbac85e | 976 | int addpath_encode = 0; |
3f9c7369 DS |
977 | |
978 | if (DISABLE_BGP_ANNOUNCE) | |
979 | return; | |
980 | ||
981 | if (!subgrp) | |
982 | return; | |
983 | ||
984 | peer = SUBGRP_PEER (subgrp); | |
985 | afi = SUBGRP_AFI (subgrp); | |
986 | safi = SUBGRP_SAFI (subgrp); | |
987 | bpacket_attr_vec_arr_reset (&vecarr); | |
adbac85e | 988 | addpath_encode = bgp_addpath_encode_tx (peer, afi, safi); |
3f9c7369 DS |
989 | |
990 | if (afi == AFI_IP) | |
991 | str2prefix ("0.0.0.0/0", &p); | |
992 | #ifdef HAVE_IPV6 | |
993 | else | |
994 | str2prefix ("::/0", &p); | |
995 | #endif /* HAVE_IPV6 */ | |
996 | ||
997 | /* Logging the attribute. */ | |
998 | if (bgp_debug_update(NULL, &p, subgrp->update_group, 0)) | |
999 | { | |
1000 | char attrstr[BUFSIZ]; | |
1001 | char buf[INET6_BUFSIZ]; | |
adbac85e | 1002 | char tx_id_buf[30]; |
3f9c7369 DS |
1003 | attrstr[0] = '\0'; |
1004 | ||
1005 | bgp_dump_attr (peer, attr, attrstr, BUFSIZ); | |
adbac85e DW |
1006 | bgp_info_addpath_tx_str (addpath_encode, BGP_ADDPATH_TX_ID_FOR_DEFAULT_ORIGINATE, tx_id_buf); |
1007 | zlog_debug ("u%" PRIu64 ":s%" PRIu64 " send UPDATE %s/%d%s %s", | |
1008 | (SUBGRP_UPDGRP (subgrp))->id, subgrp->id, | |
1009 | inet_ntop (p.family, &(p.u.prefix), buf, INET6_BUFSIZ), | |
1010 | p.prefixlen, tx_id_buf, attrstr); | |
3f9c7369 DS |
1011 | } |
1012 | ||
1013 | s = stream_new (BGP_MAX_PACKET_SIZE); | |
1014 | ||
1015 | /* Make BGP update packet. */ | |
1016 | bgp_packet_set_marker (s, BGP_MSG_UPDATE); | |
1017 | ||
1018 | /* Unfeasible Routes Length. */ | |
1019 | stream_putw (s, 0); | |
1020 | ||
1021 | /* Make place for total attribute length. */ | |
1022 | pos = stream_get_endp (s); | |
1023 | stream_putw (s, 0); | |
1024 | total_attr_len = bgp_packet_attribute (NULL, peer, s, attr, &vecarr, &p, | |
adbac85e DW |
1025 | afi, safi, from, NULL, NULL, |
1026 | addpath_encode, | |
1027 | BGP_ADDPATH_TX_ID_FOR_DEFAULT_ORIGINATE); | |
3f9c7369 DS |
1028 | |
1029 | /* Set Total Path Attribute Length. */ | |
1030 | stream_putw_at (s, pos, total_attr_len); | |
1031 | ||
1032 | /* NLRI set. */ | |
8a92a8a0 DS |
1033 | if (p.family == AF_INET && safi == SAFI_UNICAST && |
1034 | !peer_cap_enhe(peer)) | |
adbac85e | 1035 | stream_put_prefix_addpath (s, &p, addpath_encode, BGP_ADDPATH_TX_ID_FOR_DEFAULT_ORIGINATE); |
3f9c7369 DS |
1036 | |
1037 | /* Set size. */ | |
1038 | bgp_packet_set_size (s); | |
1039 | ||
af4b20d2 | 1040 | (void) bpacket_queue_add (SUBGRP_PKTQ (subgrp), s, &vecarr); |
3f9c7369 DS |
1041 | subgroup_trigger_write(subgrp); |
1042 | } | |
1043 | ||
1044 | void | |
1045 | subgroup_default_withdraw_packet (struct update_subgroup *subgrp) | |
1046 | { | |
8a92a8a0 | 1047 | struct peer *peer; |
3f9c7369 | 1048 | struct stream *s; |
3f9c7369 DS |
1049 | struct prefix p; |
1050 | unsigned long attrlen_pos = 0; | |
1051 | unsigned long cp; | |
1052 | bgp_size_t unfeasible_len; | |
18f1dc06 | 1053 | bgp_size_t total_attr_len = 0; |
3f9c7369 DS |
1054 | size_t mp_start = 0; |
1055 | size_t mplen_pos = 0; | |
1056 | afi_t afi; | |
1057 | safi_t safi; | |
adbac85e | 1058 | int addpath_encode = 0; |
3f9c7369 DS |
1059 | |
1060 | if (DISABLE_BGP_ANNOUNCE) | |
1061 | return; | |
1062 | ||
8a92a8a0 | 1063 | peer = SUBGRP_PEER (subgrp); |
3f9c7369 DS |
1064 | afi = SUBGRP_AFI (subgrp); |
1065 | safi = SUBGRP_SAFI (subgrp); | |
adbac85e | 1066 | addpath_encode = bgp_addpath_encode_tx (peer, afi, safi); |
3f9c7369 DS |
1067 | |
1068 | if (afi == AFI_IP) | |
1069 | str2prefix ("0.0.0.0/0", &p); | |
1070 | #ifdef HAVE_IPV6 | |
1071 | else | |
1072 | str2prefix ("::/0", &p); | |
1073 | #endif /* HAVE_IPV6 */ | |
1074 | ||
3f9c7369 DS |
1075 | if (bgp_debug_update(NULL, &p, subgrp->update_group, 0)) |
1076 | { | |
1077 | char buf[INET6_BUFSIZ]; | |
adbac85e | 1078 | char tx_id_buf[INET6_BUFSIZ]; |
3f9c7369 | 1079 | |
adbac85e DW |
1080 | bgp_info_addpath_tx_str (addpath_encode, BGP_ADDPATH_TX_ID_FOR_DEFAULT_ORIGINATE, tx_id_buf); |
1081 | zlog_debug ("u%" PRIu64 ":s%" PRIu64 " send UPDATE %s/%d%s -- unreachable", | |
1082 | (SUBGRP_UPDGRP (subgrp))->id, subgrp->id, | |
1083 | inet_ntop (p.family, &(p.u.prefix), buf, INET6_BUFSIZ), | |
1084 | p.prefixlen, tx_id_buf); | |
3f9c7369 DS |
1085 | } |
1086 | ||
1087 | s = stream_new (BGP_MAX_PACKET_SIZE); | |
1088 | ||
1089 | /* Make BGP update packet. */ | |
1090 | bgp_packet_set_marker (s, BGP_MSG_UPDATE); | |
1091 | ||
1092 | /* Unfeasible Routes Length. */ ; | |
1093 | cp = stream_get_endp (s); | |
1094 | stream_putw (s, 0); | |
1095 | ||
1096 | /* Withdrawn Routes. */ | |
8a92a8a0 DS |
1097 | if (p.family == AF_INET && safi == SAFI_UNICAST && |
1098 | !peer_cap_enhe(peer)) | |
3f9c7369 | 1099 | { |
adbac85e DW |
1100 | stream_put_prefix_addpath (s, &p, addpath_encode, |
1101 | BGP_ADDPATH_TX_ID_FOR_DEFAULT_ORIGINATE); | |
3f9c7369 DS |
1102 | |
1103 | unfeasible_len = stream_get_endp (s) - cp - 2; | |
1104 | ||
1105 | /* Set unfeasible len. */ | |
1106 | stream_putw_at (s, cp, unfeasible_len); | |
1107 | ||
1108 | /* Set total path attribute length. */ | |
1109 | stream_putw (s, 0); | |
1110 | } | |
1111 | else | |
1112 | { | |
1113 | attrlen_pos = stream_get_endp (s); | |
1114 | stream_putw (s, 0); | |
1115 | mp_start = stream_get_endp (s); | |
1116 | mplen_pos = bgp_packet_mpunreach_start (s, afi, safi); | |
adbac85e DW |
1117 | bgp_packet_mpunreach_prefix (s, &p, afi, safi, NULL, NULL, |
1118 | addpath_encode, | |
1119 | BGP_ADDPATH_TX_ID_FOR_DEFAULT_ORIGINATE); | |
3f9c7369 DS |
1120 | |
1121 | /* Set the mp_unreach attr's length */ | |
1122 | bgp_packet_mpunreach_end (s, mplen_pos); | |
1123 | ||
1124 | /* Set total path attribute length. */ | |
1125 | total_attr_len = stream_get_endp (s) - mp_start; | |
1126 | stream_putw_at (s, attrlen_pos, total_attr_len); | |
1127 | } | |
1128 | ||
1129 | bgp_packet_set_size (s); | |
1130 | ||
af4b20d2 | 1131 | (void) bpacket_queue_add (SUBGRP_PKTQ (subgrp), s, NULL); |
3f9c7369 DS |
1132 | subgroup_trigger_write(subgrp); |
1133 | } | |
1134 | ||
1135 | static void | |
1136 | bpacket_vec_arr_inherit_attr_flags (struct bpacket_attr_vec_arr *vecarr, | |
1137 | bpacket_attr_vec_type type, | |
1138 | struct attr *attr) | |
1139 | { | |
1140 | if (CHECK_FLAG (attr->rmap_change_flags, | |
3811f1e2 DS |
1141 | BATTR_RMAP_NEXTHOP_PEER_ADDRESS)) |
1142 | SET_FLAG (vecarr->entries[BGP_ATTR_VEC_NH].flags, | |
1143 | BPKT_ATTRVEC_FLAGS_RMAP_NH_PEER_ADDRESS); | |
1144 | ||
1145 | if (CHECK_FLAG (attr->rmap_change_flags, BATTR_REFLECTED)) | |
1146 | SET_FLAG (vecarr->entries[BGP_ATTR_VEC_NH].flags, | |
1147 | BPKT_ATTRVEC_FLAGS_REFLECTED); | |
1148 | ||
1149 | if (CHECK_FLAG (attr->rmap_change_flags, | |
1150 | BATTR_RMAP_NEXTHOP_UNCHANGED)) | |
3f9c7369 | 1151 | SET_FLAG (vecarr->entries[BGP_ATTR_VEC_NH].flags, |
3811f1e2 | 1152 | BPKT_ATTRVEC_FLAGS_RMAP_NH_UNCHANGED); |
3f9c7369 DS |
1153 | |
1154 | if (CHECK_FLAG (attr->rmap_change_flags, | |
3811f1e2 | 1155 | BATTR_RMAP_IPV4_NHOP_CHANGED)) |
3f9c7369 | 1156 | SET_FLAG (vecarr->entries[BGP_ATTR_VEC_NH].flags, |
3811f1e2 | 1157 | BPKT_ATTRVEC_FLAGS_RMAP_IPV4_NH_CHANGED); |
3f9c7369 | 1158 | |
3811f1e2 DS |
1159 | if (CHECK_FLAG (attr->rmap_change_flags, |
1160 | BATTR_RMAP_IPV6_GLOBAL_NHOP_CHANGED)) | |
3f9c7369 | 1161 | SET_FLAG (vecarr->entries[BGP_ATTR_VEC_NH].flags, |
3811f1e2 | 1162 | BPKT_ATTRVEC_FLAGS_RMAP_IPV6_GNH_CHANGED); |
316e074d DS |
1163 | |
1164 | if (CHECK_FLAG (attr->rmap_change_flags, | |
3811f1e2 | 1165 | BATTR_RMAP_IPV6_LL_NHOP_CHANGED)) |
316e074d | 1166 | SET_FLAG (vecarr->entries[BGP_ATTR_VEC_NH].flags, |
3811f1e2 | 1167 | BPKT_ATTRVEC_FLAGS_RMAP_IPV6_LNH_CHANGED); |
3f9c7369 DS |
1168 | } |
1169 | ||
1170 | /* Reset the Attributes vector array. The vector array is used to override | |
1171 | * certain output parameters in the packet for a particular peer | |
1172 | */ | |
1173 | void | |
1174 | bpacket_attr_vec_arr_reset (struct bpacket_attr_vec_arr *vecarr) | |
1175 | { | |
1176 | int i; | |
1177 | ||
1178 | if (!vecarr) | |
1179 | return; | |
1180 | ||
1181 | i = 0; | |
1182 | while (i < BGP_ATTR_VEC_MAX) | |
1183 | { | |
1184 | vecarr->entries[i].flags = 0; | |
1185 | vecarr->entries[i].offset = 0; | |
1186 | i++; | |
1187 | } | |
1188 | } | |
1189 | ||
1190 | /* Setup a particular node entry in the vecarr */ | |
1191 | void | |
1192 | bpacket_attr_vec_arr_set_vec (struct bpacket_attr_vec_arr *vecarr, | |
1193 | bpacket_attr_vec_type type, struct stream *s, | |
1194 | struct attr *attr) | |
1195 | { | |
1196 | if (!vecarr) | |
1197 | return; | |
1198 | assert (type < BGP_ATTR_VEC_MAX); | |
1199 | ||
3811f1e2 | 1200 | SET_FLAG (vecarr->entries[type].flags, BPKT_ATTRVEC_FLAGS_UPDATED); |
3f9c7369 DS |
1201 | vecarr->entries[type].offset = stream_get_endp (s); |
1202 | if (attr) | |
1203 | bpacket_vec_arr_inherit_attr_flags(vecarr, type, attr); | |
1204 | } |