Add support for configure CBS through TC

Issue: New feature requirement to have
CBS configuration through TC

Fix: added support for same.

sudo tc qdisc add dev eth4 parent root handle 6666 mqprio \
        num_tc 3 \
        map 2 2 1 0 2 2 2 2 2 2 2 2 2 2 2 2 \
        queues 1@0 1@1 2@2 \
        hw 0
sudo tc qdisc replace dev eth4 parent 6666:3 cbs \
        idleslope 2000000 sendslope -8000000 hicredit 3000 locredit -1200 \
        offload 1

Bug  200776994

Change-Id: Id83b967bcbbb18201f2757987ab1cefe63b4ad8d
Signed-off-by: Rakesh Goyal <rgoyal@nvidia.com>
Reviewed-on: https://git-master.nvidia.com/r/c/linux-nvidia/+/2649428
Reviewed-by: svc_kernel_abi <svc_kernel_abi@nvidia.com>
Reviewed-by: Narayan Reddy <narayanr@nvidia.com>
Reviewed-by: Nagarjuna Kristam <nkristam@nvidia.com>
Reviewed-by: Sachin Nikam <snikam@nvidia.com>
GVS: Gerrit_Virtual_Submit
This commit is contained in:
Rakesh Goyal
2022-01-04 15:32:08 +05:30
committed by Revanth Kumar Uppala
parent ad01764abb
commit dbf00db6bb
3 changed files with 109 additions and 2 deletions

View File

@@ -1,5 +1,5 @@
/*
* Copyright (c) 2021, NVIDIA CORPORATION. All rights reserved.
* Copyright (c) 2021-2022, NVIDIA CORPORATION. All rights reserved.
*
* This program is free software; you can redistribute it and/or modify it
* under the terms and conditions of the GNU General Public License,
@@ -170,4 +170,84 @@ disable:
done:
return ret;
}
int ether_tc_setup_cbs(struct ether_priv_data *pdata,
struct tc_cbs_qopt_offload *qopt)
{
struct osi_core_priv_data *osi_core = pdata->osi_core;
struct phy_device *phydev = pdata->phydev;
struct osi_ioctl ioctl_data = {};
int queue = qopt->queue;
unsigned int multiplier, speed_div;
unsigned long value;
int speed;
/* Queue 0 is not AVB capable */
if (queue <= 0) {
netdev_err(pdata->ndev, "%s() invalid queue\n", __func__);
return -EINVAL;
}
if (phydev != NULL) {
speed = phydev->speed;
} else {
speed = pdata->speed;
}
switch (speed) {
case OSI_SPEED_10000:
multiplier = MULTIPLIER_32;
speed_div = OSI_SPEED_10000 * ETH_1K;
break;
case OSI_SPEED_5000:
multiplier = MULTIPLIER_32;
speed_div = OSI_SPEED_5000 * ETH_1K;
break;
case OSI_SPEED_2500:
multiplier = MULTIPLIER_8;
speed_div = OSI_SPEED_2500 * ETH_1K;
break;
case OSI_SPEED_1000:
multiplier = MULTIPLIER_8;
speed_div = OSI_SPEED_1000 * ETH_1K;
break;
case OSI_SPEED_100:
multiplier = MULTIPLIER_4;
speed_div = OSI_SPEED_100 * ETH_1K;
break;
default:
netdev_err(pdata->ndev, "invalid speed\n");
return -EINVAL;
}
ioctl_data.avb.qindex = (unsigned int)queue;
ioctl_data.avb.tcindex = (unsigned int)queue;
if (qopt->enable) {
ioctl_data.avb.algo = OSI_MTL_TXQ_AVALG_CBS;
ioctl_data.avb.oper_mode = OSI_MTL_QUEUE_AVB;
ioctl_data.avb.credit_control = OSI_ENABLE;
} else {
ioctl_data.avb.algo = OSI_MTL_TXQ_AVALG_SP;
ioctl_data.avb.oper_mode = OSI_MTL_QUEUE_ENABLE;
ioctl_data.avb.credit_control = OSI_DISABLE;
}
/* Final adjustments for HW */
value = div_s64(qopt->idleslope * 1024ll * multiplier, speed_div);
ioctl_data.avb.idle_slope = (unsigned long)value;
value = div_s64(-qopt->sendslope * 1024ll * multiplier, speed_div);
ioctl_data.avb.send_slope = (unsigned long)value;
value = qopt->hicredit * 1024ll * 8;
ioctl_data.avb.hi_credit = (unsigned long)value;
value = qopt->locredit * 1024ll * 8;
ioctl_data.avb.low_credit = (unsigned long)value;
ioctl_data.cmd = OSI_CMD_SET_AVB;
return osi_handle_ioctl(osi_core, &ioctl_data);
}
#endif