Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 1 | /* |
| 2 | * Freescale eSPI controller driver. |
| 3 | * |
| 4 | * Copyright 2010 Freescale Semiconductor, Inc. |
| 5 | * |
| 6 | * This program is free software; you can redistribute it and/or modify it |
| 7 | * under the terms of the GNU General Public License as published by the |
| 8 | * Free Software Foundation; either version 2 of the License, or (at your |
| 9 | * option) any later version. |
| 10 | */ |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 11 | #include <linux/delay.h> |
Xiubo Li | a310836 | 2014-09-29 10:57:06 +0800 | [diff] [blame] | 12 | #include <linux/err.h> |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 13 | #include <linux/fsl_devices.h> |
Xiubo Li | a310836 | 2014-09-29 10:57:06 +0800 | [diff] [blame] | 14 | #include <linux/interrupt.h> |
Xiubo Li | a310836 | 2014-09-29 10:57:06 +0800 | [diff] [blame] | 15 | #include <linux/module.h> |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 16 | #include <linux/mm.h> |
| 17 | #include <linux/of.h> |
Rob Herring | 5af5073 | 2013-09-17 14:28:33 -0500 | [diff] [blame] | 18 | #include <linux/of_address.h> |
| 19 | #include <linux/of_irq.h> |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 20 | #include <linux/of_platform.h> |
Xiubo Li | a310836 | 2014-09-29 10:57:06 +0800 | [diff] [blame] | 21 | #include <linux/platform_device.h> |
| 22 | #include <linux/spi/spi.h> |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 23 | #include <linux/pm_runtime.h> |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 24 | #include <sysdev/fsl_soc.h> |
| 25 | |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 26 | /* eSPI Controller registers */ |
Heiner Kallweit | 46afd38 | 2016-09-13 23:16:02 +0200 | [diff] [blame] | 27 | #define ESPI_SPMODE 0x00 /* eSPI mode register */ |
| 28 | #define ESPI_SPIE 0x04 /* eSPI event register */ |
| 29 | #define ESPI_SPIM 0x08 /* eSPI mask register */ |
| 30 | #define ESPI_SPCOM 0x0c /* eSPI command register */ |
| 31 | #define ESPI_SPITF 0x10 /* eSPI transmit FIFO access register*/ |
| 32 | #define ESPI_SPIRF 0x14 /* eSPI receive FIFO access register*/ |
| 33 | #define ESPI_SPMODE0 0x20 /* eSPI cs0 mode register */ |
| 34 | |
| 35 | #define ESPI_SPMODEx(x) (ESPI_SPMODE0 + (x) * 4) |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 36 | |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 37 | /* eSPI Controller mode register definitions */ |
Heiner Kallweit | 81abc2e | 2016-09-13 23:16:06 +0200 | [diff] [blame] | 38 | #define SPMODE_ENABLE BIT(31) |
| 39 | #define SPMODE_LOOP BIT(30) |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 40 | #define SPMODE_TXTHR(x) ((x) << 8) |
| 41 | #define SPMODE_RXTHR(x) ((x) << 0) |
| 42 | |
| 43 | /* eSPI Controller CS mode register definitions */ |
Heiner Kallweit | 81abc2e | 2016-09-13 23:16:06 +0200 | [diff] [blame] | 44 | #define CSMODE_CI_INACTIVEHIGH BIT(31) |
| 45 | #define CSMODE_CP_BEGIN_EDGECLK BIT(30) |
| 46 | #define CSMODE_REV BIT(29) |
| 47 | #define CSMODE_DIV16 BIT(28) |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 48 | #define CSMODE_PM(x) ((x) << 24) |
Heiner Kallweit | 81abc2e | 2016-09-13 23:16:06 +0200 | [diff] [blame] | 49 | #define CSMODE_POL_1 BIT(20) |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 50 | #define CSMODE_LEN(x) ((x) << 16) |
| 51 | #define CSMODE_BEF(x) ((x) << 12) |
| 52 | #define CSMODE_AFT(x) ((x) << 8) |
| 53 | #define CSMODE_CG(x) ((x) << 3) |
| 54 | |
Heiner Kallweit | 5473126 | 2016-10-27 21:25:58 +0200 | [diff] [blame] | 55 | #define FSL_ESPI_FIFO_SIZE 32 |
Heiner Kallweit | e508cea | 2016-10-27 21:27:56 +0200 | [diff] [blame] | 56 | #define FSL_ESPI_RXTHR 15 |
Heiner Kallweit | 5473126 | 2016-10-27 21:25:58 +0200 | [diff] [blame] | 57 | |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 58 | /* Default mode/csmode for eSPI controller */ |
Heiner Kallweit | e508cea | 2016-10-27 21:27:56 +0200 | [diff] [blame] | 59 | #define SPMODE_INIT_VAL (SPMODE_TXTHR(4) | SPMODE_RXTHR(FSL_ESPI_RXTHR)) |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 60 | #define CSMODE_INIT_VAL (CSMODE_POL_1 | CSMODE_BEF(0) \ |
| 61 | | CSMODE_AFT(0) | CSMODE_CG(1)) |
| 62 | |
| 63 | /* SPIE register values */ |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 64 | #define SPIE_RXCNT(reg) ((reg >> 24) & 0x3F) |
| 65 | #define SPIE_TXCNT(reg) ((reg >> 16) & 0x3F) |
Heiner Kallweit | 81abc2e | 2016-09-13 23:16:06 +0200 | [diff] [blame] | 66 | #define SPIE_TXE BIT(15) /* TX FIFO empty */ |
| 67 | #define SPIE_DON BIT(14) /* TX done */ |
| 68 | #define SPIE_RXT BIT(13) /* RX FIFO threshold */ |
| 69 | #define SPIE_RXF BIT(12) /* RX FIFO full */ |
| 70 | #define SPIE_TXT BIT(11) /* TX FIFO threshold*/ |
| 71 | #define SPIE_RNE BIT(9) /* RX FIFO not empty */ |
| 72 | #define SPIE_TNF BIT(8) /* TX FIFO not full */ |
| 73 | |
| 74 | /* SPIM register values */ |
| 75 | #define SPIM_TXE BIT(15) /* TX FIFO empty */ |
| 76 | #define SPIM_DON BIT(14) /* TX done */ |
| 77 | #define SPIM_RXT BIT(13) /* RX FIFO threshold */ |
| 78 | #define SPIM_RXF BIT(12) /* RX FIFO full */ |
| 79 | #define SPIM_TXT BIT(11) /* TX FIFO threshold*/ |
| 80 | #define SPIM_RNE BIT(9) /* RX FIFO not empty */ |
| 81 | #define SPIM_TNF BIT(8) /* TX FIFO not full */ |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 82 | |
| 83 | /* SPCOM register values */ |
| 84 | #define SPCOM_CS(x) ((x) << 30) |
Heiner Kallweit | 81abc2e | 2016-09-13 23:16:06 +0200 | [diff] [blame] | 85 | #define SPCOM_DO BIT(28) /* Dual output */ |
| 86 | #define SPCOM_TO BIT(27) /* TX only */ |
| 87 | #define SPCOM_RXSKIP(x) ((x) << 16) |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 88 | #define SPCOM_TRANLEN(x) ((x) << 0) |
Heiner Kallweit | 81abc2e | 2016-09-13 23:16:06 +0200 | [diff] [blame] | 89 | |
Hou Zhiqiang | 5cfa1e4 | 2016-01-22 18:58:26 +0800 | [diff] [blame] | 90 | #define SPCOM_TRANLEN_MAX 0x10000 /* Max transaction length */ |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 91 | |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 92 | #define AUTOSUSPEND_TIMEOUT 2000 |
| 93 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 94 | struct fsl_espi { |
| 95 | struct device *dev; |
| 96 | void __iomem *reg_base; |
| 97 | |
| 98 | const void *tx; |
| 99 | void *rx; |
| 100 | |
| 101 | unsigned int rx_len; |
| 102 | unsigned int tx_len; |
| 103 | unsigned int rxskip; |
| 104 | |
| 105 | u8 *local_buf; |
| 106 | spinlock_t lock; |
| 107 | |
| 108 | u32 spibrg; /* SPIBRG input clock */ |
| 109 | |
| 110 | struct completion done; |
| 111 | }; |
| 112 | |
Heiner Kallweit | 219b5e3 | 2016-11-13 14:38:05 +0100 | [diff] [blame] | 113 | struct fsl_espi_cs { |
| 114 | u32 hw_mode; |
| 115 | }; |
| 116 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 117 | static inline u32 fsl_espi_read_reg(struct fsl_espi *espi, int offset) |
Heiner Kallweit | 46afd38 | 2016-09-13 23:16:02 +0200 | [diff] [blame] | 118 | { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 119 | return ioread32be(espi->reg_base + offset); |
Heiner Kallweit | 46afd38 | 2016-09-13 23:16:02 +0200 | [diff] [blame] | 120 | } |
| 121 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 122 | static inline u8 fsl_espi_read_reg8(struct fsl_espi *espi, int offset) |
Heiner Kallweit | 46afd38 | 2016-09-13 23:16:02 +0200 | [diff] [blame] | 123 | { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 124 | return ioread8(espi->reg_base + offset); |
Heiner Kallweit | 46afd38 | 2016-09-13 23:16:02 +0200 | [diff] [blame] | 125 | } |
| 126 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 127 | static inline void fsl_espi_write_reg(struct fsl_espi *espi, int offset, |
Heiner Kallweit | 46afd38 | 2016-09-13 23:16:02 +0200 | [diff] [blame] | 128 | u32 val) |
| 129 | { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 130 | iowrite32be(val, espi->reg_base + offset); |
Heiner Kallweit | 46afd38 | 2016-09-13 23:16:02 +0200 | [diff] [blame] | 131 | } |
| 132 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 133 | static inline void fsl_espi_write_reg8(struct fsl_espi *espi, int offset, |
Heiner Kallweit | 46afd38 | 2016-09-13 23:16:02 +0200 | [diff] [blame] | 134 | u8 val) |
| 135 | { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 136 | iowrite8(val, espi->reg_base + offset); |
Heiner Kallweit | 46afd38 | 2016-09-13 23:16:02 +0200 | [diff] [blame] | 137 | } |
| 138 | |
Heiner Kallweit | 923ab15 | 2016-10-02 14:22:57 +0200 | [diff] [blame] | 139 | static void fsl_espi_memcpy_swab(void *to, const void *from, |
| 140 | struct spi_message *m, |
| 141 | struct spi_transfer *t) |
| 142 | { |
| 143 | unsigned int len = t->len; |
| 144 | |
| 145 | if (!(m->spi->mode & SPI_LSB_FIRST) || t->bits_per_word <= 8) { |
| 146 | memcpy(to, from, len); |
| 147 | return; |
| 148 | } |
| 149 | |
| 150 | /* In case of LSB-first and bits_per_word > 8 byte-swap all words */ |
| 151 | while (len) |
| 152 | if (len >= 4) { |
| 153 | *(u32 *)to = swahb32p(from); |
| 154 | to += 4; |
| 155 | from += 4; |
| 156 | len -= 4; |
| 157 | } else { |
| 158 | *(u16 *)to = swab16p(from); |
| 159 | to += 2; |
| 160 | from += 2; |
| 161 | len -= 2; |
| 162 | } |
| 163 | } |
| 164 | |
Heiner Kallweit | cce7e3a | 2016-09-07 22:54:18 +0200 | [diff] [blame] | 165 | static void fsl_espi_copy_to_buf(struct spi_message *m, |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 166 | struct fsl_espi *espi) |
Heiner Kallweit | 7c159aa | 2016-09-07 22:50:53 +0200 | [diff] [blame] | 167 | { |
Heiner Kallweit | 7c159aa | 2016-09-07 22:50:53 +0200 | [diff] [blame] | 168 | struct spi_transfer *t; |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 169 | u8 *buf = espi->local_buf; |
Heiner Kallweit | 7c159aa | 2016-09-07 22:50:53 +0200 | [diff] [blame] | 170 | |
| 171 | list_for_each_entry(t, &m->transfers, transfer_list) { |
Heiner Kallweit | cce7e3a | 2016-09-07 22:54:18 +0200 | [diff] [blame] | 172 | if (t->tx_buf) |
Heiner Kallweit | 923ab15 | 2016-10-02 14:22:57 +0200 | [diff] [blame] | 173 | fsl_espi_memcpy_swab(buf, t->tx_buf, m, t); |
Heiner Kallweit | aca7515 | 2016-11-09 22:58:01 +0100 | [diff] [blame] | 174 | /* In RXSKIP mode controller shifts out zeros internally */ |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 175 | else if (!espi->rxskip) |
Heiner Kallweit | 7c159aa | 2016-09-07 22:50:53 +0200 | [diff] [blame] | 176 | memset(buf, 0, t->len); |
Heiner Kallweit | 7c159aa | 2016-09-07 22:50:53 +0200 | [diff] [blame] | 177 | buf += t->len; |
| 178 | } |
Heiner Kallweit | cce7e3a | 2016-09-07 22:54:18 +0200 | [diff] [blame] | 179 | } |
Heiner Kallweit | 7c159aa | 2016-09-07 22:50:53 +0200 | [diff] [blame] | 180 | |
Heiner Kallweit | cce7e3a | 2016-09-07 22:54:18 +0200 | [diff] [blame] | 181 | static void fsl_espi_copy_from_buf(struct spi_message *m, |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 182 | struct fsl_espi *espi) |
Heiner Kallweit | cce7e3a | 2016-09-07 22:54:18 +0200 | [diff] [blame] | 183 | { |
| 184 | struct spi_transfer *t; |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 185 | u8 *buf = espi->local_buf; |
Heiner Kallweit | cce7e3a | 2016-09-07 22:54:18 +0200 | [diff] [blame] | 186 | |
| 187 | list_for_each_entry(t, &m->transfers, transfer_list) { |
| 188 | if (t->rx_buf) |
Heiner Kallweit | 923ab15 | 2016-10-02 14:22:57 +0200 | [diff] [blame] | 189 | fsl_espi_memcpy_swab(t->rx_buf, buf, m, t); |
Heiner Kallweit | cce7e3a | 2016-09-07 22:54:18 +0200 | [diff] [blame] | 190 | buf += t->len; |
| 191 | } |
Heiner Kallweit | 7c159aa | 2016-09-07 22:50:53 +0200 | [diff] [blame] | 192 | } |
| 193 | |
Heiner Kallweit | d3152cf1 | 2016-09-07 22:53:38 +0200 | [diff] [blame] | 194 | static int fsl_espi_check_message(struct spi_message *m) |
| 195 | { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 196 | struct fsl_espi *espi = spi_master_get_devdata(m->spi->master); |
Heiner Kallweit | d3152cf1 | 2016-09-07 22:53:38 +0200 | [diff] [blame] | 197 | struct spi_transfer *t, *first; |
| 198 | |
| 199 | if (m->frame_length > SPCOM_TRANLEN_MAX) { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 200 | dev_err(espi->dev, "message too long, size is %u bytes\n", |
Heiner Kallweit | d3152cf1 | 2016-09-07 22:53:38 +0200 | [diff] [blame] | 201 | m->frame_length); |
| 202 | return -EMSGSIZE; |
| 203 | } |
| 204 | |
| 205 | first = list_first_entry(&m->transfers, struct spi_transfer, |
| 206 | transfer_list); |
Heiner Kallweit | e4be705 | 2016-10-02 14:22:35 +0200 | [diff] [blame] | 207 | |
Heiner Kallweit | d3152cf1 | 2016-09-07 22:53:38 +0200 | [diff] [blame] | 208 | list_for_each_entry(t, &m->transfers, transfer_list) { |
| 209 | if (first->bits_per_word != t->bits_per_word || |
| 210 | first->speed_hz != t->speed_hz) { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 211 | dev_err(espi->dev, "bits_per_word/speed_hz should be the same for all transfers\n"); |
Heiner Kallweit | d3152cf1 | 2016-09-07 22:53:38 +0200 | [diff] [blame] | 212 | return -EINVAL; |
| 213 | } |
| 214 | } |
| 215 | |
Heiner Kallweit | e4be705 | 2016-10-02 14:22:35 +0200 | [diff] [blame] | 216 | /* ESPI supports MSB-first transfers for word size 8 / 16 only */ |
| 217 | if (!(m->spi->mode & SPI_LSB_FIRST) && first->bits_per_word != 8 && |
| 218 | first->bits_per_word != 16) { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 219 | dev_err(espi->dev, |
Heiner Kallweit | e4be705 | 2016-10-02 14:22:35 +0200 | [diff] [blame] | 220 | "MSB-first transfer not supported for wordsize %u\n", |
| 221 | first->bits_per_word); |
| 222 | return -EINVAL; |
| 223 | } |
| 224 | |
Heiner Kallweit | d3152cf1 | 2016-09-07 22:53:38 +0200 | [diff] [blame] | 225 | return 0; |
| 226 | } |
| 227 | |
Heiner Kallweit | aca7515 | 2016-11-09 22:58:01 +0100 | [diff] [blame] | 228 | static unsigned int fsl_espi_check_rxskip_mode(struct spi_message *m) |
| 229 | { |
| 230 | struct spi_transfer *t; |
| 231 | unsigned int i = 0, rxskip = 0; |
| 232 | |
| 233 | /* |
| 234 | * prerequisites for ESPI rxskip mode: |
| 235 | * - message has two transfers |
| 236 | * - first transfer is a write and second is a read |
| 237 | * |
| 238 | * In addition the current low-level transfer mechanism requires |
| 239 | * that the rxskip bytes fit into the TX FIFO. Else the transfer |
| 240 | * would hang because after the first FSL_ESPI_FIFO_SIZE bytes |
| 241 | * the TX FIFO isn't re-filled. |
| 242 | */ |
| 243 | list_for_each_entry(t, &m->transfers, transfer_list) { |
| 244 | if (i == 0) { |
| 245 | if (!t->tx_buf || t->rx_buf || |
| 246 | t->len > FSL_ESPI_FIFO_SIZE) |
| 247 | return 0; |
| 248 | rxskip = t->len; |
| 249 | } else if (i == 1) { |
| 250 | if (t->tx_buf || !t->rx_buf) |
| 251 | return 0; |
| 252 | } |
| 253 | i++; |
| 254 | } |
| 255 | |
| 256 | return i == 2 ? rxskip : 0; |
| 257 | } |
| 258 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 259 | static void fsl_espi_fill_tx_fifo(struct fsl_espi *espi, u32 events) |
Heiner Kallweit | 5473126 | 2016-10-27 21:25:58 +0200 | [diff] [blame] | 260 | { |
| 261 | u32 tx_fifo_avail; |
| 262 | |
| 263 | /* if events is zero transfer has not started and tx fifo is empty */ |
| 264 | tx_fifo_avail = events ? SPIE_TXCNT(events) : FSL_ESPI_FIFO_SIZE; |
| 265 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 266 | while (tx_fifo_avail >= min(4U, espi->tx_len) && espi->tx_len) |
| 267 | if (espi->tx_len >= 4) { |
| 268 | fsl_espi_write_reg(espi, ESPI_SPITF, *(u32 *)espi->tx); |
| 269 | espi->tx += 4; |
| 270 | espi->tx_len -= 4; |
Heiner Kallweit | 5473126 | 2016-10-27 21:25:58 +0200 | [diff] [blame] | 271 | tx_fifo_avail -= 4; |
| 272 | } else { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 273 | fsl_espi_write_reg8(espi, ESPI_SPITF, *(u8 *)espi->tx); |
| 274 | espi->tx += 1; |
| 275 | espi->tx_len -= 1; |
Heiner Kallweit | 5473126 | 2016-10-27 21:25:58 +0200 | [diff] [blame] | 276 | tx_fifo_avail -= 1; |
| 277 | } |
| 278 | } |
| 279 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 280 | static void fsl_espi_read_rx_fifo(struct fsl_espi *espi, u32 events) |
Heiner Kallweit | f05689a | 2016-10-27 21:27:35 +0200 | [diff] [blame] | 281 | { |
| 282 | u32 rx_fifo_avail = SPIE_RXCNT(events); |
| 283 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 284 | while (rx_fifo_avail >= min(4U, espi->rx_len) && espi->rx_len) |
| 285 | if (espi->rx_len >= 4) { |
| 286 | *(u32 *)espi->rx = fsl_espi_read_reg(espi, ESPI_SPIRF); |
| 287 | espi->rx += 4; |
| 288 | espi->rx_len -= 4; |
Heiner Kallweit | f05689a | 2016-10-27 21:27:35 +0200 | [diff] [blame] | 289 | rx_fifo_avail -= 4; |
| 290 | } else { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 291 | *(u8 *)espi->rx = fsl_espi_read_reg8(espi, ESPI_SPIRF); |
| 292 | espi->rx += 1; |
| 293 | espi->rx_len -= 1; |
Heiner Kallweit | f05689a | 2016-10-27 21:27:35 +0200 | [diff] [blame] | 294 | rx_fifo_avail -= 1; |
| 295 | } |
| 296 | } |
| 297 | |
Heiner Kallweit | ea616ee | 2016-08-25 06:44:42 +0200 | [diff] [blame] | 298 | static void fsl_espi_setup_transfer(struct spi_device *spi, |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 299 | struct spi_transfer *t) |
| 300 | { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 301 | struct fsl_espi *espi = spi_master_get_devdata(spi->master); |
Heiner Kallweit | d198ebf | 2016-09-13 23:15:45 +0200 | [diff] [blame] | 302 | int bits_per_word = t ? t->bits_per_word : spi->bits_per_word; |
Paulo Zaneti | 73aaf15 | 2016-10-29 11:02:19 +0200 | [diff] [blame] | 303 | u32 pm, hz = t ? t->speed_hz : spi->max_speed_hz; |
Heiner Kallweit | 219b5e3 | 2016-11-13 14:38:05 +0100 | [diff] [blame] | 304 | struct fsl_espi_cs *cs = spi_get_ctldata(spi); |
Heiner Kallweit | 8f3086d | 2016-11-04 21:01:12 +0100 | [diff] [blame] | 305 | u32 hw_mode_old = cs->hw_mode; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 306 | |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 307 | /* mask out bits we are going to set */ |
| 308 | cs->hw_mode &= ~(CSMODE_LEN(0xF) | CSMODE_DIV16 | CSMODE_PM(0xF)); |
| 309 | |
Heiner Kallweit | a755af5 | 2016-09-04 09:56:57 +0200 | [diff] [blame] | 310 | cs->hw_mode |= CSMODE_LEN(bits_per_word - 1); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 311 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 312 | pm = DIV_ROUND_UP(espi->spibrg, hz * 4) - 1; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 313 | |
Paulo Zaneti | 73aaf15 | 2016-10-29 11:02:19 +0200 | [diff] [blame] | 314 | if (pm > 15) { |
| 315 | cs->hw_mode |= CSMODE_DIV16; |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 316 | pm = DIV_ROUND_UP(espi->spibrg, hz * 16 * 4) - 1; |
Paulo Zaneti | 73aaf15 | 2016-10-29 11:02:19 +0200 | [diff] [blame] | 317 | |
| 318 | WARN_ONCE(pm > 15, |
| 319 | "%s: Requested speed is too low: %u Hz. Will use %u Hz instead.\n", |
| 320 | dev_name(&spi->dev), hz, |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 321 | espi->spibrg / (4 * 16 * (15 + 1))); |
Paulo Zaneti | 73aaf15 | 2016-10-29 11:02:19 +0200 | [diff] [blame] | 322 | if (pm > 15) |
| 323 | pm = 15; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 324 | } |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 325 | |
| 326 | cs->hw_mode |= CSMODE_PM(pm); |
| 327 | |
Heiner Kallweit | 8f3086d | 2016-11-04 21:01:12 +0100 | [diff] [blame] | 328 | /* don't write the mode register if the mode doesn't change */ |
| 329 | if (cs->hw_mode != hw_mode_old) |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 330 | fsl_espi_write_reg(espi, ESPI_SPMODEx(spi->chip_select), |
Heiner Kallweit | 8f3086d | 2016-11-04 21:01:12 +0100 | [diff] [blame] | 331 | cs->hw_mode); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 332 | } |
| 333 | |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 334 | static int fsl_espi_bufs(struct spi_device *spi, struct spi_transfer *t) |
| 335 | { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 336 | struct fsl_espi *espi = spi_master_get_devdata(spi->master); |
Heiner Kallweit | aca7515 | 2016-11-09 22:58:01 +0100 | [diff] [blame] | 337 | u32 mask, spcom; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 338 | int ret; |
| 339 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 340 | espi->rx_len = t->len; |
| 341 | espi->tx_len = t->len; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 342 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 343 | espi->tx = t->tx_buf; |
| 344 | espi->rx = t->rx_buf; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 345 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 346 | reinit_completion(&espi->done); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 347 | |
| 348 | /* Set SPCOM[CS] and SPCOM[TRANLEN] field */ |
Heiner Kallweit | aca7515 | 2016-11-09 22:58:01 +0100 | [diff] [blame] | 349 | spcom = SPCOM_CS(spi->chip_select); |
| 350 | spcom |= SPCOM_TRANLEN(t->len - 1); |
| 351 | |
| 352 | /* configure RXSKIP mode */ |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 353 | if (espi->rxskip) { |
| 354 | spcom |= SPCOM_RXSKIP(espi->rxskip); |
| 355 | espi->tx_len = espi->rxskip; |
| 356 | espi->rx_len = t->len - espi->rxskip; |
| 357 | espi->rx = t->rx_buf + espi->rxskip; |
Heiner Kallweit | 8263cb3 | 2016-11-09 22:58:34 +0100 | [diff] [blame] | 358 | if (t->rx_nbits == SPI_NBITS_DUAL) |
| 359 | spcom |= SPCOM_DO; |
Heiner Kallweit | aca7515 | 2016-11-09 22:58:01 +0100 | [diff] [blame] | 360 | } |
| 361 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 362 | fsl_espi_write_reg(espi, ESPI_SPCOM, spcom); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 363 | |
Heiner Kallweit | e508cea | 2016-10-27 21:27:56 +0200 | [diff] [blame] | 364 | /* enable interrupts */ |
| 365 | mask = SPIM_DON; |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 366 | if (espi->rx_len > FSL_ESPI_FIFO_SIZE) |
Heiner Kallweit | e508cea | 2016-10-27 21:27:56 +0200 | [diff] [blame] | 367 | mask |= SPIM_RXT; |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 368 | fsl_espi_write_reg(espi, ESPI_SPIM, mask); |
Heiner Kallweit | 5bcc6a2 | 2016-09-07 22:53:01 +0200 | [diff] [blame] | 369 | |
Heiner Kallweit | 5473126 | 2016-10-27 21:25:58 +0200 | [diff] [blame] | 370 | /* Prevent filling the fifo from getting interrupted */ |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 371 | spin_lock_irq(&espi->lock); |
| 372 | fsl_espi_fill_tx_fifo(espi, 0); |
| 373 | spin_unlock_irq(&espi->lock); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 374 | |
Nobuteru Hayashi | aa70e56 | 2016-03-18 11:35:21 +0000 | [diff] [blame] | 375 | /* Won't hang up forever, SPI bus sometimes got lost interrupts... */ |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 376 | ret = wait_for_completion_timeout(&espi->done, 2 * HZ); |
Nobuteru Hayashi | aa70e56 | 2016-03-18 11:35:21 +0000 | [diff] [blame] | 377 | if (ret == 0) |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 378 | dev_err(espi->dev, |
Heiner Kallweit | db1b049 | 2016-10-27 21:28:02 +0200 | [diff] [blame] | 379 | "Transaction hanging up (left %u tx bytes, %u rx bytes)\n", |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 380 | espi->tx_len, espi->rx_len); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 381 | |
| 382 | /* disable rx ints */ |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 383 | fsl_espi_write_reg(espi, ESPI_SPIM, 0); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 384 | |
Heiner Kallweit | db1b049 | 2016-10-27 21:28:02 +0200 | [diff] [blame] | 385 | return ret == 0 ? -ETIMEDOUT : 0; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 386 | } |
| 387 | |
Heiner Kallweit | 38d003f | 2016-09-07 22:54:51 +0200 | [diff] [blame] | 388 | static int fsl_espi_trans(struct spi_message *m, struct spi_transfer *trans) |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 389 | { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 390 | struct fsl_espi *espi = spi_master_get_devdata(m->spi->master); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 391 | struct spi_device *spi = m->spi; |
Heiner Kallweit | 38d003f | 2016-09-07 22:54:51 +0200 | [diff] [blame] | 392 | int ret; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 393 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 394 | espi->rxskip = fsl_espi_check_rxskip_mode(m); |
| 395 | if (trans->rx_nbits == SPI_NBITS_DUAL && !espi->rxskip) { |
| 396 | dev_err(espi->dev, "Dual output mode requires RXSKIP mode!\n"); |
Heiner Kallweit | 8263cb3 | 2016-11-09 22:58:34 +0100 | [diff] [blame] | 397 | return -EINVAL; |
| 398 | } |
| 399 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 400 | fsl_espi_copy_to_buf(m, espi); |
Heiner Kallweit | faceef3 | 2016-09-07 22:52:06 +0200 | [diff] [blame] | 401 | fsl_espi_setup_transfer(spi, trans); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 402 | |
Heiner Kallweit | 06af115 | 2016-09-07 22:54:35 +0200 | [diff] [blame] | 403 | ret = fsl_espi_bufs(spi, trans); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 404 | |
Heiner Kallweit | faceef3 | 2016-09-07 22:52:06 +0200 | [diff] [blame] | 405 | if (trans->delay_usecs) |
| 406 | udelay(trans->delay_usecs); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 407 | |
Heiner Kallweit | cce7e3a | 2016-09-07 22:54:18 +0200 | [diff] [blame] | 408 | if (!ret) |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 409 | fsl_espi_copy_from_buf(m, espi); |
Heiner Kallweit | e33a3ad | 2016-09-07 22:51:10 +0200 | [diff] [blame] | 410 | |
| 411 | return ret; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 412 | } |
| 413 | |
Heiner Kallweit | c592bec | 2014-12-03 07:56:17 +0100 | [diff] [blame] | 414 | static int fsl_espi_do_one_msg(struct spi_master *master, |
| 415 | struct spi_message *m) |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 416 | { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 417 | struct fsl_espi *espi = spi_master_get_devdata(m->spi->master); |
Heiner Kallweit | 8263cb3 | 2016-11-09 22:58:34 +0100 | [diff] [blame] | 418 | unsigned int delay_usecs = 0, rx_nbits = 0; |
Heiner Kallweit | faceef3 | 2016-09-07 22:52:06 +0200 | [diff] [blame] | 419 | struct spi_transfer *t, trans = {}; |
Heiner Kallweit | e33a3ad | 2016-09-07 22:51:10 +0200 | [diff] [blame] | 420 | int ret; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 421 | |
Heiner Kallweit | d3152cf1 | 2016-09-07 22:53:38 +0200 | [diff] [blame] | 422 | ret = fsl_espi_check_message(m); |
| 423 | if (ret) |
| 424 | goto out; |
| 425 | |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 426 | list_for_each_entry(t, &m->transfers, transfer_list) { |
Heiner Kallweit | 96361faf | 2016-09-07 22:54:00 +0200 | [diff] [blame] | 427 | if (t->delay_usecs > delay_usecs) |
| 428 | delay_usecs = t->delay_usecs; |
Heiner Kallweit | 8263cb3 | 2016-11-09 22:58:34 +0100 | [diff] [blame] | 429 | if (t->rx_nbits > rx_nbits) |
| 430 | rx_nbits = t->rx_nbits; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 431 | } |
| 432 | |
Heiner Kallweit | 96361faf | 2016-09-07 22:54:00 +0200 | [diff] [blame] | 433 | t = list_first_entry(&m->transfers, struct spi_transfer, |
| 434 | transfer_list); |
| 435 | |
Heiner Kallweit | 06af115 | 2016-09-07 22:54:35 +0200 | [diff] [blame] | 436 | trans.len = m->frame_length; |
Heiner Kallweit | 96361faf | 2016-09-07 22:54:00 +0200 | [diff] [blame] | 437 | trans.speed_hz = t->speed_hz; |
| 438 | trans.bits_per_word = t->bits_per_word; |
| 439 | trans.delay_usecs = delay_usecs; |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 440 | trans.tx_buf = espi->local_buf; |
| 441 | trans.rx_buf = espi->local_buf; |
Heiner Kallweit | 8263cb3 | 2016-11-09 22:58:34 +0100 | [diff] [blame] | 442 | trans.rx_nbits = rx_nbits; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 443 | |
Heiner Kallweit | 06af115 | 2016-09-07 22:54:35 +0200 | [diff] [blame] | 444 | if (trans.len) |
| 445 | ret = fsl_espi_trans(m, &trans); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 446 | |
Heiner Kallweit | faceef3 | 2016-09-07 22:52:06 +0200 | [diff] [blame] | 447 | m->actual_length = ret ? 0 : trans.len; |
Heiner Kallweit | d3152cf1 | 2016-09-07 22:53:38 +0200 | [diff] [blame] | 448 | out: |
Heiner Kallweit | 0319d49 | 2016-09-07 22:51:29 +0200 | [diff] [blame] | 449 | if (m->status == -EINPROGRESS) |
| 450 | m->status = ret; |
| 451 | |
Heiner Kallweit | c592bec | 2014-12-03 07:56:17 +0100 | [diff] [blame] | 452 | spi_finalize_current_message(master); |
Heiner Kallweit | 0319d49 | 2016-09-07 22:51:29 +0200 | [diff] [blame] | 453 | |
| 454 | return ret; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 455 | } |
| 456 | |
| 457 | static int fsl_espi_setup(struct spi_device *spi) |
| 458 | { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 459 | struct fsl_espi *espi; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 460 | u32 loop_mode; |
Heiner Kallweit | 219b5e3 | 2016-11-13 14:38:05 +0100 | [diff] [blame] | 461 | struct fsl_espi_cs *cs = spi_get_ctldata(spi); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 462 | |
| 463 | if (!spi->max_speed_hz) |
| 464 | return -EINVAL; |
| 465 | |
| 466 | if (!cs) { |
Axel Lin | d9f2674 | 2014-08-31 12:44:09 +0800 | [diff] [blame] | 467 | cs = kzalloc(sizeof(*cs), GFP_KERNEL); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 468 | if (!cs) |
| 469 | return -ENOMEM; |
Axel Lin | d9f2674 | 2014-08-31 12:44:09 +0800 | [diff] [blame] | 470 | spi_set_ctldata(spi, cs); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 471 | } |
| 472 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 473 | espi = spi_master_get_devdata(spi->master); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 474 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 475 | pm_runtime_get_sync(espi->dev); |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 476 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 477 | cs->hw_mode = fsl_espi_read_reg(espi, ESPI_SPMODEx(spi->chip_select)); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 478 | /* mask out bits we are going to set */ |
| 479 | cs->hw_mode &= ~(CSMODE_CP_BEGIN_EDGECLK | CSMODE_CI_INACTIVEHIGH |
| 480 | | CSMODE_REV); |
| 481 | |
| 482 | if (spi->mode & SPI_CPHA) |
| 483 | cs->hw_mode |= CSMODE_CP_BEGIN_EDGECLK; |
| 484 | if (spi->mode & SPI_CPOL) |
| 485 | cs->hw_mode |= CSMODE_CI_INACTIVEHIGH; |
| 486 | if (!(spi->mode & SPI_LSB_FIRST)) |
| 487 | cs->hw_mode |= CSMODE_REV; |
| 488 | |
| 489 | /* Handle the loop mode */ |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 490 | loop_mode = fsl_espi_read_reg(espi, ESPI_SPMODE); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 491 | loop_mode &= ~SPMODE_LOOP; |
| 492 | if (spi->mode & SPI_LOOP) |
| 493 | loop_mode |= SPMODE_LOOP; |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 494 | fsl_espi_write_reg(espi, ESPI_SPMODE, loop_mode); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 495 | |
Heiner Kallweit | ea616ee | 2016-08-25 06:44:42 +0200 | [diff] [blame] | 496 | fsl_espi_setup_transfer(spi, NULL); |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 497 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 498 | pm_runtime_mark_last_busy(espi->dev); |
| 499 | pm_runtime_put_autosuspend(espi->dev); |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 500 | |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 501 | return 0; |
| 502 | } |
| 503 | |
Axel Lin | d9f2674 | 2014-08-31 12:44:09 +0800 | [diff] [blame] | 504 | static void fsl_espi_cleanup(struct spi_device *spi) |
| 505 | { |
Heiner Kallweit | 219b5e3 | 2016-11-13 14:38:05 +0100 | [diff] [blame] | 506 | struct fsl_espi_cs *cs = spi_get_ctldata(spi); |
Axel Lin | d9f2674 | 2014-08-31 12:44:09 +0800 | [diff] [blame] | 507 | |
| 508 | kfree(cs); |
| 509 | spi_set_ctldata(spi, NULL); |
| 510 | } |
| 511 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 512 | static void fsl_espi_cpu_irq(struct fsl_espi *espi, u32 events) |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 513 | { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 514 | if (espi->rx_len) |
| 515 | fsl_espi_read_rx_fifo(espi, events); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 516 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 517 | if (espi->tx_len) |
| 518 | fsl_espi_fill_tx_fifo(espi, events); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 519 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 520 | if (espi->tx_len || espi->rx_len) |
Heiner Kallweit | db1b049 | 2016-10-27 21:28:02 +0200 | [diff] [blame] | 521 | return; |
| 522 | |
| 523 | /* we're done, but check for errors before returning */ |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 524 | events = fsl_espi_read_reg(espi, ESPI_SPIE); |
Heiner Kallweit | db1b049 | 2016-10-27 21:28:02 +0200 | [diff] [blame] | 525 | |
| 526 | if (!(events & SPIE_DON)) |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 527 | dev_err(espi->dev, |
Heiner Kallweit | db1b049 | 2016-10-27 21:28:02 +0200 | [diff] [blame] | 528 | "Transfer done but SPIE_DON isn't set!\n"); |
| 529 | |
| 530 | if (SPIE_RXCNT(events) || SPIE_TXCNT(events) != FSL_ESPI_FIFO_SIZE) |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 531 | dev_err(espi->dev, "Transfer done but rx/tx fifo's aren't empty!\n"); |
Heiner Kallweit | db1b049 | 2016-10-27 21:28:02 +0200 | [diff] [blame] | 532 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 533 | complete(&espi->done); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 534 | } |
| 535 | |
| 536 | static irqreturn_t fsl_espi_irq(s32 irq, void *context_data) |
| 537 | { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 538 | struct fsl_espi *espi = context_data; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 539 | u32 events; |
| 540 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 541 | spin_lock(&espi->lock); |
Heiner Kallweit | 5473126 | 2016-10-27 21:25:58 +0200 | [diff] [blame] | 542 | |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 543 | /* Get interrupt events(tx/rx) */ |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 544 | events = fsl_espi_read_reg(espi, ESPI_SPIE); |
Heiner Kallweit | 5473126 | 2016-10-27 21:25:58 +0200 | [diff] [blame] | 545 | if (!events) { |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 546 | spin_unlock(&espi->lock); |
Heiner Kallweit | 35f5d71 | 2016-09-13 23:15:57 +0200 | [diff] [blame] | 547 | return IRQ_NONE; |
Heiner Kallweit | 5473126 | 2016-10-27 21:25:58 +0200 | [diff] [blame] | 548 | } |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 549 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 550 | dev_vdbg(espi->dev, "%s: events %x\n", __func__, events); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 551 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 552 | fsl_espi_cpu_irq(espi, events); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 553 | |
Heiner Kallweit | 35f5d71 | 2016-09-13 23:15:57 +0200 | [diff] [blame] | 554 | /* Clear the events */ |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 555 | fsl_espi_write_reg(espi, ESPI_SPIE, events); |
Heiner Kallweit | 35f5d71 | 2016-09-13 23:15:57 +0200 | [diff] [blame] | 556 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 557 | spin_unlock(&espi->lock); |
Heiner Kallweit | 5473126 | 2016-10-27 21:25:58 +0200 | [diff] [blame] | 558 | |
Heiner Kallweit | 35f5d71 | 2016-09-13 23:15:57 +0200 | [diff] [blame] | 559 | return IRQ_HANDLED; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 560 | } |
| 561 | |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 562 | #ifdef CONFIG_PM |
| 563 | static int fsl_espi_runtime_suspend(struct device *dev) |
Heiner Kallweit | 75506d0 | 2014-12-03 07:56:19 +0100 | [diff] [blame] | 564 | { |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 565 | struct spi_master *master = dev_get_drvdata(dev); |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 566 | struct fsl_espi *espi = spi_master_get_devdata(master); |
Heiner Kallweit | 75506d0 | 2014-12-03 07:56:19 +0100 | [diff] [blame] | 567 | u32 regval; |
| 568 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 569 | regval = fsl_espi_read_reg(espi, ESPI_SPMODE); |
Heiner Kallweit | 75506d0 | 2014-12-03 07:56:19 +0100 | [diff] [blame] | 570 | regval &= ~SPMODE_ENABLE; |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 571 | fsl_espi_write_reg(espi, ESPI_SPMODE, regval); |
Heiner Kallweit | 75506d0 | 2014-12-03 07:56:19 +0100 | [diff] [blame] | 572 | |
| 573 | return 0; |
| 574 | } |
| 575 | |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 576 | static int fsl_espi_runtime_resume(struct device *dev) |
Heiner Kallweit | 75506d0 | 2014-12-03 07:56:19 +0100 | [diff] [blame] | 577 | { |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 578 | struct spi_master *master = dev_get_drvdata(dev); |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 579 | struct fsl_espi *espi = spi_master_get_devdata(master); |
Heiner Kallweit | 75506d0 | 2014-12-03 07:56:19 +0100 | [diff] [blame] | 580 | u32 regval; |
| 581 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 582 | regval = fsl_espi_read_reg(espi, ESPI_SPMODE); |
Heiner Kallweit | 75506d0 | 2014-12-03 07:56:19 +0100 | [diff] [blame] | 583 | regval |= SPMODE_ENABLE; |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 584 | fsl_espi_write_reg(espi, ESPI_SPMODE, regval); |
Heiner Kallweit | 75506d0 | 2014-12-03 07:56:19 +0100 | [diff] [blame] | 585 | |
| 586 | return 0; |
| 587 | } |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 588 | #endif |
Heiner Kallweit | 75506d0 | 2014-12-03 07:56:19 +0100 | [diff] [blame] | 589 | |
Heiner Kallweit | 02a595d | 2016-08-17 21:11:01 +0200 | [diff] [blame] | 590 | static size_t fsl_espi_max_message_size(struct spi_device *spi) |
Michal Suchanek | b541eef | 2015-12-02 10:38:21 +0000 | [diff] [blame] | 591 | { |
| 592 | return SPCOM_TRANLEN_MAX; |
| 593 | } |
| 594 | |
Heiner Kallweit | 456c742 | 2016-11-13 14:40:18 +0100 | [diff] [blame] | 595 | static void fsl_espi_init_regs(struct device *dev, bool initial) |
| 596 | { |
| 597 | struct spi_master *master = dev_get_drvdata(dev); |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 598 | struct fsl_espi *espi = spi_master_get_devdata(master); |
Heiner Kallweit | 456c742 | 2016-11-13 14:40:18 +0100 | [diff] [blame] | 599 | struct device_node *nc; |
| 600 | u32 csmode, cs, prop; |
| 601 | int ret; |
| 602 | |
| 603 | /* SPI controller initializations */ |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 604 | fsl_espi_write_reg(espi, ESPI_SPMODE, 0); |
| 605 | fsl_espi_write_reg(espi, ESPI_SPIM, 0); |
| 606 | fsl_espi_write_reg(espi, ESPI_SPCOM, 0); |
| 607 | fsl_espi_write_reg(espi, ESPI_SPIE, 0xffffffff); |
Heiner Kallweit | 456c742 | 2016-11-13 14:40:18 +0100 | [diff] [blame] | 608 | |
| 609 | /* Init eSPI CS mode register */ |
| 610 | for_each_available_child_of_node(master->dev.of_node, nc) { |
| 611 | /* get chip select */ |
| 612 | ret = of_property_read_u32(nc, "reg", &cs); |
| 613 | if (ret || cs >= master->num_chipselect) |
| 614 | continue; |
| 615 | |
| 616 | csmode = CSMODE_INIT_VAL; |
| 617 | |
| 618 | /* check if CSBEF is set in device tree */ |
| 619 | ret = of_property_read_u32(nc, "fsl,csbef", &prop); |
| 620 | if (!ret) { |
| 621 | csmode &= ~(CSMODE_BEF(0xf)); |
| 622 | csmode |= CSMODE_BEF(prop); |
| 623 | } |
| 624 | |
| 625 | /* check if CSAFT is set in device tree */ |
| 626 | ret = of_property_read_u32(nc, "fsl,csaft", &prop); |
| 627 | if (!ret) { |
| 628 | csmode &= ~(CSMODE_AFT(0xf)); |
| 629 | csmode |= CSMODE_AFT(prop); |
| 630 | } |
| 631 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 632 | fsl_espi_write_reg(espi, ESPI_SPMODEx(cs), csmode); |
Heiner Kallweit | 456c742 | 2016-11-13 14:40:18 +0100 | [diff] [blame] | 633 | |
| 634 | if (initial) |
| 635 | dev_info(dev, "cs=%u, init_csmode=0x%x\n", cs, csmode); |
| 636 | } |
| 637 | |
| 638 | /* Enable SPI interface */ |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 639 | fsl_espi_write_reg(espi, ESPI_SPMODE, SPMODE_INIT_VAL | SPMODE_ENABLE); |
Heiner Kallweit | 456c742 | 2016-11-13 14:40:18 +0100 | [diff] [blame] | 640 | } |
| 641 | |
Heiner Kallweit | 604042a | 2016-09-17 15:43:31 +0200 | [diff] [blame] | 642 | static int fsl_espi_probe(struct device *dev, struct resource *mem, |
Heiner Kallweit | 7454346 | 2016-11-13 14:36:39 +0100 | [diff] [blame] | 643 | unsigned int irq, unsigned int num_cs) |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 644 | { |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 645 | struct spi_master *master; |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 646 | struct fsl_espi *espi; |
Heiner Kallweit | b497eb0 | 2016-10-01 21:07:52 +0200 | [diff] [blame] | 647 | int ret; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 648 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 649 | master = spi_alloc_master(dev, sizeof(struct fsl_espi)); |
Heiner Kallweit | 604042a | 2016-09-17 15:43:31 +0200 | [diff] [blame] | 650 | if (!master) |
| 651 | return -ENOMEM; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 652 | |
| 653 | dev_set_drvdata(dev, master); |
| 654 | |
Heiner Kallweit | 7cb5557 | 2016-11-13 14:37:41 +0100 | [diff] [blame] | 655 | master->mode_bits = SPI_RX_DUAL | SPI_CPOL | SPI_CPHA | SPI_CS_HIGH | |
| 656 | SPI_LSB_FIRST | SPI_LOOP; |
| 657 | master->dev.of_node = dev->of_node; |
Stephen Warren | 24778be | 2013-05-21 20:36:35 -0600 | [diff] [blame] | 658 | master->bits_per_word_mask = SPI_BPW_RANGE_MASK(4, 16); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 659 | master->setup = fsl_espi_setup; |
Axel Lin | d9f2674 | 2014-08-31 12:44:09 +0800 | [diff] [blame] | 660 | master->cleanup = fsl_espi_cleanup; |
Heiner Kallweit | c592bec | 2014-12-03 07:56:17 +0100 | [diff] [blame] | 661 | master->transfer_one_message = fsl_espi_do_one_msg; |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 662 | master->auto_runtime_pm = true; |
Heiner Kallweit | 02a595d | 2016-08-17 21:11:01 +0200 | [diff] [blame] | 663 | master->max_message_size = fsl_espi_max_message_size; |
Heiner Kallweit | 7454346 | 2016-11-13 14:36:39 +0100 | [diff] [blame] | 664 | master->num_chipselect = num_cs; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 665 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 666 | espi = spi_master_get_devdata(master); |
| 667 | spin_lock_init(&espi->lock); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 668 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 669 | espi->dev = dev; |
| 670 | espi->spibrg = fsl_get_sys_freq(); |
| 671 | if (espi->spibrg == -1) { |
Heiner Kallweit | 7cb5557 | 2016-11-13 14:37:41 +0100 | [diff] [blame] | 672 | dev_err(dev, "Can't get sys frequency!\n"); |
| 673 | ret = -EINVAL; |
| 674 | goto err_probe; |
| 675 | } |
| 676 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 677 | init_completion(&espi->done); |
Heiner Kallweit | 7cb5557 | 2016-11-13 14:37:41 +0100 | [diff] [blame] | 678 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 679 | espi->local_buf = devm_kmalloc(dev, SPCOM_TRANLEN_MAX, GFP_KERNEL); |
| 680 | if (!espi->local_buf) { |
Heiner Kallweit | 1423877 | 2016-09-07 22:50:22 +0200 | [diff] [blame] | 681 | ret = -ENOMEM; |
| 682 | goto err_probe; |
| 683 | } |
| 684 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 685 | espi->reg_base = devm_ioremap_resource(dev, mem); |
| 686 | if (IS_ERR(espi->reg_base)) { |
| 687 | ret = PTR_ERR(espi->reg_base); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 688 | goto err_probe; |
| 689 | } |
| 690 | |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 691 | /* Register for SPI Interrupt */ |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 692 | ret = devm_request_irq(dev, irq, fsl_espi_irq, 0, "fsl_espi", espi); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 693 | if (ret) |
Heiner Kallweit | 4178b6b | 2015-08-26 21:21:50 +0200 | [diff] [blame] | 694 | goto err_probe; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 695 | |
Heiner Kallweit | 456c742 | 2016-11-13 14:40:18 +0100 | [diff] [blame] | 696 | fsl_espi_init_regs(dev, true); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 697 | |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 698 | pm_runtime_set_autosuspend_delay(dev, AUTOSUSPEND_TIMEOUT); |
| 699 | pm_runtime_use_autosuspend(dev); |
| 700 | pm_runtime_set_active(dev); |
| 701 | pm_runtime_enable(dev); |
| 702 | pm_runtime_get_sync(dev); |
| 703 | |
Heiner Kallweit | 4178b6b | 2015-08-26 21:21:50 +0200 | [diff] [blame] | 704 | ret = devm_spi_register_master(dev, master); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 705 | if (ret < 0) |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 706 | goto err_pm; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 707 | |
Heiner Kallweit | 35ab046 | 2016-11-13 14:40:51 +0100 | [diff] [blame] | 708 | dev_info(dev, "at 0x%p (irq = %u)\n", espi->reg_base, irq); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 709 | |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 710 | pm_runtime_mark_last_busy(dev); |
| 711 | pm_runtime_put_autosuspend(dev); |
| 712 | |
Heiner Kallweit | 604042a | 2016-09-17 15:43:31 +0200 | [diff] [blame] | 713 | return 0; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 714 | |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 715 | err_pm: |
| 716 | pm_runtime_put_noidle(dev); |
| 717 | pm_runtime_disable(dev); |
| 718 | pm_runtime_set_suspended(dev); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 719 | err_probe: |
| 720 | spi_master_put(master); |
Heiner Kallweit | 604042a | 2016-09-17 15:43:31 +0200 | [diff] [blame] | 721 | return ret; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 722 | } |
| 723 | |
| 724 | static int of_fsl_espi_get_chipselects(struct device *dev) |
| 725 | { |
| 726 | struct device_node *np = dev->of_node; |
Heiner Kallweit | b497eb0 | 2016-10-01 21:07:52 +0200 | [diff] [blame] | 727 | u32 num_cs; |
| 728 | int ret; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 729 | |
Heiner Kallweit | b497eb0 | 2016-10-01 21:07:52 +0200 | [diff] [blame] | 730 | ret = of_property_read_u32(np, "fsl,espi-num-chipselects", &num_cs); |
| 731 | if (ret) { |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 732 | dev_err(dev, "No 'fsl,espi-num-chipselects' property\n"); |
Heiner Kallweit | 7454346 | 2016-11-13 14:36:39 +0100 | [diff] [blame] | 733 | return 0; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 734 | } |
| 735 | |
Heiner Kallweit | 7454346 | 2016-11-13 14:36:39 +0100 | [diff] [blame] | 736 | return num_cs; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 737 | } |
| 738 | |
Grant Likely | fd4a319 | 2012-12-07 16:57:14 +0000 | [diff] [blame] | 739 | static int of_fsl_espi_probe(struct platform_device *ofdev) |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 740 | { |
| 741 | struct device *dev = &ofdev->dev; |
| 742 | struct device_node *np = ofdev->dev.of_node; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 743 | struct resource mem; |
Heiner Kallweit | 7454346 | 2016-11-13 14:36:39 +0100 | [diff] [blame] | 744 | unsigned int irq, num_cs; |
Heiner Kallweit | acf6921 | 2016-09-17 15:43:00 +0200 | [diff] [blame] | 745 | int ret; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 746 | |
Heiner Kallweit | e3ce4f4 | 2016-11-13 14:37:18 +0100 | [diff] [blame] | 747 | if (of_property_read_bool(np, "mode")) { |
| 748 | dev_err(dev, "mode property is not supported on ESPI!\n"); |
| 749 | return -EINVAL; |
| 750 | } |
| 751 | |
Heiner Kallweit | 7454346 | 2016-11-13 14:36:39 +0100 | [diff] [blame] | 752 | num_cs = of_fsl_espi_get_chipselects(dev); |
| 753 | if (!num_cs) |
| 754 | return -EINVAL; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 755 | |
| 756 | ret = of_address_to_resource(np, 0, &mem); |
| 757 | if (ret) |
Heiner Kallweit | acf6921 | 2016-09-17 15:43:00 +0200 | [diff] [blame] | 758 | return ret; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 759 | |
Thierry Reding | f757849 | 2013-09-18 15:24:44 +0200 | [diff] [blame] | 760 | irq = irq_of_parse_and_map(np, 0); |
Heiner Kallweit | acf6921 | 2016-09-17 15:43:00 +0200 | [diff] [blame] | 761 | if (!irq) |
| 762 | return -EINVAL; |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 763 | |
Heiner Kallweit | 7454346 | 2016-11-13 14:36:39 +0100 | [diff] [blame] | 764 | return fsl_espi_probe(dev, &mem, irq, num_cs); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 765 | } |
| 766 | |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 767 | static int of_fsl_espi_remove(struct platform_device *dev) |
| 768 | { |
| 769 | pm_runtime_disable(&dev->dev); |
| 770 | |
| 771 | return 0; |
| 772 | } |
| 773 | |
Hou Zhiqiang | 714bb65 | 2013-12-12 12:53:52 +0800 | [diff] [blame] | 774 | #ifdef CONFIG_PM_SLEEP |
| 775 | static int of_fsl_espi_suspend(struct device *dev) |
| 776 | { |
| 777 | struct spi_master *master = dev_get_drvdata(dev); |
Hou Zhiqiang | 714bb65 | 2013-12-12 12:53:52 +0800 | [diff] [blame] | 778 | int ret; |
| 779 | |
Hou Zhiqiang | 714bb65 | 2013-12-12 12:53:52 +0800 | [diff] [blame] | 780 | ret = spi_master_suspend(master); |
| 781 | if (ret) { |
| 782 | dev_warn(dev, "cannot suspend master\n"); |
| 783 | return ret; |
| 784 | } |
| 785 | |
Heiner Kallweit | a9a813d | 2016-11-15 21:37:17 +0100 | [diff] [blame^] | 786 | return pm_runtime_force_suspend(dev); |
Hou Zhiqiang | 714bb65 | 2013-12-12 12:53:52 +0800 | [diff] [blame] | 787 | } |
| 788 | |
| 789 | static int of_fsl_espi_resume(struct device *dev) |
| 790 | { |
Hou Zhiqiang | 714bb65 | 2013-12-12 12:53:52 +0800 | [diff] [blame] | 791 | struct spi_master *master = dev_get_drvdata(dev); |
Heiner Kallweit | 456c742 | 2016-11-13 14:40:18 +0100 | [diff] [blame] | 792 | int ret; |
Hou Zhiqiang | 714bb65 | 2013-12-12 12:53:52 +0800 | [diff] [blame] | 793 | |
Heiner Kallweit | 456c742 | 2016-11-13 14:40:18 +0100 | [diff] [blame] | 794 | fsl_espi_init_regs(dev, false); |
Hou Zhiqiang | 714bb65 | 2013-12-12 12:53:52 +0800 | [diff] [blame] | 795 | |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 796 | ret = pm_runtime_force_resume(dev); |
| 797 | if (ret < 0) |
| 798 | return ret; |
| 799 | |
Hou Zhiqiang | 714bb65 | 2013-12-12 12:53:52 +0800 | [diff] [blame] | 800 | return spi_master_resume(master); |
| 801 | } |
| 802 | #endif /* CONFIG_PM_SLEEP */ |
| 803 | |
| 804 | static const struct dev_pm_ops espi_pm = { |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 805 | SET_RUNTIME_PM_OPS(fsl_espi_runtime_suspend, |
| 806 | fsl_espi_runtime_resume, NULL) |
Hou Zhiqiang | 714bb65 | 2013-12-12 12:53:52 +0800 | [diff] [blame] | 807 | SET_SYSTEM_SLEEP_PM_OPS(of_fsl_espi_suspend, of_fsl_espi_resume) |
| 808 | }; |
| 809 | |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 810 | static const struct of_device_id of_fsl_espi_match[] = { |
| 811 | { .compatible = "fsl,mpc8536-espi" }, |
| 812 | {} |
| 813 | }; |
| 814 | MODULE_DEVICE_TABLE(of, of_fsl_espi_match); |
| 815 | |
Grant Likely | 18d306d | 2011-02-22 21:02:43 -0700 | [diff] [blame] | 816 | static struct platform_driver fsl_espi_driver = { |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 817 | .driver = { |
| 818 | .name = "fsl_espi", |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 819 | .of_match_table = of_fsl_espi_match, |
Hou Zhiqiang | 714bb65 | 2013-12-12 12:53:52 +0800 | [diff] [blame] | 820 | .pm = &espi_pm, |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 821 | }, |
| 822 | .probe = of_fsl_espi_probe, |
Heiner Kallweit | e9abb4d | 2015-08-26 21:21:55 +0200 | [diff] [blame] | 823 | .remove = of_fsl_espi_remove, |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 824 | }; |
Grant Likely | 940ab88 | 2011-10-05 11:29:49 -0600 | [diff] [blame] | 825 | module_platform_driver(fsl_espi_driver); |
Mingkai Hu | 8b60d6c | 2010-10-12 18:18:32 +0800 | [diff] [blame] | 826 | |
| 827 | MODULE_AUTHOR("Mingkai Hu"); |
| 828 | MODULE_DESCRIPTION("Enhanced Freescale SPI Driver"); |
| 829 | MODULE_LICENSE("GPL"); |