Messages in this thread | | | From | <> | Subject | RE: [PATCH net-next v3 1/2] net/ncsi: Add NCSI Broadcom OEM command | Date | Thu, 11 Oct 2018 23:21:06 +0000 |
| |
Hi Vijay,
Please order all local variable declarations from longest to shortest line as instructed by Dave.
Thanks, Justin
> This patch adds OEM Broadcom commands and response handling. It also > defines OEM Get MAC Address handler to get and configure the device. > > ncsi_oem_gma_handler_bcm: This handler send NCSI broadcom command for > getting mac address. > ncsi_rsp_handler_oem_bcm: This handles response received for all > broadcom OEM commands. > ncsi_rsp_handler_oem_bcm_gma: This handles get mac address response and > set it to device. > > Signed-off-by: Vijay Khemka <vijaykhemka@fb.com> > --- > net/ncsi/Kconfig | 6 ++++ > net/ncsi/internal.h | 8 +++++ > net/ncsi/ncsi-manage.c | 70 ++++++++++++++++++++++++++++++++++++++++++ > net/ncsi/ncsi-pkt.h | 8 +++++ > net/ncsi/ncsi-rsp.c | 40 +++++++++++++++++++++++- > 5 files changed, 131 insertions(+), 1 deletion(-) > > diff --git a/net/ncsi/Kconfig b/net/ncsi/Kconfig > index 08a8a6031fd7..7f2b46108a24 100644 > --- a/net/ncsi/Kconfig > +++ b/net/ncsi/Kconfig > @@ -10,3 +10,9 @@ config NET_NCSI > support. Enable this only if your system connects to a network > device via NCSI and the ethernet driver you're using supports > the protocol explicitly. > +config NCSI_OEM_CMD_GET_MAC > + bool "Get NCSI OEM MAC Address" > + depends on NET_NCSI > + ---help--- > + This allows to get MAC address from NCSI firmware and set them back to > + controller. > diff --git a/net/ncsi/internal.h b/net/ncsi/internal.h > index 3d0a33b874f5..45883b32790e 100644 > --- a/net/ncsi/internal.h > +++ b/net/ncsi/internal.h > @@ -71,6 +71,13 @@ enum { > /* OEM Vendor Manufacture ID */ > #define NCSI_OEM_MFR_MLX_ID 0x8119 > #define NCSI_OEM_MFR_BCM_ID 0x113d > +/* Broadcom specific OEM Command */ > +#define NCSI_OEM_BCM_CMD_GMA 0x01 /* CMD ID for Get MAC */ > +/* OEM Command payload lengths*/ > +#define NCSI_OEM_BCM_CMD_GMA_LEN 12 > +/* Mac address offset in OEM response */ > +#define BCM_MAC_ADDR_OFFSET 28 > + > > struct ncsi_channel_version { > u32 version; /* Supported BCD encoded NCSI version */ > @@ -240,6 +247,7 @@ enum { > ncsi_dev_state_probe_dp, > ncsi_dev_state_config_sp = 0x0301, > ncsi_dev_state_config_cis, > + ncsi_dev_state_config_oem_gma, > ncsi_dev_state_config_clear_vids, > ncsi_dev_state_config_svf, > ncsi_dev_state_config_ev, > diff --git a/net/ncsi/ncsi-manage.c b/net/ncsi/ncsi-manage.c > index 091284760d21..75504ccd1b95 100644 > --- a/net/ncsi/ncsi-manage.c > +++ b/net/ncsi/ncsi-manage.c > @@ -635,6 +635,39 @@ static int set_one_vid(struct ncsi_dev_priv *ndp, struct ncsi_channel *nc, > return 0; > } > > +#if IS_ENABLED(CONFIG_NCSI_OEM_CMD_GET_MAC) > + > +/* NCSI OEM Command APIs */ > +static void ncsi_oem_gma_handler_bcm(struct ncsi_cmd_arg *nca) > +{ > + int ret = 0; > + unsigned char data[NCSI_OEM_BCM_CMD_GMA_LEN]; > + > + nca->payload = NCSI_OEM_BCM_CMD_GMA_LEN; > + > + memset(data, 0, NCSI_OEM_BCM_CMD_GMA_LEN); > + *(unsigned int *)data = ntohl(NCSI_OEM_MFR_BCM_ID); > + data[5] = NCSI_OEM_BCM_CMD_GMA; > + > + nca->data = data; > + > + ret = ncsi_xmit_cmd(nca); > + if (ret) > + netdev_err(nca->ndp->ndev.dev, > + "NCSI: Failed to transmit cmd 0x%x during configure\n", > + nca->type); > +} > + > +/* OEM Command handlers initialization */ > +static struct ncsi_oem_gma_handler { > + unsigned int mfr_id; > + void (*handler)(struct ncsi_cmd_arg *nca); > +} ncsi_oem_gma_handlers[] = { > + { NCSI_OEM_MFR_BCM_ID, ncsi_oem_gma_handler_bcm } > +}; > + > +#endif /* CONFIG_NCSI_OEM_CMD_GET_MAC */ > + > static void ncsi_configure_channel(struct ncsi_dev_priv *ndp) > { > struct ncsi_dev *nd = &ndp->ndev; > @@ -685,6 +718,43 @@ static void ncsi_configure_channel(struct ncsi_dev_priv *ndp) > goto error; > } > > +#if IS_ENABLED(CONFIG_NCSI_OEM_CMD_GET_MAC) > + nd->state = ncsi_dev_state_config_oem_gma; > + break; > + case ncsi_dev_state_config_oem_gma: > + nca.type = NCSI_PKT_CMD_OEM; > + nca.package = np->id; > + nca.channel = nc->id; > + ndp->pending_req_num = 1; > + > + /* Check for manufacturer id and Find the handler */ > + struct ncsi_oem_gma_handler *nch = NULL; > + int i; > + > + for (i = 0; i < ARRAY_SIZE(ncsi_oem_gma_handlers); i++) { > + if (ncsi_oem_gma_handlers[i].mfr_id == > + nc->version.mf_id) { > + if (ncsi_oem_gma_handlers[i].handler) > + nch = &ncsi_oem_gma_handlers[i]; > + else > + nch = NULL; > + > + break; > + } > + } > + > + if (!nch) { > + netdev_err(ndp->ndev.dev, "No handler available for GMA with MFR-ID (0x%x)\n", > + nc->version.mf_id); > + nd->state = ncsi_dev_state_config_clear_vids; > + schedule_work(&ndp->work); > + break; > + } > + > + /* Get Mac address from NCSI device */ > + nch->handler(&nca); > +#endif /* CONFIG_NCSI_OEM_CMD_GET_MAC */ > + > nd->state = ncsi_dev_state_config_clear_vids; > break; > case ncsi_dev_state_config_clear_vids: > diff --git a/net/ncsi/ncsi-pkt.h b/net/ncsi/ncsi-pkt.h > index 0f2087c8d42a..4d3f06be38bd 100644 > --- a/net/ncsi/ncsi-pkt.h > +++ b/net/ncsi/ncsi-pkt.h > @@ -165,6 +165,14 @@ struct ncsi_rsp_oem_pkt { > unsigned char data[]; /* Payload data */ > }; > > +/* Broadcom Response Data */ > +struct ncsi_rsp_oem_bcm_pkt { > + unsigned char ver; /* Payload Version */ > + unsigned char type; /* OEM Command type */ > + __be16 len; /* Payload Length */ > + unsigned char data[]; /* Cmd specific Data */ > +}; > + > /* Get Link Status */ > struct ncsi_rsp_gls_pkt { > struct ncsi_rsp_pkt_hdr rsp; /* Response header */ > diff --git a/net/ncsi/ncsi-rsp.c b/net/ncsi/ncsi-rsp.c > index d66b34749027..31672e967db2 100644 > --- a/net/ncsi/ncsi-rsp.c > +++ b/net/ncsi/ncsi-rsp.c > @@ -596,12 +596,50 @@ static int ncsi_rsp_handler_snfc(struct ncsi_request *nr) > return 0; > } > > +/* Response handler for Broadcom command Get Mac Address */ > +static int ncsi_rsp_handler_oem_bcm_gma(struct ncsi_request *nr) > +{ > + struct ncsi_rsp_oem_pkt *rsp; > + struct ncsi_dev_priv *ndp = nr->ndp; > + struct net_device *ndev = ndp->ndev.dev; > + int ret = 0; > + const struct net_device_ops *ops = ndev->netdev_ops; > + struct sockaddr saddr; > + > + /* Get the response header */ > + rsp = (struct ncsi_rsp_oem_pkt *)skb_network_header(nr->rsp); > + > + saddr.sa_family = ndev->type; > + ndev->priv_flags |= IFF_LIVE_ADDR_CHANGE; > + memcpy(saddr.sa_data, &rsp->data[BCM_MAC_ADDR_OFFSET], ETH_ALEN); > + ret = ops->ndo_set_mac_address(ndev, &saddr); > + if (ret < 0) > + netdev_warn(ndev, "NCSI: Writing mac address to device failed\n"); > + > + return ret; > +} > + > +/* Response handler for Broadcom card */ > +static int ncsi_rsp_handler_oem_bcm(struct ncsi_request *nr) > +{ > + struct ncsi_rsp_oem_pkt *rsp; > + struct ncsi_rsp_oem_bcm_pkt *bcm; > + > + /* Get the response header */ > + rsp = (struct ncsi_rsp_oem_pkt *)skb_network_header(nr->rsp); > + bcm = (struct ncsi_rsp_oem_bcm_pkt *)(rsp->data); > + > + if (bcm->type == NCSI_OEM_BCM_CMD_GMA) > + return ncsi_rsp_handler_oem_bcm_gma(nr); > + return 0; > +} > + > static struct ncsi_rsp_oem_handler { > unsigned int mfr_id; > int (*handler)(struct ncsi_request *nr); > } ncsi_rsp_oem_handlers[] = { > { NCSI_OEM_MFR_MLX_ID, NULL }, > - { NCSI_OEM_MFR_BCM_ID, NULL } > + { NCSI_OEM_MFR_BCM_ID, ncsi_rsp_handler_oem_bcm } > }; > > /* Response handler for OEM command */ > -- > 2.17.1 >
| |