dasharo/linux
0
0
Fork 0
mirror of https://github.com/Dasharo/linux.git synced 2026-03-06 15:25:10 -08:00
Code Issues Packages Projects Releases Wiki Activity

soc: fsl: cpm1: qmc: Introduce functions to change timeslots at runtime

Browse Source 
Introduce qmc_chan_{get,set}_ts_info() function to allow timeslots
modification at runtime.

The modification is provided using qmc_chan_set_ts_info() and will be
applied on next qmc_chan_start().
qmc_chan_set_ts_info() must be called with the channel rx and/or tx
stopped.

Signed-off-by: Herve Codina <herve.codina@bootlin.com>
Reviewed-by: Christophe Leroy <christophe.leroy@csgroup.eu>
Link: https://lore.kernel.org/r/20231205152116.122512-18-herve.codina@bootlin.com
This commit is contained in:
Herve Codina
2023-12-05 16:21:14 +01:00
parent 0d75119d08
commit 7a2ee1576d
2 changed files with 61 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

51
drivers/soc/fsl/qe/qmc.c
View File

@@ -290,6 +290,57 @@ int qmc_chan_get_info(struct qmc_chan *chan, struct qmc_chan_info *info)
}
EXPORT_SYMBOL(qmc_chan_get_info);
int qmc_chan_get_ts_info(struct qmc_chan *chan, struct qmc_chan_ts_info *ts_info)
{
unsigned long flags;
spin_lock_irqsave(&chan->ts_lock, flags);
ts_info->rx_ts_mask_avail = chan->rx_ts_mask_avail;
ts_info->tx_ts_mask_avail = chan->tx_ts_mask_avail;
ts_info->rx_ts_mask = chan->rx_ts_mask;
ts_info->tx_ts_mask = chan->tx_ts_mask;
spin_unlock_irqrestore(&chan->ts_lock, flags);
return 0;
}
EXPORT_SYMBOL(qmc_chan_get_ts_info);
int qmc_chan_set_ts_info(struct qmc_chan *chan, const struct qmc_chan_ts_info *ts_info)
{
unsigned long flags;
int ret;
/* Only a subset of available timeslots is allowed */
if ((ts_info->rx_ts_mask & chan->rx_ts_mask_avail) != ts_info->rx_ts_mask)
return -EINVAL;
if ((ts_info->tx_ts_mask & chan->tx_ts_mask_avail) != ts_info->tx_ts_mask)
return -EINVAL;
/* In case of common rx/tx table, rx/tx masks must be identical */
if (chan->qmc->is_tsa_64rxtx) {
if (ts_info->rx_ts_mask != ts_info->tx_ts_mask)
return -EINVAL;
}
spin_lock_irqsave(&chan->ts_lock, flags);
if ((chan->tx_ts_mask != ts_info->tx_ts_mask && !chan->is_tx_stopped) ||
(chan->rx_ts_mask != ts_info->rx_ts_mask && !chan->is_rx_stopped)) {
dev_err(chan->qmc->dev, "Channel rx and/or tx not stopped\n");
ret = -EBUSY;
} else {
chan->tx_ts_mask = ts_info->tx_ts_mask;
chan->rx_ts_mask = ts_info->rx_ts_mask;
ret = 0;
}
spin_unlock_irqrestore(&chan->ts_lock, flags);
return ret;
}
EXPORT_SYMBOL(qmc_chan_set_ts_info);
int qmc_chan_set_param(struct qmc_chan *chan, const struct qmc_chan_param *param)
{
if (param->mode != chan->mode)

10
include/soc/fsl/qe/qmc.h
View File

@@ -40,6 +40,16 @@ struct qmc_chan_info {
int qmc_chan_get_info(struct qmc_chan *chan, struct qmc_chan_info *info);
struct qmc_chan_ts_info {
u64 rx_ts_mask_avail;
u64 tx_ts_mask_avail;
u64 rx_ts_mask;
u64 tx_ts_mask;
};
int qmc_chan_get_ts_info(struct qmc_chan *chan, struct qmc_chan_ts_info *ts_info);
int qmc_chan_set_ts_info(struct qmc_chan *chan, const struct qmc_chan_ts_info *ts_info);
struct qmc_chan_param {
enum qmc_mode mode;
union {