[<prev] [next>] [<thread-prev] [day] [month] [year] [list]
Message-ID: <20251120211204.24078-5-jonathan@marek.ca>
Date: Thu, 20 Nov 2025 16:12:02 -0500
From: Jonathan Marek <jonathan@...ek.ca>
To: linux-arm-msm@...r.kernel.org
Cc: Mark Brown <broonie@...nel.org>,
linux-spi@...r.kernel.org (open list:SPI SUBSYSTEM),
linux-kernel@...r.kernel.org (open list)
Subject: [PATCH 5/5] spi-geni-qcom: rework setup_fifo_params
Update each register only if it changes.
This also fixes the chipselect related registers not being changed when
chipselect changes but not the mode.
Signed-off-by: Jonathan Marek <jonathan@...ek.ca>
---
drivers/spi/spi-geni-qcom.c | 48 ++++++++++++++++---------------------
1 file changed, 20 insertions(+), 28 deletions(-)
diff --git a/drivers/spi/spi-geni-qcom.c b/drivers/spi/spi-geni-qcom.c
index 53229150b86b5..5cca356cb673a 100644
--- a/drivers/spi/spi-geni-qcom.c
+++ b/drivers/spi/spi-geni-qcom.c
@@ -82,6 +82,7 @@ struct spi_geni_master {
u32 fifo_width_bits;
u32 tx_wm;
u32 last_mode;
+ u8 last_cs;
unsigned long cur_speed_hz;
unsigned long cur_sclk_hz;
unsigned int cur_bits_per_word;
@@ -350,34 +351,25 @@ static int setup_fifo_params(struct spi_device *spi_slv,
{
struct spi_geni_master *mas = spi_controller_get_devdata(spi);
struct geni_se *se = &mas->se;
- u32 loopback_cfg = 0, cpol = 0, cpha = 0, demux_output_inv = 0;
- u32 demux_sel;
-
- if (mas->last_mode != spi_slv->mode) {
- if (spi_slv->mode & SPI_LOOP)
- loopback_cfg = LOOPBACK_ENABLE;
-
- if (spi_slv->mode & SPI_CPOL)
- cpol = CPOL;
-
- if (spi_slv->mode & SPI_CPHA)
- cpha = CPHA;
-
- if (spi_slv->mode & SPI_CS_HIGH)
- demux_output_inv = BIT(spi_get_chipselect(spi_slv, 0));
-
- demux_sel = spi_get_chipselect(spi_slv, 0);
- mas->cur_bits_per_word = spi_slv->bits_per_word;
-
- spi_setup_word_len(mas, spi_slv->mode, spi_slv->bits_per_word);
- writel(loopback_cfg, se->base + SE_SPI_LOOPBACK);
- writel(demux_sel, se->base + SE_SPI_DEMUX_SEL);
- writel(cpha, se->base + SE_SPI_CPHA);
- writel(cpol, se->base + SE_SPI_CPOL);
- writel(demux_output_inv, se->base + SE_SPI_DEMUX_OUTPUT_INV);
-
- mas->last_mode = spi_slv->mode;
- }
+ u8 chipselect = spi_get_chipselect(spi_slv, 0);
+ bool cs_changed = (mas->last_cs != chipselect);
+ u32 mode_changed = mas->last_mode ^ spi_slv->mode;
+
+ mas->last_cs = chipselect;
+ mas->last_mode = spi_slv->mode;
+
+ if (mode_changed & SPI_LSB_FIRST)
+ mas->cur_bits_per_word = 0; /* force next setup_se_xfer to call spi_setup_word_len */
+ if (mode_changed & SPI_LOOP)
+ writel((spi_slv->mode & SPI_LOOP) ? LOOPBACK_ENABLE : 0, se->base + SE_SPI_LOOPBACK);
+ if (cs_changed)
+ writel(chipselect, se->base + SE_SPI_DEMUX_SEL);
+ if (mode_changed & SE_SPI_CPHA)
+ writel((spi_slv->mode & SPI_CPHA) ? CPHA : 0, se->base + SE_SPI_CPHA);
+ if (mode_changed & SE_SPI_CPOL)
+ writel((spi_slv->mode & SPI_CPOL) ? CPOL : 0, se->base + SE_SPI_CPOL);
+ if ((mode_changed & SPI_CS_HIGH) || (cs_changed && (spi_slv->mode & SPI_CS_HIGH)))
+ writel((spi_slv->mode & SPI_CS_HIGH) ? BIT(chipselect) : 0, se->base + SE_SPI_DEMUX_OUTPUT_INV);
return 0;
}
--
2.51.0
Powered by blists - more mailing lists