mirror of
https://github.com/torvalds/linux.git
synced 2026-07-28 01:55:51 +02:00
net: enetc: move VF message handlers to enetc_msg.c
Move enetc_msg_pf_set_vf_primary_mac_addr() and enetc_msg_handle_rxmsg() to enetc_msg.c to consolidate VF mailbox message handling logic. Make enetc_msg_handle_rxmsg() static since it's only called from enetc_msg_task() within the same file. This prepares for integrating enetc_msg.c into the enetc-pf-common driver to be shared between ENETC v1 and v4 PF drivers. Signed-off-by: Wei Fang <wei.fang@nxp.com> Link: https://patch.msgid.link/20260522092438.1264020-3-wei.fang@nxp.com Signed-off-by: Paolo Abeni <pabeni@redhat.com>
This commit is contained in:
parent
443a573e79
commit
9ba01f8770
|
|
@ -1,7 +1,7 @@
|
|||
// SPDX-License-Identifier: (GPL-2.0+ OR BSD-3-Clause)
|
||||
/* Copyright 2017-2019 NXP */
|
||||
|
||||
#include "enetc_pf.h"
|
||||
#include "enetc_pf_common.h"
|
||||
|
||||
static void enetc_msg_disable_mr_int(struct enetc_pf *pf)
|
||||
{
|
||||
|
|
@ -35,6 +35,82 @@ static irqreturn_t enetc_msg_psi_msix(int irq, void *data)
|
|||
return IRQ_HANDLED;
|
||||
}
|
||||
|
||||
/* Messaging */
|
||||
static u16 enetc_msg_pf_set_vf_primary_mac_addr(struct enetc_pf *pf,
|
||||
int vf_id, void *msg)
|
||||
{
|
||||
struct enetc_vf_state *vf_state = &pf->vf_state[vf_id];
|
||||
struct enetc_msg_cmd_set_primary_mac *cmd = msg;
|
||||
struct device *dev = &pf->si->pdev->dev;
|
||||
u16 cmd_id = cmd->header.id;
|
||||
char *addr;
|
||||
|
||||
if (cmd_id != ENETC_MSG_CMD_MNG_ADD)
|
||||
return ENETC_MSG_CMD_STATUS_FAIL;
|
||||
|
||||
addr = cmd->mac.sa_data;
|
||||
if (!is_valid_ether_addr(addr)) {
|
||||
dev_err_ratelimited(dev, "VF%d attempted to set invalid MAC\n",
|
||||
vf_id);
|
||||
return ENETC_MSG_CMD_STATUS_FAIL;
|
||||
}
|
||||
|
||||
mutex_lock(&vf_state->lock);
|
||||
if (vf_state->flags & ENETC_VF_FLAG_PF_SET_MAC) {
|
||||
mutex_unlock(&vf_state->lock);
|
||||
dev_err_ratelimited(dev,
|
||||
"VF%d attempted to override PF set MAC\n",
|
||||
vf_id);
|
||||
return ENETC_MSG_CMD_STATUS_FAIL;
|
||||
}
|
||||
|
||||
enetc_set_si_hw_addr(pf, vf_id + 1, addr);
|
||||
mutex_unlock(&vf_state->lock);
|
||||
|
||||
return ENETC_MSG_CMD_STATUS_OK;
|
||||
}
|
||||
|
||||
static void enetc_msg_handle_rxmsg(struct enetc_pf *pf, int vf_id,
|
||||
u16 *status)
|
||||
{
|
||||
struct enetc_msg_swbd *msg_swbd = &pf->rxmsg[vf_id];
|
||||
struct device *dev = &pf->si->pdev->dev;
|
||||
struct enetc_msg_cmd_header *cmd_hdr;
|
||||
u16 cmd_type;
|
||||
u8 *msg;
|
||||
|
||||
msg = kzalloc_objs(*msg, msg_swbd->size);
|
||||
if (!msg) {
|
||||
dev_err_ratelimited(dev,
|
||||
"Failed to allocate message buffer\n");
|
||||
*status = ENETC_MSG_CMD_STATUS_FAIL;
|
||||
return;
|
||||
}
|
||||
|
||||
/* Currently, only ENETC_MSG_CMD_MNG_MAC command is supported, so
|
||||
* only sizeof(struct enetc_msg_cmd_set_primary_mac) bytes need to
|
||||
* be copied. This data already includes the cmd_type field, so it
|
||||
* can correctly return an error code.
|
||||
*/
|
||||
memcpy(msg, msg_swbd->vaddr,
|
||||
sizeof(struct enetc_msg_cmd_set_primary_mac));
|
||||
cmd_hdr = (struct enetc_msg_cmd_header *)msg;
|
||||
cmd_type = cmd_hdr->type;
|
||||
|
||||
switch (cmd_type) {
|
||||
case ENETC_MSG_CMD_MNG_MAC:
|
||||
*status = enetc_msg_pf_set_vf_primary_mac_addr(pf, vf_id, msg);
|
||||
break;
|
||||
default:
|
||||
*status = ENETC_MSG_CMD_STATUS_FAIL;
|
||||
dev_err_ratelimited(dev,
|
||||
"command not supported (cmd_type: 0x%x)\n",
|
||||
cmd_type);
|
||||
}
|
||||
|
||||
kfree(msg);
|
||||
}
|
||||
|
||||
static void enetc_msg_task(struct work_struct *work)
|
||||
{
|
||||
struct enetc_pf *pf = container_of(work, struct enetc_pf, msg_task);
|
||||
|
|
|
|||
|
|
@ -480,81 +480,6 @@ static void enetc_configure_port(struct enetc_pf *pf)
|
|||
enetc_port_wr(hw, ENETC_PMR, ENETC_PMR_EN);
|
||||
}
|
||||
|
||||
/* Messaging */
|
||||
static u16 enetc_msg_pf_set_vf_primary_mac_addr(struct enetc_pf *pf,
|
||||
int vf_id, void *msg)
|
||||
{
|
||||
struct enetc_vf_state *vf_state = &pf->vf_state[vf_id];
|
||||
struct enetc_msg_cmd_set_primary_mac *cmd = msg;
|
||||
struct device *dev = &pf->si->pdev->dev;
|
||||
u16 cmd_id = cmd->header.id;
|
||||
char *addr;
|
||||
|
||||
if (cmd_id != ENETC_MSG_CMD_MNG_ADD)
|
||||
return ENETC_MSG_CMD_STATUS_FAIL;
|
||||
|
||||
addr = cmd->mac.sa_data;
|
||||
if (!is_valid_ether_addr(addr)) {
|
||||
dev_err_ratelimited(dev, "VF%d attempted to set invalid MAC\n",
|
||||
vf_id);
|
||||
return ENETC_MSG_CMD_STATUS_FAIL;
|
||||
}
|
||||
|
||||
mutex_lock(&vf_state->lock);
|
||||
if (vf_state->flags & ENETC_VF_FLAG_PF_SET_MAC) {
|
||||
mutex_unlock(&vf_state->lock);
|
||||
dev_err_ratelimited(dev,
|
||||
"VF%d attempted to override PF set MAC\n",
|
||||
vf_id);
|
||||
return ENETC_MSG_CMD_STATUS_FAIL;
|
||||
}
|
||||
|
||||
enetc_set_si_hw_addr(pf, vf_id + 1, addr);
|
||||
mutex_unlock(&vf_state->lock);
|
||||
|
||||
return ENETC_MSG_CMD_STATUS_OK;
|
||||
}
|
||||
|
||||
void enetc_msg_handle_rxmsg(struct enetc_pf *pf, int vf_id, u16 *status)
|
||||
{
|
||||
struct enetc_msg_swbd *msg_swbd = &pf->rxmsg[vf_id];
|
||||
struct device *dev = &pf->si->pdev->dev;
|
||||
struct enetc_msg_cmd_header *cmd_hdr;
|
||||
u16 cmd_type;
|
||||
u8 *msg;
|
||||
|
||||
msg = kzalloc_objs(*msg, msg_swbd->size);
|
||||
if (!msg) {
|
||||
dev_err_ratelimited(dev,
|
||||
"Failed to allocate message buffer\n");
|
||||
*status = ENETC_MSG_CMD_STATUS_FAIL;
|
||||
return;
|
||||
}
|
||||
|
||||
/* Currently, only ENETC_MSG_CMD_MNG_MAC command is supported, so
|
||||
* only sizeof(struct enetc_msg_cmd_set_primary_mac) bytes need to
|
||||
* be copied. This data already includes the cmd_type field, so it
|
||||
* can correctly return an error code.
|
||||
*/
|
||||
memcpy(msg, msg_swbd->vaddr,
|
||||
sizeof(struct enetc_msg_cmd_set_primary_mac));
|
||||
cmd_hdr = (struct enetc_msg_cmd_header *)msg;
|
||||
cmd_type = cmd_hdr->type;
|
||||
|
||||
switch (cmd_type) {
|
||||
case ENETC_MSG_CMD_MNG_MAC:
|
||||
*status = enetc_msg_pf_set_vf_primary_mac_addr(pf, vf_id, msg);
|
||||
break;
|
||||
default:
|
||||
*status = ENETC_MSG_CMD_STATUS_FAIL;
|
||||
dev_err_ratelimited(dev,
|
||||
"command not supported (cmd_type: 0x%x)\n",
|
||||
cmd_type);
|
||||
}
|
||||
|
||||
kfree(msg);
|
||||
}
|
||||
|
||||
#ifdef CONFIG_PCI_IOV
|
||||
static int enetc_sriov_configure(struct pci_dev *pdev, int num_vfs)
|
||||
{
|
||||
|
|
|
|||
|
|
@ -71,4 +71,3 @@ struct enetc_pf {
|
|||
|
||||
int enetc_msg_psi_init(struct enetc_pf *pf);
|
||||
void enetc_msg_psi_free(struct enetc_pf *pf);
|
||||
void enetc_msg_handle_rxmsg(struct enetc_pf *pf, int mbox_id, u16 *status);
|
||||
|
|
|
|||
Loading…
Reference in New Issue
Block a user