]> git.proxmox.com Git - mirror_frr.git/blame - bgpd/bgp_pbr.c
*: remove the checking returned value for hash_get()
[mirror_frr.git] / bgpd / bgp_pbr.c
CommitLineData
bbe6ffd6
PG
1/*
2 * BGP pbr
3 * Copyright (C) 6WIND
4 *
5 * FRR is free software; you can redistribute it and/or modify it
6 * under the terms of the GNU General Public License as published by the
7 * Free Software Foundation; either version 2, or (at your option) any
8 * later version.
9 *
10 * FRR is distributed in the hope that it will be useful, but
11 * WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
13 * General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License along
16 * with this program; see the file COPYING; if not, write to the Free Software
17 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
18 */
19
20#include "zebra.h"
21#include "prefix.h"
22#include "zclient.h"
f3d32faa 23#include "jhash.h"
2e1f721e 24#include "pbr.h"
bbe6ffd6 25
2dbe669b
DA
26#include "lib/printfrr.h"
27
f3d32faa 28#include "bgpd/bgpd.h"
bbe6ffd6 29#include "bgpd/bgp_pbr.h"
b46b6f1a 30#include "bgpd/bgp_debug.h"
45918cfb
PG
31#include "bgpd/bgp_flowspec_util.h"
32#include "bgpd/bgp_ecommunity.h"
33#include "bgpd/bgp_route.h"
34#include "bgpd/bgp_attr.h"
d114b0d7 35#include "bgpd/bgp_zebra.h"
529efa23 36#include "bgpd/bgp_mplsvpn.h"
35703998 37#include "bgpd/bgp_flowspec_private.h"
4f3be667 38#include "bgpd/bgp_errors.h"
d114b0d7 39
bf8d3d6a
DL
40DEFINE_MTYPE_STATIC(BGPD, PBR_MATCH_ENTRY, "PBR match entry");
41DEFINE_MTYPE_STATIC(BGPD, PBR_MATCH, "PBR match");
42DEFINE_MTYPE_STATIC(BGPD, PBR_ACTION, "PBR action");
43DEFINE_MTYPE_STATIC(BGPD, PBR_RULE, "PBR rule");
44DEFINE_MTYPE_STATIC(BGPD, PBR, "BGP PBR Context");
45DEFINE_MTYPE_STATIC(BGPD, PBR_VALMASK, "BGP PBR Val Mask Value");
4762c213 46
9a659715
PG
47/* chain strings too long to fit in one line */
48#define FSPEC_ACTION_EXCEED_LIMIT "flowspec actions exceeds limit"
173ebf47 49#define IPV6_FRAGMENT_INVALID "fragment not valid for IPv6 for this implementation"
9a659715 50
4762c213
PG
51RB_GENERATE(bgp_pbr_interface_head, bgp_pbr_interface,
52 id_entry, bgp_pbr_interface_compare);
53struct bgp_pbr_interface_head ifaces_by_name_ipv4 =
54 RB_INITIALIZER(&ifaces_by_name_ipv4);
d114b0d7
PG
55
56static int bgp_pbr_match_counter_unique;
57static int bgp_pbr_match_entry_counter_unique;
58static int bgp_pbr_action_counter_unique;
59static int bgp_pbr_match_iptable_counter_unique;
b46b6f1a 60
1815c6fc
PG
61struct bgp_pbr_match_iptable_unique {
62 uint32_t unique;
63 struct bgp_pbr_match *bpm_found;
64};
65
c5d429e1
PG
66struct bgp_pbr_match_entry_unique {
67 uint32_t unique;
68 struct bgp_pbr_match_entry *bpme_found;
69};
70
70eabd12
PG
71struct bgp_pbr_action_unique {
72 uint32_t unique;
73 struct bgp_pbr_action *bpa_found;
74};
75
ffee150e
PG
76struct bgp_pbr_rule_unique {
77 uint32_t unique;
78 struct bgp_pbr_rule *bpr_found;
79};
80
e3b78da8 81static int bgp_pbr_rule_walkcb(struct hash_bucket *bucket, void *arg)
ffee150e 82{
e3b78da8 83 struct bgp_pbr_rule *bpr = (struct bgp_pbr_rule *)bucket->data;
ffee150e
PG
84 struct bgp_pbr_rule_unique *bpru = (struct bgp_pbr_rule_unique *)
85 arg;
86 uint32_t unique = bpru->unique;
87
88 if (bpr->unique == unique) {
89 bpru->bpr_found = bpr;
90 return HASHWALK_ABORT;
91 }
92 return HASHWALK_CONTINUE;
93}
94
e3b78da8 95static int bgp_pbr_action_walkcb(struct hash_bucket *bucket, void *arg)
70eabd12 96{
e3b78da8 97 struct bgp_pbr_action *bpa = (struct bgp_pbr_action *)bucket->data;
70eabd12
PG
98 struct bgp_pbr_action_unique *bpau = (struct bgp_pbr_action_unique *)
99 arg;
100 uint32_t unique = bpau->unique;
101
102 if (bpa->unique == unique) {
103 bpau->bpa_found = bpa;
104 return HASHWALK_ABORT;
105 }
106 return HASHWALK_CONTINUE;
107}
108
e3b78da8 109static int bgp_pbr_match_entry_walkcb(struct hash_bucket *bucket, void *arg)
c5d429e1
PG
110{
111 struct bgp_pbr_match_entry *bpme =
e3b78da8 112 (struct bgp_pbr_match_entry *)bucket->data;
c5d429e1
PG
113 struct bgp_pbr_match_entry_unique *bpmeu =
114 (struct bgp_pbr_match_entry_unique *)arg;
115 uint32_t unique = bpmeu->unique;
116
117 if (bpme->unique == unique) {
118 bpmeu->bpme_found = bpme;
119 return HASHWALK_ABORT;
120 }
121 return HASHWALK_CONTINUE;
122}
123
124struct bgp_pbr_match_ipsetname {
125 char *ipsetname;
126 struct bgp_pbr_match *bpm_found;
127};
128
e3b78da8 129static int bgp_pbr_match_pername_walkcb(struct hash_bucket *bucket, void *arg)
c5d429e1 130{
e3b78da8 131 struct bgp_pbr_match *bpm = (struct bgp_pbr_match *)bucket->data;
c5d429e1
PG
132 struct bgp_pbr_match_ipsetname *bpmi =
133 (struct bgp_pbr_match_ipsetname *)arg;
134 char *ipset_name = bpmi->ipsetname;
135
136 if (!strncmp(ipset_name, bpm->ipset_name,
137 ZEBRA_IPSET_NAME_SIZE)) {
138 bpmi->bpm_found = bpm;
139 return HASHWALK_ABORT;
140 }
141 return HASHWALK_CONTINUE;
142}
143
e3b78da8 144static int bgp_pbr_match_iptable_walkcb(struct hash_bucket *bucket, void *arg)
1815c6fc 145{
e3b78da8 146 struct bgp_pbr_match *bpm = (struct bgp_pbr_match *)bucket->data;
1815c6fc
PG
147 struct bgp_pbr_match_iptable_unique *bpmiu =
148 (struct bgp_pbr_match_iptable_unique *)arg;
149 uint32_t unique = bpmiu->unique;
150
151 if (bpm->unique2 == unique) {
152 bpmiu->bpm_found = bpm;
153 return HASHWALK_ABORT;
154 }
155 return HASHWALK_CONTINUE;
156}
157
c5d429e1
PG
158struct bgp_pbr_match_unique {
159 uint32_t unique;
160 struct bgp_pbr_match *bpm_found;
161};
162
e3b78da8 163static int bgp_pbr_match_walkcb(struct hash_bucket *bucket, void *arg)
c5d429e1 164{
e3b78da8 165 struct bgp_pbr_match *bpm = (struct bgp_pbr_match *)bucket->data;
c5d429e1
PG
166 struct bgp_pbr_match_unique *bpmu = (struct bgp_pbr_match_unique *)
167 arg;
168 uint32_t unique = bpmu->unique;
169
170 if (bpm->unique == unique) {
171 bpmu->bpm_found = bpm;
172 return HASHWALK_ABORT;
173 }
174 return HASHWALK_CONTINUE;
175}
176
4371bf91
PG
177static int snprintf_bgp_pbr_match_val(char *str, int len,
178 struct bgp_pbr_match_val *mval,
9cec4121 179 const char *prepend)
b46b6f1a
PG
180{
181 char *ptr = str;
9cec4121
PG
182 int delta;
183
184 if (prepend) {
185 delta = snprintf(ptr, len, "%s", prepend);
186 ptr += delta;
187 len -= delta;
188 } else {
189 if (mval->unary_operator & OPERATOR_UNARY_OR) {
190 delta = snprintf(ptr, len, ", or ");
191 ptr += delta;
192 len -= delta;
193 }
194 if (mval->unary_operator & OPERATOR_UNARY_AND) {
195 delta = snprintf(ptr, len, ", and ");
196 ptr += delta;
197 len -= delta;
198 }
199 }
200 if (mval->compare_operator & OPERATOR_COMPARE_LESS_THAN) {
201 delta = snprintf(ptr, len, "<");
202 ptr += delta;
203 len -= delta;
204 }
205 if (mval->compare_operator & OPERATOR_COMPARE_GREATER_THAN) {
206 delta = snprintf(ptr, len, ">");
207 ptr += delta;
208 len -= delta;
209 }
210 if (mval->compare_operator & OPERATOR_COMPARE_EQUAL_TO) {
211 delta = snprintf(ptr, len, "=");
212 ptr += delta;
213 len -= delta;
b46b6f1a 214 }
9cec4121
PG
215 if (mval->compare_operator & OPERATOR_COMPARE_EXACT_MATCH) {
216 delta = snprintf(ptr, len, "match");
217 ptr += delta;
218 len -= delta;
219 }
220 ptr += snprintf(ptr, len, " %u", mval->value);
b46b6f1a
PG
221 return (int)(ptr - str);
222}
223
9cec4121
PG
224#define INCREMENT_DISPLAY(_ptr, _cnt, _len) do { \
225 int sn_delta; \
226 \
227 if (_cnt) { \
228 sn_delta = snprintf((_ptr), (_len), "; ");\
229 (_len) -= sn_delta; \
230 (_ptr) += sn_delta; \
231 } \
232 (_cnt)++; \
b46b6f1a
PG
233 } while (0)
234
0e867886
PG
235/* this structure can be used for port range,
236 * but also for other values range like packet length range
237 */
1de7dfff
PG
238struct bgp_pbr_range_port {
239 uint16_t min_port;
240 uint16_t max_port;
241};
242
2da7d62e
PG
243/* this structure can be used to filter with a mask
244 * for instance it supports not instructions like for
245 * tcpflags
246 */
247struct bgp_pbr_val_mask {
248 uint16_t val;
249 uint16_t mask;
250};
251
0e867886
PG
252/* this structure is used to pass instructs
253 * so that BGP can create pbr instructions to ZEBRA
254 */
255struct bgp_pbr_filter {
9350f1df 256 uint8_t type;
0e867886 257 vrf_id_t vrf_id;
f01e580f 258 uint8_t family;
0e867886
PG
259 struct prefix *src;
260 struct prefix *dst;
9350f1df 261 uint8_t bitmask_iprule;
0e867886
PG
262 uint8_t protocol;
263 struct bgp_pbr_range_port *pkt_len;
264 struct bgp_pbr_range_port *src_port;
265 struct bgp_pbr_range_port *dst_port;
2da7d62e 266 struct bgp_pbr_val_mask *tcp_flags;
4977bd6c 267 struct bgp_pbr_val_mask *dscp;
40881800 268 struct bgp_pbr_val_mask *flow_label;
cfaf18ce 269 struct bgp_pbr_val_mask *pkt_len_val;
6f5617d8 270 struct bgp_pbr_val_mask *fragment;
0e867886
PG
271};
272
c5ee26cc
PG
273/* this structure is used to contain OR instructions
274 * so that BGP can create multiple pbr instructions
275 * to ZEBRA
276 */
277struct bgp_pbr_or_filter {
278 struct list *tcpflags;
56707a36 279 struct list *dscp;
40881800 280 struct list *flowlabel;
cfaf18ce 281 struct list *pkt_len;
6f5617d8 282 struct list *fragment;
da3fa383
PG
283 struct list *icmp_type;
284 struct list *icmp_code;
c5ee26cc
PG
285};
286
da3fa383 287static void bgp_pbr_policyroute_add_to_zebra_unit(struct bgp *bgp,
9b6d8fcf 288 struct bgp_path_info *path,
da3fa383
PG
289 struct bgp_pbr_filter *bpf,
290 struct nexthop *nh,
291 float *rate);
6e288819 292
064a9d52
PG
293static void bgp_pbr_dump_entry(struct bgp_pbr_filter *bpf, bool add);
294
6e288819
PG
295static bool bgp_pbr_extract_enumerate_unary_opposite(
296 uint8_t unary_operator,
297 struct bgp_pbr_val_mask *and_valmask,
298 struct list *or_valmask, uint32_t value,
299 uint8_t type_entry)
300{
301 if (unary_operator == OPERATOR_UNARY_AND && and_valmask) {
302 if (type_entry == FLOWSPEC_TCP_FLAGS) {
303 and_valmask->mask |=
304 TCP_HEADER_ALL_FLAGS &
305 ~(value);
306 } else if (type_entry == FLOWSPEC_DSCP ||
40881800 307 type_entry == FLOWSPEC_FLOW_LABEL ||
6e288819
PG
308 type_entry == FLOWSPEC_PKT_LEN ||
309 type_entry == FLOWSPEC_FRAGMENT) {
310 and_valmask->val = value;
311 and_valmask->mask = 1; /* inverse */
312 }
313 } else if (unary_operator == OPERATOR_UNARY_OR && or_valmask) {
314 and_valmask = XCALLOC(MTYPE_PBR_VALMASK,
315 sizeof(struct bgp_pbr_val_mask));
316 if (type_entry == FLOWSPEC_TCP_FLAGS) {
317 and_valmask->val = TCP_HEADER_ALL_FLAGS;
318 and_valmask->mask |=
319 TCP_HEADER_ALL_FLAGS &
320 ~(value);
321 } else if (type_entry == FLOWSPEC_DSCP ||
40881800 322 type_entry == FLOWSPEC_FLOW_LABEL ||
6e288819
PG
323 type_entry == FLOWSPEC_FRAGMENT ||
324 type_entry == FLOWSPEC_PKT_LEN) {
325 and_valmask->val = value;
326 and_valmask->mask = 1; /* inverse */
327 }
328 listnode_add(or_valmask, and_valmask);
329 } else if (type_entry == FLOWSPEC_ICMP_CODE ||
330 type_entry == FLOWSPEC_ICMP_TYPE)
331 return false;
332 return true;
333}
334
2da7d62e
PG
335/* TCP : FIN and SYN -> val = ALL; mask = 3
336 * TCP : not (FIN and SYN) -> val = ALL; mask = ALL & ~(FIN|RST)
40881800 337 * other variables type: dscp, pkt len, fragment, flow label
6f5617d8
PG
338 * - value is copied in bgp_pbr_val_mask->val value
339 * - if negate form is identifierd, bgp_pbr_val_mask->mask set to 1
2da7d62e 340 */
f7b2e630
PG
341static bool bgp_pbr_extract_enumerate_unary(struct bgp_pbr_match_val list[],
342 int num, uint8_t unary_operator,
35703998 343 void *valmask, uint8_t type_entry)
932404b7
PG
344{
345 int i = 0;
f7b2e630
PG
346 struct bgp_pbr_val_mask *and_valmask = NULL;
347 struct list *or_valmask = NULL;
6e288819 348 bool ret;
932404b7 349
f7b2e630
PG
350 if (valmask) {
351 if (unary_operator == OPERATOR_UNARY_AND) {
352 and_valmask = (struct bgp_pbr_val_mask *)valmask;
353 memset(and_valmask, 0, sizeof(struct bgp_pbr_val_mask));
354 } else if (unary_operator == OPERATOR_UNARY_OR) {
355 or_valmask = (struct list *)valmask;
356 }
357 }
932404b7 358 for (i = 0; i < num; i++) {
2da7d62e
PG
359 if (i != 0 && list[i].unary_operator !=
360 unary_operator)
932404b7 361 return false;
2da7d62e
PG
362 if (!(list[i].compare_operator &
363 OPERATOR_COMPARE_EQUAL_TO) &&
364 !(list[i].compare_operator &
365 OPERATOR_COMPARE_EXACT_MATCH)) {
366 if ((list[i].compare_operator &
367 OPERATOR_COMPARE_LESS_THAN) &&
368 (list[i].compare_operator &
369 OPERATOR_COMPARE_GREATER_THAN)) {
6e288819
PG
370 ret = bgp_pbr_extract_enumerate_unary_opposite(
371 unary_operator, and_valmask,
372 or_valmask, list[i].value,
373 type_entry);
d8729f8c 374 if (!ret)
6e288819 375 return ret;
2da7d62e
PG
376 continue;
377 }
378 return false;
379 }
35703998
PG
380 if (unary_operator == OPERATOR_UNARY_AND && and_valmask) {
381 if (type_entry == FLOWSPEC_TCP_FLAGS)
382 and_valmask->mask |=
383 TCP_HEADER_ALL_FLAGS & list[i].value;
384 } else if (unary_operator == OPERATOR_UNARY_OR && or_valmask) {
f7b2e630
PG
385 and_valmask = XCALLOC(MTYPE_PBR_VALMASK,
386 sizeof(struct bgp_pbr_val_mask));
35703998
PG
387 if (type_entry == FLOWSPEC_TCP_FLAGS) {
388 and_valmask->val = TCP_HEADER_ALL_FLAGS;
389 and_valmask->mask |=
390 TCP_HEADER_ALL_FLAGS & list[i].value;
cfaf18ce 391 } else if (type_entry == FLOWSPEC_DSCP ||
40881800 392 type_entry == FLOWSPEC_FLOW_LABEL ||
da3fa383
PG
393 type_entry == FLOWSPEC_ICMP_TYPE ||
394 type_entry == FLOWSPEC_ICMP_CODE ||
6f5617d8 395 type_entry == FLOWSPEC_FRAGMENT ||
cfaf18ce 396 type_entry == FLOWSPEC_PKT_LEN)
35703998 397 and_valmask->val = list[i].value;
f7b2e630
PG
398 listnode_add(or_valmask, and_valmask);
399 }
932404b7 400 }
35703998
PG
401 if (unary_operator == OPERATOR_UNARY_AND && and_valmask
402 && type_entry == FLOWSPEC_TCP_FLAGS)
403 and_valmask->val = TCP_HEADER_ALL_FLAGS;
932404b7
PG
404 return true;
405}
406
f7b2e630
PG
407/* if unary operator can either be UNARY_OR/AND/OR-AND.
408 * in the latter case, combinationf of both is not handled
409 */
410static bool bgp_pbr_extract_enumerate(struct bgp_pbr_match_val list[],
411 int num, uint8_t unary_operator,
35703998 412 void *valmask, uint8_t type_entry)
f7b2e630
PG
413{
414 bool ret;
3f54c705 415 uint8_t unary_operator_val;
f7b2e630
PG
416 bool double_check = false;
417
418 if ((unary_operator & OPERATOR_UNARY_OR) &&
419 (unary_operator & OPERATOR_UNARY_AND)) {
420 unary_operator_val = OPERATOR_UNARY_AND;
421 double_check = true;
422 } else
423 unary_operator_val = unary_operator;
424 ret = bgp_pbr_extract_enumerate_unary(list, num, unary_operator_val,
35703998 425 valmask, type_entry);
f7b2e630
PG
426 if (!ret && double_check)
427 ret = bgp_pbr_extract_enumerate_unary(list, num,
428 OPERATOR_UNARY_OR,
35703998
PG
429 valmask,
430 type_entry);
f7b2e630
PG
431 return ret;
432}
433
434/* returns the unary operator that is in the list
435 * return 0 if both operators are used
436 */
437static uint8_t bgp_pbr_match_val_get_operator(struct bgp_pbr_match_val list[],
438 int num)
439
440{
441 int i;
442 uint8_t unary_operator = OPERATOR_UNARY_AND;
443
444 for (i = 0; i < num; i++) {
445 if (i == 0)
446 continue;
447 if (list[i].unary_operator & OPERATOR_UNARY_OR)
448 unary_operator = OPERATOR_UNARY_OR;
449 if ((list[i].unary_operator & OPERATOR_UNARY_AND
450 && unary_operator == OPERATOR_UNARY_OR) ||
451 (list[i].unary_operator & OPERATOR_UNARY_OR
452 && unary_operator == OPERATOR_UNARY_AND))
453 return 0;
454 }
455 return unary_operator;
456}
457
458
1de7dfff
PG
459/* return true if extraction ok
460 */
461static bool bgp_pbr_extract(struct bgp_pbr_match_val list[],
462 int num,
463 struct bgp_pbr_range_port *range)
464{
465 int i = 0;
466 bool exact_match = false;
467
468 if (range)
469 memset(range, 0, sizeof(struct bgp_pbr_range_port));
470
471 if (num > 2)
472 return false;
473 for (i = 0; i < num; i++) {
474 if (i != 0 && (list[i].compare_operator ==
475 OPERATOR_COMPARE_EQUAL_TO))
476 return false;
477 if (i == 0 && (list[i].compare_operator ==
478 OPERATOR_COMPARE_EQUAL_TO)) {
479 if (range)
480 range->min_port = list[i].value;
481 exact_match = true;
482 }
d8729f8c 483 if (exact_match && i > 0)
1de7dfff
PG
484 return false;
485 if (list[i].compare_operator ==
486 (OPERATOR_COMPARE_GREATER_THAN +
487 OPERATOR_COMPARE_EQUAL_TO)) {
488 if (range)
489 range->min_port = list[i].value;
490 } else if (list[i].compare_operator ==
491 (OPERATOR_COMPARE_LESS_THAN +
492 OPERATOR_COMPARE_EQUAL_TO)) {
493 if (range)
494 range->max_port = list[i].value;
495 } else if (list[i].compare_operator ==
496 OPERATOR_COMPARE_LESS_THAN) {
497 if (range)
498 range->max_port = list[i].value - 1;
499 } else if (list[i].compare_operator ==
500 OPERATOR_COMPARE_GREATER_THAN) {
501 if (range)
502 range->min_port = list[i].value + 1;
503 }
504 }
505 return true;
506}
507
b46b6f1a
PG
508static int bgp_pbr_validate_policy_route(struct bgp_pbr_entry_main *api)
509{
932404b7
PG
510 bool enumerate_icmp = false;
511
5fa779c9
PG
512 if (api->type == BGP_PBR_UNDEFINED) {
513 if (BGP_DEBUG(pbr, PBR))
514 zlog_debug("BGP: pbr entry undefined. cancel.");
515 return 0;
516 }
b46b6f1a
PG
517 /* because bgp pbr entry may contain unsupported
518 * combinations, a message will be displayed here if
519 * not supported.
520 * for now, only match/set supported is
521 * - combination src/dst => redirect nexthop [ + rate]
522 * - combination src/dst => redirect VRF [ + rate]
523 * - combination src/dst => drop
1de7dfff 524 * - combination srcport + @IP
b46b6f1a 525 */
1de7dfff
PG
526 if (api->match_protocol_num > 1) {
527 if (BGP_DEBUG(pbr, PBR))
3efd0893 528 zlog_debug("BGP: match protocol operations:multiple protocols ( %d). ignoring.",
1de7dfff
PG
529 api->match_protocol_num);
530 return 0;
531 }
173ebf47
PG
532 if (api->src_prefix_offset > 0 ||
533 api->dst_prefix_offset > 0) {
534 if (BGP_DEBUG(pbr, PBR))
535 zlog_debug("BGP: match prefix offset:"
536 "implementation does not support it.");
537 return 0;
538 }
1de7dfff
PG
539 if (api->match_protocol_num == 1 &&
540 api->protocol[0].value != PROTOCOL_UDP &&
932404b7 541 api->protocol[0].value != PROTOCOL_ICMP &&
f2ead0a5 542 api->protocol[0].value != PROTOCOL_ICMPV6 &&
1de7dfff
PG
543 api->protocol[0].value != PROTOCOL_TCP) {
544 if (BGP_DEBUG(pbr, PBR))
3efd0893 545 zlog_debug("BGP: match protocol operations:protocol (%d) not supported. ignoring",
1de7dfff
PG
546 api->match_protocol_num);
547 return 0;
548 }
549 if (!bgp_pbr_extract(api->src_port, api->match_src_port_num, NULL)) {
550 if (BGP_DEBUG(pbr, PBR))
3efd0893 551 zlog_debug("BGP: match src port operations:too complex. ignoring.");
1de7dfff
PG
552 return 0;
553 }
554 if (!bgp_pbr_extract(api->dst_port, api->match_dst_port_num, NULL)) {
555 if (BGP_DEBUG(pbr, PBR))
3efd0893 556 zlog_debug("BGP: match dst port operations:too complex. ignoring.");
1de7dfff
PG
557 return 0;
558 }
2da7d62e
PG
559 if (!bgp_pbr_extract_enumerate(api->tcpflags,
560 api->match_tcpflags_num,
c5ee26cc 561 OPERATOR_UNARY_AND |
35703998
PG
562 OPERATOR_UNARY_OR, NULL,
563 FLOWSPEC_TCP_FLAGS)) {
2da7d62e 564 if (BGP_DEBUG(pbr, PBR))
3efd0893 565 zlog_debug("BGP: match tcp flags:too complex. ignoring.");
2da7d62e
PG
566 return 0;
567 }
932404b7
PG
568 if (!bgp_pbr_extract(api->icmp_type, api->match_icmp_type_num, NULL)) {
569 if (!bgp_pbr_extract_enumerate(api->icmp_type,
2da7d62e 570 api->match_icmp_type_num,
35703998
PG
571 OPERATOR_UNARY_OR, NULL,
572 FLOWSPEC_ICMP_TYPE)) {
932404b7 573 if (BGP_DEBUG(pbr, PBR))
3efd0893 574 zlog_debug("BGP: match icmp type operations:too complex. ignoring.");
932404b7
PG
575 return 0;
576 }
577 enumerate_icmp = true;
578 }
579 if (!bgp_pbr_extract(api->icmp_code, api->match_icmp_code_num, NULL)) {
580 if (!bgp_pbr_extract_enumerate(api->icmp_code,
2da7d62e 581 api->match_icmp_code_num,
35703998
PG
582 OPERATOR_UNARY_OR, NULL,
583 FLOWSPEC_ICMP_CODE)) {
932404b7 584 if (BGP_DEBUG(pbr, PBR))
3efd0893 585 zlog_debug("BGP: match icmp code operations:too complex. ignoring.");
932404b7
PG
586 return 0;
587 } else if (api->match_icmp_type_num > 1 &&
d8729f8c 588 !enumerate_icmp) {
932404b7 589 if (BGP_DEBUG(pbr, PBR))
3efd0893 590 zlog_debug("BGP: match icmp code is enumerate, and icmp type is not. too complex. ignoring.");
932404b7
PG
591 return 0;
592 }
593 }
1de7dfff
PG
594 if (!bgp_pbr_extract(api->port, api->match_port_num, NULL)) {
595 if (BGP_DEBUG(pbr, PBR))
3efd0893 596 zlog_debug("BGP: match port operations:too complex. ignoring.");
1de7dfff
PG
597 return 0;
598 }
cfaf18ce
PG
599 if (api->match_packet_length_num) {
600 bool ret;
601
602 ret = bgp_pbr_extract(api->packet_length,
603 api->match_packet_length_num, NULL);
604 if (!ret)
605 ret = bgp_pbr_extract_enumerate(api->packet_length,
606 api->match_packet_length_num,
607 OPERATOR_UNARY_OR
608 | OPERATOR_UNARY_AND,
609 NULL, FLOWSPEC_PKT_LEN);
610 if (!ret) {
611 if (BGP_DEBUG(pbr, PBR))
3efd0893 612 zlog_debug("BGP: match packet length operations:too complex. ignoring.");
cfaf18ce
PG
613 return 0;
614 }
83360720 615 }
35703998
PG
616 if (api->match_dscp_num) {
617 if (!bgp_pbr_extract_enumerate(api->dscp, api->match_dscp_num,
618 OPERATOR_UNARY_OR | OPERATOR_UNARY_AND,
619 NULL, FLOWSPEC_DSCP)) {
620 if (BGP_DEBUG(pbr, PBR))
3efd0893 621 zlog_debug("BGP: match DSCP operations:too complex. ignoring.");
35703998
PG
622 return 0;
623 }
4977bd6c 624 }
40881800
PG
625 if (api->match_flowlabel_num) {
626 if (api->afi == AFI_IP) {
627 if (BGP_DEBUG(pbr, PBR))
628 zlog_debug("BGP: match Flow Label operations:"
629 "Not for IPv4.");
630 return 0;
631 }
632 if (!bgp_pbr_extract_enumerate(api->flow_label,
633 api->match_flowlabel_num,
634 OPERATOR_UNARY_OR | OPERATOR_UNARY_AND,
635 NULL, FLOWSPEC_FLOW_LABEL)) {
636 if (BGP_DEBUG(pbr, PBR))
637 zlog_debug("BGP: match FlowLabel operations:"
638 "too complex. ignoring.");
639 return 0;
640 }
173ebf47
PG
641 if (BGP_DEBUG(pbr, PBR))
642 zlog_debug("BGP: match FlowLabel operations "
643 "not supported. ignoring.");
644 return 0;
40881800 645 }
6f5617d8
PG
646 if (api->match_fragment_num) {
647 char fail_str[64];
648 bool success;
649
650 success = bgp_pbr_extract_enumerate(api->fragment,
651 api->match_fragment_num,
652 OPERATOR_UNARY_OR
653 | OPERATOR_UNARY_AND,
654 NULL, FLOWSPEC_FRAGMENT);
655 if (success) {
656 int i;
657
658 for (i = 0; i < api->match_fragment_num; i++) {
659 if (api->fragment[i].value != 1 &&
660 api->fragment[i].value != 2 &&
661 api->fragment[i].value != 4 &&
662 api->fragment[i].value != 8) {
663 success = false;
772270f3
QY
664 snprintf(
665 fail_str, sizeof(fail_str),
6f5617d8
PG
666 "Value not valid (%d) for this implementation",
667 api->fragment[i].value);
668 }
40881800
PG
669 if (api->afi == AFI_IP6 &&
670 api->fragment[i].value == 1) {
671 success = false;
672 snprintf(fail_str, sizeof(fail_str),
673 "IPv6 dont fragment match invalid (%d)",
674 api->fragment[i].value);
675 }
6f5617d8 676 }
173ebf47
PG
677 if (api->afi == AFI_IP6) {
678 success = false;
679 snprintf(fail_str, sizeof(fail_str),
680 "%s", IPV6_FRAGMENT_INVALID);
681 }
6f5617d8 682 } else
772270f3
QY
683 snprintf(fail_str, sizeof(fail_str),
684 "too complex. ignoring");
6f5617d8
PG
685 if (!success) {
686 if (BGP_DEBUG(pbr, PBR))
687 zlog_debug("BGP: match fragment operation (%d) %s",
688 api->match_fragment_num,
689 fail_str);
690 return 0;
691 }
692 }
693
1de7dfff
PG
694 /* no combinations with both src_port and dst_port
695 * or port with src_port and dst_port
696 */
697 if (api->match_src_port_num + api->match_dst_port_num +
698 api->match_port_num > 3) {
699 if (BGP_DEBUG(pbr, PBR))
3efd0893 700 zlog_debug("BGP: match multiple port operations: too complex. ignoring.");
1de7dfff
PG
701 return 0;
702 }
932404b7
PG
703 if ((api->match_src_port_num || api->match_dst_port_num
704 || api->match_port_num) && (api->match_icmp_type_num
705 || api->match_icmp_code_num)) {
706 if (BGP_DEBUG(pbr, PBR))
3efd0893 707 zlog_debug("BGP: match multiple port/imcp operations: too complex. ignoring.");
932404b7
PG
708 return 0;
709 }
a35a794a
PG
710 /* iprule only supports redirect IP */
711 if (api->type == BGP_PBR_IPRULE) {
712 int i;
713
714 for (i = 0; i < api->action_num; i++) {
715 if (api->actions[i].action == ACTION_TRAFFICRATE &&
716 api->actions[i].u.r.rate == 0) {
717 if (BGP_DEBUG(pbr, PBR)) {
718 bgp_pbr_print_policy_route(api);
3efd0893 719 zlog_debug("BGP: iprule match actions drop not supported");
a35a794a
PG
720 }
721 return 0;
722 }
723 if (api->actions[i].action == ACTION_MARKING) {
724 if (BGP_DEBUG(pbr, PBR)) {
725 bgp_pbr_print_policy_route(api);
40881800 726 zlog_warn("PBR: iprule set DSCP/Flow Label %u not supported",
a35a794a
PG
727 api->actions[i].u.marking_dscp);
728 }
729 }
730 if (api->actions[i].action == ACTION_REDIRECT) {
731 if (BGP_DEBUG(pbr, PBR)) {
732 bgp_pbr_print_policy_route(api);
3efd0893 733 zlog_warn("PBR: iprule redirect VRF %u not supported",
a35a794a
PG
734 api->actions[i].u.redirect_vrf);
735 }
736 }
737 }
738
739 } else if (!(api->match_bitmask & PREFIX_SRC_PRESENT) &&
740 !(api->match_bitmask & PREFIX_DST_PRESENT)) {
ac7c35f8 741 if (BGP_DEBUG(pbr, PBR)) {
b46b6f1a 742 bgp_pbr_print_policy_route(api);
3efd0893 743 zlog_debug("BGP: match actions without src or dst address can not operate. ignoring.");
ac7c35f8 744 }
b46b6f1a
PG
745 return 0;
746 }
747 return 1;
748}
bbe6ffd6 749
45918cfb 750/* return -1 if build or validation failed */
1840384b 751
5a1ae2c2
DS
752int bgp_pbr_build_and_validate_entry(const struct prefix *p,
753 struct bgp_path_info *path,
754 struct bgp_pbr_entry_main *api)
45918cfb
PG
755{
756 int ret;
f6e07e1b 757 uint32_t i, action_count = 0;
45918cfb
PG
758 struct ecommunity *ecom;
759 struct ecommunity_val *ecom_eval;
760 struct bgp_pbr_entry_action *api_action;
761 struct prefix *src = NULL, *dst = NULL;
762 int valid_prefix = 0;
2551b26e 763 struct bgp_pbr_entry_action *api_action_redirect_ip = NULL;
46b89000 764 bool discard_action_found = false;
1840384b 765 afi_t afi = family2afi(p->u.prefix_flowspec.family);
45918cfb
PG
766
767 /* extract match from flowspec entries */
768 ret = bgp_flowspec_match_rules_fill((uint8_t *)p->u.prefix_flowspec.ptr,
1840384b 769 p->u.prefix_flowspec.prefixlen, api, afi);
45918cfb
PG
770 if (ret < 0)
771 return -1;
772 /* extract actiosn from flowspec ecom list */
b53e67a3
DA
773 if (path && bgp_attr_get_ecommunity(path->attr)) {
774 ecom = bgp_attr_get_ecommunity(path->attr);
45918cfb
PG
775 for (i = 0; i < ecom->size; i++) {
776 ecom_eval = (struct ecommunity_val *)
149d272b
PG
777 (ecom->val + (i * ECOMMUNITY_SIZE));
778 action_count++;
45918cfb 779 if (action_count > ACTIONS_MAX_NUM) {
f146bb54 780 if (BGP_DEBUG(pbr, PBR_ERROR))
1c50c1c0
QY
781 flog_err(
782 EC_BGP_FLOWSPEC_PACKET,
9a659715
PG
783 "%s: %s (max %u)",
784 __func__,
785 FSPEC_ACTION_EXCEED_LIMIT,
786 action_count);
45918cfb
PG
787 break;
788 }
149d272b 789 api_action = &api->actions[action_count - 1];
45918cfb
PG
790
791 if ((ecom_eval->val[1] ==
792 (char)ECOMMUNITY_REDIRECT_VRF) &&
793 (ecom_eval->val[0] ==
794 (char)ECOMMUNITY_ENCODE_TRANS_EXP ||
795 ecom_eval->val[0] ==
796 (char)ECOMMUNITY_EXTENDED_COMMUNITY_PART_2 ||
797 ecom_eval->val[0] ==
798 (char)ECOMMUNITY_EXTENDED_COMMUNITY_PART_3)) {
799 struct ecommunity *eckey = ecommunity_new();
800 struct ecommunity_val ecom_copy;
801
802 memcpy(&ecom_copy, ecom_eval,
803 sizeof(struct ecommunity_val));
804 ecom_copy.val[0] &=
805 ~ECOMMUNITY_ENCODE_TRANS_EXP;
806 ecom_copy.val[1] = ECOMMUNITY_ROUTE_TARGET;
1207a5bc 807 ecommunity_add_val(eckey, &ecom_copy,
808 false, false);
45918cfb
PG
809
810 api_action->action = ACTION_REDIRECT;
811 api_action->u.redirect_vrf =
812 get_first_vrf_for_redirect_with_rt(
813 eckey);
814 ecommunity_free(&eckey);
815 } else if ((ecom_eval->val[0] ==
816 (char)ECOMMUNITY_ENCODE_REDIRECT_IP_NH) &&
817 (ecom_eval->val[1] ==
818 (char)ECOMMUNITY_REDIRECT_IP_NH)) {
2551b26e
PG
819 /* in case the 2 ecom present,
820 * do not overwrite
821 * draft-ietf-idr-flowspec-redirect
822 */
f01e580f
PG
823 if (api_action_redirect_ip &&
824 p->u.prefix_flowspec.family == AF_INET) {
825 if (api_action_redirect_ip->u
826 .zr.redirect_ip_v4.s_addr
975a328e 827 != INADDR_ANY)
2551b26e 828 continue;
975a328e
DA
829 if (path->attr->nexthop.s_addr
830 == INADDR_ANY)
2551b26e 831 continue;
975a328e
DA
832 api_action_redirect_ip->u.zr
833 .redirect_ip_v4.s_addr =
2551b26e
PG
834 path->attr->nexthop.s_addr;
835 api_action_redirect_ip->u.zr.duplicate
836 = ecom_eval->val[7];
837 continue;
f01e580f
PG
838 } else if (api_action_redirect_ip &&
839 p->u.prefix_flowspec.family == AF_INET6) {
840 if (memcmp(&api_action_redirect_ip->u
841 .zr.redirect_ip_v6,
842 &in6addr_any,
843 sizeof(struct in6_addr)))
844 continue;
845 if (path->attr->mp_nexthop_len == 0 ||
846 path->attr->mp_nexthop_len ==
847 BGP_ATTR_NHLEN_IPV4 ||
848 path->attr->mp_nexthop_len ==
849 BGP_ATTR_NHLEN_VPNV4)
850 continue;
851 memcpy(&api_action_redirect_ip->u
852 .zr.redirect_ip_v6,
853 &path->attr->mp_nexthop_global,
854 sizeof(struct in6_addr));
855 api_action_redirect_ip->u.zr.duplicate
856 = ecom_eval->val[7];
857 continue;
4371bf91
PG
858 } else if (p->u.prefix_flowspec.family ==
859 AF_INET) {
2551b26e
PG
860 api_action->action = ACTION_REDIRECT_IP;
861 api_action->u.zr.redirect_ip_v4.s_addr =
862 path->attr->nexthop.s_addr;
863 api_action->u.zr.duplicate =
864 ecom_eval->val[7];
865 api_action_redirect_ip = api_action;
4371bf91
PG
866 } else if (p->u.prefix_flowspec.family ==
867 AF_INET6) {
f01e580f
PG
868 api_action->action = ACTION_REDIRECT_IP;
869 memcpy(&api_action->u
870 .zr.redirect_ip_v6,
871 &path->attr->mp_nexthop_global,
872 sizeof(struct in6_addr));
873 api_action->u.zr.duplicate
874 = ecom_eval->val[7];
875 api_action_redirect_ip = api_action;
2551b26e
PG
876 }
877 } else if ((ecom_eval->val[0] ==
878 (char)ECOMMUNITY_ENCODE_IP) &&
879 (ecom_eval->val[1] ==
880 (char)ECOMMUNITY_FLOWSPEC_REDIRECT_IPV4)) {
881 /* in case the 2 ecom present,
882 * overwrite simpson draft
883 * update redirect ip fields
884 */
885 if (api_action_redirect_ip) {
886 memcpy(&(api_action_redirect_ip->u
887 .zr.redirect_ip_v4.s_addr),
888 (ecom_eval->val+2), 4);
889 api_action_redirect_ip->u
890 .zr.duplicate =
891 ecom_eval->val[7];
892 continue;
893 } else {
894 api_action->action = ACTION_REDIRECT_IP;
895 memcpy(&(api_action->u
896 .zr.redirect_ip_v4.s_addr),
897 (ecom_eval->val+2), 4);
898 api_action->u.zr.duplicate =
899 ecom_eval->val[7];
900 api_action_redirect_ip = api_action;
901 }
45918cfb
PG
902 } else {
903 if (ecom_eval->val[0] !=
904 (char)ECOMMUNITY_ENCODE_TRANS_EXP)
905 continue;
906 ret = ecommunity_fill_pbr_action(ecom_eval,
f01e580f
PG
907 api_action,
908 afi);
45918cfb
PG
909 if (ret != 0)
910 continue;
4371bf91
PG
911 if ((api_action->action == ACTION_TRAFFICRATE)
912 && api->actions[i].u.r.rate == 0)
46b89000 913 discard_action_found = true;
45918cfb
PG
914 }
915 api->action_num++;
916 }
917 }
d04ac434 918 if (path && path->attr && bgp_attr_get_ipv6_ecommunity(path->attr)) {
9a659715
PG
919 struct ecommunity_val_ipv6 *ipv6_ecom_eval;
920
d04ac434 921 ecom = bgp_attr_get_ipv6_ecommunity(path->attr);
9a659715
PG
922 for (i = 0; i < ecom->size; i++) {
923 ipv6_ecom_eval = (struct ecommunity_val_ipv6 *)
924 (ecom->val + (i * ecom->unit_size));
925 action_count++;
926 if (action_count > ACTIONS_MAX_NUM) {
927 if (BGP_DEBUG(pbr, PBR_ERROR))
928 flog_err(
929 EC_BGP_FLOWSPEC_PACKET,
930 "%s: flowspec actions exceeds limit (max %u)",
931 __func__, action_count);
932 break;
933 }
934 api_action = &api->actions[action_count - 1];
935 if ((ipv6_ecom_eval->val[1] ==
936 (char)ECOMMUNITY_FLOWSPEC_REDIRECT_IPV6) &&
937 (ipv6_ecom_eval->val[0] ==
938 (char)ECOMMUNITY_ENCODE_TRANS_EXP)) {
939 struct ecommunity *eckey = ecommunity_new();
940 struct ecommunity_val_ipv6 ecom_copy;
941
942 eckey->unit_size = IPV6_ECOMMUNITY_SIZE;
943 memcpy(&ecom_copy, ipv6_ecom_eval,
944 sizeof(struct ecommunity_val_ipv6));
945 ecom_copy.val[1] = ECOMMUNITY_ROUTE_TARGET;
946 ecommunity_add_val_ipv6(eckey, &ecom_copy,
947 false, false);
948 api_action->action = ACTION_REDIRECT;
949 api_action->u.redirect_vrf =
950 get_first_vrf_for_redirect_with_rt(
951 eckey);
952 ecommunity_free(&eckey);
953 api->action_num++;
954 }
955 }
956 }
46b89000
PG
957 /* if ECOMMUNITY_TRAFFIC_RATE = 0 as action
958 * then reduce the API action list to that action
959 */
960 if (api->action_num > 1 && discard_action_found) {
961 api->action_num = 1;
962 memset(&api->actions[0], 0,
963 sizeof(struct bgp_pbr_entry_action));
964 api->actions[0].action = ACTION_TRAFFICRATE;
965 }
45918cfb
PG
966
967 /* validate if incoming matc/action is compatible
968 * with our policy routing engine
969 */
970 if (!bgp_pbr_validate_policy_route(api))
971 return -1;
972
973 /* check inconsistency in the match rule */
974 if (api->match_bitmask & PREFIX_SRC_PRESENT) {
975 src = &api->src_prefix;
976 afi = family2afi(src->family);
977 valid_prefix = 1;
978 }
979 if (api->match_bitmask & PREFIX_DST_PRESENT) {
980 dst = &api->dst_prefix;
981 if (valid_prefix && afi != family2afi(dst->family)) {
ac7c35f8 982 if (BGP_DEBUG(pbr, PBR)) {
45918cfb 983 bgp_pbr_print_policy_route(api);
3efd0893 984 zlog_debug("%s: inconsistency: no match for afi src and dst (%u/%u)",
ac7c35f8
PG
985 __func__, afi, family2afi(dst->family));
986 }
45918cfb
PG
987 return -1;
988 }
989 }
990 return 0;
991}
992
a6b07429
PG
993static void bgp_pbr_match_entry_free(void *arg)
994{
995 struct bgp_pbr_match_entry *bpme;
996
997 bpme = (struct bgp_pbr_match_entry *)arg;
998
999 if (bpme->installed) {
1000 bgp_send_pbr_ipset_entry_match(bpme, false);
1001 bpme->installed = false;
1002 bpme->backpointer = NULL;
1003 }
1004 XFREE(MTYPE_PBR_MATCH_ENTRY, bpme);
1005}
1006
1007static void bgp_pbr_match_free(void *arg)
1008{
1009 struct bgp_pbr_match *bpm;
1010
1011 bpm = (struct bgp_pbr_match *)arg;
1012
1013 hash_clean(bpm->entry_hash, bgp_pbr_match_entry_free);
1014
1015 if (hashcount(bpm->entry_hash) == 0) {
1016 /* delete iptable entry first */
1017 /* then delete ipset match */
1018 if (bpm->installed) {
1019 if (bpm->installed_in_iptable) {
1020 bgp_send_pbr_iptable(bpm->action,
1021 bpm, false);
1022 bpm->installed_in_iptable = false;
1023 bpm->action->refcnt--;
1024 }
1025 bgp_send_pbr_ipset_match(bpm, false);
1026 bpm->installed = false;
1027 bpm->action = NULL;
1028 }
1029 }
1030 hash_free(bpm->entry_hash);
1031
1032 XFREE(MTYPE_PBR_MATCH, bpm);
1033}
1034
d114b0d7
PG
1035static void *bgp_pbr_match_alloc_intern(void *arg)
1036{
1037 struct bgp_pbr_match *bpm, *new;
1038
1039 bpm = (struct bgp_pbr_match *)arg;
1040
1041 new = XCALLOC(MTYPE_PBR_MATCH, sizeof(*new));
1042 memcpy(new, bpm, sizeof(*bpm));
1043
1044 return new;
1045}
1046
27e376d4
PG
1047static void bgp_pbr_rule_free(void *arg)
1048{
1049 struct bgp_pbr_rule *bpr;
1050
1051 bpr = (struct bgp_pbr_rule *)arg;
1052
1053 /* delete iprule */
1054 if (bpr->installed) {
1055 bgp_send_pbr_rule_action(bpr->action, bpr, false);
1056 bpr->installed = false;
1057 bpr->action->refcnt--;
1058 bpr->action = NULL;
1059 }
1060 XFREE(MTYPE_PBR_RULE, bpr);
1061}
1062
1063static void *bgp_pbr_rule_alloc_intern(void *arg)
1064{
1065 struct bgp_pbr_rule *bpr, *new;
1066
1067 bpr = (struct bgp_pbr_rule *)arg;
1068
1069 new = XCALLOC(MTYPE_PBR_RULE, sizeof(*new));
1070 memcpy(new, bpr, sizeof(*bpr));
1071
1072 return new;
1073}
1074
ebd1a47c
DS
1075static void bgp_pbr_bpa_remove(struct bgp_pbr_action *bpa)
1076{
1077 if ((bpa->refcnt == 0) && bpa->installed && bpa->table_id != 0) {
1078 bgp_send_pbr_rule_action(bpa, NULL, false);
1079 bgp_zebra_announce_default(bpa->bgp, &bpa->nh, bpa->afi,
1080 bpa->table_id, false);
1081 bpa->installed = false;
1082 }
1083}
1084
db1fcc98
DS
1085static void bgp_pbr_bpa_add(struct bgp_pbr_action *bpa)
1086{
1087 if (!bpa->installed && !bpa->install_in_progress) {
1088 bgp_send_pbr_rule_action(bpa, NULL, true);
1089 bgp_zebra_announce_default(bpa->bgp, &bpa->nh, bpa->afi,
1090 bpa->table_id, true);
1091 }
1092}
1093
a6b07429
PG
1094static void bgp_pbr_action_free(void *arg)
1095{
ebd1a47c 1096 struct bgp_pbr_action *bpa = arg;
a6b07429 1097
ebd1a47c 1098 bgp_pbr_bpa_remove(bpa);
a6b07429 1099
a6b07429
PG
1100 XFREE(MTYPE_PBR_ACTION, bpa);
1101}
1102
d114b0d7
PG
1103static void *bgp_pbr_action_alloc_intern(void *arg)
1104{
1105 struct bgp_pbr_action *bpa, *new;
1106
1107 bpa = (struct bgp_pbr_action *)arg;
1108
1109 new = XCALLOC(MTYPE_PBR_ACTION, sizeof(*new));
1110
1111 memcpy(new, bpa, sizeof(*bpa));
1112
1113 return new;
1114}
1115
1116static void *bgp_pbr_match_entry_alloc_intern(void *arg)
1117{
1118 struct bgp_pbr_match_entry *bpme, *new;
1119
1120 bpme = (struct bgp_pbr_match_entry *)arg;
1121
1122 new = XCALLOC(MTYPE_PBR_MATCH_ENTRY, sizeof(*new));
1123
1124 memcpy(new, bpme, sizeof(*bpme));
1125
1126 return new;
1127}
1128
d8b87afe 1129uint32_t bgp_pbr_match_hash_key(const void *arg)
f3d32faa 1130{
d8b87afe 1131 const struct bgp_pbr_match *pbm = arg;
f3d32faa
PG
1132 uint32_t key;
1133
1134 key = jhash_1word(pbm->vrf_id, 0x4312abde);
1135 key = jhash_1word(pbm->flags, key);
a60b7031 1136 key = jhash_1word(pbm->family, key);
9717d3e5
PG
1137 key = jhash(&pbm->pkt_len_min, 2, key);
1138 key = jhash(&pbm->pkt_len_max, 2, key);
1139 key = jhash(&pbm->tcp_flags, 2, key);
1140 key = jhash(&pbm->tcp_mask_flags, 2, key);
1141 key = jhash(&pbm->dscp_value, 1, key);
40881800 1142 key = jhash(&pbm->flow_label, 2, key);
9717d3e5 1143 key = jhash(&pbm->fragment, 1, key);
f449d223 1144 key = jhash(&pbm->protocol, 1, key);
f3d32faa
PG
1145 return jhash_1word(pbm->type, key);
1146}
1147
74df8d6d 1148bool bgp_pbr_match_hash_equal(const void *arg1, const void *arg2)
f3d32faa
PG
1149{
1150 const struct bgp_pbr_match *r1, *r2;
1151
1152 r1 = (const struct bgp_pbr_match *)arg1;
1153 r2 = (const struct bgp_pbr_match *)arg2;
1154
1155 if (r1->vrf_id != r2->vrf_id)
74df8d6d 1156 return false;
f3d32faa 1157
a60b7031
PG
1158 if (r1->family != r2->family)
1159 return false;
1160
f3d32faa 1161 if (r1->type != r2->type)
74df8d6d 1162 return false;
f3d32faa
PG
1163
1164 if (r1->flags != r2->flags)
74df8d6d 1165 return false;
f3d32faa
PG
1166
1167 if (r1->action != r2->action)
74df8d6d 1168 return false;
f3d32faa 1169
83360720 1170 if (r1->pkt_len_min != r2->pkt_len_min)
74df8d6d 1171 return false;
83360720
PG
1172
1173 if (r1->pkt_len_max != r2->pkt_len_max)
74df8d6d 1174 return false;
83360720 1175
2da7d62e 1176 if (r1->tcp_flags != r2->tcp_flags)
74df8d6d 1177 return false;
2da7d62e
PG
1178
1179 if (r1->tcp_mask_flags != r2->tcp_mask_flags)
74df8d6d 1180 return false;
2da7d62e 1181
4977bd6c 1182 if (r1->dscp_value != r2->dscp_value)
74df8d6d 1183 return false;
6f5617d8 1184
40881800
PG
1185 if (r1->flow_label != r2->flow_label)
1186 return false;
1187
6f5617d8 1188 if (r1->fragment != r2->fragment)
74df8d6d 1189 return false;
f449d223
PG
1190
1191 if (r1->protocol != r2->protocol)
1192 return false;
74df8d6d 1193 return true;
f3d32faa
PG
1194}
1195
d8b87afe 1196uint32_t bgp_pbr_rule_hash_key(const void *arg)
27e376d4 1197{
d8b87afe 1198 const struct bgp_pbr_rule *pbr = arg;
27e376d4
PG
1199 uint32_t key;
1200
1201 key = prefix_hash_key(&pbr->src);
1202 key = jhash_1word(pbr->vrf_id, key);
1203 key = jhash_1word(pbr->flags, key);
1204 return jhash_1word(prefix_hash_key(&pbr->dst), key);
1205}
1206
1207bool bgp_pbr_rule_hash_equal(const void *arg1, const void *arg2)
1208{
1209 const struct bgp_pbr_rule *r1, *r2;
1210
1211 r1 = (const struct bgp_pbr_rule *)arg1;
1212 r2 = (const struct bgp_pbr_rule *)arg2;
1213
1214 if (r1->vrf_id != r2->vrf_id)
1215 return false;
1216
1217 if (r1->flags != r2->flags)
1218 return false;
1219
1220 if (r1->action != r2->action)
1221 return false;
1222
1223 if ((r1->flags & MATCH_IP_SRC_SET) &&
1224 !prefix_same(&r1->src, &r2->src))
1225 return false;
1226
1227 if ((r1->flags & MATCH_IP_DST_SET) &&
1228 !prefix_same(&r1->dst, &r2->dst))
1229 return false;
1230
1231 return true;
1232}
1233
d8b87afe 1234uint32_t bgp_pbr_match_entry_hash_key(const void *arg)
f3d32faa 1235{
d8b87afe 1236 const struct bgp_pbr_match_entry *pbme;
f3d32faa
PG
1237 uint32_t key;
1238
d8b87afe 1239 pbme = arg;
f3d32faa
PG
1240 key = prefix_hash_key(&pbme->src);
1241 key = jhash_1word(prefix_hash_key(&pbme->dst), key);
1de7dfff
PG
1242 key = jhash(&pbme->dst_port_min, 2, key);
1243 key = jhash(&pbme->src_port_min, 2, key);
1244 key = jhash(&pbme->dst_port_max, 2, key);
1245 key = jhash(&pbme->src_port_max, 2, key);
1246 key = jhash(&pbme->proto, 1, key);
f3d32faa
PG
1247
1248 return key;
1249}
1250
74df8d6d 1251bool bgp_pbr_match_entry_hash_equal(const void *arg1, const void *arg2)
f3d32faa
PG
1252{
1253 const struct bgp_pbr_match_entry *r1, *r2;
1254
1255 r1 = (const struct bgp_pbr_match_entry *)arg1;
1256 r2 = (const struct bgp_pbr_match_entry *)arg2;
1257
74df8d6d
DS
1258 /*
1259 * on updates, comparing backpointer is not necessary
1260 * unique value is self calculated
1261 * rate is ignored for now
f3d32faa
PG
1262 */
1263
1264 if (!prefix_same(&r1->src, &r2->src))
74df8d6d 1265 return false;
f3d32faa
PG
1266
1267 if (!prefix_same(&r1->dst, &r2->dst))
74df8d6d 1268 return false;
f3d32faa 1269
1de7dfff 1270 if (r1->src_port_min != r2->src_port_min)
74df8d6d 1271 return false;
1de7dfff
PG
1272
1273 if (r1->dst_port_min != r2->dst_port_min)
74df8d6d 1274 return false;
1de7dfff
PG
1275
1276 if (r1->src_port_max != r2->src_port_max)
74df8d6d 1277 return false;
1de7dfff
PG
1278
1279 if (r1->dst_port_max != r2->dst_port_max)
74df8d6d 1280 return false;
1de7dfff
PG
1281
1282 if (r1->proto != r2->proto)
74df8d6d 1283 return false;
1de7dfff 1284
74df8d6d 1285 return true;
f3d32faa
PG
1286}
1287
d8b87afe 1288uint32_t bgp_pbr_action_hash_key(const void *arg)
f3d32faa 1289{
d8b87afe 1290 const struct bgp_pbr_action *pbra;
f3d32faa
PG
1291 uint32_t key;
1292
d8b87afe 1293 pbra = arg;
f3d32faa
PG
1294 key = jhash_1word(pbra->table_id, 0x4312abde);
1295 key = jhash_1word(pbra->fwmark, key);
f01e580f 1296 key = jhash_1word(pbra->afi, key);
f3d32faa
PG
1297 return key;
1298}
1299
74df8d6d 1300bool bgp_pbr_action_hash_equal(const void *arg1, const void *arg2)
f3d32faa
PG
1301{
1302 const struct bgp_pbr_action *r1, *r2;
1303
1304 r1 = (const struct bgp_pbr_action *)arg1;
1305 r2 = (const struct bgp_pbr_action *)arg2;
1306
1307 /* unique value is self calculated
1308 * table and fwmark is self calculated
e414819e 1309 * rate is ignored
f3d32faa 1310 */
f3d32faa 1311 if (r1->vrf_id != r2->vrf_id)
74df8d6d 1312 return false;
f3d32faa 1313
f01e580f
PG
1314 if (r1->afi != r2->afi)
1315 return false;
1316
e4190ca4 1317 return nexthop_same(&r1->nh, &r2->nh);
f3d32faa 1318}
bbe6ffd6 1319
ffee150e
PG
1320struct bgp_pbr_rule *bgp_pbr_rule_lookup(vrf_id_t vrf_id,
1321 uint32_t unique)
1322{
1323 struct bgp *bgp = bgp_lookup_by_vrf_id(vrf_id);
1324 struct bgp_pbr_rule_unique bpru;
1325
1326 if (!bgp || unique == 0)
1327 return NULL;
1328 bpru.unique = unique;
1329 bpru.bpr_found = NULL;
1330 hash_walk(bgp->pbr_rule_hash, bgp_pbr_rule_walkcb, &bpru);
1331 return bpru.bpr_found;
1332}
1333
70eabd12
PG
1334struct bgp_pbr_action *bgp_pbr_action_rule_lookup(vrf_id_t vrf_id,
1335 uint32_t unique)
bbe6ffd6 1336{
70eabd12
PG
1337 struct bgp *bgp = bgp_lookup_by_vrf_id(vrf_id);
1338 struct bgp_pbr_action_unique bpau;
1339
1340 if (!bgp || unique == 0)
1341 return NULL;
1342 bpau.unique = unique;
1343 bpau.bpa_found = NULL;
1344 hash_walk(bgp->pbr_action_hash, bgp_pbr_action_walkcb, &bpau);
1345 return bpau.bpa_found;
bbe6ffd6
PG
1346}
1347
1348struct bgp_pbr_match *bgp_pbr_match_ipset_lookup(vrf_id_t vrf_id,
1349 uint32_t unique)
1350{
c5d429e1
PG
1351 struct bgp *bgp = bgp_lookup_by_vrf_id(vrf_id);
1352 struct bgp_pbr_match_unique bpmu;
1353
1354 if (!bgp || unique == 0)
1355 return NULL;
1356 bpmu.unique = unique;
1357 bpmu.bpm_found = NULL;
1358 hash_walk(bgp->pbr_match_hash, bgp_pbr_match_walkcb, &bpmu);
1359 return bpmu.bpm_found;
bbe6ffd6
PG
1360}
1361
1362struct bgp_pbr_match_entry *bgp_pbr_match_ipset_entry_lookup(vrf_id_t vrf_id,
1363 char *ipset_name,
1364 uint32_t unique)
1365{
c5d429e1
PG
1366 struct bgp *bgp = bgp_lookup_by_vrf_id(vrf_id);
1367 struct bgp_pbr_match_entry_unique bpmeu;
1368 struct bgp_pbr_match_ipsetname bpmi;
1369
1370 if (!bgp || unique == 0)
1371 return NULL;
1372 bpmi.ipsetname = XCALLOC(MTYPE_TMP, ZEBRA_IPSET_NAME_SIZE);
1373 snprintf(bpmi.ipsetname, ZEBRA_IPSET_NAME_SIZE, "%s", ipset_name);
1374 bpmi.bpm_found = NULL;
1375 hash_walk(bgp->pbr_match_hash, bgp_pbr_match_pername_walkcb, &bpmi);
1376 XFREE(MTYPE_TMP, bpmi.ipsetname);
1377 if (!bpmi.bpm_found)
1378 return NULL;
1379 bpmeu.bpme_found = NULL;
1380 bpmeu.unique = unique;
1381 hash_walk(bpmi.bpm_found->entry_hash,
1382 bgp_pbr_match_entry_walkcb, &bpmeu);
1383 return bpmeu.bpme_found;
bbe6ffd6
PG
1384}
1385
1815c6fc
PG
1386struct bgp_pbr_match *bgp_pbr_match_iptable_lookup(vrf_id_t vrf_id,
1387 uint32_t unique)
1388{
1389 struct bgp *bgp = bgp_lookup_by_vrf_id(vrf_id);
1390 struct bgp_pbr_match_iptable_unique bpmiu;
1391
1392 if (!bgp || unique == 0)
1393 return NULL;
1394 bpmiu.unique = unique;
1395 bpmiu.bpm_found = NULL;
1396 hash_walk(bgp->pbr_match_hash, bgp_pbr_match_iptable_walkcb, &bpmiu);
1397 return bpmiu.bpm_found;
1398}
1399
a6b07429
PG
1400void bgp_pbr_cleanup(struct bgp *bgp)
1401{
1402 if (bgp->pbr_match_hash) {
1403 hash_clean(bgp->pbr_match_hash, bgp_pbr_match_free);
1404 hash_free(bgp->pbr_match_hash);
1405 bgp->pbr_match_hash = NULL;
1406 }
27e376d4
PG
1407 if (bgp->pbr_rule_hash) {
1408 hash_clean(bgp->pbr_rule_hash, bgp_pbr_rule_free);
1409 hash_free(bgp->pbr_rule_hash);
1410 bgp->pbr_rule_hash = NULL;
1411 }
a6b07429
PG
1412 if (bgp->pbr_action_hash) {
1413 hash_clean(bgp->pbr_action_hash, bgp_pbr_action_free);
1414 hash_free(bgp->pbr_action_hash);
1415 bgp->pbr_action_hash = NULL;
1416 }
4762c213
PG
1417 if (bgp->bgp_pbr_cfg == NULL)
1418 return;
1419 bgp_pbr_reset(bgp, AFI_IP);
8f242187 1420 bgp_pbr_reset(bgp, AFI_IP6);
4762c213 1421 XFREE(MTYPE_PBR, bgp->bgp_pbr_cfg);
a6b07429
PG
1422}
1423
f3d32faa
PG
1424void bgp_pbr_init(struct bgp *bgp)
1425{
1426 bgp->pbr_match_hash =
1427 hash_create_size(8, bgp_pbr_match_hash_key,
1428 bgp_pbr_match_hash_equal,
1429 "Match Hash");
1430 bgp->pbr_action_hash =
1431 hash_create_size(8, bgp_pbr_action_hash_key,
1432 bgp_pbr_action_hash_equal,
1433 "Match Hash Entry");
4762c213 1434
27e376d4
PG
1435 bgp->pbr_rule_hash =
1436 hash_create_size(8, bgp_pbr_rule_hash_key,
1437 bgp_pbr_rule_hash_equal,
1438 "Match Rule");
1439
4762c213
PG
1440 bgp->bgp_pbr_cfg = XCALLOC(MTYPE_PBR, sizeof(struct bgp_pbr_config));
1441 bgp->bgp_pbr_cfg->pbr_interface_any_ipv4 = true;
f3d32faa 1442}
b46b6f1a
PG
1443
1444void bgp_pbr_print_policy_route(struct bgp_pbr_entry_main *api)
1445{
1446 int i = 0;
1447 char return_string[512];
1448 char *ptr = return_string;
b46b6f1a 1449 int nb_items = 0;
9cec4121 1450 int delta, len = sizeof(return_string);
b46b6f1a 1451
9cec4121
PG
1452 delta = snprintf(ptr, sizeof(return_string), "MATCH : ");
1453 len -= delta;
1454 ptr += delta;
b46b6f1a
PG
1455 if (api->match_bitmask & PREFIX_SRC_PRESENT) {
1456 struct prefix *p = &(api->src_prefix);
1457
9cec4121 1458 if (api->src_prefix_offset)
2dbe669b
DA
1459 delta = snprintfrr(ptr, len, "@src %pFX/off%u", p,
1460 api->src_prefix_offset);
9cec4121 1461 else
2dbe669b 1462 delta = snprintfrr(ptr, len, "@src %pFX", p);
9cec4121
PG
1463 len -= delta;
1464 ptr += delta;
1465 INCREMENT_DISPLAY(ptr, nb_items, len);
b46b6f1a
PG
1466 }
1467 if (api->match_bitmask & PREFIX_DST_PRESENT) {
1468 struct prefix *p = &(api->dst_prefix);
1469
9cec4121
PG
1470 INCREMENT_DISPLAY(ptr, nb_items, len);
1471 if (api->dst_prefix_offset)
2dbe669b
DA
1472 delta = snprintfrr(ptr, len, "@dst %pFX/off%u", p,
1473 api->dst_prefix_offset);
9cec4121 1474 else
2dbe669b 1475 delta = snprintfrr(ptr, len, "@dst %pFX", p);
9cec4121
PG
1476 len -= delta;
1477 ptr += delta;
b46b6f1a
PG
1478 }
1479
1480 if (api->match_protocol_num)
9cec4121
PG
1481 INCREMENT_DISPLAY(ptr, nb_items, len);
1482 for (i = 0; i < api->match_protocol_num; i++) {
1483 delta = snprintf_bgp_pbr_match_val(ptr, len, &api->protocol[i],
1484 i > 0 ? NULL : "@proto ");
1485 len -= delta;
1486 ptr += delta;
1487 }
b46b6f1a
PG
1488
1489 if (api->match_src_port_num)
9cec4121
PG
1490 INCREMENT_DISPLAY(ptr, nb_items, len);
1491 for (i = 0; i < api->match_src_port_num; i++) {
1492 delta = snprintf_bgp_pbr_match_val(ptr, len, &api->src_port[i],
1493 i > 0 ? NULL : "@srcport ");
1494 len -= delta;
1495 ptr += delta;
1496 }
b46b6f1a
PG
1497
1498 if (api->match_dst_port_num)
9cec4121
PG
1499 INCREMENT_DISPLAY(ptr, nb_items, len);
1500 for (i = 0; i < api->match_dst_port_num; i++) {
1501 delta = snprintf_bgp_pbr_match_val(ptr, len, &api->dst_port[i],
1502 i > 0 ? NULL : "@dstport ");
1503 len -= delta;
1504 ptr += delta;
1505 }
b46b6f1a
PG
1506
1507 if (api->match_port_num)
9cec4121
PG
1508 INCREMENT_DISPLAY(ptr, nb_items, len);
1509 for (i = 0; i < api->match_port_num; i++) {
1510 delta = snprintf_bgp_pbr_match_val(ptr, len, &api->port[i],
1511 i > 0 ? NULL : "@port ");
1512 len -= delta;
1513 ptr += delta;
1514 }
b46b6f1a
PG
1515
1516 if (api->match_icmp_type_num)
9cec4121
PG
1517 INCREMENT_DISPLAY(ptr, nb_items, len);
1518 for (i = 0; i < api->match_icmp_type_num; i++) {
1519 delta = snprintf_bgp_pbr_match_val(ptr, len, &api->icmp_type[i],
1520 i > 0 ? NULL : "@icmptype ");
1521 len -= delta;
1522 ptr += delta;
1523 }
b46b6f1a
PG
1524
1525 if (api->match_icmp_code_num)
9cec4121
PG
1526 INCREMENT_DISPLAY(ptr, nb_items, len);
1527 for (i = 0; i < api->match_icmp_code_num; i++) {
1528 delta = snprintf_bgp_pbr_match_val(ptr, len, &api->icmp_code[i],
1529 i > 0 ? NULL : "@icmpcode ");
1530 len -= delta;
1531 ptr += delta;
1532 }
b46b6f1a
PG
1533
1534 if (api->match_packet_length_num)
9cec4121
PG
1535 INCREMENT_DISPLAY(ptr, nb_items, len);
1536 for (i = 0; i < api->match_packet_length_num; i++) {
4371bf91
PG
1537 delta = snprintf_bgp_pbr_match_val(ptr, len,
1538 &api->packet_length[i],
9cec4121
PG
1539 i > 0 ? NULL : "@plen ");
1540 len -= delta;
1541 ptr += delta;
1542 }
b46b6f1a
PG
1543
1544 if (api->match_dscp_num)
9cec4121
PG
1545 INCREMENT_DISPLAY(ptr, nb_items, len);
1546 for (i = 0; i < api->match_dscp_num; i++) {
1547 delta = snprintf_bgp_pbr_match_val(ptr, len, &api->dscp[i],
1548 i > 0 ? NULL : "@dscp ");
1549 len -= delta;
1550 ptr += delta;
1551 }
b46b6f1a 1552
40881800
PG
1553 if (api->match_flowlabel_num)
1554 INCREMENT_DISPLAY(ptr, nb_items, len);
1555 for (i = 0; i < api->match_flowlabel_num; i++) {
4371bf91
PG
1556 delta = snprintf_bgp_pbr_match_val(ptr, len,
1557 &api->flow_label[i],
40881800
PG
1558 i > 0 ? NULL : "@flowlabel ");
1559 len -= delta;
1560 ptr += delta;
1561 }
1562
b46b6f1a 1563 if (api->match_tcpflags_num)
9cec4121
PG
1564 INCREMENT_DISPLAY(ptr, nb_items, len);
1565 for (i = 0; i < api->match_tcpflags_num; i++) {
1566 delta = snprintf_bgp_pbr_match_val(ptr, len, &api->tcpflags[i],
1567 i > 0 ? NULL : "@tcpflags ");
1568 len -= delta;
1569 ptr += delta;
1570 }
b46b6f1a 1571
588ec356 1572 if (api->match_fragment_num)
9cec4121
PG
1573 INCREMENT_DISPLAY(ptr, nb_items, len);
1574 for (i = 0; i < api->match_fragment_num; i++) {
1575 delta = snprintf_bgp_pbr_match_val(ptr, len, &api->fragment[i],
1576 i > 0 ? NULL : "@fragment ");
1577 len -= delta;
1578 ptr += delta;
1579 }
1580
1581 len = sizeof(return_string);
1582 if (!nb_items) {
b46b6f1a 1583 ptr = return_string;
9cec4121
PG
1584 } else {
1585 len -= (ptr - return_string);
1586 delta = snprintf(ptr, len, "; ");
1587 len -= delta;
1588 ptr += delta;
1589 }
1590 if (api->action_num) {
1591 delta = snprintf(ptr, len, "SET : ");
1592 len -= delta;
1593 ptr += delta;
1594 }
b46b6f1a
PG
1595 nb_items = 0;
1596 for (i = 0; i < api->action_num; i++) {
1597 switch (api->actions[i].action) {
1598 case ACTION_TRAFFICRATE:
9cec4121
PG
1599 INCREMENT_DISPLAY(ptr, nb_items, len);
1600 delta = snprintf(ptr, len, "@set rate %f",
1601 api->actions[i].u.r.rate);
1602 len -= delta;
1603 ptr += delta;
b46b6f1a
PG
1604 break;
1605 case ACTION_TRAFFIC_ACTION:
9cec4121
PG
1606 INCREMENT_DISPLAY(ptr, nb_items, len);
1607 delta = snprintf(ptr, len, "@action ");
1608 len -= delta;
1609 ptr += delta;
b46b6f1a 1610 if (api->actions[i].u.za.filter
9cec4121
PG
1611 & TRAFFIC_ACTION_TERMINATE) {
1612 delta = snprintf(ptr, len,
1613 " terminate (apply filter(s))");
1614 len -= delta;
1615 ptr += delta;
1616 }
b46b6f1a 1617 if (api->actions[i].u.za.filter
9cec4121
PG
1618 & TRAFFIC_ACTION_DISTRIBUTE) {
1619 delta = snprintf(ptr, len, " distribute");
1620 len -= delta;
1621 ptr += delta;
1622 }
b46b6f1a 1623 if (api->actions[i].u.za.filter
9cec4121
PG
1624 & TRAFFIC_ACTION_SAMPLE) {
1625 delta = snprintf(ptr, len, " sample");
1626 len -= delta;
1627 ptr += delta;
1628 }
b46b6f1a 1629 break;
f01e580f
PG
1630 case ACTION_REDIRECT_IP: {
1631 char local_buff[INET6_ADDRSTRLEN];
1632 void *ptr_ip;
b46b6f1a 1633
9cec4121 1634 INCREMENT_DISPLAY(ptr, nb_items, len);
f01e580f
PG
1635 if (api->afi == AF_INET)
1636 ptr_ip = &api->actions[i].u.zr.redirect_ip_v4;
1637 else
1638 ptr_ip = &api->actions[i].u.zr.redirect_ip_v6;
1639 if (inet_ntop(afi2family(api->afi),
1640 ptr_ip, local_buff,
1641 INET6_ADDRSTRLEN) != NULL) {
9cec4121 1642 delta = snprintf(ptr, len,
b46b6f1a 1643 "@redirect ip nh %s", local_buff);
9cec4121
PG
1644 len -= delta;
1645 ptr += delta;
f01e580f 1646 }
b46b6f1a 1647 break;
f01e580f 1648 }
137147c6
DS
1649 case ACTION_REDIRECT: {
1650 struct vrf *vrf;
1651
1652 vrf = vrf_lookup_by_id(api->actions[i].u.redirect_vrf);
9cec4121
PG
1653 INCREMENT_DISPLAY(ptr, nb_items, len);
1654 delta = snprintf(ptr, len, "@redirect vrf %s(%u)",
1655 VRF_LOGNAME(vrf),
1656 api->actions[i].u.redirect_vrf);
1657 len -= delta;
1658 ptr += delta;
b46b6f1a 1659 break;
137147c6 1660 }
b46b6f1a 1661 case ACTION_MARKING:
9cec4121 1662 INCREMENT_DISPLAY(ptr, nb_items, len);
40881800 1663 delta = snprintf(ptr, len, "@set dscp/flowlabel %u",
9cec4121
PG
1664 api->actions[i].u.marking_dscp);
1665 len -= delta;
1666 ptr += delta;
b46b6f1a
PG
1667 break;
1668 default:
1669 break;
1670 }
1671 }
1672 zlog_info("%s", return_string);
1673}
45918cfb 1674
9350f1df
PG
1675static void bgp_pbr_flush_iprule(struct bgp *bgp, struct bgp_pbr_action *bpa,
1676 struct bgp_pbr_rule *bpr)
1677{
1678 /* if bpr is null, do nothing
1679 */
1680 if (bpr == NULL)
1681 return;
1682 if (bpr->installed) {
1683 bgp_send_pbr_rule_action(bpa, bpr, false);
1684 bpr->installed = false;
1685 bpr->action->refcnt--;
1686 bpr->action = NULL;
ce3c0614
PG
1687 if (bpr->path) {
1688 struct bgp_path_info *path;
1689 struct bgp_path_info_extra *extra;
1690
1691 /* unlink path to bpme */
1692 path = (struct bgp_path_info *)bpr->path;
1693 extra = bgp_path_info_extra_get(path);
3e3708cb
PG
1694 if (extra->bgp_fs_iprule)
1695 listnode_delete(extra->bgp_fs_iprule, bpr);
ce3c0614
PG
1696 bpr->path = NULL;
1697 }
9350f1df
PG
1698 }
1699 hash_release(bgp->pbr_rule_hash, bpr);
ebd1a47c 1700 bgp_pbr_bpa_remove(bpa);
9350f1df
PG
1701}
1702
d114b0d7
PG
1703static void bgp_pbr_flush_entry(struct bgp *bgp, struct bgp_pbr_action *bpa,
1704 struct bgp_pbr_match *bpm,
1705 struct bgp_pbr_match_entry *bpme)
1706{
1707 /* if bpme is null, bpm is also null
1708 */
1709 if (bpme == NULL)
1710 return;
1711 /* ipset del entry */
1712 if (bpme->installed) {
1713 bgp_send_pbr_ipset_entry_match(bpme, false);
1714 bpme->installed = false;
1715 bpme->backpointer = NULL;
9b6d8fcf
DS
1716 if (bpme->path) {
1717 struct bgp_path_info *path;
4b7e6066 1718 struct bgp_path_info_extra *extra;
b588b642 1719
ce3c0614 1720 /* unlink path to bpme */
9b6d8fcf
DS
1721 path = (struct bgp_path_info *)bpme->path;
1722 extra = bgp_path_info_extra_get(path);
3e3708cb
PG
1723 if (extra->bgp_fs_pbr)
1724 listnode_delete(extra->bgp_fs_pbr, bpme);
9b6d8fcf 1725 bpme->path = NULL;
b588b642 1726 }
d114b0d7
PG
1727 }
1728 hash_release(bpm->entry_hash, bpme);
1729 if (hashcount(bpm->entry_hash) == 0) {
1730 /* delete iptable entry first */
1731 /* then delete ipset match */
1732 if (bpm->installed) {
1733 if (bpm->installed_in_iptable) {
1734 bgp_send_pbr_iptable(bpm->action,
1735 bpm, false);
1736 bpm->installed_in_iptable = false;
a6b07429 1737 bpm->action->refcnt--;
d114b0d7
PG
1738 }
1739 bgp_send_pbr_ipset_match(bpm, false);
1740 bpm->installed = false;
1741 bpm->action = NULL;
1742 }
1743 hash_release(bgp->pbr_match_hash, bpm);
1744 /* XXX release pbr_match_action if not used
1745 * note that drop does not need to call send_pbr_action
1746 */
1747 }
ebd1a47c 1748 bgp_pbr_bpa_remove(bpa);
d114b0d7
PG
1749}
1750
1751struct bgp_pbr_match_entry_remain {
1752 struct bgp_pbr_match_entry *bpme_to_match;
1753 struct bgp_pbr_match_entry *bpme_found;
1754};
1755
9350f1df
PG
1756struct bgp_pbr_rule_remain {
1757 struct bgp_pbr_rule *bpr_to_match;
1758 struct bgp_pbr_rule *bpr_found;
1759};
1760
e3b78da8 1761static int bgp_pbr_get_same_rule(struct hash_bucket *bucket, void *arg)
9350f1df 1762{
e3b78da8 1763 struct bgp_pbr_rule *r1 = (struct bgp_pbr_rule *)bucket->data;
9350f1df
PG
1764 struct bgp_pbr_rule_remain *ctxt =
1765 (struct bgp_pbr_rule_remain *)arg;
1766 struct bgp_pbr_rule *r2;
1767
1768 r2 = ctxt->bpr_to_match;
1769
1770 if (r1->vrf_id != r2->vrf_id)
1771 return HASHWALK_CONTINUE;
1772
1773 if (r1->flags != r2->flags)
1774 return HASHWALK_CONTINUE;
1775
1776 if ((r1->flags & MATCH_IP_SRC_SET) &&
1777 !prefix_same(&r1->src, &r2->src))
1778 return HASHWALK_CONTINUE;
1779
1780 if ((r1->flags & MATCH_IP_DST_SET) &&
1781 !prefix_same(&r1->dst, &r2->dst))
1782 return HASHWALK_CONTINUE;
1783
1784 /* this function is used for two cases:
1785 * - remove an entry upon withdraw request
1786 * (case r2->action is null)
1787 * - replace an old iprule with different action
1788 * (case r2->action is != null)
1789 * the old one is removed after the new one
1790 * this is to avoid disruption in traffic
1791 */
1792 if (r2->action == NULL ||
1793 r1->action != r2->action) {
1794 ctxt->bpr_found = r1;
1795 return HASHWALK_ABORT;
1796 }
1797 return HASHWALK_CONTINUE;
1798}
1799
e3b78da8 1800static int bgp_pbr_get_remaining_entry(struct hash_bucket *bucket, void *arg)
d114b0d7 1801{
e3b78da8 1802 struct bgp_pbr_match *bpm = (struct bgp_pbr_match *)bucket->data;
d114b0d7
PG
1803 struct bgp_pbr_match_entry_remain *bpmer =
1804 (struct bgp_pbr_match_entry_remain *)arg;
1805 struct bgp_pbr_match *bpm_temp;
1806 struct bgp_pbr_match_entry *bpme = bpmer->bpme_to_match;
1807
1808 if (!bpme->backpointer ||
1809 bpm == bpme->backpointer ||
1810 bpme->backpointer->action == bpm->action)
1811 return HASHWALK_CONTINUE;
1812 /* ensure bpm other characteristics are equal */
1813 bpm_temp = bpme->backpointer;
1814 if (bpm_temp->vrf_id != bpm->vrf_id ||
1815 bpm_temp->type != bpm->type ||
836b6953
PG
1816 bpm_temp->flags != bpm->flags ||
1817 bpm_temp->tcp_flags != bpm->tcp_flags ||
1818 bpm_temp->tcp_mask_flags != bpm->tcp_mask_flags ||
1819 bpm_temp->pkt_len_min != bpm->pkt_len_min ||
1820 bpm_temp->pkt_len_max != bpm->pkt_len_max ||
1821 bpm_temp->dscp_value != bpm->dscp_value ||
40881800 1822 bpm_temp->flow_label != bpm->flow_label ||
a60b7031 1823 bpm_temp->family != bpm->family ||
836b6953 1824 bpm_temp->fragment != bpm->fragment)
d114b0d7
PG
1825 return HASHWALK_CONTINUE;
1826
1827 /* look for remaining bpme */
1828 bpmer->bpme_found = hash_lookup(bpm->entry_hash, bpme);
1829 if (!bpmer->bpme_found)
1830 return HASHWALK_CONTINUE;
1831 return HASHWALK_ABORT;
1832}
1833
9b6d8fcf
DS
1834static void bgp_pbr_policyroute_remove_from_zebra_unit(
1835 struct bgp *bgp, struct bgp_path_info *path, struct bgp_pbr_filter *bpf)
d114b0d7
PG
1836{
1837 struct bgp_pbr_match temp;
1838 struct bgp_pbr_match_entry temp2;
9350f1df
PG
1839 struct bgp_pbr_rule pbr_rule;
1840 struct bgp_pbr_rule *bpr;
d114b0d7
PG
1841 struct bgp_pbr_match *bpm;
1842 struct bgp_pbr_match_entry *bpme;
1843 struct bgp_pbr_match_entry_remain bpmer;
0e867886
PG
1844 struct bgp_pbr_range_port *src_port;
1845 struct bgp_pbr_range_port *dst_port;
1846 struct bgp_pbr_range_port *pkt_len;
9350f1df 1847 struct bgp_pbr_rule_remain bprr;
0e867886
PG
1848
1849 if (!bpf)
1850 return;
1851 src_port = bpf->src_port;
1852 dst_port = bpf->dst_port;
1853 pkt_len = bpf->pkt_len;
d114b0d7 1854
064a9d52
PG
1855 if (BGP_DEBUG(zebra, ZEBRA))
1856 bgp_pbr_dump_entry(bpf, false);
1857
d114b0d7
PG
1858 /* as we don't know information from EC
1859 * look for bpm that have the bpm
1860 * with vrf_id characteristics
1861 */
1862 memset(&temp2, 0, sizeof(temp2));
1863 memset(&temp, 0, sizeof(temp));
9350f1df
PG
1864
1865 if (bpf->type == BGP_PBR_IPRULE) {
1866 memset(&pbr_rule, 0, sizeof(pbr_rule));
1867 pbr_rule.vrf_id = bpf->vrf_id;
1868 if (bpf->src) {
1869 prefix_copy(&pbr_rule.src, bpf->src);
1870 pbr_rule.flags |= MATCH_IP_SRC_SET;
1871 }
1872 if (bpf->dst) {
1873 prefix_copy(&pbr_rule.dst, bpf->dst);
1874 pbr_rule.flags |= MATCH_IP_DST_SET;
1875 }
1876 bpr = &pbr_rule;
1877 /* A previous entry may already exist
1878 * flush previous entry if necessary
1879 */
1880 bprr.bpr_to_match = bpr;
1881 bprr.bpr_found = NULL;
1882 hash_walk(bgp->pbr_rule_hash, bgp_pbr_get_same_rule, &bprr);
1883 if (bprr.bpr_found) {
1884 static struct bgp_pbr_rule *local_bpr;
1885 static struct bgp_pbr_action *local_bpa;
1886
1887 local_bpr = bprr.bpr_found;
1888 local_bpa = local_bpr->action;
1889 bgp_pbr_flush_iprule(bgp, local_bpa,
1890 local_bpr);
1891 }
1892 return;
1893 }
1894
a60b7031 1895 temp.family = bpf->family;
0e867886 1896 if (bpf->src) {
d114b0d7 1897 temp.flags |= MATCH_IP_SRC_SET;
0e867886 1898 prefix_copy(&temp2.src, bpf->src);
d114b0d7 1899 } else
f01e580f 1900 temp2.src.family = bpf->family;
0e867886 1901 if (bpf->dst) {
d114b0d7 1902 temp.flags |= MATCH_IP_DST_SET;
0e867886 1903 prefix_copy(&temp2.dst, bpf->dst);
d114b0d7 1904 } else
f01e580f 1905 temp2.dst.family = bpf->family;
3bed2363
PG
1906 if (src_port && (src_port->min_port || bpf->protocol == IPPROTO_ICMP)) {
1907 if (bpf->protocol == IPPROTO_ICMP)
1908 temp.flags |= MATCH_ICMP_SET;
1de7dfff
PG
1909 temp.flags |= MATCH_PORT_SRC_SET;
1910 temp2.src_port_min = src_port->min_port;
1911 if (src_port->max_port) {
1912 temp.flags |= MATCH_PORT_SRC_RANGE_SET;
1913 temp2.src_port_max = src_port->max_port;
1914 }
1915 }
3bed2363
PG
1916 if (dst_port && (dst_port->min_port || bpf->protocol == IPPROTO_ICMP)) {
1917 if (bpf->protocol == IPPROTO_ICMP)
1918 temp.flags |= MATCH_ICMP_SET;
1de7dfff
PG
1919 temp.flags |= MATCH_PORT_DST_SET;
1920 temp2.dst_port_min = dst_port->min_port;
1921 if (dst_port->max_port) {
1922 temp.flags |= MATCH_PORT_DST_RANGE_SET;
1923 temp2.dst_port_max = dst_port->max_port;
1924 }
1925 }
0e867886 1926 temp2.proto = bpf->protocol;
1de7dfff 1927
cfaf18ce 1928 if (pkt_len) {
83360720 1929 temp.pkt_len_min = pkt_len->min_port;
cfaf18ce
PG
1930 if (pkt_len->max_port)
1931 temp.pkt_len_max = pkt_len->max_port;
1932 } else if (bpf->pkt_len_val) {
1933 if (bpf->pkt_len_val->mask)
1934 temp.flags |= MATCH_PKT_LEN_INVERSE_SET;
1935 temp.pkt_len_min = bpf->pkt_len_val->val;
1936 }
2da7d62e
PG
1937 if (bpf->tcp_flags) {
1938 temp.tcp_flags = bpf->tcp_flags->val;
1939 temp.tcp_mask_flags = bpf->tcp_flags->mask;
1940 }
4977bd6c
PG
1941 if (bpf->dscp) {
1942 if (bpf->dscp->mask)
1943 temp.flags |= MATCH_DSCP_INVERSE_SET;
1944 else
1945 temp.flags |= MATCH_DSCP_SET;
1946 temp.dscp_value = bpf->dscp->val;
1947 }
40881800
PG
1948 if (bpf->flow_label) {
1949 if (bpf->flow_label->mask)
1950 temp.flags |= MATCH_FLOW_LABEL_INVERSE_SET;
1951 else
1952 temp.flags |= MATCH_FLOW_LABEL_SET;
1953 temp.flow_label = bpf->flow_label->val;
1954 }
1955
6f5617d8
PG
1956 if (bpf->fragment) {
1957 if (bpf->fragment->mask)
1958 temp.flags |= MATCH_FRAGMENT_INVERSE_SET;
1959 temp.fragment = bpf->fragment->val;
1960 }
83360720 1961
0e867886 1962 if (bpf->src == NULL || bpf->dst == NULL) {
1de7dfff
PG
1963 if (temp.flags & (MATCH_PORT_DST_SET | MATCH_PORT_SRC_SET))
1964 temp.type = IPSET_NET_PORT;
1965 else
1966 temp.type = IPSET_NET;
1967 } else {
1968 if (temp.flags & (MATCH_PORT_DST_SET | MATCH_PORT_SRC_SET))
1969 temp.type = IPSET_NET_PORT_NET;
1970 else
1971 temp.type = IPSET_NET_NET;
1972 }
0e867886 1973 if (bpf->vrf_id == VRF_UNKNOWN) /* XXX case BGP destroy */
946de1b9 1974 temp.vrf_id = VRF_DEFAULT;
d114b0d7 1975 else
0e867886 1976 temp.vrf_id = bpf->vrf_id;
d114b0d7
PG
1977 bpme = &temp2;
1978 bpm = &temp;
1979 bpme->backpointer = bpm;
1980 /* right now, a previous entry may already exist
1981 * flush previous entry if necessary
1982 */
1983 bpmer.bpme_to_match = bpme;
1984 bpmer.bpme_found = NULL;
1985 hash_walk(bgp->pbr_match_hash, bgp_pbr_get_remaining_entry, &bpmer);
1986 if (bpmer.bpme_found) {
1987 static struct bgp_pbr_match *local_bpm;
1988 static struct bgp_pbr_action *local_bpa;
1989
1990 local_bpm = bpmer.bpme_found->backpointer;
1991 local_bpa = local_bpm->action;
1992 bgp_pbr_flush_entry(bgp, local_bpa,
1993 local_bpm, bpmer.bpme_found);
1994 }
1995}
1996
e45aea59
PG
1997static uint8_t bgp_pbr_next_type_entry(uint8_t type_entry)
1998{
1999 if (type_entry == FLOWSPEC_TCP_FLAGS)
2000 return FLOWSPEC_DSCP;
2001 if (type_entry == FLOWSPEC_DSCP)
40881800
PG
2002 return FLOWSPEC_FLOW_LABEL;
2003 if (type_entry == FLOWSPEC_FLOW_LABEL)
e45aea59
PG
2004 return FLOWSPEC_PKT_LEN;
2005 if (type_entry == FLOWSPEC_PKT_LEN)
2006 return FLOWSPEC_FRAGMENT;
da3fa383
PG
2007 if (type_entry == FLOWSPEC_FRAGMENT)
2008 return FLOWSPEC_ICMP_TYPE;
e45aea59
PG
2009 return 0;
2010}
2011
9b6d8fcf 2012static void bgp_pbr_icmp_action(struct bgp *bgp, struct bgp_path_info *path,
4b7e6066
DS
2013 struct bgp_pbr_filter *bpf,
2014 struct bgp_pbr_or_filter *bpof, bool add,
2015 struct nexthop *nh, float *rate)
da3fa383
PG
2016{
2017 struct bgp_pbr_range_port srcp, dstp;
2018 struct bgp_pbr_val_mask *icmp_type, *icmp_code;
2019 struct listnode *tnode, *cnode;
2020
2021 if (!bpf)
2022 return;
2023 if (bpf->protocol != IPPROTO_ICMP)
2024 return;
60031a55
DS
2025
2026 memset(&srcp, 0, sizeof(srcp));
2027 memset(&dstp, 0, sizeof(dstp));
da3fa383
PG
2028 bpf->src_port = &srcp;
2029 bpf->dst_port = &dstp;
2030 /* parse icmp type and lookup appropriate icmp code
2031 * if no icmp code found, create as many entryes as
2032 * there are listed icmp codes for that icmp type
2033 */
2034 if (!bpof->icmp_type) {
2035 srcp.min_port = 0;
2036 srcp.max_port = 255;
2037 for (ALL_LIST_ELEMENTS_RO(bpof->icmp_code, cnode, icmp_code)) {
2038 dstp.min_port = icmp_code->val;
2039 if (add)
9b6d8fcf
DS
2040 bgp_pbr_policyroute_add_to_zebra_unit(
2041 bgp, path, bpf, nh, rate);
da3fa383
PG
2042 else
2043 bgp_pbr_policyroute_remove_from_zebra_unit(
9b6d8fcf 2044 bgp, path, bpf);
da3fa383
PG
2045 }
2046 return;
2047 }
2048 for (ALL_LIST_ELEMENTS_RO(bpof->icmp_type, tnode, icmp_type)) {
2049 srcp.min_port = icmp_type->val;
2050 srcp.max_port = 0;
2051 dstp.max_port = 0;
2052 /* only icmp type. create an entry only with icmp type */
2053 if (!bpof->icmp_code) {
2054 /* icmp type is not one of the above
2055 * forge an entry only based on the icmp type
2056 */
2057 dstp.min_port = 0;
2058 dstp.max_port = 255;
2059 if (add)
2060 bgp_pbr_policyroute_add_to_zebra_unit(
9b6d8fcf 2061 bgp, path, bpf, nh, rate);
da3fa383 2062 else
9b6d8fcf
DS
2063 bgp_pbr_policyroute_remove_from_zebra_unit(
2064 bgp, path, bpf);
da3fa383
PG
2065 continue;
2066 }
2067 for (ALL_LIST_ELEMENTS_RO(bpof->icmp_code, cnode, icmp_code)) {
2068 dstp.min_port = icmp_code->val;
2069 if (add)
2070 bgp_pbr_policyroute_add_to_zebra_unit(
9b6d8fcf 2071 bgp, path, bpf, nh, rate);
da3fa383
PG
2072 else
2073 bgp_pbr_policyroute_remove_from_zebra_unit(
9b6d8fcf 2074 bgp, path, bpf);
da3fa383
PG
2075 }
2076 }
2077}
2078
4b7e6066 2079static void bgp_pbr_policyroute_remove_from_zebra_recursive(
9b6d8fcf
DS
2080 struct bgp *bgp, struct bgp_path_info *path, struct bgp_pbr_filter *bpf,
2081 struct bgp_pbr_or_filter *bpof, uint8_t type_entry)
56707a36
PG
2082{
2083 struct listnode *node, *nnode;
2084 struct bgp_pbr_val_mask *valmask;
2085 uint8_t next_type_entry;
2086 struct list *orig_list;
2087 struct bgp_pbr_val_mask **target_val;
2088
d90b788e
A
2089 if (type_entry == 0) {
2090 bgp_pbr_policyroute_remove_from_zebra_unit(bgp, path, bpf);
2091 return;
2092 }
e45aea59 2093 next_type_entry = bgp_pbr_next_type_entry(type_entry);
56707a36 2094 if (type_entry == FLOWSPEC_TCP_FLAGS && bpof->tcpflags) {
56707a36
PG
2095 orig_list = bpof->tcpflags;
2096 target_val = &bpf->tcp_flags;
2097 } else if (type_entry == FLOWSPEC_DSCP && bpof->dscp) {
56707a36
PG
2098 orig_list = bpof->dscp;
2099 target_val = &bpf->dscp;
40881800
PG
2100 } else if (type_entry == FLOWSPEC_FLOW_LABEL && bpof->flowlabel) {
2101 orig_list = bpof->flowlabel;
2102 target_val = &bpf->flow_label;
cfaf18ce 2103 } else if (type_entry == FLOWSPEC_PKT_LEN && bpof->pkt_len) {
cfaf18ce
PG
2104 orig_list = bpof->pkt_len;
2105 target_val = &bpf->pkt_len_val;
6f5617d8 2106 } else if (type_entry == FLOWSPEC_FRAGMENT && bpof->fragment) {
6f5617d8
PG
2107 orig_list = bpof->fragment;
2108 target_val = &bpf->fragment;
da3fa383
PG
2109 } else if (type_entry == FLOWSPEC_ICMP_TYPE &&
2110 (bpof->icmp_type || bpof->icmp_code)) {
2111 /* enumerate list for icmp - must be last one */
9b6d8fcf 2112 bgp_pbr_icmp_action(bgp, path, bpf, bpof, false, NULL, NULL);
da3fa383 2113 return;
56707a36 2114 } else {
d90b788e 2115 bgp_pbr_policyroute_remove_from_zebra_recursive(
9b6d8fcf 2116 bgp, path, bpf, bpof, next_type_entry);
d90b788e 2117 return;
56707a36
PG
2118 }
2119 for (ALL_LIST_ELEMENTS(orig_list, node, nnode, valmask)) {
2120 *target_val = valmask;
9b6d8fcf
DS
2121 bgp_pbr_policyroute_remove_from_zebra_recursive(
2122 bgp, path, bpf, bpof, next_type_entry);
56707a36
PG
2123 }
2124}
2125
4b7e6066 2126static void bgp_pbr_policyroute_remove_from_zebra(
9b6d8fcf
DS
2127 struct bgp *bgp, struct bgp_path_info *path, struct bgp_pbr_filter *bpf,
2128 struct bgp_pbr_or_filter *bpof)
9bba1455 2129{
d90b788e
A
2130 if (!bpof) {
2131 bgp_pbr_policyroute_remove_from_zebra_unit(bgp, path, bpf);
2132 return;
2133 }
56707a36 2134 if (bpof->tcpflags)
9b6d8fcf
DS
2135 bgp_pbr_policyroute_remove_from_zebra_recursive(
2136 bgp, path, bpf, bpof, FLOWSPEC_TCP_FLAGS);
56707a36 2137 else if (bpof->dscp)
9b6d8fcf
DS
2138 bgp_pbr_policyroute_remove_from_zebra_recursive(
2139 bgp, path, bpf, bpof, FLOWSPEC_DSCP);
40881800
PG
2140 else if (bpof->flowlabel)
2141 bgp_pbr_policyroute_remove_from_zebra_recursive(
2142 bgp, path, bpf, bpof, FLOWSPEC_FLOW_LABEL);
cfaf18ce 2143 else if (bpof->pkt_len)
9b6d8fcf
DS
2144 bgp_pbr_policyroute_remove_from_zebra_recursive(
2145 bgp, path, bpf, bpof, FLOWSPEC_PKT_LEN);
6f5617d8 2146 else if (bpof->fragment)
9b6d8fcf
DS
2147 bgp_pbr_policyroute_remove_from_zebra_recursive(
2148 bgp, path, bpf, bpof, FLOWSPEC_FRAGMENT);
da3fa383 2149 else if (bpof->icmp_type || bpof->icmp_code)
9b6d8fcf
DS
2150 bgp_pbr_policyroute_remove_from_zebra_recursive(
2151 bgp, path, bpf, bpof, FLOWSPEC_ICMP_TYPE);
56707a36 2152 else
9b6d8fcf 2153 bgp_pbr_policyroute_remove_from_zebra_unit(bgp, path, bpf);
56707a36
PG
2154 /* flush bpof */
2155 if (bpof->tcpflags)
2156 list_delete_all_node(bpof->tcpflags);
2157 if (bpof->dscp)
2158 list_delete_all_node(bpof->dscp);
40881800
PG
2159 if (bpof->flowlabel)
2160 list_delete_all_node(bpof->flowlabel);
cfaf18ce
PG
2161 if (bpof->pkt_len)
2162 list_delete_all_node(bpof->pkt_len);
6f5617d8
PG
2163 if (bpof->fragment)
2164 list_delete_all_node(bpof->fragment);
9bba1455
PG
2165}
2166
064a9d52
PG
2167static void bgp_pbr_dump_entry(struct bgp_pbr_filter *bpf, bool add)
2168{
2169 struct bgp_pbr_range_port *src_port;
2170 struct bgp_pbr_range_port *dst_port;
2171 struct bgp_pbr_range_port *pkt_len;
2172 char bufsrc[64], bufdst[64];
2173 char buffer[64];
2174 int remaining_len = 0;
2175 char protocol_str[16];
2176
2177 if (!bpf)
2178 return;
2179 src_port = bpf->src_port;
2180 dst_port = bpf->dst_port;
2181 pkt_len = bpf->pkt_len;
2182
2183 protocol_str[0] = '\0';
2184 if (bpf->tcp_flags && bpf->tcp_flags->mask)
2185 bpf->protocol = IPPROTO_TCP;
2186 if (bpf->protocol)
2187 snprintf(protocol_str, sizeof(protocol_str),
2188 "proto %d", bpf->protocol);
2189 buffer[0] = '\0';
2190 if (bpf->protocol == IPPROTO_ICMP && src_port && dst_port)
2191 remaining_len += snprintf(buffer, sizeof(buffer),
2192 "type %d, code %d",
2193 src_port->min_port,
2194 dst_port->min_port);
2195 else if (bpf->protocol == IPPROTO_UDP ||
2196 bpf->protocol == IPPROTO_TCP) {
2197
2198 if (src_port && src_port->min_port)
2199 remaining_len += snprintf(buffer,
2200 sizeof(buffer),
2201 "from [%u:%u]",
2202 src_port->min_port,
2203 src_port->max_port ?
2204 src_port->max_port :
2205 src_port->min_port);
2206 if (dst_port && dst_port->min_port)
2207 remaining_len += snprintf(buffer +
2208 remaining_len,
2209 sizeof(buffer)
2210 - remaining_len,
2211 "to [%u:%u]",
2212 dst_port->min_port,
2213 dst_port->max_port ?
2214 dst_port->max_port :
2215 dst_port->min_port);
2216 }
2217 if (pkt_len && (pkt_len->min_port || pkt_len->max_port)) {
2218 remaining_len += snprintf(buffer + remaining_len,
2219 sizeof(buffer)
2220 - remaining_len,
2221 " len [%u:%u]",
2222 pkt_len->min_port,
2223 pkt_len->max_port ?
2224 pkt_len->max_port :
2225 pkt_len->min_port);
2226 } else if (bpf->pkt_len_val) {
2227 remaining_len += snprintf(buffer + remaining_len,
2228 sizeof(buffer)
2229 - remaining_len,
2230 " %s len %u",
2231 bpf->pkt_len_val->mask
2232 ? "!" : "",
2233 bpf->pkt_len_val->val);
2234 }
2235 if (bpf->tcp_flags) {
2236 remaining_len += snprintf(buffer + remaining_len,
2237 sizeof(buffer)
2238 - remaining_len,
2239 "tcpflags %x/%x",
2240 bpf->tcp_flags->val,
2241 bpf->tcp_flags->mask);
2242 }
2243 if (bpf->dscp) {
2244 snprintf(buffer + remaining_len,
2245 sizeof(buffer)
2246 - remaining_len,
2247 "%s dscp %d",
2248 bpf->dscp->mask
2249 ? "!" : "",
2250 bpf->dscp->val);
2251 }
40881800
PG
2252 if (bpf->flow_label) {
2253 snprintf(buffer + remaining_len,
2254 sizeof(buffer)
2255 - remaining_len,
2256 "%s flow_label %d",
2257 bpf->flow_label->mask
2258 ? "!" : "",
2259 bpf->flow_label->val);
2260 }
45837bc4 2261 zlog_debug("BGP: %s FS PBR from %s to %s, %s %s",
064a9d52
PG
2262 add ? "adding" : "removing",
2263 bpf->src == NULL ? "<all>" :
2264 prefix2str(bpf->src, bufsrc, sizeof(bufsrc)),
2265 bpf->dst == NULL ? "<all>" :
2266 prefix2str(bpf->dst, bufdst, sizeof(bufdst)),
2267 protocol_str, buffer);
2268
2269}
2270
9bba1455 2271static void bgp_pbr_policyroute_add_to_zebra_unit(struct bgp *bgp,
9b6d8fcf 2272 struct bgp_path_info *path,
4b7e6066
DS
2273 struct bgp_pbr_filter *bpf,
2274 struct nexthop *nh,
2275 float *rate)
d114b0d7
PG
2276{
2277 struct bgp_pbr_match temp;
2278 struct bgp_pbr_match_entry temp2;
2279 struct bgp_pbr_match *bpm;
2280 struct bgp_pbr_match_entry *bpme = NULL;
2281 struct bgp_pbr_action temp3;
2282 struct bgp_pbr_action *bpa = NULL;
2283 struct bgp_pbr_match_entry_remain bpmer;
9350f1df 2284 struct bgp_pbr_rule_remain bprr;
0e867886
PG
2285 struct bgp_pbr_range_port *src_port;
2286 struct bgp_pbr_range_port *dst_port;
2287 struct bgp_pbr_range_port *pkt_len;
9350f1df
PG
2288 struct bgp_pbr_rule pbr_rule;
2289 struct bgp_pbr_rule *bpr;
ce3c0614 2290 bool bpr_found = false;
c26edcda 2291 bool bpme_found = false;
7afeaffa 2292 struct vrf *vrf = NULL;
0e867886
PG
2293
2294 if (!bpf)
2295 return;
2296 src_port = bpf->src_port;
2297 dst_port = bpf->dst_port;
2298 pkt_len = bpf->pkt_len;
d114b0d7 2299
064a9d52
PG
2300 if (BGP_DEBUG(zebra, ZEBRA))
2301 bgp_pbr_dump_entry(bpf, true);
2302
d114b0d7
PG
2303 /* look for bpa first */
2304 memset(&temp3, 0, sizeof(temp3));
2305 if (rate)
2306 temp3.rate = *rate;
2307 if (nh)
2308 memcpy(&temp3.nh, nh, sizeof(struct nexthop));
0e867886 2309 temp3.vrf_id = bpf->vrf_id;
f01e580f 2310 temp3.afi = family2afi(bpf->family);
d114b0d7
PG
2311 bpa = hash_get(bgp->pbr_action_hash, &temp3,
2312 bgp_pbr_action_alloc_intern);
2313
7afeaffa
PG
2314 if (nh)
2315 vrf = vrf_lookup_by_id(nh->vrf_id);
d114b0d7 2316 if (bpa->fwmark == 0) {
d114b0d7
PG
2317 /* drop is handled by iptable */
2318 if (nh && nh->type == NEXTHOP_TYPE_BLACKHOLE) {
2319 bpa->table_id = 0;
2320 bpa->installed = true;
2321 } else {
31c28cd7 2322 bpa->fwmark = bgp_zebra_tm_get_id();
7afeaffa
PG
2323 /* if action is redirect-vrf, then
2324 * use directly table_id of vrf
2325 */
2326 if (nh && vrf && !vrf_is_backend_netns()
2327 && bpf->vrf_id != vrf->vrf_id)
2328 bpa->table_id = vrf->data.l.table_id;
2329 else
2330 bpa->table_id = bpa->fwmark;
d114b0d7
PG
2331 bpa->installed = false;
2332 }
a6b07429 2333 bpa->bgp = bgp;
d114b0d7
PG
2334 bpa->unique = ++bgp_pbr_action_counter_unique;
2335 /* 0 value is forbidden */
2336 bpa->install_in_progress = false;
2337 }
9350f1df
PG
2338 if (bpf->type == BGP_PBR_IPRULE) {
2339 memset(&pbr_rule, 0, sizeof(pbr_rule));
2340 pbr_rule.vrf_id = bpf->vrf_id;
8112a7a0 2341 pbr_rule.priority = 20;
9350f1df
PG
2342 if (bpf->src) {
2343 pbr_rule.flags |= MATCH_IP_SRC_SET;
2344 prefix_copy(&pbr_rule.src, bpf->src);
2345 }
2346 if (bpf->dst) {
2347 pbr_rule.flags |= MATCH_IP_DST_SET;
2348 prefix_copy(&pbr_rule.dst, bpf->dst);
2349 }
2350 pbr_rule.action = bpa;
2351 bpr = hash_get(bgp->pbr_rule_hash, &pbr_rule,
2352 bgp_pbr_rule_alloc_intern);
8e3aae66 2353 if (bpr->unique == 0) {
9350f1df
PG
2354 bpr->unique = ++bgp_pbr_action_counter_unique;
2355 bpr->installed = false;
2356 bpr->install_in_progress = false;
ce3c0614
PG
2357 /* link bgp info to bpr */
2358 bpr->path = (void *)path;
2359 } else
2360 bpr_found = true;
2361 /* already installed */
8e3aae66 2362 if (bpr_found) {
ce3c0614
PG
2363 struct bgp_path_info_extra *extra =
2364 bgp_path_info_extra_get(path);
2365
e0c7edb0
PG
2366 if (extra &&
2367 listnode_lookup_nocheck(extra->bgp_fs_iprule,
2368 bpr)) {
ce3c0614 2369 if (BGP_DEBUG(pbr, PBR_ERROR))
3efd0893 2370 zlog_err("%s: entry %p/%p already installed in bgp pbr iprule",
ce3c0614
PG
2371 __func__, path, bpr);
2372 return;
2373 }
9350f1df 2374 }
db1fcc98
DS
2375
2376 bgp_pbr_bpa_add(bpa);
2377
9350f1df 2378 /* ip rule add */
8e3aae66 2379 if (!bpr->installed)
9350f1df 2380 bgp_send_pbr_rule_action(bpa, bpr, true);
d114b0d7 2381
9350f1df
PG
2382 /* A previous entry may already exist
2383 * flush previous entry if necessary
2384 */
2385 bprr.bpr_to_match = bpr;
2386 bprr.bpr_found = NULL;
2387 hash_walk(bgp->pbr_rule_hash, bgp_pbr_get_same_rule, &bprr);
2388 if (bprr.bpr_found) {
2389 static struct bgp_pbr_rule *local_bpr;
2390 static struct bgp_pbr_action *local_bpa;
2391
2392 local_bpr = bprr.bpr_found;
2393 local_bpa = local_bpr->action;
2394 bgp_pbr_flush_iprule(bgp, local_bpa,
2395 local_bpr);
2396 }
2397 return;
2398 }
d114b0d7
PG
2399 /* then look for bpm */
2400 memset(&temp, 0, sizeof(temp));
0e867886 2401 temp.vrf_id = bpf->vrf_id;
a60b7031 2402 temp.family = bpf->family;
0e867886 2403 if (bpf->src)
d114b0d7 2404 temp.flags |= MATCH_IP_SRC_SET;
0e867886 2405 if (bpf->dst)
d114b0d7 2406 temp.flags |= MATCH_IP_DST_SET;
1de7dfff 2407
3bed2363
PG
2408 if (src_port && (src_port->min_port || bpf->protocol == IPPROTO_ICMP)) {
2409 if (bpf->protocol == IPPROTO_ICMP)
2410 temp.flags |= MATCH_ICMP_SET;
1de7dfff 2411 temp.flags |= MATCH_PORT_SRC_SET;
3bed2363
PG
2412 }
2413 if (dst_port && (dst_port->min_port || bpf->protocol == IPPROTO_ICMP)) {
2414 if (bpf->protocol == IPPROTO_ICMP)
2415 temp.flags |= MATCH_ICMP_SET;
1de7dfff 2416 temp.flags |= MATCH_PORT_DST_SET;
3bed2363 2417 }
1de7dfff
PG
2418 if (src_port && src_port->max_port)
2419 temp.flags |= MATCH_PORT_SRC_RANGE_SET;
2420 if (dst_port && dst_port->max_port)
2421 temp.flags |= MATCH_PORT_DST_RANGE_SET;
3bed2363
PG
2422
2423 if (bpf->src == NULL || bpf->dst == NULL) {
2424 if (temp.flags & (MATCH_PORT_DST_SET | MATCH_PORT_SRC_SET))
2425 temp.type = IPSET_NET_PORT;
2426 else
2427 temp.type = IPSET_NET;
2428 } else {
2429 if (temp.flags & (MATCH_PORT_DST_SET | MATCH_PORT_SRC_SET))
2430 temp.type = IPSET_NET_PORT_NET;
2431 else
2432 temp.type = IPSET_NET_NET;
2433 }
cfaf18ce 2434 if (pkt_len) {
83360720 2435 temp.pkt_len_min = pkt_len->min_port;
cfaf18ce
PG
2436 if (pkt_len->max_port)
2437 temp.pkt_len_max = pkt_len->max_port;
2438 } else if (bpf->pkt_len_val) {
2439 if (bpf->pkt_len_val->mask)
2440 temp.flags |= MATCH_PKT_LEN_INVERSE_SET;
2441 temp.pkt_len_min = bpf->pkt_len_val->val;
2442 }
2da7d62e
PG
2443 if (bpf->tcp_flags) {
2444 temp.tcp_flags = bpf->tcp_flags->val;
2445 temp.tcp_mask_flags = bpf->tcp_flags->mask;
2446 }
4977bd6c
PG
2447 if (bpf->dscp) {
2448 if (bpf->dscp->mask)
2449 temp.flags |= MATCH_DSCP_INVERSE_SET;
2450 else
2451 temp.flags |= MATCH_DSCP_SET;
2452 temp.dscp_value = bpf->dscp->val;
2453 }
40881800
PG
2454 if (bpf->flow_label) {
2455 if (bpf->flow_label->mask)
2456 temp.flags |= MATCH_FLOW_LABEL_INVERSE_SET;
2457 else
2458 temp.flags |= MATCH_FLOW_LABEL_SET;
2459 temp.flow_label = bpf->flow_label->val;
2460 }
6f5617d8
PG
2461 if (bpf->fragment) {
2462 if (bpf->fragment->mask)
2463 temp.flags |= MATCH_FRAGMENT_INVERSE_SET;
2464 temp.fragment = bpf->fragment->val;
2465 }
f449d223
PG
2466 if (bpf->protocol) {
2467 temp.protocol = bpf->protocol;
2468 temp.flags |= MATCH_PROTOCOL_SET;
2469 }
d114b0d7
PG
2470 temp.action = bpa;
2471 bpm = hash_get(bgp->pbr_match_hash, &temp,
2472 bgp_pbr_match_alloc_intern);
2473
2474 /* new, then self allocate ipset_name and unique */
5a430eee 2475 if (bpm->unique == 0) {
d114b0d7
PG
2476 bpm->unique = ++bgp_pbr_match_counter_unique;
2477 /* 0 value is forbidden */
4371bf91
PG
2478 snprintf(bpm->ipset_name, sizeof(bpm->ipset_name),
2479 "match%p", bpm);
d114b0d7
PG
2480 bpm->entry_hash = hash_create_size(8,
2481 bgp_pbr_match_entry_hash_key,
2482 bgp_pbr_match_entry_hash_equal,
2483 "Match Entry Hash");
2484 bpm->installed = false;
2485
2486 /* unique2 should be updated too */
2487 bpm->unique2 = ++bgp_pbr_match_iptable_counter_unique;
2488 bpm->installed_in_iptable = false;
2489 bpm->install_in_progress = false;
2490 bpm->install_iptable_in_progress = false;
2491 }
2492
2493 memset(&temp2, 0, sizeof(temp2));
0e867886
PG
2494 if (bpf->src)
2495 prefix_copy(&temp2.src, bpf->src);
d114b0d7 2496 else
f01e580f 2497 temp2.src.family = bpf->family;
0e867886
PG
2498 if (bpf->dst)
2499 prefix_copy(&temp2.dst, bpf->dst);
d114b0d7 2500 else
f01e580f 2501 temp2.dst.family = bpf->family;
1de7dfff
PG
2502 temp2.src_port_min = src_port ? src_port->min_port : 0;
2503 temp2.dst_port_min = dst_port ? dst_port->min_port : 0;
2504 temp2.src_port_max = src_port ? src_port->max_port : 0;
2505 temp2.dst_port_max = dst_port ? dst_port->max_port : 0;
0e867886 2506 temp2.proto = bpf->protocol;
5a430eee
PG
2507 bpme = hash_get(bpm->entry_hash, &temp2,
2508 bgp_pbr_match_entry_alloc_intern);
2509 if (bpme->unique == 0) {
d114b0d7
PG
2510 bpme->unique = ++bgp_pbr_match_entry_counter_unique;
2511 /* 0 value is forbidden */
2512 bpme->backpointer = bpm;
2513 bpme->installed = false;
2514 bpme->install_in_progress = false;
b588b642 2515 /* link bgp info to bpme */
9b6d8fcf 2516 bpme->path = (void *)path;
c26edcda
PG
2517 } else
2518 bpme_found = true;
d114b0d7 2519
c26edcda 2520 /* already installed */
5a430eee 2521 if (bpme_found) {
18ee8310 2522 struct bgp_path_info_extra *extra =
9b6d8fcf 2523 bgp_path_info_extra_get(path);
c26edcda 2524
e0c7edb0
PG
2525 if (extra &&
2526 listnode_lookup_nocheck(extra->bgp_fs_pbr, bpme)) {
c26edcda 2527 if (BGP_DEBUG(pbr, PBR_ERROR))
9b6d8fcf
DS
2528 zlog_err(
2529 "%s: entry %p/%p already installed in bgp pbr",
2530 __func__, path, bpme);
c26edcda
PG
2531 return;
2532 }
2533 }
d114b0d7
PG
2534 /* BGP FS: append entry to zebra
2535 * - policies are not routing entries and as such
2536 * route replace semantics don't necessarily follow
2537 * through to policy entries
2538 * - because of that, not all policing information will be stored
2539 * into zebra. and non selected policies will be suppressed from zebra
2540 * - as consequence, in order to bring consistency
2541 * a policy will be added, then ifan ecmp policy exists,
2542 * it will be suppressed subsequently
2543 */
2544 /* ip rule add */
db1fcc98 2545 bgp_pbr_bpa_add(bpa);
d114b0d7
PG
2546
2547 /* ipset create */
6ea591c7 2548 if (!bpm->installed)
d114b0d7
PG
2549 bgp_send_pbr_ipset_match(bpm, true);
2550 /* ipset add */
6ea591c7 2551 if (!bpme->installed)
d114b0d7
PG
2552 bgp_send_pbr_ipset_entry_match(bpme, true);
2553
2554 /* iptables */
6ea591c7 2555 if (!bpm->installed_in_iptable)
d114b0d7
PG
2556 bgp_send_pbr_iptable(bpa, bpm, true);
2557
2558 /* A previous entry may already exist
2559 * flush previous entry if necessary
2560 */
2561 bpmer.bpme_to_match = bpme;
2562 bpmer.bpme_found = NULL;
2563 hash_walk(bgp->pbr_match_hash, bgp_pbr_get_remaining_entry, &bpmer);
2564 if (bpmer.bpme_found) {
2565 static struct bgp_pbr_match *local_bpm;
2566 static struct bgp_pbr_action *local_bpa;
2567
2568 local_bpm = bpmer.bpme_found->backpointer;
2569 local_bpa = local_bpm->action;
2570 bgp_pbr_flush_entry(bgp, local_bpa,
2571 local_bpm, bpmer.bpme_found);
2572 }
2573
2574
2575}
2576
4b7e6066 2577static void bgp_pbr_policyroute_add_to_zebra_recursive(
9b6d8fcf
DS
2578 struct bgp *bgp, struct bgp_path_info *path, struct bgp_pbr_filter *bpf,
2579 struct bgp_pbr_or_filter *bpof, struct nexthop *nh, float *rate,
2580 uint8_t type_entry)
56707a36
PG
2581{
2582 struct listnode *node, *nnode;
2583 struct bgp_pbr_val_mask *valmask;
2584 uint8_t next_type_entry;
2585 struct list *orig_list;
2586 struct bgp_pbr_val_mask **target_val;
2587
d90b788e
A
2588 if (type_entry == 0) {
2589 bgp_pbr_policyroute_add_to_zebra_unit(bgp, path, bpf, nh, rate);
2590 return;
2591 }
e45aea59 2592 next_type_entry = bgp_pbr_next_type_entry(type_entry);
56707a36 2593 if (type_entry == FLOWSPEC_TCP_FLAGS && bpof->tcpflags) {
56707a36
PG
2594 orig_list = bpof->tcpflags;
2595 target_val = &bpf->tcp_flags;
2596 } else if (type_entry == FLOWSPEC_DSCP && bpof->dscp) {
56707a36
PG
2597 orig_list = bpof->dscp;
2598 target_val = &bpf->dscp;
cfaf18ce 2599 } else if (type_entry == FLOWSPEC_PKT_LEN && bpof->pkt_len) {
cfaf18ce
PG
2600 orig_list = bpof->pkt_len;
2601 target_val = &bpf->pkt_len_val;
6f5617d8 2602 } else if (type_entry == FLOWSPEC_FRAGMENT && bpof->fragment) {
6f5617d8
PG
2603 orig_list = bpof->fragment;
2604 target_val = &bpf->fragment;
da3fa383
PG
2605 } else if (type_entry == FLOWSPEC_ICMP_TYPE &&
2606 (bpof->icmp_type || bpof->icmp_code)) {
2607 /* enumerate list for icmp - must be last one */
9b6d8fcf 2608 bgp_pbr_icmp_action(bgp, path, bpf, bpof, true, nh, rate);
da3fa383 2609 return;
56707a36 2610 } else {
d90b788e 2611 bgp_pbr_policyroute_add_to_zebra_recursive(
9b6d8fcf 2612 bgp, path, bpf, bpof, nh, rate, next_type_entry);
d90b788e 2613 return;
56707a36
PG
2614 }
2615 for (ALL_LIST_ELEMENTS(orig_list, node, nnode, valmask)) {
2616 *target_val = valmask;
9b6d8fcf
DS
2617 bgp_pbr_policyroute_add_to_zebra_recursive(
2618 bgp, path, bpf, bpof, nh, rate, next_type_entry);
56707a36
PG
2619 }
2620}
2621
9bba1455 2622static void bgp_pbr_policyroute_add_to_zebra(struct bgp *bgp,
9b6d8fcf 2623 struct bgp_path_info *path,
4b7e6066
DS
2624 struct bgp_pbr_filter *bpf,
2625 struct bgp_pbr_or_filter *bpof,
2626 struct nexthop *nh, float *rate)
9bba1455 2627{
d90b788e
A
2628 if (!bpof) {
2629 bgp_pbr_policyroute_add_to_zebra_unit(bgp, path, bpf, nh, rate);
2630 return;
2631 }
56707a36 2632 if (bpof->tcpflags)
9b6d8fcf
DS
2633 bgp_pbr_policyroute_add_to_zebra_recursive(
2634 bgp, path, bpf, bpof, nh, rate, FLOWSPEC_TCP_FLAGS);
56707a36 2635 else if (bpof->dscp)
9b6d8fcf
DS
2636 bgp_pbr_policyroute_add_to_zebra_recursive(
2637 bgp, path, bpf, bpof, nh, rate, FLOWSPEC_DSCP);
cfaf18ce 2638 else if (bpof->pkt_len)
9b6d8fcf
DS
2639 bgp_pbr_policyroute_add_to_zebra_recursive(
2640 bgp, path, bpf, bpof, nh, rate, FLOWSPEC_PKT_LEN);
6f5617d8 2641 else if (bpof->fragment)
9b6d8fcf
DS
2642 bgp_pbr_policyroute_add_to_zebra_recursive(
2643 bgp, path, bpf, bpof, nh, rate, FLOWSPEC_FRAGMENT);
da3fa383 2644 else if (bpof->icmp_type || bpof->icmp_code)
9b6d8fcf
DS
2645 bgp_pbr_policyroute_add_to_zebra_recursive(
2646 bgp, path, bpf, bpof, nh, rate, FLOWSPEC_ICMP_TYPE);
56707a36 2647 else
9b6d8fcf 2648 bgp_pbr_policyroute_add_to_zebra_unit(bgp, path, bpf, nh, rate);
56707a36
PG
2649 /* flush bpof */
2650 if (bpof->tcpflags)
2651 list_delete_all_node(bpof->tcpflags);
2652 if (bpof->dscp)
2653 list_delete_all_node(bpof->dscp);
cfaf18ce
PG
2654 if (bpof->pkt_len)
2655 list_delete_all_node(bpof->pkt_len);
6f5617d8
PG
2656 if (bpof->fragment)
2657 list_delete_all_node(bpof->fragment);
da3fa383
PG
2658 if (bpof->icmp_type)
2659 list_delete_all_node(bpof->icmp_type);
2660 if (bpof->icmp_code)
2661 list_delete_all_node(bpof->icmp_code);
932404b7
PG
2662}
2663
9b6d8fcf 2664static void bgp_pbr_handle_entry(struct bgp *bgp, struct bgp_path_info *path,
4b7e6066 2665 struct bgp_pbr_entry_main *api, bool add)
d114b0d7
PG
2666{
2667 struct nexthop nh;
2668 int i = 0;
2669 int continue_loop = 1;
2670 float rate = 0;
2671 struct prefix *src = NULL, *dst = NULL;
1de7dfff
PG
2672 uint8_t proto = 0;
2673 struct bgp_pbr_range_port *srcp = NULL, *dstp = NULL;
932404b7 2674 struct bgp_pbr_range_port range, range_icmp_code;
83360720 2675 struct bgp_pbr_range_port pkt_len;
0e867886 2676 struct bgp_pbr_filter bpf;
c5ee26cc
PG
2677 uint8_t kind_enum;
2678 struct bgp_pbr_or_filter bpof;
9bba1455 2679 struct bgp_pbr_val_mask bpvm;
d114b0d7 2680
645a1f1d 2681 memset(&range, 0, sizeof(range));
8cda9106 2682 memset(&nh, 0, sizeof(struct nexthop));
0e867886 2683 memset(&bpf, 0, sizeof(struct bgp_pbr_filter));
c5ee26cc 2684 memset(&bpof, 0, sizeof(struct bgp_pbr_or_filter));
9350f1df
PG
2685 if (api->match_bitmask & PREFIX_SRC_PRESENT ||
2686 (api->type == BGP_PBR_IPRULE &&
2687 api->match_bitmask_iprule & PREFIX_SRC_PRESENT))
d114b0d7 2688 src = &api->src_prefix;
9350f1df
PG
2689 if (api->match_bitmask & PREFIX_DST_PRESENT ||
2690 (api->type == BGP_PBR_IPRULE &&
2691 api->match_bitmask_iprule & PREFIX_DST_PRESENT))
d114b0d7 2692 dst = &api->dst_prefix;
9350f1df
PG
2693 if (api->type == BGP_PBR_IPRULE)
2694 bpf.type = api->type;
d114b0d7
PG
2695 memset(&nh, 0, sizeof(struct nexthop));
2696 nh.vrf_id = VRF_UNKNOWN;
f2ead0a5 2697 if (api->match_protocol_num) {
1de7dfff 2698 proto = (uint8_t)api->protocol[0].value;
f2ead0a5
PG
2699 if (api->afi == AF_INET6 && proto == IPPROTO_ICMPV6)
2700 proto = IPPROTO_ICMP;
2701 }
1de7dfff
PG
2702 /* if match_port is selected, then either src or dst port will be parsed
2703 * but not both at the same time
2704 */
2705 if (api->match_port_num >= 1) {
2706 bgp_pbr_extract(api->port,
2707 api->match_port_num,
2708 &range);
2709 srcp = dstp = &range;
2710 } else if (api->match_src_port_num >= 1) {
2711 bgp_pbr_extract(api->src_port,
2712 api->match_src_port_num,
2713 &range);
2714 srcp = &range;
2715 dstp = NULL;
2716 } else if (api->match_dst_port_num >= 1) {
2717 bgp_pbr_extract(api->dst_port,
2718 api->match_dst_port_num,
2719 &range);
2720 dstp = &range;
2721 srcp = NULL;
2722 }
932404b7
PG
2723 if (api->match_icmp_type_num >= 1) {
2724 proto = IPPROTO_ICMP;
da3fa383
PG
2725 if (bgp_pbr_extract(api->icmp_type,
2726 api->match_icmp_type_num,
2727 &range))
932404b7 2728 srcp = &range;
da3fa383
PG
2729 else {
2730 bpof.icmp_type = list_new();
2731 bgp_pbr_extract_enumerate(api->icmp_type,
2732 api->match_icmp_type_num,
2733 OPERATOR_UNARY_OR,
2734 bpof.icmp_type,
2735 FLOWSPEC_ICMP_TYPE);
932404b7
PG
2736 }
2737 }
2738 if (api->match_icmp_code_num >= 1) {
2739 proto = IPPROTO_ICMP;
da3fa383
PG
2740 if (bgp_pbr_extract(api->icmp_code,
2741 api->match_icmp_code_num,
2742 &range_icmp_code))
932404b7 2743 dstp = &range_icmp_code;
da3fa383
PG
2744 else {
2745 bpof.icmp_code = list_new();
2746 bgp_pbr_extract_enumerate(api->icmp_code,
2747 api->match_icmp_code_num,
2748 OPERATOR_UNARY_OR,
2749 bpof.icmp_code,
2750 FLOWSPEC_ICMP_CODE);
932404b7
PG
2751 }
2752 }
2da7d62e 2753
c5ee26cc
PG
2754 if (api->match_tcpflags_num) {
2755 kind_enum = bgp_pbr_match_val_get_operator(api->tcpflags,
2756 api->match_tcpflags_num);
2757 if (kind_enum == OPERATOR_UNARY_AND) {
9bba1455 2758 bpf.tcp_flags = &bpvm;
c5ee26cc
PG
2759 bgp_pbr_extract_enumerate(api->tcpflags,
2760 api->match_tcpflags_num,
35703998
PG
2761 OPERATOR_UNARY_AND,
2762 bpf.tcp_flags,
2763 FLOWSPEC_TCP_FLAGS);
c5ee26cc
PG
2764 } else if (kind_enum == OPERATOR_UNARY_OR) {
2765 bpof.tcpflags = list_new();
2766 bgp_pbr_extract_enumerate(api->tcpflags,
2767 api->match_tcpflags_num,
35703998
PG
2768 OPERATOR_UNARY_OR,
2769 bpof.tcpflags,
2770 FLOWSPEC_TCP_FLAGS);
c5ee26cc
PG
2771 }
2772 }
cfaf18ce
PG
2773 if (api->match_packet_length_num) {
2774 bool ret;
2775
2776 ret = bgp_pbr_extract(api->packet_length,
2777 api->match_packet_length_num,
2778 &pkt_len);
2779 if (ret)
2780 bpf.pkt_len = &pkt_len;
2781 else {
2782 bpof.pkt_len = list_new();
2783 bgp_pbr_extract_enumerate(api->packet_length,
2784 api->match_packet_length_num,
2785 OPERATOR_UNARY_OR,
2786 bpof.pkt_len,
2787 FLOWSPEC_PKT_LEN);
2788 }
2da7d62e 2789 }
4977bd6c 2790 if (api->match_dscp_num >= 1) {
35703998
PG
2791 bpof.dscp = list_new();
2792 bgp_pbr_extract_enumerate(api->dscp, api->match_dscp_num,
2793 OPERATOR_UNARY_OR,
2794 bpof.dscp, FLOWSPEC_DSCP);
4977bd6c 2795 }
6f5617d8
PG
2796 if (api->match_fragment_num) {
2797 bpof.fragment = list_new();
2798 bgp_pbr_extract_enumerate(api->fragment,
2799 api->match_fragment_num,
2800 OPERATOR_UNARY_OR,
2801 bpof.fragment,
2802 FLOWSPEC_FRAGMENT);
2803 }
0e867886
PG
2804 bpf.vrf_id = api->vrf_id;
2805 bpf.src = src;
2806 bpf.dst = dst;
2807 bpf.protocol = proto;
0e867886
PG
2808 bpf.src_port = srcp;
2809 bpf.dst_port = dstp;
f01e580f 2810 bpf.family = afi2family(api->afi);
d90b788e
A
2811 if (!add) {
2812 bgp_pbr_policyroute_remove_from_zebra(bgp, path, &bpf, &bpof);
2813 return;
2814 }
d114b0d7
PG
2815 /* no action for add = true */
2816 for (i = 0; i < api->action_num; i++) {
2817 switch (api->actions[i].action) {
2818 case ACTION_TRAFFICRATE:
2819 /* drop packet */
2820 if (api->actions[i].u.r.rate == 0) {
2821 nh.vrf_id = api->vrf_id;
2822 nh.type = NEXTHOP_TYPE_BLACKHOLE;
9b6d8fcf
DS
2823 bgp_pbr_policyroute_add_to_zebra(
2824 bgp, path, &bpf, &bpof, &nh, &rate);
d114b0d7
PG
2825 } else {
2826 /* update rate. can be reentrant */
2827 rate = api->actions[i].u.r.rate;
ac7c35f8 2828 if (BGP_DEBUG(pbr, PBR)) {
d114b0d7 2829 bgp_pbr_print_policy_route(api);
ac7c35f8
PG
2830 zlog_warn("PBR: ignoring Set action rate %f",
2831 api->actions[i].u.r.rate);
2832 }
d114b0d7
PG
2833 }
2834 break;
2835 case ACTION_TRAFFIC_ACTION:
2836 if (api->actions[i].u.za.filter
2837 & TRAFFIC_ACTION_SAMPLE) {
ac7c35f8 2838 if (BGP_DEBUG(pbr, PBR)) {
d114b0d7 2839 bgp_pbr_print_policy_route(api);
ac7c35f8
PG
2840 zlog_warn("PBR: Sample action Ignored");
2841 }
d114b0d7 2842 }
d114b0d7
PG
2843 /* terminate action: run other filters
2844 */
2845 break;
2846 case ACTION_REDIRECT_IP:
d114b0d7 2847 nh.vrf_id = api->vrf_id;
f01e580f
PG
2848 if (api->afi == AFI_IP) {
2849 nh.type = NEXTHOP_TYPE_IPV4;
2850 nh.gate.ipv4.s_addr =
2851 api->actions[i].u.zr.
2852 redirect_ip_v4.s_addr;
2853 } else {
2854 nh.type = NEXTHOP_TYPE_IPV6;
2855 memcpy(&nh.gate.ipv6,
2856 &api->actions[i].u.zr.redirect_ip_v6,
2857 sizeof(struct in6_addr));
2858 }
9b6d8fcf 2859 bgp_pbr_policyroute_add_to_zebra(bgp, path, &bpf, &bpof,
da3fa383 2860 &nh, &rate);
d114b0d7
PG
2861 /* XXX combination with REDIRECT_VRF
2862 * + REDIRECT_NH_IP not done
2863 */
2864 continue_loop = 0;
2865 break;
2866 case ACTION_REDIRECT:
9a659715
PG
2867 if (api->afi == AFI_IP)
2868 nh.type = NEXTHOP_TYPE_IPV4;
2869 else
2870 nh.type = NEXTHOP_TYPE_IPV6;
d114b0d7 2871 nh.vrf_id = api->actions[i].u.redirect_vrf;
9b6d8fcf 2872 bgp_pbr_policyroute_add_to_zebra(bgp, path, &bpf, &bpof,
da3fa383 2873 &nh, &rate);
d114b0d7
PG
2874 continue_loop = 0;
2875 break;
2876 case ACTION_MARKING:
ac7c35f8 2877 if (BGP_DEBUG(pbr, PBR)) {
d114b0d7 2878 bgp_pbr_print_policy_route(api);
40881800 2879 zlog_warn("PBR: Set DSCP/FlowLabel %u Ignored",
ac7c35f8
PG
2880 api->actions[i].u.marking_dscp);
2881 }
d114b0d7
PG
2882 break;
2883 default:
2884 break;
2885 }
2886 if (continue_loop == 0)
2887 break;
2888 }
2889}
2890
5a1ae2c2 2891void bgp_pbr_update_entry(struct bgp *bgp, const struct prefix *p,
4b7e6066
DS
2892 struct bgp_path_info *info, afi_t afi, safi_t safi,
2893 bool nlri_update)
45918cfb
PG
2894{
2895 struct bgp_pbr_entry_main api;
2896
45918cfb
PG
2897 if (safi != SAFI_FLOWSPEC)
2898 return; /* not supported */
2899 /* Make Zebra API structure. */
2900 memset(&api, 0, sizeof(api));
2901 api.vrf_id = bgp->vrf_id;
2902 api.afi = afi;
2903
6818e7e5 2904 if (!bgp_zebra_tm_chunk_obtained()) {
f146bb54 2905 if (BGP_DEBUG(pbr, PBR_ERROR))
e50f7cfd 2906 flog_err(EC_BGP_TABLE_CHUNK,
1c50c1c0 2907 "%s: table chunk not obtained yet", __func__);
6818e7e5
PG
2908 return;
2909 }
6818e7e5
PG
2910
2911 if (bgp_pbr_build_and_validate_entry(p, info, &api) < 0) {
2912 if (BGP_DEBUG(pbr, PBR_ERROR))
e50f7cfd 2913 flog_err(EC_BGP_FLOWSPEC_INSTALLATION,
1c50c1c0
QY
2914 "%s: cancel updating entry %p in bgp pbr",
2915 __func__, info);
45918cfb
PG
2916 return;
2917 }
d114b0d7 2918 bgp_pbr_handle_entry(bgp, info, &api, nlri_update);
45918cfb 2919}
4762c213
PG
2920
2921int bgp_pbr_interface_compare(const struct bgp_pbr_interface *a,
2922 const struct bgp_pbr_interface *b)
2923{
2924 return strcmp(a->name, b->name);
2925}
2926
2927struct bgp_pbr_interface *bgp_pbr_interface_lookup(const char *name,
2928 struct bgp_pbr_interface_head *head)
2929{
2930 struct bgp_pbr_interface pbr_if;
2931
2932 strlcpy(pbr_if.name, name, sizeof(pbr_if.name));
2933 return (RB_FIND(bgp_pbr_interface_head,
2934 head, &pbr_if));
2935}
2936
2937/* this function resets to the default policy routing
2938 * go back to default status
2939 */
2940void bgp_pbr_reset(struct bgp *bgp, afi_t afi)
2941{
2942 struct bgp_pbr_config *bgp_pbr_cfg = bgp->bgp_pbr_cfg;
2943 struct bgp_pbr_interface_head *head;
2944 struct bgp_pbr_interface *pbr_if;
2945
8f242187 2946 if (!bgp_pbr_cfg)
4762c213 2947 return;
8f242187
PG
2948 if (afi == AFI_IP)
2949 head = &(bgp_pbr_cfg->ifaces_by_name_ipv4);
2950 else
2951 head = &(bgp_pbr_cfg->ifaces_by_name_ipv6);
4762c213
PG
2952 while (!RB_EMPTY(bgp_pbr_interface_head, head)) {
2953 pbr_if = RB_ROOT(bgp_pbr_interface_head, head);
2954 RB_REMOVE(bgp_pbr_interface_head, head, pbr_if);
2955 XFREE(MTYPE_TMP, pbr_if);
2956 }
2957}