reiserfs: Fix spurious unlock in reiserfs_fill_super() error handling
[linux/fpc-iii.git] / drivers / spi / spi-uniphier.c
blob47cde1864630e02b5e3c8d253bb636c698cebdb9
1 // SPDX-License-Identifier: GPL-2.0
2 // spi-uniphier.c - Socionext UniPhier SPI controller driver
3 // Copyright 2012 Panasonic Corporation
4 // Copyright 2016-2018 Socionext Inc.
6 #include <linux/kernel.h>
7 #include <linux/bitfield.h>
8 #include <linux/bitops.h>
9 #include <linux/clk.h>
10 #include <linux/delay.h>
11 #include <linux/interrupt.h>
12 #include <linux/io.h>
13 #include <linux/module.h>
14 #include <linux/platform_device.h>
15 #include <linux/spi/spi.h>
17 #include <asm/unaligned.h>
19 #define SSI_TIMEOUT_MS 2000
20 #define SSI_POLL_TIMEOUT_US 200
21 #define SSI_MAX_CLK_DIVIDER 254
22 #define SSI_MIN_CLK_DIVIDER 4
24 struct uniphier_spi_priv {
25 void __iomem *base;
26 struct clk *clk;
27 struct spi_master *master;
28 struct completion xfer_done;
30 int error;
31 unsigned int tx_bytes;
32 unsigned int rx_bytes;
33 const u8 *tx_buf;
34 u8 *rx_buf;
36 bool is_save_param;
37 u8 bits_per_word;
38 u16 mode;
39 u32 speed_hz;
42 #define SSI_CTL 0x00
43 #define SSI_CTL_EN BIT(0)
45 #define SSI_CKS 0x04
46 #define SSI_CKS_CKRAT_MASK GENMASK(7, 0)
47 #define SSI_CKS_CKPHS BIT(14)
48 #define SSI_CKS_CKINIT BIT(13)
49 #define SSI_CKS_CKDLY BIT(12)
51 #define SSI_TXWDS 0x08
52 #define SSI_TXWDS_WDLEN_MASK GENMASK(13, 8)
53 #define SSI_TXWDS_TDTF_MASK GENMASK(7, 6)
54 #define SSI_TXWDS_DTLEN_MASK GENMASK(5, 0)
56 #define SSI_RXWDS 0x0c
57 #define SSI_RXWDS_DTLEN_MASK GENMASK(5, 0)
59 #define SSI_FPS 0x10
60 #define SSI_FPS_FSPOL BIT(15)
61 #define SSI_FPS_FSTRT BIT(14)
63 #define SSI_SR 0x14
64 #define SSI_SR_RNE BIT(0)
66 #define SSI_IE 0x18
67 #define SSI_IE_RCIE BIT(3)
68 #define SSI_IE_RORIE BIT(0)
70 #define SSI_IS 0x1c
71 #define SSI_IS_RXRS BIT(9)
72 #define SSI_IS_RCID BIT(3)
73 #define SSI_IS_RORID BIT(0)
75 #define SSI_IC 0x1c
76 #define SSI_IC_TCIC BIT(4)
77 #define SSI_IC_RCIC BIT(3)
78 #define SSI_IC_RORIC BIT(0)
80 #define SSI_FC 0x20
81 #define SSI_FC_TXFFL BIT(12)
82 #define SSI_FC_TXFTH_MASK GENMASK(11, 8)
83 #define SSI_FC_RXFFL BIT(4)
84 #define SSI_FC_RXFTH_MASK GENMASK(3, 0)
86 #define SSI_TXDR 0x24
87 #define SSI_RXDR 0x24
89 #define SSI_FIFO_DEPTH 8U
91 static inline unsigned int bytes_per_word(unsigned int bits)
93 return bits <= 8 ? 1 : (bits <= 16 ? 2 : 4);
96 static inline void uniphier_spi_irq_enable(struct spi_device *spi, u32 mask)
98 struct uniphier_spi_priv *priv = spi_master_get_devdata(spi->master);
99 u32 val;
101 val = readl(priv->base + SSI_IE);
102 val |= mask;
103 writel(val, priv->base + SSI_IE);
106 static inline void uniphier_spi_irq_disable(struct spi_device *spi, u32 mask)
108 struct uniphier_spi_priv *priv = spi_master_get_devdata(spi->master);
109 u32 val;
111 val = readl(priv->base + SSI_IE);
112 val &= ~mask;
113 writel(val, priv->base + SSI_IE);
116 static void uniphier_spi_set_mode(struct spi_device *spi)
118 struct uniphier_spi_priv *priv = spi_master_get_devdata(spi->master);
119 u32 val1, val2;
122 * clock setting
123 * CKPHS capture timing. 0:rising edge, 1:falling edge
124 * CKINIT clock initial level. 0:low, 1:high
125 * CKDLY clock delay. 0:no delay, 1:delay depending on FSTRT
126 * (FSTRT=0: 1 clock, FSTRT=1: 0.5 clock)
128 * frame setting
129 * FSPOL frame signal porarity. 0: low, 1: high
130 * FSTRT start frame timing
131 * 0: rising edge of clock, 1: falling edge of clock
133 switch (spi->mode & (SPI_CPOL | SPI_CPHA)) {
134 case SPI_MODE_0:
135 /* CKPHS=1, CKINIT=0, CKDLY=1, FSTRT=0 */
136 val1 = SSI_CKS_CKPHS | SSI_CKS_CKDLY;
137 val2 = 0;
138 break;
139 case SPI_MODE_1:
140 /* CKPHS=0, CKINIT=0, CKDLY=0, FSTRT=1 */
141 val1 = 0;
142 val2 = SSI_FPS_FSTRT;
143 break;
144 case SPI_MODE_2:
145 /* CKPHS=0, CKINIT=1, CKDLY=1, FSTRT=1 */
146 val1 = SSI_CKS_CKINIT | SSI_CKS_CKDLY;
147 val2 = SSI_FPS_FSTRT;
148 break;
149 case SPI_MODE_3:
150 /* CKPHS=1, CKINIT=1, CKDLY=0, FSTRT=0 */
151 val1 = SSI_CKS_CKPHS | SSI_CKS_CKINIT;
152 val2 = 0;
153 break;
156 if (!(spi->mode & SPI_CS_HIGH))
157 val2 |= SSI_FPS_FSPOL;
159 writel(val1, priv->base + SSI_CKS);
160 writel(val2, priv->base + SSI_FPS);
162 val1 = 0;
163 if (spi->mode & SPI_LSB_FIRST)
164 val1 |= FIELD_PREP(SSI_TXWDS_TDTF_MASK, 1);
165 writel(val1, priv->base + SSI_TXWDS);
166 writel(val1, priv->base + SSI_RXWDS);
169 static void uniphier_spi_set_transfer_size(struct spi_device *spi, int size)
171 struct uniphier_spi_priv *priv = spi_master_get_devdata(spi->master);
172 u32 val;
174 val = readl(priv->base + SSI_TXWDS);
175 val &= ~(SSI_TXWDS_WDLEN_MASK | SSI_TXWDS_DTLEN_MASK);
176 val |= FIELD_PREP(SSI_TXWDS_WDLEN_MASK, size);
177 val |= FIELD_PREP(SSI_TXWDS_DTLEN_MASK, size);
178 writel(val, priv->base + SSI_TXWDS);
180 val = readl(priv->base + SSI_RXWDS);
181 val &= ~SSI_RXWDS_DTLEN_MASK;
182 val |= FIELD_PREP(SSI_RXWDS_DTLEN_MASK, size);
183 writel(val, priv->base + SSI_RXWDS);
186 static void uniphier_spi_set_baudrate(struct spi_device *spi,
187 unsigned int speed)
189 struct uniphier_spi_priv *priv = spi_master_get_devdata(spi->master);
190 u32 val, ckdiv;
193 * the supported rates are even numbers from 4 to 254. (4,6,8...254)
194 * round up as we look for equal or less speed
196 ckdiv = DIV_ROUND_UP(clk_get_rate(priv->clk), speed);
197 ckdiv = round_up(ckdiv, 2);
199 val = readl(priv->base + SSI_CKS);
200 val &= ~SSI_CKS_CKRAT_MASK;
201 val |= ckdiv & SSI_CKS_CKRAT_MASK;
202 writel(val, priv->base + SSI_CKS);
205 static void uniphier_spi_setup_transfer(struct spi_device *spi,
206 struct spi_transfer *t)
208 struct uniphier_spi_priv *priv = spi_master_get_devdata(spi->master);
209 u32 val;
211 priv->error = 0;
212 priv->tx_buf = t->tx_buf;
213 priv->rx_buf = t->rx_buf;
214 priv->tx_bytes = priv->rx_bytes = t->len;
216 if (!priv->is_save_param || priv->mode != spi->mode) {
217 uniphier_spi_set_mode(spi);
218 priv->mode = spi->mode;
219 priv->is_save_param = false;
222 if (!priv->is_save_param || priv->bits_per_word != t->bits_per_word) {
223 uniphier_spi_set_transfer_size(spi, t->bits_per_word);
224 priv->bits_per_word = t->bits_per_word;
227 if (!priv->is_save_param || priv->speed_hz != t->speed_hz) {
228 uniphier_spi_set_baudrate(spi, t->speed_hz);
229 priv->speed_hz = t->speed_hz;
232 priv->is_save_param = true;
234 /* reset FIFOs */
235 val = SSI_FC_TXFFL | SSI_FC_RXFFL;
236 writel(val, priv->base + SSI_FC);
239 static void uniphier_spi_send(struct uniphier_spi_priv *priv)
241 int wsize;
242 u32 val = 0;
244 wsize = min(bytes_per_word(priv->bits_per_word), priv->tx_bytes);
245 priv->tx_bytes -= wsize;
247 if (priv->tx_buf) {
248 switch (wsize) {
249 case 1:
250 val = *priv->tx_buf;
251 break;
252 case 2:
253 val = get_unaligned_le16(priv->tx_buf);
254 break;
255 case 4:
256 val = get_unaligned_le32(priv->tx_buf);
257 break;
260 priv->tx_buf += wsize;
263 writel(val, priv->base + SSI_TXDR);
266 static void uniphier_spi_recv(struct uniphier_spi_priv *priv)
268 int rsize;
269 u32 val;
271 rsize = min(bytes_per_word(priv->bits_per_word), priv->rx_bytes);
272 priv->rx_bytes -= rsize;
274 val = readl(priv->base + SSI_RXDR);
276 if (priv->rx_buf) {
277 switch (rsize) {
278 case 1:
279 *priv->rx_buf = val;
280 break;
281 case 2:
282 put_unaligned_le16(val, priv->rx_buf);
283 break;
284 case 4:
285 put_unaligned_le32(val, priv->rx_buf);
286 break;
289 priv->rx_buf += rsize;
293 static void uniphier_spi_fill_tx_fifo(struct uniphier_spi_priv *priv)
295 unsigned int fifo_threshold, fill_bytes;
296 u32 val;
298 fifo_threshold = DIV_ROUND_UP(priv->rx_bytes,
299 bytes_per_word(priv->bits_per_word));
300 fifo_threshold = min(fifo_threshold, SSI_FIFO_DEPTH);
302 fill_bytes = fifo_threshold - (priv->rx_bytes - priv->tx_bytes);
304 /* set fifo threshold */
305 val = readl(priv->base + SSI_FC);
306 val &= ~(SSI_FC_TXFTH_MASK | SSI_FC_RXFTH_MASK);
307 val |= FIELD_PREP(SSI_FC_TXFTH_MASK, fifo_threshold);
308 val |= FIELD_PREP(SSI_FC_RXFTH_MASK, fifo_threshold);
309 writel(val, priv->base + SSI_FC);
311 while (fill_bytes--)
312 uniphier_spi_send(priv);
315 static void uniphier_spi_set_cs(struct spi_device *spi, bool enable)
317 struct uniphier_spi_priv *priv = spi_master_get_devdata(spi->master);
318 u32 val;
320 val = readl(priv->base + SSI_FPS);
322 if (enable)
323 val |= SSI_FPS_FSPOL;
324 else
325 val &= ~SSI_FPS_FSPOL;
327 writel(val, priv->base + SSI_FPS);
330 static int uniphier_spi_transfer_one_irq(struct spi_master *master,
331 struct spi_device *spi,
332 struct spi_transfer *t)
334 struct uniphier_spi_priv *priv = spi_master_get_devdata(master);
335 struct device *dev = master->dev.parent;
336 unsigned long time_left;
338 reinit_completion(&priv->xfer_done);
340 uniphier_spi_fill_tx_fifo(priv);
342 uniphier_spi_irq_enable(spi, SSI_IE_RCIE | SSI_IE_RORIE);
344 time_left = wait_for_completion_timeout(&priv->xfer_done,
345 msecs_to_jiffies(SSI_TIMEOUT_MS));
347 uniphier_spi_irq_disable(spi, SSI_IE_RCIE | SSI_IE_RORIE);
349 if (!time_left) {
350 dev_err(dev, "transfer timeout.\n");
351 return -ETIMEDOUT;
354 return priv->error;
357 static int uniphier_spi_transfer_one_poll(struct spi_master *master,
358 struct spi_device *spi,
359 struct spi_transfer *t)
361 struct uniphier_spi_priv *priv = spi_master_get_devdata(master);
362 int loop = SSI_POLL_TIMEOUT_US * 10;
364 while (priv->tx_bytes) {
365 uniphier_spi_fill_tx_fifo(priv);
367 while ((priv->rx_bytes - priv->tx_bytes) > 0) {
368 while (!(readl(priv->base + SSI_SR) & SSI_SR_RNE)
369 && loop--)
370 ndelay(100);
372 if (loop == -1)
373 goto irq_transfer;
375 uniphier_spi_recv(priv);
379 return 0;
381 irq_transfer:
382 return uniphier_spi_transfer_one_irq(master, spi, t);
385 static int uniphier_spi_transfer_one(struct spi_master *master,
386 struct spi_device *spi,
387 struct spi_transfer *t)
389 struct uniphier_spi_priv *priv = spi_master_get_devdata(master);
390 unsigned long threshold;
392 /* Terminate and return success for 0 byte length transfer */
393 if (!t->len)
394 return 0;
396 uniphier_spi_setup_transfer(spi, t);
399 * If the transfer operation will take longer than
400 * SSI_POLL_TIMEOUT_US, it should use irq.
402 threshold = DIV_ROUND_UP(SSI_POLL_TIMEOUT_US * priv->speed_hz,
403 USEC_PER_SEC * BITS_PER_BYTE);
404 if (t->len > threshold)
405 return uniphier_spi_transfer_one_irq(master, spi, t);
406 else
407 return uniphier_spi_transfer_one_poll(master, spi, t);
410 static int uniphier_spi_prepare_transfer_hardware(struct spi_master *master)
412 struct uniphier_spi_priv *priv = spi_master_get_devdata(master);
414 writel(SSI_CTL_EN, priv->base + SSI_CTL);
416 return 0;
419 static int uniphier_spi_unprepare_transfer_hardware(struct spi_master *master)
421 struct uniphier_spi_priv *priv = spi_master_get_devdata(master);
423 writel(0, priv->base + SSI_CTL);
425 return 0;
428 static irqreturn_t uniphier_spi_handler(int irq, void *dev_id)
430 struct uniphier_spi_priv *priv = dev_id;
431 u32 val, stat;
433 stat = readl(priv->base + SSI_IS);
434 val = SSI_IC_TCIC | SSI_IC_RCIC | SSI_IC_RORIC;
435 writel(val, priv->base + SSI_IC);
437 /* rx fifo overrun */
438 if (stat & SSI_IS_RORID) {
439 priv->error = -EIO;
440 goto done;
443 /* rx complete */
444 if ((stat & SSI_IS_RCID) && (stat & SSI_IS_RXRS)) {
445 while ((readl(priv->base + SSI_SR) & SSI_SR_RNE) &&
446 (priv->rx_bytes - priv->tx_bytes) > 0)
447 uniphier_spi_recv(priv);
449 if ((readl(priv->base + SSI_SR) & SSI_SR_RNE) ||
450 (priv->rx_bytes != priv->tx_bytes)) {
451 priv->error = -EIO;
452 goto done;
453 } else if (priv->rx_bytes == 0)
454 goto done;
456 /* next tx transfer */
457 uniphier_spi_fill_tx_fifo(priv);
459 return IRQ_HANDLED;
462 return IRQ_NONE;
464 done:
465 complete(&priv->xfer_done);
466 return IRQ_HANDLED;
469 static int uniphier_spi_probe(struct platform_device *pdev)
471 struct uniphier_spi_priv *priv;
472 struct spi_master *master;
473 unsigned long clk_rate;
474 int irq;
475 int ret;
477 master = spi_alloc_master(&pdev->dev, sizeof(*priv));
478 if (!master)
479 return -ENOMEM;
481 platform_set_drvdata(pdev, master);
483 priv = spi_master_get_devdata(master);
484 priv->master = master;
485 priv->is_save_param = false;
487 priv->base = devm_platform_ioremap_resource(pdev, 0);
488 if (IS_ERR(priv->base)) {
489 ret = PTR_ERR(priv->base);
490 goto out_master_put;
493 priv->clk = devm_clk_get(&pdev->dev, NULL);
494 if (IS_ERR(priv->clk)) {
495 dev_err(&pdev->dev, "failed to get clock\n");
496 ret = PTR_ERR(priv->clk);
497 goto out_master_put;
500 ret = clk_prepare_enable(priv->clk);
501 if (ret)
502 goto out_master_put;
504 irq = platform_get_irq(pdev, 0);
505 if (irq < 0) {
506 ret = irq;
507 goto out_disable_clk;
510 ret = devm_request_irq(&pdev->dev, irq, uniphier_spi_handler,
511 0, "uniphier-spi", priv);
512 if (ret) {
513 dev_err(&pdev->dev, "failed to request IRQ\n");
514 goto out_disable_clk;
517 init_completion(&priv->xfer_done);
519 clk_rate = clk_get_rate(priv->clk);
521 master->max_speed_hz = DIV_ROUND_UP(clk_rate, SSI_MIN_CLK_DIVIDER);
522 master->min_speed_hz = DIV_ROUND_UP(clk_rate, SSI_MAX_CLK_DIVIDER);
523 master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_CS_HIGH | SPI_LSB_FIRST;
524 master->dev.of_node = pdev->dev.of_node;
525 master->bus_num = pdev->id;
526 master->bits_per_word_mask = SPI_BPW_RANGE_MASK(1, 32);
528 master->set_cs = uniphier_spi_set_cs;
529 master->transfer_one = uniphier_spi_transfer_one;
530 master->prepare_transfer_hardware
531 = uniphier_spi_prepare_transfer_hardware;
532 master->unprepare_transfer_hardware
533 = uniphier_spi_unprepare_transfer_hardware;
534 master->num_chipselect = 1;
536 ret = devm_spi_register_master(&pdev->dev, master);
537 if (ret)
538 goto out_disable_clk;
540 return 0;
542 out_disable_clk:
543 clk_disable_unprepare(priv->clk);
545 out_master_put:
546 spi_master_put(master);
547 return ret;
550 static int uniphier_spi_remove(struct platform_device *pdev)
552 struct uniphier_spi_priv *priv = platform_get_drvdata(pdev);
554 clk_disable_unprepare(priv->clk);
556 return 0;
559 static const struct of_device_id uniphier_spi_match[] = {
560 { .compatible = "socionext,uniphier-scssi" },
561 { /* sentinel */ }
563 MODULE_DEVICE_TABLE(of, uniphier_spi_match);
565 static struct platform_driver uniphier_spi_driver = {
566 .probe = uniphier_spi_probe,
567 .remove = uniphier_spi_remove,
568 .driver = {
569 .name = "uniphier-spi",
570 .of_match_table = uniphier_spi_match,
573 module_platform_driver(uniphier_spi_driver);
575 MODULE_AUTHOR("Kunihiko Hayashi <hayashi.kunihiko@socionext.com>");
576 MODULE_AUTHOR("Keiji Hayashibara <hayashibara.keiji@socionext.com>");
577 MODULE_DESCRIPTION("Socionext UniPhier SPI controller driver");
578 MODULE_LICENSE("GPL v2");