Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 2 | /* |
| 3 | * (C) Copyright 2013 Xilinx, Inc. |
| 4 | * (C) Copyright 2015 Jagan Teki <jteki@openedev.com> |
| 5 | * |
| 6 | * Xilinx Zynq Quad-SPI(QSPI) controller driver (master mode only) |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 7 | */ |
| 8 | |
T Karthik Reddy | b1f0d3d | 2020-02-04 05:47:45 -0700 | [diff] [blame] | 9 | #include <clk.h> |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 10 | #include <common.h> |
| 11 | #include <dm.h> |
T Karthik Reddy | b1f0d3d | 2020-02-04 05:47:45 -0700 | [diff] [blame] | 12 | #include <dm/device_compat.h> |
Simon Glass | 0f2af88 | 2020-05-10 11:40:05 -0600 | [diff] [blame] | 13 | #include <log.h> |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 14 | #include <malloc.h> |
| 15 | #include <spi.h> |
Simon Glass | 3ba929a | 2020-10-30 21:38:53 -0600 | [diff] [blame] | 16 | #include <asm/global_data.h> |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 17 | #include <asm/io.h> |
Simon Glass | 4dcacfc | 2020-05-10 11:40:13 -0600 | [diff] [blame] | 18 | #include <linux/bitops.h> |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 19 | |
| 20 | DECLARE_GLOBAL_DATA_PTR; |
| 21 | |
| 22 | /* zynq qspi register bit masks ZYNQ_QSPI_<REG>_<BIT>_MASK */ |
Jagan Teki | f94b3f7 | 2015-10-22 20:40:16 +0530 | [diff] [blame] | 23 | #define ZYNQ_QSPI_CR_IFMODE_MASK BIT(31) /* Flash intrface mode*/ |
| 24 | #define ZYNQ_QSPI_CR_MSA_MASK BIT(15) /* Manual start enb */ |
| 25 | #define ZYNQ_QSPI_CR_MCS_MASK BIT(14) /* Manual chip select */ |
| 26 | #define ZYNQ_QSPI_CR_PCS_MASK BIT(10) /* Peri chip select */ |
Jagan Teki | e1af6ae | 2015-10-22 21:06:37 +0530 | [diff] [blame] | 27 | #define ZYNQ_QSPI_CR_FW_MASK GENMASK(7, 6) /* FIFO width */ |
| 28 | #define ZYNQ_QSPI_CR_SS_MASK GENMASK(13, 10) /* Slave Select */ |
| 29 | #define ZYNQ_QSPI_CR_BAUD_MASK GENMASK(5, 3) /* Baud rate div */ |
Jagan Teki | f94b3f7 | 2015-10-22 20:40:16 +0530 | [diff] [blame] | 30 | #define ZYNQ_QSPI_CR_CPHA_MASK BIT(2) /* Clock phase */ |
| 31 | #define ZYNQ_QSPI_CR_CPOL_MASK BIT(1) /* Clock polarity */ |
| 32 | #define ZYNQ_QSPI_CR_MSTREN_MASK BIT(0) /* Mode select */ |
| 33 | #define ZYNQ_QSPI_IXR_RXNEMPTY_MASK BIT(4) /* RX_FIFO_not_empty */ |
| 34 | #define ZYNQ_QSPI_IXR_TXOW_MASK BIT(2) /* TX_FIFO_not_full */ |
Jagan Teki | e1af6ae | 2015-10-22 21:06:37 +0530 | [diff] [blame] | 35 | #define ZYNQ_QSPI_IXR_ALL_MASK GENMASK(6, 0) /* All IXR bits */ |
Jagan Teki | f94b3f7 | 2015-10-22 20:40:16 +0530 | [diff] [blame] | 36 | #define ZYNQ_QSPI_ENR_SPI_EN_MASK BIT(0) /* SPI Enable */ |
Nathan Rossi | b115078 | 2015-12-09 00:44:40 +1000 | [diff] [blame] | 37 | #define ZYNQ_QSPI_LQSPICFG_LQMODE_MASK BIT(31) /* Linear QSPI Mode */ |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 38 | |
| 39 | /* zynq qspi Transmit Data Register */ |
| 40 | #define ZYNQ_QSPI_TXD_00_00_OFFSET 0x1C /* Transmit 4-byte inst */ |
| 41 | #define ZYNQ_QSPI_TXD_00_01_OFFSET 0x80 /* Transmit 1-byte inst */ |
| 42 | #define ZYNQ_QSPI_TXD_00_10_OFFSET 0x84 /* Transmit 2-byte inst */ |
| 43 | #define ZYNQ_QSPI_TXD_00_11_OFFSET 0x88 /* Transmit 3-byte inst */ |
| 44 | |
| 45 | #define ZYNQ_QSPI_TXFIFO_THRESHOLD 1 /* Tx FIFO threshold level*/ |
| 46 | #define ZYNQ_QSPI_RXFIFO_THRESHOLD 32 /* Rx FIFO threshold level */ |
| 47 | |
| 48 | #define ZYNQ_QSPI_CR_BAUD_MAX 8 /* Baud rate divisor max val */ |
| 49 | #define ZYNQ_QSPI_CR_BAUD_SHIFT 3 /* Baud rate divisor shift */ |
| 50 | #define ZYNQ_QSPI_CR_SS_SHIFT 10 /* Slave select shift */ |
| 51 | |
Siva Durga Prasad Paladugu | 4495fd6 | 2022-01-30 22:22:39 -0700 | [diff] [blame^] | 52 | #define ZYNQ_QSPI_MAX_BAUD_RATE 0x7 |
| 53 | #define ZYNQ_QSPI_DEFAULT_BAUD_RATE 0x2 |
| 54 | |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 55 | #define ZYNQ_QSPI_FIFO_DEPTH 63 |
Ashok Reddy Soma | caecfe6 | 2020-05-18 01:11:00 -0600 | [diff] [blame] | 56 | #define ZYNQ_QSPI_WAIT (CONFIG_SYS_HZ / 100) /* 10 ms */ |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 57 | |
| 58 | /* zynq qspi register set */ |
| 59 | struct zynq_qspi_regs { |
| 60 | u32 cr; /* 0x00 */ |
| 61 | u32 isr; /* 0x04 */ |
| 62 | u32 ier; /* 0x08 */ |
| 63 | u32 idr; /* 0x0C */ |
| 64 | u32 imr; /* 0x10 */ |
| 65 | u32 enr; /* 0x14 */ |
| 66 | u32 dr; /* 0x18 */ |
| 67 | u32 txd0r; /* 0x1C */ |
| 68 | u32 drxr; /* 0x20 */ |
| 69 | u32 sicr; /* 0x24 */ |
| 70 | u32 txftr; /* 0x28 */ |
| 71 | u32 rxftr; /* 0x2C */ |
| 72 | u32 gpior; /* 0x30 */ |
| 73 | u32 reserved0[19]; |
| 74 | u32 txd1r; /* 0x80 */ |
| 75 | u32 txd2r; /* 0x84 */ |
| 76 | u32 txd3r; /* 0x88 */ |
Nathan Rossi | b115078 | 2015-12-09 00:44:40 +1000 | [diff] [blame] | 77 | u32 reserved1[5]; |
| 78 | u32 lqspicfg; /* 0xA0 */ |
| 79 | u32 lqspists; /* 0xA4 */ |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 80 | }; |
| 81 | |
| 82 | /* zynq qspi platform data */ |
Simon Glass | b75b15b | 2020-12-03 16:55:23 -0700 | [diff] [blame] | 83 | struct zynq_qspi_plat { |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 84 | struct zynq_qspi_regs *regs; |
| 85 | u32 frequency; /* input frequency */ |
| 86 | u32 speed_hz; |
| 87 | }; |
| 88 | |
| 89 | /* zynq qspi priv */ |
| 90 | struct zynq_qspi_priv { |
| 91 | struct zynq_qspi_regs *regs; |
| 92 | u8 cs; |
| 93 | u8 mode; |
| 94 | u8 fifo_depth; |
| 95 | u32 freq; /* required frequency */ |
| 96 | const void *tx_buf; |
| 97 | void *rx_buf; |
| 98 | unsigned len; |
| 99 | int bytes_to_transfer; |
| 100 | int bytes_to_receive; |
| 101 | unsigned int is_inst; |
| 102 | unsigned cs_change:1; |
| 103 | }; |
| 104 | |
Simon Glass | aad29ae | 2020-12-03 16:55:21 -0700 | [diff] [blame] | 105 | static int zynq_qspi_of_to_plat(struct udevice *bus) |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 106 | { |
Simon Glass | 9558862 | 2020-12-22 19:30:28 -0700 | [diff] [blame] | 107 | struct zynq_qspi_plat *plat = dev_get_plat(bus); |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 108 | const void *blob = gd->fdt_blob; |
Simon Glass | dd79d6e | 2017-01-17 16:52:55 -0700 | [diff] [blame] | 109 | int node = dev_of_offset(bus); |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 110 | |
| 111 | plat->regs = (struct zynq_qspi_regs *)fdtdec_get_addr(blob, |
| 112 | node, "reg"); |
| 113 | |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 114 | return 0; |
| 115 | } |
| 116 | |
Ashok Reddy Soma | 27e770a | 2020-01-28 07:39:04 -0700 | [diff] [blame] | 117 | /** |
| 118 | * zynq_qspi_init_hw - Initialize the hardware |
| 119 | * @priv: Pointer to the zynq_qspi_priv structure |
| 120 | * |
| 121 | * The default settings of the QSPI controller's configurable parameters on |
| 122 | * reset are |
| 123 | * - Master mode |
| 124 | * - Baud rate divisor is set to 2 |
| 125 | * - Threshold value for TX FIFO not full interrupt is set to 1 |
| 126 | * - Flash memory interface mode enabled |
| 127 | * - Size of the word to be transferred as 8 bit |
| 128 | * This function performs the following actions |
| 129 | * - Disable and clear all the interrupts |
| 130 | * - Enable manual slave select |
| 131 | * - Enable auto start |
| 132 | * - Deselect all the chip select lines |
| 133 | * - Set the size of the word to be transferred as 32 bit |
| 134 | * - Set the little endian mode of TX FIFO and |
| 135 | * - Enable the QSPI controller |
| 136 | */ |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 137 | static void zynq_qspi_init_hw(struct zynq_qspi_priv *priv) |
| 138 | { |
| 139 | struct zynq_qspi_regs *regs = priv->regs; |
| 140 | u32 confr; |
| 141 | |
| 142 | /* Disable QSPI */ |
| 143 | writel(~ZYNQ_QSPI_ENR_SPI_EN_MASK, ®s->enr); |
| 144 | |
| 145 | /* Disable Interrupts */ |
| 146 | writel(ZYNQ_QSPI_IXR_ALL_MASK, ®s->idr); |
| 147 | |
| 148 | /* Clear the TX and RX threshold reg */ |
| 149 | writel(ZYNQ_QSPI_TXFIFO_THRESHOLD, ®s->txftr); |
| 150 | writel(ZYNQ_QSPI_RXFIFO_THRESHOLD, ®s->rxftr); |
| 151 | |
| 152 | /* Clear the RX FIFO */ |
| 153 | while (readl(®s->isr) & ZYNQ_QSPI_IXR_RXNEMPTY_MASK) |
| 154 | readl(®s->drxr); |
| 155 | |
| 156 | /* Clear Interrupts */ |
| 157 | writel(ZYNQ_QSPI_IXR_ALL_MASK, ®s->isr); |
| 158 | |
| 159 | /* Manual slave select and Auto start */ |
| 160 | confr = readl(®s->cr); |
| 161 | confr &= ~ZYNQ_QSPI_CR_MSA_MASK; |
| 162 | confr |= ZYNQ_QSPI_CR_IFMODE_MASK | ZYNQ_QSPI_CR_MCS_MASK | |
| 163 | ZYNQ_QSPI_CR_PCS_MASK | ZYNQ_QSPI_CR_FW_MASK | |
| 164 | ZYNQ_QSPI_CR_MSTREN_MASK; |
| 165 | writel(confr, ®s->cr); |
| 166 | |
Nathan Rossi | b115078 | 2015-12-09 00:44:40 +1000 | [diff] [blame] | 167 | /* Disable the LQSPI feature */ |
| 168 | confr = readl(®s->lqspicfg); |
| 169 | confr &= ~ZYNQ_QSPI_LQSPICFG_LQMODE_MASK; |
| 170 | writel(confr, ®s->lqspicfg); |
| 171 | |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 172 | /* Enable SPI */ |
| 173 | writel(ZYNQ_QSPI_ENR_SPI_EN_MASK, ®s->enr); |
| 174 | } |
| 175 | |
| 176 | static int zynq_qspi_probe(struct udevice *bus) |
| 177 | { |
Simon Glass | b75b15b | 2020-12-03 16:55:23 -0700 | [diff] [blame] | 178 | struct zynq_qspi_plat *plat = dev_get_plat(bus); |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 179 | struct zynq_qspi_priv *priv = dev_get_priv(bus); |
T Karthik Reddy | b1f0d3d | 2020-02-04 05:47:45 -0700 | [diff] [blame] | 180 | struct clk clk; |
| 181 | unsigned long clock; |
| 182 | int ret; |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 183 | |
| 184 | priv->regs = plat->regs; |
| 185 | priv->fifo_depth = ZYNQ_QSPI_FIFO_DEPTH; |
| 186 | |
T Karthik Reddy | b1f0d3d | 2020-02-04 05:47:45 -0700 | [diff] [blame] | 187 | ret = clk_get_by_name(bus, "ref_clk", &clk); |
| 188 | if (ret < 0) { |
| 189 | dev_err(bus, "failed to get clock\n"); |
| 190 | return ret; |
| 191 | } |
| 192 | |
| 193 | clock = clk_get_rate(&clk); |
| 194 | if (IS_ERR_VALUE(clock)) { |
| 195 | dev_err(bus, "failed to get rate\n"); |
| 196 | return clock; |
| 197 | } |
| 198 | |
| 199 | ret = clk_enable(&clk); |
Michal Simek | 4171095 | 2021-02-09 15:28:15 +0100 | [diff] [blame] | 200 | if (ret) { |
T Karthik Reddy | b1f0d3d | 2020-02-04 05:47:45 -0700 | [diff] [blame] | 201 | dev_err(bus, "failed to enable clock\n"); |
| 202 | return ret; |
| 203 | } |
| 204 | |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 205 | /* init the zynq spi hw */ |
| 206 | zynq_qspi_init_hw(priv); |
| 207 | |
T Karthik Reddy | b1f0d3d | 2020-02-04 05:47:45 -0700 | [diff] [blame] | 208 | plat->frequency = clock; |
| 209 | plat->speed_hz = plat->frequency / 2; |
| 210 | |
| 211 | debug("%s: max-frequency=%d\n", __func__, plat->speed_hz); |
| 212 | |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 213 | return 0; |
| 214 | } |
| 215 | |
Ashok Reddy Soma | 27e770a | 2020-01-28 07:39:04 -0700 | [diff] [blame] | 216 | /** |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 217 | * zynq_qspi_read_data - Copy data to RX buffer |
Ashok Reddy Soma | 27e770a | 2020-01-28 07:39:04 -0700 | [diff] [blame] | 218 | * @priv: Pointer to the zynq_qspi_priv structure |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 219 | * @data: The 32 bit variable where data is stored |
| 220 | * @size: Number of bytes to be copied from data to RX buffer |
| 221 | */ |
| 222 | static void zynq_qspi_read_data(struct zynq_qspi_priv *priv, u32 data, u8 size) |
| 223 | { |
| 224 | u8 byte3; |
| 225 | |
| 226 | debug("%s: data 0x%04x rx_buf addr: 0x%08x size %d\n", __func__ , |
| 227 | data, (unsigned)(priv->rx_buf), size); |
| 228 | |
| 229 | if (priv->rx_buf) { |
| 230 | switch (size) { |
| 231 | case 1: |
| 232 | *((u8 *)priv->rx_buf) = data; |
| 233 | priv->rx_buf += 1; |
| 234 | break; |
| 235 | case 2: |
Siva Durga Prasad Paladugu | 99844ac | 2022-01-30 22:22:37 -0700 | [diff] [blame] | 236 | *((u8 *)priv->rx_buf) = data; |
| 237 | priv->rx_buf += 1; |
| 238 | *((u8 *)priv->rx_buf) = (u8)(data >> 8); |
| 239 | priv->rx_buf += 1; |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 240 | break; |
| 241 | case 3: |
Siva Durga Prasad Paladugu | 99844ac | 2022-01-30 22:22:37 -0700 | [diff] [blame] | 242 | *((u8 *)priv->rx_buf) = data; |
| 243 | priv->rx_buf += 1; |
| 244 | *((u8 *)priv->rx_buf) = (u8)(data >> 8); |
| 245 | priv->rx_buf += 1; |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 246 | byte3 = (u8)(data >> 16); |
| 247 | *((u8 *)priv->rx_buf) = byte3; |
| 248 | priv->rx_buf += 1; |
| 249 | break; |
| 250 | case 4: |
| 251 | /* Can not assume word aligned buffer */ |
| 252 | memcpy(priv->rx_buf, &data, size); |
| 253 | priv->rx_buf += 4; |
| 254 | break; |
| 255 | default: |
| 256 | /* This will never execute */ |
| 257 | break; |
| 258 | } |
| 259 | } |
| 260 | priv->bytes_to_receive -= size; |
| 261 | if (priv->bytes_to_receive < 0) |
| 262 | priv->bytes_to_receive = 0; |
| 263 | } |
| 264 | |
Ashok Reddy Soma | 27e770a | 2020-01-28 07:39:04 -0700 | [diff] [blame] | 265 | /** |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 266 | * zynq_qspi_write_data - Copy data from TX buffer |
Ashok Reddy Soma | 27e770a | 2020-01-28 07:39:04 -0700 | [diff] [blame] | 267 | * @priv: Pointer to the zynq_qspi_priv structure |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 268 | * @data: Pointer to the 32 bit variable where data is to be copied |
| 269 | * @size: Number of bytes to be copied from TX buffer to data |
| 270 | */ |
| 271 | static void zynq_qspi_write_data(struct zynq_qspi_priv *priv, |
| 272 | u32 *data, u8 size) |
| 273 | { |
| 274 | if (priv->tx_buf) { |
| 275 | switch (size) { |
| 276 | case 1: |
| 277 | *data = *((u8 *)priv->tx_buf); |
| 278 | priv->tx_buf += 1; |
| 279 | *data |= 0xFFFFFF00; |
| 280 | break; |
| 281 | case 2: |
Siva Durga Prasad Paladugu | 5ff1e24 | 2022-01-30 22:22:38 -0700 | [diff] [blame] | 282 | *data = *((u8 *)priv->tx_buf); |
| 283 | priv->tx_buf += 1; |
| 284 | *data |= (*((u8 *)priv->tx_buf) << 8); |
| 285 | priv->tx_buf += 1; |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 286 | *data |= 0xFFFF0000; |
| 287 | break; |
| 288 | case 3: |
Siva Durga Prasad Paladugu | 5ff1e24 | 2022-01-30 22:22:38 -0700 | [diff] [blame] | 289 | *data = *((u8 *)priv->tx_buf); |
| 290 | priv->tx_buf += 1; |
| 291 | *data |= (*((u8 *)priv->tx_buf) << 8); |
| 292 | priv->tx_buf += 1; |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 293 | *data |= (*((u8 *)priv->tx_buf) << 16); |
| 294 | priv->tx_buf += 1; |
| 295 | *data |= 0xFF000000; |
| 296 | break; |
| 297 | case 4: |
| 298 | /* Can not assume word aligned buffer */ |
| 299 | memcpy(data, priv->tx_buf, size); |
| 300 | priv->tx_buf += 4; |
| 301 | break; |
| 302 | default: |
| 303 | /* This will never execute */ |
| 304 | break; |
| 305 | } |
| 306 | } else { |
| 307 | *data = 0; |
| 308 | } |
| 309 | |
| 310 | debug("%s: data 0x%08x tx_buf addr: 0x%08x size %d\n", __func__, |
| 311 | *data, (u32)priv->tx_buf, size); |
| 312 | |
| 313 | priv->bytes_to_transfer -= size; |
| 314 | if (priv->bytes_to_transfer < 0) |
| 315 | priv->bytes_to_transfer = 0; |
| 316 | } |
| 317 | |
Ashok Reddy Soma | 27e770a | 2020-01-28 07:39:04 -0700 | [diff] [blame] | 318 | /** |
| 319 | * zynq_qspi_chipselect - Select or deselect the chip select line |
| 320 | * @priv: Pointer to the zynq_qspi_priv structure |
| 321 | * @is_on: Select(1) or deselect (0) the chip select line |
| 322 | */ |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 323 | static void zynq_qspi_chipselect(struct zynq_qspi_priv *priv, int is_on) |
| 324 | { |
| 325 | u32 confr; |
| 326 | struct zynq_qspi_regs *regs = priv->regs; |
| 327 | |
| 328 | confr = readl(®s->cr); |
| 329 | |
| 330 | if (is_on) { |
| 331 | /* Select the slave */ |
| 332 | confr &= ~ZYNQ_QSPI_CR_SS_MASK; |
| 333 | confr |= (~(1 << priv->cs) << ZYNQ_QSPI_CR_SS_SHIFT) & |
| 334 | ZYNQ_QSPI_CR_SS_MASK; |
| 335 | } else |
| 336 | /* Deselect the slave */ |
| 337 | confr |= ZYNQ_QSPI_CR_SS_MASK; |
| 338 | |
| 339 | writel(confr, ®s->cr); |
| 340 | } |
| 341 | |
Ashok Reddy Soma | 27e770a | 2020-01-28 07:39:04 -0700 | [diff] [blame] | 342 | /** |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 343 | * zynq_qspi_fill_tx_fifo - Fills the TX FIFO with as many bytes as possible |
Ashok Reddy Soma | 27e770a | 2020-01-28 07:39:04 -0700 | [diff] [blame] | 344 | * @priv: Pointer to the zynq_qspi_priv structure |
| 345 | * @size: Number of bytes to be copied to fifo |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 346 | */ |
| 347 | static void zynq_qspi_fill_tx_fifo(struct zynq_qspi_priv *priv, u32 size) |
| 348 | { |
| 349 | u32 data = 0; |
| 350 | u32 fifocount = 0; |
| 351 | unsigned len, offset; |
| 352 | struct zynq_qspi_regs *regs = priv->regs; |
| 353 | static const unsigned offsets[4] = { |
| 354 | ZYNQ_QSPI_TXD_00_00_OFFSET, ZYNQ_QSPI_TXD_00_01_OFFSET, |
| 355 | ZYNQ_QSPI_TXD_00_10_OFFSET, ZYNQ_QSPI_TXD_00_11_OFFSET }; |
| 356 | |
| 357 | while ((fifocount < size) && |
| 358 | (priv->bytes_to_transfer > 0)) { |
| 359 | if (priv->bytes_to_transfer >= 4) { |
| 360 | if (priv->tx_buf) { |
| 361 | memcpy(&data, priv->tx_buf, 4); |
| 362 | priv->tx_buf += 4; |
| 363 | } else { |
| 364 | data = 0; |
| 365 | } |
| 366 | writel(data, ®s->txd0r); |
| 367 | priv->bytes_to_transfer -= 4; |
| 368 | fifocount++; |
| 369 | } else { |
| 370 | /* Write TXD1, TXD2, TXD3 only if TxFIFO is empty. */ |
| 371 | if (!(readl(®s->isr) |
| 372 | & ZYNQ_QSPI_IXR_TXOW_MASK) && |
| 373 | !priv->rx_buf) |
| 374 | return; |
| 375 | len = priv->bytes_to_transfer; |
| 376 | zynq_qspi_write_data(priv, &data, len); |
| 377 | offset = (priv->rx_buf) ? offsets[0] : offsets[len]; |
| 378 | writel(data, ®s->cr + (offset / 4)); |
| 379 | } |
| 380 | } |
| 381 | } |
| 382 | |
Ashok Reddy Soma | 27e770a | 2020-01-28 07:39:04 -0700 | [diff] [blame] | 383 | /** |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 384 | * zynq_qspi_irq_poll - Interrupt service routine of the QSPI controller |
Ashok Reddy Soma | 27e770a | 2020-01-28 07:39:04 -0700 | [diff] [blame] | 385 | * @priv: Pointer to the zynq_qspi structure |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 386 | * |
| 387 | * This function handles TX empty and Mode Fault interrupts only. |
| 388 | * On TX empty interrupt this function reads the received data from RX FIFO and |
| 389 | * fills the TX FIFO if there is any data remaining to be transferred. |
| 390 | * On Mode Fault interrupt this function indicates that transfer is completed, |
| 391 | * the SPI subsystem will identify the error as the remaining bytes to be |
| 392 | * transferred is non-zero. |
| 393 | * |
| 394 | * returns: 0 for poll timeout |
| 395 | * 1 transfer operation complete |
| 396 | */ |
| 397 | static int zynq_qspi_irq_poll(struct zynq_qspi_priv *priv) |
| 398 | { |
| 399 | struct zynq_qspi_regs *regs = priv->regs; |
| 400 | u32 rxindex = 0; |
| 401 | u32 rxcount; |
| 402 | u32 status, timeout; |
| 403 | |
| 404 | /* Poll until any of the interrupt status bits are set */ |
| 405 | timeout = get_timer(0); |
| 406 | do { |
| 407 | status = readl(®s->isr); |
| 408 | } while ((status == 0) && |
Ashok Reddy Soma | caecfe6 | 2020-05-18 01:11:00 -0600 | [diff] [blame] | 409 | (get_timer(timeout) < ZYNQ_QSPI_WAIT)); |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 410 | |
| 411 | if (status == 0) { |
| 412 | printf("zynq_qspi_irq_poll: Timeout!\n"); |
| 413 | return -ETIMEDOUT; |
| 414 | } |
| 415 | |
| 416 | writel(status, ®s->isr); |
| 417 | |
| 418 | /* Disable all interrupts */ |
| 419 | writel(ZYNQ_QSPI_IXR_ALL_MASK, ®s->idr); |
| 420 | if ((status & ZYNQ_QSPI_IXR_TXOW_MASK) || |
| 421 | (status & ZYNQ_QSPI_IXR_RXNEMPTY_MASK)) { |
| 422 | /* |
| 423 | * This bit is set when Tx FIFO has < THRESHOLD entries. We have |
| 424 | * the THRESHOLD value set to 1, so this bit indicates Tx FIFO |
| 425 | * is empty |
| 426 | */ |
| 427 | rxcount = priv->bytes_to_receive - priv->bytes_to_transfer; |
| 428 | rxcount = (rxcount % 4) ? ((rxcount/4)+1) : (rxcount/4); |
| 429 | while ((rxindex < rxcount) && |
| 430 | (rxindex < ZYNQ_QSPI_RXFIFO_THRESHOLD)) { |
| 431 | /* Read out the data from the RX FIFO */ |
| 432 | u32 data; |
| 433 | data = readl(®s->drxr); |
| 434 | |
| 435 | if (priv->bytes_to_receive >= 4) { |
| 436 | if (priv->rx_buf) { |
| 437 | memcpy(priv->rx_buf, &data, 4); |
| 438 | priv->rx_buf += 4; |
| 439 | } |
| 440 | priv->bytes_to_receive -= 4; |
| 441 | } else { |
| 442 | zynq_qspi_read_data(priv, data, |
| 443 | priv->bytes_to_receive); |
| 444 | } |
| 445 | rxindex++; |
| 446 | } |
| 447 | |
| 448 | if (priv->bytes_to_transfer) { |
| 449 | /* There is more data to send */ |
| 450 | zynq_qspi_fill_tx_fifo(priv, |
| 451 | ZYNQ_QSPI_RXFIFO_THRESHOLD); |
| 452 | |
| 453 | writel(ZYNQ_QSPI_IXR_ALL_MASK, ®s->ier); |
| 454 | } else { |
| 455 | /* |
| 456 | * If transfer and receive is completed then only send |
| 457 | * complete signal |
| 458 | */ |
| 459 | if (!priv->bytes_to_receive) { |
| 460 | /* return operation complete */ |
| 461 | writel(ZYNQ_QSPI_IXR_ALL_MASK, |
| 462 | ®s->idr); |
| 463 | return 1; |
| 464 | } |
| 465 | } |
| 466 | } |
| 467 | |
| 468 | return 0; |
| 469 | } |
| 470 | |
Ashok Reddy Soma | 27e770a | 2020-01-28 07:39:04 -0700 | [diff] [blame] | 471 | /** |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 472 | * zynq_qspi_start_transfer - Initiates the QSPI transfer |
Ashok Reddy Soma | 27e770a | 2020-01-28 07:39:04 -0700 | [diff] [blame] | 473 | * @priv: Pointer to the zynq_qspi_priv structure |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 474 | * |
| 475 | * This function fills the TX FIFO, starts the QSPI transfer, and waits for the |
| 476 | * transfer to be completed. |
| 477 | * |
| 478 | * returns: Number of bytes transferred in the last transfer |
| 479 | */ |
| 480 | static int zynq_qspi_start_transfer(struct zynq_qspi_priv *priv) |
| 481 | { |
| 482 | u32 data = 0; |
| 483 | struct zynq_qspi_regs *regs = priv->regs; |
| 484 | |
| 485 | debug("%s: qspi: 0x%08x transfer: 0x%08x len: %d\n", __func__, |
| 486 | (u32)priv, (u32)priv, priv->len); |
| 487 | |
| 488 | priv->bytes_to_transfer = priv->len; |
| 489 | priv->bytes_to_receive = priv->len; |
| 490 | |
| 491 | if (priv->len < 4) |
| 492 | zynq_qspi_fill_tx_fifo(priv, priv->len); |
| 493 | else |
| 494 | zynq_qspi_fill_tx_fifo(priv, priv->fifo_depth); |
| 495 | |
| 496 | writel(ZYNQ_QSPI_IXR_ALL_MASK, ®s->ier); |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 497 | |
| 498 | /* wait for completion */ |
| 499 | do { |
| 500 | data = zynq_qspi_irq_poll(priv); |
| 501 | } while (data == 0); |
| 502 | |
| 503 | return (priv->len) - (priv->bytes_to_transfer); |
| 504 | } |
| 505 | |
| 506 | static int zynq_qspi_transfer(struct zynq_qspi_priv *priv) |
| 507 | { |
| 508 | unsigned cs_change = 1; |
| 509 | int status = 0; |
| 510 | |
| 511 | while (1) { |
| 512 | /* Select the chip if required */ |
| 513 | if (cs_change) |
| 514 | zynq_qspi_chipselect(priv, 1); |
| 515 | |
| 516 | cs_change = priv->cs_change; |
| 517 | |
| 518 | if (!priv->tx_buf && !priv->rx_buf && priv->len) { |
| 519 | status = -1; |
| 520 | break; |
| 521 | } |
| 522 | |
| 523 | /* Request the transfer */ |
| 524 | if (priv->len) { |
| 525 | status = zynq_qspi_start_transfer(priv); |
| 526 | priv->is_inst = 0; |
| 527 | } |
| 528 | |
| 529 | if (status != priv->len) { |
| 530 | if (status > 0) |
| 531 | status = -EMSGSIZE; |
| 532 | debug("zynq_qspi_transfer:%d len:%d\n", |
| 533 | status, priv->len); |
| 534 | break; |
| 535 | } |
| 536 | status = 0; |
| 537 | |
| 538 | if (cs_change) |
| 539 | /* Deselect the chip */ |
| 540 | zynq_qspi_chipselect(priv, 0); |
| 541 | |
| 542 | break; |
| 543 | } |
| 544 | |
Vipul Kumar | 72cf0c9 | 2018-06-25 14:13:57 +0530 | [diff] [blame] | 545 | return status; |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 546 | } |
| 547 | |
| 548 | static int zynq_qspi_claim_bus(struct udevice *dev) |
| 549 | { |
| 550 | struct udevice *bus = dev->parent; |
| 551 | struct zynq_qspi_priv *priv = dev_get_priv(bus); |
| 552 | struct zynq_qspi_regs *regs = priv->regs; |
| 553 | |
| 554 | writel(ZYNQ_QSPI_ENR_SPI_EN_MASK, ®s->enr); |
| 555 | |
| 556 | return 0; |
| 557 | } |
| 558 | |
| 559 | static int zynq_qspi_release_bus(struct udevice *dev) |
| 560 | { |
| 561 | struct udevice *bus = dev->parent; |
| 562 | struct zynq_qspi_priv *priv = dev_get_priv(bus); |
| 563 | struct zynq_qspi_regs *regs = priv->regs; |
| 564 | |
| 565 | writel(~ZYNQ_QSPI_ENR_SPI_EN_MASK, ®s->enr); |
| 566 | |
| 567 | return 0; |
| 568 | } |
| 569 | |
| 570 | static int zynq_qspi_xfer(struct udevice *dev, unsigned int bitlen, |
| 571 | const void *dout, void *din, unsigned long flags) |
| 572 | { |
| 573 | struct udevice *bus = dev->parent; |
| 574 | struct zynq_qspi_priv *priv = dev_get_priv(bus); |
Simon Glass | b75b15b | 2020-12-03 16:55:23 -0700 | [diff] [blame] | 575 | struct dm_spi_slave_plat *slave_plat = dev_get_parent_plat(dev); |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 576 | |
| 577 | priv->cs = slave_plat->cs; |
| 578 | priv->tx_buf = dout; |
| 579 | priv->rx_buf = din; |
| 580 | priv->len = bitlen / 8; |
| 581 | |
Jagan Teki | cc7ae3d | 2015-10-25 09:31:54 +0530 | [diff] [blame] | 582 | debug("zynq_qspi_xfer: bus:%i cs:%i bitlen:%i len:%i flags:%lx\n", |
Simon Glass | 75e534b | 2020-12-16 21:20:07 -0700 | [diff] [blame] | 583 | dev_seq(bus), slave_plat->cs, bitlen, priv->len, flags); |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 584 | |
| 585 | /* |
| 586 | * Festering sore. |
| 587 | * Assume that the beginning of a transfer with bits to |
| 588 | * transmit must contain a device command. |
| 589 | */ |
| 590 | if (dout && flags & SPI_XFER_BEGIN) |
| 591 | priv->is_inst = 1; |
| 592 | else |
| 593 | priv->is_inst = 0; |
| 594 | |
| 595 | if (flags & SPI_XFER_END) |
| 596 | priv->cs_change = 1; |
| 597 | else |
| 598 | priv->cs_change = 0; |
| 599 | |
| 600 | zynq_qspi_transfer(priv); |
| 601 | |
| 602 | return 0; |
| 603 | } |
| 604 | |
| 605 | static int zynq_qspi_set_speed(struct udevice *bus, uint speed) |
| 606 | { |
Simon Glass | 9558862 | 2020-12-22 19:30:28 -0700 | [diff] [blame] | 607 | struct zynq_qspi_plat *plat = dev_get_plat(bus); |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 608 | struct zynq_qspi_priv *priv = dev_get_priv(bus); |
| 609 | struct zynq_qspi_regs *regs = priv->regs; |
| 610 | uint32_t confr; |
| 611 | u8 baud_rate_val = 0; |
| 612 | |
| 613 | if (speed > plat->frequency) |
| 614 | speed = plat->frequency; |
| 615 | |
| 616 | /* Set the clock frequency */ |
| 617 | confr = readl(®s->cr); |
| 618 | if (speed == 0) { |
| 619 | /* Set baudrate x8, if the freq is 0 */ |
| 620 | baud_rate_val = 0x2; |
| 621 | } else if (plat->speed_hz != speed) { |
| 622 | while ((baud_rate_val < ZYNQ_QSPI_CR_BAUD_MAX) && |
| 623 | ((plat->frequency / |
| 624 | (2 << baud_rate_val)) > speed)) |
| 625 | baud_rate_val++; |
| 626 | |
Siva Durga Prasad Paladugu | 4495fd6 | 2022-01-30 22:22:39 -0700 | [diff] [blame^] | 627 | if (baud_rate_val > ZYNQ_QSPI_MAX_BAUD_RATE) |
| 628 | baud_rate_val = ZYNQ_QSPI_DEFAULT_BAUD_RATE; |
| 629 | |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 630 | plat->speed_hz = speed / (2 << baud_rate_val); |
| 631 | } |
| 632 | confr &= ~ZYNQ_QSPI_CR_BAUD_MASK; |
| 633 | confr |= (baud_rate_val << ZYNQ_QSPI_CR_BAUD_SHIFT); |
| 634 | |
| 635 | writel(confr, ®s->cr); |
| 636 | priv->freq = speed; |
| 637 | |
Jagan Teki | cc7ae3d | 2015-10-25 09:31:54 +0530 | [diff] [blame] | 638 | debug("%s: regs=%p, speed=%d\n", __func__, priv->regs, priv->freq); |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 639 | |
| 640 | return 0; |
| 641 | } |
| 642 | |
| 643 | static int zynq_qspi_set_mode(struct udevice *bus, uint mode) |
| 644 | { |
| 645 | struct zynq_qspi_priv *priv = dev_get_priv(bus); |
| 646 | struct zynq_qspi_regs *regs = priv->regs; |
| 647 | uint32_t confr; |
| 648 | |
| 649 | /* Set the SPI Clock phase and polarities */ |
| 650 | confr = readl(®s->cr); |
| 651 | confr &= ~(ZYNQ_QSPI_CR_CPHA_MASK | ZYNQ_QSPI_CR_CPOL_MASK); |
| 652 | |
Jagan Teki | c27f1c1 | 2015-09-08 01:39:44 +0530 | [diff] [blame] | 653 | if (mode & SPI_CPHA) |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 654 | confr |= ZYNQ_QSPI_CR_CPHA_MASK; |
Jagan Teki | c27f1c1 | 2015-09-08 01:39:44 +0530 | [diff] [blame] | 655 | if (mode & SPI_CPOL) |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 656 | confr |= ZYNQ_QSPI_CR_CPOL_MASK; |
| 657 | |
| 658 | writel(confr, ®s->cr); |
| 659 | priv->mode = mode; |
| 660 | |
Jagan Teki | cc7ae3d | 2015-10-25 09:31:54 +0530 | [diff] [blame] | 661 | debug("%s: regs=%p, mode=%d\n", __func__, priv->regs, priv->mode); |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 662 | |
| 663 | return 0; |
| 664 | } |
| 665 | |
| 666 | static const struct dm_spi_ops zynq_qspi_ops = { |
| 667 | .claim_bus = zynq_qspi_claim_bus, |
| 668 | .release_bus = zynq_qspi_release_bus, |
| 669 | .xfer = zynq_qspi_xfer, |
| 670 | .set_speed = zynq_qspi_set_speed, |
| 671 | .set_mode = zynq_qspi_set_mode, |
| 672 | }; |
| 673 | |
| 674 | static const struct udevice_id zynq_qspi_ids[] = { |
| 675 | { .compatible = "xlnx,zynq-qspi-1.0" }, |
| 676 | { } |
| 677 | }; |
| 678 | |
| 679 | U_BOOT_DRIVER(zynq_qspi) = { |
| 680 | .name = "zynq_qspi", |
| 681 | .id = UCLASS_SPI, |
| 682 | .of_match = zynq_qspi_ids, |
| 683 | .ops = &zynq_qspi_ops, |
Simon Glass | aad29ae | 2020-12-03 16:55:21 -0700 | [diff] [blame] | 684 | .of_to_plat = zynq_qspi_of_to_plat, |
Simon Glass | b75b15b | 2020-12-03 16:55:23 -0700 | [diff] [blame] | 685 | .plat_auto = sizeof(struct zynq_qspi_plat), |
Simon Glass | 8a2b47f | 2020-12-03 16:55:17 -0700 | [diff] [blame] | 686 | .priv_auto = sizeof(struct zynq_qspi_priv), |
Jagan Teki | 7fbea8a | 2015-08-17 18:38:06 +0530 | [diff] [blame] | 687 | .probe = zynq_qspi_probe, |
| 688 | }; |