Commit d575c9b7 authored by Miquel Raynal's avatar Miquel Raynal Committed by Mark Brown

spi: zynq-qspi: Support two chip selects

The Zynq QSPI controller features 2 CS. When the num-cs DT property
is set to 2, the hardware will be initialized to support having two
devices connected over each CS.

In this case, both CS lines are driven by the state of the U_PAGE
(upper page) bit. When unset, the lower page (CS0) is selected,
otherwise it is the upper page (CS1).

Change tested on a custom design featuring two SPI-NORs with different
CS on the Zynq-7000 QSPI bus.
Signed-off-by: default avatarMiquel Raynal <miquel.raynal@bootlin.com>
Link: https://lore.kernel.org/r/20191108140744.1734-8-miquel.raynal@bootlin.comSigned-off-by: default avatarMark Brown <broonie@kernel.org>
parent 8f16292d
...@@ -114,8 +114,8 @@ ...@@ -114,8 +114,8 @@
*/ */
#define ZYNQ_QSPI_MODEBITS (SPI_CPOL | SPI_CPHA) #define ZYNQ_QSPI_MODEBITS (SPI_CPOL | SPI_CPHA)
/* Default number of chip selects */ /* Maximum number of chip selects */
#define ZYNQ_QSPI_DEFAULT_NUM_CS 1 #define ZYNQ_QSPI_MAX_NUM_CS 2
/** /**
* struct zynq_qspi - Defines qspi driver instance * struct zynq_qspi - Defines qspi driver instance
...@@ -159,6 +159,7 @@ static inline void zynq_qspi_write(struct zynq_qspi *xqspi, u32 offset, ...@@ -159,6 +159,7 @@ static inline void zynq_qspi_write(struct zynq_qspi *xqspi, u32 offset,
/** /**
* zynq_qspi_init_hw - Initialize the hardware * zynq_qspi_init_hw - Initialize the hardware
* @xqspi: Pointer to the zynq_qspi structure * @xqspi: Pointer to the zynq_qspi structure
* @num_cs: Number of connected CS (to enable dual memories if needed)
* *
* The default settings of the QSPI controller's configurable parameters on * The default settings of the QSPI controller's configurable parameters on
* reset are * reset are
...@@ -176,7 +177,7 @@ static inline void zynq_qspi_write(struct zynq_qspi *xqspi, u32 offset, ...@@ -176,7 +177,7 @@ static inline void zynq_qspi_write(struct zynq_qspi *xqspi, u32 offset,
* - Set the little endian mode of TX FIFO and * - Set the little endian mode of TX FIFO and
* - Enable the QSPI controller * - Enable the QSPI controller
*/ */
static void zynq_qspi_init_hw(struct zynq_qspi *xqspi) static void zynq_qspi_init_hw(struct zynq_qspi *xqspi, unsigned int num_cs)
{ {
u32 config_reg; u32 config_reg;
...@@ -184,7 +185,12 @@ static void zynq_qspi_init_hw(struct zynq_qspi *xqspi) ...@@ -184,7 +185,12 @@ static void zynq_qspi_init_hw(struct zynq_qspi *xqspi)
zynq_qspi_write(xqspi, ZYNQ_QSPI_IDIS_OFFSET, ZYNQ_QSPI_IXR_ALL_MASK); zynq_qspi_write(xqspi, ZYNQ_QSPI_IDIS_OFFSET, ZYNQ_QSPI_IXR_ALL_MASK);
/* Disable linear mode as the boot loader may have used it */ /* Disable linear mode as the boot loader may have used it */
zynq_qspi_write(xqspi, ZYNQ_QSPI_LINEAR_CFG_OFFSET, 0); config_reg = 0;
/* At the same time, enable dual mode if more than 1 CS is available */
if (num_cs > 1)
config_reg |= ZYNQ_QSPI_LCFG_TWO_MEM;
zynq_qspi_write(xqspi, ZYNQ_QSPI_LINEAR_CFG_OFFSET, config_reg);
/* Clear the RX FIFO */ /* Clear the RX FIFO */
while (zynq_qspi_read(xqspi, ZYNQ_QSPI_STATUS_OFFSET) & while (zynq_qspi_read(xqspi, ZYNQ_QSPI_STATUS_OFFSET) &
...@@ -286,6 +292,17 @@ static void zynq_qspi_chipselect(struct spi_device *spi, bool assert) ...@@ -286,6 +292,17 @@ static void zynq_qspi_chipselect(struct spi_device *spi, bool assert)
struct zynq_qspi *xqspi = spi_controller_get_devdata(ctlr); struct zynq_qspi *xqspi = spi_controller_get_devdata(ctlr);
u32 config_reg; u32 config_reg;
/* Select the lower (CS0) or upper (CS1) memory */
if (ctlr->num_chipselect > 1) {
config_reg = zynq_qspi_read(xqspi, ZYNQ_QSPI_LINEAR_CFG_OFFSET);
if (!spi->chip_select)
config_reg &= ~ZYNQ_QSPI_LCFG_U_PAGE;
else
config_reg |= ZYNQ_QSPI_LCFG_U_PAGE;
zynq_qspi_write(xqspi, ZYNQ_QSPI_LINEAR_CFG_OFFSET, config_reg);
}
/* Ground the line to assert the CS */ /* Ground the line to assert the CS */
config_reg = zynq_qspi_read(xqspi, ZYNQ_QSPI_CONFIG_OFFSET); config_reg = zynq_qspi_read(xqspi, ZYNQ_QSPI_CONFIG_OFFSET);
if (assert) if (assert)
...@@ -673,9 +690,9 @@ static int zynq_qspi_probe(struct platform_device *pdev) ...@@ -673,9 +690,9 @@ static int zynq_qspi_probe(struct platform_device *pdev)
ret = of_property_read_u32(np, "num-cs", ret = of_property_read_u32(np, "num-cs",
&num_cs); &num_cs);
if (ret < 0) { if (ret < 0) {
ctlr->num_chipselect = ZYNQ_QSPI_DEFAULT_NUM_CS; ctlr->num_chipselect = 1;
} else if (num_cs > ZYNQ_QSPI_DEFAULT_NUM_CS) { } else if (num_cs > ZYNQ_QSPI_MAX_NUM_CS) {
dev_err(&pdev->dev, "anything but CS0 is not yet supported\n"); dev_err(&pdev->dev, "only 2 chip selects are available\n");
goto remove_master; goto remove_master;
} else { } else {
ctlr->num_chipselect = num_cs; ctlr->num_chipselect = num_cs;
...@@ -689,7 +706,7 @@ static int zynq_qspi_probe(struct platform_device *pdev) ...@@ -689,7 +706,7 @@ static int zynq_qspi_probe(struct platform_device *pdev)
ctlr->dev.of_node = np; ctlr->dev.of_node = np;
/* QSPI controller initializations */ /* QSPI controller initializations */
zynq_qspi_init_hw(xqspi); zynq_qspi_init_hw(xqspi, ctlr->num_chipselect);
ret = devm_spi_register_controller(&pdev->dev, ctlr); ret = devm_spi_register_controller(&pdev->dev, ctlr);
if (ret) { if (ret) {
......
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