spi: add power control when set_cs_timing
authorleilk.liu <leilk.liu@mediatek.com>
Sun, 7 Feb 2021 03:09:51 +0000 (11:09 +0800)
committerMark Brown <broonie@kernel.org>
Mon, 8 Feb 2021 11:41:21 +0000 (11:41 +0000)
As to set_cs_timing takes effect immediately, power spi
is needed when call spi_set_cs_timing.

Signed-off-by: leilk.liu <leilk.liu@mediatek.com>
Link: https://lore.kernel.org/r/20210207030953.9297-2-leilk.liu@mediatek.com
Signed-off-by: Mark Brown <broonie@kernel.org>
drivers/spi/spi.c

index a17efa8..21ea3e8 100644 (file)
@@ -3460,11 +3460,30 @@ EXPORT_SYMBOL_GPL(spi_setup);
 int spi_set_cs_timing(struct spi_device *spi, struct spi_delay *setup,
                      struct spi_delay *hold, struct spi_delay *inactive)
 {
+       struct device *parent = spi->controller->dev.parent;
        size_t len;
+       int status;
+
+       if (spi->controller->set_cs_timing) {
+               if (spi->controller->auto_runtime_pm) {
+                       status = pm_runtime_get_sync(parent);
+                       if (status < 0) {
+                               pm_runtime_put_noidle(parent);
+                               dev_err(&spi->controller->dev, "Failed to power device: %d\n",
+                                       status);
+                               return status;
+                       }
 
-       if (spi->controller->set_cs_timing)
-               return spi->controller->set_cs_timing(spi, setup, hold,
-                                                     inactive);
+                       status = spi->controller->set_cs_timing(spi, setup,
+                                                               hold, inactive);
+                       pm_runtime_mark_last_busy(parent);
+                       pm_runtime_put_autosuspend(parent);
+                       return status;
+               } else {
+                       return spi->controller->set_cs_timing(spi, setup, hold,
+                                                             inactive);
+               }
+       }
 
        if ((setup && setup->unit == SPI_DELAY_UNIT_SCK) ||
            (hold && hold->unit == SPI_DELAY_UNIT_SCK) ||