[PATCH v14 02/20] netlink: add new family to manage ULP_DDP enablement and stats
Aurelien Aptel
aaptel at nvidia.com
Wed Sep 6 04:30:00 PDT 2023
Add a new netlink family to get/set ULP DDP capabilities on a network
device and to retrieve statistics.
The messages use the genetlink infrastructure and are specified in a
YAML file which was used to generate some of the files in this commit:
./tools/net/ynl/ynl-gen-c.py --mode kernel \
--spec ./Documentation/netlink/specs/ulp_ddp.yaml --header \
-o net/core/ulp_ddp_gen_nl.h
./tools/net/ynl/ynl-gen-c.py --mode kernel \
--spec ./Documentation/netlink/specs/ulp_ddp.yaml --source \
-o net/core/ulp_ddp_gen_nl.c
./tools/net/ynl/ynl-gen-c.py --mode uapi \
--spec ./Documentation/netlink/specs/ulp_ddp.yaml --header \
> include/uapi/linux/ulp_ddp_nl.h
Signed-off-by: Shai Malin <smalin at nvidia.com>
Signed-off-by: Aurelien Aptel <aaptel at nvidia.com>
---
Documentation/netlink/specs/ulp_ddp.yaml | 175 ++++++++++++
include/uapi/linux/ulp_ddp_nl.h | 59 ++++
net/core/Makefile | 2 +-
net/core/ulp_ddp_gen_nl.c | 75 +++++
net/core/ulp_ddp_gen_nl.h | 30 ++
net/core/ulp_ddp_nl.c | 343 +++++++++++++++++++++++
6 files changed, 683 insertions(+), 1 deletion(-)
create mode 100644 Documentation/netlink/specs/ulp_ddp.yaml
create mode 100644 include/uapi/linux/ulp_ddp_nl.h
create mode 100644 net/core/ulp_ddp_gen_nl.c
create mode 100644 net/core/ulp_ddp_gen_nl.h
create mode 100644 net/core/ulp_ddp_nl.c
diff --git a/Documentation/netlink/specs/ulp_ddp.yaml b/Documentation/netlink/specs/ulp_ddp.yaml
new file mode 100644
index 000000000000..89df10e25295
--- /dev/null
+++ b/Documentation/netlink/specs/ulp_ddp.yaml
@@ -0,0 +1,175 @@
+# SPDX-License-Identifier: ((GPL-2.0 WITH Linux-syscall-note) OR BSD-3-Clause)
+#
+# Author: Aurelien Aptel <aaptel at nvidia.com>
+#
+# Copyright (c) 2023, NVIDIA CORPORATION & AFFILIATES. All rights reserved.
+#
+
+name: ulp_ddp
+
+protocol: genetlink
+
+doc: Netlink protocol to manage ULP DPP on network devices.
+
+definitions:
+ -
+ type: enum
+ name: cap
+ entries:
+ - nvme-tcp
+ - nvme-tcp-ddgst-rx
+
+uapi-header: linux/ulp_ddp_nl.h
+
+attribute-sets:
+ -
+ name: stat
+ attributes:
+ -
+ name: ifindex
+ doc: interface index of the net device.
+ type: u32
+ -
+ name: pad
+ type: pad
+ -
+ name: rx-nvmeotcp-sk-add
+ doc: Sockets successfully configured for NVMeTCP offloading.
+ type: u64
+ -
+ name: rx-nvmeotcp-sk-add-fail
+ doc: Sockets failed to be configured for NVMeTCP offloading.
+ type: u64
+ -
+ name: rx-nvmeotcp-sk-del
+ doc: Sockets with NVMeTCP offloading configuration removed.
+ type: u64
+ -
+ name: rx-nvmeotcp-ddp-setup
+ doc: NVMe-TCP IOs successfully configured for Rx Direct Data Placement.
+ type: u64
+ -
+ name: rx-nvmeotcp-ddp-setup-fail
+ doc: NVMe-TCP IOs failed to be configured for Rx Direct Data Placement.
+ type: u64
+ -
+ name: rx-nvmeotcp-ddp-teardown
+ doc: NVMe-TCP IOs with Rx Direct Data Placement configuration removed.
+ type: u64
+ -
+ name: rx-nvmeotcp-ddp-drop
+ doc: Packets failed the NVMeTCP offload validation.
+ type: u64
+ -
+ name: rx-nvmeotcp-ddp-resync
+ doc: NVMe-TCP resync operations were processed due to Rx TCP packets re-ordering.
+ type: u64
+ -
+ name: rx-nvmeotcp-ddp-packets
+ doc: TCP packets successfully processed by the NVMeTCP offload.
+ type: u64
+ -
+ name: rx-nvmeotcp-ddp-bytes
+ doc: Bytes were successfully processed by the NVMeTCP offload.
+ type: u64
+ -
+ name: dev
+ attributes:
+ -
+ name: ifindex
+ doc: interface index of the net device.
+ type: u32
+ -
+ name: hw
+ doc: bitmask of the capabilities supported by the device.
+ type: u64
+ enum: cap
+ enum-as-flags: true
+ -
+ name: active
+ doc: bitmask of the capabilities currently enabled on the device.
+ type: u64
+ enum: cap
+ enum-as-flags: true
+ -
+ name: wanted
+ doc: new active bit values of the capabilities we want to set on the device.
+ type: u64
+ enum: cap
+ enum-as-flags: true
+ -
+ name: wanted_mask
+ doc: bitmask of the meaningful bits in the wanted field.
+ type: u64
+ enum: cap
+ enum-as-flags: true
+ -
+ name: pad
+ type: pad
+
+operations:
+ list:
+ -
+ name: get
+ doc: Get ULP DDP capabilities.
+ attribute-set: dev
+ do:
+ request:
+ attributes:
+ - ifindex
+ reply:
+ attributes:
+ - ifindex
+ - hw
+ - active
+ pre: ulp_ddp_get_netdev
+ post: ulp_ddp_put_netdev
+ -
+ name: stats
+ doc: Get ULP DDP stats.
+ attribute-set: stat
+ do:
+ request:
+ attributes:
+ - ifindex
+ reply:
+ attributes:
+ - ifindex
+ - rx-nvmeotcp-sk-add
+ - rx-nvmeotcp-sk-add-fail
+ - rx-nvmeotcp-sk-del
+ - rx-nvmeotcp-ddp-setup
+ - rx-nvmeotcp-ddp-setup-fail
+ - rx-nvmeotcp-ddp-teardown
+ - rx-nvmeotcp-ddp-drop
+ - rx-nvmeotcp-ddp-resync
+ - rx-nvmeotcp-ddp-packets
+ - rx-nvmeotcp-ddp-bytes
+ pre: ulp_ddp_get_netdev
+ post: ulp_ddp_put_netdev
+ -
+ name: set
+ doc: Set ULP DDP capabilities.
+ attribute-set: dev
+ do:
+ request:
+ attributes:
+ - ifindex
+ - wanted
+ - wanted_mask
+ reply:
+ attributes:
+ - ifindex
+ - hw
+ - active
+ pre: ulp_ddp_get_netdev
+ post: ulp_ddp_put_netdev
+ -
+ name: set-ntf
+ doc: Notification for change in ULP DDP capabilities.
+ notify: get
+
+mcast-groups:
+ list:
+ -
+ name: mgmt
diff --git a/include/uapi/linux/ulp_ddp_nl.h b/include/uapi/linux/ulp_ddp_nl.h
new file mode 100644
index 000000000000..4e09cb571c6a
--- /dev/null
+++ b/include/uapi/linux/ulp_ddp_nl.h
@@ -0,0 +1,59 @@
+/* SPDX-License-Identifier: ((GPL-2.0 WITH Linux-syscall-note) OR BSD-3-Clause) */
+/* Do not edit directly, auto-generated from: */
+/* Documentation/netlink/specs/ulp_ddp.yaml */
+/* YNL-GEN uapi header */
+
+#ifndef _UAPI_LINUX_ULP_DDP_H
+#define _UAPI_LINUX_ULP_DDP_H
+
+#define ULP_DDP_FAMILY_NAME "ulp_ddp"
+#define ULP_DDP_FAMILY_VERSION 1
+
+enum ulp_ddp_cap {
+ ULP_DDP_CAP_NVME_TCP,
+ ULP_DDP_CAP_NVME_TCP_DDGST_RX,
+};
+
+enum {
+ ULP_DDP_A_STAT_IFINDEX = 1,
+ ULP_DDP_A_STAT_PAD,
+ ULP_DDP_A_STAT_RX_NVMEOTCP_SK_ADD,
+ ULP_DDP_A_STAT_RX_NVMEOTCP_SK_ADD_FAIL,
+ ULP_DDP_A_STAT_RX_NVMEOTCP_SK_DEL,
+ ULP_DDP_A_STAT_RX_NVMEOTCP_DDP_SETUP,
+ ULP_DDP_A_STAT_RX_NVMEOTCP_DDP_SETUP_FAIL,
+ ULP_DDP_A_STAT_RX_NVMEOTCP_DDP_TEARDOWN,
+ ULP_DDP_A_STAT_RX_NVMEOTCP_DDP_DROP,
+ ULP_DDP_A_STAT_RX_NVMEOTCP_DDP_RESYNC,
+ ULP_DDP_A_STAT_RX_NVMEOTCP_DDP_PACKETS,
+ ULP_DDP_A_STAT_RX_NVMEOTCP_DDP_BYTES,
+
+ __ULP_DDP_A_STAT_MAX,
+ ULP_DDP_A_STAT_MAX = (__ULP_DDP_A_STAT_MAX - 1)
+};
+
+enum {
+ ULP_DDP_A_DEV_IFINDEX = 1,
+ ULP_DDP_A_DEV_HW,
+ ULP_DDP_A_DEV_ACTIVE,
+ ULP_DDP_A_DEV_WANTED,
+ ULP_DDP_A_DEV_WANTED_MASK,
+ ULP_DDP_A_DEV_PAD,
+
+ __ULP_DDP_A_DEV_MAX,
+ ULP_DDP_A_DEV_MAX = (__ULP_DDP_A_DEV_MAX - 1)
+};
+
+enum {
+ ULP_DDP_CMD_GET = 1,
+ ULP_DDP_CMD_STATS,
+ ULP_DDP_CMD_SET,
+ ULP_DDP_CMD_SET_NTF,
+
+ __ULP_DDP_CMD_MAX,
+ ULP_DDP_CMD_MAX = (__ULP_DDP_CMD_MAX - 1)
+};
+
+#define ULP_DDP_MCGRP_MGMT "mgmt"
+
+#endif /* _UAPI_LINUX_ULP_DDP_H */
diff --git a/net/core/Makefile b/net/core/Makefile
index 09da9ed3f9ff..35a882e7276d 100644
--- a/net/core/Makefile
+++ b/net/core/Makefile
@@ -18,7 +18,7 @@ obj-y += dev.o dev_addr_lists.o dst.o netevent.o \
obj-$(CONFIG_NETDEV_ADDR_LIST_TEST) += dev_addr_lists_test.o
obj-y += net-sysfs.o
-obj-$(CONFIG_ULP_DDP) += ulp_ddp.o
+obj-$(CONFIG_ULP_DDP) += ulp_ddp.o ulp_ddp_nl.o ulp_ddp_gen_nl.o
obj-$(CONFIG_PAGE_POOL) += page_pool.o
obj-$(CONFIG_PROC_FS) += net-procfs.o
obj-$(CONFIG_NET_PKTGEN) += pktgen.o
diff --git a/net/core/ulp_ddp_gen_nl.c b/net/core/ulp_ddp_gen_nl.c
new file mode 100644
index 000000000000..e56b12d0ca24
--- /dev/null
+++ b/net/core/ulp_ddp_gen_nl.c
@@ -0,0 +1,75 @@
+// SPDX-License-Identifier: ((GPL-2.0 WITH Linux-syscall-note) OR BSD-3-Clause)
+/* Do not edit directly, auto-generated from: */
+/* Documentation/netlink/specs/ulp_ddp.yaml */
+/* YNL-GEN kernel source */
+
+#include <net/netlink.h>
+#include <net/genetlink.h>
+
+#include "ulp_ddp_gen_nl.h"
+
+#include <uapi/linux/ulp_ddp_nl.h>
+
+/* ULP_DDP_CMD_GET - do */
+static const struct nla_policy ulp_ddp_get_nl_policy[ULP_DDP_A_DEV_IFINDEX + 1] = {
+ [ULP_DDP_A_DEV_IFINDEX] = { .type = NLA_U32, },
+};
+
+/* ULP_DDP_CMD_STATS - do */
+static const struct nla_policy ulp_ddp_stats_nl_policy[ULP_DDP_A_STAT_IFINDEX + 1] = {
+ [ULP_DDP_A_STAT_IFINDEX] = { .type = NLA_U32, },
+};
+
+/* ULP_DDP_CMD_SET - do */
+static const struct nla_policy ulp_ddp_set_nl_policy[ULP_DDP_A_DEV_WANTED_MASK + 1] = {
+ [ULP_DDP_A_DEV_IFINDEX] = { .type = NLA_U32, },
+ [ULP_DDP_A_DEV_WANTED] = NLA_POLICY_MASK(NLA_U64, 0x3),
+ [ULP_DDP_A_DEV_WANTED_MASK] = NLA_POLICY_MASK(NLA_U64, 0x3),
+};
+
+/* Ops table for ulp_ddp */
+static const struct genl_split_ops ulp_ddp_nl_ops[] = {
+ {
+ .cmd = ULP_DDP_CMD_GET,
+ .pre_doit = ulp_ddp_get_netdev,
+ .doit = ulp_ddp_nl_get_doit,
+ .post_doit = ulp_ddp_put_netdev,
+ .policy = ulp_ddp_get_nl_policy,
+ .maxattr = ULP_DDP_A_DEV_IFINDEX,
+ .flags = GENL_CMD_CAP_DO,
+ },
+ {
+ .cmd = ULP_DDP_CMD_STATS,
+ .pre_doit = ulp_ddp_get_netdev,
+ .doit = ulp_ddp_nl_stats_doit,
+ .post_doit = ulp_ddp_put_netdev,
+ .policy = ulp_ddp_stats_nl_policy,
+ .maxattr = ULP_DDP_A_STAT_IFINDEX,
+ .flags = GENL_CMD_CAP_DO,
+ },
+ {
+ .cmd = ULP_DDP_CMD_SET,
+ .pre_doit = ulp_ddp_get_netdev,
+ .doit = ulp_ddp_nl_set_doit,
+ .post_doit = ulp_ddp_put_netdev,
+ .policy = ulp_ddp_set_nl_policy,
+ .maxattr = ULP_DDP_A_DEV_WANTED_MASK,
+ .flags = GENL_CMD_CAP_DO,
+ },
+};
+
+static const struct genl_multicast_group ulp_ddp_nl_mcgrps[] = {
+ [ULP_DDP_NLGRP_MGMT] = { "mgmt", },
+};
+
+struct genl_family ulp_ddp_nl_family __ro_after_init = {
+ .name = ULP_DDP_FAMILY_NAME,
+ .version = ULP_DDP_FAMILY_VERSION,
+ .netnsok = true,
+ .parallel_ops = true,
+ .module = THIS_MODULE,
+ .split_ops = ulp_ddp_nl_ops,
+ .n_split_ops = ARRAY_SIZE(ulp_ddp_nl_ops),
+ .mcgrps = ulp_ddp_nl_mcgrps,
+ .n_mcgrps = ARRAY_SIZE(ulp_ddp_nl_mcgrps),
+};
diff --git a/net/core/ulp_ddp_gen_nl.h b/net/core/ulp_ddp_gen_nl.h
new file mode 100644
index 000000000000..fc3be4d155ba
--- /dev/null
+++ b/net/core/ulp_ddp_gen_nl.h
@@ -0,0 +1,30 @@
+/* SPDX-License-Identifier: ((GPL-2.0 WITH Linux-syscall-note) OR BSD-3-Clause) */
+/* Do not edit directly, auto-generated from: */
+/* Documentation/netlink/specs/ulp_ddp.yaml */
+/* YNL-GEN kernel header */
+
+#ifndef _LINUX_ULP_DDP_GEN_H
+#define _LINUX_ULP_DDP_GEN_H
+
+#include <net/netlink.h>
+#include <net/genetlink.h>
+
+#include <uapi/linux/ulp_ddp_nl.h>
+
+int ulp_ddp_get_netdev(const struct genl_split_ops *ops, struct sk_buff *skb,
+ struct genl_info *info);
+void
+ulp_ddp_put_netdev(const struct genl_split_ops *ops, struct sk_buff *skb,
+ struct genl_info *info);
+
+int ulp_ddp_nl_get_doit(struct sk_buff *skb, struct genl_info *info);
+int ulp_ddp_nl_stats_doit(struct sk_buff *skb, struct genl_info *info);
+int ulp_ddp_nl_set_doit(struct sk_buff *skb, struct genl_info *info);
+
+enum {
+ ULP_DDP_NLGRP_MGMT,
+};
+
+extern struct genl_family ulp_ddp_nl_family;
+
+#endif /* _LINUX_ULP_DDP_GEN_H */
diff --git a/net/core/ulp_ddp_nl.c b/net/core/ulp_ddp_nl.c
new file mode 100644
index 000000000000..d6f17d738203
--- /dev/null
+++ b/net/core/ulp_ddp_nl.c
@@ -0,0 +1,343 @@
+// SPDX-License-Identifier: GPL-2.0
+/*
+ * ulp_ddp.c
+ * Author: Aurelien Aptel <aaptel at nvidia.com>
+ * Copyright (c) 2023, NVIDIA CORPORATION & AFFILIATES. All rights reserved.
+ */
+#include <net/ulp_ddp.h>
+#include "ulp_ddp_gen_nl.h"
+
+#define ULP_DDP_STATS_CNT (sizeof(struct netlink_ulp_ddp_stats) / sizeof(u64))
+
+static struct ulp_ddp_netdev_caps *netdev_ulp_ddp_caps(struct net_device *dev)
+{
+#ifdef CONFIG_ULP_DDP
+ return &dev->ulp_ddp_caps;
+#else
+ return NULL;
+#endif
+}
+
+static const struct ulp_ddp_dev_ops *netdev_ulp_ddp_ops(struct net_device *dev)
+{
+#ifdef CONFIG_ULP_DDP
+ return dev->netdev_ops->ulp_ddp_ops;
+#else
+ return NULL;
+#endif
+}
+
+struct reply_data {
+ struct net_device *dev;
+ netdevice_tracker tracker;
+ void *hdr;
+ u32 ifindex;
+ DECLARE_BITMAP(hw, ULP_DDP_C_COUNT);
+ DECLARE_BITMAP(active, ULP_DDP_C_COUNT);
+ struct netlink_ulp_ddp_stats stats;
+};
+
+static size_t reply_size(int cmd)
+{
+ size_t len = 0;
+
+ BUILD_BUG_ON(ULP_DDP_C_COUNT > 64);
+
+ /* ifindex */
+ len += nla_total_size(sizeof(u32));
+
+ switch (cmd) {
+ case ULP_DDP_CMD_GET:
+ case ULP_DDP_CMD_SET:
+ case ULP_DDP_CMD_SET_NTF:
+ /* hw */
+ len += nla_total_size_64bit(sizeof(u64));
+
+ /* active */
+ len += nla_total_size_64bit(sizeof(u64));
+ break;
+ case ULP_DDP_CMD_STATS:
+ /* stats */
+ len += nla_total_size_64bit(sizeof(u64)) * ULP_DDP_STATS_CNT;
+ break;
+ }
+
+ return len;
+}
+
+/* pre_doit */
+int ulp_ddp_get_netdev(const struct genl_split_ops *ops,
+ struct sk_buff *skb, struct genl_info *info)
+{
+ struct reply_data *data;
+
+ if (GENL_REQ_ATTR_CHECK(info, ULP_DDP_A_DEV_IFINDEX))
+ return -EINVAL;
+
+ data = kzalloc(sizeof(*data), GFP_KERNEL);
+ if (!data)
+ return -ENOMEM;
+
+ data->ifindex = nla_get_u32(info->attrs[ULP_DDP_A_DEV_IFINDEX]);
+ data->dev = netdev_get_by_index(genl_info_net(info),
+ data->ifindex,
+ &data->tracker,
+ GFP_KERNEL);
+
+ if (!data->dev) {
+ kfree(data);
+ return -EINVAL;
+ }
+
+ info->user_ptr[0] = data;
+ return 0;
+}
+
+/* post_doit */
+void ulp_ddp_put_netdev(const struct genl_split_ops *ops, struct sk_buff *skb,
+ struct genl_info *info)
+{
+ struct reply_data *data = info->user_ptr[0];
+
+ if (data) {
+ if (data->dev)
+ netdev_put(data->dev, &data->tracker);
+ kfree(data);
+ }
+}
+
+static int prepare_data(struct genl_info *info, struct reply_data *data, int cmd)
+{
+ const struct ulp_ddp_dev_ops *ops = netdev_ulp_ddp_ops(data->dev);
+ struct ulp_ddp_netdev_caps *caps = netdev_ulp_ddp_caps(data->dev);
+
+ if (!caps || !ops)
+ return -EOPNOTSUPP;
+
+ switch (cmd) {
+ case ULP_DDP_CMD_GET:
+ case ULP_DDP_CMD_SET:
+ case ULP_DDP_CMD_SET_NTF:
+ bitmap_copy(data->hw, caps->hw, ULP_DDP_C_COUNT);
+ bitmap_copy(data->active, caps->active, ULP_DDP_C_COUNT);
+ break;
+ case ULP_DDP_CMD_STATS:
+ ops->get_stats(data->dev, &data->stats);
+ break;
+ }
+
+ return 0;
+}
+
+static int fill_data(struct sk_buff *rsp, struct reply_data *data, int cmd,
+ u32 portid, u32 seq, int flags)
+{
+ u64 *val = (u64 *)&data->stats;
+ int attr, i;
+
+ data->hdr = genlmsg_put(rsp, portid, seq, &ulp_ddp_nl_family, flags, cmd);
+ if (!data->hdr)
+ return -EMSGSIZE;
+
+ switch (cmd) {
+ case ULP_DDP_CMD_GET:
+ case ULP_DDP_CMD_SET:
+ case ULP_DDP_CMD_SET_NTF:
+ if (nla_put_u32(rsp, ULP_DDP_A_DEV_IFINDEX, data->ifindex) ||
+ nla_put_u64_64bit(rsp, ULP_DDP_A_DEV_HW,
+ data->hw[0], ULP_DDP_A_DEV_PAD) ||
+ nla_put_u64_64bit(rsp, ULP_DDP_A_DEV_ACTIVE,
+ data->active[0], ULP_DDP_A_DEV_PAD))
+ goto err_cancel_msg;
+ break;
+ case ULP_DDP_CMD_STATS:
+ if (nla_put_u32(rsp, ULP_DDP_A_STAT_IFINDEX, data->ifindex))
+ goto err_cancel_msg;
+
+ attr = ULP_DDP_A_STAT_PAD + 1;
+ for (i = 0; i < ULP_DDP_STATS_CNT; i++, attr++)
+ if (nla_put_u64_64bit(rsp, attr, val[i],
+ ULP_DDP_A_STAT_PAD))
+ goto err_cancel_msg;
+ }
+ genlmsg_end(rsp, data->hdr);
+
+ return 0;
+
+err_cancel_msg:
+ genlmsg_cancel(rsp, data->hdr);
+
+ return -EMSGSIZE;
+}
+
+int ulp_ddp_nl_get_doit(struct sk_buff *req, struct genl_info *info)
+{
+ struct reply_data *data = info->user_ptr[0];
+ struct sk_buff *rsp;
+ int ret = 0;
+
+ ret = prepare_data(info, data, ULP_DDP_CMD_GET);
+ if (ret)
+ return ret;
+
+ rsp = genlmsg_new(reply_size(ULP_DDP_CMD_GET), GFP_KERNEL);
+ if (!rsp)
+ return -EMSGSIZE;
+
+ ret = fill_data(rsp, data, ULP_DDP_CMD_GET, info->snd_portid, info->snd_seq, 0);
+ if (ret < 0)
+ goto err_rsp;
+
+ return genlmsg_reply(rsp, info);
+
+err_rsp:
+ nlmsg_free(rsp);
+ return ret;
+}
+
+void ulp_ddp_nl_notify_dev(struct reply_data *data)
+{
+ struct sk_buff *ntf;
+
+ if (!genl_has_listeners(&ulp_ddp_nl_family, dev_net(data->dev),
+ ULP_DDP_NLGRP_MGMT))
+ return;
+
+ ntf = genlmsg_new(reply_size(ULP_DDP_CMD_GET), GFP_KERNEL);
+ if (!ntf)
+ return;
+
+ if (fill_data(ntf, data, ULP_DDP_CMD_SET_NTF, 0, 0, 0)) {
+ nlmsg_free(ntf);
+ return;
+ }
+
+ genlmsg_multicast_netns(&ulp_ddp_nl_family, dev_net(data->dev), ntf,
+ 0, ULP_DDP_NLGRP_MGMT, GFP_KERNEL);
+}
+
+static int apply_bits(struct reply_data *data,
+ unsigned long *req_wanted,
+ unsigned long *req_mask,
+ struct netlink_ext_ack *extack)
+{
+ DECLARE_BITMAP(old_active, ULP_DDP_C_COUNT);
+ DECLARE_BITMAP(new_active, ULP_DDP_C_COUNT);
+ DECLARE_BITMAP(all_bits, ULP_DDP_C_COUNT);
+ DECLARE_BITMAP(tmp, ULP_DDP_C_COUNT);
+ const struct ulp_ddp_dev_ops *ops;
+ struct ulp_ddp_netdev_caps *caps;
+ int ret;
+
+ caps = netdev_ulp_ddp_caps(data->dev);
+ ops = netdev_ulp_ddp_ops(data->dev);
+
+ if (!ops || !caps)
+ return -EOPNOTSUPP;
+
+ /* if (req_mask & ~all_bits) */
+ bitmap_fill(all_bits, ULP_DDP_C_COUNT);
+ bitmap_andnot(tmp, req_mask, all_bits, ULP_DDP_C_COUNT);
+ if (!bitmap_empty(tmp, ULP_DDP_C_COUNT))
+ return -EINVAL;
+
+ /* new_active = (old_active & ~req_mask) | (wanted & req_mask)
+ * new_active &= caps_hw
+ */
+ bitmap_copy(old_active, caps->active, ULP_DDP_C_COUNT);
+ bitmap_and(req_wanted, req_wanted, req_mask, ULP_DDP_C_COUNT);
+ bitmap_andnot(new_active, old_active, req_mask, ULP_DDP_C_COUNT);
+ bitmap_or(new_active, new_active, req_wanted, ULP_DDP_C_COUNT);
+ bitmap_and(new_active, new_active, caps->hw, ULP_DDP_C_COUNT);
+ if (!bitmap_equal(old_active, new_active, ULP_DDP_C_COUNT)) {
+ ret = ops->set_caps(data->dev, new_active, extack);
+ if (ret < 0)
+ return ret;
+ bitmap_copy(new_active, caps->active, ULP_DDP_C_COUNT);
+ }
+
+ /* return 1 to notify */
+ return !bitmap_equal(old_active, new_active, ULP_DDP_C_COUNT);
+}
+
+int ulp_ddp_nl_set_doit(struct sk_buff *skb, struct genl_info *info)
+{
+ struct reply_data *data = info->user_ptr[0];
+ unsigned long wanted, wanted_mask;
+ struct sk_buff *rsp;
+ bool notify;
+ int ret;
+
+ if (GENL_REQ_ATTR_CHECK(info, ULP_DDP_A_DEV_WANTED) ||
+ GENL_REQ_ATTR_CHECK(info, ULP_DDP_A_DEV_WANTED_MASK))
+ return -EINVAL;
+
+ rsp = genlmsg_new(reply_size(ULP_DDP_CMD_STATS), GFP_KERNEL);
+ if (!rsp)
+ return -EMSGSIZE;
+
+ wanted = nla_get_u64(info->attrs[ULP_DDP_A_DEV_WANTED]);
+ wanted_mask = nla_get_u64(info->attrs[ULP_DDP_A_DEV_WANTED_MASK]);
+
+ ret = apply_bits(data, &wanted, &wanted_mask, info->extack);
+ if (ret < 0)
+ return ret;
+
+ notify = !!ret;
+ ret = prepare_data(info, data, ULP_DDP_CMD_SET);
+ if (ret)
+ return ret;
+
+ ret = fill_data(rsp, data, ULP_DDP_CMD_SET, info->snd_portid, info->snd_seq, 0);
+ if (ret < 0)
+ goto err_rsp;
+
+ ret = genlmsg_reply(rsp, info);
+ if (notify)
+ ulp_ddp_nl_notify_dev(data);
+
+ return ret;
+
+err_rsp:
+ nlmsg_free(rsp);
+
+ return ret;
+}
+
+int ulp_ddp_nl_stats_doit(struct sk_buff *skb, struct genl_info *info)
+{
+ struct reply_data *data = info->user_ptr[0];
+ struct sk_buff *rsp;
+ int ret = 0;
+
+ ret = prepare_data(info, data, ULP_DDP_CMD_STATS);
+ if (ret)
+ return ret;
+
+ rsp = genlmsg_new(reply_size(ULP_DDP_CMD_STATS), GFP_KERNEL);
+ if (!rsp)
+ return -EMSGSIZE;
+
+ ret = fill_data(rsp, data, ULP_DDP_CMD_STATS, info->snd_portid, info->snd_seq, 0);
+ if (ret < 0)
+ goto err_rsp;
+
+ return genlmsg_reply(rsp, info);
+
+err_rsp:
+ nlmsg_free(rsp);
+ return ret;
+}
+
+static int __init ulp_ddp_init(void)
+{
+ int err;
+
+ err = genl_register_family(&ulp_ddp_nl_family);
+ if (err)
+ return err;
+
+ return 0;
+}
+
+subsys_initcall(ulp_ddp_init);
--
2.34.1
More information about the Linux-nvme
mailing list