Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 2 | /* |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 3 | * Copyright 2013-2015 Freescale Semiconductor, Inc. |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 4 | * |
| 5 | * Freescale Quad Serial Peripheral Interface (QSPI) driver |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 6 | */ |
| 7 | |
| 8 | #include <common.h> |
| 9 | #include <malloc.h> |
| 10 | #include <spi.h> |
| 11 | #include <asm/io.h> |
| 12 | #include <linux/sizes.h> |
Thomas Schaefer | f751d85 | 2019-07-01 17:37:35 +0200 | [diff] [blame] | 13 | #include <linux/iopoll.h> |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 14 | #include <dm.h> |
| 15 | #include <errno.h> |
Alexander Stein | 9b2c8a9 | 2015-11-04 09:19:10 +0100 | [diff] [blame] | 16 | #include <watchdog.h> |
Suresh Gupta | 4945b87 | 2017-08-30 20:06:33 +0530 | [diff] [blame] | 17 | #include <wait_bit.h> |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 18 | #include "fsl_qspi.h" |
| 19 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 20 | DECLARE_GLOBAL_DATA_PTR; |
| 21 | |
Gong Qianyu | 44f65f8 | 2015-12-14 18:26:25 +0800 | [diff] [blame] | 22 | #define OFFSET_BITS_MASK GENMASK(23, 0) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 23 | |
| 24 | #define FLASH_STATUS_WEL 0x02 |
| 25 | |
| 26 | /* SEQID */ |
| 27 | #define SEQID_WREN 1 |
| 28 | #define SEQID_FAST_READ 2 |
| 29 | #define SEQID_RDSR 3 |
| 30 | #define SEQID_SE 4 |
| 31 | #define SEQID_CHIP_ERASE 5 |
| 32 | #define SEQID_PP 6 |
| 33 | #define SEQID_RDID 7 |
Peng Fan | 3642a87 | 2014-12-31 11:01:39 +0800 | [diff] [blame] | 34 | #define SEQID_BE_4K 8 |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 35 | #ifdef CONFIG_SPI_FLASH_BAR |
| 36 | #define SEQID_BRRD 9 |
| 37 | #define SEQID_BRWR 10 |
| 38 | #define SEQID_RDEAR 11 |
| 39 | #define SEQID_WREAR 12 |
| 40 | #endif |
Yuan Yao | d719326 | 2016-03-15 14:36:42 +0800 | [diff] [blame] | 41 | #define SEQID_WRAR 13 |
| 42 | #define SEQID_RDAR 14 |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 43 | |
Peng Fan | ff16234 | 2014-12-31 11:01:36 +0800 | [diff] [blame] | 44 | /* QSPI CMD */ |
| 45 | #define QSPI_CMD_PP 0x02 /* Page program (up to 256 bytes) */ |
| 46 | #define QSPI_CMD_RDSR 0x05 /* Read status register */ |
| 47 | #define QSPI_CMD_WREN 0x06 /* Write enable */ |
| 48 | #define QSPI_CMD_FAST_READ 0x0b /* Read data bytes (high frequency) */ |
Peng Fan | 3642a87 | 2014-12-31 11:01:39 +0800 | [diff] [blame] | 49 | #define QSPI_CMD_BE_4K 0x20 /* 4K erase */ |
Peng Fan | ff16234 | 2014-12-31 11:01:36 +0800 | [diff] [blame] | 50 | #define QSPI_CMD_CHIP_ERASE 0xc7 /* Erase whole flash chip */ |
| 51 | #define QSPI_CMD_SE 0xd8 /* Sector erase (usually 64KiB) */ |
| 52 | #define QSPI_CMD_RDID 0x9f /* Read JEDEC ID */ |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 53 | |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 54 | /* Used for Micron, winbond and Macronix flashes */ |
| 55 | #define QSPI_CMD_WREAR 0xc5 /* EAR register write */ |
| 56 | #define QSPI_CMD_RDEAR 0xc8 /* EAR reigster read */ |
| 57 | |
| 58 | /* Used for Spansion flashes only. */ |
| 59 | #define QSPI_CMD_BRRD 0x16 /* Bank register read */ |
| 60 | #define QSPI_CMD_BRWR 0x17 /* Bank register write */ |
| 61 | |
Yuan Yao | d719326 | 2016-03-15 14:36:42 +0800 | [diff] [blame] | 62 | /* Used for Spansion S25FS-S family flash only. */ |
| 63 | #define QSPI_CMD_RDAR 0x65 /* Read any device register */ |
| 64 | #define QSPI_CMD_WRAR 0x71 /* Write any device register */ |
| 65 | |
Peng Fan | ff16234 | 2014-12-31 11:01:36 +0800 | [diff] [blame] | 66 | /* 4-byte address QSPI CMD - used on Spansion and some Macronix flashes */ |
| 67 | #define QSPI_CMD_FAST_READ_4B 0x0c /* Read data bytes (high frequency) */ |
| 68 | #define QSPI_CMD_PP_4B 0x12 /* Page program (up to 256 bytes) */ |
| 69 | #define QSPI_CMD_SE_4B 0xdc /* Sector erase (usually 64KiB) */ |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 70 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 71 | /* fsl_qspi_platdata flags */ |
Jagan Teki | c97ca92 | 2015-10-23 01:37:18 +0530 | [diff] [blame] | 72 | #define QSPI_FLAG_REGMAP_ENDIAN_BIG BIT(0) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 73 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 74 | /* default SCK frequency, unit: HZ */ |
| 75 | #define FSL_QSPI_DEFAULT_SCK_FREQ 50000000 |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 76 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 77 | /* QSPI max chipselect signals number */ |
| 78 | #define FSL_QSPI_MAX_CHIPSELECT_NUM 4 |
| 79 | |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 80 | /* Controller needs driver to swap endian */ |
| 81 | #define QUADSPI_QUIRK_SWAP_ENDIAN BIT(0) |
| 82 | |
| 83 | enum fsl_qspi_devtype { |
| 84 | FSL_QUADSPI_VYBRID, |
| 85 | FSL_QUADSPI_IMX6SX, |
| 86 | FSL_QUADSPI_IMX6UL_7D, |
Ye Li | 57f6775 | 2019-08-14 11:31:40 +0000 | [diff] [blame] | 87 | FSL_QUADSPI_IMX7ULP, |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 88 | }; |
| 89 | |
| 90 | struct fsl_qspi_devtype_data { |
| 91 | enum fsl_qspi_devtype devtype; |
| 92 | u32 rxfifo; |
| 93 | u32 txfifo; |
| 94 | u32 ahb_buf_size; |
| 95 | u32 driver_data; |
| 96 | }; |
| 97 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 98 | /** |
| 99 | * struct fsl_qspi_platdata - platform data for Freescale QSPI |
| 100 | * |
| 101 | * @flags: Flags for QSPI QSPI_FLAG_... |
| 102 | * @speed_hz: Default SCK frequency |
| 103 | * @reg_base: Base address of QSPI registers |
| 104 | * @amba_base: Base address of QSPI memory mapping |
| 105 | * @amba_total_size: size of QSPI memory mapping |
| 106 | * @flash_num: Number of active slave devices |
| 107 | * @num_chipselect: Number of QSPI chipselect signals |
| 108 | */ |
| 109 | struct fsl_qspi_platdata { |
| 110 | u32 flags; |
| 111 | u32 speed_hz; |
Yuan Yao | ae41239 | 2016-03-15 14:36:40 +0800 | [diff] [blame] | 112 | fdt_addr_t reg_base; |
| 113 | fdt_addr_t amba_base; |
| 114 | fdt_size_t amba_total_size; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 115 | u32 flash_num; |
| 116 | u32 num_chipselect; |
| 117 | }; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 118 | |
| 119 | /** |
| 120 | * struct fsl_qspi_priv - private data for Freescale QSPI |
| 121 | * |
| 122 | * @flags: Flags for QSPI QSPI_FLAG_... |
| 123 | * @bus_clk: QSPI input clk frequency |
| 124 | * @speed_hz: Default SCK frequency |
| 125 | * @cur_seqid: current LUT table sequence id |
| 126 | * @sf_addr: flash access offset |
| 127 | * @amba_base: Base address of QSPI memory mapping of every CS |
| 128 | * @amba_total_size: size of QSPI memory mapping |
| 129 | * @cur_amba_base: Base address of QSPI memory mapping of current CS |
| 130 | * @flash_num: Number of active slave devices |
| 131 | * @num_chipselect: Number of QSPI chipselect signals |
| 132 | * @regs: Point to QSPI register structure for I/O access |
| 133 | */ |
| 134 | struct fsl_qspi_priv { |
| 135 | u32 flags; |
| 136 | u32 bus_clk; |
| 137 | u32 speed_hz; |
| 138 | u32 cur_seqid; |
| 139 | u32 sf_addr; |
| 140 | u32 amba_base[FSL_QSPI_MAX_CHIPSELECT_NUM]; |
| 141 | u32 amba_total_size; |
| 142 | u32 cur_amba_base; |
| 143 | u32 flash_num; |
| 144 | u32 num_chipselect; |
| 145 | struct fsl_qspi_regs *regs; |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 146 | struct fsl_qspi_devtype_data *devtype_data; |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 147 | }; |
| 148 | |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 149 | static const struct fsl_qspi_devtype_data vybrid_data = { |
| 150 | .devtype = FSL_QUADSPI_VYBRID, |
| 151 | .rxfifo = 128, |
| 152 | .txfifo = 64, |
| 153 | .ahb_buf_size = 1024, |
| 154 | .driver_data = QUADSPI_QUIRK_SWAP_ENDIAN, |
| 155 | }; |
| 156 | |
| 157 | static const struct fsl_qspi_devtype_data imx6sx_data = { |
| 158 | .devtype = FSL_QUADSPI_IMX6SX, |
| 159 | .rxfifo = 128, |
| 160 | .txfifo = 512, |
| 161 | .ahb_buf_size = 1024, |
| 162 | .driver_data = 0, |
| 163 | }; |
| 164 | |
| 165 | static const struct fsl_qspi_devtype_data imx6ul_7d_data = { |
| 166 | .devtype = FSL_QUADSPI_IMX6UL_7D, |
| 167 | .rxfifo = 128, |
| 168 | .txfifo = 512, |
| 169 | .ahb_buf_size = 1024, |
| 170 | .driver_data = 0, |
| 171 | }; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 172 | |
Ye Li | 57f6775 | 2019-08-14 11:31:40 +0000 | [diff] [blame] | 173 | static const struct fsl_qspi_devtype_data imx7ulp_data = { |
| 174 | .devtype = FSL_QUADSPI_IMX7ULP, |
| 175 | .rxfifo = 64, |
| 176 | .txfifo = 64, |
| 177 | .ahb_buf_size = 128, |
| 178 | .driver_data = 0, |
| 179 | }; |
| 180 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 181 | static u32 qspi_read32(u32 flags, u32 *addr) |
| 182 | { |
| 183 | return flags & QSPI_FLAG_REGMAP_ENDIAN_BIG ? |
| 184 | in_be32(addr) : in_le32(addr); |
| 185 | } |
| 186 | |
| 187 | static void qspi_write32(u32 flags, u32 *addr, u32 val) |
| 188 | { |
| 189 | flags & QSPI_FLAG_REGMAP_ENDIAN_BIG ? |
| 190 | out_be32(addr, val) : out_le32(addr, val); |
| 191 | } |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 192 | |
Rajat Srivastava | 234daec | 2018-03-22 13:30:55 +0530 | [diff] [blame] | 193 | static inline int is_controller_busy(const struct fsl_qspi_priv *priv) |
| 194 | { |
| 195 | u32 val; |
Thomas Schaefer | f751d85 | 2019-07-01 17:37:35 +0200 | [diff] [blame] | 196 | u32 mask = QSPI_SR_BUSY_MASK | QSPI_SR_AHB_ACC_MASK | |
| 197 | QSPI_SR_IP_ACC_MASK; |
Rajat Srivastava | 234daec | 2018-03-22 13:30:55 +0530 | [diff] [blame] | 198 | |
Thomas Schaefer | f751d85 | 2019-07-01 17:37:35 +0200 | [diff] [blame] | 199 | if (priv->flags & QSPI_FLAG_REGMAP_ENDIAN_BIG) |
| 200 | mask = (u32)cpu_to_be32(mask); |
Rajat Srivastava | 234daec | 2018-03-22 13:30:55 +0530 | [diff] [blame] | 201 | |
Thomas Schaefer | f751d85 | 2019-07-01 17:37:35 +0200 | [diff] [blame] | 202 | return readl_poll_timeout(&priv->regs->sr, val, !(val & mask), 1000); |
Rajat Srivastava | 234daec | 2018-03-22 13:30:55 +0530 | [diff] [blame] | 203 | } |
| 204 | |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 205 | /* QSPI support swapping the flash read/write data |
| 206 | * in hardware for LS102xA, but not for VF610 */ |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 207 | static inline u32 qspi_endian_xchg(struct fsl_qspi_priv *priv, u32 data) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 208 | { |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 209 | if (priv->devtype_data->driver_data & QUADSPI_QUIRK_SWAP_ENDIAN) |
| 210 | return swab32(data); |
| 211 | else |
| 212 | return data; |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 213 | } |
| 214 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 215 | static void qspi_set_lut(struct fsl_qspi_priv *priv) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 216 | { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 217 | struct fsl_qspi_regs *regs = priv->regs; |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 218 | u32 lut_base; |
| 219 | |
| 220 | /* Unlock the LUT */ |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 221 | qspi_write32(priv->flags, ®s->lutkey, LUT_KEY_VALUE); |
| 222 | qspi_write32(priv->flags, ®s->lckcr, QSPI_LCKCR_UNLOCK); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 223 | |
| 224 | /* Write Enable */ |
| 225 | lut_base = SEQID_WREN * 4; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 226 | qspi_write32(priv->flags, ®s->lut[lut_base], OPRND0(QSPI_CMD_WREN) | |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 227 | PAD0(LUT_PAD1) | INSTR0(LUT_CMD)); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 228 | qspi_write32(priv->flags, ®s->lut[lut_base + 1], 0); |
| 229 | qspi_write32(priv->flags, ®s->lut[lut_base + 2], 0); |
| 230 | qspi_write32(priv->flags, ®s->lut[lut_base + 3], 0); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 231 | |
| 232 | /* Fast Read */ |
| 233 | lut_base = SEQID_FAST_READ * 4; |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 234 | #ifdef CONFIG_SPI_FLASH_BAR |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 235 | qspi_write32(priv->flags, ®s->lut[lut_base], |
| 236 | OPRND0(QSPI_CMD_FAST_READ) | PAD0(LUT_PAD1) | |
| 237 | INSTR0(LUT_CMD) | OPRND1(ADDR24BIT) | |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 238 | PAD1(LUT_PAD1) | INSTR1(LUT_ADDR)); |
| 239 | #else |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 240 | if (FSL_QSPI_FLASH_SIZE <= SZ_16M) |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 241 | qspi_write32(priv->flags, ®s->lut[lut_base], |
| 242 | OPRND0(QSPI_CMD_FAST_READ) | PAD0(LUT_PAD1) | |
| 243 | INSTR0(LUT_CMD) | OPRND1(ADDR24BIT) | |
| 244 | PAD1(LUT_PAD1) | INSTR1(LUT_ADDR)); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 245 | else |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 246 | qspi_write32(priv->flags, ®s->lut[lut_base], |
Peng Fan | ff16234 | 2014-12-31 11:01:36 +0800 | [diff] [blame] | 247 | OPRND0(QSPI_CMD_FAST_READ_4B) | |
| 248 | PAD0(LUT_PAD1) | INSTR0(LUT_CMD) | |
| 249 | OPRND1(ADDR32BIT) | PAD1(LUT_PAD1) | |
| 250 | INSTR1(LUT_ADDR)); |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 251 | #endif |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 252 | qspi_write32(priv->flags, ®s->lut[lut_base + 1], |
| 253 | OPRND0(8) | PAD0(LUT_PAD1) | INSTR0(LUT_DUMMY) | |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 254 | OPRND1(priv->devtype_data->rxfifo) | PAD1(LUT_PAD1) | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 255 | INSTR1(LUT_READ)); |
| 256 | qspi_write32(priv->flags, ®s->lut[lut_base + 2], 0); |
| 257 | qspi_write32(priv->flags, ®s->lut[lut_base + 3], 0); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 258 | |
| 259 | /* Read Status */ |
| 260 | lut_base = SEQID_RDSR * 4; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 261 | qspi_write32(priv->flags, ®s->lut[lut_base], OPRND0(QSPI_CMD_RDSR) | |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 262 | PAD0(LUT_PAD1) | INSTR0(LUT_CMD) | OPRND1(1) | |
| 263 | PAD1(LUT_PAD1) | INSTR1(LUT_READ)); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 264 | qspi_write32(priv->flags, ®s->lut[lut_base + 1], 0); |
| 265 | qspi_write32(priv->flags, ®s->lut[lut_base + 2], 0); |
| 266 | qspi_write32(priv->flags, ®s->lut[lut_base + 3], 0); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 267 | |
| 268 | /* Erase a sector */ |
| 269 | lut_base = SEQID_SE * 4; |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 270 | #ifdef CONFIG_SPI_FLASH_BAR |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 271 | qspi_write32(priv->flags, ®s->lut[lut_base], OPRND0(QSPI_CMD_SE) | |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 272 | PAD0(LUT_PAD1) | INSTR0(LUT_CMD) | OPRND1(ADDR24BIT) | |
| 273 | PAD1(LUT_PAD1) | INSTR1(LUT_ADDR)); |
| 274 | #else |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 275 | if (FSL_QSPI_FLASH_SIZE <= SZ_16M) |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 276 | qspi_write32(priv->flags, ®s->lut[lut_base], |
| 277 | OPRND0(QSPI_CMD_SE) | PAD0(LUT_PAD1) | |
| 278 | INSTR0(LUT_CMD) | OPRND1(ADDR24BIT) | |
| 279 | PAD1(LUT_PAD1) | INSTR1(LUT_ADDR)); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 280 | else |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 281 | qspi_write32(priv->flags, ®s->lut[lut_base], |
| 282 | OPRND0(QSPI_CMD_SE_4B) | PAD0(LUT_PAD1) | |
| 283 | INSTR0(LUT_CMD) | OPRND1(ADDR32BIT) | |
| 284 | PAD1(LUT_PAD1) | INSTR1(LUT_ADDR)); |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 285 | #endif |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 286 | qspi_write32(priv->flags, ®s->lut[lut_base + 1], 0); |
| 287 | qspi_write32(priv->flags, ®s->lut[lut_base + 2], 0); |
| 288 | qspi_write32(priv->flags, ®s->lut[lut_base + 3], 0); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 289 | |
| 290 | /* Erase the whole chip */ |
| 291 | lut_base = SEQID_CHIP_ERASE * 4; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 292 | qspi_write32(priv->flags, ®s->lut[lut_base], |
| 293 | OPRND0(QSPI_CMD_CHIP_ERASE) | |
| 294 | PAD0(LUT_PAD1) | INSTR0(LUT_CMD)); |
| 295 | qspi_write32(priv->flags, ®s->lut[lut_base + 1], 0); |
| 296 | qspi_write32(priv->flags, ®s->lut[lut_base + 2], 0); |
| 297 | qspi_write32(priv->flags, ®s->lut[lut_base + 3], 0); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 298 | |
| 299 | /* Page Program */ |
| 300 | lut_base = SEQID_PP * 4; |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 301 | #ifdef CONFIG_SPI_FLASH_BAR |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 302 | qspi_write32(priv->flags, ®s->lut[lut_base], OPRND0(QSPI_CMD_PP) | |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 303 | PAD0(LUT_PAD1) | INSTR0(LUT_CMD) | OPRND1(ADDR24BIT) | |
| 304 | PAD1(LUT_PAD1) | INSTR1(LUT_ADDR)); |
| 305 | #else |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 306 | if (FSL_QSPI_FLASH_SIZE <= SZ_16M) |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 307 | qspi_write32(priv->flags, ®s->lut[lut_base], |
| 308 | OPRND0(QSPI_CMD_PP) | PAD0(LUT_PAD1) | |
| 309 | INSTR0(LUT_CMD) | OPRND1(ADDR24BIT) | |
| 310 | PAD1(LUT_PAD1) | INSTR1(LUT_ADDR)); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 311 | else |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 312 | qspi_write32(priv->flags, ®s->lut[lut_base], |
| 313 | OPRND0(QSPI_CMD_PP_4B) | PAD0(LUT_PAD1) | |
| 314 | INSTR0(LUT_CMD) | OPRND1(ADDR32BIT) | |
| 315 | PAD1(LUT_PAD1) | INSTR1(LUT_ADDR)); |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 316 | #endif |
Ye Li | ce561f5 | 2019-08-14 11:31:31 +0000 | [diff] [blame] | 317 | /* Use IDATSZ in IPCR to determine the size and here set 0. */ |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 318 | qspi_write32(priv->flags, ®s->lut[lut_base + 1], OPRND0(0) | |
Peng Fan | 828e468 | 2014-12-31 11:01:38 +0800 | [diff] [blame] | 319 | PAD0(LUT_PAD1) | INSTR0(LUT_WRITE)); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 320 | qspi_write32(priv->flags, ®s->lut[lut_base + 2], 0); |
| 321 | qspi_write32(priv->flags, ®s->lut[lut_base + 3], 0); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 322 | |
| 323 | /* READ ID */ |
| 324 | lut_base = SEQID_RDID * 4; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 325 | qspi_write32(priv->flags, ®s->lut[lut_base], OPRND0(QSPI_CMD_RDID) | |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 326 | PAD0(LUT_PAD1) | INSTR0(LUT_CMD) | OPRND1(8) | |
| 327 | PAD1(LUT_PAD1) | INSTR1(LUT_READ)); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 328 | qspi_write32(priv->flags, ®s->lut[lut_base + 1], 0); |
| 329 | qspi_write32(priv->flags, ®s->lut[lut_base + 2], 0); |
| 330 | qspi_write32(priv->flags, ®s->lut[lut_base + 3], 0); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 331 | |
Peng Fan | 3642a87 | 2014-12-31 11:01:39 +0800 | [diff] [blame] | 332 | /* SUB SECTOR 4K ERASE */ |
| 333 | lut_base = SEQID_BE_4K * 4; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 334 | qspi_write32(priv->flags, ®s->lut[lut_base], OPRND0(QSPI_CMD_BE_4K) | |
Peng Fan | 3642a87 | 2014-12-31 11:01:39 +0800 | [diff] [blame] | 335 | PAD0(LUT_PAD1) | INSTR0(LUT_CMD) | OPRND1(ADDR24BIT) | |
| 336 | PAD1(LUT_PAD1) | INSTR1(LUT_ADDR)); |
| 337 | |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 338 | #ifdef CONFIG_SPI_FLASH_BAR |
| 339 | /* |
| 340 | * BRRD BRWR RDEAR WREAR are all supported, because it is hard to |
| 341 | * dynamically check whether to set BRRD BRWR or RDEAR WREAR during |
| 342 | * initialization. |
| 343 | */ |
| 344 | lut_base = SEQID_BRRD * 4; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 345 | qspi_write32(priv->flags, ®s->lut[lut_base], OPRND0(QSPI_CMD_BRRD) | |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 346 | PAD0(LUT_PAD1) | INSTR0(LUT_CMD) | OPRND1(1) | |
| 347 | PAD1(LUT_PAD1) | INSTR1(LUT_READ)); |
| 348 | |
| 349 | lut_base = SEQID_BRWR * 4; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 350 | qspi_write32(priv->flags, ®s->lut[lut_base], OPRND0(QSPI_CMD_BRWR) | |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 351 | PAD0(LUT_PAD1) | INSTR0(LUT_CMD) | OPRND1(1) | |
| 352 | PAD1(LUT_PAD1) | INSTR1(LUT_WRITE)); |
| 353 | |
| 354 | lut_base = SEQID_RDEAR * 4; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 355 | qspi_write32(priv->flags, ®s->lut[lut_base], OPRND0(QSPI_CMD_RDEAR) | |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 356 | PAD0(LUT_PAD1) | INSTR0(LUT_CMD) | OPRND1(1) | |
| 357 | PAD1(LUT_PAD1) | INSTR1(LUT_READ)); |
| 358 | |
| 359 | lut_base = SEQID_WREAR * 4; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 360 | qspi_write32(priv->flags, ®s->lut[lut_base], OPRND0(QSPI_CMD_WREAR) | |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 361 | PAD0(LUT_PAD1) | INSTR0(LUT_CMD) | OPRND1(1) | |
| 362 | PAD1(LUT_PAD1) | INSTR1(LUT_WRITE)); |
| 363 | #endif |
Yuan Yao | d719326 | 2016-03-15 14:36:42 +0800 | [diff] [blame] | 364 | |
| 365 | /* |
| 366 | * Read any device register. |
| 367 | * Used for Spansion S25FS-S family flash only. |
| 368 | */ |
| 369 | lut_base = SEQID_RDAR * 4; |
| 370 | qspi_write32(priv->flags, ®s->lut[lut_base], |
| 371 | OPRND0(QSPI_CMD_RDAR) | PAD0(LUT_PAD1) | |
| 372 | INSTR0(LUT_CMD) | OPRND1(ADDR24BIT) | |
| 373 | PAD1(LUT_PAD1) | INSTR1(LUT_ADDR)); |
| 374 | qspi_write32(priv->flags, ®s->lut[lut_base + 1], |
| 375 | OPRND0(8) | PAD0(LUT_PAD1) | INSTR0(LUT_DUMMY) | |
| 376 | OPRND1(1) | PAD1(LUT_PAD1) | |
| 377 | INSTR1(LUT_READ)); |
| 378 | |
| 379 | /* |
| 380 | * Write any device register. |
| 381 | * Used for Spansion S25FS-S family flash only. |
| 382 | */ |
| 383 | lut_base = SEQID_WRAR * 4; |
| 384 | qspi_write32(priv->flags, ®s->lut[lut_base], |
| 385 | OPRND0(QSPI_CMD_WRAR) | PAD0(LUT_PAD1) | |
| 386 | INSTR0(LUT_CMD) | OPRND1(ADDR24BIT) | |
| 387 | PAD1(LUT_PAD1) | INSTR1(LUT_ADDR)); |
| 388 | qspi_write32(priv->flags, ®s->lut[lut_base + 1], |
| 389 | OPRND0(1) | PAD0(LUT_PAD1) | INSTR0(LUT_WRITE)); |
| 390 | |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 391 | /* Lock the LUT */ |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 392 | qspi_write32(priv->flags, ®s->lutkey, LUT_KEY_VALUE); |
| 393 | qspi_write32(priv->flags, ®s->lckcr, QSPI_LCKCR_LOCK); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 394 | } |
| 395 | |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 396 | #if defined(CONFIG_SYS_FSL_QSPI_AHB) |
| 397 | /* |
| 398 | * If we have changed the content of the flash by writing or erasing, |
| 399 | * we need to invalidate the AHB buffer. If we do not do so, we may read out |
| 400 | * the wrong data. The spec tells us reset the AHB domain and Serial Flash |
| 401 | * domain at the same time. |
| 402 | */ |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 403 | static inline void qspi_ahb_invalid(struct fsl_qspi_priv *priv) |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 404 | { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 405 | struct fsl_qspi_regs *regs = priv->regs; |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 406 | u32 reg; |
| 407 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 408 | reg = qspi_read32(priv->flags, ®s->mcr); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 409 | reg |= QSPI_MCR_SWRSTHD_MASK | QSPI_MCR_SWRSTSD_MASK; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 410 | qspi_write32(priv->flags, ®s->mcr, reg); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 411 | |
| 412 | /* |
| 413 | * The minimum delay : 1 AHB + 2 SFCK clocks. |
| 414 | * Delay 1 us is enough. |
| 415 | */ |
| 416 | udelay(1); |
| 417 | |
| 418 | reg &= ~(QSPI_MCR_SWRSTHD_MASK | QSPI_MCR_SWRSTSD_MASK); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 419 | qspi_write32(priv->flags, ®s->mcr, reg); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 420 | } |
| 421 | |
| 422 | /* Read out the data from the AHB buffer. */ |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 423 | static inline void qspi_ahb_read(struct fsl_qspi_priv *priv, u8 *rxbuf, int len) |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 424 | { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 425 | struct fsl_qspi_regs *regs = priv->regs; |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 426 | u32 mcr_reg; |
Heinrich Schuchardt | 950e75d | 2018-03-18 12:47:20 +0100 | [diff] [blame] | 427 | void *rx_addr; |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 428 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 429 | mcr_reg = qspi_read32(priv->flags, ®s->mcr); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 430 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 431 | qspi_write32(priv->flags, ®s->mcr, |
| 432 | QSPI_MCR_CLR_RXF_MASK | QSPI_MCR_CLR_TXF_MASK | |
Ye Li | 416d2ec | 2019-08-14 11:31:27 +0000 | [diff] [blame] | 433 | mcr_reg); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 434 | |
Yunhui Cui | e4584cc | 2016-07-13 10:46:27 +0800 | [diff] [blame] | 435 | rx_addr = (void *)(uintptr_t)(priv->cur_amba_base + priv->sf_addr); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 436 | /* Read out the data directly from the AHB buffer. */ |
Yunhui Cui | e4584cc | 2016-07-13 10:46:27 +0800 | [diff] [blame] | 437 | memcpy(rxbuf, rx_addr, len); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 438 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 439 | qspi_write32(priv->flags, ®s->mcr, mcr_reg); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 440 | } |
| 441 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 442 | static void qspi_enable_ddr_mode(struct fsl_qspi_priv *priv) |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 443 | { |
| 444 | u32 reg, reg2; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 445 | struct fsl_qspi_regs *regs = priv->regs; |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 446 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 447 | reg = qspi_read32(priv->flags, ®s->mcr); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 448 | /* Disable the module */ |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 449 | qspi_write32(priv->flags, ®s->mcr, reg | QSPI_MCR_MDIS_MASK); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 450 | |
| 451 | /* Set the Sampling Register for DDR */ |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 452 | reg2 = qspi_read32(priv->flags, ®s->smpr); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 453 | reg2 &= ~QSPI_SMPR_DDRSMP_MASK; |
| 454 | reg2 |= (2 << QSPI_SMPR_DDRSMP_SHIFT); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 455 | qspi_write32(priv->flags, ®s->smpr, reg2); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 456 | |
| 457 | /* Enable the module again (enable the DDR too) */ |
| 458 | reg |= QSPI_MCR_DDR_EN_MASK; |
| 459 | /* Enable bit 29 for imx6sx */ |
Jagan Teki | c97ca92 | 2015-10-23 01:37:18 +0530 | [diff] [blame] | 460 | reg |= BIT(29); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 461 | qspi_write32(priv->flags, ®s->mcr, reg); |
Ye Li | 416d2ec | 2019-08-14 11:31:27 +0000 | [diff] [blame] | 462 | |
| 463 | /* Enable the TDH to 1 for some platforms like imx6ul, imx7d, etc |
| 464 | * These two bits are reserved on other platforms |
| 465 | */ |
| 466 | reg = qspi_read32(priv->flags, ®s->flshcr); |
| 467 | reg &= ~(BIT(17)); |
| 468 | reg |= BIT(16); |
| 469 | qspi_write32(priv->flags, ®s->flshcr, reg); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 470 | } |
| 471 | |
| 472 | /* |
| 473 | * There are two different ways to read out the data from the flash: |
| 474 | * the "IP Command Read" and the "AHB Command Read". |
| 475 | * |
| 476 | * The IC guy suggests we use the "AHB Command Read" which is faster |
| 477 | * then the "IP Command Read". (What's more is that there is a bug in |
| 478 | * the "IP Command Read" in the Vybrid.) |
| 479 | * |
| 480 | * After we set up the registers for the "AHB Command Read", we can use |
| 481 | * the memcpy to read the data directly. A "missed" access to the buffer |
| 482 | * causes the controller to clear the buffer, and use the sequence pointed |
| 483 | * by the QUADSPI_BFGENCR[SEQID] to initiate a read from the flash. |
| 484 | */ |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 485 | static void qspi_init_ahb_read(struct fsl_qspi_priv *priv) |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 486 | { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 487 | struct fsl_qspi_regs *regs = priv->regs; |
| 488 | |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 489 | /* AHB configuration for access buffer 0/1/2 .*/ |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 490 | qspi_write32(priv->flags, ®s->buf0cr, QSPI_BUFXCR_INVALID_MSTRID); |
| 491 | qspi_write32(priv->flags, ®s->buf1cr, QSPI_BUFXCR_INVALID_MSTRID); |
| 492 | qspi_write32(priv->flags, ®s->buf2cr, QSPI_BUFXCR_INVALID_MSTRID); |
| 493 | qspi_write32(priv->flags, ®s->buf3cr, QSPI_BUF3CR_ALLMST_MASK | |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 494 | ((priv->devtype_data->ahb_buf_size >> 3) << QSPI_BUF3CR_ADATSZ_SHIFT)); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 495 | |
| 496 | /* We only use the buffer3 */ |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 497 | qspi_write32(priv->flags, ®s->buf0ind, 0); |
| 498 | qspi_write32(priv->flags, ®s->buf1ind, 0); |
| 499 | qspi_write32(priv->flags, ®s->buf2ind, 0); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 500 | |
| 501 | /* |
| 502 | * Set the default lut sequence for AHB Read. |
| 503 | * Parallel mode is disabled. |
| 504 | */ |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 505 | qspi_write32(priv->flags, ®s->bfgencr, |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 506 | SEQID_FAST_READ << QSPI_BFGENCR_SEQID_SHIFT); |
| 507 | |
| 508 | /*Enable DDR Mode*/ |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 509 | qspi_enable_ddr_mode(priv); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 510 | } |
| 511 | #endif |
| 512 | |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 513 | #ifdef CONFIG_SPI_FLASH_BAR |
| 514 | /* Bank register read/write, EAR register read/write */ |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 515 | static void qspi_op_rdbank(struct fsl_qspi_priv *priv, u8 *rxbuf, u32 len) |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 516 | { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 517 | struct fsl_qspi_regs *regs = priv->regs; |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 518 | u32 reg, mcr_reg, data, seqid; |
| 519 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 520 | mcr_reg = qspi_read32(priv->flags, ®s->mcr); |
| 521 | qspi_write32(priv->flags, ®s->mcr, |
| 522 | QSPI_MCR_CLR_RXF_MASK | QSPI_MCR_CLR_TXF_MASK | |
Ye Li | 416d2ec | 2019-08-14 11:31:27 +0000 | [diff] [blame] | 523 | mcr_reg); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 524 | qspi_write32(priv->flags, ®s->rbct, QSPI_RBCT_RXBRD_USEIPS); |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 525 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 526 | qspi_write32(priv->flags, ®s->sfar, priv->cur_amba_base); |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 527 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 528 | if (priv->cur_seqid == QSPI_CMD_BRRD) |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 529 | seqid = SEQID_BRRD; |
| 530 | else |
| 531 | seqid = SEQID_RDEAR; |
| 532 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 533 | qspi_write32(priv->flags, ®s->ipcr, |
| 534 | (seqid << QSPI_IPCR_SEQID_SHIFT) | len); |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 535 | |
| 536 | /* Wait previous command complete */ |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 537 | while (qspi_read32(priv->flags, ®s->sr) & QSPI_SR_BUSY_MASK) |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 538 | ; |
| 539 | |
| 540 | while (1) { |
Alexander Stein | 283eb4a | 2017-06-01 09:32:19 +0200 | [diff] [blame] | 541 | WATCHDOG_RESET(); |
| 542 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 543 | reg = qspi_read32(priv->flags, ®s->rbsr); |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 544 | if (reg & QSPI_RBSR_RDBFL_MASK) { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 545 | data = qspi_read32(priv->flags, ®s->rbdr[0]); |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 546 | data = qspi_endian_xchg(priv, data); |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 547 | memcpy(rxbuf, &data, len); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 548 | qspi_write32(priv->flags, ®s->mcr, |
| 549 | qspi_read32(priv->flags, ®s->mcr) | |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 550 | QSPI_MCR_CLR_RXF_MASK); |
| 551 | break; |
| 552 | } |
| 553 | } |
| 554 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 555 | qspi_write32(priv->flags, ®s->mcr, mcr_reg); |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 556 | } |
| 557 | #endif |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 558 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 559 | static void qspi_op_rdid(struct fsl_qspi_priv *priv, u32 *rxbuf, u32 len) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 560 | { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 561 | struct fsl_qspi_regs *regs = priv->regs; |
Gong Qianyu | a5357ca | 2016-01-26 15:06:40 +0800 | [diff] [blame] | 562 | u32 mcr_reg, rbsr_reg, data, size; |
| 563 | int i; |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 564 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 565 | mcr_reg = qspi_read32(priv->flags, ®s->mcr); |
| 566 | qspi_write32(priv->flags, ®s->mcr, |
| 567 | QSPI_MCR_CLR_RXF_MASK | QSPI_MCR_CLR_TXF_MASK | |
Ye Li | 416d2ec | 2019-08-14 11:31:27 +0000 | [diff] [blame] | 568 | mcr_reg); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 569 | qspi_write32(priv->flags, ®s->rbct, QSPI_RBCT_RXBRD_USEIPS); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 570 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 571 | qspi_write32(priv->flags, ®s->sfar, priv->cur_amba_base); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 572 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 573 | qspi_write32(priv->flags, ®s->ipcr, |
| 574 | (SEQID_RDID << QSPI_IPCR_SEQID_SHIFT) | 0); |
| 575 | while (qspi_read32(priv->flags, ®s->sr) & QSPI_SR_BUSY_MASK) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 576 | ; |
| 577 | |
| 578 | i = 0; |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 579 | while ((priv->devtype_data->rxfifo >= len) && (len > 0)) { |
Alexander Stein | 283eb4a | 2017-06-01 09:32:19 +0200 | [diff] [blame] | 580 | WATCHDOG_RESET(); |
| 581 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 582 | rbsr_reg = qspi_read32(priv->flags, ®s->rbsr); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 583 | if (rbsr_reg & QSPI_RBSR_RDBFL_MASK) { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 584 | data = qspi_read32(priv->flags, ®s->rbdr[i]); |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 585 | data = qspi_endian_xchg(priv, data); |
Gong Qianyu | a5357ca | 2016-01-26 15:06:40 +0800 | [diff] [blame] | 586 | size = (len < 4) ? len : 4; |
| 587 | memcpy(rxbuf, &data, size); |
| 588 | len -= size; |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 589 | rxbuf++; |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 590 | i++; |
| 591 | } |
| 592 | } |
| 593 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 594 | qspi_write32(priv->flags, ®s->mcr, mcr_reg); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 595 | } |
| 596 | |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 597 | /* If not use AHB read, read data from ip interface */ |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 598 | static void qspi_op_read(struct fsl_qspi_priv *priv, u32 *rxbuf, u32 len) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 599 | { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 600 | struct fsl_qspi_regs *regs = priv->regs; |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 601 | u32 mcr_reg, data; |
| 602 | int i, size; |
| 603 | u32 to_or_from; |
Yuan Yao | d719326 | 2016-03-15 14:36:42 +0800 | [diff] [blame] | 604 | u32 seqid; |
| 605 | |
| 606 | if (priv->cur_seqid == QSPI_CMD_RDAR) |
| 607 | seqid = SEQID_RDAR; |
| 608 | else |
| 609 | seqid = SEQID_FAST_READ; |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 610 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 611 | mcr_reg = qspi_read32(priv->flags, ®s->mcr); |
| 612 | qspi_write32(priv->flags, ®s->mcr, |
| 613 | QSPI_MCR_CLR_RXF_MASK | QSPI_MCR_CLR_TXF_MASK | |
Ye Li | 416d2ec | 2019-08-14 11:31:27 +0000 | [diff] [blame] | 614 | mcr_reg); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 615 | qspi_write32(priv->flags, ®s->rbct, QSPI_RBCT_RXBRD_USEIPS); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 616 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 617 | to_or_from = priv->sf_addr + priv->cur_amba_base; |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 618 | |
| 619 | while (len > 0) { |
Alexander Stein | 9b2c8a9 | 2015-11-04 09:19:10 +0100 | [diff] [blame] | 620 | WATCHDOG_RESET(); |
| 621 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 622 | qspi_write32(priv->flags, ®s->sfar, to_or_from); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 623 | |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 624 | size = (len > priv->devtype_data->rxfifo) ? |
| 625 | priv->devtype_data->rxfifo : len; |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 626 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 627 | qspi_write32(priv->flags, ®s->ipcr, |
Yuan Yao | d719326 | 2016-03-15 14:36:42 +0800 | [diff] [blame] | 628 | (seqid << QSPI_IPCR_SEQID_SHIFT) | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 629 | size); |
| 630 | while (qspi_read32(priv->flags, ®s->sr) & QSPI_SR_BUSY_MASK) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 631 | ; |
| 632 | |
| 633 | to_or_from += size; |
| 634 | len -= size; |
| 635 | |
| 636 | i = 0; |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 637 | while ((priv->devtype_data->rxfifo >= size) && (size > 0)) { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 638 | data = qspi_read32(priv->flags, ®s->rbdr[i]); |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 639 | data = qspi_endian_xchg(priv, data); |
Yuan Yao | d719326 | 2016-03-15 14:36:42 +0800 | [diff] [blame] | 640 | if (size < 4) |
| 641 | memcpy(rxbuf, &data, size); |
| 642 | else |
| 643 | memcpy(rxbuf, &data, 4); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 644 | rxbuf++; |
| 645 | size -= 4; |
| 646 | i++; |
| 647 | } |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 648 | qspi_write32(priv->flags, ®s->mcr, |
| 649 | qspi_read32(priv->flags, ®s->mcr) | |
| 650 | QSPI_MCR_CLR_RXF_MASK); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 651 | } |
| 652 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 653 | qspi_write32(priv->flags, ®s->mcr, mcr_reg); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 654 | } |
| 655 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 656 | static void qspi_op_write(struct fsl_qspi_priv *priv, u8 *txbuf, u32 len) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 657 | { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 658 | struct fsl_qspi_regs *regs = priv->regs; |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 659 | u32 mcr_reg, data, reg, status_reg, seqid; |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 660 | int i, size, tx_size; |
| 661 | u32 to_or_from = 0; |
| 662 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 663 | mcr_reg = qspi_read32(priv->flags, ®s->mcr); |
| 664 | qspi_write32(priv->flags, ®s->mcr, |
| 665 | QSPI_MCR_CLR_RXF_MASK | QSPI_MCR_CLR_TXF_MASK | |
Ye Li | 416d2ec | 2019-08-14 11:31:27 +0000 | [diff] [blame] | 666 | mcr_reg); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 667 | qspi_write32(priv->flags, ®s->rbct, QSPI_RBCT_RXBRD_USEIPS); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 668 | |
| 669 | status_reg = 0; |
| 670 | while ((status_reg & FLASH_STATUS_WEL) != FLASH_STATUS_WEL) { |
Alexander Stein | 9b2c8a9 | 2015-11-04 09:19:10 +0100 | [diff] [blame] | 671 | WATCHDOG_RESET(); |
| 672 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 673 | qspi_write32(priv->flags, ®s->ipcr, |
| 674 | (SEQID_WREN << QSPI_IPCR_SEQID_SHIFT) | 0); |
| 675 | while (qspi_read32(priv->flags, ®s->sr) & QSPI_SR_BUSY_MASK) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 676 | ; |
| 677 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 678 | qspi_write32(priv->flags, ®s->ipcr, |
| 679 | (SEQID_RDSR << QSPI_IPCR_SEQID_SHIFT) | 1); |
| 680 | while (qspi_read32(priv->flags, ®s->sr) & QSPI_SR_BUSY_MASK) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 681 | ; |
| 682 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 683 | reg = qspi_read32(priv->flags, ®s->rbsr); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 684 | if (reg & QSPI_RBSR_RDBFL_MASK) { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 685 | status_reg = qspi_read32(priv->flags, ®s->rbdr[0]); |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 686 | status_reg = qspi_endian_xchg(priv, status_reg); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 687 | } |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 688 | qspi_write32(priv->flags, ®s->mcr, |
| 689 | qspi_read32(priv->flags, ®s->mcr) | |
| 690 | QSPI_MCR_CLR_RXF_MASK); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 691 | } |
| 692 | |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 693 | /* Default is page programming */ |
| 694 | seqid = SEQID_PP; |
Yuan Yao | d719326 | 2016-03-15 14:36:42 +0800 | [diff] [blame] | 695 | if (priv->cur_seqid == QSPI_CMD_WRAR) |
| 696 | seqid = SEQID_WRAR; |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 697 | #ifdef CONFIG_SPI_FLASH_BAR |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 698 | if (priv->cur_seqid == QSPI_CMD_BRWR) |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 699 | seqid = SEQID_BRWR; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 700 | else if (priv->cur_seqid == QSPI_CMD_WREAR) |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 701 | seqid = SEQID_WREAR; |
| 702 | #endif |
| 703 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 704 | to_or_from = priv->sf_addr + priv->cur_amba_base; |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 705 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 706 | qspi_write32(priv->flags, ®s->sfar, to_or_from); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 707 | |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 708 | tx_size = (len > priv->devtype_data->txfifo) ? |
| 709 | priv->devtype_data->txfifo : len; |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 710 | |
Suresh Gupta | 14ae0f9 | 2017-06-05 14:37:20 +0530 | [diff] [blame] | 711 | size = tx_size / 16; |
| 712 | /* |
| 713 | * There must be atleast 128bit data |
| 714 | * available in TX FIFO for any pop operation |
| 715 | */ |
| 716 | if (tx_size % 16) |
| 717 | size++; |
| 718 | for (i = 0; i < size * 4; i++) { |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 719 | memcpy(&data, txbuf, 4); |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 720 | data = qspi_endian_xchg(priv, data); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 721 | qspi_write32(priv->flags, ®s->tbdr, data); |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 722 | txbuf += 4; |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 723 | } |
| 724 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 725 | qspi_write32(priv->flags, ®s->ipcr, |
| 726 | (seqid << QSPI_IPCR_SEQID_SHIFT) | tx_size); |
| 727 | while (qspi_read32(priv->flags, ®s->sr) & QSPI_SR_BUSY_MASK) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 728 | ; |
| 729 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 730 | qspi_write32(priv->flags, ®s->mcr, mcr_reg); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 731 | } |
| 732 | |
Gong Qianyu | 4e8630b | 2016-01-26 15:06:41 +0800 | [diff] [blame] | 733 | static void qspi_op_rdsr(struct fsl_qspi_priv *priv, void *rxbuf, u32 len) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 734 | { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 735 | struct fsl_qspi_regs *regs = priv->regs; |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 736 | u32 mcr_reg, reg, data; |
| 737 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 738 | mcr_reg = qspi_read32(priv->flags, ®s->mcr); |
| 739 | qspi_write32(priv->flags, ®s->mcr, |
| 740 | QSPI_MCR_CLR_RXF_MASK | QSPI_MCR_CLR_TXF_MASK | |
Ye Li | 416d2ec | 2019-08-14 11:31:27 +0000 | [diff] [blame] | 741 | mcr_reg); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 742 | qspi_write32(priv->flags, ®s->rbct, QSPI_RBCT_RXBRD_USEIPS); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 743 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 744 | qspi_write32(priv->flags, ®s->sfar, priv->cur_amba_base); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 745 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 746 | qspi_write32(priv->flags, ®s->ipcr, |
| 747 | (SEQID_RDSR << QSPI_IPCR_SEQID_SHIFT) | 0); |
| 748 | while (qspi_read32(priv->flags, ®s->sr) & QSPI_SR_BUSY_MASK) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 749 | ; |
| 750 | |
| 751 | while (1) { |
Alexander Stein | 283eb4a | 2017-06-01 09:32:19 +0200 | [diff] [blame] | 752 | WATCHDOG_RESET(); |
| 753 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 754 | reg = qspi_read32(priv->flags, ®s->rbsr); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 755 | if (reg & QSPI_RBSR_RDBFL_MASK) { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 756 | data = qspi_read32(priv->flags, ®s->rbdr[0]); |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 757 | data = qspi_endian_xchg(priv, data); |
Gong Qianyu | 4e8630b | 2016-01-26 15:06:41 +0800 | [diff] [blame] | 758 | memcpy(rxbuf, &data, len); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 759 | qspi_write32(priv->flags, ®s->mcr, |
| 760 | qspi_read32(priv->flags, ®s->mcr) | |
| 761 | QSPI_MCR_CLR_RXF_MASK); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 762 | break; |
| 763 | } |
| 764 | } |
| 765 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 766 | qspi_write32(priv->flags, ®s->mcr, mcr_reg); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 767 | } |
| 768 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 769 | static void qspi_op_erase(struct fsl_qspi_priv *priv) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 770 | { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 771 | struct fsl_qspi_regs *regs = priv->regs; |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 772 | u32 mcr_reg; |
| 773 | u32 to_or_from = 0; |
| 774 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 775 | mcr_reg = qspi_read32(priv->flags, ®s->mcr); |
| 776 | qspi_write32(priv->flags, ®s->mcr, |
| 777 | QSPI_MCR_CLR_RXF_MASK | QSPI_MCR_CLR_TXF_MASK | |
Ye Li | 416d2ec | 2019-08-14 11:31:27 +0000 | [diff] [blame] | 778 | mcr_reg); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 779 | qspi_write32(priv->flags, ®s->rbct, QSPI_RBCT_RXBRD_USEIPS); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 780 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 781 | to_or_from = priv->sf_addr + priv->cur_amba_base; |
| 782 | qspi_write32(priv->flags, ®s->sfar, to_or_from); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 783 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 784 | qspi_write32(priv->flags, ®s->ipcr, |
| 785 | (SEQID_WREN << QSPI_IPCR_SEQID_SHIFT) | 0); |
| 786 | while (qspi_read32(priv->flags, ®s->sr) & QSPI_SR_BUSY_MASK) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 787 | ; |
| 788 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 789 | if (priv->cur_seqid == QSPI_CMD_SE) { |
| 790 | qspi_write32(priv->flags, ®s->ipcr, |
Peng Fan | 3642a87 | 2014-12-31 11:01:39 +0800 | [diff] [blame] | 791 | (SEQID_SE << QSPI_IPCR_SEQID_SHIFT) | 0); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 792 | } else if (priv->cur_seqid == QSPI_CMD_BE_4K) { |
| 793 | qspi_write32(priv->flags, ®s->ipcr, |
Peng Fan | 3642a87 | 2014-12-31 11:01:39 +0800 | [diff] [blame] | 794 | (SEQID_BE_4K << QSPI_IPCR_SEQID_SHIFT) | 0); |
| 795 | } |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 796 | while (qspi_read32(priv->flags, ®s->sr) & QSPI_SR_BUSY_MASK) |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 797 | ; |
| 798 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 799 | qspi_write32(priv->flags, ®s->mcr, mcr_reg); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 800 | } |
| 801 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 802 | int qspi_xfer(struct fsl_qspi_priv *priv, unsigned int bitlen, |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 803 | const void *dout, void *din, unsigned long flags) |
| 804 | { |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 805 | u32 bytes = DIV_ROUND_UP(bitlen, 8); |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 806 | static u32 wr_sfaddr; |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 807 | u32 txbuf; |
| 808 | |
Alexander Stein | 283eb4a | 2017-06-01 09:32:19 +0200 | [diff] [blame] | 809 | WATCHDOG_RESET(); |
| 810 | |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 811 | if (dout) { |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 812 | if (flags & SPI_XFER_BEGIN) { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 813 | priv->cur_seqid = *(u8 *)dout; |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 814 | memcpy(&txbuf, dout, 4); |
| 815 | } |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 816 | |
| 817 | if (flags == SPI_XFER_END) { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 818 | priv->sf_addr = wr_sfaddr; |
| 819 | qspi_op_write(priv, (u8 *)dout, bytes); |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 820 | return 0; |
| 821 | } |
| 822 | |
Yuan Yao | d719326 | 2016-03-15 14:36:42 +0800 | [diff] [blame] | 823 | if (priv->cur_seqid == QSPI_CMD_FAST_READ || |
| 824 | priv->cur_seqid == QSPI_CMD_RDAR) { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 825 | priv->sf_addr = swab32(txbuf) & OFFSET_BITS_MASK; |
| 826 | } else if ((priv->cur_seqid == QSPI_CMD_SE) || |
| 827 | (priv->cur_seqid == QSPI_CMD_BE_4K)) { |
| 828 | priv->sf_addr = swab32(txbuf) & OFFSET_BITS_MASK; |
| 829 | qspi_op_erase(priv); |
Yuan Yao | d719326 | 2016-03-15 14:36:42 +0800 | [diff] [blame] | 830 | } else if (priv->cur_seqid == QSPI_CMD_PP || |
| 831 | priv->cur_seqid == QSPI_CMD_WRAR) { |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 832 | wr_sfaddr = swab32(txbuf) & OFFSET_BITS_MASK; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 833 | } else if ((priv->cur_seqid == QSPI_CMD_BRWR) || |
| 834 | (priv->cur_seqid == QSPI_CMD_WREAR)) { |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 835 | #ifdef CONFIG_SPI_FLASH_BAR |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 836 | wr_sfaddr = 0; |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 837 | #endif |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 838 | } |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 839 | } |
| 840 | |
| 841 | if (din) { |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 842 | if (priv->cur_seqid == QSPI_CMD_FAST_READ) { |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 843 | #ifdef CONFIG_SYS_FSL_QSPI_AHB |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 844 | qspi_ahb_read(priv, din, bytes); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 845 | #else |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 846 | qspi_op_read(priv, din, bytes); |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 847 | #endif |
Yuan Yao | d719326 | 2016-03-15 14:36:42 +0800 | [diff] [blame] | 848 | } else if (priv->cur_seqid == QSPI_CMD_RDAR) { |
| 849 | qspi_op_read(priv, din, bytes); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 850 | } else if (priv->cur_seqid == QSPI_CMD_RDID) |
| 851 | qspi_op_rdid(priv, din, bytes); |
| 852 | else if (priv->cur_seqid == QSPI_CMD_RDSR) |
Gong Qianyu | 4e8630b | 2016-01-26 15:06:41 +0800 | [diff] [blame] | 853 | qspi_op_rdsr(priv, din, bytes); |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 854 | #ifdef CONFIG_SPI_FLASH_BAR |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 855 | else if ((priv->cur_seqid == QSPI_CMD_BRRD) || |
| 856 | (priv->cur_seqid == QSPI_CMD_RDEAR)) { |
| 857 | priv->sf_addr = 0; |
| 858 | qspi_op_rdbank(priv, din, bytes); |
Peng Fan | 3a34448 | 2015-01-04 17:07:14 +0800 | [diff] [blame] | 859 | } |
| 860 | #endif |
Alison Wang | c7410e3 | 2014-05-06 09:13:01 +0800 | [diff] [blame] | 861 | } |
| 862 | |
Peng Fan | 1c5f966 | 2015-01-08 10:40:20 +0800 | [diff] [blame] | 863 | #ifdef CONFIG_SYS_FSL_QSPI_AHB |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 864 | if ((priv->cur_seqid == QSPI_CMD_SE) || |
| 865 | (priv->cur_seqid == QSPI_CMD_PP) || |
| 866 | (priv->cur_seqid == QSPI_CMD_BE_4K) || |
| 867 | (priv->cur_seqid == QSPI_CMD_WREAR) || |
| 868 | (priv->cur_seqid == QSPI_CMD_BRWR)) |
| 869 | qspi_ahb_invalid(priv); |
| 870 | #endif |
| 871 | |
| 872 | return 0; |
| 873 | } |
| 874 | |
| 875 | void qspi_module_disable(struct fsl_qspi_priv *priv, u8 disable) |
| 876 | { |
| 877 | u32 mcr_val; |
| 878 | |
| 879 | mcr_val = qspi_read32(priv->flags, &priv->regs->mcr); |
| 880 | if (disable) |
| 881 | mcr_val |= QSPI_MCR_MDIS_MASK; |
| 882 | else |
| 883 | mcr_val &= ~QSPI_MCR_MDIS_MASK; |
| 884 | qspi_write32(priv->flags, &priv->regs->mcr, mcr_val); |
| 885 | } |
| 886 | |
| 887 | void qspi_cfg_smpr(struct fsl_qspi_priv *priv, u32 clear_bits, u32 set_bits) |
| 888 | { |
| 889 | u32 smpr_val; |
| 890 | |
| 891 | smpr_val = qspi_read32(priv->flags, &priv->regs->smpr); |
| 892 | smpr_val &= ~clear_bits; |
| 893 | smpr_val |= set_bits; |
| 894 | qspi_write32(priv->flags, &priv->regs->smpr, smpr_val); |
| 895 | } |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 896 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 897 | static int fsl_qspi_child_pre_probe(struct udevice *dev) |
| 898 | { |
Simon Glass | de44acf | 2015-09-28 23:32:01 -0600 | [diff] [blame] | 899 | struct spi_slave *slave = dev_get_parent_priv(dev); |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 900 | struct fsl_qspi_priv *priv = dev_get_priv(dev_get_parent(dev)); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 901 | |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 902 | slave->max_write_size = priv->devtype_data->txfifo; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 903 | |
| 904 | return 0; |
| 905 | } |
| 906 | |
| 907 | static int fsl_qspi_probe(struct udevice *bus) |
| 908 | { |
Yuan Yao | b4bfe10 | 2016-03-15 14:36:41 +0800 | [diff] [blame] | 909 | u32 amba_size_per_chip; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 910 | struct fsl_qspi_platdata *plat = dev_get_platdata(bus); |
| 911 | struct fsl_qspi_priv *priv = dev_get_priv(bus); |
| 912 | struct dm_spi_bus *dm_spi_bus; |
Suresh Gupta | 4945b87 | 2017-08-30 20:06:33 +0530 | [diff] [blame] | 913 | int i, ret; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 914 | |
| 915 | dm_spi_bus = bus->uclass_priv; |
| 916 | |
| 917 | dm_spi_bus->max_hz = plat->speed_hz; |
| 918 | |
Gong Qianyu | 14b532e | 2016-01-26 15:06:39 +0800 | [diff] [blame] | 919 | priv->regs = (struct fsl_qspi_regs *)(uintptr_t)plat->reg_base; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 920 | priv->flags = plat->flags; |
| 921 | |
| 922 | priv->speed_hz = plat->speed_hz; |
Yuan Yao | ae41239 | 2016-03-15 14:36:40 +0800 | [diff] [blame] | 923 | /* |
| 924 | * QSPI SFADR width is 32bits, the max dest addr is 4GB-1. |
| 925 | * AMBA memory zone should be located on the 0~4GB space |
| 926 | * even on a 64bits cpu. |
| 927 | */ |
| 928 | priv->amba_base[0] = (u32)plat->amba_base; |
| 929 | priv->amba_total_size = (u32)plat->amba_total_size; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 930 | priv->flash_num = plat->flash_num; |
| 931 | priv->num_chipselect = plat->num_chipselect; |
| 932 | |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 933 | priv->devtype_data = (struct fsl_qspi_devtype_data *)dev_get_driver_data(bus); |
| 934 | if (!priv->devtype_data) { |
| 935 | printf("ERROR : No devtype_data found\n"); |
| 936 | return -ENODEV; |
| 937 | } |
| 938 | |
| 939 | debug("devtype=%d, txfifo=%d, rxfifo=%d, ahb=%d, data=0x%x\n", |
| 940 | priv->devtype_data->devtype, |
| 941 | priv->devtype_data->txfifo, |
| 942 | priv->devtype_data->rxfifo, |
| 943 | priv->devtype_data->ahb_buf_size, |
| 944 | priv->devtype_data->driver_data); |
| 945 | |
Suresh Gupta | 4945b87 | 2017-08-30 20:06:33 +0530 | [diff] [blame] | 946 | /* make sure controller is not busy anywhere */ |
Rajat Srivastava | 234daec | 2018-03-22 13:30:55 +0530 | [diff] [blame] | 947 | ret = is_controller_busy(priv); |
Suresh Gupta | 4945b87 | 2017-08-30 20:06:33 +0530 | [diff] [blame] | 948 | |
| 949 | if (ret) { |
| 950 | debug("ERROR : The controller is busy\n"); |
| 951 | return ret; |
| 952 | } |
| 953 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 954 | qspi_write32(priv->flags, &priv->regs->mcr, |
York Sun | b4f57a9 | 2016-10-05 13:19:08 -0700 | [diff] [blame] | 955 | QSPI_MCR_RESERVED_MASK | QSPI_MCR_MDIS_MASK | |
Ye Li | 416d2ec | 2019-08-14 11:31:27 +0000 | [diff] [blame] | 956 | QSPI_MCR_END_CFD_LE); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 957 | |
| 958 | qspi_cfg_smpr(priv, ~(QSPI_SMPR_FSDLY_MASK | QSPI_SMPR_DDRSMP_MASK | |
| 959 | QSPI_SMPR_FSPHS_MASK | QSPI_SMPR_HSENA_MASK), 0); |
| 960 | |
Yuan Yao | b4bfe10 | 2016-03-15 14:36:41 +0800 | [diff] [blame] | 961 | /* |
| 962 | * Assign AMBA memory zone for every chipselect |
| 963 | * QuadSPI has two channels, every channel has two chipselects. |
| 964 | * If the property 'num-cs' in dts is 2, the AMBA memory will be divided |
| 965 | * into two parts and assign to every channel. This indicate that every |
| 966 | * channel only has one valid chipselect. |
| 967 | * If the property 'num-cs' in dts is 4, the AMBA memory will be divided |
| 968 | * into four parts and assign to every chipselect. |
| 969 | * Every channel will has two valid chipselects. |
| 970 | */ |
| 971 | amba_size_per_chip = priv->amba_total_size >> |
| 972 | (priv->num_chipselect >> 1); |
| 973 | for (i = 1 ; i < priv->num_chipselect ; i++) |
| 974 | priv->amba_base[i] = |
| 975 | amba_size_per_chip + priv->amba_base[i - 1]; |
| 976 | |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 977 | /* |
| 978 | * Any read access to non-implemented addresses will provide |
| 979 | * undefined results. |
| 980 | * |
| 981 | * In case single die flash devices, TOP_ADDR_MEMA2 and |
| 982 | * TOP_ADDR_MEMB2 should be initialized/programmed to |
| 983 | * TOP_ADDR_MEMA1 and TOP_ADDR_MEMB1 respectively - in effect, |
| 984 | * setting the size of these devices to 0. This would ensure |
| 985 | * that the complete memory map is assigned to only one flash device. |
| 986 | */ |
Suresh Gupta | 095f78e | 2017-02-21 14:26:46 +0530 | [diff] [blame] | 987 | qspi_write32(priv->flags, &priv->regs->sfa1ad, |
| 988 | priv->amba_base[0] + amba_size_per_chip); |
Yuan Yao | b4bfe10 | 2016-03-15 14:36:41 +0800 | [diff] [blame] | 989 | switch (priv->num_chipselect) { |
Suresh Gupta | 095f78e | 2017-02-21 14:26:46 +0530 | [diff] [blame] | 990 | case 1: |
| 991 | break; |
Yuan Yao | b4bfe10 | 2016-03-15 14:36:41 +0800 | [diff] [blame] | 992 | case 2: |
| 993 | qspi_write32(priv->flags, &priv->regs->sfa2ad, |
| 994 | priv->amba_base[1]); |
| 995 | qspi_write32(priv->flags, &priv->regs->sfb1ad, |
| 996 | priv->amba_base[1] + amba_size_per_chip); |
| 997 | qspi_write32(priv->flags, &priv->regs->sfb2ad, |
| 998 | priv->amba_base[1] + amba_size_per_chip); |
| 999 | break; |
| 1000 | case 4: |
| 1001 | qspi_write32(priv->flags, &priv->regs->sfa2ad, |
| 1002 | priv->amba_base[2]); |
| 1003 | qspi_write32(priv->flags, &priv->regs->sfb1ad, |
| 1004 | priv->amba_base[3]); |
| 1005 | qspi_write32(priv->flags, &priv->regs->sfb2ad, |
| 1006 | priv->amba_base[3] + amba_size_per_chip); |
| 1007 | break; |
| 1008 | default: |
| 1009 | debug("Error: Unsupported chipselect number %u!\n", |
| 1010 | priv->num_chipselect); |
| 1011 | qspi_module_disable(priv, 1); |
| 1012 | return -EINVAL; |
| 1013 | } |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 1014 | |
| 1015 | qspi_set_lut(priv); |
| 1016 | |
| 1017 | #ifdef CONFIG_SYS_FSL_QSPI_AHB |
| 1018 | qspi_init_ahb_read(priv); |
| 1019 | #endif |
| 1020 | |
| 1021 | qspi_module_disable(priv, 0); |
| 1022 | |
| 1023 | return 0; |
| 1024 | } |
| 1025 | |
| 1026 | static int fsl_qspi_ofdata_to_platdata(struct udevice *bus) |
| 1027 | { |
Yuan Yao | ae41239 | 2016-03-15 14:36:40 +0800 | [diff] [blame] | 1028 | struct fdt_resource res_regs, res_mem; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 1029 | struct fsl_qspi_platdata *plat = bus->platdata; |
| 1030 | const void *blob = gd->fdt_blob; |
Simon Glass | dd79d6e | 2017-01-17 16:52:55 -0700 | [diff] [blame] | 1031 | int node = dev_of_offset(bus); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 1032 | int ret, flash_num = 0, subnode; |
| 1033 | |
| 1034 | if (fdtdec_get_bool(blob, node, "big-endian")) |
| 1035 | plat->flags |= QSPI_FLAG_REGMAP_ENDIAN_BIG; |
| 1036 | |
Yuan Yao | ae41239 | 2016-03-15 14:36:40 +0800 | [diff] [blame] | 1037 | ret = fdt_get_named_resource(blob, node, "reg", "reg-names", |
| 1038 | "QuadSPI", &res_regs); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 1039 | if (ret) { |
Yuan Yao | ae41239 | 2016-03-15 14:36:40 +0800 | [diff] [blame] | 1040 | debug("Error: can't get regs base addresses(ret = %d)!\n", ret); |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 1041 | return -ENOMEM; |
| 1042 | } |
Yuan Yao | ae41239 | 2016-03-15 14:36:40 +0800 | [diff] [blame] | 1043 | ret = fdt_get_named_resource(blob, node, "reg", "reg-names", |
| 1044 | "QuadSPI-memory", &res_mem); |
| 1045 | if (ret) { |
| 1046 | debug("Error: can't get AMBA base addresses(ret = %d)!\n", ret); |
| 1047 | return -ENOMEM; |
| 1048 | } |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 1049 | |
| 1050 | /* Count flash numbers */ |
Simon Glass | 499c29e | 2016-10-02 17:59:29 -0600 | [diff] [blame] | 1051 | fdt_for_each_subnode(subnode, blob, node) |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 1052 | ++flash_num; |
| 1053 | |
| 1054 | if (flash_num == 0) { |
| 1055 | debug("Error: Missing flashes!\n"); |
| 1056 | return -ENODEV; |
| 1057 | } |
| 1058 | |
| 1059 | plat->speed_hz = fdtdec_get_int(blob, node, "spi-max-frequency", |
| 1060 | FSL_QSPI_DEFAULT_SCK_FREQ); |
| 1061 | plat->num_chipselect = fdtdec_get_int(blob, node, "num-cs", |
| 1062 | FSL_QSPI_MAX_CHIPSELECT_NUM); |
| 1063 | |
Yuan Yao | ae41239 | 2016-03-15 14:36:40 +0800 | [diff] [blame] | 1064 | plat->reg_base = res_regs.start; |
| 1065 | plat->amba_base = res_mem.start; |
| 1066 | plat->amba_total_size = res_mem.end - res_mem.start + 1; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 1067 | plat->flash_num = flash_num; |
| 1068 | |
Yuan Yao | ae41239 | 2016-03-15 14:36:40 +0800 | [diff] [blame] | 1069 | debug("%s: regs=<0x%llx> <0x%llx, 0x%llx>, max-frequency=%d, endianess=%s\n", |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 1070 | __func__, |
Yuan Yao | ae41239 | 2016-03-15 14:36:40 +0800 | [diff] [blame] | 1071 | (u64)plat->reg_base, |
| 1072 | (u64)plat->amba_base, |
| 1073 | (u64)plat->amba_total_size, |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 1074 | plat->speed_hz, |
| 1075 | plat->flags & QSPI_FLAG_REGMAP_ENDIAN_BIG ? "be" : "le" |
| 1076 | ); |
| 1077 | |
| 1078 | return 0; |
| 1079 | } |
| 1080 | |
| 1081 | static int fsl_qspi_xfer(struct udevice *dev, unsigned int bitlen, |
| 1082 | const void *dout, void *din, unsigned long flags) |
| 1083 | { |
| 1084 | struct fsl_qspi_priv *priv; |
| 1085 | struct udevice *bus; |
| 1086 | |
| 1087 | bus = dev->parent; |
| 1088 | priv = dev_get_priv(bus); |
| 1089 | |
| 1090 | return qspi_xfer(priv, bitlen, dout, din, flags); |
| 1091 | } |
| 1092 | |
| 1093 | static int fsl_qspi_claim_bus(struct udevice *dev) |
| 1094 | { |
| 1095 | struct fsl_qspi_priv *priv; |
| 1096 | struct udevice *bus; |
| 1097 | struct dm_spi_slave_platdata *slave_plat = dev_get_parent_platdata(dev); |
Suresh Gupta | 4945b87 | 2017-08-30 20:06:33 +0530 | [diff] [blame] | 1098 | int ret; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 1099 | |
| 1100 | bus = dev->parent; |
| 1101 | priv = dev_get_priv(bus); |
| 1102 | |
Suresh Gupta | 4945b87 | 2017-08-30 20:06:33 +0530 | [diff] [blame] | 1103 | /* make sure controller is not busy anywhere */ |
Rajat Srivastava | 234daec | 2018-03-22 13:30:55 +0530 | [diff] [blame] | 1104 | ret = is_controller_busy(priv); |
Suresh Gupta | 4945b87 | 2017-08-30 20:06:33 +0530 | [diff] [blame] | 1105 | |
| 1106 | if (ret) { |
| 1107 | debug("ERROR : The controller is busy\n"); |
| 1108 | return ret; |
| 1109 | } |
| 1110 | |
Yuan Yao | b4bfe10 | 2016-03-15 14:36:41 +0800 | [diff] [blame] | 1111 | priv->cur_amba_base = priv->amba_base[slave_plat->cs]; |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 1112 | |
| 1113 | qspi_module_disable(priv, 0); |
| 1114 | |
| 1115 | return 0; |
| 1116 | } |
| 1117 | |
| 1118 | static int fsl_qspi_release_bus(struct udevice *dev) |
| 1119 | { |
| 1120 | struct fsl_qspi_priv *priv; |
| 1121 | struct udevice *bus; |
| 1122 | |
| 1123 | bus = dev->parent; |
| 1124 | priv = dev_get_priv(bus); |
| 1125 | |
| 1126 | qspi_module_disable(priv, 1); |
| 1127 | |
| 1128 | return 0; |
| 1129 | } |
| 1130 | |
| 1131 | static int fsl_qspi_set_speed(struct udevice *bus, uint speed) |
| 1132 | { |
| 1133 | /* Nothing to do */ |
| 1134 | return 0; |
| 1135 | } |
| 1136 | |
| 1137 | static int fsl_qspi_set_mode(struct udevice *bus, uint mode) |
| 1138 | { |
| 1139 | /* Nothing to do */ |
| 1140 | return 0; |
| 1141 | } |
| 1142 | |
| 1143 | static const struct dm_spi_ops fsl_qspi_ops = { |
| 1144 | .claim_bus = fsl_qspi_claim_bus, |
| 1145 | .release_bus = fsl_qspi_release_bus, |
| 1146 | .xfer = fsl_qspi_xfer, |
| 1147 | .set_speed = fsl_qspi_set_speed, |
| 1148 | .set_mode = fsl_qspi_set_mode, |
| 1149 | }; |
| 1150 | |
| 1151 | static const struct udevice_id fsl_qspi_ids[] = { |
Ye Li | 007b604 | 2019-08-14 11:31:36 +0000 | [diff] [blame] | 1152 | { .compatible = "fsl,vf610-qspi", .data = (ulong)&vybrid_data }, |
| 1153 | { .compatible = "fsl,imx6sx-qspi", .data = (ulong)&imx6sx_data }, |
| 1154 | { .compatible = "fsl,imx6ul-qspi", .data = (ulong)&imx6ul_7d_data }, |
| 1155 | { .compatible = "fsl,imx7d-qspi", .data = (ulong)&imx6ul_7d_data }, |
Ye Li | 57f6775 | 2019-08-14 11:31:40 +0000 | [diff] [blame] | 1156 | { .compatible = "fsl,imx7ulp-qspi", .data = (ulong)&imx7ulp_data }, |
Haikun.Wang@freescale.com | 221f2e1 | 2015-04-01 11:10:40 +0800 | [diff] [blame] | 1157 | { } |
| 1158 | }; |
| 1159 | |
| 1160 | U_BOOT_DRIVER(fsl_qspi) = { |
| 1161 | .name = "fsl_qspi", |
| 1162 | .id = UCLASS_SPI, |
| 1163 | .of_match = fsl_qspi_ids, |
| 1164 | .ops = &fsl_qspi_ops, |
| 1165 | .ofdata_to_platdata = fsl_qspi_ofdata_to_platdata, |
| 1166 | .platdata_auto_alloc_size = sizeof(struct fsl_qspi_platdata), |
| 1167 | .priv_auto_alloc_size = sizeof(struct fsl_qspi_priv), |
| 1168 | .probe = fsl_qspi_probe, |
| 1169 | .child_pre_probe = fsl_qspi_child_pre_probe, |
| 1170 | }; |