Unverified Commit 9cd34efb authored Dec 24, 2019 by Kunihiko Hayashi Committed by Mark Brown Dec 25, 2019

spi: uniphier: Fix FIFO threshold



Rx threshold means the value to inform the receiver when the number of words
in Rx FIFO is equal to or more than the value. Similarly, Tx threshold means
the value to inform the sender when the number of words in Tx FIFO is equal
to or less than the value. The controller triggers the driver to start
the transfer.

In case of Rx, the driver wants to detect that the specified number of words
N are in Rx FIFO, so the value of Rx threshold should be N. In case of Tx,
the driver wants to detect that the same number of spaces as Rx are in
Tx FIFO, so the value of Tx threshold should be (FIFO size - N).

For example, in order for the driver to receive at least 3 words from
Rx FIFO, set 3 to Rx threshold.
   +-+-+-+-+-+-+-+-+
   | | | | | |*|*|*|
   +-+-+-+-+-+-+-+-+

In order for the driver to send at least 3 words to Tx FIFO, because
it needs at least 3 spaces, set 8(FIFO size) - 3 = 5 to Tx threshold.
   +-+-+-+-+-+-+-+-+
   |*|*|*|*|*| | | |
   +-+-+-+-+-+-+-+-+

This adds new function uniphier_spi_set_fifo_threshold() to set
threshold value to the register.

And more, FIFO counts by 'words', so this renames 'fill_bytes' with
'fill_words', and fixes the calculation using bytes_per_words.

Fixes: 37ffab81 ("spi: uniphier: introduce polling mode")
Cc: Keiji Hayashibara <hayashibara.keiji@socionext.com>
Signed-off-by: Kunihiko Hayashi <hayashi.kunihiko@socionext.com>
Link: https://lore.kernel.org/r/1577149107-30670-2-git-send-email-hayashi.kunihiko@socionext.com


Signed-off-by: Mark Brown <broonie@kernel.org>

parent 63aa6a69

drivers/spi/spi-uniphier.c

+19 −12

Original line number	Diff line number	Diff line
		@@ -290,25 +290,32 @@ static void uniphier_spi_recv(struct uniphier_spi_priv *priv)
		}
		}

		static void uniphier_spi_fill_tx_fifo(struct uniphier_spi_priv *priv)
		static void uniphier_spi_set_fifo_threshold(struct uniphier_spi_priv *priv,
		unsigned int threshold)
		{
		unsigned int fifo_threshold, fill_bytes;
		u32 val;

		fifo_threshold = DIV_ROUND_UP(priv->rx_bytes,
		bytes_per_word(priv->bits_per_word));
		fifo_threshold = min(fifo_threshold, SSI_FIFO_DEPTH);

		fill_bytes = fifo_threshold - (priv->rx_bytes - priv->tx_bytes);

		/* set fifo threshold */
		val = readl(priv->base + SSI_FC);
		val &= ~(SSI_FC_TXFTH_MASK \| SSI_FC_RXFTH_MASK);
		val \|= FIELD_PREP(SSI_FC_TXFTH_MASK, fifo_threshold);
		val \|= FIELD_PREP(SSI_FC_RXFTH_MASK, fifo_threshold);
		val \|= FIELD_PREP(SSI_FC_TXFTH_MASK, SSI_FIFO_DEPTH - threshold);
		val \|= FIELD_PREP(SSI_FC_RXFTH_MASK, threshold);
		writel(val, priv->base + SSI_FC);
		}

		static void uniphier_spi_fill_tx_fifo(struct uniphier_spi_priv *priv)
		{
		unsigned int fifo_threshold, fill_words;
		unsigned int bpw = bytes_per_word(priv->bits_per_word);

		fifo_threshold = DIV_ROUND_UP(priv->rx_bytes, bpw);
		fifo_threshold = min(fifo_threshold, SSI_FIFO_DEPTH);

		uniphier_spi_set_fifo_threshold(priv, fifo_threshold);

		fill_words = fifo_threshold -
		DIV_ROUND_UP(priv->rx_bytes - priv->tx_bytes, bpw);

		while (fill_bytes--)
		while (fill_words--)
		uniphier_spi_send(priv);
		}

Admin message