1 // SPDX-License-Identifier: BSD-3-Clause OR GPL-2.0 2 /* Copyright (c) 2017-2018 Mellanox Technologies. All rights reserved */ 3 4 #include <linux/kernel.h> 5 #include <linux/slab.h> 6 #include <linux/errno.h> 7 #include <linux/list.h> 8 #include <linux/string.h> 9 #include <linux/rhashtable.h> 10 #include <linux/netdevice.h> 11 #include <linux/mutex.h> 12 #include <net/net_namespace.h> 13 #include <net/tc_act/tc_vlan.h> 14 15 #include "reg.h" 16 #include "core.h" 17 #include "resources.h" 18 #include "spectrum.h" 19 #include "core_acl_flex_keys.h" 20 #include "core_acl_flex_actions.h" 21 #include "spectrum_acl_tcam.h" 22 23 struct mlxsw_sp_acl { 24 struct mlxsw_sp *mlxsw_sp; 25 struct mlxsw_afk *afk; 26 struct mlxsw_sp_fid *dummy_fid; 27 struct rhashtable ruleset_ht; 28 struct list_head rules; 29 struct mutex rules_lock; /* Protects rules list */ 30 struct { 31 struct delayed_work dw; 32 unsigned long interval; /* ms */ 33 #define MLXSW_SP_ACL_RULE_ACTIVITY_UPDATE_PERIOD_MS 1000 34 } rule_activity_update; 35 struct mlxsw_sp_acl_tcam tcam; 36 }; 37 38 struct mlxsw_afk *mlxsw_sp_acl_afk(struct mlxsw_sp_acl *acl) 39 { 40 return acl->afk; 41 } 42 43 struct mlxsw_sp_acl_block_binding { 44 struct list_head list; 45 struct net_device *dev; 46 struct mlxsw_sp_port *mlxsw_sp_port; 47 bool ingress; 48 }; 49 50 struct mlxsw_sp_acl_ruleset_ht_key { 51 struct mlxsw_sp_acl_block *block; 52 u32 chain_index; 53 const struct mlxsw_sp_acl_profile_ops *ops; 54 }; 55 56 struct mlxsw_sp_acl_ruleset { 57 struct rhash_head ht_node; /* Member of acl HT */ 58 struct mlxsw_sp_acl_ruleset_ht_key ht_key; 59 struct rhashtable rule_ht; 60 unsigned int ref_count; 61 unsigned long priv[]; 62 /* priv has to be always the last item */ 63 }; 64 65 struct mlxsw_sp_acl_rule { 66 struct rhash_head ht_node; /* Member of rule HT */ 67 struct list_head list; 68 unsigned long cookie; /* HT key */ 69 struct mlxsw_sp_acl_ruleset *ruleset; 70 struct mlxsw_sp_acl_rule_info *rulei; 71 u64 last_used; 72 u64 last_packets; 73 u64 last_bytes; 74 unsigned long priv[]; 75 /* priv has to be always the last item */ 76 }; 77 78 static const struct rhashtable_params mlxsw_sp_acl_ruleset_ht_params = { 79 .key_len = sizeof(struct mlxsw_sp_acl_ruleset_ht_key), 80 .key_offset = offsetof(struct mlxsw_sp_acl_ruleset, ht_key), 81 .head_offset = offsetof(struct mlxsw_sp_acl_ruleset, ht_node), 82 .automatic_shrinking = true, 83 }; 84 85 static const struct rhashtable_params mlxsw_sp_acl_rule_ht_params = { 86 .key_len = sizeof(unsigned long), 87 .key_offset = offsetof(struct mlxsw_sp_acl_rule, cookie), 88 .head_offset = offsetof(struct mlxsw_sp_acl_rule, ht_node), 89 .automatic_shrinking = true, 90 }; 91 92 struct mlxsw_sp_fid *mlxsw_sp_acl_dummy_fid(struct mlxsw_sp *mlxsw_sp) 93 { 94 return mlxsw_sp->acl->dummy_fid; 95 } 96 97 struct mlxsw_sp *mlxsw_sp_acl_block_mlxsw_sp(struct mlxsw_sp_acl_block *block) 98 { 99 return block->mlxsw_sp; 100 } 101 102 unsigned int 103 mlxsw_sp_acl_block_rule_count(const struct mlxsw_sp_acl_block *block) 104 { 105 return block ? block->rule_count : 0; 106 } 107 108 void mlxsw_sp_acl_block_disable_inc(struct mlxsw_sp_acl_block *block) 109 { 110 if (block) 111 block->disable_count++; 112 } 113 114 void mlxsw_sp_acl_block_disable_dec(struct mlxsw_sp_acl_block *block) 115 { 116 if (block) 117 block->disable_count--; 118 } 119 120 bool mlxsw_sp_acl_block_disabled(const struct mlxsw_sp_acl_block *block) 121 { 122 return block->disable_count; 123 } 124 125 bool mlxsw_sp_acl_block_is_egress_bound(const struct mlxsw_sp_acl_block *block) 126 { 127 return block->egress_binding_count; 128 } 129 130 bool mlxsw_sp_acl_block_is_ingress_bound(const struct mlxsw_sp_acl_block *block) 131 { 132 return block->ingress_binding_count; 133 } 134 135 bool mlxsw_sp_acl_block_is_mixed_bound(const struct mlxsw_sp_acl_block *block) 136 { 137 return block->ingress_binding_count && block->egress_binding_count; 138 } 139 140 static bool 141 mlxsw_sp_acl_ruleset_is_singular(const struct mlxsw_sp_acl_ruleset *ruleset) 142 { 143 /* We hold a reference on ruleset ourselves */ 144 return ruleset->ref_count == 2; 145 } 146 147 static int 148 mlxsw_sp_acl_ruleset_bind(struct mlxsw_sp *mlxsw_sp, 149 struct mlxsw_sp_acl_block *block, 150 struct mlxsw_sp_acl_block_binding *binding) 151 { 152 struct mlxsw_sp_acl_ruleset *ruleset = block->ruleset_zero; 153 const struct mlxsw_sp_acl_profile_ops *ops = ruleset->ht_key.ops; 154 155 return ops->ruleset_bind(mlxsw_sp, ruleset->priv, 156 binding->mlxsw_sp_port, binding->ingress); 157 } 158 159 static void 160 mlxsw_sp_acl_ruleset_unbind(struct mlxsw_sp *mlxsw_sp, 161 struct mlxsw_sp_acl_block *block, 162 struct mlxsw_sp_acl_block_binding *binding) 163 { 164 struct mlxsw_sp_acl_ruleset *ruleset = block->ruleset_zero; 165 const struct mlxsw_sp_acl_profile_ops *ops = ruleset->ht_key.ops; 166 167 ops->ruleset_unbind(mlxsw_sp, ruleset->priv, 168 binding->mlxsw_sp_port, binding->ingress); 169 } 170 171 static bool 172 mlxsw_sp_acl_ruleset_block_bound(const struct mlxsw_sp_acl_block *block) 173 { 174 return block->ruleset_zero; 175 } 176 177 static int 178 mlxsw_sp_acl_ruleset_block_bind(struct mlxsw_sp *mlxsw_sp, 179 struct mlxsw_sp_acl_ruleset *ruleset, 180 struct mlxsw_sp_acl_block *block) 181 { 182 struct mlxsw_sp_acl_block_binding *binding; 183 int err; 184 185 block->ruleset_zero = ruleset; 186 list_for_each_entry(binding, &block->binding_list, list) { 187 err = mlxsw_sp_acl_ruleset_bind(mlxsw_sp, block, binding); 188 if (err) 189 goto rollback; 190 } 191 return 0; 192 193 rollback: 194 list_for_each_entry_continue_reverse(binding, &block->binding_list, 195 list) 196 mlxsw_sp_acl_ruleset_unbind(mlxsw_sp, block, binding); 197 block->ruleset_zero = NULL; 198 199 return err; 200 } 201 202 static void 203 mlxsw_sp_acl_ruleset_block_unbind(struct mlxsw_sp *mlxsw_sp, 204 struct mlxsw_sp_acl_ruleset *ruleset, 205 struct mlxsw_sp_acl_block *block) 206 { 207 struct mlxsw_sp_acl_block_binding *binding; 208 209 list_for_each_entry(binding, &block->binding_list, list) 210 mlxsw_sp_acl_ruleset_unbind(mlxsw_sp, block, binding); 211 block->ruleset_zero = NULL; 212 } 213 214 struct mlxsw_sp_acl_block *mlxsw_sp_acl_block_create(struct mlxsw_sp *mlxsw_sp, 215 struct net *net) 216 { 217 struct mlxsw_sp_acl_block *block; 218 219 block = kzalloc(sizeof(*block), GFP_KERNEL); 220 if (!block) 221 return NULL; 222 INIT_LIST_HEAD(&block->binding_list); 223 block->mlxsw_sp = mlxsw_sp; 224 block->net = net; 225 return block; 226 } 227 228 void mlxsw_sp_acl_block_destroy(struct mlxsw_sp_acl_block *block) 229 { 230 WARN_ON(!list_empty(&block->binding_list)); 231 kfree(block); 232 } 233 234 static struct mlxsw_sp_acl_block_binding * 235 mlxsw_sp_acl_block_lookup(struct mlxsw_sp_acl_block *block, 236 struct mlxsw_sp_port *mlxsw_sp_port, bool ingress) 237 { 238 struct mlxsw_sp_acl_block_binding *binding; 239 240 list_for_each_entry(binding, &block->binding_list, list) 241 if (binding->mlxsw_sp_port == mlxsw_sp_port && 242 binding->ingress == ingress) 243 return binding; 244 return NULL; 245 } 246 247 int mlxsw_sp_acl_block_bind(struct mlxsw_sp *mlxsw_sp, 248 struct mlxsw_sp_acl_block *block, 249 struct mlxsw_sp_port *mlxsw_sp_port, 250 bool ingress, 251 struct netlink_ext_ack *extack) 252 { 253 struct mlxsw_sp_acl_block_binding *binding; 254 int err; 255 256 if (WARN_ON(mlxsw_sp_acl_block_lookup(block, mlxsw_sp_port, ingress))) 257 return -EEXIST; 258 259 if (ingress && block->ingress_blocker_rule_count) { 260 NL_SET_ERR_MSG_MOD(extack, "Block cannot be bound to ingress because it contains unsupported rules"); 261 return -EOPNOTSUPP; 262 } 263 264 if (!ingress && block->egress_blocker_rule_count) { 265 NL_SET_ERR_MSG_MOD(extack, "Block cannot be bound to egress because it contains unsupported rules"); 266 return -EOPNOTSUPP; 267 } 268 269 binding = kzalloc(sizeof(*binding), GFP_KERNEL); 270 if (!binding) 271 return -ENOMEM; 272 binding->mlxsw_sp_port = mlxsw_sp_port; 273 binding->ingress = ingress; 274 275 if (mlxsw_sp_acl_ruleset_block_bound(block)) { 276 err = mlxsw_sp_acl_ruleset_bind(mlxsw_sp, block, binding); 277 if (err) 278 goto err_ruleset_bind; 279 } 280 281 if (ingress) 282 block->ingress_binding_count++; 283 else 284 block->egress_binding_count++; 285 list_add(&binding->list, &block->binding_list); 286 return 0; 287 288 err_ruleset_bind: 289 kfree(binding); 290 return err; 291 } 292 293 int mlxsw_sp_acl_block_unbind(struct mlxsw_sp *mlxsw_sp, 294 struct mlxsw_sp_acl_block *block, 295 struct mlxsw_sp_port *mlxsw_sp_port, 296 bool ingress) 297 { 298 struct mlxsw_sp_acl_block_binding *binding; 299 300 binding = mlxsw_sp_acl_block_lookup(block, mlxsw_sp_port, ingress); 301 if (!binding) 302 return -ENOENT; 303 304 list_del(&binding->list); 305 306 if (ingress) 307 block->ingress_binding_count--; 308 else 309 block->egress_binding_count--; 310 311 if (mlxsw_sp_acl_ruleset_block_bound(block)) 312 mlxsw_sp_acl_ruleset_unbind(mlxsw_sp, block, binding); 313 314 kfree(binding); 315 return 0; 316 } 317 318 static struct mlxsw_sp_acl_ruleset * 319 mlxsw_sp_acl_ruleset_create(struct mlxsw_sp *mlxsw_sp, 320 struct mlxsw_sp_acl_block *block, u32 chain_index, 321 const struct mlxsw_sp_acl_profile_ops *ops, 322 struct mlxsw_afk_element_usage *tmplt_elusage) 323 { 324 struct mlxsw_sp_acl *acl = mlxsw_sp->acl; 325 struct mlxsw_sp_acl_ruleset *ruleset; 326 size_t alloc_size; 327 int err; 328 329 alloc_size = sizeof(*ruleset) + ops->ruleset_priv_size; 330 ruleset = kzalloc(alloc_size, GFP_KERNEL); 331 if (!ruleset) 332 return ERR_PTR(-ENOMEM); 333 ruleset->ref_count = 1; 334 ruleset->ht_key.block = block; 335 ruleset->ht_key.chain_index = chain_index; 336 ruleset->ht_key.ops = ops; 337 338 err = rhashtable_init(&ruleset->rule_ht, &mlxsw_sp_acl_rule_ht_params); 339 if (err) 340 goto err_rhashtable_init; 341 342 err = ops->ruleset_add(mlxsw_sp, &acl->tcam, ruleset->priv, 343 tmplt_elusage); 344 if (err) 345 goto err_ops_ruleset_add; 346 347 err = rhashtable_insert_fast(&acl->ruleset_ht, &ruleset->ht_node, 348 mlxsw_sp_acl_ruleset_ht_params); 349 if (err) 350 goto err_ht_insert; 351 352 return ruleset; 353 354 err_ht_insert: 355 ops->ruleset_del(mlxsw_sp, ruleset->priv); 356 err_ops_ruleset_add: 357 rhashtable_destroy(&ruleset->rule_ht); 358 err_rhashtable_init: 359 kfree(ruleset); 360 return ERR_PTR(err); 361 } 362 363 static void mlxsw_sp_acl_ruleset_destroy(struct mlxsw_sp *mlxsw_sp, 364 struct mlxsw_sp_acl_ruleset *ruleset) 365 { 366 const struct mlxsw_sp_acl_profile_ops *ops = ruleset->ht_key.ops; 367 struct mlxsw_sp_acl *acl = mlxsw_sp->acl; 368 369 rhashtable_remove_fast(&acl->ruleset_ht, &ruleset->ht_node, 370 mlxsw_sp_acl_ruleset_ht_params); 371 ops->ruleset_del(mlxsw_sp, ruleset->priv); 372 rhashtable_destroy(&ruleset->rule_ht); 373 kfree(ruleset); 374 } 375 376 static void mlxsw_sp_acl_ruleset_ref_inc(struct mlxsw_sp_acl_ruleset *ruleset) 377 { 378 ruleset->ref_count++; 379 } 380 381 static void mlxsw_sp_acl_ruleset_ref_dec(struct mlxsw_sp *mlxsw_sp, 382 struct mlxsw_sp_acl_ruleset *ruleset) 383 { 384 if (--ruleset->ref_count) 385 return; 386 mlxsw_sp_acl_ruleset_destroy(mlxsw_sp, ruleset); 387 } 388 389 static struct mlxsw_sp_acl_ruleset * 390 __mlxsw_sp_acl_ruleset_lookup(struct mlxsw_sp_acl *acl, 391 struct mlxsw_sp_acl_block *block, u32 chain_index, 392 const struct mlxsw_sp_acl_profile_ops *ops) 393 { 394 struct mlxsw_sp_acl_ruleset_ht_key ht_key; 395 396 memset(&ht_key, 0, sizeof(ht_key)); 397 ht_key.block = block; 398 ht_key.chain_index = chain_index; 399 ht_key.ops = ops; 400 return rhashtable_lookup_fast(&acl->ruleset_ht, &ht_key, 401 mlxsw_sp_acl_ruleset_ht_params); 402 } 403 404 struct mlxsw_sp_acl_ruleset * 405 mlxsw_sp_acl_ruleset_lookup(struct mlxsw_sp *mlxsw_sp, 406 struct mlxsw_sp_acl_block *block, u32 chain_index, 407 enum mlxsw_sp_acl_profile profile) 408 { 409 const struct mlxsw_sp_acl_profile_ops *ops; 410 struct mlxsw_sp_acl *acl = mlxsw_sp->acl; 411 struct mlxsw_sp_acl_ruleset *ruleset; 412 413 ops = mlxsw_sp_acl_tcam_profile_ops(mlxsw_sp, profile); 414 if (!ops) 415 return ERR_PTR(-EINVAL); 416 ruleset = __mlxsw_sp_acl_ruleset_lookup(acl, block, chain_index, ops); 417 if (!ruleset) 418 return ERR_PTR(-ENOENT); 419 return ruleset; 420 } 421 422 struct mlxsw_sp_acl_ruleset * 423 mlxsw_sp_acl_ruleset_get(struct mlxsw_sp *mlxsw_sp, 424 struct mlxsw_sp_acl_block *block, u32 chain_index, 425 enum mlxsw_sp_acl_profile profile, 426 struct mlxsw_afk_element_usage *tmplt_elusage) 427 { 428 const struct mlxsw_sp_acl_profile_ops *ops; 429 struct mlxsw_sp_acl *acl = mlxsw_sp->acl; 430 struct mlxsw_sp_acl_ruleset *ruleset; 431 432 ops = mlxsw_sp_acl_tcam_profile_ops(mlxsw_sp, profile); 433 if (!ops) 434 return ERR_PTR(-EINVAL); 435 436 ruleset = __mlxsw_sp_acl_ruleset_lookup(acl, block, chain_index, ops); 437 if (ruleset) { 438 mlxsw_sp_acl_ruleset_ref_inc(ruleset); 439 return ruleset; 440 } 441 return mlxsw_sp_acl_ruleset_create(mlxsw_sp, block, chain_index, ops, 442 tmplt_elusage); 443 } 444 445 void mlxsw_sp_acl_ruleset_put(struct mlxsw_sp *mlxsw_sp, 446 struct mlxsw_sp_acl_ruleset *ruleset) 447 { 448 mlxsw_sp_acl_ruleset_ref_dec(mlxsw_sp, ruleset); 449 } 450 451 u16 mlxsw_sp_acl_ruleset_group_id(struct mlxsw_sp_acl_ruleset *ruleset) 452 { 453 const struct mlxsw_sp_acl_profile_ops *ops = ruleset->ht_key.ops; 454 455 return ops->ruleset_group_id(ruleset->priv); 456 } 457 458 struct mlxsw_sp_acl_rule_info * 459 mlxsw_sp_acl_rulei_create(struct mlxsw_sp_acl *acl, 460 struct mlxsw_afa_block *afa_block) 461 { 462 struct mlxsw_sp_acl_rule_info *rulei; 463 int err; 464 465 rulei = kzalloc(sizeof(*rulei), GFP_KERNEL); 466 if (!rulei) 467 return NULL; 468 469 if (afa_block) { 470 rulei->act_block = afa_block; 471 return rulei; 472 } 473 474 rulei->act_block = mlxsw_afa_block_create(acl->mlxsw_sp->afa); 475 if (IS_ERR(rulei->act_block)) { 476 err = PTR_ERR(rulei->act_block); 477 goto err_afa_block_create; 478 } 479 rulei->action_created = 1; 480 return rulei; 481 482 err_afa_block_create: 483 kfree(rulei); 484 return ERR_PTR(err); 485 } 486 487 void mlxsw_sp_acl_rulei_destroy(struct mlxsw_sp_acl_rule_info *rulei) 488 { 489 if (rulei->action_created) 490 mlxsw_afa_block_destroy(rulei->act_block); 491 kfree(rulei); 492 } 493 494 int mlxsw_sp_acl_rulei_commit(struct mlxsw_sp_acl_rule_info *rulei) 495 { 496 return mlxsw_afa_block_commit(rulei->act_block); 497 } 498 499 void mlxsw_sp_acl_rulei_priority(struct mlxsw_sp_acl_rule_info *rulei, 500 unsigned int priority) 501 { 502 rulei->priority = priority; 503 } 504 505 void mlxsw_sp_acl_rulei_keymask_u32(struct mlxsw_sp_acl_rule_info *rulei, 506 enum mlxsw_afk_element element, 507 u32 key_value, u32 mask_value) 508 { 509 mlxsw_afk_values_add_u32(&rulei->values, element, 510 key_value, mask_value); 511 } 512 513 void mlxsw_sp_acl_rulei_keymask_buf(struct mlxsw_sp_acl_rule_info *rulei, 514 enum mlxsw_afk_element element, 515 const char *key_value, 516 const char *mask_value, unsigned int len) 517 { 518 mlxsw_afk_values_add_buf(&rulei->values, element, 519 key_value, mask_value, len); 520 } 521 522 int mlxsw_sp_acl_rulei_act_continue(struct mlxsw_sp_acl_rule_info *rulei) 523 { 524 return mlxsw_afa_block_continue(rulei->act_block); 525 } 526 527 int mlxsw_sp_acl_rulei_act_jump(struct mlxsw_sp_acl_rule_info *rulei, 528 u16 group_id) 529 { 530 return mlxsw_afa_block_jump(rulei->act_block, group_id); 531 } 532 533 int mlxsw_sp_acl_rulei_act_terminate(struct mlxsw_sp_acl_rule_info *rulei) 534 { 535 return mlxsw_afa_block_terminate(rulei->act_block); 536 } 537 538 int mlxsw_sp_acl_rulei_act_drop(struct mlxsw_sp_acl_rule_info *rulei, 539 bool ingress, 540 const struct flow_action_cookie *fa_cookie, 541 struct netlink_ext_ack *extack) 542 { 543 return mlxsw_afa_block_append_drop(rulei->act_block, ingress, 544 fa_cookie, extack); 545 } 546 547 int mlxsw_sp_acl_rulei_act_trap(struct mlxsw_sp_acl_rule_info *rulei) 548 { 549 return mlxsw_afa_block_append_trap(rulei->act_block, 550 MLXSW_TRAP_ID_ACL0); 551 } 552 553 int mlxsw_sp_acl_rulei_act_fwd(struct mlxsw_sp *mlxsw_sp, 554 struct mlxsw_sp_acl_rule_info *rulei, 555 struct net_device *out_dev, 556 struct netlink_ext_ack *extack) 557 { 558 struct mlxsw_sp_port *mlxsw_sp_port; 559 u8 local_port; 560 bool in_port; 561 562 if (out_dev) { 563 if (!mlxsw_sp_port_dev_check(out_dev)) { 564 NL_SET_ERR_MSG_MOD(extack, "Invalid output device"); 565 return -EINVAL; 566 } 567 mlxsw_sp_port = netdev_priv(out_dev); 568 if (mlxsw_sp_port->mlxsw_sp != mlxsw_sp) { 569 NL_SET_ERR_MSG_MOD(extack, "Invalid output device"); 570 return -EINVAL; 571 } 572 local_port = mlxsw_sp_port->local_port; 573 in_port = false; 574 } else { 575 /* If out_dev is NULL, the caller wants to 576 * set forward to ingress port. 577 */ 578 local_port = 0; 579 in_port = true; 580 } 581 return mlxsw_afa_block_append_fwd(rulei->act_block, 582 local_port, in_port, extack); 583 } 584 585 int mlxsw_sp_acl_rulei_act_mirror(struct mlxsw_sp *mlxsw_sp, 586 struct mlxsw_sp_acl_rule_info *rulei, 587 struct mlxsw_sp_acl_block *block, 588 struct net_device *out_dev, 589 struct netlink_ext_ack *extack) 590 { 591 struct mlxsw_sp_acl_block_binding *binding; 592 struct mlxsw_sp_port *in_port; 593 594 if (!list_is_singular(&block->binding_list)) { 595 NL_SET_ERR_MSG_MOD(extack, "Only a single mirror source is allowed"); 596 return -EOPNOTSUPP; 597 } 598 binding = list_first_entry(&block->binding_list, 599 struct mlxsw_sp_acl_block_binding, list); 600 in_port = binding->mlxsw_sp_port; 601 602 return mlxsw_afa_block_append_mirror(rulei->act_block, 603 in_port->local_port, 604 out_dev, 605 binding->ingress, 606 extack); 607 } 608 609 int mlxsw_sp_acl_rulei_act_vlan(struct mlxsw_sp *mlxsw_sp, 610 struct mlxsw_sp_acl_rule_info *rulei, 611 u32 action, u16 vid, u16 proto, u8 prio, 612 struct netlink_ext_ack *extack) 613 { 614 u8 ethertype; 615 616 if (action == FLOW_ACTION_VLAN_MANGLE) { 617 switch (proto) { 618 case ETH_P_8021Q: 619 ethertype = 0; 620 break; 621 case ETH_P_8021AD: 622 ethertype = 1; 623 break; 624 default: 625 NL_SET_ERR_MSG_MOD(extack, "Unsupported VLAN protocol"); 626 dev_err(mlxsw_sp->bus_info->dev, "Unsupported VLAN protocol %#04x\n", 627 proto); 628 return -EINVAL; 629 } 630 631 return mlxsw_afa_block_append_vlan_modify(rulei->act_block, 632 vid, prio, ethertype, 633 extack); 634 } else { 635 NL_SET_ERR_MSG_MOD(extack, "Unsupported VLAN action"); 636 dev_err(mlxsw_sp->bus_info->dev, "Unsupported VLAN action\n"); 637 return -EINVAL; 638 } 639 } 640 641 int mlxsw_sp_acl_rulei_act_count(struct mlxsw_sp *mlxsw_sp, 642 struct mlxsw_sp_acl_rule_info *rulei, 643 struct netlink_ext_ack *extack) 644 { 645 int err; 646 647 err = mlxsw_afa_block_append_counter(rulei->act_block, 648 &rulei->counter_index, extack); 649 if (err) 650 return err; 651 rulei->counter_valid = true; 652 return 0; 653 } 654 655 int mlxsw_sp_acl_rulei_act_fid_set(struct mlxsw_sp *mlxsw_sp, 656 struct mlxsw_sp_acl_rule_info *rulei, 657 u16 fid, struct netlink_ext_ack *extack) 658 { 659 return mlxsw_afa_block_append_fid_set(rulei->act_block, fid, extack); 660 } 661 662 struct mlxsw_sp_acl_rule * 663 mlxsw_sp_acl_rule_create(struct mlxsw_sp *mlxsw_sp, 664 struct mlxsw_sp_acl_ruleset *ruleset, 665 unsigned long cookie, 666 struct mlxsw_afa_block *afa_block, 667 struct netlink_ext_ack *extack) 668 { 669 const struct mlxsw_sp_acl_profile_ops *ops = ruleset->ht_key.ops; 670 struct mlxsw_sp_acl_rule *rule; 671 int err; 672 673 mlxsw_sp_acl_ruleset_ref_inc(ruleset); 674 rule = kzalloc(sizeof(*rule) + ops->rule_priv_size, 675 GFP_KERNEL); 676 if (!rule) { 677 err = -ENOMEM; 678 goto err_alloc; 679 } 680 rule->cookie = cookie; 681 rule->ruleset = ruleset; 682 683 rule->rulei = mlxsw_sp_acl_rulei_create(mlxsw_sp->acl, afa_block); 684 if (IS_ERR(rule->rulei)) { 685 err = PTR_ERR(rule->rulei); 686 goto err_rulei_create; 687 } 688 689 return rule; 690 691 err_rulei_create: 692 kfree(rule); 693 err_alloc: 694 mlxsw_sp_acl_ruleset_ref_dec(mlxsw_sp, ruleset); 695 return ERR_PTR(err); 696 } 697 698 void mlxsw_sp_acl_rule_destroy(struct mlxsw_sp *mlxsw_sp, 699 struct mlxsw_sp_acl_rule *rule) 700 { 701 struct mlxsw_sp_acl_ruleset *ruleset = rule->ruleset; 702 703 mlxsw_sp_acl_rulei_destroy(rule->rulei); 704 kfree(rule); 705 mlxsw_sp_acl_ruleset_ref_dec(mlxsw_sp, ruleset); 706 } 707 708 int mlxsw_sp_acl_rule_add(struct mlxsw_sp *mlxsw_sp, 709 struct mlxsw_sp_acl_rule *rule) 710 { 711 struct mlxsw_sp_acl_ruleset *ruleset = rule->ruleset; 712 const struct mlxsw_sp_acl_profile_ops *ops = ruleset->ht_key.ops; 713 struct mlxsw_sp_acl_block *block = ruleset->ht_key.block; 714 int err; 715 716 err = ops->rule_add(mlxsw_sp, ruleset->priv, rule->priv, rule->rulei); 717 if (err) 718 return err; 719 720 err = rhashtable_insert_fast(&ruleset->rule_ht, &rule->ht_node, 721 mlxsw_sp_acl_rule_ht_params); 722 if (err) 723 goto err_rhashtable_insert; 724 725 if (!ruleset->ht_key.chain_index && 726 mlxsw_sp_acl_ruleset_is_singular(ruleset)) { 727 /* We only need ruleset with chain index 0, the implicit 728 * one, to be directly bound to device. The rest of the 729 * rulesets are bound by "Goto action set". 730 */ 731 err = mlxsw_sp_acl_ruleset_block_bind(mlxsw_sp, ruleset, block); 732 if (err) 733 goto err_ruleset_block_bind; 734 } 735 736 mutex_lock(&mlxsw_sp->acl->rules_lock); 737 list_add_tail(&rule->list, &mlxsw_sp->acl->rules); 738 mutex_unlock(&mlxsw_sp->acl->rules_lock); 739 block->rule_count++; 740 block->ingress_blocker_rule_count += rule->rulei->ingress_bind_blocker; 741 block->egress_blocker_rule_count += rule->rulei->egress_bind_blocker; 742 return 0; 743 744 err_ruleset_block_bind: 745 rhashtable_remove_fast(&ruleset->rule_ht, &rule->ht_node, 746 mlxsw_sp_acl_rule_ht_params); 747 err_rhashtable_insert: 748 ops->rule_del(mlxsw_sp, rule->priv); 749 return err; 750 } 751 752 void mlxsw_sp_acl_rule_del(struct mlxsw_sp *mlxsw_sp, 753 struct mlxsw_sp_acl_rule *rule) 754 { 755 struct mlxsw_sp_acl_ruleset *ruleset = rule->ruleset; 756 const struct mlxsw_sp_acl_profile_ops *ops = ruleset->ht_key.ops; 757 struct mlxsw_sp_acl_block *block = ruleset->ht_key.block; 758 759 block->egress_blocker_rule_count -= rule->rulei->egress_bind_blocker; 760 block->ingress_blocker_rule_count -= rule->rulei->ingress_bind_blocker; 761 ruleset->ht_key.block->rule_count--; 762 mutex_lock(&mlxsw_sp->acl->rules_lock); 763 list_del(&rule->list); 764 mutex_unlock(&mlxsw_sp->acl->rules_lock); 765 if (!ruleset->ht_key.chain_index && 766 mlxsw_sp_acl_ruleset_is_singular(ruleset)) 767 mlxsw_sp_acl_ruleset_block_unbind(mlxsw_sp, ruleset, 768 ruleset->ht_key.block); 769 rhashtable_remove_fast(&ruleset->rule_ht, &rule->ht_node, 770 mlxsw_sp_acl_rule_ht_params); 771 ops->rule_del(mlxsw_sp, rule->priv); 772 } 773 774 int mlxsw_sp_acl_rule_action_replace(struct mlxsw_sp *mlxsw_sp, 775 struct mlxsw_sp_acl_rule *rule, 776 struct mlxsw_afa_block *afa_block) 777 { 778 struct mlxsw_sp_acl_ruleset *ruleset = rule->ruleset; 779 const struct mlxsw_sp_acl_profile_ops *ops = ruleset->ht_key.ops; 780 struct mlxsw_sp_acl_rule_info *rulei; 781 782 rulei = mlxsw_sp_acl_rule_rulei(rule); 783 rulei->act_block = afa_block; 784 785 return ops->rule_action_replace(mlxsw_sp, rule->priv, rule->rulei); 786 } 787 788 struct mlxsw_sp_acl_rule * 789 mlxsw_sp_acl_rule_lookup(struct mlxsw_sp *mlxsw_sp, 790 struct mlxsw_sp_acl_ruleset *ruleset, 791 unsigned long cookie) 792 { 793 return rhashtable_lookup_fast(&ruleset->rule_ht, &cookie, 794 mlxsw_sp_acl_rule_ht_params); 795 } 796 797 struct mlxsw_sp_acl_rule_info * 798 mlxsw_sp_acl_rule_rulei(struct mlxsw_sp_acl_rule *rule) 799 { 800 return rule->rulei; 801 } 802 803 static int mlxsw_sp_acl_rule_activity_update(struct mlxsw_sp *mlxsw_sp, 804 struct mlxsw_sp_acl_rule *rule) 805 { 806 struct mlxsw_sp_acl_ruleset *ruleset = rule->ruleset; 807 const struct mlxsw_sp_acl_profile_ops *ops = ruleset->ht_key.ops; 808 bool active; 809 int err; 810 811 err = ops->rule_activity_get(mlxsw_sp, rule->priv, &active); 812 if (err) 813 return err; 814 if (active) 815 rule->last_used = jiffies; 816 return 0; 817 } 818 819 static int mlxsw_sp_acl_rules_activity_update(struct mlxsw_sp_acl *acl) 820 { 821 struct mlxsw_sp_acl_rule *rule; 822 int err; 823 824 mutex_lock(&acl->rules_lock); 825 list_for_each_entry(rule, &acl->rules, list) { 826 err = mlxsw_sp_acl_rule_activity_update(acl->mlxsw_sp, 827 rule); 828 if (err) 829 goto err_rule_update; 830 } 831 mutex_unlock(&acl->rules_lock); 832 return 0; 833 834 err_rule_update: 835 mutex_unlock(&acl->rules_lock); 836 return err; 837 } 838 839 static void mlxsw_sp_acl_rule_activity_work_schedule(struct mlxsw_sp_acl *acl) 840 { 841 unsigned long interval = acl->rule_activity_update.interval; 842 843 mlxsw_core_schedule_dw(&acl->rule_activity_update.dw, 844 msecs_to_jiffies(interval)); 845 } 846 847 static void mlxsw_sp_acl_rule_activity_update_work(struct work_struct *work) 848 { 849 struct mlxsw_sp_acl *acl = container_of(work, struct mlxsw_sp_acl, 850 rule_activity_update.dw.work); 851 int err; 852 853 err = mlxsw_sp_acl_rules_activity_update(acl); 854 if (err) 855 dev_err(acl->mlxsw_sp->bus_info->dev, "Could not update acl activity"); 856 857 mlxsw_sp_acl_rule_activity_work_schedule(acl); 858 } 859 860 int mlxsw_sp_acl_rule_get_stats(struct mlxsw_sp *mlxsw_sp, 861 struct mlxsw_sp_acl_rule *rule, 862 u64 *packets, u64 *bytes, u64 *last_use) 863 864 { 865 struct mlxsw_sp_acl_rule_info *rulei; 866 u64 current_packets = 0; 867 u64 current_bytes = 0; 868 int err; 869 870 rulei = mlxsw_sp_acl_rule_rulei(rule); 871 if (rulei->counter_valid) { 872 err = mlxsw_sp_flow_counter_get(mlxsw_sp, rulei->counter_index, 873 ¤t_packets, 874 ¤t_bytes); 875 if (err) 876 return err; 877 } 878 *packets = current_packets - rule->last_packets; 879 *bytes = current_bytes - rule->last_bytes; 880 *last_use = rule->last_used; 881 882 rule->last_bytes = current_bytes; 883 rule->last_packets = current_packets; 884 885 return 0; 886 } 887 888 int mlxsw_sp_acl_init(struct mlxsw_sp *mlxsw_sp) 889 { 890 struct mlxsw_sp_fid *fid; 891 struct mlxsw_sp_acl *acl; 892 size_t alloc_size; 893 int err; 894 895 alloc_size = sizeof(*acl) + mlxsw_sp_acl_tcam_priv_size(mlxsw_sp); 896 acl = kzalloc(alloc_size, GFP_KERNEL); 897 if (!acl) 898 return -ENOMEM; 899 mlxsw_sp->acl = acl; 900 acl->mlxsw_sp = mlxsw_sp; 901 acl->afk = mlxsw_afk_create(MLXSW_CORE_RES_GET(mlxsw_sp->core, 902 ACL_FLEX_KEYS), 903 mlxsw_sp->afk_ops); 904 if (!acl->afk) { 905 err = -ENOMEM; 906 goto err_afk_create; 907 } 908 909 err = rhashtable_init(&acl->ruleset_ht, 910 &mlxsw_sp_acl_ruleset_ht_params); 911 if (err) 912 goto err_rhashtable_init; 913 914 fid = mlxsw_sp_fid_dummy_get(mlxsw_sp); 915 if (IS_ERR(fid)) { 916 err = PTR_ERR(fid); 917 goto err_fid_get; 918 } 919 acl->dummy_fid = fid; 920 921 INIT_LIST_HEAD(&acl->rules); 922 mutex_init(&acl->rules_lock); 923 err = mlxsw_sp_acl_tcam_init(mlxsw_sp, &acl->tcam); 924 if (err) 925 goto err_acl_ops_init; 926 927 /* Create the delayed work for the rule activity_update */ 928 INIT_DELAYED_WORK(&acl->rule_activity_update.dw, 929 mlxsw_sp_acl_rule_activity_update_work); 930 acl->rule_activity_update.interval = MLXSW_SP_ACL_RULE_ACTIVITY_UPDATE_PERIOD_MS; 931 mlxsw_core_schedule_dw(&acl->rule_activity_update.dw, 0); 932 return 0; 933 934 err_acl_ops_init: 935 mutex_destroy(&acl->rules_lock); 936 mlxsw_sp_fid_put(fid); 937 err_fid_get: 938 rhashtable_destroy(&acl->ruleset_ht); 939 err_rhashtable_init: 940 mlxsw_afk_destroy(acl->afk); 941 err_afk_create: 942 kfree(acl); 943 return err; 944 } 945 946 void mlxsw_sp_acl_fini(struct mlxsw_sp *mlxsw_sp) 947 { 948 struct mlxsw_sp_acl *acl = mlxsw_sp->acl; 949 950 cancel_delayed_work_sync(&mlxsw_sp->acl->rule_activity_update.dw); 951 mlxsw_sp_acl_tcam_fini(mlxsw_sp, &acl->tcam); 952 mutex_destroy(&acl->rules_lock); 953 WARN_ON(!list_empty(&acl->rules)); 954 mlxsw_sp_fid_put(acl->dummy_fid); 955 rhashtable_destroy(&acl->ruleset_ht); 956 mlxsw_afk_destroy(acl->afk); 957 kfree(acl); 958 } 959 960 u32 mlxsw_sp_acl_region_rehash_intrvl_get(struct mlxsw_sp *mlxsw_sp) 961 { 962 struct mlxsw_sp_acl *acl = mlxsw_sp->acl; 963 964 return mlxsw_sp_acl_tcam_vregion_rehash_intrvl_get(mlxsw_sp, 965 &acl->tcam); 966 } 967 968 int mlxsw_sp_acl_region_rehash_intrvl_set(struct mlxsw_sp *mlxsw_sp, u32 val) 969 { 970 struct mlxsw_sp_acl *acl = mlxsw_sp->acl; 971 972 return mlxsw_sp_acl_tcam_vregion_rehash_intrvl_set(mlxsw_sp, 973 &acl->tcam, val); 974 } 975