| From 0f7364cc3351aa1d9be5bee917f3566cb9635c9a Mon Sep 17 00:00:00 2001 |
| From: Sasha Levin <sashal@kernel.org> |
| Date: Fri, 24 Apr 2020 14:12:16 +0800 |
| Subject: spi: spi-fsl-dspi: Adding shutdown hook |
| |
| From: Peng Ma <peng.ma@nxp.com> |
| |
| [ Upstream commit dc234825997ec6ff05980ca9e2204f4ac3f8d695 ] |
| |
| We need to ensure dspi controller could be stopped in order for kexec |
| to start the next kernel. |
| So add the shutdown operation support. |
| |
| Signed-off-by: Peng Ma <peng.ma@nxp.com> |
| Link: https://lore.kernel.org/r/20200424061216.27445-1-peng.ma@nxp.com |
| Signed-off-by: Mark Brown <broonie@kernel.org> |
| Signed-off-by: Sasha Levin <sashal@kernel.org> |
| --- |
| drivers/spi/spi-fsl-dspi.c | 23 +++++++++++++++++++++++ |
| 1 file changed, 23 insertions(+) |
| |
| diff --git a/drivers/spi/spi-fsl-dspi.c b/drivers/spi/spi-fsl-dspi.c |
| index 9a06818d28169..e34278a00b708 100644 |
| --- a/drivers/spi/spi-fsl-dspi.c |
| +++ b/drivers/spi/spi-fsl-dspi.c |
| @@ -1,6 +1,7 @@ |
| // SPDX-License-Identifier: GPL-2.0+ |
| // |
| // Copyright 2013 Freescale Semiconductor, Inc. |
| +// Copyright 2020 NXP |
| // |
| // Freescale DSPI driver |
| // This file contains a driver for the Freescale DSPI |
| @@ -33,6 +34,9 @@ |
| #define SPI_MCR_CLR_TXF BIT(11) |
| #define SPI_MCR_CLR_RXF BIT(10) |
| #define SPI_MCR_XSPI BIT(3) |
| +#define SPI_MCR_DIS_TXF BIT(13) |
| +#define SPI_MCR_DIS_RXF BIT(12) |
| +#define SPI_MCR_HALT BIT(0) |
| |
| #define SPI_TCR 0x08 |
| #define SPI_TCR_GET_TCNT(x) (((x) & GENMASK(31, 16)) >> 16) |
| @@ -1169,6 +1173,24 @@ static int dspi_remove(struct platform_device *pdev) |
| return 0; |
| } |
| |
| +static void dspi_shutdown(struct platform_device *pdev) |
| +{ |
| + struct spi_controller *ctlr = platform_get_drvdata(pdev); |
| + struct fsl_dspi *dspi = spi_controller_get_devdata(ctlr); |
| + |
| + /* Disable RX and TX */ |
| + regmap_update_bits(dspi->regmap, SPI_MCR, |
| + SPI_MCR_DIS_TXF | SPI_MCR_DIS_RXF, |
| + SPI_MCR_DIS_TXF | SPI_MCR_DIS_RXF); |
| + |
| + /* Stop Running */ |
| + regmap_update_bits(dspi->regmap, SPI_MCR, SPI_MCR_HALT, SPI_MCR_HALT); |
| + |
| + dspi_release_dma(dspi); |
| + clk_disable_unprepare(dspi->clk); |
| + spi_unregister_controller(dspi->ctlr); |
| +} |
| + |
| static struct platform_driver fsl_dspi_driver = { |
| .driver.name = DRIVER_NAME, |
| .driver.of_match_table = fsl_dspi_dt_ids, |
| @@ -1176,6 +1198,7 @@ static struct platform_driver fsl_dspi_driver = { |
| .driver.pm = &dspi_pm, |
| .probe = dspi_probe, |
| .remove = dspi_remove, |
| + .shutdown = dspi_shutdown, |
| }; |
| module_platform_driver(fsl_dspi_driver); |
| |
| -- |
| 2.25.1 |
| |