[PATCH net-next 04/15] net: enetc: add link speed message support to PF driver
From: <hidden>
Date: 2026-06-05 07:23:21
Also in:
imx, lkml
Subsystem:
freescale enetc ethernet drivers, networking drivers, the rest · Maintainers:
Claudiu Manoil, Vladimir Oltean, Wei Fang, Clark Wang, Andrew Lunn, "David S. Miller", Eric Dumazet, Jakub Kicinski, Paolo Abeni, Linus Torvalds
From: Wei Fang <wei.fang@nxp.com> When a VF is driven by DPDK, the VF relies on the PF to provide accurate link speed information so that the VF-side user space application can make correct forwarding and configuration decisions. Therefore, add link speed message support for DPDK-owned VF. The PF will reply the current link speed when it receives the get link speed message from VF. With this enhancement, VFs controlled by DPDK can obtain real-time link speed information from the PF, improving overall link state visibility, synchronization between PF/VF, and enabling more accurate performance adjustments in VF-side applications. Note that currently the link speed change notification is not supported. Signed-off-by: Wei Fang <wei.fang@nxp.com> --- .../ethernet/freescale/enetc/enetc_mailbox.h | 29 +++++++ .../net/ethernet/freescale/enetc/enetc_msg.c | 77 +++++++++++++++++++ 2 files changed, 106 insertions(+)
diff --git a/drivers/net/ethernet/freescale/enetc/enetc_mailbox.h b/drivers/net/ethernet/freescale/enetc/enetc_mailbox.h
index 43b9ee2ab3e4..44c8196accaa 100644
--- a/drivers/net/ethernet/freescale/enetc/enetc_mailbox.h
+++ b/drivers/net/ethernet/freescale/enetc/enetc_mailbox.h@@ -108,6 +108,7 @@ enum enetc_msg_class_id { /* Common Class ID for PSI-to-VSI and VSI-to-PSI messages */ ENETC_MSG_CLASS_ID_MAC_FILTER = 0x20, ENETC_MSG_CLASS_ID_LINK_STATUS = 0x80, + ENETC_MSG_CLASS_ID_LINK_SPEED, ENETC_MSG_CLASS_ID_IP_REVISION = 0xf0, };
@@ -125,6 +126,13 @@ enum enetc_msg_link_status_cmd_id { ENETC_MSG_UNREGISTER_LINK_CHANGE_NOTIFIER, }; +enum enetc_msg_link_speed_cmd_id { + ENETC_MSG_GET_CURRENT_LINK_SPEED, + /* The following command IDs are not currently supported */ + ENETC_MSG_REGISTER_SPEED_CHANGE_NOTIFIER, + ENETC_MSG_UNREGISTER_SPEED_CHANGE_NOTIFIER, +}; + /* Class-specific error return codes of MAC filter */ enum enetc_mac_filter_class_code { ENETC_MF_CLASS_CODE_INVALID_MAC,
@@ -136,6 +144,22 @@ enum enetc_link_status_class_code { ENETC_LINK_STATUS_CLASS_CODE_DOWN, }; +/* Class-specific notifcaitons/codes of link speed */ +enum enetc_link_speed_class_code { + ENETC_MSG_SPEED_UNKNOWN, + ENETC_MSG_SPEED_10M_HD, + ENETC_MSG_SPEED_10M_FD, + ENETC_MSG_SPEED_100M_HD, + ENETC_MSG_SPEED_100M_FD, + ENETC_MSG_SPEED_1000M, + ENETC_MSG_SPEED_2500M, + ENETC_MSG_SPEED_5G, + ENETC_MSG_SPEED_10G, + ENETC_MSG_SPEED_25G, + ENETC_MSG_SPEED_50G, + ENETC_MSG_SPEED_100G, +}; + struct enetc_msg_swbd { void *vaddr; dma_addr_t dma;
@@ -179,6 +203,11 @@ struct enetc_msg_mac_exact_filter { * cmd_id 0x0: get the current link status * cmd_id 0x1: register link status change notification * cmd_id 0x2: unregister link status change notification + * + * Link speed message, class_id 0x81. + * cmd_id 0x0: get the current link speed. + * cmd_id 0x1: register link speed change notification + * cmd_id 0x2: unregister link speed change notification */ struct enetc_msg_generic { struct enetc_msg_header hdr;
diff --git a/drivers/net/ethernet/freescale/enetc/enetc_msg.c b/drivers/net/ethernet/freescale/enetc/enetc_msg.c
index c93b4e6913d8..49c1ca14735c 100644
--- a/drivers/net/ethernet/freescale/enetc/enetc_msg.c
+++ b/drivers/net/ethernet/freescale/enetc/enetc_msg.c@@ -9,6 +9,7 @@ ENETC_MSG_CLASS_ID_CMD_NOT_SUPPORT) #define ENETC_PF_MSG_PERM_DENY FIELD_PREP(ENETC_PF_MSG_CLASS_ID, \ ENETC_MSG_CLASS_ID_PERMISSION_DENY) +#define ENETC_PF_MSG_SPEED(s) FIELD_PREP(ENETC_PF_MSG_CLASS_CODE, (s)) static void enetc_msg_disable_mr_int(struct enetc_pf *pf) {
@@ -235,6 +236,79 @@ static u16 enetc_msg_handle_link_status(struct enetc_pf *pf, int vf_id, } } +static u16 enetc_msg_get_link_speed(struct enetc_pf *pf) +{ + struct enetc_ndev_priv *priv = netdev_priv(pf->si->ndev); + struct ethtool_link_ksettings link_info = {}; + u16 pf_msg; + + pf_msg = FIELD_PREP(ENETC_PF_MSG_CLASS_ID, + ENETC_MSG_CLASS_ID_LINK_SPEED); + + rtnl_lock(); + if (phylink_ethtool_ksettings_get(priv->phylink, &link_info)) { + pf_msg |= ENETC_PF_MSG_SPEED(ENETC_MSG_SPEED_UNKNOWN); + rtnl_unlock(); + + return pf_msg; + } + rtnl_unlock(); + + switch (link_info.base.speed) { + case SPEED_10: + if (link_info.base.duplex == DUPLEX_HALF) + pf_msg |= ENETC_PF_MSG_SPEED(ENETC_MSG_SPEED_10M_HD); + else + pf_msg |= ENETC_PF_MSG_SPEED(ENETC_MSG_SPEED_10M_FD); + break; + case SPEED_100: + if (link_info.base.duplex == DUPLEX_HALF) + pf_msg |= ENETC_PF_MSG_SPEED(ENETC_MSG_SPEED_100M_HD); + else + pf_msg |= ENETC_PF_MSG_SPEED(ENETC_MSG_SPEED_100M_FD); + break; + case SPEED_1000: + pf_msg |= ENETC_PF_MSG_SPEED(ENETC_MSG_SPEED_1000M); + break; + case SPEED_2500: + pf_msg |= ENETC_PF_MSG_SPEED(ENETC_MSG_SPEED_2500M); + break; + case SPEED_5000: + pf_msg |= ENETC_PF_MSG_SPEED(ENETC_MSG_SPEED_5G); + break; + case SPEED_10000: + pf_msg |= ENETC_PF_MSG_SPEED(ENETC_MSG_SPEED_10G); + break; + case SPEED_25000: + pf_msg |= ENETC_PF_MSG_SPEED(ENETC_MSG_SPEED_25G); + break; + case SPEED_50000: + pf_msg |= ENETC_PF_MSG_SPEED(ENETC_MSG_SPEED_50G); + break; + case SPEED_100000: + pf_msg |= ENETC_PF_MSG_SPEED(ENETC_MSG_SPEED_100G); + break; + default: + pf_msg |= ENETC_PF_MSG_SPEED(ENETC_MSG_SPEED_UNKNOWN); + } + + return pf_msg; +} + +static u16 enetc_msg_handle_link_speed(struct enetc_pf *pf, void *vf_msg) +{ + struct enetc_msg_header *msg_hdr = vf_msg; + + switch (msg_hdr->cmd_id) { + case ENETC_MSG_GET_CURRENT_LINK_SPEED: + return enetc_msg_get_link_speed(pf); + case ENETC_MSG_REGISTER_SPEED_CHANGE_NOTIFIER: + case ENETC_MSG_UNREGISTER_SPEED_CHANGE_NOTIFIER: + default: + return ENETC_PF_MSG_NOTSUPP; + } +} + static void enetc_msg_handle_rxmsg(struct enetc_pf *pf, int vf_id, u16 *pf_msg) {
@@ -313,6 +387,9 @@ static void enetc_msg_handle_rxmsg(struct enetc_pf *pf, int vf_id, case ENETC_MSG_CLASS_ID_LINK_STATUS: *pf_msg = enetc_msg_handle_link_status(pf, vf_id, msg); break; + case ENETC_MSG_CLASS_ID_LINK_SPEED: + *pf_msg = enetc_msg_handle_link_speed(pf, msg); + break; default: dev_err_ratelimited(dev, "Unsupported message class ID: 0x%x\n",
--
2.34.1