net: stmmac: add mutex lock to protect est parameters

[ Upstream commit b2aae654a4794ef898ad33a179f341eb610f6b85 ]

Add a mutex lock to protect est structure parameters so that the
EST parameters can be updated by other threads.

Signed-off-by: Xiaoliang Yang <xiaoliang.yang_1@nxp.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
Signed-off-by: Pavel Machek (CIP) <pavel@denx.de>
Signed-off-by: Sasha Levin <sashal@kernel.org>
This commit is contained in:
Xiaoliang Yang 2021-07-05 18:26:54 +08:00 committed by AuxXxilium
parent 7400f7b54f
commit 8b92e17dfa
2 changed files with 14 additions and 1 deletions

View File

@ -689,14 +689,18 @@ static int tc_setup_taprio(struct stmmac_priv *priv,
GFP_KERNEL); GFP_KERNEL);
if (!plat->est) if (!plat->est)
return -ENOMEM; return -ENOMEM;
mutex_init(&priv->plat->est->lock);
} else { } else {
memset(plat->est, 0, sizeof(*plat->est)); memset(plat->est, 0, sizeof(*plat->est));
} }
size = qopt->num_entries; size = qopt->num_entries;
mutex_lock(&priv->plat->est->lock);
priv->plat->est->gcl_size = size; priv->plat->est->gcl_size = size;
priv->plat->est->enable = qopt->enable; priv->plat->est->enable = qopt->enable;
mutex_unlock(&priv->plat->est->lock);
for (i = 0; i < size; i++) { for (i = 0; i < size; i++) {
s64 delta_ns = qopt->entries[i].interval; s64 delta_ns = qopt->entries[i].interval;
@ -727,6 +731,7 @@ static int tc_setup_taprio(struct stmmac_priv *priv,
priv->plat->est->gcl[i] = delta_ns | (gates << wid); priv->plat->est->gcl[i] = delta_ns | (gates << wid);
} }
mutex_lock(&priv->plat->est->lock);
/* Adjust for real system time */ /* Adjust for real system time */
priv->ptp_clock_ops.gettime64(&priv->ptp_clock_ops, &current_time); priv->ptp_clock_ops.gettime64(&priv->ptp_clock_ops, &current_time);
current_time_ns = timespec64_to_ktime(current_time); current_time_ns = timespec64_to_ktime(current_time);
@ -751,19 +756,23 @@ static int tc_setup_taprio(struct stmmac_priv *priv,
priv->plat->est->ctr[0] = do_div(ctr, NSEC_PER_SEC); priv->plat->est->ctr[0] = do_div(ctr, NSEC_PER_SEC);
priv->plat->est->ctr[1] = (u32)ctr; priv->plat->est->ctr[1] = (u32)ctr;
if (fpe && !priv->dma_cap.fpesel) if (fpe && !priv->dma_cap.fpesel) {
mutex_unlock(&priv->plat->est->lock);
return -EOPNOTSUPP; return -EOPNOTSUPP;
}
ret = stmmac_fpe_configure(priv, priv->ioaddr, ret = stmmac_fpe_configure(priv, priv->ioaddr,
priv->plat->tx_queues_to_use, priv->plat->tx_queues_to_use,
priv->plat->rx_queues_to_use, fpe); priv->plat->rx_queues_to_use, fpe);
if (ret && fpe) { if (ret && fpe) {
mutex_unlock(&priv->plat->est->lock);
netdev_err(priv->dev, "failed to enable Frame Preemption\n"); netdev_err(priv->dev, "failed to enable Frame Preemption\n");
return ret; return ret;
} }
ret = stmmac_est_configure(priv, priv->ioaddr, priv->plat->est, ret = stmmac_est_configure(priv, priv->ioaddr, priv->plat->est,
priv->plat->clk_ptp_rate); priv->plat->clk_ptp_rate);
mutex_unlock(&priv->plat->est->lock);
if (ret) { if (ret) {
netdev_err(priv->dev, "failed to configure EST\n"); netdev_err(priv->dev, "failed to configure EST\n");
goto disable; goto disable;
@ -773,9 +782,12 @@ static int tc_setup_taprio(struct stmmac_priv *priv,
return 0; return 0;
disable: disable:
mutex_lock(&priv->plat->est->lock);
priv->plat->est->enable = false; priv->plat->est->enable = false;
stmmac_est_configure(priv, priv->ioaddr, priv->plat->est, stmmac_est_configure(priv, priv->ioaddr, priv->plat->est,
priv->plat->clk_ptp_rate); priv->plat->clk_ptp_rate);
mutex_unlock(&priv->plat->est->lock);
return ret; return ret;
} }

View File

@ -112,6 +112,7 @@ struct stmmac_axi {
#define EST_GCL 1024 #define EST_GCL 1024
struct stmmac_est { struct stmmac_est {
struct mutex lock;
int enable; int enable;
u32 btr_offset[2]; u32 btr_offset[2];
u32 btr[2]; u32 btr[2];