175 lines
4.5 KiB
Diff
175 lines
4.5 KiB
Diff
From fdb457a0ebb57c99fb987d0e34b2549f10dd4161 Mon Sep 17 00:00:00 2001
|
|
From: Ido Schimmel <idosch@nvidia.com>
|
|
Date: Tue, 12 Oct 2021 16:25:21 +0300
|
|
Subject: [PATCH 22/35] netlink: eeprom: Export a function to request an EEPROM
|
|
page
|
|
|
|
The function will be used by the EEPROM parsing code (e.g., cmis.c) to
|
|
request a specific page for parsing.
|
|
|
|
All the data buffers used to store EEPROM page contents are stored on a
|
|
linked list that is flushed on exit. This relieves callers from the need
|
|
to explicitly free the requested pages.
|
|
|
|
Signed-off-by: Ido Schimmel <idosch@nvidia.com>
|
|
---
|
|
netlink/extapi.h | 11 +++++
|
|
netlink/module-eeprom.c | 105 ++++++++++++++++++++++++++++++++++++++++
|
|
2 files changed, 116 insertions(+)
|
|
|
|
diff --git a/netlink/extapi.h b/netlink/extapi.h
|
|
index 91bf02b5e3be..129e2931d01d 100644
|
|
--- a/netlink/extapi.h
|
|
+++ b/netlink/extapi.h
|
|
@@ -48,6 +48,9 @@ int nl_getmodule(struct cmd_context *ctx);
|
|
|
|
void nl_monitor_usage(void);
|
|
|
|
+int nl_get_eeprom_page(struct cmd_context *ctx,
|
|
+ struct ethtool_module_eeprom *request);
|
|
+
|
|
#else /* ETHTOOL_ENABLE_NETLINK */
|
|
|
|
static inline void netlink_run_handler(struct cmd_context *ctx __maybe_unused,
|
|
@@ -73,6 +76,14 @@ static inline void nl_monitor_usage(void)
|
|
{
|
|
}
|
|
|
|
+static inline int
|
|
+nl_get_eeprom_page(struct cmd_context *ctx __maybe_unused,
|
|
+ struct ethtool_module_eeprom *request __maybe_unused)
|
|
+{
|
|
+ fprintf(stderr, "Netlink not supported by ethtool.\n");
|
|
+ return -EOPNOTSUPP;
|
|
+}
|
|
+
|
|
#define nl_gset NULL
|
|
#define nl_sset NULL
|
|
#define nl_permaddr NULL
|
|
diff --git a/netlink/module-eeprom.c b/netlink/module-eeprom.c
|
|
index 101d5943c2bc..ee5508840157 100644
|
|
--- a/netlink/module-eeprom.c
|
|
+++ b/netlink/module-eeprom.c
|
|
@@ -341,6 +341,110 @@ static void decoder_print(void)
|
|
}
|
|
#endif
|
|
|
|
+static struct list_head eeprom_page_list = LIST_HEAD_INIT(eeprom_page_list);
|
|
+
|
|
+struct eeprom_page_entry {
|
|
+ struct list_head list; /* Member of eeprom_page_list */
|
|
+ void *data;
|
|
+};
|
|
+
|
|
+static int eeprom_page_list_add(void *data)
|
|
+{
|
|
+ struct eeprom_page_entry *entry;
|
|
+
|
|
+ entry = malloc(sizeof(*entry));
|
|
+ if (!entry)
|
|
+ return -ENOMEM;
|
|
+
|
|
+ entry->data = data;
|
|
+ list_add(&entry->list, &eeprom_page_list);
|
|
+
|
|
+ return 0;
|
|
+}
|
|
+
|
|
+static void eeprom_page_list_flush(void)
|
|
+{
|
|
+ struct eeprom_page_entry *entry;
|
|
+ struct list_head *head, *next;
|
|
+
|
|
+ list_for_each_safe(head, next, &eeprom_page_list) {
|
|
+ entry = (struct eeprom_page_entry *) head;
|
|
+ free(entry->data);
|
|
+ list_del(head);
|
|
+ free(entry);
|
|
+ }
|
|
+}
|
|
+
|
|
+static int get_eeprom_page_reply_cb(const struct nlmsghdr *nlhdr, void *data)
|
|
+{
|
|
+ const struct nlattr *tb[ETHTOOL_A_MODULE_EEPROM_DATA + 1] = {};
|
|
+ struct ethtool_module_eeprom *request = data;
|
|
+ DECLARE_ATTR_TB_INFO(tb);
|
|
+ u8 *eeprom_data;
|
|
+ int ret;
|
|
+
|
|
+ ret = mnl_attr_parse(nlhdr, GENL_HDRLEN, attr_cb, &tb_info);
|
|
+ if (ret < 0)
|
|
+ return ret;
|
|
+
|
|
+ if (!tb[ETHTOOL_A_MODULE_EEPROM_DATA])
|
|
+ return MNL_CB_ERROR;
|
|
+
|
|
+ eeprom_data = mnl_attr_get_payload(tb[ETHTOOL_A_MODULE_EEPROM_DATA]);
|
|
+ request->data = malloc(request->length);
|
|
+ if (!request->data)
|
|
+ return MNL_CB_ERROR;
|
|
+ memcpy(request->data, eeprom_data, request->length);
|
|
+
|
|
+ ret = eeprom_page_list_add(request->data);
|
|
+ if (ret < 0)
|
|
+ goto err_list_add;
|
|
+
|
|
+ return MNL_CB_OK;
|
|
+
|
|
+err_list_add:
|
|
+ free(request->data);
|
|
+ return MNL_CB_ERROR;
|
|
+}
|
|
+
|
|
+int nl_get_eeprom_page(struct cmd_context *ctx,
|
|
+ struct ethtool_module_eeprom *request)
|
|
+{
|
|
+ struct nl_context *nlctx = ctx->nlctx;
|
|
+ struct nl_socket *nlsock;
|
|
+ struct nl_msg_buff *msg;
|
|
+ int ret;
|
|
+
|
|
+ if (!request || request->i2c_address > ETH_I2C_MAX_ADDRESS)
|
|
+ return -EINVAL;
|
|
+
|
|
+ nlsock = nlctx->ethnl_socket;
|
|
+ msg = &nlsock->msgbuff;
|
|
+
|
|
+ ret = nlsock_prep_get_request(nlsock, ETHTOOL_MSG_MODULE_EEPROM_GET,
|
|
+ ETHTOOL_A_MODULE_EEPROM_HEADER, 0);
|
|
+ if (ret < 0)
|
|
+ return ret;
|
|
+
|
|
+ if (ethnla_put_u32(msg, ETHTOOL_A_MODULE_EEPROM_LENGTH,
|
|
+ request->length) ||
|
|
+ ethnla_put_u32(msg, ETHTOOL_A_MODULE_EEPROM_OFFSET,
|
|
+ request->offset) ||
|
|
+ ethnla_put_u8(msg, ETHTOOL_A_MODULE_EEPROM_PAGE,
|
|
+ request->page) ||
|
|
+ ethnla_put_u8(msg, ETHTOOL_A_MODULE_EEPROM_BANK,
|
|
+ request->bank) ||
|
|
+ ethnla_put_u8(msg, ETHTOOL_A_MODULE_EEPROM_I2C_ADDRESS,
|
|
+ request->i2c_address))
|
|
+ return -EMSGSIZE;
|
|
+
|
|
+ ret = nlsock_sendmsg(nlsock, NULL);
|
|
+ if (ret < 0)
|
|
+ return ret;
|
|
+ return nlsock_process_reply(nlsock, get_eeprom_page_reply_cb,
|
|
+ (void *)request);
|
|
+}
|
|
+
|
|
int nl_getmodule(struct cmd_context *ctx)
|
|
{
|
|
struct cmd_params getmodule_cmd_params = {};
|
|
@@ -425,6 +529,7 @@ int nl_getmodule(struct cmd_context *ctx)
|
|
}
|
|
|
|
cleanup:
|
|
+ eeprom_page_list_flush();
|
|
cache_free();
|
|
return ret;
|
|
}
|
|
--
|
|
2.35.1
|
|
|