On Sun, 31 Jan 2021 18:41:05 +0530 Hariprasad Kelam wrote:
> From: Christina Jacob <cja...@marvell.com>
>
> Register set_link_ksetting callback with driver such that
> link configurations parameters like advertised mode,speed, duplex
> and autoneg can be configured.
>
> below command
> ethtool -s eth0 advertise 0x1 speed 10 duplex full autoneg on
>
> Signed-off-by: Christina Jacob <cja...@marvell.com>
> Signed-off-by: Sunil Goutham <sgout...@marvell.com>
> Signed-off-by: Hariprasad Kelam <hke...@marvell.com>
> ---
> .../ethernet/marvell/octeontx2/nic/otx2_ethtool.c | 67
> ++++++++++++++++++++++
> 1 file changed, 67 insertions(+)
>
> diff --git a/drivers/net/ethernet/marvell/octeontx2/nic/otx2_ethtool.c
> b/drivers/net/ethernet/marvell/octeontx2/nic/otx2_ethtool.c
> index d637815..74a62de 100644
> --- a/drivers/net/ethernet/marvell/octeontx2/nic/otx2_ethtool.c
> +++ b/drivers/net/ethernet/marvell/octeontx2/nic/otx2_ethtool.c
> @@ -1170,6 +1170,72 @@ static int otx2_get_link_ksettings(struct net_device
> *netdev,
> return 0;
> }
>
> +static void otx2_get_advertised_mode(const struct ethtool_link_ksettings
> *cmd,
> + u64 *mode)
> +{
> + u32 bit_pos;
> +
> + /* Firmware does not support requesting multiple advertised modes
> + * return first set bit
> + */
> + bit_pos = find_first_bit(cmd->link_modes.advertising,
> + __ETHTOOL_LINK_MODE_MASK_NBITS);
> + if (bit_pos != __ETHTOOL_LINK_MODE_MASK_NBITS)
> + *mode = bit_pos;
> +}
> +
> +static int otx2_set_link_ksettings(struct net_device *netdev,
> + const struct ethtool_link_ksettings *cmd)
> +{
> + struct otx2_nic *pf = netdev_priv(netdev);
> + struct ethtool_link_ksettings req_ks;
> + struct ethtool_link_ksettings cur_ks;
> + struct cgx_set_link_mode_req *req;
> + struct mbox *mbox = &pf->mbox;
> + int err = 0;
> +
> + /* save requested link settings */
> + memcpy(&req_ks, cmd, sizeof(struct ethtool_link_ksettings));
Why do you make this copy? The comment above does not help at all.
> + memset(&cur_ks, 0, sizeof(struct ethtool_link_ksettings));
> +
> + if (!ethtool_validate_speed(cmd->base.speed) ||
> + !ethtool_validate_duplex(cmd->base.duplex))
> + return -EINVAL;
> +
> + if (cmd->base.autoneg != AUTONEG_ENABLE &&
> + cmd->base.autoneg != AUTONEG_DISABLE)
> + return -EINVAL;
> +
> + otx2_get_link_ksettings(netdev, &cur_ks);
> +
> + /* Check requested modes against supported modes by hardware */
> + if (!bitmap_subset(req_ks.link_modes.advertising,
> + cur_ks.link_modes.supported,
> + __ETHTOOL_LINK_MODE_MASK_NBITS))
> + return -EINVAL;
> +
> + mutex_lock(&mbox->lock);
> + req = otx2_mbox_alloc_msg_cgx_set_link_mode(&pf->mbox);
> + if (!req) {
> + err = -ENOMEM;
> + goto end;
> + }
> +
> + req->args.speed = req_ks.base.speed;
> + /* firmware expects 1 for half duplex and 0 for full duplex
> + * hence inverting
> + */
> + req->args.duplex = req_ks.base.duplex ^ 0x1;
> + req->args.an = req_ks.base.autoneg;
> + otx2_get_advertised_mode(&req_ks, &req->args.mode);
But that only returns the first bit set. What does the device actually
do? What if the user cleared a middle bit?
> + err = otx2_sync_mbox_msg(&pf->mbox);
> +end:
> + mutex_unlock(&mbox->lock);
> + return err;
> +}
> +
> static const struct ethtool_ops otx2_ethtool_ops = {
> .supported_coalesce_params = ETHTOOL_COALESCE_USECS |
> ETHTOOL_COALESCE_MAX_FRAMES,
> @@ -1200,6 +1266,7 @@ static const struct ethtool_ops otx2_ethtool_ops = {
> .get_fecparam = otx2_get_fecparam,
> .set_fecparam = otx2_set_fecparam,
> .get_link_ksettings = otx2_get_link_ksettings,
> + .set_link_ksettings = otx2_set_link_ksettings,
> };
>
> void otx2_set_ethtool_ops(struct net_device *netdev)
