1784 lines · c
1/*2 * Copyright (c) 2018 Cumulus Networks. All rights reserved.3 * Copyright (c) 2018 David Ahern <dsa@cumulusnetworks.com>4 * Copyright (c) 2019 Mellanox Technologies. All rights reserved.5 *6 * This software is licensed under the GNU General License Version 2,7 * June 1991 as shown in the file COPYING in the top-level directory of this8 * source tree.9 *10 * THE COPYRIGHT HOLDERS AND/OR OTHER PARTIES PROVIDE THE PROGRAM "AS IS"11 * WITHOUT WARRANTY OF ANY KIND, EITHER EXPRESSED OR IMPLIED, INCLUDING,12 * BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS13 * FOR A PARTICULAR PURPOSE. THE ENTIRE RISK AS TO THE QUALITY AND PERFORMANCE14 * OF THE PROGRAM IS WITH YOU. SHOULD THE PROGRAM PROVE DEFECTIVE, YOU ASSUME15 * THE COST OF ALL NECESSARY SERVICING, REPAIR OR CORRECTION.16 */17 18#include <linux/debugfs.h>19#include <linux/device.h>20#include <linux/etherdevice.h>21#include <linux/inet.h>22#include <linux/jiffies.h>23#include <linux/kernel.h>24#include <linux/list.h>25#include <linux/mutex.h>26#include <linux/random.h>27#include <linux/rtnetlink.h>28#include <linux/workqueue.h>29#include <net/devlink.h>30#include <net/ip.h>31#include <net/flow_offload.h>32#include <uapi/linux/devlink.h>33#include <uapi/linux/ip.h>34#include <uapi/linux/udp.h>35 36#include "netdevsim.h"37 38static unsigned int39nsim_dev_port_index(enum nsim_dev_port_type type, unsigned int port_index)40{41 switch (type) {42 case NSIM_DEV_PORT_TYPE_VF:43 port_index = NSIM_DEV_VF_PORT_INDEX_BASE + port_index;44 break;45 case NSIM_DEV_PORT_TYPE_PF:46 break;47 }48 49 return port_index;50}51 52static inline unsigned int nsim_dev_port_index_to_vf_index(unsigned int port_index)53{54 return port_index - NSIM_DEV_VF_PORT_INDEX_BASE;55}56 57static struct dentry *nsim_dev_ddir;58 59unsigned int nsim_dev_get_vfs(struct nsim_dev *nsim_dev)60{61 WARN_ON(!lockdep_rtnl_is_held() &&62 !devl_lock_is_held(priv_to_devlink(nsim_dev)));63 64 return nsim_dev->nsim_bus_dev->num_vfs;65}66 67static void68nsim_bus_dev_set_vfs(struct nsim_bus_dev *nsim_bus_dev, unsigned int num_vfs)69{70 rtnl_lock();71 nsim_bus_dev->num_vfs = num_vfs;72 rtnl_unlock();73}74 75#define NSIM_DEV_DUMMY_REGION_SIZE (1024 * 32)76 77static int78nsim_dev_take_snapshot(struct devlink *devlink,79 const struct devlink_region_ops *ops,80 struct netlink_ext_ack *extack,81 u8 **data)82{83 void *dummy_data;84 85 dummy_data = kmalloc(NSIM_DEV_DUMMY_REGION_SIZE, GFP_KERNEL);86 if (!dummy_data)87 return -ENOMEM;88 89 get_random_bytes(dummy_data, NSIM_DEV_DUMMY_REGION_SIZE);90 91 *data = dummy_data;92 93 return 0;94}95 96static ssize_t nsim_dev_take_snapshot_write(struct file *file,97 const char __user *data,98 size_t count, loff_t *ppos)99{100 struct nsim_dev *nsim_dev = file->private_data;101 struct devlink *devlink;102 u8 *dummy_data;103 int err;104 u32 id;105 106 devlink = priv_to_devlink(nsim_dev);107 108 err = nsim_dev_take_snapshot(devlink, NULL, NULL, &dummy_data);109 if (err)110 return err;111 112 err = devlink_region_snapshot_id_get(devlink, &id);113 if (err) {114 pr_err("Failed to get snapshot id\n");115 kfree(dummy_data);116 return err;117 }118 err = devlink_region_snapshot_create(nsim_dev->dummy_region,119 dummy_data, id);120 devlink_region_snapshot_id_put(devlink, id);121 if (err) {122 pr_err("Failed to create region snapshot\n");123 kfree(dummy_data);124 return err;125 }126 127 return count;128}129 130static const struct file_operations nsim_dev_take_snapshot_fops = {131 .open = simple_open,132 .write = nsim_dev_take_snapshot_write,133 .llseek = generic_file_llseek,134 .owner = THIS_MODULE,135};136 137static ssize_t nsim_dev_trap_fa_cookie_read(struct file *file,138 char __user *data,139 size_t count, loff_t *ppos)140{141 struct nsim_dev *nsim_dev = file->private_data;142 struct flow_action_cookie *fa_cookie;143 unsigned int buf_len;144 ssize_t ret;145 char *buf;146 147 spin_lock(&nsim_dev->fa_cookie_lock);148 fa_cookie = nsim_dev->fa_cookie;149 if (!fa_cookie) {150 ret = -EINVAL;151 goto errout;152 }153 buf_len = fa_cookie->cookie_len * 2;154 buf = kmalloc(buf_len, GFP_ATOMIC);155 if (!buf) {156 ret = -ENOMEM;157 goto errout;158 }159 bin2hex(buf, fa_cookie->cookie, fa_cookie->cookie_len);160 spin_unlock(&nsim_dev->fa_cookie_lock);161 162 ret = simple_read_from_buffer(data, count, ppos, buf, buf_len);163 164 kfree(buf);165 return ret;166 167errout:168 spin_unlock(&nsim_dev->fa_cookie_lock);169 return ret;170}171 172static ssize_t nsim_dev_trap_fa_cookie_write(struct file *file,173 const char __user *data,174 size_t count, loff_t *ppos)175{176 struct nsim_dev *nsim_dev = file->private_data;177 struct flow_action_cookie *fa_cookie;178 size_t cookie_len;179 ssize_t ret;180 char *buf;181 182 if (*ppos != 0)183 return -EINVAL;184 cookie_len = (count - 1) / 2;185 if ((count - 1) % 2)186 return -EINVAL;187 188 buf = memdup_user(data, count);189 if (IS_ERR(buf))190 return PTR_ERR(buf);191 192 fa_cookie = kmalloc(sizeof(*fa_cookie) + cookie_len,193 GFP_KERNEL | __GFP_NOWARN);194 if (!fa_cookie) {195 ret = -ENOMEM;196 goto free_buf;197 }198 199 fa_cookie->cookie_len = cookie_len;200 ret = hex2bin(fa_cookie->cookie, buf, cookie_len);201 if (ret)202 goto free_fa_cookie;203 kfree(buf);204 205 spin_lock(&nsim_dev->fa_cookie_lock);206 kfree(nsim_dev->fa_cookie);207 nsim_dev->fa_cookie = fa_cookie;208 spin_unlock(&nsim_dev->fa_cookie_lock);209 210 return count;211 212free_fa_cookie:213 kfree(fa_cookie);214free_buf:215 kfree(buf);216 return ret;217}218 219static const struct file_operations nsim_dev_trap_fa_cookie_fops = {220 .open = simple_open,221 .read = nsim_dev_trap_fa_cookie_read,222 .write = nsim_dev_trap_fa_cookie_write,223 .llseek = generic_file_llseek,224 .owner = THIS_MODULE,225};226 227static ssize_t nsim_bus_dev_max_vfs_read(struct file *file, char __user *data,228 size_t count, loff_t *ppos)229{230 struct nsim_dev *nsim_dev = file->private_data;231 char buf[11];232 ssize_t len;233 234 len = scnprintf(buf, sizeof(buf), "%u\n",235 READ_ONCE(nsim_dev->nsim_bus_dev->max_vfs));236 237 return simple_read_from_buffer(data, count, ppos, buf, len);238}239 240static ssize_t nsim_bus_dev_max_vfs_write(struct file *file,241 const char __user *data,242 size_t count, loff_t *ppos)243{244 struct nsim_vf_config *vfconfigs;245 struct nsim_dev *nsim_dev;246 char buf[10];247 ssize_t ret;248 u32 val;249 250 if (*ppos != 0)251 return 0;252 253 if (count >= sizeof(buf))254 return -ENOSPC;255 256 ret = copy_from_user(buf, data, count);257 if (ret)258 return -EFAULT;259 buf[count] = '\0';260 261 ret = kstrtouint(buf, 10, &val);262 if (ret)263 return -EINVAL;264 265 /* max_vfs limited by the maximum number of provided port indexes */266 if (val > NSIM_DEV_VF_PORT_INDEX_MAX - NSIM_DEV_VF_PORT_INDEX_BASE)267 return -ERANGE;268 269 vfconfigs = kcalloc(val, sizeof(struct nsim_vf_config),270 GFP_KERNEL | __GFP_NOWARN);271 if (!vfconfigs)272 return -ENOMEM;273 274 nsim_dev = file->private_data;275 devl_lock(priv_to_devlink(nsim_dev));276 /* Reject if VFs are configured */277 if (nsim_dev_get_vfs(nsim_dev)) {278 ret = -EBUSY;279 } else {280 swap(nsim_dev->vfconfigs, vfconfigs);281 WRITE_ONCE(nsim_dev->nsim_bus_dev->max_vfs, val);282 *ppos += count;283 ret = count;284 }285 devl_unlock(priv_to_devlink(nsim_dev));286 287 kfree(vfconfigs);288 return ret;289}290 291static const struct file_operations nsim_dev_max_vfs_fops = {292 .open = simple_open,293 .read = nsim_bus_dev_max_vfs_read,294 .write = nsim_bus_dev_max_vfs_write,295 .llseek = generic_file_llseek,296 .owner = THIS_MODULE,297};298 299static int nsim_dev_debugfs_init(struct nsim_dev *nsim_dev)300{301 char dev_ddir_name[sizeof(DRV_NAME) + 10];302 int err;303 304 sprintf(dev_ddir_name, DRV_NAME "%u", nsim_dev->nsim_bus_dev->dev.id);305 nsim_dev->ddir = debugfs_create_dir(dev_ddir_name, nsim_dev_ddir);306 if (IS_ERR(nsim_dev->ddir))307 return PTR_ERR(nsim_dev->ddir);308 nsim_dev->ports_ddir = debugfs_create_dir("ports", nsim_dev->ddir);309 if (IS_ERR(nsim_dev->ports_ddir)) {310 err = PTR_ERR(nsim_dev->ports_ddir);311 goto err_ddir;312 }313 debugfs_create_bool("fw_update_status", 0600, nsim_dev->ddir,314 &nsim_dev->fw_update_status);315 debugfs_create_u32("fw_update_overwrite_mask", 0600, nsim_dev->ddir,316 &nsim_dev->fw_update_overwrite_mask);317 debugfs_create_u32("max_macs", 0600, nsim_dev->ddir,318 &nsim_dev->max_macs);319 debugfs_create_bool("test1", 0600, nsim_dev->ddir,320 &nsim_dev->test1);321 nsim_dev->take_snapshot = debugfs_create_file("take_snapshot",322 0200,323 nsim_dev->ddir,324 nsim_dev,325 &nsim_dev_take_snapshot_fops);326 debugfs_create_bool("dont_allow_reload", 0600, nsim_dev->ddir,327 &nsim_dev->dont_allow_reload);328 debugfs_create_bool("fail_reload", 0600, nsim_dev->ddir,329 &nsim_dev->fail_reload);330 debugfs_create_file("trap_flow_action_cookie", 0600, nsim_dev->ddir,331 nsim_dev, &nsim_dev_trap_fa_cookie_fops);332 debugfs_create_bool("fail_trap_group_set", 0600,333 nsim_dev->ddir,334 &nsim_dev->fail_trap_group_set);335 debugfs_create_bool("fail_trap_policer_set", 0600,336 nsim_dev->ddir,337 &nsim_dev->fail_trap_policer_set);338 debugfs_create_bool("fail_trap_policer_counter_get", 0600,339 nsim_dev->ddir,340 &nsim_dev->fail_trap_policer_counter_get);341 /* caution, dev_max_vfs write takes devlink lock */342 debugfs_create_file("max_vfs", 0600, nsim_dev->ddir,343 nsim_dev, &nsim_dev_max_vfs_fops);344 345 nsim_dev->nodes_ddir = debugfs_create_dir("rate_nodes", nsim_dev->ddir);346 if (IS_ERR(nsim_dev->nodes_ddir)) {347 err = PTR_ERR(nsim_dev->nodes_ddir);348 goto err_ports_ddir;349 }350 debugfs_create_bool("fail_trap_drop_counter_get", 0600,351 nsim_dev->ddir,352 &nsim_dev->fail_trap_drop_counter_get);353 nsim_udp_tunnels_debugfs_create(nsim_dev);354 return 0;355 356err_ports_ddir:357 debugfs_remove_recursive(nsim_dev->ports_ddir);358err_ddir:359 debugfs_remove_recursive(nsim_dev->ddir);360 return err;361}362 363static void nsim_dev_debugfs_exit(struct nsim_dev *nsim_dev)364{365 debugfs_remove_recursive(nsim_dev->nodes_ddir);366 debugfs_remove_recursive(nsim_dev->ports_ddir);367 debugfs_remove_recursive(nsim_dev->ddir);368}369 370static ssize_t nsim_dev_rate_parent_read(struct file *file,371 char __user *data,372 size_t count, loff_t *ppos)373{374 char **name_ptr = file->private_data;375 size_t len;376 377 if (!*name_ptr)378 return 0;379 380 len = strlen(*name_ptr);381 return simple_read_from_buffer(data, count, ppos, *name_ptr, len);382}383 384static const struct file_operations nsim_dev_rate_parent_fops = {385 .open = simple_open,386 .read = nsim_dev_rate_parent_read,387 .llseek = generic_file_llseek,388 .owner = THIS_MODULE,389};390 391static int nsim_dev_port_debugfs_init(struct nsim_dev *nsim_dev,392 struct nsim_dev_port *nsim_dev_port)393{394 struct nsim_bus_dev *nsim_bus_dev = nsim_dev->nsim_bus_dev;395 unsigned int port_index = nsim_dev_port->port_index;396 char port_ddir_name[16];397 char dev_link_name[32];398 399 sprintf(port_ddir_name, "%u", port_index);400 nsim_dev_port->ddir = debugfs_create_dir(port_ddir_name,401 nsim_dev->ports_ddir);402 if (IS_ERR(nsim_dev_port->ddir))403 return PTR_ERR(nsim_dev_port->ddir);404 405 sprintf(dev_link_name, "../../../" DRV_NAME "%u", nsim_bus_dev->dev.id);406 if (nsim_dev_port_is_vf(nsim_dev_port)) {407 unsigned int vf_id = nsim_dev_port_index_to_vf_index(port_index);408 409 debugfs_create_u16("tx_share", 0400, nsim_dev_port->ddir,410 &nsim_dev->vfconfigs[vf_id].min_tx_rate);411 debugfs_create_u16("tx_max", 0400, nsim_dev_port->ddir,412 &nsim_dev->vfconfigs[vf_id].max_tx_rate);413 nsim_dev_port->rate_parent = debugfs_create_file("rate_parent",414 0400,415 nsim_dev_port->ddir,416 &nsim_dev_port->parent_name,417 &nsim_dev_rate_parent_fops);418 }419 debugfs_create_symlink("dev", nsim_dev_port->ddir, dev_link_name);420 421 return 0;422}423 424static void nsim_dev_port_debugfs_exit(struct nsim_dev_port *nsim_dev_port)425{426 debugfs_remove_recursive(nsim_dev_port->ddir);427}428 429static int nsim_dev_resources_register(struct devlink *devlink)430{431 struct devlink_resource_size_params params = {432 .size_max = (u64)-1,433 .size_granularity = 1,434 .unit = DEVLINK_RESOURCE_UNIT_ENTRY435 };436 int err;437 438 /* Resources for IPv4 */439 err = devl_resource_register(devlink, "IPv4", (u64)-1,440 NSIM_RESOURCE_IPV4,441 DEVLINK_RESOURCE_ID_PARENT_TOP,442 ¶ms);443 if (err) {444 pr_err("Failed to register IPv4 top resource\n");445 goto err_out;446 }447 448 err = devl_resource_register(devlink, "fib", (u64)-1,449 NSIM_RESOURCE_IPV4_FIB,450 NSIM_RESOURCE_IPV4, ¶ms);451 if (err) {452 pr_err("Failed to register IPv4 FIB resource\n");453 goto err_out;454 }455 456 err = devl_resource_register(devlink, "fib-rules", (u64)-1,457 NSIM_RESOURCE_IPV4_FIB_RULES,458 NSIM_RESOURCE_IPV4, ¶ms);459 if (err) {460 pr_err("Failed to register IPv4 FIB rules resource\n");461 goto err_out;462 }463 464 /* Resources for IPv6 */465 err = devl_resource_register(devlink, "IPv6", (u64)-1,466 NSIM_RESOURCE_IPV6,467 DEVLINK_RESOURCE_ID_PARENT_TOP,468 ¶ms);469 if (err) {470 pr_err("Failed to register IPv6 top resource\n");471 goto err_out;472 }473 474 err = devl_resource_register(devlink, "fib", (u64)-1,475 NSIM_RESOURCE_IPV6_FIB,476 NSIM_RESOURCE_IPV6, ¶ms);477 if (err) {478 pr_err("Failed to register IPv6 FIB resource\n");479 goto err_out;480 }481 482 err = devl_resource_register(devlink, "fib-rules", (u64)-1,483 NSIM_RESOURCE_IPV6_FIB_RULES,484 NSIM_RESOURCE_IPV6, ¶ms);485 if (err) {486 pr_err("Failed to register IPv6 FIB rules resource\n");487 goto err_out;488 }489 490 /* Resources for nexthops */491 err = devl_resource_register(devlink, "nexthops", (u64)-1,492 NSIM_RESOURCE_NEXTHOPS,493 DEVLINK_RESOURCE_ID_PARENT_TOP,494 ¶ms);495 if (err) {496 pr_err("Failed to register NEXTHOPS resource\n");497 goto err_out;498 }499 return 0;500 501err_out:502 devl_resources_unregister(devlink);503 return err;504}505 506enum nsim_devlink_param_id {507 NSIM_DEVLINK_PARAM_ID_BASE = DEVLINK_PARAM_GENERIC_ID_MAX,508 NSIM_DEVLINK_PARAM_ID_TEST1,509};510 511static const struct devlink_param nsim_devlink_params[] = {512 DEVLINK_PARAM_GENERIC(MAX_MACS,513 BIT(DEVLINK_PARAM_CMODE_DRIVERINIT),514 NULL, NULL, NULL),515 DEVLINK_PARAM_DRIVER(NSIM_DEVLINK_PARAM_ID_TEST1,516 "test1", DEVLINK_PARAM_TYPE_BOOL,517 BIT(DEVLINK_PARAM_CMODE_DRIVERINIT),518 NULL, NULL, NULL),519};520 521static void nsim_devlink_set_params_init_values(struct nsim_dev *nsim_dev,522 struct devlink *devlink)523{524 union devlink_param_value value;525 526 value.vu32 = nsim_dev->max_macs;527 devl_param_driverinit_value_set(devlink,528 DEVLINK_PARAM_GENERIC_ID_MAX_MACS,529 value);530 value.vbool = nsim_dev->test1;531 devl_param_driverinit_value_set(devlink,532 NSIM_DEVLINK_PARAM_ID_TEST1,533 value);534}535 536static void nsim_devlink_param_load_driverinit_values(struct devlink *devlink)537{538 struct nsim_dev *nsim_dev = devlink_priv(devlink);539 union devlink_param_value saved_value;540 int err;541 542 err = devl_param_driverinit_value_get(devlink,543 DEVLINK_PARAM_GENERIC_ID_MAX_MACS,544 &saved_value);545 if (!err)546 nsim_dev->max_macs = saved_value.vu32;547 err = devl_param_driverinit_value_get(devlink,548 NSIM_DEVLINK_PARAM_ID_TEST1,549 &saved_value);550 if (!err)551 nsim_dev->test1 = saved_value.vbool;552}553 554#define NSIM_DEV_DUMMY_REGION_SNAPSHOT_MAX 16555 556static const struct devlink_region_ops dummy_region_ops = {557 .name = "dummy",558 .destructor = &kfree,559 .snapshot = nsim_dev_take_snapshot,560};561 562static int nsim_dev_dummy_region_init(struct nsim_dev *nsim_dev,563 struct devlink *devlink)564{565 nsim_dev->dummy_region =566 devl_region_create(devlink, &dummy_region_ops,567 NSIM_DEV_DUMMY_REGION_SNAPSHOT_MAX,568 NSIM_DEV_DUMMY_REGION_SIZE);569 return PTR_ERR_OR_ZERO(nsim_dev->dummy_region);570}571 572static void nsim_dev_dummy_region_exit(struct nsim_dev *nsim_dev)573{574 devl_region_destroy(nsim_dev->dummy_region);575}576 577static int578__nsim_dev_port_add(struct nsim_dev *nsim_dev, enum nsim_dev_port_type type,579 unsigned int port_index);580static void __nsim_dev_port_del(struct nsim_dev_port *nsim_dev_port);581 582static int nsim_esw_legacy_enable(struct nsim_dev *nsim_dev,583 struct netlink_ext_ack *extack)584{585 struct devlink *devlink = priv_to_devlink(nsim_dev);586 struct nsim_dev_port *nsim_dev_port, *tmp;587 588 devl_rate_nodes_destroy(devlink);589 list_for_each_entry_safe(nsim_dev_port, tmp, &nsim_dev->port_list, list)590 if (nsim_dev_port_is_vf(nsim_dev_port))591 __nsim_dev_port_del(nsim_dev_port);592 nsim_dev->esw_mode = DEVLINK_ESWITCH_MODE_LEGACY;593 return 0;594}595 596static int nsim_esw_switchdev_enable(struct nsim_dev *nsim_dev,597 struct netlink_ext_ack *extack)598{599 struct nsim_dev_port *nsim_dev_port, *tmp;600 int i, err;601 602 for (i = 0; i < nsim_dev_get_vfs(nsim_dev); i++) {603 err = __nsim_dev_port_add(nsim_dev, NSIM_DEV_PORT_TYPE_VF, i);604 if (err) {605 NL_SET_ERR_MSG_MOD(extack, "Failed to initialize VFs' netdevsim ports");606 pr_err("Failed to initialize VF id=%d. %d.\n", i, err);607 goto err_port_add_vfs;608 }609 }610 nsim_dev->esw_mode = DEVLINK_ESWITCH_MODE_SWITCHDEV;611 return 0;612 613err_port_add_vfs:614 list_for_each_entry_safe(nsim_dev_port, tmp, &nsim_dev->port_list, list)615 if (nsim_dev_port_is_vf(nsim_dev_port))616 __nsim_dev_port_del(nsim_dev_port);617 return err;618}619 620static int nsim_devlink_eswitch_mode_set(struct devlink *devlink, u16 mode,621 struct netlink_ext_ack *extack)622{623 struct nsim_dev *nsim_dev = devlink_priv(devlink);624 625 if (mode == nsim_dev->esw_mode)626 return 0;627 628 if (mode == DEVLINK_ESWITCH_MODE_LEGACY)629 return nsim_esw_legacy_enable(nsim_dev, extack);630 if (mode == DEVLINK_ESWITCH_MODE_SWITCHDEV)631 return nsim_esw_switchdev_enable(nsim_dev, extack);632 633 return -EINVAL;634}635 636static int nsim_devlink_eswitch_mode_get(struct devlink *devlink, u16 *mode)637{638 struct nsim_dev *nsim_dev = devlink_priv(devlink);639 640 *mode = nsim_dev->esw_mode;641 return 0;642}643 644struct nsim_trap_item {645 void *trap_ctx;646 enum devlink_trap_action action;647};648 649struct nsim_trap_data {650 struct delayed_work trap_report_dw;651 struct nsim_trap_item *trap_items_arr;652 u64 *trap_policers_cnt_arr;653 u64 trap_pkt_cnt;654 struct nsim_dev *nsim_dev;655 spinlock_t trap_lock; /* Protects trap_items_arr */656};657 658/* All driver-specific traps must be documented in659 * Documentation/networking/devlink/netdevsim.rst660 */661enum {662 NSIM_TRAP_ID_BASE = DEVLINK_TRAP_GENERIC_ID_MAX,663 NSIM_TRAP_ID_FID_MISS,664};665 666#define NSIM_TRAP_NAME_FID_MISS "fid_miss"667 668#define NSIM_TRAP_METADATA DEVLINK_TRAP_METADATA_TYPE_F_IN_PORT669 670#define NSIM_TRAP_DROP(_id, _group_id) \671 DEVLINK_TRAP_GENERIC(DROP, DROP, _id, \672 DEVLINK_TRAP_GROUP_GENERIC_ID_##_group_id, \673 NSIM_TRAP_METADATA)674#define NSIM_TRAP_DROP_EXT(_id, _group_id, _metadata) \675 DEVLINK_TRAP_GENERIC(DROP, DROP, _id, \676 DEVLINK_TRAP_GROUP_GENERIC_ID_##_group_id, \677 NSIM_TRAP_METADATA | (_metadata))678#define NSIM_TRAP_EXCEPTION(_id, _group_id) \679 DEVLINK_TRAP_GENERIC(EXCEPTION, TRAP, _id, \680 DEVLINK_TRAP_GROUP_GENERIC_ID_##_group_id, \681 NSIM_TRAP_METADATA)682#define NSIM_TRAP_CONTROL(_id, _group_id, _action) \683 DEVLINK_TRAP_GENERIC(CONTROL, _action, _id, \684 DEVLINK_TRAP_GROUP_GENERIC_ID_##_group_id, \685 NSIM_TRAP_METADATA)686#define NSIM_TRAP_DRIVER_EXCEPTION(_id, _group_id) \687 DEVLINK_TRAP_DRIVER(EXCEPTION, TRAP, NSIM_TRAP_ID_##_id, \688 NSIM_TRAP_NAME_##_id, \689 DEVLINK_TRAP_GROUP_GENERIC_ID_##_group_id, \690 NSIM_TRAP_METADATA)691 692#define NSIM_DEV_TRAP_POLICER_MIN_RATE 1693#define NSIM_DEV_TRAP_POLICER_MAX_RATE 8000694#define NSIM_DEV_TRAP_POLICER_MIN_BURST 8695#define NSIM_DEV_TRAP_POLICER_MAX_BURST 65536696 697#define NSIM_TRAP_POLICER(_id, _rate, _burst) \698 DEVLINK_TRAP_POLICER(_id, _rate, _burst, \699 NSIM_DEV_TRAP_POLICER_MAX_RATE, \700 NSIM_DEV_TRAP_POLICER_MIN_RATE, \701 NSIM_DEV_TRAP_POLICER_MAX_BURST, \702 NSIM_DEV_TRAP_POLICER_MIN_BURST)703 704static const struct devlink_trap_policer nsim_trap_policers_arr[] = {705 NSIM_TRAP_POLICER(1, 1000, 128),706 NSIM_TRAP_POLICER(2, 2000, 256),707 NSIM_TRAP_POLICER(3, 3000, 512),708};709 710static const struct devlink_trap_group nsim_trap_groups_arr[] = {711 DEVLINK_TRAP_GROUP_GENERIC(L2_DROPS, 0),712 DEVLINK_TRAP_GROUP_GENERIC(L3_DROPS, 1),713 DEVLINK_TRAP_GROUP_GENERIC(L3_EXCEPTIONS, 1),714 DEVLINK_TRAP_GROUP_GENERIC(BUFFER_DROPS, 2),715 DEVLINK_TRAP_GROUP_GENERIC(ACL_DROPS, 3),716 DEVLINK_TRAP_GROUP_GENERIC(MC_SNOOPING, 3),717};718 719static const struct devlink_trap nsim_traps_arr[] = {720 NSIM_TRAP_DROP(SMAC_MC, L2_DROPS),721 NSIM_TRAP_DROP(VLAN_TAG_MISMATCH, L2_DROPS),722 NSIM_TRAP_DROP(INGRESS_VLAN_FILTER, L2_DROPS),723 NSIM_TRAP_DROP(INGRESS_STP_FILTER, L2_DROPS),724 NSIM_TRAP_DROP(EMPTY_TX_LIST, L2_DROPS),725 NSIM_TRAP_DROP(PORT_LOOPBACK_FILTER, L2_DROPS),726 NSIM_TRAP_DRIVER_EXCEPTION(FID_MISS, L2_DROPS),727 NSIM_TRAP_DROP(BLACKHOLE_ROUTE, L3_DROPS),728 NSIM_TRAP_EXCEPTION(TTL_ERROR, L3_EXCEPTIONS),729 NSIM_TRAP_DROP(TAIL_DROP, BUFFER_DROPS),730 NSIM_TRAP_DROP_EXT(INGRESS_FLOW_ACTION_DROP, ACL_DROPS,731 DEVLINK_TRAP_METADATA_TYPE_F_FA_COOKIE),732 NSIM_TRAP_DROP_EXT(EGRESS_FLOW_ACTION_DROP, ACL_DROPS,733 DEVLINK_TRAP_METADATA_TYPE_F_FA_COOKIE),734 NSIM_TRAP_CONTROL(IGMP_QUERY, MC_SNOOPING, MIRROR),735 NSIM_TRAP_CONTROL(IGMP_V1_REPORT, MC_SNOOPING, TRAP),736};737 738#define NSIM_TRAP_L4_DATA_LEN 100739 740static struct sk_buff *nsim_dev_trap_skb_build(void)741{742 int tot_len, data_len = NSIM_TRAP_L4_DATA_LEN;743 struct sk_buff *skb;744 struct udphdr *udph;745 struct ethhdr *eth;746 struct iphdr *iph;747 748 skb = alloc_skb(NLMSG_GOODSIZE, GFP_ATOMIC);749 if (!skb)750 return NULL;751 tot_len = sizeof(struct iphdr) + sizeof(struct udphdr) + data_len;752 753 skb_reset_mac_header(skb);754 eth = skb_put(skb, sizeof(struct ethhdr));755 eth_random_addr(eth->h_dest);756 eth_random_addr(eth->h_source);757 eth->h_proto = htons(ETH_P_IP);758 skb->protocol = htons(ETH_P_IP);759 760 skb_set_network_header(skb, skb->len);761 iph = skb_put(skb, sizeof(struct iphdr));762 iph->protocol = IPPROTO_UDP;763 iph->saddr = in_aton("192.0.2.1");764 iph->daddr = in_aton("198.51.100.1");765 iph->version = 0x4;766 iph->frag_off = 0;767 iph->ihl = 0x5;768 iph->tot_len = htons(tot_len);769 iph->ttl = 100;770 iph->check = 0;771 iph->check = ip_fast_csum((unsigned char *)iph, iph->ihl);772 773 skb_set_transport_header(skb, skb->len);774 udph = skb_put_zero(skb, sizeof(struct udphdr) + data_len);775 get_random_bytes(&udph->source, sizeof(u16));776 get_random_bytes(&udph->dest, sizeof(u16));777 udph->len = htons(sizeof(struct udphdr) + data_len);778 779 return skb;780}781 782static void nsim_dev_trap_report(struct nsim_dev_port *nsim_dev_port)783{784 struct nsim_dev *nsim_dev = nsim_dev_port->ns->nsim_dev;785 struct devlink *devlink = priv_to_devlink(nsim_dev);786 struct nsim_trap_data *nsim_trap_data;787 int i;788 789 nsim_trap_data = nsim_dev->trap_data;790 791 spin_lock(&nsim_trap_data->trap_lock);792 for (i = 0; i < ARRAY_SIZE(nsim_traps_arr); i++) {793 struct flow_action_cookie *fa_cookie = NULL;794 struct nsim_trap_item *nsim_trap_item;795 struct sk_buff *skb;796 bool has_fa_cookie;797 798 has_fa_cookie = nsim_traps_arr[i].metadata_cap &799 DEVLINK_TRAP_METADATA_TYPE_F_FA_COOKIE;800 801 nsim_trap_item = &nsim_trap_data->trap_items_arr[i];802 if (nsim_trap_item->action == DEVLINK_TRAP_ACTION_DROP)803 continue;804 805 skb = nsim_dev_trap_skb_build();806 if (!skb)807 continue;808 skb->dev = nsim_dev_port->ns->netdev;809 810 /* Trapped packets are usually passed to devlink in softIRQ,811 * but in this case they are generated in a workqueue. Disable812 * softIRQs to prevent lockdep from complaining about813 * "incosistent lock state".814 */815 816 spin_lock_bh(&nsim_dev->fa_cookie_lock);817 fa_cookie = has_fa_cookie ? nsim_dev->fa_cookie : NULL;818 devlink_trap_report(devlink, skb, nsim_trap_item->trap_ctx,819 &nsim_dev_port->devlink_port, fa_cookie);820 spin_unlock_bh(&nsim_dev->fa_cookie_lock);821 consume_skb(skb);822 }823 spin_unlock(&nsim_trap_data->trap_lock);824}825 826#define NSIM_TRAP_REPORT_INTERVAL_MS 100827 828static void nsim_dev_trap_report_work(struct work_struct *work)829{830 struct nsim_trap_data *nsim_trap_data;831 struct nsim_dev_port *nsim_dev_port;832 struct nsim_dev *nsim_dev;833 834 nsim_trap_data = container_of(work, struct nsim_trap_data,835 trap_report_dw.work);836 nsim_dev = nsim_trap_data->nsim_dev;837 838 if (!devl_trylock(priv_to_devlink(nsim_dev))) {839 queue_delayed_work(system_unbound_wq,840 &nsim_dev->trap_data->trap_report_dw, 1);841 return;842 }843 844 /* For each running port and enabled packet trap, generate a UDP845 * packet with a random 5-tuple and report it.846 */847 list_for_each_entry(nsim_dev_port, &nsim_dev->port_list, list) {848 if (!netif_running(nsim_dev_port->ns->netdev))849 continue;850 851 nsim_dev_trap_report(nsim_dev_port);852 cond_resched();853 }854 devl_unlock(priv_to_devlink(nsim_dev));855 queue_delayed_work(system_unbound_wq,856 &nsim_dev->trap_data->trap_report_dw,857 msecs_to_jiffies(NSIM_TRAP_REPORT_INTERVAL_MS));858}859 860static int nsim_dev_traps_init(struct devlink *devlink)861{862 size_t policers_count = ARRAY_SIZE(nsim_trap_policers_arr);863 struct nsim_dev *nsim_dev = devlink_priv(devlink);864 struct nsim_trap_data *nsim_trap_data;865 int err;866 867 nsim_trap_data = kzalloc(sizeof(*nsim_trap_data), GFP_KERNEL);868 if (!nsim_trap_data)869 return -ENOMEM;870 871 nsim_trap_data->trap_items_arr = kcalloc(ARRAY_SIZE(nsim_traps_arr),872 sizeof(struct nsim_trap_item),873 GFP_KERNEL);874 if (!nsim_trap_data->trap_items_arr) {875 err = -ENOMEM;876 goto err_trap_data_free;877 }878 879 nsim_trap_data->trap_policers_cnt_arr = kcalloc(policers_count,880 sizeof(u64),881 GFP_KERNEL);882 if (!nsim_trap_data->trap_policers_cnt_arr) {883 err = -ENOMEM;884 goto err_trap_items_free;885 }886 887 /* The lock is used to protect the action state of the registered888 * traps. The value is written by user and read in delayed work when889 * iterating over all the traps.890 */891 spin_lock_init(&nsim_trap_data->trap_lock);892 nsim_trap_data->nsim_dev = nsim_dev;893 nsim_dev->trap_data = nsim_trap_data;894 895 err = devl_trap_policers_register(devlink, nsim_trap_policers_arr,896 policers_count);897 if (err)898 goto err_trap_policers_cnt_free;899 900 err = devl_trap_groups_register(devlink, nsim_trap_groups_arr,901 ARRAY_SIZE(nsim_trap_groups_arr));902 if (err)903 goto err_trap_policers_unregister;904 905 err = devl_traps_register(devlink, nsim_traps_arr,906 ARRAY_SIZE(nsim_traps_arr), NULL);907 if (err)908 goto err_trap_groups_unregister;909 910 INIT_DELAYED_WORK(&nsim_dev->trap_data->trap_report_dw,911 nsim_dev_trap_report_work);912 queue_delayed_work(system_unbound_wq,913 &nsim_dev->trap_data->trap_report_dw,914 msecs_to_jiffies(NSIM_TRAP_REPORT_INTERVAL_MS));915 916 return 0;917 918err_trap_groups_unregister:919 devl_trap_groups_unregister(devlink, nsim_trap_groups_arr,920 ARRAY_SIZE(nsim_trap_groups_arr));921err_trap_policers_unregister:922 devl_trap_policers_unregister(devlink, nsim_trap_policers_arr,923 ARRAY_SIZE(nsim_trap_policers_arr));924err_trap_policers_cnt_free:925 kfree(nsim_trap_data->trap_policers_cnt_arr);926err_trap_items_free:927 kfree(nsim_trap_data->trap_items_arr);928err_trap_data_free:929 kfree(nsim_trap_data);930 return err;931}932 933static void nsim_dev_traps_exit(struct devlink *devlink)934{935 struct nsim_dev *nsim_dev = devlink_priv(devlink);936 937 /* caution, trap work takes devlink lock */938 cancel_delayed_work_sync(&nsim_dev->trap_data->trap_report_dw);939 devl_traps_unregister(devlink, nsim_traps_arr,940 ARRAY_SIZE(nsim_traps_arr));941 devl_trap_groups_unregister(devlink, nsim_trap_groups_arr,942 ARRAY_SIZE(nsim_trap_groups_arr));943 devl_trap_policers_unregister(devlink, nsim_trap_policers_arr,944 ARRAY_SIZE(nsim_trap_policers_arr));945 kfree(nsim_dev->trap_data->trap_policers_cnt_arr);946 kfree(nsim_dev->trap_data->trap_items_arr);947 kfree(nsim_dev->trap_data);948}949 950static int nsim_dev_reload_create(struct nsim_dev *nsim_dev,951 struct netlink_ext_ack *extack);952static void nsim_dev_reload_destroy(struct nsim_dev *nsim_dev);953 954static int nsim_dev_reload_down(struct devlink *devlink, bool netns_change,955 enum devlink_reload_action action, enum devlink_reload_limit limit,956 struct netlink_ext_ack *extack)957{958 struct nsim_dev *nsim_dev = devlink_priv(devlink);959 960 if (nsim_dev->dont_allow_reload) {961 /* For testing purposes, user set debugfs dont_allow_reload962 * value to true. So forbid it.963 */964 NL_SET_ERR_MSG_MOD(extack, "User forbid the reload for testing purposes");965 return -EOPNOTSUPP;966 }967 968 nsim_dev_reload_destroy(nsim_dev);969 return 0;970}971 972static int nsim_dev_reload_up(struct devlink *devlink, enum devlink_reload_action action,973 enum devlink_reload_limit limit, u32 *actions_performed,974 struct netlink_ext_ack *extack)975{976 struct nsim_dev *nsim_dev = devlink_priv(devlink);977 978 if (nsim_dev->fail_reload) {979 /* For testing purposes, user set debugfs fail_reload980 * value to true. Fail right away.981 */982 NL_SET_ERR_MSG_MOD(extack, "User setup the reload to fail for testing purposes");983 return -EINVAL;984 }985 986 *actions_performed = BIT(DEVLINK_RELOAD_ACTION_DRIVER_REINIT);987 988 return nsim_dev_reload_create(nsim_dev, extack);989}990 991static int nsim_dev_info_get(struct devlink *devlink,992 struct devlink_info_req *req,993 struct netlink_ext_ack *extack)994{995 int err;996 997 err = devlink_info_version_stored_put_ext(req, "fw.mgmt", "10.20.30",998 DEVLINK_INFO_VERSION_TYPE_COMPONENT);999 if (err)1000 return err;1001 return devlink_info_version_running_put_ext(req, "fw.mgmt", "10.20.30",1002 DEVLINK_INFO_VERSION_TYPE_COMPONENT);1003}1004 1005#define NSIM_DEV_FLASH_SIZE 5000001006#define NSIM_DEV_FLASH_CHUNK_SIZE 10001007#define NSIM_DEV_FLASH_CHUNK_TIME_MS 101008 1009static int nsim_dev_flash_update(struct devlink *devlink,1010 struct devlink_flash_update_params *params,1011 struct netlink_ext_ack *extack)1012{1013 struct nsim_dev *nsim_dev = devlink_priv(devlink);1014 int i;1015 1016 if ((params->overwrite_mask & ~nsim_dev->fw_update_overwrite_mask) != 0)1017 return -EOPNOTSUPP;1018 1019 if (nsim_dev->fw_update_status) {1020 devlink_flash_update_status_notify(devlink,1021 "Preparing to flash",1022 params->component, 0, 0);1023 }1024 1025 for (i = 0; i < NSIM_DEV_FLASH_SIZE / NSIM_DEV_FLASH_CHUNK_SIZE; i++) {1026 if (nsim_dev->fw_update_status)1027 devlink_flash_update_status_notify(devlink, "Flashing",1028 params->component,1029 i * NSIM_DEV_FLASH_CHUNK_SIZE,1030 NSIM_DEV_FLASH_SIZE);1031 msleep(NSIM_DEV_FLASH_CHUNK_TIME_MS);1032 }1033 1034 if (nsim_dev->fw_update_status) {1035 devlink_flash_update_status_notify(devlink, "Flashing",1036 params->component,1037 NSIM_DEV_FLASH_SIZE,1038 NSIM_DEV_FLASH_SIZE);1039 devlink_flash_update_timeout_notify(devlink, "Flash select",1040 params->component, 81);1041 devlink_flash_update_status_notify(devlink, "Flashing done",1042 params->component, 0, 0);1043 }1044 1045 return 0;1046}1047 1048static struct nsim_trap_item *1049nsim_dev_trap_item_lookup(struct nsim_dev *nsim_dev, u16 trap_id)1050{1051 struct nsim_trap_data *nsim_trap_data = nsim_dev->trap_data;1052 int i;1053 1054 for (i = 0; i < ARRAY_SIZE(nsim_traps_arr); i++) {1055 if (nsim_traps_arr[i].id == trap_id)1056 return &nsim_trap_data->trap_items_arr[i];1057 }1058 1059 return NULL;1060}1061 1062static int nsim_dev_devlink_trap_init(struct devlink *devlink,1063 const struct devlink_trap *trap,1064 void *trap_ctx)1065{1066 struct nsim_dev *nsim_dev = devlink_priv(devlink);1067 struct nsim_trap_item *nsim_trap_item;1068 1069 nsim_trap_item = nsim_dev_trap_item_lookup(nsim_dev, trap->id);1070 if (WARN_ON(!nsim_trap_item))1071 return -ENOENT;1072 1073 nsim_trap_item->trap_ctx = trap_ctx;1074 nsim_trap_item->action = trap->init_action;1075 1076 return 0;1077}1078 1079static int1080nsim_dev_devlink_trap_action_set(struct devlink *devlink,1081 const struct devlink_trap *trap,1082 enum devlink_trap_action action,1083 struct netlink_ext_ack *extack)1084{1085 struct nsim_dev *nsim_dev = devlink_priv(devlink);1086 struct nsim_trap_item *nsim_trap_item;1087 1088 nsim_trap_item = nsim_dev_trap_item_lookup(nsim_dev, trap->id);1089 if (WARN_ON(!nsim_trap_item))1090 return -ENOENT;1091 1092 spin_lock(&nsim_dev->trap_data->trap_lock);1093 nsim_trap_item->action = action;1094 spin_unlock(&nsim_dev->trap_data->trap_lock);1095 1096 return 0;1097}1098 1099static int1100nsim_dev_devlink_trap_group_set(struct devlink *devlink,1101 const struct devlink_trap_group *group,1102 const struct devlink_trap_policer *policer,1103 struct netlink_ext_ack *extack)1104{1105 struct nsim_dev *nsim_dev = devlink_priv(devlink);1106 1107 if (nsim_dev->fail_trap_group_set)1108 return -EINVAL;1109 1110 return 0;1111}1112 1113static int1114nsim_dev_devlink_trap_policer_set(struct devlink *devlink,1115 const struct devlink_trap_policer *policer,1116 u64 rate, u64 burst,1117 struct netlink_ext_ack *extack)1118{1119 struct nsim_dev *nsim_dev = devlink_priv(devlink);1120 1121 if (nsim_dev->fail_trap_policer_set) {1122 NL_SET_ERR_MSG_MOD(extack, "User setup the operation to fail for testing purposes");1123 return -EINVAL;1124 }1125 1126 return 0;1127}1128 1129static int1130nsim_dev_devlink_trap_policer_counter_get(struct devlink *devlink,1131 const struct devlink_trap_policer *policer,1132 u64 *p_drops)1133{1134 struct nsim_dev *nsim_dev = devlink_priv(devlink);1135 u64 *cnt;1136 1137 if (nsim_dev->fail_trap_policer_counter_get)1138 return -EINVAL;1139 1140 cnt = &nsim_dev->trap_data->trap_policers_cnt_arr[policer->id - 1];1141 *p_drops = (*cnt)++;1142 1143 return 0;1144}1145 1146#define NSIM_LINK_SPEED_MAX 5000 /* Mbps */1147#define NSIM_LINK_SPEED_UNIT 125000 /* 1 Mbps given in bytes/sec to avoid1148 * u64 overflow during conversion from1149 * bytes to bits.1150 */1151 1152static int nsim_rate_bytes_to_units(char *name, u64 *rate, struct netlink_ext_ack *extack)1153{1154 u64 val;1155 u32 rem;1156 1157 val = div_u64_rem(*rate, NSIM_LINK_SPEED_UNIT, &rem);1158 if (rem) {1159 pr_err("%s rate value %lluBps not in link speed units of 1Mbps.\n",1160 name, *rate);1161 NL_SET_ERR_MSG_MOD(extack, "TX rate value not in link speed units of 1Mbps.");1162 return -EINVAL;1163 }1164 1165 if (val > NSIM_LINK_SPEED_MAX) {1166 pr_err("%s rate value %lluMbps exceed link maximum speed 5000Mbps.\n",1167 name, val);1168 NL_SET_ERR_MSG_MOD(extack, "TX rate value exceed link maximum speed 5000Mbps.");1169 return -EINVAL;1170 }1171 *rate = val;1172 return 0;1173}1174 1175static int nsim_leaf_tx_share_set(struct devlink_rate *devlink_rate, void *priv,1176 u64 tx_share, struct netlink_ext_ack *extack)1177{1178 struct nsim_dev_port *nsim_dev_port = priv;1179 struct nsim_dev *nsim_dev = nsim_dev_port->ns->nsim_dev;1180 int vf_id = nsim_dev_port_index_to_vf_index(nsim_dev_port->port_index);1181 int err;1182 1183 err = nsim_rate_bytes_to_units("tx_share", &tx_share, extack);1184 if (err)1185 return err;1186 1187 nsim_dev->vfconfigs[vf_id].min_tx_rate = tx_share;1188 return 0;1189}1190 1191static int nsim_leaf_tx_max_set(struct devlink_rate *devlink_rate, void *priv,1192 u64 tx_max, struct netlink_ext_ack *extack)1193{1194 struct nsim_dev_port *nsim_dev_port = priv;1195 struct nsim_dev *nsim_dev = nsim_dev_port->ns->nsim_dev;1196 int vf_id = nsim_dev_port_index_to_vf_index(nsim_dev_port->port_index);1197 int err;1198 1199 err = nsim_rate_bytes_to_units("tx_max", &tx_max, extack);1200 if (err)1201 return err;1202 1203 nsim_dev->vfconfigs[vf_id].max_tx_rate = tx_max;1204 return 0;1205}1206 1207struct nsim_rate_node {1208 struct dentry *ddir;1209 struct dentry *rate_parent;1210 char *parent_name;1211 u16 tx_share;1212 u16 tx_max;1213};1214 1215static int nsim_node_tx_share_set(struct devlink_rate *devlink_rate, void *priv,1216 u64 tx_share, struct netlink_ext_ack *extack)1217{1218 struct nsim_rate_node *nsim_node = priv;1219 int err;1220 1221 err = nsim_rate_bytes_to_units("tx_share", &tx_share, extack);1222 if (err)1223 return err;1224 1225 nsim_node->tx_share = tx_share;1226 return 0;1227}1228 1229static int nsim_node_tx_max_set(struct devlink_rate *devlink_rate, void *priv,1230 u64 tx_max, struct netlink_ext_ack *extack)1231{1232 struct nsim_rate_node *nsim_node = priv;1233 int err;1234 1235 err = nsim_rate_bytes_to_units("tx_max", &tx_max, extack);1236 if (err)1237 return err;1238 1239 nsim_node->tx_max = tx_max;1240 return 0;1241}1242 1243static int nsim_rate_node_new(struct devlink_rate *node, void **priv,1244 struct netlink_ext_ack *extack)1245{1246 struct nsim_dev *nsim_dev = devlink_priv(node->devlink);1247 struct nsim_rate_node *nsim_node;1248 1249 if (!nsim_esw_mode_is_switchdev(nsim_dev)) {1250 NL_SET_ERR_MSG_MOD(extack, "Node creation allowed only in switchdev mode.");1251 return -EOPNOTSUPP;1252 }1253 1254 nsim_node = kzalloc(sizeof(*nsim_node), GFP_KERNEL);1255 if (!nsim_node)1256 return -ENOMEM;1257 1258 nsim_node->ddir = debugfs_create_dir(node->name, nsim_dev->nodes_ddir);1259 1260 debugfs_create_u16("tx_share", 0400, nsim_node->ddir, &nsim_node->tx_share);1261 debugfs_create_u16("tx_max", 0400, nsim_node->ddir, &nsim_node->tx_max);1262 nsim_node->rate_parent = debugfs_create_file("rate_parent", 0400,1263 nsim_node->ddir,1264 &nsim_node->parent_name,1265 &nsim_dev_rate_parent_fops);1266 1267 *priv = nsim_node;1268 return 0;1269}1270 1271static int nsim_rate_node_del(struct devlink_rate *node, void *priv,1272 struct netlink_ext_ack *extack)1273{1274 struct nsim_rate_node *nsim_node = priv;1275 1276 debugfs_remove(nsim_node->rate_parent);1277 debugfs_remove_recursive(nsim_node->ddir);1278 kfree(nsim_node);1279 return 0;1280}1281 1282static int nsim_rate_leaf_parent_set(struct devlink_rate *child,1283 struct devlink_rate *parent,1284 void *priv_child, void *priv_parent,1285 struct netlink_ext_ack *extack)1286{1287 struct nsim_dev_port *nsim_dev_port = priv_child;1288 1289 if (parent)1290 nsim_dev_port->parent_name = parent->name;1291 else1292 nsim_dev_port->parent_name = NULL;1293 return 0;1294}1295 1296static int nsim_rate_node_parent_set(struct devlink_rate *child,1297 struct devlink_rate *parent,1298 void *priv_child, void *priv_parent,1299 struct netlink_ext_ack *extack)1300{1301 struct nsim_rate_node *nsim_node = priv_child;1302 1303 if (parent)1304 nsim_node->parent_name = parent->name;1305 else1306 nsim_node->parent_name = NULL;1307 return 0;1308}1309 1310static int1311nsim_dev_devlink_trap_drop_counter_get(struct devlink *devlink,1312 const struct devlink_trap *trap,1313 u64 *p_drops)1314{1315 struct nsim_dev *nsim_dev = devlink_priv(devlink);1316 u64 *cnt;1317 1318 if (nsim_dev->fail_trap_drop_counter_get)1319 return -EINVAL;1320 1321 cnt = &nsim_dev->trap_data->trap_pkt_cnt;1322 *p_drops = (*cnt)++;1323 1324 return 0;1325}1326 1327static const struct devlink_ops nsim_dev_devlink_ops = {1328 .eswitch_mode_set = nsim_devlink_eswitch_mode_set,1329 .eswitch_mode_get = nsim_devlink_eswitch_mode_get,1330 .supported_flash_update_params = DEVLINK_SUPPORT_FLASH_UPDATE_OVERWRITE_MASK,1331 .reload_actions = BIT(DEVLINK_RELOAD_ACTION_DRIVER_REINIT),1332 .reload_down = nsim_dev_reload_down,1333 .reload_up = nsim_dev_reload_up,1334 .info_get = nsim_dev_info_get,1335 .flash_update = nsim_dev_flash_update,1336 .trap_init = nsim_dev_devlink_trap_init,1337 .trap_action_set = nsim_dev_devlink_trap_action_set,1338 .trap_group_set = nsim_dev_devlink_trap_group_set,1339 .trap_policer_set = nsim_dev_devlink_trap_policer_set,1340 .trap_policer_counter_get = nsim_dev_devlink_trap_policer_counter_get,1341 .rate_leaf_tx_share_set = nsim_leaf_tx_share_set,1342 .rate_leaf_tx_max_set = nsim_leaf_tx_max_set,1343 .rate_node_tx_share_set = nsim_node_tx_share_set,1344 .rate_node_tx_max_set = nsim_node_tx_max_set,1345 .rate_node_new = nsim_rate_node_new,1346 .rate_node_del = nsim_rate_node_del,1347 .rate_leaf_parent_set = nsim_rate_leaf_parent_set,1348 .rate_node_parent_set = nsim_rate_node_parent_set,1349 .trap_drop_counter_get = nsim_dev_devlink_trap_drop_counter_get,1350};1351 1352#define NSIM_DEV_MAX_MACS_DEFAULT 321353#define NSIM_DEV_TEST1_DEFAULT true1354 1355static int __nsim_dev_port_add(struct nsim_dev *nsim_dev, enum nsim_dev_port_type type,1356 unsigned int port_index)1357{1358 struct devlink_port_attrs attrs = {};1359 struct nsim_dev_port *nsim_dev_port;1360 struct devlink_port *devlink_port;1361 int err;1362 1363 if (type == NSIM_DEV_PORT_TYPE_VF && !nsim_dev_get_vfs(nsim_dev))1364 return -EINVAL;1365 1366 nsim_dev_port = kzalloc(sizeof(*nsim_dev_port), GFP_KERNEL);1367 if (!nsim_dev_port)1368 return -ENOMEM;1369 nsim_dev_port->port_index = nsim_dev_port_index(type, port_index);1370 nsim_dev_port->port_type = type;1371 1372 devlink_port = &nsim_dev_port->devlink_port;1373 if (nsim_dev_port_is_pf(nsim_dev_port)) {1374 attrs.flavour = DEVLINK_PORT_FLAVOUR_PHYSICAL;1375 attrs.phys.port_number = port_index + 1;1376 } else {1377 attrs.flavour = DEVLINK_PORT_FLAVOUR_PCI_VF;1378 attrs.pci_vf.pf = 0;1379 attrs.pci_vf.vf = port_index;1380 }1381 memcpy(attrs.switch_id.id, nsim_dev->switch_id.id, nsim_dev->switch_id.id_len);1382 attrs.switch_id.id_len = nsim_dev->switch_id.id_len;1383 devlink_port_attrs_set(devlink_port, &attrs);1384 err = devl_port_register(priv_to_devlink(nsim_dev), devlink_port,1385 nsim_dev_port->port_index);1386 if (err)1387 goto err_port_free;1388 1389 err = nsim_dev_port_debugfs_init(nsim_dev, nsim_dev_port);1390 if (err)1391 goto err_dl_port_unregister;1392 1393 nsim_dev_port->ns = nsim_create(nsim_dev, nsim_dev_port);1394 if (IS_ERR(nsim_dev_port->ns)) {1395 err = PTR_ERR(nsim_dev_port->ns);1396 goto err_port_debugfs_exit;1397 }1398 1399 if (nsim_dev_port_is_vf(nsim_dev_port)) {1400 err = devl_rate_leaf_create(&nsim_dev_port->devlink_port,1401 nsim_dev_port, NULL);1402 if (err)1403 goto err_nsim_destroy;1404 }1405 1406 list_add(&nsim_dev_port->list, &nsim_dev->port_list);1407 1408 return 0;1409 1410err_nsim_destroy:1411 nsim_destroy(nsim_dev_port->ns);1412err_port_debugfs_exit:1413 nsim_dev_port_debugfs_exit(nsim_dev_port);1414err_dl_port_unregister:1415 devl_port_unregister(devlink_port);1416err_port_free:1417 kfree(nsim_dev_port);1418 return err;1419}1420 1421static void __nsim_dev_port_del(struct nsim_dev_port *nsim_dev_port)1422{1423 struct devlink_port *devlink_port = &nsim_dev_port->devlink_port;1424 1425 list_del(&nsim_dev_port->list);1426 if (nsim_dev_port_is_vf(nsim_dev_port))1427 devl_rate_leaf_destroy(&nsim_dev_port->devlink_port);1428 nsim_destroy(nsim_dev_port->ns);1429 nsim_dev_port_debugfs_exit(nsim_dev_port);1430 devl_port_unregister(devlink_port);1431 kfree(nsim_dev_port);1432}1433 1434static void nsim_dev_port_del_all(struct nsim_dev *nsim_dev)1435{1436 struct nsim_dev_port *nsim_dev_port, *tmp;1437 1438 list_for_each_entry_safe(nsim_dev_port, tmp,1439 &nsim_dev->port_list, list)1440 __nsim_dev_port_del(nsim_dev_port);1441}1442 1443static int nsim_dev_port_add_all(struct nsim_dev *nsim_dev,1444 unsigned int port_count)1445{1446 int i, err;1447 1448 for (i = 0; i < port_count; i++) {1449 err = __nsim_dev_port_add(nsim_dev, NSIM_DEV_PORT_TYPE_PF, i);1450 if (err)1451 goto err_port_del_all;1452 }1453 return 0;1454 1455err_port_del_all:1456 nsim_dev_port_del_all(nsim_dev);1457 return err;1458}1459 1460static int nsim_dev_reload_create(struct nsim_dev *nsim_dev,1461 struct netlink_ext_ack *extack)1462{1463 struct nsim_bus_dev *nsim_bus_dev = nsim_dev->nsim_bus_dev;1464 struct devlink *devlink;1465 int err;1466 1467 devlink = priv_to_devlink(nsim_dev);1468 nsim_dev = devlink_priv(devlink);1469 INIT_LIST_HEAD(&nsim_dev->port_list);1470 nsim_dev->fw_update_status = true;1471 nsim_dev->fw_update_overwrite_mask = 0;1472 1473 nsim_devlink_param_load_driverinit_values(devlink);1474 1475 err = nsim_dev_dummy_region_init(nsim_dev, devlink);1476 if (err)1477 return err;1478 1479 err = nsim_dev_traps_init(devlink);1480 if (err)1481 goto err_dummy_region_exit;1482 1483 nsim_dev->fib_data = nsim_fib_create(devlink, extack);1484 if (IS_ERR(nsim_dev->fib_data)) {1485 err = PTR_ERR(nsim_dev->fib_data);1486 goto err_traps_exit;1487 }1488 1489 err = nsim_dev_health_init(nsim_dev, devlink);1490 if (err)1491 goto err_fib_destroy;1492 1493 err = nsim_dev_psample_init(nsim_dev);1494 if (err)1495 goto err_health_exit;1496 1497 err = nsim_dev_hwstats_init(nsim_dev);1498 if (err)1499 goto err_psample_exit;1500 1501 err = nsim_dev_port_add_all(nsim_dev, nsim_bus_dev->port_count);1502 if (err)1503 goto err_hwstats_exit;1504 1505 nsim_dev->take_snapshot = debugfs_create_file("take_snapshot",1506 0200,1507 nsim_dev->ddir,1508 nsim_dev,1509 &nsim_dev_take_snapshot_fops);1510 return 0;1511 1512err_hwstats_exit:1513 nsim_dev_hwstats_exit(nsim_dev);1514err_psample_exit:1515 nsim_dev_psample_exit(nsim_dev);1516err_health_exit:1517 nsim_dev_health_exit(nsim_dev);1518err_fib_destroy:1519 nsim_fib_destroy(devlink, nsim_dev->fib_data);1520err_traps_exit:1521 nsim_dev_traps_exit(devlink);1522err_dummy_region_exit:1523 nsim_dev_dummy_region_exit(nsim_dev);1524 return err;1525}1526 1527int nsim_drv_probe(struct nsim_bus_dev *nsim_bus_dev)1528{1529 struct nsim_dev *nsim_dev;1530 struct devlink *devlink;1531 int err;1532 1533 devlink = devlink_alloc_ns(&nsim_dev_devlink_ops, sizeof(*nsim_dev),1534 nsim_bus_dev->initial_net, &nsim_bus_dev->dev);1535 if (!devlink)1536 return -ENOMEM;1537 devl_lock(devlink);1538 nsim_dev = devlink_priv(devlink);1539 nsim_dev->nsim_bus_dev = nsim_bus_dev;1540 nsim_dev->switch_id.id_len = sizeof(nsim_dev->switch_id.id);1541 get_random_bytes(nsim_dev->switch_id.id, nsim_dev->switch_id.id_len);1542 INIT_LIST_HEAD(&nsim_dev->port_list);1543 nsim_dev->fw_update_status = true;1544 nsim_dev->fw_update_overwrite_mask = 0;1545 nsim_dev->max_macs = NSIM_DEV_MAX_MACS_DEFAULT;1546 nsim_dev->test1 = NSIM_DEV_TEST1_DEFAULT;1547 spin_lock_init(&nsim_dev->fa_cookie_lock);1548 1549 dev_set_drvdata(&nsim_bus_dev->dev, nsim_dev);1550 1551 nsim_dev->vfconfigs = kcalloc(nsim_bus_dev->max_vfs,1552 sizeof(struct nsim_vf_config),1553 GFP_KERNEL | __GFP_NOWARN);1554 if (!nsim_dev->vfconfigs) {1555 err = -ENOMEM;1556 goto err_devlink_unlock;1557 }1558 1559 err = devl_register(devlink);1560 if (err)1561 goto err_vfc_free;1562 1563 err = nsim_dev_resources_register(devlink);1564 if (err)1565 goto err_dl_unregister;1566 1567 err = devl_params_register(devlink, nsim_devlink_params,1568 ARRAY_SIZE(nsim_devlink_params));1569 if (err)1570 goto err_resource_unregister;1571 nsim_devlink_set_params_init_values(nsim_dev, devlink);1572 1573 err = nsim_dev_dummy_region_init(nsim_dev, devlink);1574 if (err)1575 goto err_params_unregister;1576 1577 err = nsim_dev_traps_init(devlink);1578 if (err)1579 goto err_dummy_region_exit;1580 1581 err = nsim_dev_debugfs_init(nsim_dev);1582 if (err)1583 goto err_traps_exit;1584 1585 nsim_dev->fib_data = nsim_fib_create(devlink, NULL);1586 if (IS_ERR(nsim_dev->fib_data)) {1587 err = PTR_ERR(nsim_dev->fib_data);1588 goto err_debugfs_exit;1589 }1590 1591 err = nsim_dev_health_init(nsim_dev, devlink);1592 if (err)1593 goto err_fib_destroy;1594 1595 err = nsim_bpf_dev_init(nsim_dev);1596 if (err)1597 goto err_health_exit;1598 1599 err = nsim_dev_psample_init(nsim_dev);1600 if (err)1601 goto err_bpf_dev_exit;1602 1603 err = nsim_dev_hwstats_init(nsim_dev);1604 if (err)1605 goto err_psample_exit;1606 1607 err = nsim_dev_port_add_all(nsim_dev, nsim_bus_dev->port_count);1608 if (err)1609 goto err_hwstats_exit;1610 1611 nsim_dev->esw_mode = DEVLINK_ESWITCH_MODE_LEGACY;1612 devl_unlock(devlink);1613 return 0;1614 1615err_hwstats_exit:1616 nsim_dev_hwstats_exit(nsim_dev);1617err_psample_exit:1618 nsim_dev_psample_exit(nsim_dev);1619err_bpf_dev_exit:1620 nsim_bpf_dev_exit(nsim_dev);1621err_health_exit:1622 nsim_dev_health_exit(nsim_dev);1623err_fib_destroy:1624 nsim_fib_destroy(devlink, nsim_dev->fib_data);1625err_debugfs_exit:1626 nsim_dev_debugfs_exit(nsim_dev);1627err_traps_exit:1628 nsim_dev_traps_exit(devlink);1629err_dummy_region_exit:1630 nsim_dev_dummy_region_exit(nsim_dev);1631err_params_unregister:1632 devl_params_unregister(devlink, nsim_devlink_params,1633 ARRAY_SIZE(nsim_devlink_params));1634err_resource_unregister:1635 devl_resources_unregister(devlink);1636err_dl_unregister:1637 devl_unregister(devlink);1638err_vfc_free:1639 kfree(nsim_dev->vfconfigs);1640err_devlink_unlock:1641 devl_unlock(devlink);1642 devlink_free(devlink);1643 dev_set_drvdata(&nsim_bus_dev->dev, NULL);1644 return err;1645}1646 1647static void nsim_dev_reload_destroy(struct nsim_dev *nsim_dev)1648{1649 struct devlink *devlink = priv_to_devlink(nsim_dev);1650 1651 if (devlink_is_reload_failed(devlink))1652 return;1653 debugfs_remove(nsim_dev->take_snapshot);1654 1655 if (nsim_dev_get_vfs(nsim_dev)) {1656 nsim_bus_dev_set_vfs(nsim_dev->nsim_bus_dev, 0);1657 if (nsim_esw_mode_is_switchdev(nsim_dev))1658 nsim_esw_legacy_enable(nsim_dev, NULL);1659 }1660 1661 nsim_dev_port_del_all(nsim_dev);1662 nsim_dev_hwstats_exit(nsim_dev);1663 nsim_dev_psample_exit(nsim_dev);1664 nsim_dev_health_exit(nsim_dev);1665 nsim_fib_destroy(devlink, nsim_dev->fib_data);1666 nsim_dev_traps_exit(devlink);1667 nsim_dev_dummy_region_exit(nsim_dev);1668}1669 1670void nsim_drv_remove(struct nsim_bus_dev *nsim_bus_dev)1671{1672 struct nsim_dev *nsim_dev = dev_get_drvdata(&nsim_bus_dev->dev);1673 struct devlink *devlink = priv_to_devlink(nsim_dev);1674 1675 devl_lock(devlink);1676 nsim_dev_reload_destroy(nsim_dev);1677 1678 nsim_bpf_dev_exit(nsim_dev);1679 nsim_dev_debugfs_exit(nsim_dev);1680 devl_params_unregister(devlink, nsim_devlink_params,1681 ARRAY_SIZE(nsim_devlink_params));1682 devl_resources_unregister(devlink);1683 devl_unregister(devlink);1684 kfree(nsim_dev->vfconfigs);1685 kfree(nsim_dev->fa_cookie);1686 devl_unlock(devlink);1687 devlink_free(devlink);1688 dev_set_drvdata(&nsim_bus_dev->dev, NULL);1689}1690 1691static struct nsim_dev_port *1692__nsim_dev_port_lookup(struct nsim_dev *nsim_dev, enum nsim_dev_port_type type,1693 unsigned int port_index)1694{1695 struct nsim_dev_port *nsim_dev_port;1696 1697 port_index = nsim_dev_port_index(type, port_index);1698 list_for_each_entry(nsim_dev_port, &nsim_dev->port_list, list)1699 if (nsim_dev_port->port_index == port_index)1700 return nsim_dev_port;1701 return NULL;1702}1703 1704int nsim_drv_port_add(struct nsim_bus_dev *nsim_bus_dev, enum nsim_dev_port_type type,1705 unsigned int port_index)1706{1707 struct nsim_dev *nsim_dev = dev_get_drvdata(&nsim_bus_dev->dev);1708 int err;1709 1710 devl_lock(priv_to_devlink(nsim_dev));1711 if (__nsim_dev_port_lookup(nsim_dev, type, port_index))1712 err = -EEXIST;1713 else1714 err = __nsim_dev_port_add(nsim_dev, type, port_index);1715 devl_unlock(priv_to_devlink(nsim_dev));1716 return err;1717}1718 1719int nsim_drv_port_del(struct nsim_bus_dev *nsim_bus_dev, enum nsim_dev_port_type type,1720 unsigned int port_index)1721{1722 struct nsim_dev *nsim_dev = dev_get_drvdata(&nsim_bus_dev->dev);1723 struct nsim_dev_port *nsim_dev_port;1724 int err = 0;1725 1726 devl_lock(priv_to_devlink(nsim_dev));1727 nsim_dev_port = __nsim_dev_port_lookup(nsim_dev, type, port_index);1728 if (!nsim_dev_port)1729 err = -ENOENT;1730 else1731 __nsim_dev_port_del(nsim_dev_port);1732 devl_unlock(priv_to_devlink(nsim_dev));1733 return err;1734}1735 1736int nsim_drv_configure_vfs(struct nsim_bus_dev *nsim_bus_dev,1737 unsigned int num_vfs)1738{1739 struct nsim_dev *nsim_dev = dev_get_drvdata(&nsim_bus_dev->dev);1740 struct devlink *devlink = priv_to_devlink(nsim_dev);1741 int ret = 0;1742 1743 devl_lock(devlink);1744 if (nsim_bus_dev->num_vfs == num_vfs)1745 goto exit_unlock;1746 if (nsim_bus_dev->num_vfs && num_vfs) {1747 ret = -EBUSY;1748 goto exit_unlock;1749 }1750 if (nsim_bus_dev->max_vfs < num_vfs) {1751 ret = -ENOMEM;1752 goto exit_unlock;1753 }1754 1755 nsim_bus_dev_set_vfs(nsim_bus_dev, num_vfs);1756 if (nsim_esw_mode_is_switchdev(nsim_dev)) {1757 if (num_vfs) {1758 ret = nsim_esw_switchdev_enable(nsim_dev, NULL);1759 if (ret) {1760 nsim_bus_dev_set_vfs(nsim_bus_dev, 0);1761 goto exit_unlock;1762 }1763 } else {1764 nsim_esw_legacy_enable(nsim_dev, NULL);1765 }1766 }1767 1768exit_unlock:1769 devl_unlock(devlink);1770 1771 return ret;1772}1773 1774int nsim_dev_init(void)1775{1776 nsim_dev_ddir = debugfs_create_dir(DRV_NAME, NULL);1777 return PTR_ERR_OR_ZERO(nsim_dev_ddir);1778}1779 1780void nsim_dev_exit(void)1781{1782 debugfs_remove_recursive(nsim_dev_ddir);1783}1784