net: stmmac: Add support for EST cycle-time-extension

[linux-2.6-microblaze.git] / drivers / net / ethernet / stmicro / stmmac / stmmac_tc.c

diff --git a/drivers/net/ethernet/stmicro/stmmac/stmmac_tc.c b/drivers/net/ethernet/stmicro/stmmac/stmmac_tc.c
index d4ee468..287767f 100644 (file)
--- a/drivers/net/ethernet/stmicro/stmmac/stmmac_tc.c
+++ b/drivers/net/ethernet/stmicro/stmmac/stmmac_tc.c
@@ -975,6 +975,8 @@ static int tc_setup_taprio(struct stmmac_priv *priv,
                return -EINVAL;
        if (!qopt->cycle_time)
                return -ERANGE;
+       if (qopt->cycle_time_extension >= BIT(wid + 7))
+               return -ERANGE;
 
        if (!plat->est) {
                plat->est = devm_kzalloc(priv->device, sizeof(*plat->est),
@@ -1041,6 +1043,8 @@ static int tc_setup_taprio(struct stmmac_priv *priv,
        priv->plat->est->ctr[0] = do_div(ctr, NSEC_PER_SEC);
        priv->plat->est->ctr[1] = (u32)ctr;
 
+       priv->plat->est->ter = qopt->cycle_time_extension;
+
        if (fpe && !priv->dma_cap.fpesel) {
                mutex_unlock(&priv->plat->est->lock);
                return -EOPNOTSUPP;