Commit 2e541b64 authored by Ludovic Barre's avatar Ludovic Barre Committed by Mark Brown

spi: spi-mem: stm32-qspi: add suspend/resume support

This patch adds suspend and resume support for spi-stm32-qspi
drivers.
Signed-off-by: default avatarLudovic Barre <ludovic.barre@st.com>
Signed-off-by: default avatarMark Brown <broonie@kernel.org>
parent 3949ba3b
...@@ -13,6 +13,7 @@ ...@@ -13,6 +13,7 @@
#include <linux/mutex.h> #include <linux/mutex.h>
#include <linux/of.h> #include <linux/of.h>
#include <linux/of_device.h> #include <linux/of_device.h>
#include <linux/pinctrl/consumer.h>
#include <linux/platform_device.h> #include <linux/platform_device.h>
#include <linux/reset.h> #include <linux/reset.h>
#include <linux/sizes.h> #include <linux/sizes.h>
...@@ -101,6 +102,9 @@ struct stm32_qspi { ...@@ -101,6 +102,9 @@ struct stm32_qspi {
struct completion data_completion; struct completion data_completion;
u32 fmode; u32 fmode;
u32 cr_reg;
u32 dcr_reg;
/* /*
* to protect device configuration, could be different between * to protect device configuration, could be different between
* 2 flash access (bk1, bk2) * 2 flash access (bk1, bk2)
...@@ -355,7 +359,7 @@ static int stm32_qspi_setup(struct spi_device *spi) ...@@ -355,7 +359,7 @@ static int stm32_qspi_setup(struct spi_device *spi)
struct spi_controller *ctrl = spi->master; struct spi_controller *ctrl = spi->master;
struct stm32_qspi *qspi = spi_controller_get_devdata(ctrl); struct stm32_qspi *qspi = spi_controller_get_devdata(ctrl);
struct stm32_qspi_flash *flash; struct stm32_qspi_flash *flash;
u32 cr, presc; u32 presc;
if (ctrl->busy) if (ctrl->busy)
return -EBUSY; return -EBUSY;
...@@ -371,11 +375,12 @@ static int stm32_qspi_setup(struct spi_device *spi) ...@@ -371,11 +375,12 @@ static int stm32_qspi_setup(struct spi_device *spi)
flash->presc = presc; flash->presc = presc;
mutex_lock(&qspi->lock); mutex_lock(&qspi->lock);
cr = FIELD_PREP(CR_FTHRES_MASK, 3) | CR_SSHIFT | CR_EN; qspi->cr_reg = FIELD_PREP(CR_FTHRES_MASK, 3) | CR_SSHIFT | CR_EN;
writel_relaxed(cr, qspi->io_base + QSPI_CR); writel_relaxed(qspi->cr_reg, qspi->io_base + QSPI_CR);
/* set dcr fsize to max address */ /* set dcr fsize to max address */
writel_relaxed(DCR_FSIZE_MASK, qspi->io_base + QSPI_DCR); qspi->dcr_reg = DCR_FSIZE_MASK;
writel_relaxed(qspi->dcr_reg, qspi->io_base + QSPI_DCR);
mutex_unlock(&qspi->lock); mutex_unlock(&qspi->lock);
return 0; return 0;
...@@ -489,6 +494,31 @@ static int stm32_qspi_remove(struct platform_device *pdev) ...@@ -489,6 +494,31 @@ static int stm32_qspi_remove(struct platform_device *pdev)
return 0; return 0;
} }
static int __maybe_unused stm32_qspi_suspend(struct device *dev)
{
struct stm32_qspi *qspi = dev_get_drvdata(dev);
clk_disable_unprepare(qspi->clk);
pinctrl_pm_select_sleep_state(dev);
return 0;
}
static int __maybe_unused stm32_qspi_resume(struct device *dev)
{
struct stm32_qspi *qspi = dev_get_drvdata(dev);
pinctrl_pm_select_default_state(dev);
clk_prepare_enable(qspi->clk);
writel_relaxed(qspi->cr_reg, qspi->io_base + QSPI_CR);
writel_relaxed(qspi->dcr_reg, qspi->io_base + QSPI_DCR);
return 0;
}
SIMPLE_DEV_PM_OPS(stm32_qspi_pm_ops, stm32_qspi_suspend, stm32_qspi_resume);
static const struct of_device_id stm32_qspi_match[] = { static const struct of_device_id stm32_qspi_match[] = {
{.compatible = "st,stm32f469-qspi"}, {.compatible = "st,stm32f469-qspi"},
{} {}
...@@ -501,6 +531,7 @@ static struct platform_driver stm32_qspi_driver = { ...@@ -501,6 +531,7 @@ static struct platform_driver stm32_qspi_driver = {
.driver = { .driver = {
.name = "stm32-qspi", .name = "stm32-qspi",
.of_match_table = stm32_qspi_match, .of_match_table = stm32_qspi_match,
.pm = &stm32_qspi_pm_ops,
}, },
}; };
module_platform_driver(stm32_qspi_driver); module_platform_driver(stm32_qspi_driver);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment