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);
95 static struct net *devlink_net(const struct devlink *devlink)
97 return read_pnet(&devlink->_net);
100 static void devlink_net_set(struct devlink *devlink, struct net *net)
102 write_pnet(&devlink->_net, net);
105 static struct devlink *devlink_get_from_attrs(struct net *net,
106 struct nlattr **attrs)
108 struct devlink *devlink;
112 if (!attrs[DEVLINK_ATTR_BUS_NAME] || !attrs[DEVLINK_ATTR_DEV_NAME])
113 return ERR_PTR(-EINVAL);
115 busname = nla_data(attrs[DEVLINK_ATTR_BUS_NAME]);
116 devname = nla_data(attrs[DEVLINK_ATTR_DEV_NAME]);
118 list_for_each_entry(devlink, &devlink_list, list) {
119 if (strcmp(devlink->dev->bus->name, busname) == 0 &&
120 strcmp(dev_name(devlink->dev), devname) == 0 &&
121 net_eq(devlink_net(devlink), net))
125 return ERR_PTR(-ENODEV);
128 static struct devlink *devlink_get_from_info(struct genl_info *info)
130 return devlink_get_from_attrs(genl_info_net(info), info->attrs);
133 static struct devlink_port *devlink_port_get_by_index(struct devlink *devlink,
136 struct devlink_port *devlink_port;
138 list_for_each_entry(devlink_port, &devlink->port_list, list) {
139 if (devlink_port->index == port_index)
145 static bool devlink_port_index_exists(struct devlink *devlink, int port_index)
147 return devlink_port_get_by_index(devlink, port_index);
150 static struct devlink_port *devlink_port_get_from_attrs(struct devlink *devlink,
151 struct nlattr **attrs)
153 if (attrs[DEVLINK_ATTR_PORT_INDEX]) {
154 u32 port_index = nla_get_u32(attrs[DEVLINK_ATTR_PORT_INDEX]);
155 struct devlink_port *devlink_port;
157 devlink_port = devlink_port_get_by_index(devlink, port_index);
159 return ERR_PTR(-ENODEV);
162 return ERR_PTR(-EINVAL);
165 static struct devlink_port *devlink_port_get_from_info(struct devlink *devlink,
166 struct genl_info *info)
168 return devlink_port_get_from_attrs(devlink, info->attrs);
172 struct list_head list;
175 u16 ingress_pools_count;
176 u16 egress_pools_count;
177 u16 ingress_tc_count;
181 static u16 devlink_sb_pool_count(struct devlink_sb *devlink_sb)
183 return devlink_sb->ingress_pools_count + devlink_sb->egress_pools_count;
186 static struct devlink_sb *devlink_sb_get_by_index(struct devlink *devlink,
187 unsigned int sb_index)
189 struct devlink_sb *devlink_sb;
191 list_for_each_entry(devlink_sb, &devlink->sb_list, list) {
192 if (devlink_sb->index == sb_index)
198 static bool devlink_sb_index_exists(struct devlink *devlink,
199 unsigned int sb_index)
201 return devlink_sb_get_by_index(devlink, sb_index);
204 static struct devlink_sb *devlink_sb_get_from_attrs(struct devlink *devlink,
205 struct nlattr **attrs)
207 if (attrs[DEVLINK_ATTR_SB_INDEX]) {
208 u32 sb_index = nla_get_u32(attrs[DEVLINK_ATTR_SB_INDEX]);
209 struct devlink_sb *devlink_sb;
211 devlink_sb = devlink_sb_get_by_index(devlink, sb_index);
213 return ERR_PTR(-ENODEV);
216 return ERR_PTR(-EINVAL);
219 static struct devlink_sb *devlink_sb_get_from_info(struct devlink *devlink,
220 struct genl_info *info)
222 return devlink_sb_get_from_attrs(devlink, info->attrs);
225 static int devlink_sb_pool_index_get_from_attrs(struct devlink_sb *devlink_sb,
226 struct nlattr **attrs,
231 if (!attrs[DEVLINK_ATTR_SB_POOL_INDEX])
234 val = nla_get_u16(attrs[DEVLINK_ATTR_SB_POOL_INDEX]);
235 if (val >= devlink_sb_pool_count(devlink_sb))
241 static int devlink_sb_pool_index_get_from_info(struct devlink_sb *devlink_sb,
242 struct genl_info *info,
245 return devlink_sb_pool_index_get_from_attrs(devlink_sb, info->attrs,
250 devlink_sb_pool_type_get_from_attrs(struct nlattr **attrs,
251 enum devlink_sb_pool_type *p_pool_type)
255 if (!attrs[DEVLINK_ATTR_SB_POOL_TYPE])
258 val = nla_get_u8(attrs[DEVLINK_ATTR_SB_POOL_TYPE]);
259 if (val != DEVLINK_SB_POOL_TYPE_INGRESS &&
260 val != DEVLINK_SB_POOL_TYPE_EGRESS)
267 devlink_sb_pool_type_get_from_info(struct genl_info *info,
268 enum devlink_sb_pool_type *p_pool_type)
270 return devlink_sb_pool_type_get_from_attrs(info->attrs, p_pool_type);
274 devlink_sb_th_type_get_from_attrs(struct nlattr **attrs,
275 enum devlink_sb_threshold_type *p_th_type)
279 if (!attrs[DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE])
282 val = nla_get_u8(attrs[DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE]);
283 if (val != DEVLINK_SB_THRESHOLD_TYPE_STATIC &&
284 val != DEVLINK_SB_THRESHOLD_TYPE_DYNAMIC)
291 devlink_sb_th_type_get_from_info(struct genl_info *info,
292 enum devlink_sb_threshold_type *p_th_type)
294 return devlink_sb_th_type_get_from_attrs(info->attrs, p_th_type);
298 devlink_sb_tc_index_get_from_attrs(struct devlink_sb *devlink_sb,
299 struct nlattr **attrs,
300 enum devlink_sb_pool_type pool_type,
305 if (!attrs[DEVLINK_ATTR_SB_TC_INDEX])
308 val = nla_get_u16(attrs[DEVLINK_ATTR_SB_TC_INDEX]);
309 if (pool_type == DEVLINK_SB_POOL_TYPE_INGRESS &&
310 val >= devlink_sb->ingress_tc_count)
312 if (pool_type == DEVLINK_SB_POOL_TYPE_EGRESS &&
313 val >= devlink_sb->egress_tc_count)
320 devlink_sb_tc_index_get_from_info(struct devlink_sb *devlink_sb,
321 struct genl_info *info,
322 enum devlink_sb_pool_type pool_type,
325 return devlink_sb_tc_index_get_from_attrs(devlink_sb, info->attrs,
326 pool_type, p_tc_index);
329 #define DEVLINK_NL_FLAG_NEED_DEVLINK BIT(0)
330 #define DEVLINK_NL_FLAG_NEED_PORT BIT(1)
331 #define DEVLINK_NL_FLAG_NEED_SB BIT(2)
333 /* The per devlink instance lock is taken by default in the pre-doit
334 * operation, yet several commands do not require this. The global
335 * devlink lock is taken and protects from disruption by user-calls.
337 #define DEVLINK_NL_FLAG_NO_LOCK BIT(3)
339 static int devlink_nl_pre_doit(const struct genl_ops *ops,
340 struct sk_buff *skb, struct genl_info *info)
342 struct devlink *devlink;
345 mutex_lock(&devlink_mutex);
346 devlink = devlink_get_from_info(info);
347 if (IS_ERR(devlink)) {
348 mutex_unlock(&devlink_mutex);
349 return PTR_ERR(devlink);
351 if (~ops->internal_flags & DEVLINK_NL_FLAG_NO_LOCK)
352 mutex_lock(&devlink->lock);
353 if (ops->internal_flags & DEVLINK_NL_FLAG_NEED_DEVLINK) {
354 info->user_ptr[0] = devlink;
355 } else if (ops->internal_flags & DEVLINK_NL_FLAG_NEED_PORT) {
356 struct devlink_port *devlink_port;
358 devlink_port = devlink_port_get_from_info(devlink, info);
359 if (IS_ERR(devlink_port)) {
360 err = PTR_ERR(devlink_port);
363 info->user_ptr[0] = devlink_port;
365 if (ops->internal_flags & DEVLINK_NL_FLAG_NEED_SB) {
366 struct devlink_sb *devlink_sb;
368 devlink_sb = devlink_sb_get_from_info(devlink, info);
369 if (IS_ERR(devlink_sb)) {
370 err = PTR_ERR(devlink_sb);
373 info->user_ptr[1] = devlink_sb;
378 if (~ops->internal_flags & DEVLINK_NL_FLAG_NO_LOCK)
379 mutex_unlock(&devlink->lock);
380 mutex_unlock(&devlink_mutex);
384 static void devlink_nl_post_doit(const struct genl_ops *ops,
385 struct sk_buff *skb, struct genl_info *info)
387 struct devlink *devlink;
389 devlink = devlink_get_from_info(info);
390 if (~ops->internal_flags & DEVLINK_NL_FLAG_NO_LOCK)
391 mutex_unlock(&devlink->lock);
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_attrs_put(struct sk_buff *msg,
457 struct devlink_port *devlink_port)
459 struct devlink_port_attrs *attrs = &devlink_port->attrs;
463 if (nla_put_u16(msg, DEVLINK_ATTR_PORT_FLAVOUR, attrs->flavour))
465 if (nla_put_u32(msg, DEVLINK_ATTR_PORT_NUMBER, attrs->port_number))
469 if (nla_put_u32(msg, DEVLINK_ATTR_PORT_SPLIT_GROUP, attrs->port_number))
471 if (nla_put_u32(msg, DEVLINK_ATTR_PORT_SPLIT_SUBPORT_NUMBER,
472 attrs->split_subport_number))
477 static int devlink_nl_port_fill(struct sk_buff *msg, struct devlink *devlink,
478 struct devlink_port *devlink_port,
479 enum devlink_command cmd, u32 portid,
484 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
488 if (devlink_nl_put_handle(msg, devlink))
489 goto nla_put_failure;
490 if (nla_put_u32(msg, DEVLINK_ATTR_PORT_INDEX, devlink_port->index))
491 goto nla_put_failure;
492 if (nla_put_u16(msg, DEVLINK_ATTR_PORT_TYPE, devlink_port->type))
493 goto nla_put_failure;
494 if (devlink_port->desired_type != DEVLINK_PORT_TYPE_NOTSET &&
495 nla_put_u16(msg, DEVLINK_ATTR_PORT_DESIRED_TYPE,
496 devlink_port->desired_type))
497 goto nla_put_failure;
498 if (devlink_port->type == DEVLINK_PORT_TYPE_ETH) {
499 struct net_device *netdev = devlink_port->type_dev;
502 (nla_put_u32(msg, DEVLINK_ATTR_PORT_NETDEV_IFINDEX,
504 nla_put_string(msg, DEVLINK_ATTR_PORT_NETDEV_NAME,
506 goto nla_put_failure;
508 if (devlink_port->type == DEVLINK_PORT_TYPE_IB) {
509 struct ib_device *ibdev = devlink_port->type_dev;
512 nla_put_string(msg, DEVLINK_ATTR_PORT_IBDEV_NAME,
514 goto nla_put_failure;
516 if (devlink_nl_port_attrs_put(msg, devlink_port))
517 goto nla_put_failure;
519 genlmsg_end(msg, hdr);
523 genlmsg_cancel(msg, hdr);
527 static void devlink_port_notify(struct devlink_port *devlink_port,
528 enum devlink_command cmd)
530 struct devlink *devlink = devlink_port->devlink;
534 if (!devlink_port->registered)
537 WARN_ON(cmd != DEVLINK_CMD_PORT_NEW && cmd != DEVLINK_CMD_PORT_DEL);
539 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
543 err = devlink_nl_port_fill(msg, devlink, devlink_port, cmd, 0, 0, 0);
549 genlmsg_multicast_netns(&devlink_nl_family, devlink_net(devlink),
550 msg, 0, DEVLINK_MCGRP_CONFIG, GFP_KERNEL);
553 static int devlink_nl_cmd_get_doit(struct sk_buff *skb, struct genl_info *info)
555 struct devlink *devlink = info->user_ptr[0];
559 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
563 err = devlink_nl_fill(msg, devlink, DEVLINK_CMD_NEW,
564 info->snd_portid, info->snd_seq, 0);
570 return genlmsg_reply(msg, info);
573 static int devlink_nl_cmd_get_dumpit(struct sk_buff *msg,
574 struct netlink_callback *cb)
576 struct devlink *devlink;
577 int start = cb->args[0];
581 mutex_lock(&devlink_mutex);
582 list_for_each_entry(devlink, &devlink_list, list) {
583 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)))
589 err = devlink_nl_fill(msg, devlink, DEVLINK_CMD_NEW,
590 NETLINK_CB(cb->skb).portid,
591 cb->nlh->nlmsg_seq, NLM_F_MULTI);
597 mutex_unlock(&devlink_mutex);
603 static int devlink_nl_cmd_port_get_doit(struct sk_buff *skb,
604 struct genl_info *info)
606 struct devlink_port *devlink_port = info->user_ptr[0];
607 struct devlink *devlink = devlink_port->devlink;
611 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
615 err = devlink_nl_port_fill(msg, devlink, devlink_port,
616 DEVLINK_CMD_PORT_NEW,
617 info->snd_portid, info->snd_seq, 0);
623 return genlmsg_reply(msg, info);
626 static int devlink_nl_cmd_port_get_dumpit(struct sk_buff *msg,
627 struct netlink_callback *cb)
629 struct devlink *devlink;
630 struct devlink_port *devlink_port;
631 int start = cb->args[0];
635 mutex_lock(&devlink_mutex);
636 list_for_each_entry(devlink, &devlink_list, list) {
637 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)))
639 mutex_lock(&devlink->lock);
640 list_for_each_entry(devlink_port, &devlink->port_list, list) {
645 err = devlink_nl_port_fill(msg, devlink, devlink_port,
647 NETLINK_CB(cb->skb).portid,
651 mutex_unlock(&devlink->lock);
656 mutex_unlock(&devlink->lock);
659 mutex_unlock(&devlink_mutex);
665 static int devlink_port_type_set(struct devlink *devlink,
666 struct devlink_port *devlink_port,
667 enum devlink_port_type port_type)
672 if (devlink->ops && devlink->ops->port_type_set) {
673 if (port_type == DEVLINK_PORT_TYPE_NOTSET)
675 if (port_type == devlink_port->type)
677 err = devlink->ops->port_type_set(devlink_port, port_type);
680 devlink_port->desired_type = port_type;
681 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_NEW);
687 static int devlink_nl_cmd_port_set_doit(struct sk_buff *skb,
688 struct genl_info *info)
690 struct devlink_port *devlink_port = info->user_ptr[0];
691 struct devlink *devlink = devlink_port->devlink;
694 if (info->attrs[DEVLINK_ATTR_PORT_TYPE]) {
695 enum devlink_port_type port_type;
697 port_type = nla_get_u16(info->attrs[DEVLINK_ATTR_PORT_TYPE]);
698 err = devlink_port_type_set(devlink, devlink_port, port_type);
705 static int devlink_port_split(struct devlink *devlink, u32 port_index,
706 u32 count, struct netlink_ext_ack *extack)
709 if (devlink->ops && devlink->ops->port_split)
710 return devlink->ops->port_split(devlink, port_index, count,
715 static int devlink_nl_cmd_port_split_doit(struct sk_buff *skb,
716 struct genl_info *info)
718 struct devlink *devlink = info->user_ptr[0];
722 if (!info->attrs[DEVLINK_ATTR_PORT_INDEX] ||
723 !info->attrs[DEVLINK_ATTR_PORT_SPLIT_COUNT])
726 port_index = nla_get_u32(info->attrs[DEVLINK_ATTR_PORT_INDEX]);
727 count = nla_get_u32(info->attrs[DEVLINK_ATTR_PORT_SPLIT_COUNT]);
728 return devlink_port_split(devlink, port_index, count, info->extack);
731 static int devlink_port_unsplit(struct devlink *devlink, u32 port_index,
732 struct netlink_ext_ack *extack)
735 if (devlink->ops && devlink->ops->port_unsplit)
736 return devlink->ops->port_unsplit(devlink, port_index, extack);
740 static int devlink_nl_cmd_port_unsplit_doit(struct sk_buff *skb,
741 struct genl_info *info)
743 struct devlink *devlink = info->user_ptr[0];
746 if (!info->attrs[DEVLINK_ATTR_PORT_INDEX])
749 port_index = nla_get_u32(info->attrs[DEVLINK_ATTR_PORT_INDEX]);
750 return devlink_port_unsplit(devlink, port_index, info->extack);
753 static int devlink_nl_sb_fill(struct sk_buff *msg, struct devlink *devlink,
754 struct devlink_sb *devlink_sb,
755 enum devlink_command cmd, u32 portid,
760 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
764 if (devlink_nl_put_handle(msg, devlink))
765 goto nla_put_failure;
766 if (nla_put_u32(msg, DEVLINK_ATTR_SB_INDEX, devlink_sb->index))
767 goto nla_put_failure;
768 if (nla_put_u32(msg, DEVLINK_ATTR_SB_SIZE, devlink_sb->size))
769 goto nla_put_failure;
770 if (nla_put_u16(msg, DEVLINK_ATTR_SB_INGRESS_POOL_COUNT,
771 devlink_sb->ingress_pools_count))
772 goto nla_put_failure;
773 if (nla_put_u16(msg, DEVLINK_ATTR_SB_EGRESS_POOL_COUNT,
774 devlink_sb->egress_pools_count))
775 goto nla_put_failure;
776 if (nla_put_u16(msg, DEVLINK_ATTR_SB_INGRESS_TC_COUNT,
777 devlink_sb->ingress_tc_count))
778 goto nla_put_failure;
779 if (nla_put_u16(msg, DEVLINK_ATTR_SB_EGRESS_TC_COUNT,
780 devlink_sb->egress_tc_count))
781 goto nla_put_failure;
783 genlmsg_end(msg, hdr);
787 genlmsg_cancel(msg, hdr);
791 static int devlink_nl_cmd_sb_get_doit(struct sk_buff *skb,
792 struct genl_info *info)
794 struct devlink *devlink = info->user_ptr[0];
795 struct devlink_sb *devlink_sb = info->user_ptr[1];
799 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
803 err = devlink_nl_sb_fill(msg, devlink, devlink_sb,
805 info->snd_portid, info->snd_seq, 0);
811 return genlmsg_reply(msg, info);
814 static int devlink_nl_cmd_sb_get_dumpit(struct sk_buff *msg,
815 struct netlink_callback *cb)
817 struct devlink *devlink;
818 struct devlink_sb *devlink_sb;
819 int start = cb->args[0];
823 mutex_lock(&devlink_mutex);
824 list_for_each_entry(devlink, &devlink_list, list) {
825 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)))
827 mutex_lock(&devlink->lock);
828 list_for_each_entry(devlink_sb, &devlink->sb_list, list) {
833 err = devlink_nl_sb_fill(msg, devlink, devlink_sb,
835 NETLINK_CB(cb->skb).portid,
839 mutex_unlock(&devlink->lock);
844 mutex_unlock(&devlink->lock);
847 mutex_unlock(&devlink_mutex);
853 static int devlink_nl_sb_pool_fill(struct sk_buff *msg, struct devlink *devlink,
854 struct devlink_sb *devlink_sb,
855 u16 pool_index, enum devlink_command cmd,
856 u32 portid, u32 seq, int flags)
858 struct devlink_sb_pool_info pool_info;
862 err = devlink->ops->sb_pool_get(devlink, devlink_sb->index,
863 pool_index, &pool_info);
867 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
871 if (devlink_nl_put_handle(msg, devlink))
872 goto nla_put_failure;
873 if (nla_put_u32(msg, DEVLINK_ATTR_SB_INDEX, devlink_sb->index))
874 goto nla_put_failure;
875 if (nla_put_u16(msg, DEVLINK_ATTR_SB_POOL_INDEX, pool_index))
876 goto nla_put_failure;
877 if (nla_put_u8(msg, DEVLINK_ATTR_SB_POOL_TYPE, pool_info.pool_type))
878 goto nla_put_failure;
879 if (nla_put_u32(msg, DEVLINK_ATTR_SB_POOL_SIZE, pool_info.size))
880 goto nla_put_failure;
881 if (nla_put_u8(msg, DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE,
882 pool_info.threshold_type))
883 goto nla_put_failure;
885 genlmsg_end(msg, hdr);
889 genlmsg_cancel(msg, hdr);
893 static int devlink_nl_cmd_sb_pool_get_doit(struct sk_buff *skb,
894 struct genl_info *info)
896 struct devlink *devlink = info->user_ptr[0];
897 struct devlink_sb *devlink_sb = info->user_ptr[1];
902 err = devlink_sb_pool_index_get_from_info(devlink_sb, info,
907 if (!devlink->ops || !devlink->ops->sb_pool_get)
910 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
914 err = devlink_nl_sb_pool_fill(msg, devlink, devlink_sb, pool_index,
915 DEVLINK_CMD_SB_POOL_NEW,
916 info->snd_portid, info->snd_seq, 0);
922 return genlmsg_reply(msg, info);
925 static int __sb_pool_get_dumpit(struct sk_buff *msg, int start, int *p_idx,
926 struct devlink *devlink,
927 struct devlink_sb *devlink_sb,
930 u16 pool_count = devlink_sb_pool_count(devlink_sb);
934 for (pool_index = 0; pool_index < pool_count; pool_index++) {
935 if (*p_idx < start) {
939 err = devlink_nl_sb_pool_fill(msg, devlink,
942 DEVLINK_CMD_SB_POOL_NEW,
943 portid, seq, NLM_F_MULTI);
951 static int devlink_nl_cmd_sb_pool_get_dumpit(struct sk_buff *msg,
952 struct netlink_callback *cb)
954 struct devlink *devlink;
955 struct devlink_sb *devlink_sb;
956 int start = cb->args[0];
960 mutex_lock(&devlink_mutex);
961 list_for_each_entry(devlink, &devlink_list, list) {
962 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)) ||
963 !devlink->ops || !devlink->ops->sb_pool_get)
965 mutex_lock(&devlink->lock);
966 list_for_each_entry(devlink_sb, &devlink->sb_list, list) {
967 err = __sb_pool_get_dumpit(msg, start, &idx, devlink,
969 NETLINK_CB(cb->skb).portid,
971 if (err && err != -EOPNOTSUPP) {
972 mutex_unlock(&devlink->lock);
976 mutex_unlock(&devlink->lock);
979 mutex_unlock(&devlink_mutex);
985 static int devlink_sb_pool_set(struct devlink *devlink, unsigned int sb_index,
986 u16 pool_index, u32 size,
987 enum devlink_sb_threshold_type threshold_type)
990 const struct devlink_ops *ops = devlink->ops;
992 if (ops && ops->sb_pool_set)
993 return ops->sb_pool_set(devlink, sb_index, pool_index,
994 size, threshold_type);
998 static int devlink_nl_cmd_sb_pool_set_doit(struct sk_buff *skb,
999 struct genl_info *info)
1001 struct devlink *devlink = info->user_ptr[0];
1002 struct devlink_sb *devlink_sb = info->user_ptr[1];
1003 enum devlink_sb_threshold_type threshold_type;
1008 err = devlink_sb_pool_index_get_from_info(devlink_sb, info,
1013 err = devlink_sb_th_type_get_from_info(info, &threshold_type);
1017 if (!info->attrs[DEVLINK_ATTR_SB_POOL_SIZE])
1020 size = nla_get_u32(info->attrs[DEVLINK_ATTR_SB_POOL_SIZE]);
1021 return devlink_sb_pool_set(devlink, devlink_sb->index,
1022 pool_index, size, threshold_type);
1025 static int devlink_nl_sb_port_pool_fill(struct sk_buff *msg,
1026 struct devlink *devlink,
1027 struct devlink_port *devlink_port,
1028 struct devlink_sb *devlink_sb,
1030 enum devlink_command cmd,
1031 u32 portid, u32 seq, int flags)
1033 const struct devlink_ops *ops = devlink->ops;
1038 err = ops->sb_port_pool_get(devlink_port, devlink_sb->index,
1039 pool_index, &threshold);
1043 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
1047 if (devlink_nl_put_handle(msg, devlink))
1048 goto nla_put_failure;
1049 if (nla_put_u32(msg, DEVLINK_ATTR_PORT_INDEX, devlink_port->index))
1050 goto nla_put_failure;
1051 if (nla_put_u32(msg, DEVLINK_ATTR_SB_INDEX, devlink_sb->index))
1052 goto nla_put_failure;
1053 if (nla_put_u16(msg, DEVLINK_ATTR_SB_POOL_INDEX, pool_index))
1054 goto nla_put_failure;
1055 if (nla_put_u32(msg, DEVLINK_ATTR_SB_THRESHOLD, threshold))
1056 goto nla_put_failure;
1058 if (ops->sb_occ_port_pool_get) {
1062 err = ops->sb_occ_port_pool_get(devlink_port, devlink_sb->index,
1063 pool_index, &cur, &max);
1064 if (err && err != -EOPNOTSUPP)
1067 if (nla_put_u32(msg, DEVLINK_ATTR_SB_OCC_CUR, cur))
1068 goto nla_put_failure;
1069 if (nla_put_u32(msg, DEVLINK_ATTR_SB_OCC_MAX, max))
1070 goto nla_put_failure;
1074 genlmsg_end(msg, hdr);
1078 genlmsg_cancel(msg, hdr);
1082 static int devlink_nl_cmd_sb_port_pool_get_doit(struct sk_buff *skb,
1083 struct genl_info *info)
1085 struct devlink_port *devlink_port = info->user_ptr[0];
1086 struct devlink *devlink = devlink_port->devlink;
1087 struct devlink_sb *devlink_sb = info->user_ptr[1];
1088 struct sk_buff *msg;
1092 err = devlink_sb_pool_index_get_from_info(devlink_sb, info,
1097 if (!devlink->ops || !devlink->ops->sb_port_pool_get)
1100 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1104 err = devlink_nl_sb_port_pool_fill(msg, devlink, devlink_port,
1105 devlink_sb, pool_index,
1106 DEVLINK_CMD_SB_PORT_POOL_NEW,
1107 info->snd_portid, info->snd_seq, 0);
1113 return genlmsg_reply(msg, info);
1116 static int __sb_port_pool_get_dumpit(struct sk_buff *msg, int start, int *p_idx,
1117 struct devlink *devlink,
1118 struct devlink_sb *devlink_sb,
1119 u32 portid, u32 seq)
1121 struct devlink_port *devlink_port;
1122 u16 pool_count = devlink_sb_pool_count(devlink_sb);
1126 list_for_each_entry(devlink_port, &devlink->port_list, list) {
1127 for (pool_index = 0; pool_index < pool_count; pool_index++) {
1128 if (*p_idx < start) {
1132 err = devlink_nl_sb_port_pool_fill(msg, devlink,
1136 DEVLINK_CMD_SB_PORT_POOL_NEW,
1147 static int devlink_nl_cmd_sb_port_pool_get_dumpit(struct sk_buff *msg,
1148 struct netlink_callback *cb)
1150 struct devlink *devlink;
1151 struct devlink_sb *devlink_sb;
1152 int start = cb->args[0];
1156 mutex_lock(&devlink_mutex);
1157 list_for_each_entry(devlink, &devlink_list, list) {
1158 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)) ||
1159 !devlink->ops || !devlink->ops->sb_port_pool_get)
1161 mutex_lock(&devlink->lock);
1162 list_for_each_entry(devlink_sb, &devlink->sb_list, list) {
1163 err = __sb_port_pool_get_dumpit(msg, start, &idx,
1164 devlink, devlink_sb,
1165 NETLINK_CB(cb->skb).portid,
1166 cb->nlh->nlmsg_seq);
1167 if (err && err != -EOPNOTSUPP) {
1168 mutex_unlock(&devlink->lock);
1172 mutex_unlock(&devlink->lock);
1175 mutex_unlock(&devlink_mutex);
1181 static int devlink_sb_port_pool_set(struct devlink_port *devlink_port,
1182 unsigned int sb_index, u16 pool_index,
1186 const struct devlink_ops *ops = devlink_port->devlink->ops;
1188 if (ops && ops->sb_port_pool_set)
1189 return ops->sb_port_pool_set(devlink_port, sb_index,
1190 pool_index, threshold);
1194 static int devlink_nl_cmd_sb_port_pool_set_doit(struct sk_buff *skb,
1195 struct genl_info *info)
1197 struct devlink_port *devlink_port = info->user_ptr[0];
1198 struct devlink_sb *devlink_sb = info->user_ptr[1];
1203 err = devlink_sb_pool_index_get_from_info(devlink_sb, info,
1208 if (!info->attrs[DEVLINK_ATTR_SB_THRESHOLD])
1211 threshold = nla_get_u32(info->attrs[DEVLINK_ATTR_SB_THRESHOLD]);
1212 return devlink_sb_port_pool_set(devlink_port, devlink_sb->index,
1213 pool_index, threshold);
1217 devlink_nl_sb_tc_pool_bind_fill(struct sk_buff *msg, struct devlink *devlink,
1218 struct devlink_port *devlink_port,
1219 struct devlink_sb *devlink_sb, u16 tc_index,
1220 enum devlink_sb_pool_type pool_type,
1221 enum devlink_command cmd,
1222 u32 portid, u32 seq, int flags)
1224 const struct devlink_ops *ops = devlink->ops;
1230 err = ops->sb_tc_pool_bind_get(devlink_port, devlink_sb->index,
1231 tc_index, pool_type,
1232 &pool_index, &threshold);
1236 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
1240 if (devlink_nl_put_handle(msg, devlink))
1241 goto nla_put_failure;
1242 if (nla_put_u32(msg, DEVLINK_ATTR_PORT_INDEX, devlink_port->index))
1243 goto nla_put_failure;
1244 if (nla_put_u32(msg, DEVLINK_ATTR_SB_INDEX, devlink_sb->index))
1245 goto nla_put_failure;
1246 if (nla_put_u16(msg, DEVLINK_ATTR_SB_TC_INDEX, tc_index))
1247 goto nla_put_failure;
1248 if (nla_put_u8(msg, DEVLINK_ATTR_SB_POOL_TYPE, pool_type))
1249 goto nla_put_failure;
1250 if (nla_put_u16(msg, DEVLINK_ATTR_SB_POOL_INDEX, pool_index))
1251 goto nla_put_failure;
1252 if (nla_put_u32(msg, DEVLINK_ATTR_SB_THRESHOLD, threshold))
1253 goto nla_put_failure;
1255 if (ops->sb_occ_tc_port_bind_get) {
1259 err = ops->sb_occ_tc_port_bind_get(devlink_port,
1261 tc_index, pool_type,
1263 if (err && err != -EOPNOTSUPP)
1266 if (nla_put_u32(msg, DEVLINK_ATTR_SB_OCC_CUR, cur))
1267 goto nla_put_failure;
1268 if (nla_put_u32(msg, DEVLINK_ATTR_SB_OCC_MAX, max))
1269 goto nla_put_failure;
1273 genlmsg_end(msg, hdr);
1277 genlmsg_cancel(msg, hdr);
1281 static int devlink_nl_cmd_sb_tc_pool_bind_get_doit(struct sk_buff *skb,
1282 struct genl_info *info)
1284 struct devlink_port *devlink_port = info->user_ptr[0];
1285 struct devlink *devlink = devlink_port->devlink;
1286 struct devlink_sb *devlink_sb = info->user_ptr[1];
1287 struct sk_buff *msg;
1288 enum devlink_sb_pool_type pool_type;
1292 err = devlink_sb_pool_type_get_from_info(info, &pool_type);
1296 err = devlink_sb_tc_index_get_from_info(devlink_sb, info,
1297 pool_type, &tc_index);
1301 if (!devlink->ops || !devlink->ops->sb_tc_pool_bind_get)
1304 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1308 err = devlink_nl_sb_tc_pool_bind_fill(msg, devlink, devlink_port,
1309 devlink_sb, tc_index, pool_type,
1310 DEVLINK_CMD_SB_TC_POOL_BIND_NEW,
1318 return genlmsg_reply(msg, info);
1321 static int __sb_tc_pool_bind_get_dumpit(struct sk_buff *msg,
1322 int start, int *p_idx,
1323 struct devlink *devlink,
1324 struct devlink_sb *devlink_sb,
1325 u32 portid, u32 seq)
1327 struct devlink_port *devlink_port;
1331 list_for_each_entry(devlink_port, &devlink->port_list, list) {
1333 tc_index < devlink_sb->ingress_tc_count; tc_index++) {
1334 if (*p_idx < start) {
1338 err = devlink_nl_sb_tc_pool_bind_fill(msg, devlink,
1342 DEVLINK_SB_POOL_TYPE_INGRESS,
1343 DEVLINK_CMD_SB_TC_POOL_BIND_NEW,
1351 tc_index < devlink_sb->egress_tc_count; tc_index++) {
1352 if (*p_idx < start) {
1356 err = devlink_nl_sb_tc_pool_bind_fill(msg, devlink,
1360 DEVLINK_SB_POOL_TYPE_EGRESS,
1361 DEVLINK_CMD_SB_TC_POOL_BIND_NEW,
1373 devlink_nl_cmd_sb_tc_pool_bind_get_dumpit(struct sk_buff *msg,
1374 struct netlink_callback *cb)
1376 struct devlink *devlink;
1377 struct devlink_sb *devlink_sb;
1378 int start = cb->args[0];
1382 mutex_lock(&devlink_mutex);
1383 list_for_each_entry(devlink, &devlink_list, list) {
1384 if (!net_eq(devlink_net(devlink), sock_net(msg->sk)) ||
1385 !devlink->ops || !devlink->ops->sb_tc_pool_bind_get)
1388 mutex_lock(&devlink->lock);
1389 list_for_each_entry(devlink_sb, &devlink->sb_list, list) {
1390 err = __sb_tc_pool_bind_get_dumpit(msg, start, &idx,
1393 NETLINK_CB(cb->skb).portid,
1394 cb->nlh->nlmsg_seq);
1395 if (err && err != -EOPNOTSUPP) {
1396 mutex_unlock(&devlink->lock);
1400 mutex_unlock(&devlink->lock);
1403 mutex_unlock(&devlink_mutex);
1409 static int devlink_sb_tc_pool_bind_set(struct devlink_port *devlink_port,
1410 unsigned int sb_index, u16 tc_index,
1411 enum devlink_sb_pool_type pool_type,
1412 u16 pool_index, u32 threshold)
1415 const struct devlink_ops *ops = devlink_port->devlink->ops;
1417 if (ops && ops->sb_tc_pool_bind_set)
1418 return ops->sb_tc_pool_bind_set(devlink_port, sb_index,
1419 tc_index, pool_type,
1420 pool_index, threshold);
1424 static int devlink_nl_cmd_sb_tc_pool_bind_set_doit(struct sk_buff *skb,
1425 struct genl_info *info)
1427 struct devlink_port *devlink_port = info->user_ptr[0];
1428 struct devlink_sb *devlink_sb = info->user_ptr[1];
1429 enum devlink_sb_pool_type pool_type;
1435 err = devlink_sb_pool_type_get_from_info(info, &pool_type);
1439 err = devlink_sb_tc_index_get_from_info(devlink_sb, info,
1440 pool_type, &tc_index);
1444 err = devlink_sb_pool_index_get_from_info(devlink_sb, info,
1449 if (!info->attrs[DEVLINK_ATTR_SB_THRESHOLD])
1452 threshold = nla_get_u32(info->attrs[DEVLINK_ATTR_SB_THRESHOLD]);
1453 return devlink_sb_tc_pool_bind_set(devlink_port, devlink_sb->index,
1454 tc_index, pool_type,
1455 pool_index, threshold);
1458 static int devlink_nl_cmd_sb_occ_snapshot_doit(struct sk_buff *skb,
1459 struct genl_info *info)
1461 struct devlink *devlink = info->user_ptr[0];
1462 struct devlink_sb *devlink_sb = info->user_ptr[1];
1463 const struct devlink_ops *ops = devlink->ops;
1465 if (ops && ops->sb_occ_snapshot)
1466 return ops->sb_occ_snapshot(devlink, devlink_sb->index);
1470 static int devlink_nl_cmd_sb_occ_max_clear_doit(struct sk_buff *skb,
1471 struct genl_info *info)
1473 struct devlink *devlink = info->user_ptr[0];
1474 struct devlink_sb *devlink_sb = info->user_ptr[1];
1475 const struct devlink_ops *ops = devlink->ops;
1477 if (ops && ops->sb_occ_max_clear)
1478 return ops->sb_occ_max_clear(devlink, devlink_sb->index);
1482 static int devlink_nl_eswitch_fill(struct sk_buff *msg, struct devlink *devlink,
1483 enum devlink_command cmd, u32 portid,
1486 const struct devlink_ops *ops = devlink->ops;
1487 u8 inline_mode, encap_mode;
1492 hdr = genlmsg_put(msg, portid, seq, &devlink_nl_family, flags, cmd);
1496 err = devlink_nl_put_handle(msg, devlink);
1498 goto nla_put_failure;
1500 if (ops->eswitch_mode_get) {
1501 err = ops->eswitch_mode_get(devlink, &mode);
1503 goto nla_put_failure;
1504 err = nla_put_u16(msg, DEVLINK_ATTR_ESWITCH_MODE, mode);
1506 goto nla_put_failure;
1509 if (ops->eswitch_inline_mode_get) {
1510 err = ops->eswitch_inline_mode_get(devlink, &inline_mode);
1512 goto nla_put_failure;
1513 err = nla_put_u8(msg, DEVLINK_ATTR_ESWITCH_INLINE_MODE,
1516 goto nla_put_failure;
1519 if (ops->eswitch_encap_mode_get) {
1520 err = ops->eswitch_encap_mode_get(devlink, &encap_mode);
1522 goto nla_put_failure;
1523 err = nla_put_u8(msg, DEVLINK_ATTR_ESWITCH_ENCAP_MODE, encap_mode);
1525 goto nla_put_failure;
1528 genlmsg_end(msg, hdr);
1532 genlmsg_cancel(msg, hdr);
1536 static int devlink_nl_cmd_eswitch_get_doit(struct sk_buff *skb,
1537 struct genl_info *info)
1539 struct devlink *devlink = info->user_ptr[0];
1540 const struct devlink_ops *ops = devlink->ops;
1541 struct sk_buff *msg;
1547 msg = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
1551 err = devlink_nl_eswitch_fill(msg, devlink, DEVLINK_CMD_ESWITCH_GET,
1552 info->snd_portid, info->snd_seq, 0);
1559 return genlmsg_reply(msg, info);
1562 static int devlink_nl_cmd_eswitch_set_doit(struct sk_buff *skb,
1563 struct genl_info *info)
1565 struct devlink *devlink = info->user_ptr[0];
1566 const struct devlink_ops *ops = devlink->ops;
1567 u8 inline_mode, encap_mode;
1574 if (info->attrs[DEVLINK_ATTR_ESWITCH_MODE]) {
1575 if (!ops->eswitch_mode_set)
1577 mode = nla_get_u16(info->attrs[DEVLINK_ATTR_ESWITCH_MODE]);
1578 err = ops->eswitch_mode_set(devlink, mode);
1583 if (info->attrs[DEVLINK_ATTR_ESWITCH_INLINE_MODE]) {
1584 if (!ops->eswitch_inline_mode_set)
1586 inline_mode = nla_get_u8(
1587 info->attrs[DEVLINK_ATTR_ESWITCH_INLINE_MODE]);
1588 err = ops->eswitch_inline_mode_set(devlink, inline_mode);
1593 if (info->attrs[DEVLINK_ATTR_ESWITCH_ENCAP_MODE]) {
1594 if (!ops->eswitch_encap_mode_set)
1596 encap_mode = nla_get_u8(info->attrs[DEVLINK_ATTR_ESWITCH_ENCAP_MODE]);
1597 err = ops->eswitch_encap_mode_set(devlink, encap_mode);
1605 int devlink_dpipe_match_put(struct sk_buff *skb,
1606 struct devlink_dpipe_match *match)
1608 struct devlink_dpipe_header *header = match->header;
1609 struct devlink_dpipe_field *field = &header->fields[match->field_id];
1610 struct nlattr *match_attr;
1612 match_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_MATCH);
1616 if (nla_put_u32(skb, DEVLINK_ATTR_DPIPE_MATCH_TYPE, match->type) ||
1617 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_INDEX, match->header_index) ||
1618 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_ID, header->id) ||
1619 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_ID, field->id) ||
1620 nla_put_u8(skb, DEVLINK_ATTR_DPIPE_HEADER_GLOBAL, header->global))
1621 goto nla_put_failure;
1623 nla_nest_end(skb, match_attr);
1627 nla_nest_cancel(skb, match_attr);
1630 EXPORT_SYMBOL_GPL(devlink_dpipe_match_put);
1632 static int devlink_dpipe_matches_put(struct devlink_dpipe_table *table,
1633 struct sk_buff *skb)
1635 struct nlattr *matches_attr;
1637 matches_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_TABLE_MATCHES);
1641 if (table->table_ops->matches_dump(table->priv, skb))
1642 goto nla_put_failure;
1644 nla_nest_end(skb, matches_attr);
1648 nla_nest_cancel(skb, matches_attr);
1652 int devlink_dpipe_action_put(struct sk_buff *skb,
1653 struct devlink_dpipe_action *action)
1655 struct devlink_dpipe_header *header = action->header;
1656 struct devlink_dpipe_field *field = &header->fields[action->field_id];
1657 struct nlattr *action_attr;
1659 action_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_ACTION);
1663 if (nla_put_u32(skb, DEVLINK_ATTR_DPIPE_ACTION_TYPE, action->type) ||
1664 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_INDEX, action->header_index) ||
1665 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_ID, header->id) ||
1666 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_ID, field->id) ||
1667 nla_put_u8(skb, DEVLINK_ATTR_DPIPE_HEADER_GLOBAL, header->global))
1668 goto nla_put_failure;
1670 nla_nest_end(skb, action_attr);
1674 nla_nest_cancel(skb, action_attr);
1677 EXPORT_SYMBOL_GPL(devlink_dpipe_action_put);
1679 static int devlink_dpipe_actions_put(struct devlink_dpipe_table *table,
1680 struct sk_buff *skb)
1682 struct nlattr *actions_attr;
1684 actions_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_TABLE_ACTIONS);
1688 if (table->table_ops->actions_dump(table->priv, skb))
1689 goto nla_put_failure;
1691 nla_nest_end(skb, actions_attr);
1695 nla_nest_cancel(skb, actions_attr);
1699 static int devlink_dpipe_table_put(struct sk_buff *skb,
1700 struct devlink_dpipe_table *table)
1702 struct nlattr *table_attr;
1705 table_size = table->table_ops->size_get(table->priv);
1706 table_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_TABLE);
1710 if (nla_put_string(skb, DEVLINK_ATTR_DPIPE_TABLE_NAME, table->name) ||
1711 nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_TABLE_SIZE, table_size,
1713 goto nla_put_failure;
1714 if (nla_put_u8(skb, DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED,
1715 table->counters_enabled))
1716 goto nla_put_failure;
1718 if (table->resource_valid) {
1719 if (nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_TABLE_RESOURCE_ID,
1720 table->resource_id, DEVLINK_ATTR_PAD) ||
1721 nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_TABLE_RESOURCE_UNITS,
1722 table->resource_units, DEVLINK_ATTR_PAD))
1723 goto nla_put_failure;
1725 if (devlink_dpipe_matches_put(table, skb))
1726 goto nla_put_failure;
1728 if (devlink_dpipe_actions_put(table, skb))
1729 goto nla_put_failure;
1731 nla_nest_end(skb, table_attr);
1735 nla_nest_cancel(skb, table_attr);
1739 static int devlink_dpipe_send_and_alloc_skb(struct sk_buff **pskb,
1740 struct genl_info *info)
1745 err = genlmsg_reply(*pskb, info);
1749 *pskb = genlmsg_new(GENLMSG_DEFAULT_SIZE, GFP_KERNEL);
1755 static int devlink_dpipe_tables_fill(struct genl_info *info,
1756 enum devlink_command cmd, int flags,
1757 struct list_head *dpipe_tables,
1758 const char *table_name)
1760 struct devlink *devlink = info->user_ptr[0];
1761 struct devlink_dpipe_table *table;
1762 struct nlattr *tables_attr;
1763 struct sk_buff *skb = NULL;
1764 struct nlmsghdr *nlh;
1770 table = list_first_entry(dpipe_tables,
1771 struct devlink_dpipe_table, list);
1773 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
1777 hdr = genlmsg_put(skb, info->snd_portid, info->snd_seq,
1778 &devlink_nl_family, NLM_F_MULTI, cmd);
1784 if (devlink_nl_put_handle(skb, devlink))
1785 goto nla_put_failure;
1786 tables_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_TABLES);
1788 goto nla_put_failure;
1792 list_for_each_entry_from(table, dpipe_tables, list) {
1794 err = devlink_dpipe_table_put(skb, table);
1802 if (!strcmp(table->name, table_name)) {
1803 err = devlink_dpipe_table_put(skb, table);
1811 nla_nest_end(skb, tables_attr);
1812 genlmsg_end(skb, hdr);
1817 nlh = nlmsg_put(skb, info->snd_portid, info->snd_seq,
1818 NLMSG_DONE, 0, flags | NLM_F_MULTI);
1820 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
1826 return genlmsg_reply(skb, info);
1835 static int devlink_nl_cmd_dpipe_table_get(struct sk_buff *skb,
1836 struct genl_info *info)
1838 struct devlink *devlink = info->user_ptr[0];
1839 const char *table_name = NULL;
1841 if (info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME])
1842 table_name = nla_data(info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME]);
1844 return devlink_dpipe_tables_fill(info, DEVLINK_CMD_DPIPE_TABLE_GET, 0,
1845 &devlink->dpipe_table_list,
1849 static int devlink_dpipe_value_put(struct sk_buff *skb,
1850 struct devlink_dpipe_value *value)
1852 if (nla_put(skb, DEVLINK_ATTR_DPIPE_VALUE,
1853 value->value_size, value->value))
1856 if (nla_put(skb, DEVLINK_ATTR_DPIPE_VALUE_MASK,
1857 value->value_size, value->mask))
1859 if (value->mapping_valid)
1860 if (nla_put_u32(skb, DEVLINK_ATTR_DPIPE_VALUE_MAPPING,
1861 value->mapping_value))
1866 static int devlink_dpipe_action_value_put(struct sk_buff *skb,
1867 struct devlink_dpipe_value *value)
1871 if (devlink_dpipe_action_put(skb, value->action))
1873 if (devlink_dpipe_value_put(skb, value))
1878 static int devlink_dpipe_action_values_put(struct sk_buff *skb,
1879 struct devlink_dpipe_value *values,
1880 unsigned int values_count)
1882 struct nlattr *action_attr;
1886 for (i = 0; i < values_count; i++) {
1887 action_attr = nla_nest_start(skb,
1888 DEVLINK_ATTR_DPIPE_ACTION_VALUE);
1891 err = devlink_dpipe_action_value_put(skb, &values[i]);
1893 goto err_action_value_put;
1894 nla_nest_end(skb, action_attr);
1898 err_action_value_put:
1899 nla_nest_cancel(skb, action_attr);
1903 static int devlink_dpipe_match_value_put(struct sk_buff *skb,
1904 struct devlink_dpipe_value *value)
1908 if (devlink_dpipe_match_put(skb, value->match))
1910 if (devlink_dpipe_value_put(skb, value))
1915 static int devlink_dpipe_match_values_put(struct sk_buff *skb,
1916 struct devlink_dpipe_value *values,
1917 unsigned int values_count)
1919 struct nlattr *match_attr;
1923 for (i = 0; i < values_count; i++) {
1924 match_attr = nla_nest_start(skb,
1925 DEVLINK_ATTR_DPIPE_MATCH_VALUE);
1928 err = devlink_dpipe_match_value_put(skb, &values[i]);
1930 goto err_match_value_put;
1931 nla_nest_end(skb, match_attr);
1935 err_match_value_put:
1936 nla_nest_cancel(skb, match_attr);
1940 static int devlink_dpipe_entry_put(struct sk_buff *skb,
1941 struct devlink_dpipe_entry *entry)
1943 struct nlattr *entry_attr, *matches_attr, *actions_attr;
1946 entry_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_ENTRY);
1950 if (nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_ENTRY_INDEX, entry->index,
1952 goto nla_put_failure;
1953 if (entry->counter_valid)
1954 if (nla_put_u64_64bit(skb, DEVLINK_ATTR_DPIPE_ENTRY_COUNTER,
1955 entry->counter, DEVLINK_ATTR_PAD))
1956 goto nla_put_failure;
1958 matches_attr = nla_nest_start(skb,
1959 DEVLINK_ATTR_DPIPE_ENTRY_MATCH_VALUES);
1961 goto nla_put_failure;
1963 err = devlink_dpipe_match_values_put(skb, entry->match_values,
1964 entry->match_values_count);
1966 nla_nest_cancel(skb, matches_attr);
1967 goto err_match_values_put;
1969 nla_nest_end(skb, matches_attr);
1971 actions_attr = nla_nest_start(skb,
1972 DEVLINK_ATTR_DPIPE_ENTRY_ACTION_VALUES);
1974 goto nla_put_failure;
1976 err = devlink_dpipe_action_values_put(skb, entry->action_values,
1977 entry->action_values_count);
1979 nla_nest_cancel(skb, actions_attr);
1980 goto err_action_values_put;
1982 nla_nest_end(skb, actions_attr);
1984 nla_nest_end(skb, entry_attr);
1989 err_match_values_put:
1990 err_action_values_put:
1991 nla_nest_cancel(skb, entry_attr);
1995 static struct devlink_dpipe_table *
1996 devlink_dpipe_table_find(struct list_head *dpipe_tables,
1997 const char *table_name)
1999 struct devlink_dpipe_table *table;
2001 list_for_each_entry_rcu(table, dpipe_tables, list) {
2002 if (!strcmp(table->name, table_name))
2008 int devlink_dpipe_entry_ctx_prepare(struct devlink_dpipe_dump_ctx *dump_ctx)
2010 struct devlink *devlink;
2013 err = devlink_dpipe_send_and_alloc_skb(&dump_ctx->skb,
2018 dump_ctx->hdr = genlmsg_put(dump_ctx->skb,
2019 dump_ctx->info->snd_portid,
2020 dump_ctx->info->snd_seq,
2021 &devlink_nl_family, NLM_F_MULTI,
2024 goto nla_put_failure;
2026 devlink = dump_ctx->info->user_ptr[0];
2027 if (devlink_nl_put_handle(dump_ctx->skb, devlink))
2028 goto nla_put_failure;
2029 dump_ctx->nest = nla_nest_start(dump_ctx->skb,
2030 DEVLINK_ATTR_DPIPE_ENTRIES);
2031 if (!dump_ctx->nest)
2032 goto nla_put_failure;
2036 nlmsg_free(dump_ctx->skb);
2039 EXPORT_SYMBOL_GPL(devlink_dpipe_entry_ctx_prepare);
2041 int devlink_dpipe_entry_ctx_append(struct devlink_dpipe_dump_ctx *dump_ctx,
2042 struct devlink_dpipe_entry *entry)
2044 return devlink_dpipe_entry_put(dump_ctx->skb, entry);
2046 EXPORT_SYMBOL_GPL(devlink_dpipe_entry_ctx_append);
2048 int devlink_dpipe_entry_ctx_close(struct devlink_dpipe_dump_ctx *dump_ctx)
2050 nla_nest_end(dump_ctx->skb, dump_ctx->nest);
2051 genlmsg_end(dump_ctx->skb, dump_ctx->hdr);
2054 EXPORT_SYMBOL_GPL(devlink_dpipe_entry_ctx_close);
2056 void devlink_dpipe_entry_clear(struct devlink_dpipe_entry *entry)
2059 unsigned int value_count, value_index;
2060 struct devlink_dpipe_value *value;
2062 value = entry->action_values;
2063 value_count = entry->action_values_count;
2064 for (value_index = 0; value_index < value_count; value_index++) {
2065 kfree(value[value_index].value);
2066 kfree(value[value_index].mask);
2069 value = entry->match_values;
2070 value_count = entry->match_values_count;
2071 for (value_index = 0; value_index < value_count; value_index++) {
2072 kfree(value[value_index].value);
2073 kfree(value[value_index].mask);
2076 EXPORT_SYMBOL(devlink_dpipe_entry_clear);
2078 static int devlink_dpipe_entries_fill(struct genl_info *info,
2079 enum devlink_command cmd, int flags,
2080 struct devlink_dpipe_table *table)
2082 struct devlink_dpipe_dump_ctx dump_ctx;
2083 struct nlmsghdr *nlh;
2086 dump_ctx.skb = NULL;
2088 dump_ctx.info = info;
2090 err = table->table_ops->entries_dump(table->priv,
2091 table->counters_enabled,
2097 nlh = nlmsg_put(dump_ctx.skb, info->snd_portid, info->snd_seq,
2098 NLMSG_DONE, 0, flags | NLM_F_MULTI);
2100 err = devlink_dpipe_send_and_alloc_skb(&dump_ctx.skb, info);
2105 return genlmsg_reply(dump_ctx.skb, info);
2108 static int devlink_nl_cmd_dpipe_entries_get(struct sk_buff *skb,
2109 struct genl_info *info)
2111 struct devlink *devlink = info->user_ptr[0];
2112 struct devlink_dpipe_table *table;
2113 const char *table_name;
2115 if (!info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME])
2118 table_name = nla_data(info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME]);
2119 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
2124 if (!table->table_ops->entries_dump)
2127 return devlink_dpipe_entries_fill(info, DEVLINK_CMD_DPIPE_ENTRIES_GET,
2131 static int devlink_dpipe_fields_put(struct sk_buff *skb,
2132 const struct devlink_dpipe_header *header)
2134 struct devlink_dpipe_field *field;
2135 struct nlattr *field_attr;
2138 for (i = 0; i < header->fields_count; i++) {
2139 field = &header->fields[i];
2140 field_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_FIELD);
2143 if (nla_put_string(skb, DEVLINK_ATTR_DPIPE_FIELD_NAME, field->name) ||
2144 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_ID, field->id) ||
2145 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_BITWIDTH, field->bitwidth) ||
2146 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_FIELD_MAPPING_TYPE, field->mapping_type))
2147 goto nla_put_failure;
2148 nla_nest_end(skb, field_attr);
2153 nla_nest_cancel(skb, field_attr);
2157 static int devlink_dpipe_header_put(struct sk_buff *skb,
2158 struct devlink_dpipe_header *header)
2160 struct nlattr *fields_attr, *header_attr;
2163 header_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_HEADER);
2167 if (nla_put_string(skb, DEVLINK_ATTR_DPIPE_HEADER_NAME, header->name) ||
2168 nla_put_u32(skb, DEVLINK_ATTR_DPIPE_HEADER_ID, header->id) ||
2169 nla_put_u8(skb, DEVLINK_ATTR_DPIPE_HEADER_GLOBAL, header->global))
2170 goto nla_put_failure;
2172 fields_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_HEADER_FIELDS);
2174 goto nla_put_failure;
2176 err = devlink_dpipe_fields_put(skb, header);
2178 nla_nest_cancel(skb, fields_attr);
2179 goto nla_put_failure;
2181 nla_nest_end(skb, fields_attr);
2182 nla_nest_end(skb, header_attr);
2187 nla_nest_cancel(skb, header_attr);
2191 static int devlink_dpipe_headers_fill(struct genl_info *info,
2192 enum devlink_command cmd, int flags,
2193 struct devlink_dpipe_headers *
2196 struct devlink *devlink = info->user_ptr[0];
2197 struct nlattr *headers_attr;
2198 struct sk_buff *skb = NULL;
2199 struct nlmsghdr *nlh;
2206 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
2210 hdr = genlmsg_put(skb, info->snd_portid, info->snd_seq,
2211 &devlink_nl_family, NLM_F_MULTI, cmd);
2217 if (devlink_nl_put_handle(skb, devlink))
2218 goto nla_put_failure;
2219 headers_attr = nla_nest_start(skb, DEVLINK_ATTR_DPIPE_HEADERS);
2221 goto nla_put_failure;
2224 for (; i < dpipe_headers->headers_count; i++) {
2225 err = devlink_dpipe_header_put(skb, dpipe_headers->headers[i]);
2233 nla_nest_end(skb, headers_attr);
2234 genlmsg_end(skb, hdr);
2235 if (i != dpipe_headers->headers_count)
2239 nlh = nlmsg_put(skb, info->snd_portid, info->snd_seq,
2240 NLMSG_DONE, 0, flags | NLM_F_MULTI);
2242 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
2247 return genlmsg_reply(skb, info);
2256 static int devlink_nl_cmd_dpipe_headers_get(struct sk_buff *skb,
2257 struct genl_info *info)
2259 struct devlink *devlink = info->user_ptr[0];
2261 if (!devlink->dpipe_headers)
2263 return devlink_dpipe_headers_fill(info, DEVLINK_CMD_DPIPE_HEADERS_GET,
2264 0, devlink->dpipe_headers);
2267 static int devlink_dpipe_table_counters_set(struct devlink *devlink,
2268 const char *table_name,
2271 struct devlink_dpipe_table *table;
2273 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
2278 if (table->counter_control_extern)
2281 if (!(table->counters_enabled ^ enable))
2284 table->counters_enabled = enable;
2285 if (table->table_ops->counters_set_update)
2286 table->table_ops->counters_set_update(table->priv, enable);
2290 static int devlink_nl_cmd_dpipe_table_counters_set(struct sk_buff *skb,
2291 struct genl_info *info)
2293 struct devlink *devlink = info->user_ptr[0];
2294 const char *table_name;
2295 bool counters_enable;
2297 if (!info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME] ||
2298 !info->attrs[DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED])
2301 table_name = nla_data(info->attrs[DEVLINK_ATTR_DPIPE_TABLE_NAME]);
2302 counters_enable = !!nla_get_u8(info->attrs[DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED]);
2304 return devlink_dpipe_table_counters_set(devlink, table_name,
2308 static struct devlink_resource *
2309 devlink_resource_find(struct devlink *devlink,
2310 struct devlink_resource *resource, u64 resource_id)
2312 struct list_head *resource_list;
2315 resource_list = &resource->resource_list;
2317 resource_list = &devlink->resource_list;
2319 list_for_each_entry(resource, resource_list, list) {
2320 struct devlink_resource *child_resource;
2322 if (resource->id == resource_id)
2325 child_resource = devlink_resource_find(devlink, resource,
2328 return child_resource;
2334 devlink_resource_validate_children(struct devlink_resource *resource)
2336 struct devlink_resource *child_resource;
2337 bool size_valid = true;
2340 if (list_empty(&resource->resource_list))
2343 list_for_each_entry(child_resource, &resource->resource_list, list)
2344 parts_size += child_resource->size_new;
2346 if (parts_size > resource->size_new)
2349 resource->size_valid = size_valid;
2353 devlink_resource_validate_size(struct devlink_resource *resource, u64 size,
2354 struct netlink_ext_ack *extack)
2359 if (size > resource->size_params.size_max) {
2360 NL_SET_ERR_MSG_MOD(extack, "Size larger than maximum");
2364 if (size < resource->size_params.size_min) {
2365 NL_SET_ERR_MSG_MOD(extack, "Size smaller than minimum");
2369 div64_u64_rem(size, resource->size_params.size_granularity, &reminder);
2371 NL_SET_ERR_MSG_MOD(extack, "Wrong granularity");
2378 static int devlink_nl_cmd_resource_set(struct sk_buff *skb,
2379 struct genl_info *info)
2381 struct devlink *devlink = info->user_ptr[0];
2382 struct devlink_resource *resource;
2387 if (!info->attrs[DEVLINK_ATTR_RESOURCE_ID] ||
2388 !info->attrs[DEVLINK_ATTR_RESOURCE_SIZE])
2390 resource_id = nla_get_u64(info->attrs[DEVLINK_ATTR_RESOURCE_ID]);
2392 resource = devlink_resource_find(devlink, NULL, resource_id);
2396 size = nla_get_u64(info->attrs[DEVLINK_ATTR_RESOURCE_SIZE]);
2397 err = devlink_resource_validate_size(resource, size, info->extack);
2401 resource->size_new = size;
2402 devlink_resource_validate_children(resource);
2403 if (resource->parent)
2404 devlink_resource_validate_children(resource->parent);
2409 devlink_resource_size_params_put(struct devlink_resource *resource,
2410 struct sk_buff *skb)
2412 struct devlink_resource_size_params *size_params;
2414 size_params = &resource->size_params;
2415 if (nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_SIZE_GRAN,
2416 size_params->size_granularity, DEVLINK_ATTR_PAD) ||
2417 nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_SIZE_MAX,
2418 size_params->size_max, DEVLINK_ATTR_PAD) ||
2419 nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_SIZE_MIN,
2420 size_params->size_min, DEVLINK_ATTR_PAD) ||
2421 nla_put_u8(skb, DEVLINK_ATTR_RESOURCE_UNIT, size_params->unit))
2426 static int devlink_resource_occ_put(struct devlink_resource *resource,
2427 struct sk_buff *skb)
2429 if (!resource->occ_get)
2431 return nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_OCC,
2432 resource->occ_get(resource->occ_get_priv),
2436 static int devlink_resource_put(struct devlink *devlink, struct sk_buff *skb,
2437 struct devlink_resource *resource)
2439 struct devlink_resource *child_resource;
2440 struct nlattr *child_resource_attr;
2441 struct nlattr *resource_attr;
2443 resource_attr = nla_nest_start(skb, DEVLINK_ATTR_RESOURCE);
2447 if (nla_put_string(skb, DEVLINK_ATTR_RESOURCE_NAME, resource->name) ||
2448 nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_SIZE, resource->size,
2449 DEVLINK_ATTR_PAD) ||
2450 nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_ID, resource->id,
2452 goto nla_put_failure;
2453 if (resource->size != resource->size_new)
2454 nla_put_u64_64bit(skb, DEVLINK_ATTR_RESOURCE_SIZE_NEW,
2455 resource->size_new, DEVLINK_ATTR_PAD);
2456 if (devlink_resource_occ_put(resource, skb))
2457 goto nla_put_failure;
2458 if (devlink_resource_size_params_put(resource, skb))
2459 goto nla_put_failure;
2460 if (list_empty(&resource->resource_list))
2463 if (nla_put_u8(skb, DEVLINK_ATTR_RESOURCE_SIZE_VALID,
2464 resource->size_valid))
2465 goto nla_put_failure;
2467 child_resource_attr = nla_nest_start(skb, DEVLINK_ATTR_RESOURCE_LIST);
2468 if (!child_resource_attr)
2469 goto nla_put_failure;
2471 list_for_each_entry(child_resource, &resource->resource_list, list) {
2472 if (devlink_resource_put(devlink, skb, child_resource))
2473 goto resource_put_failure;
2476 nla_nest_end(skb, child_resource_attr);
2478 nla_nest_end(skb, resource_attr);
2481 resource_put_failure:
2482 nla_nest_cancel(skb, child_resource_attr);
2484 nla_nest_cancel(skb, resource_attr);
2488 static int devlink_resource_fill(struct genl_info *info,
2489 enum devlink_command cmd, int flags)
2491 struct devlink *devlink = info->user_ptr[0];
2492 struct devlink_resource *resource;
2493 struct nlattr *resources_attr;
2494 struct sk_buff *skb = NULL;
2495 struct nlmsghdr *nlh;
2501 resource = list_first_entry(&devlink->resource_list,
2502 struct devlink_resource, list);
2504 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
2508 hdr = genlmsg_put(skb, info->snd_portid, info->snd_seq,
2509 &devlink_nl_family, NLM_F_MULTI, cmd);
2515 if (devlink_nl_put_handle(skb, devlink))
2516 goto nla_put_failure;
2518 resources_attr = nla_nest_start(skb, DEVLINK_ATTR_RESOURCE_LIST);
2519 if (!resources_attr)
2520 goto nla_put_failure;
2524 list_for_each_entry_from(resource, &devlink->resource_list, list) {
2525 err = devlink_resource_put(devlink, skb, resource);
2528 goto err_resource_put;
2534 nla_nest_end(skb, resources_attr);
2535 genlmsg_end(skb, hdr);
2539 nlh = nlmsg_put(skb, info->snd_portid, info->snd_seq,
2540 NLMSG_DONE, 0, flags | NLM_F_MULTI);
2542 err = devlink_dpipe_send_and_alloc_skb(&skb, info);
2544 goto err_skb_send_alloc;
2547 return genlmsg_reply(skb, info);
2557 static int devlink_nl_cmd_resource_dump(struct sk_buff *skb,
2558 struct genl_info *info)
2560 struct devlink *devlink = info->user_ptr[0];
2562 if (list_empty(&devlink->resource_list))
2565 return devlink_resource_fill(info, DEVLINK_CMD_RESOURCE_DUMP, 0);
2569 devlink_resources_validate(struct devlink *devlink,
2570 struct devlink_resource *resource,
2571 struct genl_info *info)
2573 struct list_head *resource_list;
2577 resource_list = &resource->resource_list;
2579 resource_list = &devlink->resource_list;
2581 list_for_each_entry(resource, resource_list, list) {
2582 if (!resource->size_valid)
2584 err = devlink_resources_validate(devlink, resource, info);
2591 static int devlink_nl_cmd_reload(struct sk_buff *skb, struct genl_info *info)
2593 struct devlink *devlink = info->user_ptr[0];
2596 if (!devlink->ops->reload)
2599 err = devlink_resources_validate(devlink, NULL, info);
2601 NL_SET_ERR_MSG_MOD(info->extack, "resources size validation failed");
2604 return devlink->ops->reload(devlink, info->extack);
2607 static const struct nla_policy devlink_nl_policy[DEVLINK_ATTR_MAX + 1] = {
2608 [DEVLINK_ATTR_BUS_NAME] = { .type = NLA_NUL_STRING },
2609 [DEVLINK_ATTR_DEV_NAME] = { .type = NLA_NUL_STRING },
2610 [DEVLINK_ATTR_PORT_INDEX] = { .type = NLA_U32 },
2611 [DEVLINK_ATTR_PORT_TYPE] = { .type = NLA_U16 },
2612 [DEVLINK_ATTR_PORT_SPLIT_COUNT] = { .type = NLA_U32 },
2613 [DEVLINK_ATTR_SB_INDEX] = { .type = NLA_U32 },
2614 [DEVLINK_ATTR_SB_POOL_INDEX] = { .type = NLA_U16 },
2615 [DEVLINK_ATTR_SB_POOL_TYPE] = { .type = NLA_U8 },
2616 [DEVLINK_ATTR_SB_POOL_SIZE] = { .type = NLA_U32 },
2617 [DEVLINK_ATTR_SB_POOL_THRESHOLD_TYPE] = { .type = NLA_U8 },
2618 [DEVLINK_ATTR_SB_THRESHOLD] = { .type = NLA_U32 },
2619 [DEVLINK_ATTR_SB_TC_INDEX] = { .type = NLA_U16 },
2620 [DEVLINK_ATTR_ESWITCH_MODE] = { .type = NLA_U16 },
2621 [DEVLINK_ATTR_ESWITCH_INLINE_MODE] = { .type = NLA_U8 },
2622 [DEVLINK_ATTR_ESWITCH_ENCAP_MODE] = { .type = NLA_U8 },
2623 [DEVLINK_ATTR_DPIPE_TABLE_NAME] = { .type = NLA_NUL_STRING },
2624 [DEVLINK_ATTR_DPIPE_TABLE_COUNTERS_ENABLED] = { .type = NLA_U8 },
2625 [DEVLINK_ATTR_RESOURCE_ID] = { .type = NLA_U64},
2626 [DEVLINK_ATTR_RESOURCE_SIZE] = { .type = NLA_U64},
2629 static const struct genl_ops devlink_nl_ops[] = {
2631 .cmd = DEVLINK_CMD_GET,
2632 .doit = devlink_nl_cmd_get_doit,
2633 .dumpit = devlink_nl_cmd_get_dumpit,
2634 .policy = devlink_nl_policy,
2635 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2636 /* can be retrieved by unprivileged users */
2639 .cmd = DEVLINK_CMD_PORT_GET,
2640 .doit = devlink_nl_cmd_port_get_doit,
2641 .dumpit = devlink_nl_cmd_port_get_dumpit,
2642 .policy = devlink_nl_policy,
2643 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT,
2644 /* can be retrieved by unprivileged users */
2647 .cmd = DEVLINK_CMD_PORT_SET,
2648 .doit = devlink_nl_cmd_port_set_doit,
2649 .policy = devlink_nl_policy,
2650 .flags = GENL_ADMIN_PERM,
2651 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT,
2654 .cmd = DEVLINK_CMD_PORT_SPLIT,
2655 .doit = devlink_nl_cmd_port_split_doit,
2656 .policy = devlink_nl_policy,
2657 .flags = GENL_ADMIN_PERM,
2658 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2659 DEVLINK_NL_FLAG_NO_LOCK,
2662 .cmd = DEVLINK_CMD_PORT_UNSPLIT,
2663 .doit = devlink_nl_cmd_port_unsplit_doit,
2664 .policy = devlink_nl_policy,
2665 .flags = GENL_ADMIN_PERM,
2666 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2667 DEVLINK_NL_FLAG_NO_LOCK,
2670 .cmd = DEVLINK_CMD_SB_GET,
2671 .doit = devlink_nl_cmd_sb_get_doit,
2672 .dumpit = devlink_nl_cmd_sb_get_dumpit,
2673 .policy = devlink_nl_policy,
2674 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2675 DEVLINK_NL_FLAG_NEED_SB,
2676 /* can be retrieved by unprivileged users */
2679 .cmd = DEVLINK_CMD_SB_POOL_GET,
2680 .doit = devlink_nl_cmd_sb_pool_get_doit,
2681 .dumpit = devlink_nl_cmd_sb_pool_get_dumpit,
2682 .policy = devlink_nl_policy,
2683 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2684 DEVLINK_NL_FLAG_NEED_SB,
2685 /* can be retrieved by unprivileged users */
2688 .cmd = DEVLINK_CMD_SB_POOL_SET,
2689 .doit = devlink_nl_cmd_sb_pool_set_doit,
2690 .policy = devlink_nl_policy,
2691 .flags = GENL_ADMIN_PERM,
2692 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2693 DEVLINK_NL_FLAG_NEED_SB,
2696 .cmd = DEVLINK_CMD_SB_PORT_POOL_GET,
2697 .doit = devlink_nl_cmd_sb_port_pool_get_doit,
2698 .dumpit = devlink_nl_cmd_sb_port_pool_get_dumpit,
2699 .policy = devlink_nl_policy,
2700 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT |
2701 DEVLINK_NL_FLAG_NEED_SB,
2702 /* can be retrieved by unprivileged users */
2705 .cmd = DEVLINK_CMD_SB_PORT_POOL_SET,
2706 .doit = devlink_nl_cmd_sb_port_pool_set_doit,
2707 .policy = devlink_nl_policy,
2708 .flags = GENL_ADMIN_PERM,
2709 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT |
2710 DEVLINK_NL_FLAG_NEED_SB,
2713 .cmd = DEVLINK_CMD_SB_TC_POOL_BIND_GET,
2714 .doit = devlink_nl_cmd_sb_tc_pool_bind_get_doit,
2715 .dumpit = devlink_nl_cmd_sb_tc_pool_bind_get_dumpit,
2716 .policy = devlink_nl_policy,
2717 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT |
2718 DEVLINK_NL_FLAG_NEED_SB,
2719 /* can be retrieved by unprivileged users */
2722 .cmd = DEVLINK_CMD_SB_TC_POOL_BIND_SET,
2723 .doit = devlink_nl_cmd_sb_tc_pool_bind_set_doit,
2724 .policy = devlink_nl_policy,
2725 .flags = GENL_ADMIN_PERM,
2726 .internal_flags = DEVLINK_NL_FLAG_NEED_PORT |
2727 DEVLINK_NL_FLAG_NEED_SB,
2730 .cmd = DEVLINK_CMD_SB_OCC_SNAPSHOT,
2731 .doit = devlink_nl_cmd_sb_occ_snapshot_doit,
2732 .policy = devlink_nl_policy,
2733 .flags = GENL_ADMIN_PERM,
2734 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2735 DEVLINK_NL_FLAG_NEED_SB,
2738 .cmd = DEVLINK_CMD_SB_OCC_MAX_CLEAR,
2739 .doit = devlink_nl_cmd_sb_occ_max_clear_doit,
2740 .policy = devlink_nl_policy,
2741 .flags = GENL_ADMIN_PERM,
2742 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2743 DEVLINK_NL_FLAG_NEED_SB,
2746 .cmd = DEVLINK_CMD_ESWITCH_GET,
2747 .doit = devlink_nl_cmd_eswitch_get_doit,
2748 .policy = devlink_nl_policy,
2749 .flags = GENL_ADMIN_PERM,
2750 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2753 .cmd = DEVLINK_CMD_ESWITCH_SET,
2754 .doit = devlink_nl_cmd_eswitch_set_doit,
2755 .policy = devlink_nl_policy,
2756 .flags = GENL_ADMIN_PERM,
2757 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2758 DEVLINK_NL_FLAG_NO_LOCK,
2761 .cmd = DEVLINK_CMD_DPIPE_TABLE_GET,
2762 .doit = devlink_nl_cmd_dpipe_table_get,
2763 .policy = devlink_nl_policy,
2764 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2765 /* can be retrieved by unprivileged users */
2768 .cmd = DEVLINK_CMD_DPIPE_ENTRIES_GET,
2769 .doit = devlink_nl_cmd_dpipe_entries_get,
2770 .policy = devlink_nl_policy,
2771 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2772 /* can be retrieved by unprivileged users */
2775 .cmd = DEVLINK_CMD_DPIPE_HEADERS_GET,
2776 .doit = devlink_nl_cmd_dpipe_headers_get,
2777 .policy = devlink_nl_policy,
2778 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2779 /* can be retrieved by unprivileged users */
2782 .cmd = DEVLINK_CMD_DPIPE_TABLE_COUNTERS_SET,
2783 .doit = devlink_nl_cmd_dpipe_table_counters_set,
2784 .policy = devlink_nl_policy,
2785 .flags = GENL_ADMIN_PERM,
2786 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2789 .cmd = DEVLINK_CMD_RESOURCE_SET,
2790 .doit = devlink_nl_cmd_resource_set,
2791 .policy = devlink_nl_policy,
2792 .flags = GENL_ADMIN_PERM,
2793 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2796 .cmd = DEVLINK_CMD_RESOURCE_DUMP,
2797 .doit = devlink_nl_cmd_resource_dump,
2798 .policy = devlink_nl_policy,
2799 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK,
2800 /* can be retrieved by unprivileged users */
2803 .cmd = DEVLINK_CMD_RELOAD,
2804 .doit = devlink_nl_cmd_reload,
2805 .policy = devlink_nl_policy,
2806 .flags = GENL_ADMIN_PERM,
2807 .internal_flags = DEVLINK_NL_FLAG_NEED_DEVLINK |
2808 DEVLINK_NL_FLAG_NO_LOCK,
2812 static struct genl_family devlink_nl_family __ro_after_init = {
2813 .name = DEVLINK_GENL_NAME,
2814 .version = DEVLINK_GENL_VERSION,
2815 .maxattr = DEVLINK_ATTR_MAX,
2817 .pre_doit = devlink_nl_pre_doit,
2818 .post_doit = devlink_nl_post_doit,
2819 .module = THIS_MODULE,
2820 .ops = devlink_nl_ops,
2821 .n_ops = ARRAY_SIZE(devlink_nl_ops),
2822 .mcgrps = devlink_nl_mcgrps,
2823 .n_mcgrps = ARRAY_SIZE(devlink_nl_mcgrps),
2827 * devlink_alloc - Allocate new devlink instance resources
2830 * @priv_size: size of user private data
2832 * Allocate new devlink instance resources, including devlink index
2835 struct devlink *devlink_alloc(const struct devlink_ops *ops, size_t priv_size)
2837 struct devlink *devlink;
2839 devlink = kzalloc(sizeof(*devlink) + priv_size, GFP_KERNEL);
2843 devlink_net_set(devlink, &init_net);
2844 INIT_LIST_HEAD(&devlink->port_list);
2845 INIT_LIST_HEAD(&devlink->sb_list);
2846 INIT_LIST_HEAD_RCU(&devlink->dpipe_table_list);
2847 INIT_LIST_HEAD(&devlink->resource_list);
2848 mutex_init(&devlink->lock);
2851 EXPORT_SYMBOL_GPL(devlink_alloc);
2854 * devlink_register - Register devlink instance
2858 int devlink_register(struct devlink *devlink, struct device *dev)
2860 mutex_lock(&devlink_mutex);
2862 list_add_tail(&devlink->list, &devlink_list);
2863 devlink_notify(devlink, DEVLINK_CMD_NEW);
2864 mutex_unlock(&devlink_mutex);
2867 EXPORT_SYMBOL_GPL(devlink_register);
2870 * devlink_unregister - Unregister devlink instance
2874 void devlink_unregister(struct devlink *devlink)
2876 mutex_lock(&devlink_mutex);
2877 devlink_notify(devlink, DEVLINK_CMD_DEL);
2878 list_del(&devlink->list);
2879 mutex_unlock(&devlink_mutex);
2881 EXPORT_SYMBOL_GPL(devlink_unregister);
2884 * devlink_free - Free devlink instance resources
2888 void devlink_free(struct devlink *devlink)
2892 EXPORT_SYMBOL_GPL(devlink_free);
2895 * devlink_port_register - Register devlink port
2898 * @devlink_port: devlink port
2901 * Register devlink port with provided port index. User can use
2902 * any indexing, even hw-related one. devlink_port structure
2903 * is convenient to be embedded inside user driver private structure.
2904 * Note that the caller should take care of zeroing the devlink_port
2907 int devlink_port_register(struct devlink *devlink,
2908 struct devlink_port *devlink_port,
2909 unsigned int port_index)
2911 mutex_lock(&devlink->lock);
2912 if (devlink_port_index_exists(devlink, port_index)) {
2913 mutex_unlock(&devlink->lock);
2916 devlink_port->devlink = devlink;
2917 devlink_port->index = port_index;
2918 devlink_port->registered = true;
2919 list_add_tail(&devlink_port->list, &devlink->port_list);
2920 mutex_unlock(&devlink->lock);
2921 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_NEW);
2924 EXPORT_SYMBOL_GPL(devlink_port_register);
2927 * devlink_port_unregister - Unregister devlink port
2929 * @devlink_port: devlink port
2931 void devlink_port_unregister(struct devlink_port *devlink_port)
2933 struct devlink *devlink = devlink_port->devlink;
2935 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_DEL);
2936 mutex_lock(&devlink->lock);
2937 list_del(&devlink_port->list);
2938 mutex_unlock(&devlink->lock);
2940 EXPORT_SYMBOL_GPL(devlink_port_unregister);
2942 static void __devlink_port_type_set(struct devlink_port *devlink_port,
2943 enum devlink_port_type type,
2946 devlink_port->type = type;
2947 devlink_port->type_dev = type_dev;
2948 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_NEW);
2952 * devlink_port_type_eth_set - Set port type to Ethernet
2954 * @devlink_port: devlink port
2955 * @netdev: related netdevice
2957 void devlink_port_type_eth_set(struct devlink_port *devlink_port,
2958 struct net_device *netdev)
2960 return __devlink_port_type_set(devlink_port,
2961 DEVLINK_PORT_TYPE_ETH, netdev);
2963 EXPORT_SYMBOL_GPL(devlink_port_type_eth_set);
2966 * devlink_port_type_ib_set - Set port type to InfiniBand
2968 * @devlink_port: devlink port
2969 * @ibdev: related IB device
2971 void devlink_port_type_ib_set(struct devlink_port *devlink_port,
2972 struct ib_device *ibdev)
2974 return __devlink_port_type_set(devlink_port,
2975 DEVLINK_PORT_TYPE_IB, ibdev);
2977 EXPORT_SYMBOL_GPL(devlink_port_type_ib_set);
2980 * devlink_port_type_clear - Clear port type
2982 * @devlink_port: devlink port
2984 void devlink_port_type_clear(struct devlink_port *devlink_port)
2986 return __devlink_port_type_set(devlink_port,
2987 DEVLINK_PORT_TYPE_NOTSET, NULL);
2989 EXPORT_SYMBOL_GPL(devlink_port_type_clear);
2992 * devlink_port_attrs_set - Set port attributes
2994 * @devlink_port: devlink port
2995 * @flavour: flavour of the port
2996 * @port_number: number of the port that is facing user, for example
2997 * the front panel port number
2998 * @split: indicates if this is split port
2999 * @split_subport_number: if the port is split, this is the number
3002 void devlink_port_attrs_set(struct devlink_port *devlink_port,
3003 enum devlink_port_flavour flavour,
3004 u32 port_number, bool split,
3005 u32 split_subport_number)
3007 struct devlink_port_attrs *attrs = &devlink_port->attrs;
3010 attrs->flavour = flavour;
3011 attrs->port_number = port_number;
3012 attrs->split = split;
3013 attrs->split_subport_number = split_subport_number;
3014 devlink_port_notify(devlink_port, DEVLINK_CMD_PORT_NEW);
3016 EXPORT_SYMBOL_GPL(devlink_port_attrs_set);
3018 int devlink_port_get_phys_port_name(struct devlink_port *devlink_port,
3019 char *name, size_t len)
3021 struct devlink_port_attrs *attrs = &devlink_port->attrs;
3027 switch (attrs->flavour) {
3028 case DEVLINK_PORT_FLAVOUR_PHYSICAL:
3030 n = snprintf(name, len, "p%u", attrs->port_number);
3032 n = snprintf(name, len, "p%us%u", attrs->port_number,
3033 attrs->split_subport_number);
3035 case DEVLINK_PORT_FLAVOUR_CPU:
3036 case DEVLINK_PORT_FLAVOUR_DSA:
3037 /* As CPU and DSA ports do not have a netdevice associated
3038 * case should not ever happen.
3049 EXPORT_SYMBOL_GPL(devlink_port_get_phys_port_name);
3051 int devlink_sb_register(struct devlink *devlink, unsigned int sb_index,
3052 u32 size, u16 ingress_pools_count,
3053 u16 egress_pools_count, u16 ingress_tc_count,
3054 u16 egress_tc_count)
3056 struct devlink_sb *devlink_sb;
3059 mutex_lock(&devlink->lock);
3060 if (devlink_sb_index_exists(devlink, sb_index)) {
3065 devlink_sb = kzalloc(sizeof(*devlink_sb), GFP_KERNEL);
3070 devlink_sb->index = sb_index;
3071 devlink_sb->size = size;
3072 devlink_sb->ingress_pools_count = ingress_pools_count;
3073 devlink_sb->egress_pools_count = egress_pools_count;
3074 devlink_sb->ingress_tc_count = ingress_tc_count;
3075 devlink_sb->egress_tc_count = egress_tc_count;
3076 list_add_tail(&devlink_sb->list, &devlink->sb_list);
3078 mutex_unlock(&devlink->lock);
3081 EXPORT_SYMBOL_GPL(devlink_sb_register);
3083 void devlink_sb_unregister(struct devlink *devlink, unsigned int sb_index)
3085 struct devlink_sb *devlink_sb;
3087 mutex_lock(&devlink->lock);
3088 devlink_sb = devlink_sb_get_by_index(devlink, sb_index);
3089 WARN_ON(!devlink_sb);
3090 list_del(&devlink_sb->list);
3091 mutex_unlock(&devlink->lock);
3094 EXPORT_SYMBOL_GPL(devlink_sb_unregister);
3097 * devlink_dpipe_headers_register - register dpipe headers
3100 * @dpipe_headers: dpipe header array
3102 * Register the headers supported by hardware.
3104 int devlink_dpipe_headers_register(struct devlink *devlink,
3105 struct devlink_dpipe_headers *dpipe_headers)
3107 mutex_lock(&devlink->lock);
3108 devlink->dpipe_headers = dpipe_headers;
3109 mutex_unlock(&devlink->lock);
3112 EXPORT_SYMBOL_GPL(devlink_dpipe_headers_register);
3115 * devlink_dpipe_headers_unregister - unregister dpipe headers
3119 * Unregister the headers supported by hardware.
3121 void devlink_dpipe_headers_unregister(struct devlink *devlink)
3123 mutex_lock(&devlink->lock);
3124 devlink->dpipe_headers = NULL;
3125 mutex_unlock(&devlink->lock);
3127 EXPORT_SYMBOL_GPL(devlink_dpipe_headers_unregister);
3130 * devlink_dpipe_table_counter_enabled - check if counter allocation
3133 * @table_name: tables name
3135 * Used by driver to check if counter allocation is required.
3136 * After counter allocation is turned on the table entries
3137 * are updated to include counter statistics.
3139 * After that point on the driver must respect the counter
3140 * state so that each entry added to the table is added
3143 bool devlink_dpipe_table_counter_enabled(struct devlink *devlink,
3144 const char *table_name)
3146 struct devlink_dpipe_table *table;
3150 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
3154 enabled = table->counters_enabled;
3158 EXPORT_SYMBOL_GPL(devlink_dpipe_table_counter_enabled);
3161 * devlink_dpipe_table_register - register dpipe table
3164 * @table_name: table name
3165 * @table_ops: table ops
3167 * @counter_control_extern: external control for counters
3169 int devlink_dpipe_table_register(struct devlink *devlink,
3170 const char *table_name,
3171 struct devlink_dpipe_table_ops *table_ops,
3172 void *priv, bool counter_control_extern)
3174 struct devlink_dpipe_table *table;
3176 if (devlink_dpipe_table_find(&devlink->dpipe_table_list, table_name))
3179 if (WARN_ON(!table_ops->size_get))
3182 table = kzalloc(sizeof(*table), GFP_KERNEL);
3186 table->name = table_name;
3187 table->table_ops = table_ops;
3189 table->counter_control_extern = counter_control_extern;
3191 mutex_lock(&devlink->lock);
3192 list_add_tail_rcu(&table->list, &devlink->dpipe_table_list);
3193 mutex_unlock(&devlink->lock);
3196 EXPORT_SYMBOL_GPL(devlink_dpipe_table_register);
3199 * devlink_dpipe_table_unregister - unregister dpipe table
3202 * @table_name: table name
3204 void devlink_dpipe_table_unregister(struct devlink *devlink,
3205 const char *table_name)
3207 struct devlink_dpipe_table *table;
3209 mutex_lock(&devlink->lock);
3210 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
3214 list_del_rcu(&table->list);
3215 mutex_unlock(&devlink->lock);
3216 kfree_rcu(table, rcu);
3219 mutex_unlock(&devlink->lock);
3221 EXPORT_SYMBOL_GPL(devlink_dpipe_table_unregister);
3224 * devlink_resource_register - devlink resource register
3227 * @resource_name: resource's name
3228 * @top_hierarchy: top hierarchy
3229 * @reload_required: reload is required for new configuration to
3231 * @resource_size: resource's size
3232 * @resource_id: resource's id
3233 * @parent_reosurce_id: resource's parent id
3234 * @size params: size parameters
3236 int devlink_resource_register(struct devlink *devlink,
3237 const char *resource_name,
3240 u64 parent_resource_id,
3241 const struct devlink_resource_size_params *size_params)
3243 struct devlink_resource *resource;
3244 struct list_head *resource_list;
3248 top_hierarchy = parent_resource_id == DEVLINK_RESOURCE_ID_PARENT_TOP;
3250 mutex_lock(&devlink->lock);
3251 resource = devlink_resource_find(devlink, NULL, resource_id);
3257 resource = kzalloc(sizeof(*resource), GFP_KERNEL);
3263 if (top_hierarchy) {
3264 resource_list = &devlink->resource_list;
3266 struct devlink_resource *parent_resource;
3268 parent_resource = devlink_resource_find(devlink, NULL,
3269 parent_resource_id);
3270 if (parent_resource) {
3271 resource_list = &parent_resource->resource_list;
3272 resource->parent = parent_resource;
3280 resource->name = resource_name;
3281 resource->size = resource_size;
3282 resource->size_new = resource_size;
3283 resource->id = resource_id;
3284 resource->size_valid = true;
3285 memcpy(&resource->size_params, size_params,
3286 sizeof(resource->size_params));
3287 INIT_LIST_HEAD(&resource->resource_list);
3288 list_add_tail(&resource->list, resource_list);
3290 mutex_unlock(&devlink->lock);
3293 EXPORT_SYMBOL_GPL(devlink_resource_register);
3296 * devlink_resources_unregister - free all resources
3299 * @resource: resource
3301 void devlink_resources_unregister(struct devlink *devlink,
3302 struct devlink_resource *resource)
3304 struct devlink_resource *tmp, *child_resource;
3305 struct list_head *resource_list;
3308 resource_list = &resource->resource_list;
3310 resource_list = &devlink->resource_list;
3313 mutex_lock(&devlink->lock);
3315 list_for_each_entry_safe(child_resource, tmp, resource_list, list) {
3316 devlink_resources_unregister(devlink, child_resource);
3317 list_del(&child_resource->list);
3318 kfree(child_resource);
3322 mutex_unlock(&devlink->lock);
3324 EXPORT_SYMBOL_GPL(devlink_resources_unregister);
3327 * devlink_resource_size_get - get and update size
3330 * @resource_id: the requested resource id
3331 * @p_resource_size: ptr to update
3333 int devlink_resource_size_get(struct devlink *devlink,
3335 u64 *p_resource_size)
3337 struct devlink_resource *resource;
3340 mutex_lock(&devlink->lock);
3341 resource = devlink_resource_find(devlink, NULL, resource_id);
3346 *p_resource_size = resource->size_new;
3347 resource->size = resource->size_new;
3349 mutex_unlock(&devlink->lock);
3352 EXPORT_SYMBOL_GPL(devlink_resource_size_get);
3355 * devlink_dpipe_table_resource_set - set the resource id
3358 * @table_name: table name
3359 * @resource_id: resource id
3360 * @resource_units: number of resource's units consumed per table's entry
3362 int devlink_dpipe_table_resource_set(struct devlink *devlink,
3363 const char *table_name, u64 resource_id,
3366 struct devlink_dpipe_table *table;
3369 mutex_lock(&devlink->lock);
3370 table = devlink_dpipe_table_find(&devlink->dpipe_table_list,
3376 table->resource_id = resource_id;
3377 table->resource_units = resource_units;
3378 table->resource_valid = true;
3380 mutex_unlock(&devlink->lock);
3383 EXPORT_SYMBOL_GPL(devlink_dpipe_table_resource_set);
3386 * devlink_resource_occ_get_register - register occupancy getter
3389 * @resource_id: resource id
3390 * @occ_get: occupancy getter callback
3391 * @occ_get_priv: occupancy getter callback priv
3393 void devlink_resource_occ_get_register(struct devlink *devlink,
3395 devlink_resource_occ_get_t *occ_get,
3398 struct devlink_resource *resource;
3400 mutex_lock(&devlink->lock);
3401 resource = devlink_resource_find(devlink, NULL, resource_id);
3402 if (WARN_ON(!resource))
3404 WARN_ON(resource->occ_get);
3406 resource->occ_get = occ_get;
3407 resource->occ_get_priv = occ_get_priv;
3409 mutex_unlock(&devlink->lock);
3411 EXPORT_SYMBOL_GPL(devlink_resource_occ_get_register);
3414 * devlink_resource_occ_get_unregister - unregister occupancy getter
3417 * @resource_id: resource id
3419 void devlink_resource_occ_get_unregister(struct devlink *devlink,
3422 struct devlink_resource *resource;
3424 mutex_lock(&devlink->lock);
3425 resource = devlink_resource_find(devlink, NULL, resource_id);
3426 if (WARN_ON(!resource))
3428 WARN_ON(!resource->occ_get);
3430 resource->occ_get = NULL;
3431 resource->occ_get_priv = NULL;
3433 mutex_unlock(&devlink->lock);
3435 EXPORT_SYMBOL_GPL(devlink_resource_occ_get_unregister);
3437 static int __init devlink_module_init(void)
3439 return genl_register_family(&devlink_nl_family);
3442 static void __exit devlink_module_exit(void)
3444 genl_unregister_family(&devlink_nl_family);
3447 module_init(devlink_module_init);
3448 module_exit(devlink_module_exit);
3450 MODULE_LICENSE("GPL v2");
3451 MODULE_AUTHOR("Jiri Pirko <jiri@mellanox.com>");
3452 MODULE_DESCRIPTION("Network physical device Netlink interface");
3453 MODULE_ALIAS_GENL_FAMILY(DEVLINK_GENL_NAME);