2 * Copyright (C) 2005 Stephen Street / StreetFire Sound Labs
3 * Copyright (C) 2013, Intel Corporation
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
16 #include <linux/bitops.h>
17 #include <linux/init.h>
18 #include <linux/module.h>
19 #include <linux/device.h>
20 #include <linux/ioport.h>
21 #include <linux/errno.h>
22 #include <linux/err.h>
23 #include <linux/interrupt.h>
24 #include <linux/kernel.h>
25 #include <linux/pci.h>
26 #include <linux/platform_device.h>
27 #include <linux/spi/pxa2xx_spi.h>
28 #include <linux/spi/spi.h>
29 #include <linux/delay.h>
30 #include <linux/gpio.h>
31 #include <linux/slab.h>
32 #include <linux/clk.h>
33 #include <linux/pm_runtime.h>
34 #include <linux/acpi.h>
36 #include "spi-pxa2xx.h"
38 MODULE_AUTHOR("Stephen Street");
39 MODULE_DESCRIPTION("PXA2xx SSP SPI Controller");
40 MODULE_LICENSE("GPL");
41 MODULE_ALIAS("platform:pxa2xx-spi");
43 #define TIMOUT_DFLT 1000
46 * for testing SSCR1 changes that require SSP restart, basically
47 * everything except the service and interrupt enables, the pxa270 developer
48 * manual says only SSCR1_SCFR, SSCR1_SPH, SSCR1_SPO need to be in this
49 * list, but the PXA255 dev man says all bits without really meaning the
50 * service and interrupt enables
52 #define SSCR1_CHANGE_MASK (SSCR1_TTELP | SSCR1_TTE | SSCR1_SCFR \
53 | SSCR1_ECRA | SSCR1_ECRB | SSCR1_SCLKDIR \
54 | SSCR1_SFRMDIR | SSCR1_RWOT | SSCR1_TRAIL \
55 | SSCR1_IFS | SSCR1_STRF | SSCR1_EFWR \
56 | SSCR1_RFT | SSCR1_TFT | SSCR1_MWDS \
57 | SSCR1_SPH | SSCR1_SPO | SSCR1_LBM)
59 #define QUARK_X1000_SSCR1_CHANGE_MASK (QUARK_X1000_SSCR1_STRF \
60 | QUARK_X1000_SSCR1_EFWR \
61 | QUARK_X1000_SSCR1_RFT \
62 | QUARK_X1000_SSCR1_TFT \
63 | SSCR1_SPH | SSCR1_SPO | SSCR1_LBM)
65 #define LPSS_GENERAL_REG_RXTO_HOLDOFF_DISABLE BIT(24)
66 #define LPSS_CS_CONTROL_SW_MODE BIT(0)
67 #define LPSS_CS_CONTROL_CS_HIGH BIT(1)
68 #define LPSS_CAPS_CS_EN_SHIFT 9
69 #define LPSS_CAPS_CS_EN_MASK (0xf << LPSS_CAPS_CS_EN_SHIFT)
72 /* LPSS offset from drv_data->ioaddr */
74 /* Register offsets from drv_data->lpss_base or -1 */
83 /* Chip select control */
84 unsigned cs_sel_shift
;
89 /* Keep these sorted with enum pxa_ssp_type */
90 static const struct lpss_config lpss_platforms
[] = {
96 .reg_capabilities
= -1,
98 .tx_threshold_lo
= 160,
99 .tx_threshold_hi
= 224,
106 .reg_capabilities
= -1,
108 .tx_threshold_lo
= 160,
109 .tx_threshold_hi
= 224,
116 .reg_capabilities
= -1,
118 .tx_threshold_lo
= 160,
119 .tx_threshold_hi
= 224,
121 .cs_sel_mask
= 1 << 2,
129 .reg_capabilities
= 0xfc,
131 .tx_threshold_lo
= 32,
132 .tx_threshold_hi
= 56,
139 .reg_capabilities
= 0xfc,
141 .tx_threshold_lo
= 16,
142 .tx_threshold_hi
= 48,
144 .cs_sel_mask
= 3 << 8,
148 static inline const struct lpss_config
149 *lpss_get_config(const struct driver_data
*drv_data
)
151 return &lpss_platforms
[drv_data
->ssp_type
- LPSS_LPT_SSP
];
154 static bool is_lpss_ssp(const struct driver_data
*drv_data
)
156 switch (drv_data
->ssp_type
) {
168 static bool is_quark_x1000_ssp(const struct driver_data
*drv_data
)
170 return drv_data
->ssp_type
== QUARK_X1000_SSP
;
173 static u32
pxa2xx_spi_get_ssrc1_change_mask(const struct driver_data
*drv_data
)
175 switch (drv_data
->ssp_type
) {
176 case QUARK_X1000_SSP
:
177 return QUARK_X1000_SSCR1_CHANGE_MASK
;
179 return SSCR1_CHANGE_MASK
;
184 pxa2xx_spi_get_rx_default_thre(const struct driver_data
*drv_data
)
186 switch (drv_data
->ssp_type
) {
187 case QUARK_X1000_SSP
:
188 return RX_THRESH_QUARK_X1000_DFLT
;
190 return RX_THRESH_DFLT
;
194 static bool pxa2xx_spi_txfifo_full(const struct driver_data
*drv_data
)
198 switch (drv_data
->ssp_type
) {
199 case QUARK_X1000_SSP
:
200 mask
= QUARK_X1000_SSSR_TFL_MASK
;
203 mask
= SSSR_TFL_MASK
;
207 return (pxa2xx_spi_read(drv_data
, SSSR
) & mask
) == mask
;
210 static void pxa2xx_spi_clear_rx_thre(const struct driver_data
*drv_data
,
215 switch (drv_data
->ssp_type
) {
216 case QUARK_X1000_SSP
:
217 mask
= QUARK_X1000_SSCR1_RFT
;
226 static void pxa2xx_spi_set_rx_thre(const struct driver_data
*drv_data
,
227 u32
*sccr1_reg
, u32 threshold
)
229 switch (drv_data
->ssp_type
) {
230 case QUARK_X1000_SSP
:
231 *sccr1_reg
|= QUARK_X1000_SSCR1_RxTresh(threshold
);
234 *sccr1_reg
|= SSCR1_RxTresh(threshold
);
239 static u32
pxa2xx_configure_sscr0(const struct driver_data
*drv_data
,
240 u32 clk_div
, u8 bits
)
242 switch (drv_data
->ssp_type
) {
243 case QUARK_X1000_SSP
:
245 | QUARK_X1000_SSCR0_Motorola
246 | QUARK_X1000_SSCR0_DataSize(bits
> 32 ? 8 : bits
)
251 | SSCR0_DataSize(bits
> 16 ? bits
- 16 : bits
)
253 | (bits
> 16 ? SSCR0_EDSS
: 0);
258 * Read and write LPSS SSP private registers. Caller must first check that
259 * is_lpss_ssp() returns true before these can be called.
261 static u32
__lpss_ssp_read_priv(struct driver_data
*drv_data
, unsigned offset
)
263 WARN_ON(!drv_data
->lpss_base
);
264 return readl(drv_data
->lpss_base
+ offset
);
267 static void __lpss_ssp_write_priv(struct driver_data
*drv_data
,
268 unsigned offset
, u32 value
)
270 WARN_ON(!drv_data
->lpss_base
);
271 writel(value
, drv_data
->lpss_base
+ offset
);
275 * lpss_ssp_setup - perform LPSS SSP specific setup
276 * @drv_data: pointer to the driver private data
278 * Perform LPSS SSP specific setup. This function must be called first if
279 * one is going to use LPSS SSP private registers.
281 static void lpss_ssp_setup(struct driver_data
*drv_data
)
283 const struct lpss_config
*config
;
286 config
= lpss_get_config(drv_data
);
287 drv_data
->lpss_base
= drv_data
->ioaddr
+ config
->offset
;
289 /* Enable software chip select control */
290 value
= __lpss_ssp_read_priv(drv_data
, config
->reg_cs_ctrl
);
291 value
&= ~(LPSS_CS_CONTROL_SW_MODE
| LPSS_CS_CONTROL_CS_HIGH
);
292 value
|= LPSS_CS_CONTROL_SW_MODE
| LPSS_CS_CONTROL_CS_HIGH
;
293 __lpss_ssp_write_priv(drv_data
, config
->reg_cs_ctrl
, value
);
295 /* Enable multiblock DMA transfers */
296 if (drv_data
->master_info
->enable_dma
) {
297 __lpss_ssp_write_priv(drv_data
, config
->reg_ssp
, 1);
299 if (config
->reg_general
>= 0) {
300 value
= __lpss_ssp_read_priv(drv_data
,
301 config
->reg_general
);
302 value
|= LPSS_GENERAL_REG_RXTO_HOLDOFF_DISABLE
;
303 __lpss_ssp_write_priv(drv_data
,
304 config
->reg_general
, value
);
309 static void lpss_ssp_select_cs(struct driver_data
*drv_data
,
310 const struct lpss_config
*config
)
314 if (!config
->cs_sel_mask
)
317 value
= __lpss_ssp_read_priv(drv_data
, config
->reg_cs_ctrl
);
319 cs
= drv_data
->cur_msg
->spi
->chip_select
;
320 cs
<<= config
->cs_sel_shift
;
321 if (cs
!= (value
& config
->cs_sel_mask
)) {
323 * When switching another chip select output active the
324 * output must be selected first and wait 2 ssp_clk cycles
325 * before changing state to active. Otherwise a short
326 * glitch will occur on the previous chip select since
327 * output select is latched but state control is not.
329 value
&= ~config
->cs_sel_mask
;
331 __lpss_ssp_write_priv(drv_data
,
332 config
->reg_cs_ctrl
, value
);
334 (drv_data
->master
->max_speed_hz
/ 2));
338 static void lpss_ssp_cs_control(struct driver_data
*drv_data
, bool enable
)
340 const struct lpss_config
*config
;
343 config
= lpss_get_config(drv_data
);
346 lpss_ssp_select_cs(drv_data
, config
);
348 value
= __lpss_ssp_read_priv(drv_data
, config
->reg_cs_ctrl
);
350 value
&= ~LPSS_CS_CONTROL_CS_HIGH
;
352 value
|= LPSS_CS_CONTROL_CS_HIGH
;
353 __lpss_ssp_write_priv(drv_data
, config
->reg_cs_ctrl
, value
);
356 static void cs_assert(struct driver_data
*drv_data
)
358 struct chip_data
*chip
= drv_data
->cur_chip
;
360 if (drv_data
->ssp_type
== CE4100_SSP
) {
361 pxa2xx_spi_write(drv_data
, SSSR
, drv_data
->cur_chip
->frm
);
365 if (chip
->cs_control
) {
366 chip
->cs_control(PXA2XX_CS_ASSERT
);
370 if (gpio_is_valid(chip
->gpio_cs
)) {
371 gpio_set_value(chip
->gpio_cs
, chip
->gpio_cs_inverted
);
375 if (is_lpss_ssp(drv_data
))
376 lpss_ssp_cs_control(drv_data
, true);
379 static void cs_deassert(struct driver_data
*drv_data
)
381 struct chip_data
*chip
= drv_data
->cur_chip
;
383 if (drv_data
->ssp_type
== CE4100_SSP
)
386 if (chip
->cs_control
) {
387 chip
->cs_control(PXA2XX_CS_DEASSERT
);
391 if (gpio_is_valid(chip
->gpio_cs
)) {
392 gpio_set_value(chip
->gpio_cs
, !chip
->gpio_cs_inverted
);
396 if (is_lpss_ssp(drv_data
))
397 lpss_ssp_cs_control(drv_data
, false);
400 int pxa2xx_spi_flush(struct driver_data
*drv_data
)
402 unsigned long limit
= loops_per_jiffy
<< 1;
405 while (pxa2xx_spi_read(drv_data
, SSSR
) & SSSR_RNE
)
406 pxa2xx_spi_read(drv_data
, SSDR
);
407 } while ((pxa2xx_spi_read(drv_data
, SSSR
) & SSSR_BSY
) && --limit
);
408 write_SSSR_CS(drv_data
, SSSR_ROR
);
413 static int null_writer(struct driver_data
*drv_data
)
415 u8 n_bytes
= drv_data
->n_bytes
;
417 if (pxa2xx_spi_txfifo_full(drv_data
)
418 || (drv_data
->tx
== drv_data
->tx_end
))
421 pxa2xx_spi_write(drv_data
, SSDR
, 0);
422 drv_data
->tx
+= n_bytes
;
427 static int null_reader(struct driver_data
*drv_data
)
429 u8 n_bytes
= drv_data
->n_bytes
;
431 while ((pxa2xx_spi_read(drv_data
, SSSR
) & SSSR_RNE
)
432 && (drv_data
->rx
< drv_data
->rx_end
)) {
433 pxa2xx_spi_read(drv_data
, SSDR
);
434 drv_data
->rx
+= n_bytes
;
437 return drv_data
->rx
== drv_data
->rx_end
;
440 static int u8_writer(struct driver_data
*drv_data
)
442 if (pxa2xx_spi_txfifo_full(drv_data
)
443 || (drv_data
->tx
== drv_data
->tx_end
))
446 pxa2xx_spi_write(drv_data
, SSDR
, *(u8
*)(drv_data
->tx
));
452 static int u8_reader(struct driver_data
*drv_data
)
454 while ((pxa2xx_spi_read(drv_data
, SSSR
) & SSSR_RNE
)
455 && (drv_data
->rx
< drv_data
->rx_end
)) {
456 *(u8
*)(drv_data
->rx
) = pxa2xx_spi_read(drv_data
, SSDR
);
460 return drv_data
->rx
== drv_data
->rx_end
;
463 static int u16_writer(struct driver_data
*drv_data
)
465 if (pxa2xx_spi_txfifo_full(drv_data
)
466 || (drv_data
->tx
== drv_data
->tx_end
))
469 pxa2xx_spi_write(drv_data
, SSDR
, *(u16
*)(drv_data
->tx
));
475 static int u16_reader(struct driver_data
*drv_data
)
477 while ((pxa2xx_spi_read(drv_data
, SSSR
) & SSSR_RNE
)
478 && (drv_data
->rx
< drv_data
->rx_end
)) {
479 *(u16
*)(drv_data
->rx
) = pxa2xx_spi_read(drv_data
, SSDR
);
483 return drv_data
->rx
== drv_data
->rx_end
;
486 static int u32_writer(struct driver_data
*drv_data
)
488 if (pxa2xx_spi_txfifo_full(drv_data
)
489 || (drv_data
->tx
== drv_data
->tx_end
))
492 pxa2xx_spi_write(drv_data
, SSDR
, *(u32
*)(drv_data
->tx
));
498 static int u32_reader(struct driver_data
*drv_data
)
500 while ((pxa2xx_spi_read(drv_data
, SSSR
) & SSSR_RNE
)
501 && (drv_data
->rx
< drv_data
->rx_end
)) {
502 *(u32
*)(drv_data
->rx
) = pxa2xx_spi_read(drv_data
, SSDR
);
506 return drv_data
->rx
== drv_data
->rx_end
;
509 void *pxa2xx_spi_next_transfer(struct driver_data
*drv_data
)
511 struct spi_message
*msg
= drv_data
->cur_msg
;
512 struct spi_transfer
*trans
= drv_data
->cur_transfer
;
514 /* Move to next transfer */
515 if (trans
->transfer_list
.next
!= &msg
->transfers
) {
516 drv_data
->cur_transfer
=
517 list_entry(trans
->transfer_list
.next
,
520 return RUNNING_STATE
;
525 /* caller already set message->status; dma and pio irqs are blocked */
526 static void giveback(struct driver_data
*drv_data
)
528 struct spi_transfer
* last_transfer
;
529 struct spi_message
*msg
;
530 unsigned long timeout
;
532 msg
= drv_data
->cur_msg
;
533 drv_data
->cur_msg
= NULL
;
534 drv_data
->cur_transfer
= NULL
;
536 last_transfer
= list_last_entry(&msg
->transfers
, struct spi_transfer
,
539 /* Delay if requested before any change in chip select */
540 if (last_transfer
->delay_usecs
)
541 udelay(last_transfer
->delay_usecs
);
543 /* Wait until SSP becomes idle before deasserting the CS */
544 timeout
= jiffies
+ msecs_to_jiffies(10);
545 while (pxa2xx_spi_read(drv_data
, SSSR
) & SSSR_BSY
&&
546 !time_after(jiffies
, timeout
))
549 /* Drop chip select UNLESS cs_change is true or we are returning
550 * a message with an error, or next message is for another chip
552 if (!last_transfer
->cs_change
)
553 cs_deassert(drv_data
);
555 struct spi_message
*next_msg
;
557 /* Holding of cs was hinted, but we need to make sure
558 * the next message is for the same chip. Don't waste
559 * time with the following tests unless this was hinted.
561 * We cannot postpone this until pump_messages, because
562 * after calling msg->complete (below) the driver that
563 * sent the current message could be unloaded, which
564 * could invalidate the cs_control() callback...
567 /* get a pointer to the next message, if any */
568 next_msg
= spi_get_next_queued_message(drv_data
->master
);
570 /* see if the next and current messages point
573 if (next_msg
&& next_msg
->spi
!= msg
->spi
)
575 if (!next_msg
|| msg
->state
== ERROR_STATE
)
576 cs_deassert(drv_data
);
579 drv_data
->cur_chip
= NULL
;
580 spi_finalize_current_message(drv_data
->master
);
583 static void reset_sccr1(struct driver_data
*drv_data
)
585 struct chip_data
*chip
= drv_data
->cur_chip
;
588 sccr1_reg
= pxa2xx_spi_read(drv_data
, SSCR1
) & ~drv_data
->int_cr1
;
589 sccr1_reg
&= ~SSCR1_RFT
;
590 sccr1_reg
|= chip
->threshold
;
591 pxa2xx_spi_write(drv_data
, SSCR1
, sccr1_reg
);
594 static void int_error_stop(struct driver_data
*drv_data
, const char* msg
)
596 /* Stop and reset SSP */
597 write_SSSR_CS(drv_data
, drv_data
->clear_sr
);
598 reset_sccr1(drv_data
);
599 if (!pxa25x_ssp_comp(drv_data
))
600 pxa2xx_spi_write(drv_data
, SSTO
, 0);
601 pxa2xx_spi_flush(drv_data
);
602 pxa2xx_spi_write(drv_data
, SSCR0
,
603 pxa2xx_spi_read(drv_data
, SSCR0
) & ~SSCR0_SSE
);
605 dev_err(&drv_data
->pdev
->dev
, "%s\n", msg
);
607 drv_data
->cur_msg
->state
= ERROR_STATE
;
608 tasklet_schedule(&drv_data
->pump_transfers
);
611 static void int_transfer_complete(struct driver_data
*drv_data
)
613 /* Clear and disable interrupts */
614 write_SSSR_CS(drv_data
, drv_data
->clear_sr
);
615 reset_sccr1(drv_data
);
616 if (!pxa25x_ssp_comp(drv_data
))
617 pxa2xx_spi_write(drv_data
, SSTO
, 0);
619 /* Update total byte transferred return count actual bytes read */
620 drv_data
->cur_msg
->actual_length
+= drv_data
->len
-
621 (drv_data
->rx_end
- drv_data
->rx
);
623 /* Transfer delays and chip select release are
624 * handled in pump_transfers or giveback
627 /* Move to next transfer */
628 drv_data
->cur_msg
->state
= pxa2xx_spi_next_transfer(drv_data
);
630 /* Schedule transfer tasklet */
631 tasklet_schedule(&drv_data
->pump_transfers
);
634 static irqreturn_t
interrupt_transfer(struct driver_data
*drv_data
)
636 u32 irq_mask
= (pxa2xx_spi_read(drv_data
, SSCR1
) & SSCR1_TIE
) ?
637 drv_data
->mask_sr
: drv_data
->mask_sr
& ~SSSR_TFS
;
639 u32 irq_status
= pxa2xx_spi_read(drv_data
, SSSR
) & irq_mask
;
641 if (irq_status
& SSSR_ROR
) {
642 int_error_stop(drv_data
, "interrupt_transfer: fifo overrun");
646 if (irq_status
& SSSR_TINT
) {
647 pxa2xx_spi_write(drv_data
, SSSR
, SSSR_TINT
);
648 if (drv_data
->read(drv_data
)) {
649 int_transfer_complete(drv_data
);
654 /* Drain rx fifo, Fill tx fifo and prevent overruns */
656 if (drv_data
->read(drv_data
)) {
657 int_transfer_complete(drv_data
);
660 } while (drv_data
->write(drv_data
));
662 if (drv_data
->read(drv_data
)) {
663 int_transfer_complete(drv_data
);
667 if (drv_data
->tx
== drv_data
->tx_end
) {
671 sccr1_reg
= pxa2xx_spi_read(drv_data
, SSCR1
);
672 sccr1_reg
&= ~SSCR1_TIE
;
675 * PXA25x_SSP has no timeout, set up rx threshould for the
676 * remaining RX bytes.
678 if (pxa25x_ssp_comp(drv_data
)) {
681 pxa2xx_spi_clear_rx_thre(drv_data
, &sccr1_reg
);
683 bytes_left
= drv_data
->rx_end
- drv_data
->rx
;
684 switch (drv_data
->n_bytes
) {
691 rx_thre
= pxa2xx_spi_get_rx_default_thre(drv_data
);
692 if (rx_thre
> bytes_left
)
693 rx_thre
= bytes_left
;
695 pxa2xx_spi_set_rx_thre(drv_data
, &sccr1_reg
, rx_thre
);
697 pxa2xx_spi_write(drv_data
, SSCR1
, sccr1_reg
);
700 /* We did something */
704 static irqreturn_t
ssp_int(int irq
, void *dev_id
)
706 struct driver_data
*drv_data
= dev_id
;
708 u32 mask
= drv_data
->mask_sr
;
712 * The IRQ might be shared with other peripherals so we must first
713 * check that are we RPM suspended or not. If we are we assume that
714 * the IRQ was not for us (we shouldn't be RPM suspended when the
715 * interrupt is enabled).
717 if (pm_runtime_suspended(&drv_data
->pdev
->dev
))
721 * If the device is not yet in RPM suspended state and we get an
722 * interrupt that is meant for another device, check if status bits
723 * are all set to one. That means that the device is already
726 status
= pxa2xx_spi_read(drv_data
, SSSR
);
730 sccr1_reg
= pxa2xx_spi_read(drv_data
, SSCR1
);
732 /* Ignore possible writes if we don't need to write */
733 if (!(sccr1_reg
& SSCR1_TIE
))
736 /* Ignore RX timeout interrupt if it is disabled */
737 if (!(sccr1_reg
& SSCR1_TINTE
))
740 if (!(status
& mask
))
743 if (!drv_data
->cur_msg
) {
745 pxa2xx_spi_write(drv_data
, SSCR0
,
746 pxa2xx_spi_read(drv_data
, SSCR0
)
748 pxa2xx_spi_write(drv_data
, SSCR1
,
749 pxa2xx_spi_read(drv_data
, SSCR1
)
750 & ~drv_data
->int_cr1
);
751 if (!pxa25x_ssp_comp(drv_data
))
752 pxa2xx_spi_write(drv_data
, SSTO
, 0);
753 write_SSSR_CS(drv_data
, drv_data
->clear_sr
);
755 dev_err(&drv_data
->pdev
->dev
,
756 "bad message state in interrupt handler\n");
762 return drv_data
->transfer_handler(drv_data
);
766 * The Quark SPI has an additional 24 bit register (DDS_CLK_RATE) to multiply
767 * input frequency by fractions of 2^24. It also has a divider by 5.
769 * There are formulas to get baud rate value for given input frequency and
770 * divider parameters, such as DDS_CLK_RATE and SCR:
774 * Fssp = Fsys * DDS_CLK_RATE / 2^24 (1)
775 * Baud rate = Fsclk = Fssp / (2 * (SCR + 1)) (2)
777 * DDS_CLK_RATE either 2^n or 2^n / 5.
778 * SCR is in range 0 .. 255
780 * Divisor = 5^i * 2^j * 2 * k
781 * i = [0, 1] i = 1 iff j = 0 or j > 3
782 * j = [0, 23] j = 0 iff i = 1
784 * Special case: j = 0, i = 1: Divisor = 2 / 5
786 * Accordingly to the specification the recommended values for DDS_CLK_RATE
788 * Case 1: 2^n, n = [0, 23]
789 * Case 2: 2^24 * 2 / 5 (0x666666)
790 * Case 3: less than or equal to 2^24 / 5 / 16 (0x33333)
792 * In all cases the lowest possible value is better.
794 * The function calculates parameters for all cases and chooses the one closest
795 * to the asked baud rate.
797 static unsigned int quark_x1000_get_clk_div(int rate
, u32
*dds
)
799 unsigned long xtal
= 200000000;
800 unsigned long fref
= xtal
/ 2; /* mandatory division by 2,
803 unsigned long fref1
= fref
/ 2; /* case 1 */
804 unsigned long fref2
= fref
* 2 / 5; /* case 2 */
806 unsigned long q
, q1
, q2
;
812 /* Set initial value for DDS_CLK_RATE */
813 mul
= (1 << 24) >> 1;
815 /* Calculate initial quot */
816 q1
= DIV_ROUND_UP(fref1
, rate
);
818 /* Scale q1 if it's too big */
820 /* Scale q1 to range [1, 512] */
821 scale
= fls_long(q1
- 1);
827 /* Round the result if we have a remainder */
831 /* Decrease DDS_CLK_RATE as much as we can without loss in precision */
836 /* Get the remainder */
837 r1
= abs(fref1
/ (1 << (24 - fls_long(mul
))) / q1
- rate
);
841 q2
= DIV_ROUND_UP(fref2
, rate
);
842 r2
= abs(fref2
/ q2
- rate
);
845 * Choose the best between two: less remainder we have the better. We
846 * can't go case 2 if q2 is greater than 256 since SCR register can
847 * hold only values 0 .. 255.
849 if (r2
>= r1
|| q2
> 256) {
850 /* case 1 is better */
854 /* case 2 is better */
857 mul
= (1 << 24) * 2 / 5;
860 /* Check case 3 only if the divisor is big enough */
861 if (fref
/ rate
>= 80) {
865 /* Calculate initial quot */
866 q1
= DIV_ROUND_UP(fref
, rate
);
869 /* Get the remainder */
870 fssp
= (u64
)fref
* m
;
871 do_div(fssp
, 1 << 24);
872 r1
= abs(fssp
- rate
);
874 /* Choose this one if it suits better */
876 /* case 3 is better */
886 static unsigned int ssp_get_clk_div(struct driver_data
*drv_data
, int rate
)
888 unsigned long ssp_clk
= drv_data
->master
->max_speed_hz
;
889 const struct ssp_device
*ssp
= drv_data
->ssp
;
891 rate
= min_t(int, ssp_clk
, rate
);
893 if (ssp
->type
== PXA25x_SSP
|| ssp
->type
== CE4100_SSP
)
894 return (ssp_clk
/ (2 * rate
) - 1) & 0xff;
896 return (ssp_clk
/ rate
- 1) & 0xfff;
899 static unsigned int pxa2xx_ssp_get_clk_div(struct driver_data
*drv_data
,
902 struct chip_data
*chip
= drv_data
->cur_chip
;
903 unsigned int clk_div
;
905 switch (drv_data
->ssp_type
) {
906 case QUARK_X1000_SSP
:
907 clk_div
= quark_x1000_get_clk_div(rate
, &chip
->dds_rate
);
910 clk_div
= ssp_get_clk_div(drv_data
, rate
);
916 static void pump_transfers(unsigned long data
)
918 struct driver_data
*drv_data
= (struct driver_data
*)data
;
919 struct spi_message
*message
= NULL
;
920 struct spi_transfer
*transfer
= NULL
;
921 struct spi_transfer
*previous
= NULL
;
922 struct chip_data
*chip
= NULL
;
928 u32 dma_thresh
= drv_data
->cur_chip
->dma_threshold
;
929 u32 dma_burst
= drv_data
->cur_chip
->dma_burst_size
;
930 u32 change_mask
= pxa2xx_spi_get_ssrc1_change_mask(drv_data
);
932 /* Get current state information */
933 message
= drv_data
->cur_msg
;
934 transfer
= drv_data
->cur_transfer
;
935 chip
= drv_data
->cur_chip
;
937 /* Handle for abort */
938 if (message
->state
== ERROR_STATE
) {
939 message
->status
= -EIO
;
944 /* Handle end of message */
945 if (message
->state
== DONE_STATE
) {
951 /* Delay if requested at end of transfer before CS change */
952 if (message
->state
== RUNNING_STATE
) {
953 previous
= list_entry(transfer
->transfer_list
.prev
,
956 if (previous
->delay_usecs
)
957 udelay(previous
->delay_usecs
);
959 /* Drop chip select only if cs_change is requested */
960 if (previous
->cs_change
)
961 cs_deassert(drv_data
);
964 /* Check if we can DMA this transfer */
965 if (!pxa2xx_spi_dma_is_possible(transfer
->len
) && chip
->enable_dma
) {
967 /* reject already-mapped transfers; PIO won't always work */
968 if (message
->is_dma_mapped
969 || transfer
->rx_dma
|| transfer
->tx_dma
) {
970 dev_err(&drv_data
->pdev
->dev
,
971 "pump_transfers: mapped transfer length of "
972 "%u is greater than %d\n",
973 transfer
->len
, MAX_DMA_LEN
);
974 message
->status
= -EINVAL
;
979 /* warn ... we force this to PIO mode */
980 dev_warn_ratelimited(&message
->spi
->dev
,
981 "pump_transfers: DMA disabled for transfer length %ld "
983 (long)drv_data
->len
, MAX_DMA_LEN
);
986 /* Setup the transfer state based on the type of transfer */
987 if (pxa2xx_spi_flush(drv_data
) == 0) {
988 dev_err(&drv_data
->pdev
->dev
, "pump_transfers: flush failed\n");
989 message
->status
= -EIO
;
993 drv_data
->n_bytes
= chip
->n_bytes
;
994 drv_data
->tx
= (void *)transfer
->tx_buf
;
995 drv_data
->tx_end
= drv_data
->tx
+ transfer
->len
;
996 drv_data
->rx
= transfer
->rx_buf
;
997 drv_data
->rx_end
= drv_data
->rx
+ transfer
->len
;
998 drv_data
->len
= transfer
->len
;
999 drv_data
->write
= drv_data
->tx
? chip
->write
: null_writer
;
1000 drv_data
->read
= drv_data
->rx
? chip
->read
: null_reader
;
1002 /* Change speed and bit per word on a per transfer */
1003 bits
= transfer
->bits_per_word
;
1004 speed
= transfer
->speed_hz
;
1006 clk_div
= pxa2xx_ssp_get_clk_div(drv_data
, speed
);
1009 drv_data
->n_bytes
= 1;
1010 drv_data
->read
= drv_data
->read
!= null_reader
?
1011 u8_reader
: null_reader
;
1012 drv_data
->write
= drv_data
->write
!= null_writer
?
1013 u8_writer
: null_writer
;
1014 } else if (bits
<= 16) {
1015 drv_data
->n_bytes
= 2;
1016 drv_data
->read
= drv_data
->read
!= null_reader
?
1017 u16_reader
: null_reader
;
1018 drv_data
->write
= drv_data
->write
!= null_writer
?
1019 u16_writer
: null_writer
;
1020 } else if (bits
<= 32) {
1021 drv_data
->n_bytes
= 4;
1022 drv_data
->read
= drv_data
->read
!= null_reader
?
1023 u32_reader
: null_reader
;
1024 drv_data
->write
= drv_data
->write
!= null_writer
?
1025 u32_writer
: null_writer
;
1028 * if bits/word is changed in dma mode, then must check the
1029 * thresholds and burst also
1031 if (chip
->enable_dma
) {
1032 if (pxa2xx_spi_set_dma_burst_and_threshold(chip
,
1036 dev_warn_ratelimited(&message
->spi
->dev
,
1037 "pump_transfers: DMA burst size reduced to match bits_per_word\n");
1040 message
->state
= RUNNING_STATE
;
1042 drv_data
->dma_mapped
= 0;
1043 if (pxa2xx_spi_dma_is_possible(drv_data
->len
))
1044 drv_data
->dma_mapped
= pxa2xx_spi_map_dma_buffers(drv_data
);
1045 if (drv_data
->dma_mapped
) {
1047 /* Ensure we have the correct interrupt handler */
1048 drv_data
->transfer_handler
= pxa2xx_spi_dma_transfer
;
1050 pxa2xx_spi_dma_prepare(drv_data
, dma_burst
);
1052 /* Clear status and start DMA engine */
1053 cr1
= chip
->cr1
| dma_thresh
| drv_data
->dma_cr1
;
1054 pxa2xx_spi_write(drv_data
, SSSR
, drv_data
->clear_sr
);
1056 pxa2xx_spi_dma_start(drv_data
);
1058 /* Ensure we have the correct interrupt handler */
1059 drv_data
->transfer_handler
= interrupt_transfer
;
1062 cr1
= chip
->cr1
| chip
->threshold
| drv_data
->int_cr1
;
1063 write_SSSR_CS(drv_data
, drv_data
->clear_sr
);
1066 /* NOTE: PXA25x_SSP _could_ use external clocking ... */
1067 cr0
= pxa2xx_configure_sscr0(drv_data
, clk_div
, bits
);
1068 if (!pxa25x_ssp_comp(drv_data
))
1069 dev_dbg(&message
->spi
->dev
, "%u Hz actual, %s\n",
1070 drv_data
->master
->max_speed_hz
1071 / (1 + ((cr0
& SSCR0_SCR(0xfff)) >> 8)),
1072 drv_data
->dma_mapped
? "DMA" : "PIO");
1074 dev_dbg(&message
->spi
->dev
, "%u Hz actual, %s\n",
1075 drv_data
->master
->max_speed_hz
/ 2
1076 / (1 + ((cr0
& SSCR0_SCR(0x0ff)) >> 8)),
1077 drv_data
->dma_mapped
? "DMA" : "PIO");
1079 if (is_lpss_ssp(drv_data
)) {
1080 if ((pxa2xx_spi_read(drv_data
, SSIRF
) & 0xff)
1081 != chip
->lpss_rx_threshold
)
1082 pxa2xx_spi_write(drv_data
, SSIRF
,
1083 chip
->lpss_rx_threshold
);
1084 if ((pxa2xx_spi_read(drv_data
, SSITF
) & 0xffff)
1085 != chip
->lpss_tx_threshold
)
1086 pxa2xx_spi_write(drv_data
, SSITF
,
1087 chip
->lpss_tx_threshold
);
1090 if (is_quark_x1000_ssp(drv_data
) &&
1091 (pxa2xx_spi_read(drv_data
, DDS_RATE
) != chip
->dds_rate
))
1092 pxa2xx_spi_write(drv_data
, DDS_RATE
, chip
->dds_rate
);
1094 /* see if we need to reload the config registers */
1095 if ((pxa2xx_spi_read(drv_data
, SSCR0
) != cr0
)
1096 || (pxa2xx_spi_read(drv_data
, SSCR1
) & change_mask
)
1097 != (cr1
& change_mask
)) {
1098 /* stop the SSP, and update the other bits */
1099 pxa2xx_spi_write(drv_data
, SSCR0
, cr0
& ~SSCR0_SSE
);
1100 if (!pxa25x_ssp_comp(drv_data
))
1101 pxa2xx_spi_write(drv_data
, SSTO
, chip
->timeout
);
1102 /* first set CR1 without interrupt and service enables */
1103 pxa2xx_spi_write(drv_data
, SSCR1
, cr1
& change_mask
);
1104 /* restart the SSP */
1105 pxa2xx_spi_write(drv_data
, SSCR0
, cr0
);
1108 if (!pxa25x_ssp_comp(drv_data
))
1109 pxa2xx_spi_write(drv_data
, SSTO
, chip
->timeout
);
1112 cs_assert(drv_data
);
1114 /* after chip select, release the data by enabling service
1115 * requests and interrupts, without changing any mode bits */
1116 pxa2xx_spi_write(drv_data
, SSCR1
, cr1
);
1119 static int pxa2xx_spi_transfer_one_message(struct spi_master
*master
,
1120 struct spi_message
*msg
)
1122 struct driver_data
*drv_data
= spi_master_get_devdata(master
);
1124 drv_data
->cur_msg
= msg
;
1125 /* Initial message state*/
1126 drv_data
->cur_msg
->state
= START_STATE
;
1127 drv_data
->cur_transfer
= list_entry(drv_data
->cur_msg
->transfers
.next
,
1128 struct spi_transfer
,
1131 /* prepare to setup the SSP, in pump_transfers, using the per
1132 * chip configuration */
1133 drv_data
->cur_chip
= spi_get_ctldata(drv_data
->cur_msg
->spi
);
1135 /* Mark as busy and launch transfers */
1136 tasklet_schedule(&drv_data
->pump_transfers
);
1140 static int pxa2xx_spi_unprepare_transfer(struct spi_master
*master
)
1142 struct driver_data
*drv_data
= spi_master_get_devdata(master
);
1144 /* Disable the SSP now */
1145 pxa2xx_spi_write(drv_data
, SSCR0
,
1146 pxa2xx_spi_read(drv_data
, SSCR0
) & ~SSCR0_SSE
);
1151 static int setup_cs(struct spi_device
*spi
, struct chip_data
*chip
,
1152 struct pxa2xx_spi_chip
*chip_info
)
1156 if (chip
== NULL
|| chip_info
== NULL
)
1159 /* NOTE: setup() can be called multiple times, possibly with
1160 * different chip_info, release previously requested GPIO
1162 if (gpio_is_valid(chip
->gpio_cs
))
1163 gpio_free(chip
->gpio_cs
);
1165 /* If (*cs_control) is provided, ignore GPIO chip select */
1166 if (chip_info
->cs_control
) {
1167 chip
->cs_control
= chip_info
->cs_control
;
1171 if (gpio_is_valid(chip_info
->gpio_cs
)) {
1172 err
= gpio_request(chip_info
->gpio_cs
, "SPI_CS");
1174 dev_err(&spi
->dev
, "failed to request chip select GPIO%d\n",
1175 chip_info
->gpio_cs
);
1179 chip
->gpio_cs
= chip_info
->gpio_cs
;
1180 chip
->gpio_cs_inverted
= spi
->mode
& SPI_CS_HIGH
;
1182 err
= gpio_direction_output(chip
->gpio_cs
,
1183 !chip
->gpio_cs_inverted
);
1189 static int setup(struct spi_device
*spi
)
1191 struct pxa2xx_spi_chip
*chip_info
= NULL
;
1192 struct chip_data
*chip
;
1193 const struct lpss_config
*config
;
1194 struct driver_data
*drv_data
= spi_master_get_devdata(spi
->master
);
1195 uint tx_thres
, tx_hi_thres
, rx_thres
;
1197 switch (drv_data
->ssp_type
) {
1198 case QUARK_X1000_SSP
:
1199 tx_thres
= TX_THRESH_QUARK_X1000_DFLT
;
1201 rx_thres
= RX_THRESH_QUARK_X1000_DFLT
;
1208 config
= lpss_get_config(drv_data
);
1209 tx_thres
= config
->tx_threshold_lo
;
1210 tx_hi_thres
= config
->tx_threshold_hi
;
1211 rx_thres
= config
->rx_threshold
;
1214 tx_thres
= TX_THRESH_DFLT
;
1216 rx_thres
= RX_THRESH_DFLT
;
1220 /* Only alloc on first setup */
1221 chip
= spi_get_ctldata(spi
);
1223 chip
= kzalloc(sizeof(struct chip_data
), GFP_KERNEL
);
1227 if (drv_data
->ssp_type
== CE4100_SSP
) {
1228 if (spi
->chip_select
> 4) {
1230 "failed setup: cs number must not be > 4.\n");
1235 chip
->frm
= spi
->chip_select
;
1238 chip
->enable_dma
= 0;
1239 chip
->timeout
= TIMOUT_DFLT
;
1242 /* protocol drivers may change the chip settings, so...
1243 * if chip_info exists, use it */
1244 chip_info
= spi
->controller_data
;
1246 /* chip_info isn't always needed */
1249 if (chip_info
->timeout
)
1250 chip
->timeout
= chip_info
->timeout
;
1251 if (chip_info
->tx_threshold
)
1252 tx_thres
= chip_info
->tx_threshold
;
1253 if (chip_info
->tx_hi_threshold
)
1254 tx_hi_thres
= chip_info
->tx_hi_threshold
;
1255 if (chip_info
->rx_threshold
)
1256 rx_thres
= chip_info
->rx_threshold
;
1257 chip
->enable_dma
= drv_data
->master_info
->enable_dma
;
1258 chip
->dma_threshold
= 0;
1259 if (chip_info
->enable_loopback
)
1260 chip
->cr1
= SSCR1_LBM
;
1261 } else if (ACPI_HANDLE(&spi
->dev
)) {
1263 * Slave devices enumerated from ACPI namespace don't
1264 * usually have chip_info but we still might want to use
1267 chip
->enable_dma
= drv_data
->master_info
->enable_dma
;
1270 chip
->lpss_rx_threshold
= SSIRF_RxThresh(rx_thres
);
1271 chip
->lpss_tx_threshold
= SSITF_TxLoThresh(tx_thres
)
1272 | SSITF_TxHiThresh(tx_hi_thres
);
1274 /* set dma burst and threshold outside of chip_info path so that if
1275 * chip_info goes away after setting chip->enable_dma, the
1276 * burst and threshold can still respond to changes in bits_per_word */
1277 if (chip
->enable_dma
) {
1278 /* set up legal burst and threshold for dma */
1279 if (pxa2xx_spi_set_dma_burst_and_threshold(chip
, spi
,
1281 &chip
->dma_burst_size
,
1282 &chip
->dma_threshold
)) {
1284 "in setup: DMA burst size reduced to match bits_per_word\n");
1288 switch (drv_data
->ssp_type
) {
1289 case QUARK_X1000_SSP
:
1290 chip
->threshold
= (QUARK_X1000_SSCR1_RxTresh(rx_thres
)
1291 & QUARK_X1000_SSCR1_RFT
)
1292 | (QUARK_X1000_SSCR1_TxTresh(tx_thres
)
1293 & QUARK_X1000_SSCR1_TFT
);
1296 chip
->threshold
= (SSCR1_RxTresh(rx_thres
) & SSCR1_RFT
) |
1297 (SSCR1_TxTresh(tx_thres
) & SSCR1_TFT
);
1301 chip
->cr1
&= ~(SSCR1_SPO
| SSCR1_SPH
);
1302 chip
->cr1
|= (((spi
->mode
& SPI_CPHA
) != 0) ? SSCR1_SPH
: 0)
1303 | (((spi
->mode
& SPI_CPOL
) != 0) ? SSCR1_SPO
: 0);
1305 if (spi
->mode
& SPI_LOOP
)
1306 chip
->cr1
|= SSCR1_LBM
;
1308 if (spi
->bits_per_word
<= 8) {
1310 chip
->read
= u8_reader
;
1311 chip
->write
= u8_writer
;
1312 } else if (spi
->bits_per_word
<= 16) {
1314 chip
->read
= u16_reader
;
1315 chip
->write
= u16_writer
;
1316 } else if (spi
->bits_per_word
<= 32) {
1318 chip
->read
= u32_reader
;
1319 chip
->write
= u32_writer
;
1322 spi_set_ctldata(spi
, chip
);
1324 if (drv_data
->ssp_type
== CE4100_SSP
)
1327 return setup_cs(spi
, chip
, chip_info
);
1330 static void cleanup(struct spi_device
*spi
)
1332 struct chip_data
*chip
= spi_get_ctldata(spi
);
1333 struct driver_data
*drv_data
= spi_master_get_devdata(spi
->master
);
1338 if (drv_data
->ssp_type
!= CE4100_SSP
&& gpio_is_valid(chip
->gpio_cs
))
1339 gpio_free(chip
->gpio_cs
);
1347 static const struct acpi_device_id pxa2xx_spi_acpi_match
[] = {
1348 { "INT33C0", LPSS_LPT_SSP
},
1349 { "INT33C1", LPSS_LPT_SSP
},
1350 { "INT3430", LPSS_LPT_SSP
},
1351 { "INT3431", LPSS_LPT_SSP
},
1352 { "80860F0E", LPSS_BYT_SSP
},
1353 { "8086228E", LPSS_BSW_SSP
},
1356 MODULE_DEVICE_TABLE(acpi
, pxa2xx_spi_acpi_match
);
1358 static int pxa2xx_spi_get_port_id(struct acpi_device
*adev
)
1363 if (adev
&& adev
->pnp
.unique_id
&&
1364 !kstrtouint(adev
->pnp
.unique_id
, 0, &devid
))
1368 #else /* !CONFIG_ACPI */
1369 static int pxa2xx_spi_get_port_id(struct acpi_device
*adev
)
1376 * PCI IDs of compound devices that integrate both host controller and private
1377 * integrated DMA engine. Please note these are not used in module
1378 * autoloading and probing in this module but matching the LPSS SSP type.
1380 static const struct pci_device_id pxa2xx_spi_pci_compound_match
[] = {
1382 { PCI_VDEVICE(INTEL
, 0x9d29), LPSS_SPT_SSP
},
1383 { PCI_VDEVICE(INTEL
, 0x9d2a), LPSS_SPT_SSP
},
1385 { PCI_VDEVICE(INTEL
, 0xa129), LPSS_SPT_SSP
},
1386 { PCI_VDEVICE(INTEL
, 0xa12a), LPSS_SPT_SSP
},
1388 { PCI_VDEVICE(INTEL
, 0x0ac2), LPSS_BXT_SSP
},
1389 { PCI_VDEVICE(INTEL
, 0x0ac4), LPSS_BXT_SSP
},
1390 { PCI_VDEVICE(INTEL
, 0x0ac6), LPSS_BXT_SSP
},
1392 { PCI_VDEVICE(INTEL
, 0x1ac2), LPSS_BXT_SSP
},
1393 { PCI_VDEVICE(INTEL
, 0x1ac4), LPSS_BXT_SSP
},
1394 { PCI_VDEVICE(INTEL
, 0x1ac6), LPSS_BXT_SSP
},
1396 { PCI_VDEVICE(INTEL
, 0x5ac2), LPSS_BXT_SSP
},
1397 { PCI_VDEVICE(INTEL
, 0x5ac4), LPSS_BXT_SSP
},
1398 { PCI_VDEVICE(INTEL
, 0x5ac6), LPSS_BXT_SSP
},
1402 static bool pxa2xx_spi_idma_filter(struct dma_chan
*chan
, void *param
)
1404 struct device
*dev
= param
;
1406 if (dev
!= chan
->device
->dev
->parent
)
1412 static struct pxa2xx_spi_master
*
1413 pxa2xx_spi_init_pdata(struct platform_device
*pdev
)
1415 struct pxa2xx_spi_master
*pdata
;
1416 struct acpi_device
*adev
;
1417 struct ssp_device
*ssp
;
1418 struct resource
*res
;
1419 const struct acpi_device_id
*adev_id
= NULL
;
1420 const struct pci_device_id
*pcidev_id
= NULL
;
1423 adev
= ACPI_COMPANION(&pdev
->dev
);
1425 if (dev_is_pci(pdev
->dev
.parent
))
1426 pcidev_id
= pci_match_id(pxa2xx_spi_pci_compound_match
,
1427 to_pci_dev(pdev
->dev
.parent
));
1429 adev_id
= acpi_match_device(pdev
->dev
.driver
->acpi_match_table
,
1435 type
= (int)adev_id
->driver_data
;
1437 type
= (int)pcidev_id
->driver_data
;
1441 pdata
= devm_kzalloc(&pdev
->dev
, sizeof(*pdata
), GFP_KERNEL
);
1445 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
1451 ssp
->phys_base
= res
->start
;
1452 ssp
->mmio_base
= devm_ioremap_resource(&pdev
->dev
, res
);
1453 if (IS_ERR(ssp
->mmio_base
))
1457 pdata
->tx_param
= pdev
->dev
.parent
;
1458 pdata
->rx_param
= pdev
->dev
.parent
;
1459 pdata
->dma_filter
= pxa2xx_spi_idma_filter
;
1462 ssp
->clk
= devm_clk_get(&pdev
->dev
, NULL
);
1463 ssp
->irq
= platform_get_irq(pdev
, 0);
1466 ssp
->port_id
= pxa2xx_spi_get_port_id(adev
);
1468 pdata
->num_chipselect
= 1;
1469 pdata
->enable_dma
= true;
1474 #else /* !CONFIG_PCI */
1475 static inline struct pxa2xx_spi_master
*
1476 pxa2xx_spi_init_pdata(struct platform_device
*pdev
)
1482 static int pxa2xx_spi_fw_translate_cs(struct spi_master
*master
, unsigned cs
)
1484 struct driver_data
*drv_data
= spi_master_get_devdata(master
);
1486 if (has_acpi_companion(&drv_data
->pdev
->dev
)) {
1487 switch (drv_data
->ssp_type
) {
1489 * For Atoms the ACPI DeviceSelection used by the Windows
1490 * driver starts from 1 instead of 0 so translate it here
1491 * to match what Linux expects.
1505 static int pxa2xx_spi_probe(struct platform_device
*pdev
)
1507 struct device
*dev
= &pdev
->dev
;
1508 struct pxa2xx_spi_master
*platform_info
;
1509 struct spi_master
*master
;
1510 struct driver_data
*drv_data
;
1511 struct ssp_device
*ssp
;
1512 const struct lpss_config
*config
;
1516 platform_info
= dev_get_platdata(dev
);
1517 if (!platform_info
) {
1518 platform_info
= pxa2xx_spi_init_pdata(pdev
);
1519 if (!platform_info
) {
1520 dev_err(&pdev
->dev
, "missing platform data\n");
1525 ssp
= pxa_ssp_request(pdev
->id
, pdev
->name
);
1527 ssp
= &platform_info
->ssp
;
1529 if (!ssp
->mmio_base
) {
1530 dev_err(&pdev
->dev
, "failed to get ssp\n");
1534 master
= spi_alloc_master(dev
, sizeof(struct driver_data
));
1536 dev_err(&pdev
->dev
, "cannot alloc spi_master\n");
1540 drv_data
= spi_master_get_devdata(master
);
1541 drv_data
->master
= master
;
1542 drv_data
->master_info
= platform_info
;
1543 drv_data
->pdev
= pdev
;
1544 drv_data
->ssp
= ssp
;
1546 master
->dev
.parent
= &pdev
->dev
;
1547 master
->dev
.of_node
= pdev
->dev
.of_node
;
1548 /* the spi->mode bits understood by this driver: */
1549 master
->mode_bits
= SPI_CPOL
| SPI_CPHA
| SPI_CS_HIGH
| SPI_LOOP
;
1551 master
->bus_num
= ssp
->port_id
;
1552 master
->dma_alignment
= DMA_ALIGNMENT
;
1553 master
->cleanup
= cleanup
;
1554 master
->setup
= setup
;
1555 master
->transfer_one_message
= pxa2xx_spi_transfer_one_message
;
1556 master
->unprepare_transfer_hardware
= pxa2xx_spi_unprepare_transfer
;
1557 master
->fw_translate_cs
= pxa2xx_spi_fw_translate_cs
;
1558 master
->auto_runtime_pm
= true;
1560 drv_data
->ssp_type
= ssp
->type
;
1562 drv_data
->ioaddr
= ssp
->mmio_base
;
1563 drv_data
->ssdr_physical
= ssp
->phys_base
+ SSDR
;
1564 if (pxa25x_ssp_comp(drv_data
)) {
1565 switch (drv_data
->ssp_type
) {
1566 case QUARK_X1000_SSP
:
1567 master
->bits_per_word_mask
= SPI_BPW_RANGE_MASK(4, 32);
1570 master
->bits_per_word_mask
= SPI_BPW_RANGE_MASK(4, 16);
1574 drv_data
->int_cr1
= SSCR1_TIE
| SSCR1_RIE
;
1575 drv_data
->dma_cr1
= 0;
1576 drv_data
->clear_sr
= SSSR_ROR
;
1577 drv_data
->mask_sr
= SSSR_RFS
| SSSR_TFS
| SSSR_ROR
;
1579 master
->bits_per_word_mask
= SPI_BPW_RANGE_MASK(4, 32);
1580 drv_data
->int_cr1
= SSCR1_TIE
| SSCR1_RIE
| SSCR1_TINTE
;
1581 drv_data
->dma_cr1
= DEFAULT_DMA_CR1
;
1582 drv_data
->clear_sr
= SSSR_ROR
| SSSR_TINT
;
1583 drv_data
->mask_sr
= SSSR_TINT
| SSSR_RFS
| SSSR_TFS
| SSSR_ROR
;
1586 status
= request_irq(ssp
->irq
, ssp_int
, IRQF_SHARED
, dev_name(dev
),
1589 dev_err(&pdev
->dev
, "cannot get IRQ %d\n", ssp
->irq
);
1590 goto out_error_master_alloc
;
1593 /* Setup DMA if requested */
1594 if (platform_info
->enable_dma
) {
1595 status
= pxa2xx_spi_dma_setup(drv_data
);
1597 dev_dbg(dev
, "no DMA channels available, using PIO\n");
1598 platform_info
->enable_dma
= false;
1602 /* Enable SOC clock */
1603 clk_prepare_enable(ssp
->clk
);
1605 master
->max_speed_hz
= clk_get_rate(ssp
->clk
);
1607 /* Load default SSP configuration */
1608 pxa2xx_spi_write(drv_data
, SSCR0
, 0);
1609 switch (drv_data
->ssp_type
) {
1610 case QUARK_X1000_SSP
:
1611 tmp
= QUARK_X1000_SSCR1_RxTresh(RX_THRESH_QUARK_X1000_DFLT
)
1612 | QUARK_X1000_SSCR1_TxTresh(TX_THRESH_QUARK_X1000_DFLT
);
1613 pxa2xx_spi_write(drv_data
, SSCR1
, tmp
);
1615 /* using the Motorola SPI protocol and use 8 bit frame */
1616 pxa2xx_spi_write(drv_data
, SSCR0
,
1617 QUARK_X1000_SSCR0_Motorola
1618 | QUARK_X1000_SSCR0_DataSize(8));
1621 tmp
= SSCR1_RxTresh(RX_THRESH_DFLT
) |
1622 SSCR1_TxTresh(TX_THRESH_DFLT
);
1623 pxa2xx_spi_write(drv_data
, SSCR1
, tmp
);
1624 tmp
= SSCR0_SCR(2) | SSCR0_Motorola
| SSCR0_DataSize(8);
1625 pxa2xx_spi_write(drv_data
, SSCR0
, tmp
);
1629 if (!pxa25x_ssp_comp(drv_data
))
1630 pxa2xx_spi_write(drv_data
, SSTO
, 0);
1632 if (!is_quark_x1000_ssp(drv_data
))
1633 pxa2xx_spi_write(drv_data
, SSPSP
, 0);
1635 if (is_lpss_ssp(drv_data
)) {
1636 lpss_ssp_setup(drv_data
);
1637 config
= lpss_get_config(drv_data
);
1638 if (config
->reg_capabilities
>= 0) {
1639 tmp
= __lpss_ssp_read_priv(drv_data
,
1640 config
->reg_capabilities
);
1641 tmp
&= LPSS_CAPS_CS_EN_MASK
;
1642 tmp
>>= LPSS_CAPS_CS_EN_SHIFT
;
1643 platform_info
->num_chipselect
= ffz(tmp
);
1644 } else if (config
->cs_num
) {
1645 platform_info
->num_chipselect
= config
->cs_num
;
1648 master
->num_chipselect
= platform_info
->num_chipselect
;
1650 tasklet_init(&drv_data
->pump_transfers
, pump_transfers
,
1651 (unsigned long)drv_data
);
1653 pm_runtime_set_autosuspend_delay(&pdev
->dev
, 50);
1654 pm_runtime_use_autosuspend(&pdev
->dev
);
1655 pm_runtime_set_active(&pdev
->dev
);
1656 pm_runtime_enable(&pdev
->dev
);
1658 /* Register with the SPI framework */
1659 platform_set_drvdata(pdev
, drv_data
);
1660 status
= devm_spi_register_master(&pdev
->dev
, master
);
1662 dev_err(&pdev
->dev
, "problem registering spi master\n");
1663 goto out_error_clock_enabled
;
1668 out_error_clock_enabled
:
1669 clk_disable_unprepare(ssp
->clk
);
1670 pxa2xx_spi_dma_release(drv_data
);
1671 free_irq(ssp
->irq
, drv_data
);
1673 out_error_master_alloc
:
1674 spi_master_put(master
);
1679 static int pxa2xx_spi_remove(struct platform_device
*pdev
)
1681 struct driver_data
*drv_data
= platform_get_drvdata(pdev
);
1682 struct ssp_device
*ssp
;
1686 ssp
= drv_data
->ssp
;
1688 pm_runtime_get_sync(&pdev
->dev
);
1690 /* Disable the SSP at the peripheral and SOC level */
1691 pxa2xx_spi_write(drv_data
, SSCR0
, 0);
1692 clk_disable_unprepare(ssp
->clk
);
1695 if (drv_data
->master_info
->enable_dma
)
1696 pxa2xx_spi_dma_release(drv_data
);
1698 pm_runtime_put_noidle(&pdev
->dev
);
1699 pm_runtime_disable(&pdev
->dev
);
1702 free_irq(ssp
->irq
, drv_data
);
1710 static void pxa2xx_spi_shutdown(struct platform_device
*pdev
)
1714 if ((status
= pxa2xx_spi_remove(pdev
)) != 0)
1715 dev_err(&pdev
->dev
, "shutdown failed with %d\n", status
);
1718 #ifdef CONFIG_PM_SLEEP
1719 static int pxa2xx_spi_suspend(struct device
*dev
)
1721 struct driver_data
*drv_data
= dev_get_drvdata(dev
);
1722 struct ssp_device
*ssp
= drv_data
->ssp
;
1725 status
= spi_master_suspend(drv_data
->master
);
1728 pxa2xx_spi_write(drv_data
, SSCR0
, 0);
1730 if (!pm_runtime_suspended(dev
))
1731 clk_disable_unprepare(ssp
->clk
);
1736 static int pxa2xx_spi_resume(struct device
*dev
)
1738 struct driver_data
*drv_data
= dev_get_drvdata(dev
);
1739 struct ssp_device
*ssp
= drv_data
->ssp
;
1742 /* Enable the SSP clock */
1743 if (!pm_runtime_suspended(dev
))
1744 clk_prepare_enable(ssp
->clk
);
1746 /* Restore LPSS private register bits */
1747 if (is_lpss_ssp(drv_data
))
1748 lpss_ssp_setup(drv_data
);
1750 /* Start the queue running */
1751 status
= spi_master_resume(drv_data
->master
);
1753 dev_err(dev
, "problem starting queue (%d)\n", status
);
1762 static int pxa2xx_spi_runtime_suspend(struct device
*dev
)
1764 struct driver_data
*drv_data
= dev_get_drvdata(dev
);
1766 clk_disable_unprepare(drv_data
->ssp
->clk
);
1770 static int pxa2xx_spi_runtime_resume(struct device
*dev
)
1772 struct driver_data
*drv_data
= dev_get_drvdata(dev
);
1774 clk_prepare_enable(drv_data
->ssp
->clk
);
1779 static const struct dev_pm_ops pxa2xx_spi_pm_ops
= {
1780 SET_SYSTEM_SLEEP_PM_OPS(pxa2xx_spi_suspend
, pxa2xx_spi_resume
)
1781 SET_RUNTIME_PM_OPS(pxa2xx_spi_runtime_suspend
,
1782 pxa2xx_spi_runtime_resume
, NULL
)
1785 static struct platform_driver driver
= {
1787 .name
= "pxa2xx-spi",
1788 .pm
= &pxa2xx_spi_pm_ops
,
1789 .acpi_match_table
= ACPI_PTR(pxa2xx_spi_acpi_match
),
1791 .probe
= pxa2xx_spi_probe
,
1792 .remove
= pxa2xx_spi_remove
,
1793 .shutdown
= pxa2xx_spi_shutdown
,
1796 static int __init
pxa2xx_spi_init(void)
1798 return platform_driver_register(&driver
);
1800 subsys_initcall(pxa2xx_spi_init
);
1802 static void __exit
pxa2xx_spi_exit(void)
1804 platform_driver_unregister(&driver
);
1806 module_exit(pxa2xx_spi_exit
);