lkml.org 
[lkml]   [2023]   [Nov]   [28]   [last100]   RSS Feed
Views: [wrap][no wrap]   [headers]  [forward] 
 
Messages in this thread
    Patch in this message
    /
    From
    Subject[PATCH 17/17] soc: fsl: cpm1: qmc: Introduce functions to change timeslots at runtime
    Date
    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>
    ---
    drivers/soc/fsl/qe/qmc.c | 51 ++++++++++++++++++++++++++++++++++++++++
    include/soc/fsl/qe/qmc.h | 10 ++++++++
    2 files changed, 61 insertions(+)

    diff --git a/drivers/soc/fsl/qe/qmc.c b/drivers/soc/fsl/qe/qmc.c
    index 73903ce31695..79fe79b9464f 100644
    --- a/drivers/soc/fsl/qe/qmc.c
    +++ b/drivers/soc/fsl/qe/qmc.c
    @@ -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)
    diff --git a/include/soc/fsl/qe/qmc.h b/include/soc/fsl/qe/qmc.h
    index 166484bb4294..2a333fc1ea81 100644
    --- a/include/soc/fsl/qe/qmc.h
    +++ b/include/soc/fsl/qe/qmc.h
    @@ -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 {
    --
    2.42.0
    \
     
     \ /
      Last update: 2023-11-28 15:10    [W:4.743 / U:0.044 seconds]
    ©2003-2020 Jasper Spaans|hosted at Digital Ocean and TransIP|Read the blog|Advertise on this site