2 * net/core/devlink.c - Network physical/parent device Netlink interface
4 * Heavily inspired by net/wireless/
5 * Copyright (c) 2016 Mellanox Technologies. All rights reserved.
6 * Copyright (c) 2016 Jiri Pirko <jiri@mellanox.com>
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
14 #include <linux/kernel.h>
15 #include <linux/module.h>
16 #include <linux/types.h>
17 #include <linux/slab.h>
18 #include <linux/gfp.h>
19 #include <linux/device.h>
20 #include <linux/list.h>
21 #include <linux/netdevice.h>
22 #include <rdma/ib_verbs.h>
23 #include <net/netlink.h>
24 #include <net/genetlink.h>
25 #include <net/rtnetlink.h>
26 #include <net/net_namespace.h>
28 #include <net/devlink.h>
29 #define CREATE_TRACE_POINTS
30 #include <trace/events/devlink.h>
32 static struct devlink_dpipe_field devlink_dpipe_fields_ethernet[] = {
34 .name = "destination mac",
35 .id = DEVLINK_DPIPE_FIELD_ETHERNET_DST_MAC,
40 struct devlink_dpipe_header devlink_dpipe_header_ethernet = {
42 .id = DEVLINK_DPIPE_HEADER_ETHERNET,
43 .fields = devlink_dpipe_fields_ethernet,
44 .fields_count = ARRAY_SIZE(devlink_dpipe_fields_ethernet),
47 EXPORT_SYMBOL(devlink_dpipe_header_ethernet);
49 static struct devlink_dpipe_field devlink_dpipe_fields_ipv4[] = {
51 .name = "destination ip",
52 .id = DEVLINK_DPIPE_FIELD_IPV4_DST_IP,
57 struct devlink_dpipe_header devlink_dpipe_header_ipv4 = {
59 .id = DEVLINK_DPIPE_HEADER_IPV4,
60 .fields = devlink_dpipe_fields_ipv4,
61 .fields_count = ARRAY_SIZE(devlink_dpipe_fields_ipv4),
64 EXPORT_SYMBOL(devlink_dpipe_header_ipv4);
66 static struct devlink_dpipe_field devlink_dpipe_fields_ipv6[] = {
68 .name = "destination ip",
69 .id = DEVLINK_DPIPE_FIELD_IPV6_DST_IP,
74 struct devlink_dpipe_header devlink_dpipe_header_ipv6 = {
76 .id = DEVLINK_DPIPE_HEADER_IPV6,
77 .fields = devlink_dpipe_fields_ipv6,
78 .fields_count = ARRAY_SIZE(devlink_dpipe_fields_ipv6),
81 EXPORT_SYMBOL(devlink_dpipe_header_ipv6);
83 EXPORT_TRACEPOINT_SYMBOL_GPL(devlink_hwmsg);
85 static LIST_HEAD(devlink_list);
89 * An overall lock guarding every operation coming from userspace.
90 * It also guards devlink devices list and it is taken when
91 * driver registers/unregisters it.
93 static DEFINE_MUTEX(devlink_mutex);
97 * Shared lock to guard lists of ports in all devlink devices.
99 static DEFINE_MUTEX(devlink_port_mutex);
101 static struct net *devlink_net(const struct devlink *devlink)
103 return read_pnet(&devlink->_net);
106 static void devlink_net_set(struct devlink *devlink, struct net *net)
108 write_pnet(&devlink->_net, net);
111 static struct devlink *devlink_get_from_attrs(struct net *net,
112 struct nlattr **attrs)
114 struct devlink *devlink;
118 if (!attrs[DEVLINK_ATTR_BUS_NAME] || !attrs[DEVLINK_ATTR_DEV_NAME])
119 return ERR_PTR(-EINVAL);
121 busname = nla_data(attrs[DEVLINK_ATTR_BUS_NAME]);
122 devname = nla_data(attrs[DEVLINK_ATTR_DEV_NAME]);
124 list_for_each_entry(devlink, &devlink_list, list) {
125 if (strcmp(devlink->dev->bus->name, busname) == 0 &&
126 strcmp(dev_name(devlink->dev), devname) == 0 &&
127 net_eq(devlink_net(devlink), net))
131 return ERR_PTR(-ENODEV);
134 static struct devlink *devlink_get_from_info(struct genl_info *info)
136 return devlink_get_from_attrs(genl_info_net(info), info->attrs);
139 static struct devlink_port *devlink_port_get_by_index(struct devlink *devlink,
142 struct devlink_port *devlink_port;
144 list_for_each_entry(devlink_port, &devlink->port_list, list) {
145 if (devlink_port->index == port_index)
151 static bool devlink_port_index_exists(struct devlink *devlink, int port_index)
153 return devlink_port_get_by_index(devlink, port_index);
156 static struct devlink_port *devlink_port_get_from_attrs(struct devlink *devlink,
157 struct nlattr **attrs)
159 if (attrs[DEVLINK_ATTR_PORT_INDEX]) {
160 u32 port_index = nla_get_u32(attrs[DEVLINK_ATTR_PORT_INDEX]);
161 struct devlink_port *devlink_port;
163 devlink_port = devlink_port_get_by_index(devlink, port_index);
165 return ERR_PTR(-ENODEV);
168 return ERR_PTR(-EINVAL);
171 static struct devlink_port *devlink_port_get_from_info(struct devlink *devlink,
172 struct genl_info *info)
174 return devlink_port_get_from_attrs(devlink, info->attrs);
178 struct list_head list;
181 u16 ingress_pools_count;
182 u16 egress_pools_count;
183 u16 ingress_tc_count;
187 static u16 devlink_sb_pool_count(struct devlink_sb *devlink_sb)
189 return devlink_sb->ingress_pools_count + devlink_sb->egress_pools_count;
192 static struct devlink_sb *devlink_sb_get_by_index(struct devlink *devlink,
193 unsigned int sb_index)
195 struct devlink_sb *devlink_sb;
197 list_for_each_entry(devlink_sb, &devlink->sb_list, list) {
198 if (devlink_sb->index == sb_index)
204 static bool devlink_sb_index_exists(struct devlink *devlink,
205 unsigned int sb_index)
207 return devlink_sb_get_by_index(devlink, sb_index);
210 static struct devlink_sb *devlink_sb_get_from_attrs(struct devlink *devlink,
211 struct nlattr **attrs)
213 if (attrs[DEVLINK_ATTR_SB_INDEX]) {
214 u32 sb_index = nla_get_u32(attrs[DEVLINK_ATTR_SB_INDEX]);
215 struct devlink_sb *devlink_sb;
217 devlink_sb = devlink_sb_get_by_index(devlink, sb_index);
219 return ERR_PTR(-ENODEV);
222 return ERR_PTR(-EINVAL);
225 static struct devlink_sb *devlink_sb_get_from_info(struct devlink *devlink,
226 struct genl_info *info)
228 return devlink_sb_get_from_attrs(devlink, info->attrs);
231 static int devlink_sb_pool_index_get_from_attrs(struct devlink_sb *devlink_sb,
232 struct nlattr **attrs,
237 if (!attrs[DEVLINK_ATTR_SB_POOL_INDEX])
240 val = nla_get_u16(attrs[DEVLINK_ATTR_SB_POOL_INDEX]);
241 if (val >= devlink_sb_pool_count(devlink_sb))
247 static int devlink_sb_pool_index_get_from_info(struct devlink_sb *devlink_sb,
248 struct genl_info *info,
251 return devlink_sb_pool_index_get_from_attrs(devlink_sb, info->attrs,
256 devlink_sb_pool_type_get_from_attrs(struct nlattr **attrs,
257 enum devlink_sb_pool_type *p_pool_type)
261 if (!attrs[DEVLINK_ATTR_SB_POOL_TYPE])
264 val = nla_get_u8(attrs[DEVLINK_ATTR_SB_POOL_TYPE]);
265 if (val != DEVLINK_SB_POOL_TYPE_INGRESS &&
266 val != DEVLINK_SB_POOL_TYPE_EGRESS)
273 devlink_sb_pool_type_get_from_info(struct genl_info *info,
274 enum devlink_sb_pool_type *p_pool_type)
276 return devlink_sb_pool_type_get_from_attrs(info->attrs, p_pool_type);
280 devlink_sb_th_type_get_from_attrs(struct nlattr **attrs,
281 enum devlink_sb_threshold_type *p_th_type)
285 if (!attrs[DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE])
288 val = nla_get_u8(attrs[DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE]);
289 if (val != DEVLINK_SB_THRESHOLD_TYPE_STATIC &&
290 val != DEVLINK_SB_THRESHOLD_TYPE_DYNAMIC)
297 devlink_sb_th_type_get_from_info(struct genl_info *info,
298 enum devlink_sb_threshold_type *p_th_type)
300 return devlink_sb_th_type_get_from_attrs(info->attrs, p_th_type);
304 devlink_sb_tc_index_get_from_attrs(struct devlink_sb *devlink_sb,
305 struct nlattr **attrs,
306 enum devlink_sb_pool_type pool_type,
311 if (!attrs[DEVLINK_ATTR_SB_TC_INDEX])
314 val = nla_get_u16(attrs[DEVLINK_ATTR_SB_TC_INDEX]);
315 if (pool_type == DEVLINK_SB_POOL_TYPE_INGRESS &&
316 val >= devlink_sb->ingress_tc_count)
318 if (pool_type == DEVLINK_SB_POOL_TYPE_EGRESS &&
319 val >= devlink_sb->egress_tc_count)
326 devlink_sb_tc_index_get_from_info(struct devlink_sb *devlink_sb,
327 struct genl_info *info,
328 enum devlink_sb_pool_type pool_type,
331 return devlink_sb_tc_index_get_from_attrs(devlink_sb, info->attrs,
332 pool_type, p_tc_index);
335 #define DEVLINK_NL_FLAG_NEED_DEVLINK BIT(0)
336 #define DEVLINK_NL_FLAG_NEED_PORT BIT(1)
337 #define DEVLINK_NL_FLAG_NEED_SB BIT(2)
338 #define DEVLINK_NL_FLAG_LOCK_PORTS BIT(3)
339 /* port is not needed but we need to ensure they don't
340 * change in the middle of command
343 static int devlink_nl_pre_doit(const struct genl_ops *ops,
344 struct sk_buff *skb, struct genl_info *info)
346 struct devlink *devlink;
348 mutex_lock(&devlink_mutex);
349 devlink = devlink_get_from_info(info);
350 if (IS_ERR(devlink)) {
351 mutex_unlock(&devlink_mutex);
352 return PTR_ERR(devlink);
354 if (ops->internal_flags & DEVLINK_NL_FLAG_NEED_DEVLINK) {
355 info->user_ptr[0] = devlink;
356 } else if (ops->internal_flags & DEVLINK_NL_FLAG_NEED_PORT) {
357 struct devlink_port *devlink_port;
359 mutex_lock(&devlink_port_mutex);
360 devlink_port = devlink_port_get_from_info(devlink, info);
361 if (IS_ERR(devlink_port)) {
362 mutex_unlock(&devlink_port_mutex);
363 mutex_unlock(&devlink_mutex);
364 return PTR_ERR(devlink_port);
366 info->user_ptr[0] = devlink_port;
368 if (ops->internal_flags & DEVLINK_NL_FLAG_LOCK_PORTS) {
369 mutex_lock(&devlink_port_mutex);
371 if (ops->internal_flags & DEVLINK_NL_FLAG_NEED_SB) {
372 struct devlink_sb *devlink_sb;
374 devlink_sb = devlink_sb_get_from_info(devlink, info);
375 if (IS_ERR(devlink_sb)) {
376 if (ops->internal_flags & DEVLINK_NL_FLAG_NEED_PORT)
377 mutex_unlock(&devlink_port_mutex);
378 mutex_unlock(&devlink_mutex);
379 return PTR_ERR(devlink_sb);
381 info->user_ptr[1] = devlink_sb;
386 static void devlink_nl_post_doit(const struct genl_ops *ops,
387 struct sk_buff *skb, struct genl_info *info)
389 if (ops->internal_flags & DEVLINK_NL_FLAG_NEED_PORT ||
390 ops->internal_flags & DEVLINK_NL_FLAG_LOCK_PORTS)
391 mutex_unlock(&devlink_port_mutex);
392 mutex_unlock(&devlink_mutex);
395 static struct genl_family devlink_nl_family;
397 enum devlink_multicast_groups {
398 DEVLINK_MCGRP_CONFIG,
401 static const struct genl_multicast_group devlink_nl_mcgrps[] = {
402 [DEVLINK_MCGRP_CONFIG] = { .name = DEVLINK_GENL_MCGRP_CONFIG_NAME },
405 static int devlink_nl_put_handle(struct sk_buff *msg, struct devlink *devlink)
407 if (nla_put_string(msg, DEVLINK_ATTR_BUS_NAME, devlink->dev->bus->name))
409 if (nla_put_string(msg, DEVLINK_ATTR_DEV_NAME, dev_name(devlink->dev)))
414 static int devlink_nl_fill(struct sk_buff *msg, struct devlink *devlink,
415 enum devlink_command cmd, u32 portid,
420 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
424 if (devlink_nl_put_handle(msg, devlink))
425 goto nla_put_failure;
427 genlmsg_end(msg, hdr);
431 genlmsg_cancel(msg, hdr);
435 static void devlink_notify(struct devlink *devlink, enum devlink_command cmd)
440 WARN_ON(cmd != DEVLINK_CMD_NEW && cmd != DEVLINK_CMD_DEL);
442 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
446 err = devlink_nl_fill(msg, devlink, cmd, 0, 0, 0);
452 genlmsg_multicast_netns(&devlink_nl_family, devlink_net(devlink),
453 msg, 0, DEVLINK_MCGRP_CONFIG, GFP_KERNEL);
456 static int devlink_nl_port_fill(struct sk_buff *msg, struct devlink *devlink,
457 struct devlink_port *devlink_port,
458 enum devlink_command cmd, u32 portid,
463 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
467 if (devlink_nl_put_handle(msg, devlink))
468 goto nla_put_failure;
469 if (nla_put_u32(msg, DEVLINK_ATTR_PORT_INDEX, devlink_port->index))
470 goto nla_put_failure;
471 if (nla_put_u16(msg, DEVLINK_ATTR_PORT_TYPE, devlink_port->type))
472 goto nla_put_failure;
473 if (devlink_port->desired_type != DEVLINK_PORT_TYPE_NOTSET &&
474 nla_put_u16(msg, DEVLINK_ATTR_PORT_DESIRED_TYPE,
475 devlink_port->desired_type))
476 goto nla_put_failure;
477 if (devlink_port->type == DEVLINK_PORT_TYPE_ETH) {
478 struct net_device *netdev = devlink_port->type_dev;
481 (nla_put_u32(msg, DEVLINK_ATTR_PORT_NETDEV_IFINDEX,
483 nla_put_string(msg, DEVLINK_ATTR_PORT_NETDEV_NAME,
485 goto nla_put_failure;
487 if (devlink_port->type == DEVLINK_PORT_TYPE_IB) {
488 struct ib_device *ibdev = devlink_port->type_dev;
491 nla_put_string(msg, DEVLINK_ATTR_PORT_IBDEV_NAME,
493 goto nla_put_failure;
495 if (devlink_port->split &&
496 nla_put_u32(msg, DEVLINK_ATTR_PORT_SPLIT_GROUP,
497 devlink_port->split_group))
498 goto nla_put_failure;
500 genlmsg_end(msg, hdr);
504 genlmsg_cancel(msg, hdr);
508 static void devlink_port_notify(struct devlink_port *devlink_port,
509 enum devlink_command cmd)
511 struct devlink *devlink = devlink_port->devlink;
515 if (!devlink_port->registered)
518 WARN_ON(cmd != DEVLINK_CMD_PORT_NEW && cmd != DEVLINK_CMD_PORT_DEL);
520 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
524 err = devlink_nl_port_fill(msg, devlink, devlink_port, cmd, 0, 0, 0);
530 genlmsg_multicast_netns(&devlink_nl_family, devlink_net(devlink),
531 msg, 0, DEVLINK_MCGRP_CONFIG, GFP_KERNEL);
534 static int devlink_nl_cmd_get_doit(struct sk_buff *skb, struct genl_info *info)
536 struct devlink *devlink = info->user_ptr[0];
540 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
544 err = devlink_nl_fill(msg, devlink, DEVLINK_CMD_NEW,
545 info->snd_portid, info->snd_seq, 0);
551 return genlmsg_reply(msg, info);
554 static int devlink_nl_cmd_get_dumpit(struct sk_buff *msg,
555 struct netlink_callback *cb)
557 struct devlink *devlink;
558 int start = cb->args[0];
562 mutex_lock(&devlink_mutex);
563 list_for_each_entry(devlink, &devlink_list, list) {
564 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)))
570 err = devlink_nl_fill(msg, devlink, DEVLINK_CMD_NEW,
571 NETLINK_CB(cb->skb).portid,
572 cb->nlh->nlmsg_seq, NLM_F_MULTI);
578 mutex_unlock(&devlink_mutex);
584 static int devlink_nl_cmd_port_get_doit(struct sk_buff *skb,
585 struct genl_info *info)
587 struct devlink_port *devlink_port = info->user_ptr[0];
588 struct devlink *devlink = devlink_port->devlink;
592 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
596 err = devlink_nl_port_fill(msg, devlink, devlink_port,
597 DEVLINK_CMD_PORT_NEW,
598 info->snd_portid, info->snd_seq, 0);
604 return genlmsg_reply(msg, info);
607 static int devlink_nl_cmd_port_get_dumpit(struct sk_buff *msg,
608 struct netlink_callback *cb)
610 struct devlink *devlink;
611 struct devlink_port *devlink_port;
612 int start = cb->args[0];
616 mutex_lock(&devlink_mutex);
617 mutex_lock(&devlink_port_mutex);
618 list_for_each_entry(devlink, &devlink_list, list) {
619 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)))
621 list_for_each_entry(devlink_port, &devlink->port_list, list) {
626 err = devlink_nl_port_fill(msg, devlink, devlink_port,
628 NETLINK_CB(cb->skb).portid,
637 mutex_unlock(&devlink_port_mutex);
638 mutex_unlock(&devlink_mutex);
644 static int devlink_port_type_set(struct devlink *devlink,
645 struct devlink_port *devlink_port,
646 enum devlink_port_type port_type)
651 if (devlink->ops && devlink->ops->port_type_set) {
652 if (port_type == DEVLINK_PORT_TYPE_NOTSET)
654 if (port_type == devlink_port->type)
656 err = devlink->ops->port_type_set(devlink_port, port_type);
659 devlink_port->desired_type = port_type;
660 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_NEW);
666 static int devlink_nl_cmd_port_set_doit(struct sk_buff *skb,
667 struct genl_info *info)
669 struct devlink_port *devlink_port = info->user_ptr[0];
670 struct devlink *devlink = devlink_port->devlink;
673 if (info->attrs[DEVLINK_ATTR_PORT_TYPE]) {
674 enum devlink_port_type port_type;
676 port_type = nla_get_u16(info->attrs[DEVLINK_ATTR_PORT_TYPE]);
677 err = devlink_port_type_set(devlink, devlink_port, port_type);
684 static int devlink_port_split(struct devlink *devlink,
685 u32 port_index, u32 count)
688 if (devlink->ops && devlink->ops->port_split)
689 return devlink->ops->port_split(devlink, port_index, count);
693 static int devlink_nl_cmd_port_split_doit(struct sk_buff *skb,
694 struct genl_info *info)
696 struct devlink *devlink = info->user_ptr[0];
700 if (!info->attrs[DEVLINK_ATTR_PORT_INDEX] ||
701 !info->attrs[DEVLINK_ATTR_PORT_SPLIT_COUNT])
704 port_index = nla_get_u32(info->attrs[DEVLINK_ATTR_PORT_INDEX]);
705 count = nla_get_u32(info->attrs[DEVLINK_ATTR_PORT_SPLIT_COUNT]);
706 return devlink_port_split(devlink, port_index, count);
709 static int devlink_port_unsplit(struct devlink *devlink, u32 port_index)
712 if (devlink->ops && devlink->ops->port_unsplit)
713 return devlink->ops->port_unsplit(devlink, port_index);
717 static int devlink_nl_cmd_port_unsplit_doit(struct sk_buff *skb,
718 struct genl_info *info)
720 struct devlink *devlink = info->user_ptr[0];
723 if (!info->attrs[DEVLINK_ATTR_PORT_INDEX])
726 port_index = nla_get_u32(info->attrs[DEVLINK_ATTR_PORT_INDEX]);
727 return devlink_port_unsplit(devlink, port_index);
730 static int devlink_nl_sb_fill(struct sk_buff *msg, struct devlink *devlink,
731 struct devlink_sb *devlink_sb,
732 enum devlink_command cmd, u32 portid,
737 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
741 if (devlink_nl_put_handle(msg, devlink))
742 goto nla_put_failure;
743 if (nla_put_u32(msg, DEVLINK_ATTR_SB_INDEX, devlink_sb->index))
744 goto nla_put_failure;
745 if (nla_put_u32(msg, DEVLINK_ATTR_SB_SIZE, devlink_sb->size))
746 goto nla_put_failure;
747 if (nla_put_u16(msg, DEVLINK_ATTR_SB_INGRESS_POOL_COUNT,
748 devlink_sb->ingress_pools_count))
749 goto nla_put_failure;
750 if (nla_put_u16(msg, DEVLINK_ATTR_SB_EGRESS_POOL_COUNT,
751 devlink_sb->egress_pools_count))
752 goto nla_put_failure;
753 if (nla_put_u16(msg, DEVLINK_ATTR_SB_INGRESS_TC_COUNT,
754 devlink_sb->ingress_tc_count))
755 goto nla_put_failure;
756 if (nla_put_u16(msg, DEVLINK_ATTR_SB_EGRESS_TC_COUNT,
757 devlink_sb->egress_tc_count))
758 goto nla_put_failure;
760 genlmsg_end(msg, hdr);
764 genlmsg_cancel(msg, hdr);
768 static int devlink_nl_cmd_sb_get_doit(struct sk_buff *skb,
769 struct genl_info *info)
771 struct devlink *devlink = info->user_ptr[0];
772 struct devlink_sb *devlink_sb = info->user_ptr[1];
776 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
780 err = devlink_nl_sb_fill(msg, devlink, devlink_sb,
782 info->snd_portid, info->snd_seq, 0);
788 return genlmsg_reply(msg, info);
791 static int devlink_nl_cmd_sb_get_dumpit(struct sk_buff *msg,
792 struct netlink_callback *cb)
794 struct devlink *devlink;
795 struct devlink_sb *devlink_sb;
796 int start = cb->args[0];
800 mutex_lock(&devlink_mutex);
801 list_for_each_entry(devlink, &devlink_list, list) {
802 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)))
804 list_for_each_entry(devlink_sb, &devlink->sb_list, list) {
809 err = devlink_nl_sb_fill(msg, devlink, devlink_sb,
811 NETLINK_CB(cb->skb).portid,
820 mutex_unlock(&devlink_mutex);
826 static int devlink_nl_sb_pool_fill(struct sk_buff *msg, struct devlink *devlink,
827 struct devlink_sb *devlink_sb,
828 u16 pool_index, enum devlink_command cmd,
829 u32 portid, u32 seq, int flags)
831 struct devlink_sb_pool_info pool_info;
835 err = devlink->ops->sb_pool_get(devlink, devlink_sb->index,
836 pool_index, &pool_info);
840 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
844 if (devlink_nl_put_handle(msg, devlink))
845 goto nla_put_failure;
846 if (nla_put_u32(msg, DEVLINK_ATTR_SB_INDEX, devlink_sb->index))
847 goto nla_put_failure;
848 if (nla_put_u16(msg, DEVLINK_ATTR_SB_POOL_INDEX, pool_index))
849 goto nla_put_failure;
850 if (nla_put_u8(msg, DEVLINK_ATTR_SB_POOL_TYPE, pool_info.pool_type))
851 goto nla_put_failure;
852 if (nla_put_u32(msg, DEVLINK_ATTR_SB_POOL_SIZE, pool_info.size))
853 goto nla_put_failure;
854 if (nla_put_u8(msg, DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE,
855 pool_info.threshold_type))
856 goto nla_put_failure;
858 genlmsg_end(msg, hdr);
862 genlmsg_cancel(msg, hdr);
866 static int devlink_nl_cmd_sb_pool_get_doit(struct sk_buff *skb,
867 struct genl_info *info)
869 struct devlink *devlink = info->user_ptr[0];
870 struct devlink_sb *devlink_sb = info->user_ptr[1];
875 err = devlink_sb_pool_index_get_from_info(devlink_sb, info,
880 if (!devlink->ops || !devlink->ops->sb_pool_get)
883 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
887 err = devlink_nl_sb_pool_fill(msg, devlink, devlink_sb, pool_index,
888 DEVLINK_CMD_SB_POOL_NEW,
889 info->snd_portid, info->snd_seq, 0);
895 return genlmsg_reply(msg, info);
898 static int __sb_pool_get_dumpit(struct sk_buff *msg, int start, int *p_idx,
899 struct devlink *devlink,
900 struct devlink_sb *devlink_sb,
903 u16 pool_count = devlink_sb_pool_count(devlink_sb);
907 for (pool_index = 0; pool_index < pool_count; pool_index++) {
908 if (*p_idx < start) {
912 err = devlink_nl_sb_pool_fill(msg, devlink,
915 DEVLINK_CMD_SB_POOL_NEW,
916 portid, seq, NLM_F_MULTI);
924 static int devlink_nl_cmd_sb_pool_get_dumpit(struct sk_buff *msg,
925 struct netlink_callback *cb)
927 struct devlink *devlink;
928 struct devlink_sb *devlink_sb;
929 int start = cb->args[0];
933 mutex_lock(&devlink_mutex);
934 list_for_each_entry(devlink, &devlink_list, list) {
935 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)) ||
936 !devlink->ops || !devlink->ops->sb_pool_get)
938 list_for_each_entry(devlink_sb, &devlink->sb_list, list) {
939 err = __sb_pool_get_dumpit(msg, start, &idx, devlink,
941 NETLINK_CB(cb->skb).portid,
943 if (err && err != -EOPNOTSUPP)
948 mutex_unlock(&devlink_mutex);
954 static int devlink_sb_pool_set(struct devlink *devlink, unsigned int sb_index,
955 u16 pool_index, u32 size,
956 enum devlink_sb_threshold_type threshold_type)
959 const struct devlink_ops *ops = devlink->ops;
961 if (ops && ops->sb_pool_set)
962 return ops->sb_pool_set(devlink, sb_index, pool_index,
963 size, threshold_type);
967 static int devlink_nl_cmd_sb_pool_set_doit(struct sk_buff *skb,
968 struct genl_info *info)
970 struct devlink *devlink = info->user_ptr[0];
971 struct devlink_sb *devlink_sb = info->user_ptr[1];
972 enum devlink_sb_threshold_type threshold_type;
977 err = devlink_sb_pool_index_get_from_info(devlink_sb, info,
982 err = devlink_sb_th_type_get_from_info(info, &threshold_type);
986 if (!info->attrs[DEVLINK_ATTR_SB_POOL_SIZE])
989 size = nla_get_u32(info->attrs[DEVLINK_ATTR_SB_POOL_SIZE]);
990 return devlink_sb_pool_set(devlink, devlink_sb->index,
991 pool_index, size, threshold_type);
994 static int devlink_nl_sb_port_pool_fill(struct sk_buff *msg,
995 struct devlink *devlink,
996 struct devlink_port *devlink_port,
997 struct devlink_sb *devlink_sb,
999 enum devlink_command cmd,
1000 u32 portid, u32 seq, int flags)
1002 const struct devlink_ops *ops = devlink->ops;
1007 err = ops->sb_port_pool_get(devlink_port, devlink_sb->index,
1008 pool_index, &threshold);
1012 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
1016 if (devlink_nl_put_handle(msg, devlink))
1017 goto nla_put_failure;
1018 if (nla_put_u32(msg, DEVLINK_ATTR_PORT_INDEX, devlink_port->index))
1019 goto nla_put_failure;
1020 if (nla_put_u32(msg, DEVLINK_ATTR_SB_INDEX, devlink_sb->index))
1021 goto nla_put_failure;
1022 if (nla_put_u16(msg, DEVLINK_ATTR_SB_POOL_INDEX, pool_index))
1023 goto nla_put_failure;
1024 if (nla_put_u32(msg, DEVLINK_ATTR_SB_THRESHOLD, threshold))
1025 goto nla_put_failure;
1027 if (ops->sb_occ_port_pool_get) {
1031 err = ops->sb_occ_port_pool_get(devlink_port, devlink_sb->index,
1032 pool_index, &cur, &max);
1033 if (err && err != -EOPNOTSUPP)
1034 goto sb_occ_get_failure;
1036 if (nla_put_u32(msg, DEVLINK_ATTR_SB_OCC_CUR, cur))
1037 goto nla_put_failure;
1038 if (nla_put_u32(msg, DEVLINK_ATTR_SB_OCC_MAX, max))
1039 goto nla_put_failure;
1043 genlmsg_end(msg, hdr);
1049 genlmsg_cancel(msg, hdr);
1053 static int devlink_nl_cmd_sb_port_pool_get_doit(struct sk_buff *skb,
1054 struct genl_info *info)
1056 struct devlink_port *devlink_port = info->user_ptr[0];
1057 struct devlink *devlink = devlink_port->devlink;
1058 struct devlink_sb *devlink_sb = info->user_ptr[1];
1059 struct sk_buff *msg;
1063 err = devlink_sb_pool_index_get_from_info(devlink_sb, info,
1068 if (!devlink->ops || !devlink->ops->sb_port_pool_get)
1071 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1075 err = devlink_nl_sb_port_pool_fill(msg, devlink, devlink_port,
1076 devlink_sb, pool_index,
1077 DEVLINK_CMD_SB_PORT_POOL_NEW,
1078 info->snd_portid, info->snd_seq, 0);
1084 return genlmsg_reply(msg, info);
1087 static int __sb_port_pool_get_dumpit(struct sk_buff *msg, int start, int *p_idx,
1088 struct devlink *devlink,
1089 struct devlink_sb *devlink_sb,
1090 u32 portid, u32 seq)
1092 struct devlink_port *devlink_port;
1093 u16 pool_count = devlink_sb_pool_count(devlink_sb);
1097 list_for_each_entry(devlink_port, &devlink->port_list, list) {
1098 for (pool_index = 0; pool_index < pool_count; pool_index++) {
1099 if (*p_idx < start) {
1103 err = devlink_nl_sb_port_pool_fill(msg, devlink,
1107 DEVLINK_CMD_SB_PORT_POOL_NEW,
1118 static int devlink_nl_cmd_sb_port_pool_get_dumpit(struct sk_buff *msg,
1119 struct netlink_callback *cb)
1121 struct devlink *devlink;
1122 struct devlink_sb *devlink_sb;
1123 int start = cb->args[0];
1127 mutex_lock(&devlink_mutex);
1128 mutex_lock(&devlink_port_mutex);
1129 list_for_each_entry(devlink, &devlink_list, list) {
1130 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)) ||
1131 !devlink->ops || !devlink->ops->sb_port_pool_get)
1133 list_for_each_entry(devlink_sb, &devlink->sb_list, list) {
1134 err = __sb_port_pool_get_dumpit(msg, start, &idx,
1135 devlink, devlink_sb,
1136 NETLINK_CB(cb->skb).portid,
1137 cb->nlh->nlmsg_seq);
1138 if (err && err != -EOPNOTSUPP)
1143 mutex_unlock(&devlink_port_mutex);
1144 mutex_unlock(&devlink_mutex);
1150 static int devlink_sb_port_pool_set(struct devlink_port *devlink_port,
1151 unsigned int sb_index, u16 pool_index,
1155 const struct devlink_ops *ops = devlink_port->devlink->ops;
1157 if (ops && ops->sb_port_pool_set)
1158 return ops->sb_port_pool_set(devlink_port, sb_index,
1159 pool_index, threshold);
1163 static int devlink_nl_cmd_sb_port_pool_set_doit(struct sk_buff *skb,
1164 struct genl_info *info)
1166 struct devlink_port *devlink_port = info->user_ptr[0];
1167 struct devlink_sb *devlink_sb = info->user_ptr[1];
1172 err = devlink_sb_pool_index_get_from_info(devlink_sb, info,
1177 if (!info->attrs[DEVLINK_ATTR_SB_THRESHOLD])
1180 threshold = nla_get_u32(info->attrs[DEVLINK_ATTR_SB_THRESHOLD]);
1181 return devlink_sb_port_pool_set(devlink_port, devlink_sb->index,
1182 pool_index, threshold);
1186 devlink_nl_sb_tc_pool_bind_fill(struct sk_buff *msg, struct devlink *devlink,
1187 struct devlink_port *devlink_port,
1188 struct devlink_sb *devlink_sb, u16 tc_index,
1189 enum devlink_sb_pool_type pool_type,
1190 enum devlink_command cmd,
1191 u32 portid, u32 seq, int flags)
1193 const struct devlink_ops *ops = devlink->ops;
1199 err = ops->sb_tc_pool_bind_get(devlink_port, devlink_sb->index,
1200 tc_index, pool_type,
1201 &pool_index, &threshold);
1205 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
1209 if (devlink_nl_put_handle(msg, devlink))
1210 goto nla_put_failure;
1211 if (nla_put_u32(msg, DEVLINK_ATTR_PORT_INDEX, devlink_port->index))
1212 goto nla_put_failure;
1213 if (nla_put_u32(msg, DEVLINK_ATTR_SB_INDEX, devlink_sb->index))
1214 goto nla_put_failure;
1215 if (nla_put_u16(msg, DEVLINK_ATTR_SB_TC_INDEX, tc_index))
1216 goto nla_put_failure;
1217 if (nla_put_u8(msg, DEVLINK_ATTR_SB_POOL_TYPE, pool_type))
1218 goto nla_put_failure;
1219 if (nla_put_u16(msg, DEVLINK_ATTR_SB_POOL_INDEX, pool_index))
1220 goto nla_put_failure;
1221 if (nla_put_u32(msg, DEVLINK_ATTR_SB_THRESHOLD, threshold))
1222 goto nla_put_failure;
1224 if (ops->sb_occ_tc_port_bind_get) {
1228 err = ops->sb_occ_tc_port_bind_get(devlink_port,
1230 tc_index, pool_type,
1232 if (err && err != -EOPNOTSUPP)
1235 if (nla_put_u32(msg, DEVLINK_ATTR_SB_OCC_CUR, cur))
1236 goto nla_put_failure;
1237 if (nla_put_u32(msg, DEVLINK_ATTR_SB_OCC_MAX, max))
1238 goto nla_put_failure;
1242 genlmsg_end(msg, hdr);
1246 genlmsg_cancel(msg, hdr);
1250 static int devlink_nl_cmd_sb_tc_pool_bind_get_doit(struct sk_buff *skb,
1251 struct genl_info *info)
1253 struct devlink_port *devlink_port = info->user_ptr[0];
1254 struct devlink *devlink = devlink_port->devlink;
1255 struct devlink_sb *devlink_sb = info->user_ptr[1];
1256 struct sk_buff *msg;
1257 enum devlink_sb_pool_type pool_type;
1261 err = devlink_sb_pool_type_get_from_info(info, &pool_type);
1265 err = devlink_sb_tc_index_get_from_info(devlink_sb, info,
1266 pool_type, &tc_index);
1270 if (!devlink->ops || !devlink->ops->sb_tc_pool_bind_get)
1273 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1277 err = devlink_nl_sb_tc_pool_bind_fill(msg, devlink, devlink_port,
1278 devlink_sb, tc_index, pool_type,
1279 DEVLINK_CMD_SB_TC_POOL_BIND_NEW,
1287 return genlmsg_reply(msg, info);
1290 static int __sb_tc_pool_bind_get_dumpit(struct sk_buff *msg,
1291 int start, int *p_idx,
1292 struct devlink *devlink,
1293 struct devlink_sb *devlink_sb,
1294 u32 portid, u32 seq)
1296 struct devlink_port *devlink_port;
1300 list_for_each_entry(devlink_port, &devlink->port_list, list) {
1302 tc_index < devlink_sb->ingress_tc_count; tc_index++) {
1303 if (*p_idx < start) {
1307 err = devlink_nl_sb_tc_pool_bind_fill(msg, devlink,
1311 DEVLINK_SB_POOL_TYPE_INGRESS,
1312 DEVLINK_CMD_SB_TC_POOL_BIND_NEW,
1320 tc_index < devlink_sb->egress_tc_count; tc_index++) {
1321 if (*p_idx < start) {
1325 err = devlink_nl_sb_tc_pool_bind_fill(msg, devlink,
1329 DEVLINK_SB_POOL_TYPE_EGRESS,
1330 DEVLINK_CMD_SB_TC_POOL_BIND_NEW,
1342 devlink_nl_cmd_sb_tc_pool_bind_get_dumpit(struct sk_buff *msg,
1343 struct netlink_callback *cb)
1345 struct devlink *devlink;
1346 struct devlink_sb *devlink_sb;
1347 int start = cb->args[0];
1351 mutex_lock(&devlink_mutex);
1352 mutex_lock(&devlink_port_mutex);
1353 list_for_each_entry(devlink, &devlink_list, list) {
1354 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)) ||
1355 !devlink->ops || !devlink->ops->sb_tc_pool_bind_get)
1357 list_for_each_entry(devlink_sb, &devlink->sb_list, list) {
1358 err = __sb_tc_pool_bind_get_dumpit(msg, start, &idx,
1361 NETLINK_CB(cb->skb).portid,
1362 cb->nlh->nlmsg_seq);
1363 if (err && err != -EOPNOTSUPP)
1368 mutex_unlock(&devlink_port_mutex);
1369 mutex_unlock(&devlink_mutex);
1375 static int devlink_sb_tc_pool_bind_set(struct devlink_port *devlink_port,
1376 unsigned int sb_index, u16 tc_index,
1377 enum devlink_sb_pool_type pool_type,
1378 u16 pool_index, u32 threshold)
1381 const struct devlink_ops *ops = devlink_port->devlink->ops;
1383 if (ops && ops->sb_tc_pool_bind_set)
1384 return ops->sb_tc_pool_bind_set(devlink_port, sb_index,
1385 tc_index, pool_type,
1386 pool_index, threshold);
1390 static int devlink_nl_cmd_sb_tc_pool_bind_set_doit(struct sk_buff *skb,
1391 struct genl_info *info)
1393 struct devlink_port *devlink_port = info->user_ptr[0];
1394 struct devlink_sb *devlink_sb = info->user_ptr[1];
1395 enum devlink_sb_pool_type pool_type;
1401 err = devlink_sb_pool_type_get_from_info(info, &pool_type);
1405 err = devlink_sb_tc_index_get_from_info(devlink_sb, info,
1406 pool_type, &tc_index);
1410 err = devlink_sb_pool_index_get_from_info(devlink_sb, info,
1415 if (!info->attrs[DEVLINK_ATTR_SB_THRESHOLD])
1418 threshold = nla_get_u32(info->attrs[DEVLINK_ATTR_SB_THRESHOLD]);
1419 return devlink_sb_tc_pool_bind_set(devlink_port, devlink_sb->index,
1420 tc_index, pool_type,
1421 pool_index, threshold);
1424 static int devlink_nl_cmd_sb_occ_snapshot_doit(struct sk_buff *skb,
1425 struct genl_info *info)
1427 struct devlink *devlink = info->user_ptr[0];
1428 struct devlink_sb *devlink_sb = info->user_ptr[1];
1429 const struct devlink_ops *ops = devlink->ops;
1431 if (ops && ops->sb_occ_snapshot)
1432 return ops->sb_occ_snapshot(devlink, devlink_sb->index);
1436 static int devlink_nl_cmd_sb_occ_max_clear_doit(struct sk_buff *skb,
1437 struct genl_info *info)
1439 struct devlink *devlink = info->user_ptr[0];
1440 struct devlink_sb *devlink_sb = info->user_ptr[1];
1441 const struct devlink_ops *ops = devlink->ops;
1443 if (ops && ops->sb_occ_max_clear)
1444 return ops->sb_occ_max_clear(devlink, devlink_sb->index);
1448 static int devlink_nl_eswitch_fill(struct sk_buff *msg, struct devlink *devlink,
1449 enum devlink_command cmd, u32 portid,
1452 const struct devlink_ops *ops = devlink->ops;
1453 u8 inline_mode, encap_mode;
1458 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
1462 err = devlink_nl_put_handle(msg, devlink);
1464 goto nla_put_failure;
1466 if (ops->eswitch_mode_get) {
1467 err = ops->eswitch_mode_get(devlink, &mode);
1469 goto nla_put_failure;
1470 err = nla_put_u16(msg, DEVLINK_ATTR_ESWITCH_MODE, mode);
1472 goto nla_put_failure;
1475 if (ops->eswitch_inline_mode_get) {
1476 err = ops->eswitch_inline_mode_get(devlink, &inline_mode);
1478 goto nla_put_failure;
1479 err = nla_put_u8(msg, DEVLINK_ATTR_ESWITCH_INLINE_MODE,
1482 goto nla_put_failure;
1485 if (ops->eswitch_encap_mode_get) {
1486 err = ops->eswitch_encap_mode_get(devlink, &encap_mode);
1488 goto nla_put_failure;
1489 err = nla_put_u8(msg, DEVLINK_ATTR_ESWITCH_ENCAP_MODE, encap_mode);
1491 goto nla_put_failure;
1494 genlmsg_end(msg, hdr);
1498 genlmsg_cancel(msg, hdr);
1502 static int devlink_nl_cmd_eswitch_get_doit(struct sk_buff *skb,
1503 struct genl_info *info)
1505 struct devlink *devlink = info->user_ptr[0];
1506 const struct devlink_ops *ops = devlink->ops;
1507 struct sk_buff *msg;
1513 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1517 err = devlink_nl_eswitch_fill(msg, devlink, DEVLINK_CMD_ESWITCH_GET,
1518 info->snd_portid, info->snd_seq, 0);
1525 return genlmsg_reply(msg, info);
1528 static int devlink_nl_cmd_eswitch_set_doit(struct sk_buff *skb,
1529 struct genl_info *info)
1531 struct devlink *devlink = info->user_ptr[0];
1532 const struct devlink_ops *ops = devlink->ops;
1533 u8 inline_mode, encap_mode;
1540 if (info->attrs[DEVLINK_ATTR_ESWITCH_MODE]) {
1541 if (!ops->eswitch_mode_set)
1543 mode = nla_get_u16(info->attrs[DEVLINK_ATTR_ESWITCH_MODE]);
1544 err = ops->eswitch_mode_set(devlink, mode);
1549 if (info->attrs[DEVLINK_ATTR_ESWITCH_INLINE_MODE]) {
1550 if (!ops->eswitch_inline_mode_set)
1552 inline_mode = nla_get_u8(
1553 info->attrs[DEVLINK_ATTR_ESWITCH_INLINE_MODE]);
1554 err = ops->eswitch_inline_mode_set(devlink, inline_mode);
1559 if (info->attrs[DEVLINK_ATTR_ESWITCH_ENCAP_MODE]) {
1560 if (!ops->eswitch_encap_mode_set)
1562 encap_mode = nla_get_u8(info->attrs[DEVLINK_ATTR_ESWITCH_ENCAP_MODE]);
1563 err = ops->eswitch_encap_mode_set(devlink, encap_mode);
1571 int devlink_dpipe_match_put(struct sk_buff *skb,
1572 struct devlink_dpipe_match *match)
1574 struct devlink_dpipe_header *header = match->header;
1575 struct devlink_dpipe_field *field = &header->fields[match->field_id];
1576 struct nlattr *match_attr;
1578 match_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_MATCH);
1582 if (nla_put_u32(skb, DEVLINK_ATTR_DPIPE_MATCH_TYPE, match->type) ||
1583 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_INDEX, match->header_index) ||
1584 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_ID, header->id) ||
1585 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_ID, field->id) ||
1586 nla_put_u8(skb, DEVLINK_ATTR_DPIPE_HEADER_GLOBAL, header->global))
1587 goto nla_put_failure;
1589 nla_nest_end(skb, match_attr);
1593 nla_nest_cancel(skb, match_attr);
1596 EXPORT_SYMBOL_GPL(devlink_dpipe_match_put);
1598 static int devlink_dpipe_matches_put(struct devlink_dpipe_table *table,
1599 struct sk_buff *skb)
1601 struct nlattr *matches_attr;
1603 matches_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_TABLE_MATCHES);
1607 if (table->table_ops->matches_dump(table->priv, skb))
1608 goto nla_put_failure;
1610 nla_nest_end(skb, matches_attr);
1614 nla_nest_cancel(skb, matches_attr);
1618 int devlink_dpipe_action_put(struct sk_buff *skb,
1619 struct devlink_dpipe_action *action)
1621 struct devlink_dpipe_header *header = action->header;
1622 struct devlink_dpipe_field *field = &header->fields[action->field_id];
1623 struct nlattr *action_attr;
1625 action_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_ACTION);
1629 if (nla_put_u32(skb, DEVLINK_ATTR_DPIPE_ACTION_TYPE, action->type) ||
1630 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_INDEX, action->header_index) ||
1631 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_ID, header->id) ||
1632 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_ID, field->id) ||
1633 nla_put_u8(skb, DEVLINK_ATTR_DPIPE_HEADER_GLOBAL, header->global))
1634 goto nla_put_failure;
1636 nla_nest_end(skb, action_attr);
1640 nla_nest_cancel(skb, action_attr);
1643 EXPORT_SYMBOL_GPL(devlink_dpipe_action_put);
1645 static int devlink_dpipe_actions_put(struct devlink_dpipe_table *table,
1646 struct sk_buff *skb)
1648 struct nlattr *actions_attr;
1650 actions_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_TABLE_ACTIONS);
1654 if (table->table_ops->actions_dump(table->priv, skb))
1655 goto nla_put_failure;
1657 nla_nest_end(skb, actions_attr);
1661 nla_nest_cancel(skb, actions_attr);
1665 static int devlink_dpipe_table_put(struct sk_buff *skb,
1666 struct devlink_dpipe_table *table)
1668 struct nlattr *table_attr;
1671 table_size = table->table_ops->size_get(table->priv);
1672 table_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_TABLE);
1676 if (nla_put_string(skb, DEVLINK_ATTR_DPIPE_TABLE_NAME, table->name) ||
1677 nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_TABLE_SIZE, table_size,
1679 goto nla_put_failure;
1680 if (nla_put_u8(skb, DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED,
1681 table->counters_enabled))
1682 goto nla_put_failure;
1684 if (devlink_dpipe_matches_put(table, skb))
1685 goto nla_put_failure;
1687 if (devlink_dpipe_actions_put(table, skb))
1688 goto nla_put_failure;
1690 nla_nest_end(skb, table_attr);
1694 nla_nest_cancel(skb, table_attr);
1698 static int devlink_dpipe_send_and_alloc_skb(struct sk_buff **pskb,
1699 struct genl_info *info)
1704 err = genlmsg_reply(*pskb, info);
1708 *pskb = genlmsg_new(GENLMSG_DEFAULT_SIZE, GFP_KERNEL);
1714 static int devlink_dpipe_tables_fill(struct genl_info *info,
1715 enum devlink_command cmd, int flags,
1716 struct list_head *dpipe_tables,
1717 const char *table_name)
1719 struct devlink *devlink = info->user_ptr[0];
1720 struct devlink_dpipe_table *table;
1721 struct nlattr *tables_attr;
1722 struct sk_buff *skb = NULL;
1723 struct nlmsghdr *nlh;
1729 table = list_first_entry(dpipe_tables,
1730 struct devlink_dpipe_table, list);
1732 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
1736 hdr = genlmsg_put(skb, info->snd_portid, info->snd_seq,
1737 &devlink_nl_family, NLM_F_MULTI, cmd);
1743 if (devlink_nl_put_handle(skb, devlink))
1744 goto nla_put_failure;
1745 tables_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_TABLES);
1747 goto nla_put_failure;
1751 list_for_each_entry_from(table, dpipe_tables, list) {
1753 err = devlink_dpipe_table_put(skb, table);
1761 if (!strcmp(table->name, table_name)) {
1762 err = devlink_dpipe_table_put(skb, table);
1770 nla_nest_end(skb, tables_attr);
1771 genlmsg_end(skb, hdr);
1776 nlh = nlmsg_put(skb, info->snd_portid, info->snd_seq,
1777 NLMSG_DONE, 0, flags | NLM_F_MULTI);
1779 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
1785 return genlmsg_reply(skb, info);
1790 genlmsg_cancel(skb, hdr);
1795 static int devlink_nl_cmd_dpipe_table_get(struct sk_buff *skb,
1796 struct genl_info *info)
1798 struct devlink *devlink = info->user_ptr[0];
1799 const char *table_name = NULL;
1801 if (info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME])
1802 table_name = nla_data(info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME]);
1804 return devlink_dpipe_tables_fill(info, DEVLINK_CMD_DPIPE_TABLE_GET, 0,
1805 &devlink->dpipe_table_list,
1809 static int devlink_dpipe_value_put(struct sk_buff *skb,
1810 struct devlink_dpipe_value *value)
1812 if (nla_put(skb, DEVLINK_ATTR_DPIPE_VALUE,
1813 value->value_size, value->value))
1816 if (nla_put(skb, DEVLINK_ATTR_DPIPE_VALUE_MASK,
1817 value->value_size, value->mask))
1819 if (value->mapping_valid)
1820 if (nla_put_u32(skb, DEVLINK_ATTR_DPIPE_VALUE_MAPPING,
1821 value->mapping_value))
1826 static int devlink_dpipe_action_value_put(struct sk_buff *skb,
1827 struct devlink_dpipe_value *value)
1831 if (devlink_dpipe_action_put(skb, value->action))
1833 if (devlink_dpipe_value_put(skb, value))
1838 static int devlink_dpipe_action_values_put(struct sk_buff *skb,
1839 struct devlink_dpipe_value *values,
1840 unsigned int values_count)
1842 struct nlattr *action_attr;
1846 for (i = 0; i < values_count; i++) {
1847 action_attr = nla_nest_start(skb,
1848 DEVLINK_ATTR_DPIPE_ACTION_VALUE);
1851 err = devlink_dpipe_action_value_put(skb, &values[i]);
1853 goto err_action_value_put;
1854 nla_nest_end(skb, action_attr);
1858 err_action_value_put:
1859 nla_nest_cancel(skb, action_attr);
1863 static int devlink_dpipe_match_value_put(struct sk_buff *skb,
1864 struct devlink_dpipe_value *value)
1868 if (devlink_dpipe_match_put(skb, value->match))
1870 if (devlink_dpipe_value_put(skb, value))
1875 static int devlink_dpipe_match_values_put(struct sk_buff *skb,
1876 struct devlink_dpipe_value *values,
1877 unsigned int values_count)
1879 struct nlattr *match_attr;
1883 for (i = 0; i < values_count; i++) {
1884 match_attr = nla_nest_start(skb,
1885 DEVLINK_ATTR_DPIPE_MATCH_VALUE);
1888 err = devlink_dpipe_match_value_put(skb, &values[i]);
1890 goto err_match_value_put;
1891 nla_nest_end(skb, match_attr);
1895 err_match_value_put:
1896 nla_nest_cancel(skb, match_attr);
1900 static int devlink_dpipe_entry_put(struct sk_buff *skb,
1901 struct devlink_dpipe_entry *entry)
1903 struct nlattr *entry_attr, *matches_attr, *actions_attr;
1906 entry_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_ENTRY);
1910 if (nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_ENTRY_INDEX, entry->index,
1912 goto nla_put_failure;
1913 if (entry->counter_valid)
1914 if (nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_ENTRY_COUNTER,
1915 entry->counter, DEVLINK_ATTR_PAD))
1916 goto nla_put_failure;
1918 matches_attr = nla_nest_start(skb,
1919 DEVLINK_ATTR_DPIPE_ENTRY_MATCH_VALUES);
1921 goto nla_put_failure;
1923 err = devlink_dpipe_match_values_put(skb, entry->match_values,
1924 entry->match_values_count);
1926 nla_nest_cancel(skb, matches_attr);
1927 goto err_match_values_put;
1929 nla_nest_end(skb, matches_attr);
1931 actions_attr = nla_nest_start(skb,
1932 DEVLINK_ATTR_DPIPE_ENTRY_ACTION_VALUES);
1934 goto nla_put_failure;
1936 err = devlink_dpipe_action_values_put(skb, entry->action_values,
1937 entry->action_values_count);
1939 nla_nest_cancel(skb, actions_attr);
1940 goto err_action_values_put;
1942 nla_nest_end(skb, actions_attr);
1944 nla_nest_end(skb, entry_attr);
1949 err_match_values_put:
1950 err_action_values_put:
1951 nla_nest_cancel(skb, entry_attr);
1955 static struct devlink_dpipe_table *
1956 devlink_dpipe_table_find(struct list_head *dpipe_tables,
1957 const char *table_name)
1959 struct devlink_dpipe_table *table;
1961 list_for_each_entry_rcu(table, dpipe_tables, list) {
1962 if (!strcmp(table->name, table_name))
1968 int devlink_dpipe_entry_ctx_prepare(struct devlink_dpipe_dump_ctx *dump_ctx)
1970 struct devlink *devlink;
1973 err = devlink_dpipe_send_and_alloc_skb(&dump_ctx->skb,
1978 dump_ctx->hdr = genlmsg_put(dump_ctx->skb,
1979 dump_ctx->info->snd_portid,
1980 dump_ctx->info->snd_seq,
1981 &devlink_nl_family, NLM_F_MULTI,
1984 goto nla_put_failure;
1986 devlink = dump_ctx->info->user_ptr[0];
1987 if (devlink_nl_put_handle(dump_ctx->skb, devlink))
1988 goto nla_put_failure;
1989 dump_ctx->nest = nla_nest_start(dump_ctx->skb,
1990 DEVLINK_ATTR_DPIPE_ENTRIES);
1991 if (!dump_ctx->nest)
1992 goto nla_put_failure;
1996 genlmsg_cancel(dump_ctx->skb, dump_ctx->hdr);
1997 nlmsg_free(dump_ctx->skb);
2000 EXPORT_SYMBOL_GPL(devlink_dpipe_entry_ctx_prepare);
2002 int devlink_dpipe_entry_ctx_append(struct devlink_dpipe_dump_ctx *dump_ctx,
2003 struct devlink_dpipe_entry *entry)
2005 return devlink_dpipe_entry_put(dump_ctx->skb, entry);
2007 EXPORT_SYMBOL_GPL(devlink_dpipe_entry_ctx_append);
2009 int devlink_dpipe_entry_ctx_close(struct devlink_dpipe_dump_ctx *dump_ctx)
2011 nla_nest_end(dump_ctx->skb, dump_ctx->nest);
2012 genlmsg_end(dump_ctx->skb, dump_ctx->hdr);
2015 EXPORT_SYMBOL_GPL(devlink_dpipe_entry_ctx_close);
2017 void devlink_dpipe_entry_clear(struct devlink_dpipe_entry *entry)
2020 unsigned int value_count, value_index;
2021 struct devlink_dpipe_value *value;
2023 value = entry->action_values;
2024 value_count = entry->action_values_count;
2025 for (value_index = 0; value_index < value_count; value_index++) {
2026 kfree(value[value_index].value);
2027 kfree(value[value_index].mask);
2030 value = entry->match_values;
2031 value_count = entry->match_values_count;
2032 for (value_index = 0; value_index < value_count; value_index++) {
2033 kfree(value[value_index].value);
2034 kfree(value[value_index].mask);
2037 EXPORT_SYMBOL(devlink_dpipe_entry_clear);
2039 static int devlink_dpipe_entries_fill(struct genl_info *info,
2040 enum devlink_command cmd, int flags,
2041 struct devlink_dpipe_table *table)
2043 struct devlink_dpipe_dump_ctx dump_ctx;
2044 struct nlmsghdr *nlh;
2047 dump_ctx.skb = NULL;
2049 dump_ctx.info = info;
2051 err = table->table_ops->entries_dump(table->priv,
2052 table->counters_enabled,
2058 nlh = nlmsg_put(dump_ctx.skb, info->snd_portid, info->snd_seq,
2059 NLMSG_DONE, 0, flags | NLM_F_MULTI);
2061 err = devlink_dpipe_send_and_alloc_skb(&dump_ctx.skb, info);
2066 return genlmsg_reply(dump_ctx.skb, info);
2069 static int devlink_nl_cmd_dpipe_entries_get(struct sk_buff *skb,
2070 struct genl_info *info)
2072 struct devlink *devlink = info->user_ptr[0];
2073 struct devlink_dpipe_table *table;
2074 const char *table_name;
2076 if (!info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME])
2079 table_name = nla_data(info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME]);
2080 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
2085 if (!table->table_ops->entries_dump)
2088 return devlink_dpipe_entries_fill(info, DEVLINK_CMD_DPIPE_ENTRIES_GET,
2092 static int devlink_dpipe_fields_put(struct sk_buff *skb,
2093 const struct devlink_dpipe_header *header)
2095 struct devlink_dpipe_field *field;
2096 struct nlattr *field_attr;
2099 for (i = 0; i < header->fields_count; i++) {
2100 field = &header->fields[i];
2101 field_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_FIELD);
2104 if (nla_put_string(skb, DEVLINK_ATTR_DPIPE_FIELD_NAME, field->name) ||
2105 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_ID, field->id) ||
2106 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_BITWIDTH, field->bitwidth) ||
2107 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_MAPPING_TYPE, field->mapping_type))
2108 goto nla_put_failure;
2109 nla_nest_end(skb, field_attr);
2114 nla_nest_cancel(skb, field_attr);
2118 static int devlink_dpipe_header_put(struct sk_buff *skb,
2119 struct devlink_dpipe_header *header)
2121 struct nlattr *fields_attr, *header_attr;
2124 header_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_HEADER);
2128 if (nla_put_string(skb, DEVLINK_ATTR_DPIPE_HEADER_NAME, header->name) ||
2129 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_ID, header->id) ||
2130 nla_put_u8(skb, DEVLINK_ATTR_DPIPE_HEADER_GLOBAL, header->global))
2131 goto nla_put_failure;
2133 fields_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_HEADER_FIELDS);
2135 goto nla_put_failure;
2137 err = devlink_dpipe_fields_put(skb, header);
2139 nla_nest_cancel(skb, fields_attr);
2140 goto nla_put_failure;
2142 nla_nest_end(skb, fields_attr);
2143 nla_nest_end(skb, header_attr);
2148 nla_nest_cancel(skb, header_attr);
2152 static int devlink_dpipe_headers_fill(struct genl_info *info,
2153 enum devlink_command cmd, int flags,
2154 struct devlink_dpipe_headers *
2157 struct devlink *devlink = info->user_ptr[0];
2158 struct nlattr *headers_attr;
2159 struct sk_buff *skb = NULL;
2160 struct nlmsghdr *nlh;
2167 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
2171 hdr = genlmsg_put(skb, info->snd_portid, info->snd_seq,
2172 &devlink_nl_family, NLM_F_MULTI, cmd);
2178 if (devlink_nl_put_handle(skb, devlink))
2179 goto nla_put_failure;
2180 headers_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_HEADERS);
2182 goto nla_put_failure;
2185 for (; i < dpipe_headers->headers_count; i++) {
2186 err = devlink_dpipe_header_put(skb, dpipe_headers->headers[i]);
2194 nla_nest_end(skb, headers_attr);
2195 genlmsg_end(skb, hdr);
2196 if (i != dpipe_headers->headers_count)
2200 nlh = nlmsg_put(skb, info->snd_portid, info->snd_seq,
2201 NLMSG_DONE, 0, flags | NLM_F_MULTI);
2203 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
2208 return genlmsg_reply(skb, info);
2213 genlmsg_cancel(skb, hdr);
2218 static int devlink_nl_cmd_dpipe_headers_get(struct sk_buff *skb,
2219 struct genl_info *info)
2221 struct devlink *devlink = info->user_ptr[0];
2223 if (!devlink->dpipe_headers)
2225 return devlink_dpipe_headers_fill(info, DEVLINK_CMD_DPIPE_HEADERS_GET,
2226 0, devlink->dpipe_headers);
2229 static int devlink_dpipe_table_counters_set(struct devlink *devlink,
2230 const char *table_name,
2233 struct devlink_dpipe_table *table;
2235 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
2240 if (table->counter_control_extern)
2243 if (!(table->counters_enabled ^ enable))
2246 table->counters_enabled = enable;
2247 if (table->table_ops->counters_set_update)
2248 table->table_ops->counters_set_update(table->priv, enable);
2252 static int devlink_nl_cmd_dpipe_table_counters_set(struct sk_buff *skb,
2253 struct genl_info *info)
2255 struct devlink *devlink = info->user_ptr[0];
2256 const char *table_name;
2257 bool counters_enable;
2259 if (!info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME] ||
2260 !info->attrs[DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED])
2263 table_name = nla_data(info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME]);
2264 counters_enable = !!nla_get_u8(info->attrs[DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED]);
2266 return devlink_dpipe_table_counters_set(devlink, table_name,
2270 static const struct nla_policy devlink_nl_policy[DEVLINK_ATTR_MAX + 1] = {
2271 [DEVLINK_ATTR_BUS_NAME] = { .type = NLA_NUL_STRING },
2272 [DEVLINK_ATTR_DEV_NAME] = { .type = NLA_NUL_STRING },
2273 [DEVLINK_ATTR_PORT_INDEX] = { .type = NLA_U32 },
2274 [DEVLINK_ATTR_PORT_TYPE] = { .type = NLA_U16 },
2275 [DEVLINK_ATTR_PORT_SPLIT_COUNT] = { .type = NLA_U32 },
2276 [DEVLINK_ATTR_SB_INDEX] = { .type = NLA_U32 },
2277 [DEVLINK_ATTR_SB_POOL_INDEX] = { .type = NLA_U16 },
2278 [DEVLINK_ATTR_SB_POOL_TYPE] = { .type = NLA_U8 },
2279 [DEVLINK_ATTR_SB_POOL_SIZE] = { .type = NLA_U32 },
2280 [DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE] = { .type = NLA_U8 },
2281 [DEVLINK_ATTR_SB_THRESHOLD] = { .type = NLA_U32 },
2282 [DEVLINK_ATTR_SB_TC_INDEX] = { .type = NLA_U16 },
2283 [DEVLINK_ATTR_ESWITCH_MODE] = { .type = NLA_U16 },
2284 [DEVLINK_ATTR_ESWITCH_INLINE_MODE] = { .type = NLA_U8 },
2285 [DEVLINK_ATTR_ESWITCH_ENCAP_MODE] = { .type = NLA_U8 },
2286 [DEVLINK_ATTR_DPIPE_TABLE_NAME] = { .type = NLA_NUL_STRING },
2287 [DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED] = { .type = NLA_U8 },
2290 static const struct genl_ops devlink_nl_ops[] = {
2292 .cmd = DEVLINK_CMD_GET,
2293 .doit = devlink_nl_cmd_get_doit,
2294 .dumpit = devlink_nl_cmd_get_dumpit,
2295 .policy = devlink_nl_policy,
2296 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2297 /* can be retrieved by unprivileged users */
2300 .cmd = DEVLINK_CMD_PORT_GET,
2301 .doit = devlink_nl_cmd_port_get_doit,
2302 .dumpit = devlink_nl_cmd_port_get_dumpit,
2303 .policy = devlink_nl_policy,
2304 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT,
2305 /* can be retrieved by unprivileged users */
2308 .cmd = DEVLINK_CMD_PORT_SET,
2309 .doit = devlink_nl_cmd_port_set_doit,
2310 .policy = devlink_nl_policy,
2311 .flags = GENL_ADMIN_PERM,
2312 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT,
2315 .cmd = DEVLINK_CMD_PORT_SPLIT,
2316 .doit = devlink_nl_cmd_port_split_doit,
2317 .policy = devlink_nl_policy,
2318 .flags = GENL_ADMIN_PERM,
2319 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2322 .cmd = DEVLINK_CMD_PORT_UNSPLIT,
2323 .doit = devlink_nl_cmd_port_unsplit_doit,
2324 .policy = devlink_nl_policy,
2325 .flags = GENL_ADMIN_PERM,
2326 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2329 .cmd = DEVLINK_CMD_SB_GET,
2330 .doit = devlink_nl_cmd_sb_get_doit,
2331 .dumpit = devlink_nl_cmd_sb_get_dumpit,
2332 .policy = devlink_nl_policy,
2333 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2334 DEVLINK_NL_FLAG_NEED_SB,
2335 /* can be retrieved by unprivileged users */
2338 .cmd = DEVLINK_CMD_SB_POOL_GET,
2339 .doit = devlink_nl_cmd_sb_pool_get_doit,
2340 .dumpit = devlink_nl_cmd_sb_pool_get_dumpit,
2341 .policy = devlink_nl_policy,
2342 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2343 DEVLINK_NL_FLAG_NEED_SB,
2344 /* can be retrieved by unprivileged users */
2347 .cmd = DEVLINK_CMD_SB_POOL_SET,
2348 .doit = devlink_nl_cmd_sb_pool_set_doit,
2349 .policy = devlink_nl_policy,
2350 .flags = GENL_ADMIN_PERM,
2351 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2352 DEVLINK_NL_FLAG_NEED_SB,
2355 .cmd = DEVLINK_CMD_SB_PORT_POOL_GET,
2356 .doit = devlink_nl_cmd_sb_port_pool_get_doit,
2357 .dumpit = devlink_nl_cmd_sb_port_pool_get_dumpit,
2358 .policy = devlink_nl_policy,
2359 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT |
2360 DEVLINK_NL_FLAG_NEED_SB,
2361 /* can be retrieved by unprivileged users */
2364 .cmd = DEVLINK_CMD_SB_PORT_POOL_SET,
2365 .doit = devlink_nl_cmd_sb_port_pool_set_doit,
2366 .policy = devlink_nl_policy,
2367 .flags = GENL_ADMIN_PERM,
2368 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT |
2369 DEVLINK_NL_FLAG_NEED_SB,
2372 .cmd = DEVLINK_CMD_SB_TC_POOL_BIND_GET,
2373 .doit = devlink_nl_cmd_sb_tc_pool_bind_get_doit,
2374 .dumpit = devlink_nl_cmd_sb_tc_pool_bind_get_dumpit,
2375 .policy = devlink_nl_policy,
2376 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT |
2377 DEVLINK_NL_FLAG_NEED_SB,
2378 /* can be retrieved by unprivileged users */
2381 .cmd = DEVLINK_CMD_SB_TC_POOL_BIND_SET,
2382 .doit = devlink_nl_cmd_sb_tc_pool_bind_set_doit,
2383 .policy = devlink_nl_policy,
2384 .flags = GENL_ADMIN_PERM,
2385 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT |
2386 DEVLINK_NL_FLAG_NEED_SB,
2389 .cmd = DEVLINK_CMD_SB_OCC_SNAPSHOT,
2390 .doit = devlink_nl_cmd_sb_occ_snapshot_doit,
2391 .policy = devlink_nl_policy,
2392 .flags = GENL_ADMIN_PERM,
2393 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2394 DEVLINK_NL_FLAG_NEED_SB |
2395 DEVLINK_NL_FLAG_LOCK_PORTS,
2398 .cmd = DEVLINK_CMD_SB_OCC_MAX_CLEAR,
2399 .doit = devlink_nl_cmd_sb_occ_max_clear_doit,
2400 .policy = devlink_nl_policy,
2401 .flags = GENL_ADMIN_PERM,
2402 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2403 DEVLINK_NL_FLAG_NEED_SB |
2404 DEVLINK_NL_FLAG_LOCK_PORTS,
2407 .cmd = DEVLINK_CMD_ESWITCH_GET,
2408 .doit = devlink_nl_cmd_eswitch_get_doit,
2409 .policy = devlink_nl_policy,
2410 .flags = GENL_ADMIN_PERM,
2411 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2414 .cmd = DEVLINK_CMD_ESWITCH_SET,
2415 .doit = devlink_nl_cmd_eswitch_set_doit,
2416 .policy = devlink_nl_policy,
2417 .flags = GENL_ADMIN_PERM,
2418 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2421 .cmd = DEVLINK_CMD_DPIPE_TABLE_GET,
2422 .doit = devlink_nl_cmd_dpipe_table_get,
2423 .policy = devlink_nl_policy,
2424 .flags = GENL_ADMIN_PERM,
2425 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2428 .cmd = DEVLINK_CMD_DPIPE_ENTRIES_GET,
2429 .doit = devlink_nl_cmd_dpipe_entries_get,
2430 .policy = devlink_nl_policy,
2431 .flags = GENL_ADMIN_PERM,
2432 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2435 .cmd = DEVLINK_CMD_DPIPE_HEADERS_GET,
2436 .doit = devlink_nl_cmd_dpipe_headers_get,
2437 .policy = devlink_nl_policy,
2438 .flags = GENL_ADMIN_PERM,
2439 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2442 .cmd = DEVLINK_CMD_DPIPE_TABLE_COUNTERS_SET,
2443 .doit = devlink_nl_cmd_dpipe_table_counters_set,
2444 .policy = devlink_nl_policy,
2445 .flags = GENL_ADMIN_PERM,
2446 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2450 static struct genl_family devlink_nl_family __ro_after_init = {
2451 .name = DEVLINK_GENL_NAME,
2452 .version = DEVLINK_GENL_VERSION,
2453 .maxattr = DEVLINK_ATTR_MAX,
2455 .pre_doit = devlink_nl_pre_doit,
2456 .post_doit = devlink_nl_post_doit,
2457 .module = THIS_MODULE,
2458 .ops = devlink_nl_ops,
2459 .n_ops = ARRAY_SIZE(devlink_nl_ops),
2460 .mcgrps = devlink_nl_mcgrps,
2461 .n_mcgrps = ARRAY_SIZE(devlink_nl_mcgrps),
2465 * devlink_alloc - Allocate new devlink instance resources
2468 * @priv_size: size of user private data
2470 * Allocate new devlink instance resources, including devlink index
2473 struct devlink *devlink_alloc(const struct devlink_ops *ops, size_t priv_size)
2475 struct devlink *devlink;
2477 devlink = kzalloc(sizeof(*devlink) + priv_size, GFP_KERNEL);
2481 devlink_net_set(devlink, &init_net);
2482 INIT_LIST_HEAD(&devlink->port_list);
2483 INIT_LIST_HEAD(&devlink->sb_list);
2484 INIT_LIST_HEAD_RCU(&devlink->dpipe_table_list);
2487 EXPORT_SYMBOL_GPL(devlink_alloc);
2490 * devlink_register - Register devlink instance
2494 int devlink_register(struct devlink *devlink, struct device *dev)
2496 mutex_lock(&devlink_mutex);
2498 list_add_tail(&devlink->list, &devlink_list);
2499 devlink_notify(devlink, DEVLINK_CMD_NEW);
2500 mutex_unlock(&devlink_mutex);
2503 EXPORT_SYMBOL_GPL(devlink_register);
2506 * devlink_unregister - Unregister devlink instance
2510 void devlink_unregister(struct devlink *devlink)
2512 mutex_lock(&devlink_mutex);
2513 devlink_notify(devlink, DEVLINK_CMD_DEL);
2514 list_del(&devlink->list);
2515 mutex_unlock(&devlink_mutex);
2517 EXPORT_SYMBOL_GPL(devlink_unregister);
2520 * devlink_free - Free devlink instance resources
2524 void devlink_free(struct devlink *devlink)
2528 EXPORT_SYMBOL_GPL(devlink_free);
2531 * devlink_port_register - Register devlink port
2534 * @devlink_port: devlink port
2537 * Register devlink port with provided port index. User can use
2538 * any indexing, even hw-related one. devlink_port structure
2539 * is convenient to be embedded inside user driver private structure.
2540 * Note that the caller should take care of zeroing the devlink_port
2543 int devlink_port_register(struct devlink *devlink,
2544 struct devlink_port *devlink_port,
2545 unsigned int port_index)
2547 mutex_lock(&devlink_port_mutex);
2548 if (devlink_port_index_exists(devlink, port_index)) {
2549 mutex_unlock(&devlink_port_mutex);
2552 devlink_port->devlink = devlink;
2553 devlink_port->index = port_index;
2554 devlink_port->registered = true;
2555 list_add_tail(&devlink_port->list, &devlink->port_list);
2556 mutex_unlock(&devlink_port_mutex);
2557 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_NEW);
2560 EXPORT_SYMBOL_GPL(devlink_port_register);
2563 * devlink_port_unregister - Unregister devlink port
2565 * @devlink_port: devlink port
2567 void devlink_port_unregister(struct devlink_port *devlink_port)
2569 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_DEL);
2570 mutex_lock(&devlink_port_mutex);
2571 list_del(&devlink_port->list);
2572 mutex_unlock(&devlink_port_mutex);
2574 EXPORT_SYMBOL_GPL(devlink_port_unregister);
2576 static void __devlink_port_type_set(struct devlink_port *devlink_port,
2577 enum devlink_port_type type,
2580 devlink_port->type = type;
2581 devlink_port->type_dev = type_dev;
2582 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_NEW);
2586 * devlink_port_type_eth_set - Set port type to Ethernet
2588 * @devlink_port: devlink port
2589 * @netdev: related netdevice
2591 void devlink_port_type_eth_set(struct devlink_port *devlink_port,
2592 struct net_device *netdev)
2594 return __devlink_port_type_set(devlink_port,
2595 DEVLINK_PORT_TYPE_ETH, netdev);
2597 EXPORT_SYMBOL_GPL(devlink_port_type_eth_set);
2600 * devlink_port_type_ib_set - Set port type to InfiniBand
2602 * @devlink_port: devlink port
2603 * @ibdev: related IB device
2605 void devlink_port_type_ib_set(struct devlink_port *devlink_port,
2606 struct ib_device *ibdev)
2608 return __devlink_port_type_set(devlink_port,
2609 DEVLINK_PORT_TYPE_IB, ibdev);
2611 EXPORT_SYMBOL_GPL(devlink_port_type_ib_set);
2614 * devlink_port_type_clear - Clear port type
2616 * @devlink_port: devlink port
2618 void devlink_port_type_clear(struct devlink_port *devlink_port)
2620 return __devlink_port_type_set(devlink_port,
2621 DEVLINK_PORT_TYPE_NOTSET, NULL);
2623 EXPORT_SYMBOL_GPL(devlink_port_type_clear);
2626 * devlink_port_split_set - Set port is split
2628 * @devlink_port: devlink port
2629 * @split_group: split group - identifies group split port is part of
2631 void devlink_port_split_set(struct devlink_port *devlink_port,
2634 devlink_port->split = true;
2635 devlink_port->split_group = split_group;
2636 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_NEW);
2638 EXPORT_SYMBOL_GPL(devlink_port_split_set);
2640 int devlink_sb_register(struct devlink *devlink, unsigned int sb_index,
2641 u32 size, u16 ingress_pools_count,
2642 u16 egress_pools_count, u16 ingress_tc_count,
2643 u16 egress_tc_count)
2645 struct devlink_sb *devlink_sb;
2648 mutex_lock(&devlink_mutex);
2649 if (devlink_sb_index_exists(devlink, sb_index)) {
2654 devlink_sb = kzalloc(sizeof(*devlink_sb), GFP_KERNEL);
2659 devlink_sb->index = sb_index;
2660 devlink_sb->size = size;
2661 devlink_sb->ingress_pools_count = ingress_pools_count;
2662 devlink_sb->egress_pools_count = egress_pools_count;
2663 devlink_sb->ingress_tc_count = ingress_tc_count;
2664 devlink_sb->egress_tc_count = egress_tc_count;
2665 list_add_tail(&devlink_sb->list, &devlink->sb_list);
2667 mutex_unlock(&devlink_mutex);
2670 EXPORT_SYMBOL_GPL(devlink_sb_register);
2672 void devlink_sb_unregister(struct devlink *devlink, unsigned int sb_index)
2674 struct devlink_sb *devlink_sb;
2676 mutex_lock(&devlink_mutex);
2677 devlink_sb = devlink_sb_get_by_index(devlink, sb_index);
2678 WARN_ON(!devlink_sb);
2679 list_del(&devlink_sb->list);
2680 mutex_unlock(&devlink_mutex);
2683 EXPORT_SYMBOL_GPL(devlink_sb_unregister);
2686 * devlink_dpipe_headers_register - register dpipe headers
2689 * @dpipe_headers: dpipe header array
2691 * Register the headers supported by hardware.
2693 int devlink_dpipe_headers_register(struct devlink *devlink,
2694 struct devlink_dpipe_headers *dpipe_headers)
2696 mutex_lock(&devlink_mutex);
2697 devlink->dpipe_headers = dpipe_headers;
2698 mutex_unlock(&devlink_mutex);
2701 EXPORT_SYMBOL_GPL(devlink_dpipe_headers_register);
2704 * devlink_dpipe_headers_unregister - unregister dpipe headers
2708 * Unregister the headers supported by hardware.
2710 void devlink_dpipe_headers_unregister(struct devlink *devlink)
2712 mutex_lock(&devlink_mutex);
2713 devlink->dpipe_headers = NULL;
2714 mutex_unlock(&devlink_mutex);
2716 EXPORT_SYMBOL_GPL(devlink_dpipe_headers_unregister);
2719 * devlink_dpipe_table_counter_enabled - check if counter allocation
2722 * @table_name: tables name
2724 * Used by driver to check if counter allocation is required.
2725 * After counter allocation is turned on the table entries
2726 * are updated to include counter statistics.
2728 * After that point on the driver must respect the counter
2729 * state so that each entry added to the table is added
2732 bool devlink_dpipe_table_counter_enabled(struct devlink *devlink,
2733 const char *table_name)
2735 struct devlink_dpipe_table *table;
2739 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
2743 enabled = table->counters_enabled;
2747 EXPORT_SYMBOL_GPL(devlink_dpipe_table_counter_enabled);
2750 * devlink_dpipe_table_register - register dpipe table
2753 * @table_name: table name
2754 * @table_ops: table ops
2756 * @counter_control_extern: external control for counters
2758 int devlink_dpipe_table_register(struct devlink *devlink,
2759 const char *table_name,
2760 struct devlink_dpipe_table_ops *table_ops,
2761 void *priv, bool counter_control_extern)
2763 struct devlink_dpipe_table *table;
2765 if (devlink_dpipe_table_find(&devlink->dpipe_table_list, table_name))
2768 if (WARN_ON(!table_ops->size_get))
2771 table = kzalloc(sizeof(*table), GFP_KERNEL);
2775 table->name = table_name;
2776 table->table_ops = table_ops;
2778 table->counter_control_extern = counter_control_extern;
2780 mutex_lock(&devlink_mutex);
2781 list_add_tail_rcu(&table->list, &devlink->dpipe_table_list);
2782 mutex_unlock(&devlink_mutex);
2785 EXPORT_SYMBOL_GPL(devlink_dpipe_table_register);
2788 * devlink_dpipe_table_unregister - unregister dpipe table
2791 * @table_name: table name
2793 void devlink_dpipe_table_unregister(struct devlink *devlink,
2794 const char *table_name)
2796 struct devlink_dpipe_table *table;
2798 mutex_lock(&devlink_mutex);
2799 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
2803 list_del_rcu(&table->list);
2804 mutex_unlock(&devlink_mutex);
2805 kfree_rcu(table, rcu);
2808 mutex_unlock(&devlink_mutex);
2810 EXPORT_SYMBOL_GPL(devlink_dpipe_table_unregister);
2812 static int __init devlink_module_init(void)
2814 return genl_register_family(&devlink_nl_family);
2817 static void __exit devlink_module_exit(void)
2819 genl_unregister_family(&devlink_nl_family);
2822 module_init(devlink_module_init);
2823 module_exit(devlink_module_exit);
2825 MODULE_LICENSE("GPL v2");
2826 MODULE_AUTHOR("Jiri Pirko <jiri@mellanox.com>");
2827 MODULE_DESCRIPTION("Network physical device Netlink interface");
2828 MODULE_ALIAS_GENL_FAMILY(DEVLINK_GENL_NAME);