xref: /openbmc/linux/drivers/spi/spi-pxa2xx.c (revision 7c7289a40425d48bbfcaacc454a8caf5b47f63b0)
1ca632f55SGrant Likely /*
2ca632f55SGrant Likely  * Copyright (C) 2005 Stephen Street / StreetFire Sound Labs
3a0d2642eSMika Westerberg  * Copyright (C) 2013, Intel Corporation
4ca632f55SGrant Likely  *
5ca632f55SGrant Likely  * This program is free software; you can redistribute it and/or modify
6ca632f55SGrant Likely  * it under the terms of the GNU General Public License as published by
7ca632f55SGrant Likely  * the Free Software Foundation; either version 2 of the License, or
8ca632f55SGrant Likely  * (at your option) any later version.
9ca632f55SGrant Likely  *
10ca632f55SGrant Likely  * This program is distributed in the hope that it will be useful,
11ca632f55SGrant Likely  * but WITHOUT ANY WARRANTY; without even the implied warranty of
12ca632f55SGrant Likely  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
13ca632f55SGrant Likely  * GNU General Public License for more details.
14ca632f55SGrant Likely  */
15ca632f55SGrant Likely 
168b136baaSJarkko Nikula #include <linux/bitops.h>
17ca632f55SGrant Likely #include <linux/init.h>
18ca632f55SGrant Likely #include <linux/module.h>
19ca632f55SGrant Likely #include <linux/device.h>
20ca632f55SGrant Likely #include <linux/ioport.h>
21ca632f55SGrant Likely #include <linux/errno.h>
22cbfd6a21SSachin Kamat #include <linux/err.h>
23ca632f55SGrant Likely #include <linux/interrupt.h>
249df461ecSAndy Shevchenko #include <linux/kernel.h>
2534cadd9cSJarkko Nikula #include <linux/pci.h>
26ca632f55SGrant Likely #include <linux/platform_device.h>
27ca632f55SGrant Likely #include <linux/spi/pxa2xx_spi.h>
28ca632f55SGrant Likely #include <linux/spi/spi.h>
29ca632f55SGrant Likely #include <linux/delay.h>
30ca632f55SGrant Likely #include <linux/gpio.h>
31ca632f55SGrant Likely #include <linux/slab.h>
323343b7a6SMika Westerberg #include <linux/clk.h>
337d94a505SMika Westerberg #include <linux/pm_runtime.h>
34a3496855SMika Westerberg #include <linux/acpi.h>
35ca632f55SGrant Likely 
36cd7bed00SMika Westerberg #include "spi-pxa2xx.h"
37ca632f55SGrant Likely 
38ca632f55SGrant Likely MODULE_AUTHOR("Stephen Street");
39ca632f55SGrant Likely MODULE_DESCRIPTION("PXA2xx SSP SPI Controller");
40ca632f55SGrant Likely MODULE_LICENSE("GPL");
41ca632f55SGrant Likely MODULE_ALIAS("platform:pxa2xx-spi");
42ca632f55SGrant Likely 
43ca632f55SGrant Likely #define TIMOUT_DFLT		1000
44ca632f55SGrant Likely 
45ca632f55SGrant Likely /*
46ca632f55SGrant Likely  * for testing SSCR1 changes that require SSP restart, basically
47ca632f55SGrant Likely  * everything except the service and interrupt enables, the pxa270 developer
48ca632f55SGrant Likely  * manual says only SSCR1_SCFR, SSCR1_SPH, SSCR1_SPO need to be in this
49ca632f55SGrant Likely  * list, but the PXA255 dev man says all bits without really meaning the
50ca632f55SGrant Likely  * service and interrupt enables
51ca632f55SGrant Likely  */
52ca632f55SGrant Likely #define SSCR1_CHANGE_MASK (SSCR1_TTELP | SSCR1_TTE | SSCR1_SCFR \
53ca632f55SGrant Likely 				| SSCR1_ECRA | SSCR1_ECRB | SSCR1_SCLKDIR \
54ca632f55SGrant Likely 				| SSCR1_SFRMDIR | SSCR1_RWOT | SSCR1_TRAIL \
55ca632f55SGrant Likely 				| SSCR1_IFS | SSCR1_STRF | SSCR1_EFWR \
56ca632f55SGrant Likely 				| SSCR1_RFT | SSCR1_TFT | SSCR1_MWDS \
57ca632f55SGrant Likely 				| SSCR1_SPH | SSCR1_SPO | SSCR1_LBM)
58ca632f55SGrant Likely 
59e5262d05SWeike Chen #define QUARK_X1000_SSCR1_CHANGE_MASK (QUARK_X1000_SSCR1_STRF	\
60e5262d05SWeike Chen 				| QUARK_X1000_SSCR1_EFWR	\
61e5262d05SWeike Chen 				| QUARK_X1000_SSCR1_RFT		\
62e5262d05SWeike Chen 				| QUARK_X1000_SSCR1_TFT		\
63e5262d05SWeike Chen 				| SSCR1_SPH | SSCR1_SPO | SSCR1_LBM)
64e5262d05SWeike Chen 
65*7c7289a4SAndy Shevchenko #define CE4100_SSCR1_CHANGE_MASK (SSCR1_TTELP | SSCR1_TTE | SSCR1_SCFR \
66*7c7289a4SAndy Shevchenko 				| SSCR1_ECRA | SSCR1_ECRB | SSCR1_SCLKDIR \
67*7c7289a4SAndy Shevchenko 				| SSCR1_SFRMDIR | SSCR1_RWOT | SSCR1_TRAIL \
68*7c7289a4SAndy Shevchenko 				| SSCR1_IFS | SSCR1_STRF | SSCR1_EFWR \
69*7c7289a4SAndy Shevchenko 				| CE4100_SSCR1_RFT | CE4100_SSCR1_TFT | SSCR1_MWDS \
70*7c7289a4SAndy Shevchenko 				| SSCR1_SPH | SSCR1_SPO | SSCR1_LBM)
71*7c7289a4SAndy Shevchenko 
72624ea72eSJarkko Nikula #define LPSS_GENERAL_REG_RXTO_HOLDOFF_DISABLE	BIT(24)
73624ea72eSJarkko Nikula #define LPSS_CS_CONTROL_SW_MODE			BIT(0)
74624ea72eSJarkko Nikula #define LPSS_CS_CONTROL_CS_HIGH			BIT(1)
758b136baaSJarkko Nikula #define LPSS_CAPS_CS_EN_SHIFT			9
768b136baaSJarkko Nikula #define LPSS_CAPS_CS_EN_MASK			(0xf << LPSS_CAPS_CS_EN_SHIFT)
77a0d2642eSMika Westerberg 
78dccf7369SJarkko Nikula struct lpss_config {
79dccf7369SJarkko Nikula 	/* LPSS offset from drv_data->ioaddr */
80dccf7369SJarkko Nikula 	unsigned offset;
81dccf7369SJarkko Nikula 	/* Register offsets from drv_data->lpss_base or -1 */
82dccf7369SJarkko Nikula 	int reg_general;
83dccf7369SJarkko Nikula 	int reg_ssp;
84dccf7369SJarkko Nikula 	int reg_cs_ctrl;
858b136baaSJarkko Nikula 	int reg_capabilities;
86dccf7369SJarkko Nikula 	/* FIFO thresholds */
87dccf7369SJarkko Nikula 	u32 rx_threshold;
88dccf7369SJarkko Nikula 	u32 tx_threshold_lo;
89dccf7369SJarkko Nikula 	u32 tx_threshold_hi;
90c1e4a53cSMika Westerberg 	/* Chip select control */
91c1e4a53cSMika Westerberg 	unsigned cs_sel_shift;
92c1e4a53cSMika Westerberg 	unsigned cs_sel_mask;
9330f3a6abSMika Westerberg 	unsigned cs_num;
94dccf7369SJarkko Nikula };
95dccf7369SJarkko Nikula 
96dccf7369SJarkko Nikula /* Keep these sorted with enum pxa_ssp_type */
97dccf7369SJarkko Nikula static const struct lpss_config lpss_platforms[] = {
98dccf7369SJarkko Nikula 	{	/* LPSS_LPT_SSP */
99dccf7369SJarkko Nikula 		.offset = 0x800,
100dccf7369SJarkko Nikula 		.reg_general = 0x08,
101dccf7369SJarkko Nikula 		.reg_ssp = 0x0c,
102dccf7369SJarkko Nikula 		.reg_cs_ctrl = 0x18,
1038b136baaSJarkko Nikula 		.reg_capabilities = -1,
104dccf7369SJarkko Nikula 		.rx_threshold = 64,
105dccf7369SJarkko Nikula 		.tx_threshold_lo = 160,
106dccf7369SJarkko Nikula 		.tx_threshold_hi = 224,
107dccf7369SJarkko Nikula 	},
108dccf7369SJarkko Nikula 	{	/* LPSS_BYT_SSP */
109dccf7369SJarkko Nikula 		.offset = 0x400,
110dccf7369SJarkko Nikula 		.reg_general = 0x08,
111dccf7369SJarkko Nikula 		.reg_ssp = 0x0c,
112dccf7369SJarkko Nikula 		.reg_cs_ctrl = 0x18,
1138b136baaSJarkko Nikula 		.reg_capabilities = -1,
114dccf7369SJarkko Nikula 		.rx_threshold = 64,
115dccf7369SJarkko Nikula 		.tx_threshold_lo = 160,
116dccf7369SJarkko Nikula 		.tx_threshold_hi = 224,
117dccf7369SJarkko Nikula 	},
11830f3a6abSMika Westerberg 	{	/* LPSS_BSW_SSP */
11930f3a6abSMika Westerberg 		.offset = 0x400,
12030f3a6abSMika Westerberg 		.reg_general = 0x08,
12130f3a6abSMika Westerberg 		.reg_ssp = 0x0c,
12230f3a6abSMika Westerberg 		.reg_cs_ctrl = 0x18,
12330f3a6abSMika Westerberg 		.reg_capabilities = -1,
12430f3a6abSMika Westerberg 		.rx_threshold = 64,
12530f3a6abSMika Westerberg 		.tx_threshold_lo = 160,
12630f3a6abSMika Westerberg 		.tx_threshold_hi = 224,
12730f3a6abSMika Westerberg 		.cs_sel_shift = 2,
12830f3a6abSMika Westerberg 		.cs_sel_mask = 1 << 2,
12930f3a6abSMika Westerberg 		.cs_num = 2,
13030f3a6abSMika Westerberg 	},
13134cadd9cSJarkko Nikula 	{	/* LPSS_SPT_SSP */
13234cadd9cSJarkko Nikula 		.offset = 0x200,
13334cadd9cSJarkko Nikula 		.reg_general = -1,
13434cadd9cSJarkko Nikula 		.reg_ssp = 0x20,
13534cadd9cSJarkko Nikula 		.reg_cs_ctrl = 0x24,
13666ec246eSJarkko Nikula 		.reg_capabilities = -1,
13734cadd9cSJarkko Nikula 		.rx_threshold = 1,
13834cadd9cSJarkko Nikula 		.tx_threshold_lo = 32,
13934cadd9cSJarkko Nikula 		.tx_threshold_hi = 56,
14034cadd9cSJarkko Nikula 	},
141b7c08cf8SJarkko Nikula 	{	/* LPSS_BXT_SSP */
142b7c08cf8SJarkko Nikula 		.offset = 0x200,
143b7c08cf8SJarkko Nikula 		.reg_general = -1,
144b7c08cf8SJarkko Nikula 		.reg_ssp = 0x20,
145b7c08cf8SJarkko Nikula 		.reg_cs_ctrl = 0x24,
146b7c08cf8SJarkko Nikula 		.reg_capabilities = 0xfc,
147b7c08cf8SJarkko Nikula 		.rx_threshold = 1,
148b7c08cf8SJarkko Nikula 		.tx_threshold_lo = 16,
149b7c08cf8SJarkko Nikula 		.tx_threshold_hi = 48,
150c1e4a53cSMika Westerberg 		.cs_sel_shift = 8,
151c1e4a53cSMika Westerberg 		.cs_sel_mask = 3 << 8,
152b7c08cf8SJarkko Nikula 	},
153dccf7369SJarkko Nikula };
154dccf7369SJarkko Nikula 
155dccf7369SJarkko Nikula static inline const struct lpss_config
156dccf7369SJarkko Nikula *lpss_get_config(const struct driver_data *drv_data)
157dccf7369SJarkko Nikula {
158dccf7369SJarkko Nikula 	return &lpss_platforms[drv_data->ssp_type - LPSS_LPT_SSP];
159dccf7369SJarkko Nikula }
160dccf7369SJarkko Nikula 
161a0d2642eSMika Westerberg static bool is_lpss_ssp(const struct driver_data *drv_data)
162a0d2642eSMika Westerberg {
16303fbf488SJarkko Nikula 	switch (drv_data->ssp_type) {
16403fbf488SJarkko Nikula 	case LPSS_LPT_SSP:
16503fbf488SJarkko Nikula 	case LPSS_BYT_SSP:
16630f3a6abSMika Westerberg 	case LPSS_BSW_SSP:
16734cadd9cSJarkko Nikula 	case LPSS_SPT_SSP:
168b7c08cf8SJarkko Nikula 	case LPSS_BXT_SSP:
16903fbf488SJarkko Nikula 		return true;
17003fbf488SJarkko Nikula 	default:
17103fbf488SJarkko Nikula 		return false;
17203fbf488SJarkko Nikula 	}
173a0d2642eSMika Westerberg }
174a0d2642eSMika Westerberg 
175e5262d05SWeike Chen static bool is_quark_x1000_ssp(const struct driver_data *drv_data)
176e5262d05SWeike Chen {
177e5262d05SWeike Chen 	return drv_data->ssp_type == QUARK_X1000_SSP;
178e5262d05SWeike Chen }
179e5262d05SWeike Chen 
1804fdb2424SWeike Chen static u32 pxa2xx_spi_get_ssrc1_change_mask(const struct driver_data *drv_data)
1814fdb2424SWeike Chen {
1824fdb2424SWeike Chen 	switch (drv_data->ssp_type) {
183e5262d05SWeike Chen 	case QUARK_X1000_SSP:
184e5262d05SWeike Chen 		return QUARK_X1000_SSCR1_CHANGE_MASK;
185*7c7289a4SAndy Shevchenko 	case CE4100_SSP:
186*7c7289a4SAndy Shevchenko 		return CE4100_SSCR1_CHANGE_MASK;
1874fdb2424SWeike Chen 	default:
1884fdb2424SWeike Chen 		return SSCR1_CHANGE_MASK;
1894fdb2424SWeike Chen 	}
1904fdb2424SWeike Chen }
1914fdb2424SWeike Chen 
1924fdb2424SWeike Chen static u32
1934fdb2424SWeike Chen pxa2xx_spi_get_rx_default_thre(const struct driver_data *drv_data)
1944fdb2424SWeike Chen {
1954fdb2424SWeike Chen 	switch (drv_data->ssp_type) {
196e5262d05SWeike Chen 	case QUARK_X1000_SSP:
197e5262d05SWeike Chen 		return RX_THRESH_QUARK_X1000_DFLT;
198*7c7289a4SAndy Shevchenko 	case CE4100_SSP:
199*7c7289a4SAndy Shevchenko 		return RX_THRESH_CE4100_DFLT;
2004fdb2424SWeike Chen 	default:
2014fdb2424SWeike Chen 		return RX_THRESH_DFLT;
2024fdb2424SWeike Chen 	}
2034fdb2424SWeike Chen }
2044fdb2424SWeike Chen 
2054fdb2424SWeike Chen static bool pxa2xx_spi_txfifo_full(const struct driver_data *drv_data)
2064fdb2424SWeike Chen {
2074fdb2424SWeike Chen 	u32 mask;
2084fdb2424SWeike Chen 
2094fdb2424SWeike Chen 	switch (drv_data->ssp_type) {
210e5262d05SWeike Chen 	case QUARK_X1000_SSP:
211e5262d05SWeike Chen 		mask = QUARK_X1000_SSSR_TFL_MASK;
212e5262d05SWeike Chen 		break;
213*7c7289a4SAndy Shevchenko 	case CE4100_SSP:
214*7c7289a4SAndy Shevchenko 		mask = CE4100_SSSR_TFL_MASK;
215*7c7289a4SAndy Shevchenko 		break;
2164fdb2424SWeike Chen 	default:
2174fdb2424SWeike Chen 		mask = SSSR_TFL_MASK;
2184fdb2424SWeike Chen 		break;
2194fdb2424SWeike Chen 	}
2204fdb2424SWeike Chen 
221c039dd27SJarkko Nikula 	return (pxa2xx_spi_read(drv_data, SSSR) & mask) == mask;
2224fdb2424SWeike Chen }
2234fdb2424SWeike Chen 
2244fdb2424SWeike Chen static void pxa2xx_spi_clear_rx_thre(const struct driver_data *drv_data,
2254fdb2424SWeike Chen 				     u32 *sccr1_reg)
2264fdb2424SWeike Chen {
2274fdb2424SWeike Chen 	u32 mask;
2284fdb2424SWeike Chen 
2294fdb2424SWeike Chen 	switch (drv_data->ssp_type) {
230e5262d05SWeike Chen 	case QUARK_X1000_SSP:
231e5262d05SWeike Chen 		mask = QUARK_X1000_SSCR1_RFT;
232e5262d05SWeike Chen 		break;
233*7c7289a4SAndy Shevchenko 	case CE4100_SSP:
234*7c7289a4SAndy Shevchenko 		mask = CE4100_SSCR1_RFT;
235*7c7289a4SAndy Shevchenko 		break;
2364fdb2424SWeike Chen 	default:
2374fdb2424SWeike Chen 		mask = SSCR1_RFT;
2384fdb2424SWeike Chen 		break;
2394fdb2424SWeike Chen 	}
2404fdb2424SWeike Chen 	*sccr1_reg &= ~mask;
2414fdb2424SWeike Chen }
2424fdb2424SWeike Chen 
2434fdb2424SWeike Chen static void pxa2xx_spi_set_rx_thre(const struct driver_data *drv_data,
2444fdb2424SWeike Chen 				   u32 *sccr1_reg, u32 threshold)
2454fdb2424SWeike Chen {
2464fdb2424SWeike Chen 	switch (drv_data->ssp_type) {
247e5262d05SWeike Chen 	case QUARK_X1000_SSP:
248e5262d05SWeike Chen 		*sccr1_reg |= QUARK_X1000_SSCR1_RxTresh(threshold);
249e5262d05SWeike Chen 		break;
250*7c7289a4SAndy Shevchenko 	case CE4100_SSP:
251*7c7289a4SAndy Shevchenko 		*sccr1_reg |= CE4100_SSCR1_RxTresh(threshold);
252*7c7289a4SAndy Shevchenko 		break;
2534fdb2424SWeike Chen 	default:
2544fdb2424SWeike Chen 		*sccr1_reg |= SSCR1_RxTresh(threshold);
2554fdb2424SWeike Chen 		break;
2564fdb2424SWeike Chen 	}
2574fdb2424SWeike Chen }
2584fdb2424SWeike Chen 
2594fdb2424SWeike Chen static u32 pxa2xx_configure_sscr0(const struct driver_data *drv_data,
2604fdb2424SWeike Chen 				  u32 clk_div, u8 bits)
2614fdb2424SWeike Chen {
2624fdb2424SWeike Chen 	switch (drv_data->ssp_type) {
263e5262d05SWeike Chen 	case QUARK_X1000_SSP:
264e5262d05SWeike Chen 		return clk_div
265e5262d05SWeike Chen 			| QUARK_X1000_SSCR0_Motorola
266e5262d05SWeike Chen 			| QUARK_X1000_SSCR0_DataSize(bits > 32 ? 8 : bits)
267e5262d05SWeike Chen 			| SSCR0_SSE;
2684fdb2424SWeike Chen 	default:
2694fdb2424SWeike Chen 		return clk_div
2704fdb2424SWeike Chen 			| SSCR0_Motorola
2714fdb2424SWeike Chen 			| SSCR0_DataSize(bits > 16 ? bits - 16 : bits)
2724fdb2424SWeike Chen 			| SSCR0_SSE
2734fdb2424SWeike Chen 			| (bits > 16 ? SSCR0_EDSS : 0);
2744fdb2424SWeike Chen 	}
2754fdb2424SWeike Chen }
2764fdb2424SWeike Chen 
277a0d2642eSMika Westerberg /*
278a0d2642eSMika Westerberg  * Read and write LPSS SSP private registers. Caller must first check that
279a0d2642eSMika Westerberg  * is_lpss_ssp() returns true before these can be called.
280a0d2642eSMika Westerberg  */
281a0d2642eSMika Westerberg static u32 __lpss_ssp_read_priv(struct driver_data *drv_data, unsigned offset)
282a0d2642eSMika Westerberg {
283a0d2642eSMika Westerberg 	WARN_ON(!drv_data->lpss_base);
284a0d2642eSMika Westerberg 	return readl(drv_data->lpss_base + offset);
285a0d2642eSMika Westerberg }
286a0d2642eSMika Westerberg 
287a0d2642eSMika Westerberg static void __lpss_ssp_write_priv(struct driver_data *drv_data,
288a0d2642eSMika Westerberg 				  unsigned offset, u32 value)
289a0d2642eSMika Westerberg {
290a0d2642eSMika Westerberg 	WARN_ON(!drv_data->lpss_base);
291a0d2642eSMika Westerberg 	writel(value, drv_data->lpss_base + offset);
292a0d2642eSMika Westerberg }
293a0d2642eSMika Westerberg 
294a0d2642eSMika Westerberg /*
295a0d2642eSMika Westerberg  * lpss_ssp_setup - perform LPSS SSP specific setup
296a0d2642eSMika Westerberg  * @drv_data: pointer to the driver private data
297a0d2642eSMika Westerberg  *
298a0d2642eSMika Westerberg  * Perform LPSS SSP specific setup. This function must be called first if
299a0d2642eSMika Westerberg  * one is going to use LPSS SSP private registers.
300a0d2642eSMika Westerberg  */
301a0d2642eSMika Westerberg static void lpss_ssp_setup(struct driver_data *drv_data)
302a0d2642eSMika Westerberg {
303dccf7369SJarkko Nikula 	const struct lpss_config *config;
304dccf7369SJarkko Nikula 	u32 value;
305a0d2642eSMika Westerberg 
306dccf7369SJarkko Nikula 	config = lpss_get_config(drv_data);
307dccf7369SJarkko Nikula 	drv_data->lpss_base = drv_data->ioaddr + config->offset;
308a0d2642eSMika Westerberg 
309a0d2642eSMika Westerberg 	/* Enable software chip select control */
3100e897218SJarkko Nikula 	value = __lpss_ssp_read_priv(drv_data, config->reg_cs_ctrl);
311624ea72eSJarkko Nikula 	value &= ~(LPSS_CS_CONTROL_SW_MODE | LPSS_CS_CONTROL_CS_HIGH);
312624ea72eSJarkko Nikula 	value |= LPSS_CS_CONTROL_SW_MODE | LPSS_CS_CONTROL_CS_HIGH;
313dccf7369SJarkko Nikula 	__lpss_ssp_write_priv(drv_data, config->reg_cs_ctrl, value);
3140054e28dSMika Westerberg 
3150054e28dSMika Westerberg 	/* Enable multiblock DMA transfers */
3161de70612SMika Westerberg 	if (drv_data->master_info->enable_dma) {
317dccf7369SJarkko Nikula 		__lpss_ssp_write_priv(drv_data, config->reg_ssp, 1);
3181de70612SMika Westerberg 
31982ba2c2aSJarkko Nikula 		if (config->reg_general >= 0) {
32082ba2c2aSJarkko Nikula 			value = __lpss_ssp_read_priv(drv_data,
32182ba2c2aSJarkko Nikula 						     config->reg_general);
322624ea72eSJarkko Nikula 			value |= LPSS_GENERAL_REG_RXTO_HOLDOFF_DISABLE;
32382ba2c2aSJarkko Nikula 			__lpss_ssp_write_priv(drv_data,
32482ba2c2aSJarkko Nikula 					      config->reg_general, value);
32582ba2c2aSJarkko Nikula 		}
3261de70612SMika Westerberg 	}
327a0d2642eSMika Westerberg }
328a0d2642eSMika Westerberg 
329c1e4a53cSMika Westerberg static void lpss_ssp_select_cs(struct driver_data *drv_data,
330c1e4a53cSMika Westerberg 			       const struct lpss_config *config)
331a0d2642eSMika Westerberg {
332d0283eb2SJarkko Nikula 	u32 value, cs;
333a0d2642eSMika Westerberg 
334c1e4a53cSMika Westerberg 	if (!config->cs_sel_mask)
335c1e4a53cSMika Westerberg 		return;
336dccf7369SJarkko Nikula 
337dccf7369SJarkko Nikula 	value = __lpss_ssp_read_priv(drv_data, config->reg_cs_ctrl);
338c1e4a53cSMika Westerberg 
3394fc0caacSJarkko Nikula 	cs = drv_data->master->cur_msg->spi->chip_select;
340c1e4a53cSMika Westerberg 	cs <<= config->cs_sel_shift;
341c1e4a53cSMika Westerberg 	if (cs != (value & config->cs_sel_mask)) {
342d0283eb2SJarkko Nikula 		/*
343c1e4a53cSMika Westerberg 		 * When switching another chip select output active the
344c1e4a53cSMika Westerberg 		 * output must be selected first and wait 2 ssp_clk cycles
345c1e4a53cSMika Westerberg 		 * before changing state to active. Otherwise a short
346c1e4a53cSMika Westerberg 		 * glitch will occur on the previous chip select since
347c1e4a53cSMika Westerberg 		 * output select is latched but state control is not.
348d0283eb2SJarkko Nikula 		 */
349c1e4a53cSMika Westerberg 		value &= ~config->cs_sel_mask;
350d0283eb2SJarkko Nikula 		value |= cs;
351d0283eb2SJarkko Nikula 		__lpss_ssp_write_priv(drv_data,
352d0283eb2SJarkko Nikula 				      config->reg_cs_ctrl, value);
353d0283eb2SJarkko Nikula 		ndelay(1000000000 /
354d0283eb2SJarkko Nikula 		       (drv_data->master->max_speed_hz / 2));
355d0283eb2SJarkko Nikula 	}
356d0283eb2SJarkko Nikula }
357c1e4a53cSMika Westerberg 
358c1e4a53cSMika Westerberg static void lpss_ssp_cs_control(struct driver_data *drv_data, bool enable)
359c1e4a53cSMika Westerberg {
360c1e4a53cSMika Westerberg 	const struct lpss_config *config;
361c1e4a53cSMika Westerberg 	u32 value;
362c1e4a53cSMika Westerberg 
363c1e4a53cSMika Westerberg 	config = lpss_get_config(drv_data);
364c1e4a53cSMika Westerberg 
365c1e4a53cSMika Westerberg 	if (enable)
366c1e4a53cSMika Westerberg 		lpss_ssp_select_cs(drv_data, config);
367c1e4a53cSMika Westerberg 
368c1e4a53cSMika Westerberg 	value = __lpss_ssp_read_priv(drv_data, config->reg_cs_ctrl);
369c1e4a53cSMika Westerberg 	if (enable)
370c1e4a53cSMika Westerberg 		value &= ~LPSS_CS_CONTROL_CS_HIGH;
371c1e4a53cSMika Westerberg 	else
372c1e4a53cSMika Westerberg 		value |= LPSS_CS_CONTROL_CS_HIGH;
373dccf7369SJarkko Nikula 	__lpss_ssp_write_priv(drv_data, config->reg_cs_ctrl, value);
374a0d2642eSMika Westerberg }
375a0d2642eSMika Westerberg 
376ca632f55SGrant Likely static void cs_assert(struct driver_data *drv_data)
377ca632f55SGrant Likely {
37896579a4eSJarkko Nikula 	struct chip_data *chip =
37996579a4eSJarkko Nikula 		spi_get_ctldata(drv_data->master->cur_msg->spi);
380ca632f55SGrant Likely 
381ca632f55SGrant Likely 	if (drv_data->ssp_type == CE4100_SSP) {
38296579a4eSJarkko Nikula 		pxa2xx_spi_write(drv_data, SSSR, chip->frm);
383ca632f55SGrant Likely 		return;
384ca632f55SGrant Likely 	}
385ca632f55SGrant Likely 
386ca632f55SGrant Likely 	if (chip->cs_control) {
387ca632f55SGrant Likely 		chip->cs_control(PXA2XX_CS_ASSERT);
388ca632f55SGrant Likely 		return;
389ca632f55SGrant Likely 	}
390ca632f55SGrant Likely 
391a0d2642eSMika Westerberg 	if (gpio_is_valid(chip->gpio_cs)) {
392ca632f55SGrant Likely 		gpio_set_value(chip->gpio_cs, chip->gpio_cs_inverted);
393a0d2642eSMika Westerberg 		return;
394a0d2642eSMika Westerberg 	}
395a0d2642eSMika Westerberg 
3967566bcc7SJarkko Nikula 	if (is_lpss_ssp(drv_data))
397a0d2642eSMika Westerberg 		lpss_ssp_cs_control(drv_data, true);
398ca632f55SGrant Likely }
399ca632f55SGrant Likely 
400ca632f55SGrant Likely static void cs_deassert(struct driver_data *drv_data)
401ca632f55SGrant Likely {
40296579a4eSJarkko Nikula 	struct chip_data *chip =
40396579a4eSJarkko Nikula 		spi_get_ctldata(drv_data->master->cur_msg->spi);
404ca632f55SGrant Likely 
405ca632f55SGrant Likely 	if (drv_data->ssp_type == CE4100_SSP)
406ca632f55SGrant Likely 		return;
407ca632f55SGrant Likely 
408ca632f55SGrant Likely 	if (chip->cs_control) {
409ca632f55SGrant Likely 		chip->cs_control(PXA2XX_CS_DEASSERT);
410ca632f55SGrant Likely 		return;
411ca632f55SGrant Likely 	}
412ca632f55SGrant Likely 
413a0d2642eSMika Westerberg 	if (gpio_is_valid(chip->gpio_cs)) {
414ca632f55SGrant Likely 		gpio_set_value(chip->gpio_cs, !chip->gpio_cs_inverted);
415a0d2642eSMika Westerberg 		return;
416a0d2642eSMika Westerberg 	}
417a0d2642eSMika Westerberg 
4187566bcc7SJarkko Nikula 	if (is_lpss_ssp(drv_data))
419a0d2642eSMika Westerberg 		lpss_ssp_cs_control(drv_data, false);
420ca632f55SGrant Likely }
421ca632f55SGrant Likely 
422cd7bed00SMika Westerberg int pxa2xx_spi_flush(struct driver_data *drv_data)
423ca632f55SGrant Likely {
424ca632f55SGrant Likely 	unsigned long limit = loops_per_jiffy << 1;
425ca632f55SGrant Likely 
426ca632f55SGrant Likely 	do {
427c039dd27SJarkko Nikula 		while (pxa2xx_spi_read(drv_data, SSSR) & SSSR_RNE)
428c039dd27SJarkko Nikula 			pxa2xx_spi_read(drv_data, SSDR);
429c039dd27SJarkko Nikula 	} while ((pxa2xx_spi_read(drv_data, SSSR) & SSSR_BSY) && --limit);
430ca632f55SGrant Likely 	write_SSSR_CS(drv_data, SSSR_ROR);
431ca632f55SGrant Likely 
432ca632f55SGrant Likely 	return limit;
433ca632f55SGrant Likely }
434ca632f55SGrant Likely 
435ca632f55SGrant Likely static int null_writer(struct driver_data *drv_data)
436ca632f55SGrant Likely {
437ca632f55SGrant Likely 	u8 n_bytes = drv_data->n_bytes;
438ca632f55SGrant Likely 
4394fdb2424SWeike Chen 	if (pxa2xx_spi_txfifo_full(drv_data)
440ca632f55SGrant Likely 		|| (drv_data->tx == drv_data->tx_end))
441ca632f55SGrant Likely 		return 0;
442ca632f55SGrant Likely 
443c039dd27SJarkko Nikula 	pxa2xx_spi_write(drv_data, SSDR, 0);
444ca632f55SGrant Likely 	drv_data->tx += n_bytes;
445ca632f55SGrant Likely 
446ca632f55SGrant Likely 	return 1;
447ca632f55SGrant Likely }
448ca632f55SGrant Likely 
449ca632f55SGrant Likely static int null_reader(struct driver_data *drv_data)
450ca632f55SGrant Likely {
451ca632f55SGrant Likely 	u8 n_bytes = drv_data->n_bytes;
452ca632f55SGrant Likely 
453c039dd27SJarkko Nikula 	while ((pxa2xx_spi_read(drv_data, SSSR) & SSSR_RNE)
454ca632f55SGrant Likely 	       && (drv_data->rx < drv_data->rx_end)) {
455c039dd27SJarkko Nikula 		pxa2xx_spi_read(drv_data, SSDR);
456ca632f55SGrant Likely 		drv_data->rx += n_bytes;
457ca632f55SGrant Likely 	}
458ca632f55SGrant Likely 
459ca632f55SGrant Likely 	return drv_data->rx == drv_data->rx_end;
460ca632f55SGrant Likely }
461ca632f55SGrant Likely 
462ca632f55SGrant Likely static int u8_writer(struct driver_data *drv_data)
463ca632f55SGrant Likely {
4644fdb2424SWeike Chen 	if (pxa2xx_spi_txfifo_full(drv_data)
465ca632f55SGrant Likely 		|| (drv_data->tx == drv_data->tx_end))
466ca632f55SGrant Likely 		return 0;
467ca632f55SGrant Likely 
468c039dd27SJarkko Nikula 	pxa2xx_spi_write(drv_data, SSDR, *(u8 *)(drv_data->tx));
469ca632f55SGrant Likely 	++drv_data->tx;
470ca632f55SGrant Likely 
471ca632f55SGrant Likely 	return 1;
472ca632f55SGrant Likely }
473ca632f55SGrant Likely 
474ca632f55SGrant Likely static int u8_reader(struct driver_data *drv_data)
475ca632f55SGrant Likely {
476c039dd27SJarkko Nikula 	while ((pxa2xx_spi_read(drv_data, SSSR) & SSSR_RNE)
477ca632f55SGrant Likely 	       && (drv_data->rx < drv_data->rx_end)) {
478c039dd27SJarkko Nikula 		*(u8 *)(drv_data->rx) = pxa2xx_spi_read(drv_data, SSDR);
479ca632f55SGrant Likely 		++drv_data->rx;
480ca632f55SGrant Likely 	}
481ca632f55SGrant Likely 
482ca632f55SGrant Likely 	return drv_data->rx == drv_data->rx_end;
483ca632f55SGrant Likely }
484ca632f55SGrant Likely 
485ca632f55SGrant Likely static int u16_writer(struct driver_data *drv_data)
486ca632f55SGrant Likely {
4874fdb2424SWeike Chen 	if (pxa2xx_spi_txfifo_full(drv_data)
488ca632f55SGrant Likely 		|| (drv_data->tx == drv_data->tx_end))
489ca632f55SGrant Likely 		return 0;
490ca632f55SGrant Likely 
491c039dd27SJarkko Nikula 	pxa2xx_spi_write(drv_data, SSDR, *(u16 *)(drv_data->tx));
492ca632f55SGrant Likely 	drv_data->tx += 2;
493ca632f55SGrant Likely 
494ca632f55SGrant Likely 	return 1;
495ca632f55SGrant Likely }
496ca632f55SGrant Likely 
497ca632f55SGrant Likely static int u16_reader(struct driver_data *drv_data)
498ca632f55SGrant Likely {
499c039dd27SJarkko Nikula 	while ((pxa2xx_spi_read(drv_data, SSSR) & SSSR_RNE)
500ca632f55SGrant Likely 	       && (drv_data->rx < drv_data->rx_end)) {
501c039dd27SJarkko Nikula 		*(u16 *)(drv_data->rx) = pxa2xx_spi_read(drv_data, SSDR);
502ca632f55SGrant Likely 		drv_data->rx += 2;
503ca632f55SGrant Likely 	}
504ca632f55SGrant Likely 
505ca632f55SGrant Likely 	return drv_data->rx == drv_data->rx_end;
506ca632f55SGrant Likely }
507ca632f55SGrant Likely 
508ca632f55SGrant Likely static int u32_writer(struct driver_data *drv_data)
509ca632f55SGrant Likely {
5104fdb2424SWeike Chen 	if (pxa2xx_spi_txfifo_full(drv_data)
511ca632f55SGrant Likely 		|| (drv_data->tx == drv_data->tx_end))
512ca632f55SGrant Likely 		return 0;
513ca632f55SGrant Likely 
514c039dd27SJarkko Nikula 	pxa2xx_spi_write(drv_data, SSDR, *(u32 *)(drv_data->tx));
515ca632f55SGrant Likely 	drv_data->tx += 4;
516ca632f55SGrant Likely 
517ca632f55SGrant Likely 	return 1;
518ca632f55SGrant Likely }
519ca632f55SGrant Likely 
520ca632f55SGrant Likely static int u32_reader(struct driver_data *drv_data)
521ca632f55SGrant Likely {
522c039dd27SJarkko Nikula 	while ((pxa2xx_spi_read(drv_data, SSSR) & SSSR_RNE)
523ca632f55SGrant Likely 	       && (drv_data->rx < drv_data->rx_end)) {
524c039dd27SJarkko Nikula 		*(u32 *)(drv_data->rx) = pxa2xx_spi_read(drv_data, SSDR);
525ca632f55SGrant Likely 		drv_data->rx += 4;
526ca632f55SGrant Likely 	}
527ca632f55SGrant Likely 
528ca632f55SGrant Likely 	return drv_data->rx == drv_data->rx_end;
529ca632f55SGrant Likely }
530ca632f55SGrant Likely 
531cd7bed00SMika Westerberg void *pxa2xx_spi_next_transfer(struct driver_data *drv_data)
532ca632f55SGrant Likely {
5334fc0caacSJarkko Nikula 	struct spi_message *msg = drv_data->master->cur_msg;
534ca632f55SGrant Likely 	struct spi_transfer *trans = drv_data->cur_transfer;
535ca632f55SGrant Likely 
536ca632f55SGrant Likely 	/* Move to next transfer */
537ca632f55SGrant Likely 	if (trans->transfer_list.next != &msg->transfers) {
538ca632f55SGrant Likely 		drv_data->cur_transfer =
539ca632f55SGrant Likely 			list_entry(trans->transfer_list.next,
540ca632f55SGrant Likely 					struct spi_transfer,
541ca632f55SGrant Likely 					transfer_list);
542ca632f55SGrant Likely 		return RUNNING_STATE;
543ca632f55SGrant Likely 	} else
544ca632f55SGrant Likely 		return DONE_STATE;
545ca632f55SGrant Likely }
546ca632f55SGrant Likely 
547ca632f55SGrant Likely /* caller already set message->status; dma and pio irqs are blocked */
548ca632f55SGrant Likely static void giveback(struct driver_data *drv_data)
549ca632f55SGrant Likely {
550ca632f55SGrant Likely 	struct spi_transfer* last_transfer;
551ca632f55SGrant Likely 	struct spi_message *msg;
5527a8d44bcSJarkko Nikula 	unsigned long timeout;
553ca632f55SGrant Likely 
5544fc0caacSJarkko Nikula 	msg = drv_data->master->cur_msg;
555ca632f55SGrant Likely 	drv_data->cur_transfer = NULL;
556ca632f55SGrant Likely 
55723e2c2aaSAxel Lin 	last_transfer = list_last_entry(&msg->transfers, struct spi_transfer,
558ca632f55SGrant Likely 					transfer_list);
559ca632f55SGrant Likely 
560ca632f55SGrant Likely 	/* Delay if requested before any change in chip select */
561ca632f55SGrant Likely 	if (last_transfer->delay_usecs)
562ca632f55SGrant Likely 		udelay(last_transfer->delay_usecs);
563ca632f55SGrant Likely 
5647a8d44bcSJarkko Nikula 	/* Wait until SSP becomes idle before deasserting the CS */
5657a8d44bcSJarkko Nikula 	timeout = jiffies + msecs_to_jiffies(10);
5667a8d44bcSJarkko Nikula 	while (pxa2xx_spi_read(drv_data, SSSR) & SSSR_BSY &&
5677a8d44bcSJarkko Nikula 	       !time_after(jiffies, timeout))
5687a8d44bcSJarkko Nikula 		cpu_relax();
5697a8d44bcSJarkko Nikula 
570ca632f55SGrant Likely 	/* Drop chip select UNLESS cs_change is true or we are returning
571ca632f55SGrant Likely 	 * a message with an error, or next message is for another chip
572ca632f55SGrant Likely 	 */
573ca632f55SGrant Likely 	if (!last_transfer->cs_change)
574ca632f55SGrant Likely 		cs_deassert(drv_data);
575ca632f55SGrant Likely 	else {
576ca632f55SGrant Likely 		struct spi_message *next_msg;
577ca632f55SGrant Likely 
578ca632f55SGrant Likely 		/* Holding of cs was hinted, but we need to make sure
579ca632f55SGrant Likely 		 * the next message is for the same chip.  Don't waste
580ca632f55SGrant Likely 		 * time with the following tests unless this was hinted.
581ca632f55SGrant Likely 		 *
582ca632f55SGrant Likely 		 * We cannot postpone this until pump_messages, because
583ca632f55SGrant Likely 		 * after calling msg->complete (below) the driver that
584ca632f55SGrant Likely 		 * sent the current message could be unloaded, which
585ca632f55SGrant Likely 		 * could invalidate the cs_control() callback...
586ca632f55SGrant Likely 		 */
587ca632f55SGrant Likely 
588ca632f55SGrant Likely 		/* get a pointer to the next message, if any */
5897f86bde9SMika Westerberg 		next_msg = spi_get_next_queued_message(drv_data->master);
590ca632f55SGrant Likely 
591ca632f55SGrant Likely 		/* see if the next and current messages point
592ca632f55SGrant Likely 		 * to the same chip
593ca632f55SGrant Likely 		 */
594a52db659SChristophe Ricard 		if ((next_msg && next_msg->spi != msg->spi) ||
595a52db659SChristophe Ricard 		    msg->state == ERROR_STATE)
596ca632f55SGrant Likely 			cs_deassert(drv_data);
597ca632f55SGrant Likely 	}
598ca632f55SGrant Likely 
599c957e8f0SMika Westerberg 	spi_finalize_current_message(drv_data->master);
600ca632f55SGrant Likely }
601ca632f55SGrant Likely 
602ca632f55SGrant Likely static void reset_sccr1(struct driver_data *drv_data)
603ca632f55SGrant Likely {
60496579a4eSJarkko Nikula 	struct chip_data *chip =
60596579a4eSJarkko Nikula 		spi_get_ctldata(drv_data->master->cur_msg->spi);
606ca632f55SGrant Likely 	u32 sccr1_reg;
607ca632f55SGrant Likely 
608c039dd27SJarkko Nikula 	sccr1_reg = pxa2xx_spi_read(drv_data, SSCR1) & ~drv_data->int_cr1;
609152bc19eSAndy Shevchenko 	switch (drv_data->ssp_type) {
610152bc19eSAndy Shevchenko 	case QUARK_X1000_SSP:
611152bc19eSAndy Shevchenko 		sccr1_reg &= ~QUARK_X1000_SSCR1_RFT;
612152bc19eSAndy Shevchenko 		break;
613*7c7289a4SAndy Shevchenko 	case CE4100_SSP:
614*7c7289a4SAndy Shevchenko 		sccr1_reg &= ~CE4100_SSCR1_RFT;
615*7c7289a4SAndy Shevchenko 		break;
616152bc19eSAndy Shevchenko 	default:
617ca632f55SGrant Likely 		sccr1_reg &= ~SSCR1_RFT;
618152bc19eSAndy Shevchenko 		break;
619152bc19eSAndy Shevchenko 	}
620ca632f55SGrant Likely 	sccr1_reg |= chip->threshold;
621c039dd27SJarkko Nikula 	pxa2xx_spi_write(drv_data, SSCR1, sccr1_reg);
622ca632f55SGrant Likely }
623ca632f55SGrant Likely 
624ca632f55SGrant Likely static void int_error_stop(struct driver_data *drv_data, const char* msg)
625ca632f55SGrant Likely {
626ca632f55SGrant Likely 	/* Stop and reset SSP */
627ca632f55SGrant Likely 	write_SSSR_CS(drv_data, drv_data->clear_sr);
628ca632f55SGrant Likely 	reset_sccr1(drv_data);
629ca632f55SGrant Likely 	if (!pxa25x_ssp_comp(drv_data))
630c039dd27SJarkko Nikula 		pxa2xx_spi_write(drv_data, SSTO, 0);
631cd7bed00SMika Westerberg 	pxa2xx_spi_flush(drv_data);
632c039dd27SJarkko Nikula 	pxa2xx_spi_write(drv_data, SSCR0,
633c039dd27SJarkko Nikula 			 pxa2xx_spi_read(drv_data, SSCR0) & ~SSCR0_SSE);
634ca632f55SGrant Likely 
635ca632f55SGrant Likely 	dev_err(&drv_data->pdev->dev, "%s\n", msg);
636ca632f55SGrant Likely 
6374fc0caacSJarkko Nikula 	drv_data->master->cur_msg->state = ERROR_STATE;
638ca632f55SGrant Likely 	tasklet_schedule(&drv_data->pump_transfers);
639ca632f55SGrant Likely }
640ca632f55SGrant Likely 
641ca632f55SGrant Likely static void int_transfer_complete(struct driver_data *drv_data)
642ca632f55SGrant Likely {
64307550df0SJarkko Nikula 	/* Clear and disable interrupts */
644ca632f55SGrant Likely 	write_SSSR_CS(drv_data, drv_data->clear_sr);
645ca632f55SGrant Likely 	reset_sccr1(drv_data);
646ca632f55SGrant Likely 	if (!pxa25x_ssp_comp(drv_data))
647c039dd27SJarkko Nikula 		pxa2xx_spi_write(drv_data, SSTO, 0);
648ca632f55SGrant Likely 
649ca632f55SGrant Likely 	/* Update total byte transferred return count actual bytes read */
6504fc0caacSJarkko Nikula 	drv_data->master->cur_msg->actual_length += drv_data->len -
651ca632f55SGrant Likely 				(drv_data->rx_end - drv_data->rx);
652ca632f55SGrant Likely 
653ca632f55SGrant Likely 	/* Transfer delays and chip select release are
654ca632f55SGrant Likely 	 * handled in pump_transfers or giveback
655ca632f55SGrant Likely 	 */
656ca632f55SGrant Likely 
657ca632f55SGrant Likely 	/* Move to next transfer */
6584fc0caacSJarkko Nikula 	drv_data->master->cur_msg->state = pxa2xx_spi_next_transfer(drv_data);
659ca632f55SGrant Likely 
660ca632f55SGrant Likely 	/* Schedule transfer tasklet */
661ca632f55SGrant Likely 	tasklet_schedule(&drv_data->pump_transfers);
662ca632f55SGrant Likely }
663ca632f55SGrant Likely 
664ca632f55SGrant Likely static irqreturn_t interrupt_transfer(struct driver_data *drv_data)
665ca632f55SGrant Likely {
666c039dd27SJarkko Nikula 	u32 irq_mask = (pxa2xx_spi_read(drv_data, SSCR1) & SSCR1_TIE) ?
667ca632f55SGrant Likely 		       drv_data->mask_sr : drv_data->mask_sr & ~SSSR_TFS;
668ca632f55SGrant Likely 
669c039dd27SJarkko Nikula 	u32 irq_status = pxa2xx_spi_read(drv_data, SSSR) & irq_mask;
670ca632f55SGrant Likely 
671ca632f55SGrant Likely 	if (irq_status & SSSR_ROR) {
672ca632f55SGrant Likely 		int_error_stop(drv_data, "interrupt_transfer: fifo overrun");
673ca632f55SGrant Likely 		return IRQ_HANDLED;
674ca632f55SGrant Likely 	}
675ca632f55SGrant Likely 
676ca632f55SGrant Likely 	if (irq_status & SSSR_TINT) {
677c039dd27SJarkko Nikula 		pxa2xx_spi_write(drv_data, SSSR, SSSR_TINT);
678ca632f55SGrant Likely 		if (drv_data->read(drv_data)) {
679ca632f55SGrant Likely 			int_transfer_complete(drv_data);
680ca632f55SGrant Likely 			return IRQ_HANDLED;
681ca632f55SGrant Likely 		}
682ca632f55SGrant Likely 	}
683ca632f55SGrant Likely 
684ca632f55SGrant Likely 	/* Drain rx fifo, Fill tx fifo and prevent overruns */
685ca632f55SGrant Likely 	do {
686ca632f55SGrant Likely 		if (drv_data->read(drv_data)) {
687ca632f55SGrant Likely 			int_transfer_complete(drv_data);
688ca632f55SGrant Likely 			return IRQ_HANDLED;
689ca632f55SGrant Likely 		}
690ca632f55SGrant Likely 	} while (drv_data->write(drv_data));
691ca632f55SGrant Likely 
692ca632f55SGrant Likely 	if (drv_data->read(drv_data)) {
693ca632f55SGrant Likely 		int_transfer_complete(drv_data);
694ca632f55SGrant Likely 		return IRQ_HANDLED;
695ca632f55SGrant Likely 	}
696ca632f55SGrant Likely 
697ca632f55SGrant Likely 	if (drv_data->tx == drv_data->tx_end) {
698ca632f55SGrant Likely 		u32 bytes_left;
699ca632f55SGrant Likely 		u32 sccr1_reg;
700ca632f55SGrant Likely 
701c039dd27SJarkko Nikula 		sccr1_reg = pxa2xx_spi_read(drv_data, SSCR1);
702ca632f55SGrant Likely 		sccr1_reg &= ~SSCR1_TIE;
703ca632f55SGrant Likely 
704ca632f55SGrant Likely 		/*
705ca632f55SGrant Likely 		 * PXA25x_SSP has no timeout, set up rx threshould for the
706ca632f55SGrant Likely 		 * remaining RX bytes.
707ca632f55SGrant Likely 		 */
708ca632f55SGrant Likely 		if (pxa25x_ssp_comp(drv_data)) {
7094fdb2424SWeike Chen 			u32 rx_thre;
710ca632f55SGrant Likely 
7114fdb2424SWeike Chen 			pxa2xx_spi_clear_rx_thre(drv_data, &sccr1_reg);
712ca632f55SGrant Likely 
713ca632f55SGrant Likely 			bytes_left = drv_data->rx_end - drv_data->rx;
714ca632f55SGrant Likely 			switch (drv_data->n_bytes) {
715ca632f55SGrant Likely 			case 4:
716ca632f55SGrant Likely 				bytes_left >>= 1;
717ca632f55SGrant Likely 			case 2:
718ca632f55SGrant Likely 				bytes_left >>= 1;
719ca632f55SGrant Likely 			}
720ca632f55SGrant Likely 
7214fdb2424SWeike Chen 			rx_thre = pxa2xx_spi_get_rx_default_thre(drv_data);
7224fdb2424SWeike Chen 			if (rx_thre > bytes_left)
7234fdb2424SWeike Chen 				rx_thre = bytes_left;
724ca632f55SGrant Likely 
7254fdb2424SWeike Chen 			pxa2xx_spi_set_rx_thre(drv_data, &sccr1_reg, rx_thre);
726ca632f55SGrant Likely 		}
727c039dd27SJarkko Nikula 		pxa2xx_spi_write(drv_data, SSCR1, sccr1_reg);
728ca632f55SGrant Likely 	}
729ca632f55SGrant Likely 
730ca632f55SGrant Likely 	/* We did something */
731ca632f55SGrant Likely 	return IRQ_HANDLED;
732ca632f55SGrant Likely }
733ca632f55SGrant Likely 
734ca632f55SGrant Likely static irqreturn_t ssp_int(int irq, void *dev_id)
735ca632f55SGrant Likely {
736ca632f55SGrant Likely 	struct driver_data *drv_data = dev_id;
7377d94a505SMika Westerberg 	u32 sccr1_reg;
738ca632f55SGrant Likely 	u32 mask = drv_data->mask_sr;
739ca632f55SGrant Likely 	u32 status;
740ca632f55SGrant Likely 
7417d94a505SMika Westerberg 	/*
7427d94a505SMika Westerberg 	 * The IRQ might be shared with other peripherals so we must first
7437d94a505SMika Westerberg 	 * check that are we RPM suspended or not. If we are we assume that
7447d94a505SMika Westerberg 	 * the IRQ was not for us (we shouldn't be RPM suspended when the
7457d94a505SMika Westerberg 	 * interrupt is enabled).
7467d94a505SMika Westerberg 	 */
7477d94a505SMika Westerberg 	if (pm_runtime_suspended(&drv_data->pdev->dev))
7487d94a505SMika Westerberg 		return IRQ_NONE;
7497d94a505SMika Westerberg 
750269e4a41SMika Westerberg 	/*
751269e4a41SMika Westerberg 	 * If the device is not yet in RPM suspended state and we get an
752269e4a41SMika Westerberg 	 * interrupt that is meant for another device, check if status bits
753269e4a41SMika Westerberg 	 * are all set to one. That means that the device is already
754269e4a41SMika Westerberg 	 * powered off.
755269e4a41SMika Westerberg 	 */
756c039dd27SJarkko Nikula 	status = pxa2xx_spi_read(drv_data, SSSR);
757269e4a41SMika Westerberg 	if (status == ~0)
758269e4a41SMika Westerberg 		return IRQ_NONE;
759269e4a41SMika Westerberg 
760c039dd27SJarkko Nikula 	sccr1_reg = pxa2xx_spi_read(drv_data, SSCR1);
761ca632f55SGrant Likely 
762ca632f55SGrant Likely 	/* Ignore possible writes if we don't need to write */
763ca632f55SGrant Likely 	if (!(sccr1_reg & SSCR1_TIE))
764ca632f55SGrant Likely 		mask &= ~SSSR_TFS;
765ca632f55SGrant Likely 
76602bc933eSTan, Jui Nee 	/* Ignore RX timeout interrupt if it is disabled */
76702bc933eSTan, Jui Nee 	if (!(sccr1_reg & SSCR1_TINTE))
76802bc933eSTan, Jui Nee 		mask &= ~SSSR_TINT;
76902bc933eSTan, Jui Nee 
770ca632f55SGrant Likely 	if (!(status & mask))
771ca632f55SGrant Likely 		return IRQ_NONE;
772ca632f55SGrant Likely 
7734fc0caacSJarkko Nikula 	if (!drv_data->master->cur_msg) {
774ca632f55SGrant Likely 
775c039dd27SJarkko Nikula 		pxa2xx_spi_write(drv_data, SSCR0,
776c039dd27SJarkko Nikula 				 pxa2xx_spi_read(drv_data, SSCR0)
777c039dd27SJarkko Nikula 				 & ~SSCR0_SSE);
778c039dd27SJarkko Nikula 		pxa2xx_spi_write(drv_data, SSCR1,
779c039dd27SJarkko Nikula 				 pxa2xx_spi_read(drv_data, SSCR1)
780c039dd27SJarkko Nikula 				 & ~drv_data->int_cr1);
781ca632f55SGrant Likely 		if (!pxa25x_ssp_comp(drv_data))
782c039dd27SJarkko Nikula 			pxa2xx_spi_write(drv_data, SSTO, 0);
783ca632f55SGrant Likely 		write_SSSR_CS(drv_data, drv_data->clear_sr);
784ca632f55SGrant Likely 
785f6bd03a7SJarkko Nikula 		dev_err(&drv_data->pdev->dev,
786f6bd03a7SJarkko Nikula 			"bad message state in interrupt handler\n");
787ca632f55SGrant Likely 
788ca632f55SGrant Likely 		/* Never fail */
789ca632f55SGrant Likely 		return IRQ_HANDLED;
790ca632f55SGrant Likely 	}
791ca632f55SGrant Likely 
792ca632f55SGrant Likely 	return drv_data->transfer_handler(drv_data);
793ca632f55SGrant Likely }
794ca632f55SGrant Likely 
795e5262d05SWeike Chen /*
7969df461ecSAndy Shevchenko  * The Quark SPI has an additional 24 bit register (DDS_CLK_RATE) to multiply
7979df461ecSAndy Shevchenko  * input frequency by fractions of 2^24. It also has a divider by 5.
7989df461ecSAndy Shevchenko  *
7999df461ecSAndy Shevchenko  * There are formulas to get baud rate value for given input frequency and
8009df461ecSAndy Shevchenko  * divider parameters, such as DDS_CLK_RATE and SCR:
8019df461ecSAndy Shevchenko  *
8029df461ecSAndy Shevchenko  * Fsys = 200MHz
8039df461ecSAndy Shevchenko  *
8049df461ecSAndy Shevchenko  * Fssp = Fsys * DDS_CLK_RATE / 2^24			(1)
8059df461ecSAndy Shevchenko  * Baud rate = Fsclk = Fssp / (2 * (SCR + 1))		(2)
8069df461ecSAndy Shevchenko  *
8079df461ecSAndy Shevchenko  * DDS_CLK_RATE either 2^n or 2^n / 5.
8089df461ecSAndy Shevchenko  * SCR is in range 0 .. 255
8099df461ecSAndy Shevchenko  *
8109df461ecSAndy Shevchenko  * Divisor = 5^i * 2^j * 2 * k
8119df461ecSAndy Shevchenko  *       i = [0, 1]      i = 1 iff j = 0 or j > 3
8129df461ecSAndy Shevchenko  *       j = [0, 23]     j = 0 iff i = 1
8139df461ecSAndy Shevchenko  *       k = [1, 256]
8149df461ecSAndy Shevchenko  * Special case: j = 0, i = 1: Divisor = 2 / 5
8159df461ecSAndy Shevchenko  *
8169df461ecSAndy Shevchenko  * Accordingly to the specification the recommended values for DDS_CLK_RATE
8179df461ecSAndy Shevchenko  * are:
8189df461ecSAndy Shevchenko  *	Case 1:		2^n, n = [0, 23]
8199df461ecSAndy Shevchenko  *	Case 2:		2^24 * 2 / 5 (0x666666)
8209df461ecSAndy Shevchenko  *	Case 3:		less than or equal to 2^24 / 5 / 16 (0x33333)
8219df461ecSAndy Shevchenko  *
8229df461ecSAndy Shevchenko  * In all cases the lowest possible value is better.
8239df461ecSAndy Shevchenko  *
8249df461ecSAndy Shevchenko  * The function calculates parameters for all cases and chooses the one closest
8259df461ecSAndy Shevchenko  * to the asked baud rate.
826e5262d05SWeike Chen  */
8279df461ecSAndy Shevchenko static unsigned int quark_x1000_get_clk_div(int rate, u32 *dds)
828e5262d05SWeike Chen {
8299df461ecSAndy Shevchenko 	unsigned long xtal = 200000000;
8309df461ecSAndy Shevchenko 	unsigned long fref = xtal / 2;		/* mandatory division by 2,
8319df461ecSAndy Shevchenko 						   see (2) */
8329df461ecSAndy Shevchenko 						/* case 3 */
8339df461ecSAndy Shevchenko 	unsigned long fref1 = fref / 2;		/* case 1 */
8349df461ecSAndy Shevchenko 	unsigned long fref2 = fref * 2 / 5;	/* case 2 */
8359df461ecSAndy Shevchenko 	unsigned long scale;
8369df461ecSAndy Shevchenko 	unsigned long q, q1, q2;
8379df461ecSAndy Shevchenko 	long r, r1, r2;
8389df461ecSAndy Shevchenko 	u32 mul;
839e5262d05SWeike Chen 
8409df461ecSAndy Shevchenko 	/* Case 1 */
8419df461ecSAndy Shevchenko 
8429df461ecSAndy Shevchenko 	/* Set initial value for DDS_CLK_RATE */
8439df461ecSAndy Shevchenko 	mul = (1 << 24) >> 1;
8449df461ecSAndy Shevchenko 
8459df461ecSAndy Shevchenko 	/* Calculate initial quot */
8463ad48062SAndy Shevchenko 	q1 = DIV_ROUND_UP(fref1, rate);
8479df461ecSAndy Shevchenko 
8489df461ecSAndy Shevchenko 	/* Scale q1 if it's too big */
8499df461ecSAndy Shevchenko 	if (q1 > 256) {
8509df461ecSAndy Shevchenko 		/* Scale q1 to range [1, 512] */
8519df461ecSAndy Shevchenko 		scale = fls_long(q1 - 1);
8529df461ecSAndy Shevchenko 		if (scale > 9) {
8539df461ecSAndy Shevchenko 			q1 >>= scale - 9;
8549df461ecSAndy Shevchenko 			mul >>= scale - 9;
8559df461ecSAndy Shevchenko 		}
8569df461ecSAndy Shevchenko 
8579df461ecSAndy Shevchenko 		/* Round the result if we have a remainder */
8589df461ecSAndy Shevchenko 		q1 += q1 & 1;
8599df461ecSAndy Shevchenko 	}
8609df461ecSAndy Shevchenko 
8619df461ecSAndy Shevchenko 	/* Decrease DDS_CLK_RATE as much as we can without loss in precision */
8629df461ecSAndy Shevchenko 	scale = __ffs(q1);
8639df461ecSAndy Shevchenko 	q1 >>= scale;
8649df461ecSAndy Shevchenko 	mul >>= scale;
8659df461ecSAndy Shevchenko 
8669df461ecSAndy Shevchenko 	/* Get the remainder */
8679df461ecSAndy Shevchenko 	r1 = abs(fref1 / (1 << (24 - fls_long(mul))) / q1 - rate);
8689df461ecSAndy Shevchenko 
8699df461ecSAndy Shevchenko 	/* Case 2 */
8709df461ecSAndy Shevchenko 
8713ad48062SAndy Shevchenko 	q2 = DIV_ROUND_UP(fref2, rate);
8729df461ecSAndy Shevchenko 	r2 = abs(fref2 / q2 - rate);
8739df461ecSAndy Shevchenko 
8749df461ecSAndy Shevchenko 	/*
8759df461ecSAndy Shevchenko 	 * Choose the best between two: less remainder we have the better. We
8769df461ecSAndy Shevchenko 	 * can't go case 2 if q2 is greater than 256 since SCR register can
8779df461ecSAndy Shevchenko 	 * hold only values 0 .. 255.
8789df461ecSAndy Shevchenko 	 */
8799df461ecSAndy Shevchenko 	if (r2 >= r1 || q2 > 256) {
8809df461ecSAndy Shevchenko 		/* case 1 is better */
8819df461ecSAndy Shevchenko 		r = r1;
8829df461ecSAndy Shevchenko 		q = q1;
8839df461ecSAndy Shevchenko 	} else {
8849df461ecSAndy Shevchenko 		/* case 2 is better */
8859df461ecSAndy Shevchenko 		r = r2;
8869df461ecSAndy Shevchenko 		q = q2;
8879df461ecSAndy Shevchenko 		mul = (1 << 24) * 2 / 5;
8889df461ecSAndy Shevchenko 	}
8899df461ecSAndy Shevchenko 
8903ad48062SAndy Shevchenko 	/* Check case 3 only if the divisor is big enough */
8919df461ecSAndy Shevchenko 	if (fref / rate >= 80) {
8929df461ecSAndy Shevchenko 		u64 fssp;
8939df461ecSAndy Shevchenko 		u32 m;
8949df461ecSAndy Shevchenko 
8959df461ecSAndy Shevchenko 		/* Calculate initial quot */
8963ad48062SAndy Shevchenko 		q1 = DIV_ROUND_UP(fref, rate);
8979df461ecSAndy Shevchenko 		m = (1 << 24) / q1;
8989df461ecSAndy Shevchenko 
8999df461ecSAndy Shevchenko 		/* Get the remainder */
9009df461ecSAndy Shevchenko 		fssp = (u64)fref * m;
9019df461ecSAndy Shevchenko 		do_div(fssp, 1 << 24);
9029df461ecSAndy Shevchenko 		r1 = abs(fssp - rate);
9039df461ecSAndy Shevchenko 
9049df461ecSAndy Shevchenko 		/* Choose this one if it suits better */
9059df461ecSAndy Shevchenko 		if (r1 < r) {
9069df461ecSAndy Shevchenko 			/* case 3 is better */
9079df461ecSAndy Shevchenko 			q = 1;
9089df461ecSAndy Shevchenko 			mul = m;
909e5262d05SWeike Chen 		}
910e5262d05SWeike Chen 	}
911e5262d05SWeike Chen 
9129df461ecSAndy Shevchenko 	*dds = mul;
9139df461ecSAndy Shevchenko 	return q - 1;
914e5262d05SWeike Chen }
915e5262d05SWeike Chen 
9163343b7a6SMika Westerberg static unsigned int ssp_get_clk_div(struct driver_data *drv_data, int rate)
917ca632f55SGrant Likely {
9180eca7cf2SJarkko Nikula 	unsigned long ssp_clk = drv_data->master->max_speed_hz;
9193343b7a6SMika Westerberg 	const struct ssp_device *ssp = drv_data->ssp;
9203343b7a6SMika Westerberg 
9213343b7a6SMika Westerberg 	rate = min_t(int, ssp_clk, rate);
922ca632f55SGrant Likely 
923ca632f55SGrant Likely 	if (ssp->type == PXA25x_SSP || ssp->type == CE4100_SSP)
924025ffe88SAndy Shevchenko 		return (ssp_clk / (2 * rate) - 1) & 0xff;
925ca632f55SGrant Likely 	else
926025ffe88SAndy Shevchenko 		return (ssp_clk / rate - 1) & 0xfff;
927ca632f55SGrant Likely }
928ca632f55SGrant Likely 
929e5262d05SWeike Chen static unsigned int pxa2xx_ssp_get_clk_div(struct driver_data *drv_data,
930d2c2f6a4SAndy Shevchenko 					   int rate)
931e5262d05SWeike Chen {
93296579a4eSJarkko Nikula 	struct chip_data *chip =
93396579a4eSJarkko Nikula 		spi_get_ctldata(drv_data->master->cur_msg->spi);
934025ffe88SAndy Shevchenko 	unsigned int clk_div;
935e5262d05SWeike Chen 
936e5262d05SWeike Chen 	switch (drv_data->ssp_type) {
937e5262d05SWeike Chen 	case QUARK_X1000_SSP:
9389df461ecSAndy Shevchenko 		clk_div = quark_x1000_get_clk_div(rate, &chip->dds_rate);
939eecacf73SDan Carpenter 		break;
940e5262d05SWeike Chen 	default:
941025ffe88SAndy Shevchenko 		clk_div = ssp_get_clk_div(drv_data, rate);
942eecacf73SDan Carpenter 		break;
943e5262d05SWeike Chen 	}
944025ffe88SAndy Shevchenko 	return clk_div << 8;
945e5262d05SWeike Chen }
946e5262d05SWeike Chen 
947b6ced294SJarkko Nikula static bool pxa2xx_spi_can_dma(struct spi_master *master,
948b6ced294SJarkko Nikula 			       struct spi_device *spi,
949b6ced294SJarkko Nikula 			       struct spi_transfer *xfer)
950b6ced294SJarkko Nikula {
951b6ced294SJarkko Nikula 	struct chip_data *chip = spi_get_ctldata(spi);
952b6ced294SJarkko Nikula 
953b6ced294SJarkko Nikula 	return chip->enable_dma &&
954b6ced294SJarkko Nikula 	       xfer->len <= MAX_DMA_LEN &&
955b6ced294SJarkko Nikula 	       xfer->len >= chip->dma_burst_size;
956b6ced294SJarkko Nikula }
957b6ced294SJarkko Nikula 
958ca632f55SGrant Likely static void pump_transfers(unsigned long data)
959ca632f55SGrant Likely {
960ca632f55SGrant Likely 	struct driver_data *drv_data = (struct driver_data *)data;
9612d7537d8SJarkko Nikula 	struct spi_master *master = drv_data->master;
9624fc0caacSJarkko Nikula 	struct spi_message *message = master->cur_msg;
96396579a4eSJarkko Nikula 	struct chip_data *chip = spi_get_ctldata(message->spi);
96496579a4eSJarkko Nikula 	u32 dma_thresh = chip->dma_threshold;
96596579a4eSJarkko Nikula 	u32 dma_burst = chip->dma_burst_size;
96696579a4eSJarkko Nikula 	u32 change_mask = pxa2xx_spi_get_ssrc1_change_mask(drv_data);
967bffc967eSJarkko Nikula 	struct spi_transfer *transfer;
968bffc967eSJarkko Nikula 	struct spi_transfer *previous;
969bffc967eSJarkko Nikula 	u32 clk_div;
970bffc967eSJarkko Nikula 	u8 bits;
971bffc967eSJarkko Nikula 	u32 speed;
972ca632f55SGrant Likely 	u32 cr0;
973ca632f55SGrant Likely 	u32 cr1;
9747d1f1bf6SAndy Shevchenko 	int err;
975b6ced294SJarkko Nikula 	int dma_mapped;
976ca632f55SGrant Likely 
977ca632f55SGrant Likely 	/* Get current state information */
978ca632f55SGrant Likely 	transfer = drv_data->cur_transfer;
979ca632f55SGrant Likely 
980ca632f55SGrant Likely 	/* Handle for abort */
981ca632f55SGrant Likely 	if (message->state == ERROR_STATE) {
982ca632f55SGrant Likely 		message->status = -EIO;
983ca632f55SGrant Likely 		giveback(drv_data);
984ca632f55SGrant Likely 		return;
985ca632f55SGrant Likely 	}
986ca632f55SGrant Likely 
987ca632f55SGrant Likely 	/* Handle end of message */
988ca632f55SGrant Likely 	if (message->state == DONE_STATE) {
989ca632f55SGrant Likely 		message->status = 0;
990ca632f55SGrant Likely 		giveback(drv_data);
991ca632f55SGrant Likely 		return;
992ca632f55SGrant Likely 	}
993ca632f55SGrant Likely 
994ca632f55SGrant Likely 	/* Delay if requested at end of transfer before CS change */
995ca632f55SGrant Likely 	if (message->state == RUNNING_STATE) {
996ca632f55SGrant Likely 		previous = list_entry(transfer->transfer_list.prev,
997ca632f55SGrant Likely 					struct spi_transfer,
998ca632f55SGrant Likely 					transfer_list);
999ca632f55SGrant Likely 		if (previous->delay_usecs)
1000ca632f55SGrant Likely 			udelay(previous->delay_usecs);
1001ca632f55SGrant Likely 
1002ca632f55SGrant Likely 		/* Drop chip select only if cs_change is requested */
1003ca632f55SGrant Likely 		if (previous->cs_change)
1004ca632f55SGrant Likely 			cs_deassert(drv_data);
1005ca632f55SGrant Likely 	}
1006ca632f55SGrant Likely 
1007cd7bed00SMika Westerberg 	/* Check if we can DMA this transfer */
1008b6ced294SJarkko Nikula 	if (transfer->len > MAX_DMA_LEN && chip->enable_dma) {
1009ca632f55SGrant Likely 
1010ca632f55SGrant Likely 		/* reject already-mapped transfers; PIO won't always work */
1011ca632f55SGrant Likely 		if (message->is_dma_mapped
1012ca632f55SGrant Likely 				|| transfer->rx_dma || transfer->tx_dma) {
1013ca632f55SGrant Likely 			dev_err(&drv_data->pdev->dev,
1014f6bd03a7SJarkko Nikula 				"pump_transfers: mapped transfer length of "
1015f6bd03a7SJarkko Nikula 				"%u is greater than %d\n",
1016ca632f55SGrant Likely 				transfer->len, MAX_DMA_LEN);
1017ca632f55SGrant Likely 			message->status = -EINVAL;
1018ca632f55SGrant Likely 			giveback(drv_data);
1019ca632f55SGrant Likely 			return;
1020ca632f55SGrant Likely 		}
1021ca632f55SGrant Likely 
1022ca632f55SGrant Likely 		/* warn ... we force this to PIO mode */
1023f6bd03a7SJarkko Nikula 		dev_warn_ratelimited(&message->spi->dev,
1024f6bd03a7SJarkko Nikula 				     "pump_transfers: DMA disabled for transfer length %ld "
1025ca632f55SGrant Likely 				     "greater than %d\n",
1026ca632f55SGrant Likely 				     (long)drv_data->len, MAX_DMA_LEN);
1027ca632f55SGrant Likely 	}
1028ca632f55SGrant Likely 
1029ca632f55SGrant Likely 	/* Setup the transfer state based on the type of transfer */
1030cd7bed00SMika Westerberg 	if (pxa2xx_spi_flush(drv_data) == 0) {
1031ca632f55SGrant Likely 		dev_err(&drv_data->pdev->dev, "pump_transfers: flush failed\n");
1032ca632f55SGrant Likely 		message->status = -EIO;
1033ca632f55SGrant Likely 		giveback(drv_data);
1034ca632f55SGrant Likely 		return;
1035ca632f55SGrant Likely 	}
1036ca632f55SGrant Likely 	drv_data->n_bytes = chip->n_bytes;
1037ca632f55SGrant Likely 	drv_data->tx = (void *)transfer->tx_buf;
1038ca632f55SGrant Likely 	drv_data->tx_end = drv_data->tx + transfer->len;
1039ca632f55SGrant Likely 	drv_data->rx = transfer->rx_buf;
1040ca632f55SGrant Likely 	drv_data->rx_end = drv_data->rx + transfer->len;
1041cd7bed00SMika Westerberg 	drv_data->len = transfer->len;
1042ca632f55SGrant Likely 	drv_data->write = drv_data->tx ? chip->write : null_writer;
1043ca632f55SGrant Likely 	drv_data->read = drv_data->rx ? chip->read : null_reader;
1044ca632f55SGrant Likely 
1045ca632f55SGrant Likely 	/* Change speed and bit per word on a per transfer */
1046ca632f55SGrant Likely 	bits = transfer->bits_per_word;
1047ca632f55SGrant Likely 	speed = transfer->speed_hz;
1048ca632f55SGrant Likely 
1049d2c2f6a4SAndy Shevchenko 	clk_div = pxa2xx_ssp_get_clk_div(drv_data, speed);
1050ca632f55SGrant Likely 
1051ca632f55SGrant Likely 	if (bits <= 8) {
1052ca632f55SGrant Likely 		drv_data->n_bytes = 1;
1053ca632f55SGrant Likely 		drv_data->read = drv_data->read != null_reader ?
1054ca632f55SGrant Likely 					u8_reader : null_reader;
1055ca632f55SGrant Likely 		drv_data->write = drv_data->write != null_writer ?
1056ca632f55SGrant Likely 					u8_writer : null_writer;
1057ca632f55SGrant Likely 	} else if (bits <= 16) {
1058ca632f55SGrant Likely 		drv_data->n_bytes = 2;
1059ca632f55SGrant Likely 		drv_data->read = drv_data->read != null_reader ?
1060ca632f55SGrant Likely 					u16_reader : null_reader;
1061ca632f55SGrant Likely 		drv_data->write = drv_data->write != null_writer ?
1062ca632f55SGrant Likely 					u16_writer : null_writer;
1063ca632f55SGrant Likely 	} else if (bits <= 32) {
1064ca632f55SGrant Likely 		drv_data->n_bytes = 4;
1065ca632f55SGrant Likely 		drv_data->read = drv_data->read != null_reader ?
1066ca632f55SGrant Likely 					u32_reader : null_reader;
1067ca632f55SGrant Likely 		drv_data->write = drv_data->write != null_writer ?
1068ca632f55SGrant Likely 					u32_writer : null_writer;
1069ca632f55SGrant Likely 	}
1070196b0e2cSJarkko Nikula 	/*
1071196b0e2cSJarkko Nikula 	 * if bits/word is changed in dma mode, then must check the
1072196b0e2cSJarkko Nikula 	 * thresholds and burst also
1073196b0e2cSJarkko Nikula 	 */
1074ca632f55SGrant Likely 	if (chip->enable_dma) {
1075cd7bed00SMika Westerberg 		if (pxa2xx_spi_set_dma_burst_and_threshold(chip,
1076cd7bed00SMika Westerberg 						message->spi,
1077ca632f55SGrant Likely 						bits, &dma_burst,
1078ca632f55SGrant Likely 						&dma_thresh))
1079f6bd03a7SJarkko Nikula 			dev_warn_ratelimited(&message->spi->dev,
1080f6bd03a7SJarkko Nikula 					     "pump_transfers: DMA burst size reduced to match bits_per_word\n");
1081ca632f55SGrant Likely 	}
1082ca632f55SGrant Likely 
1083ca632f55SGrant Likely 	message->state = RUNNING_STATE;
1084ca632f55SGrant Likely 
1085b6ced294SJarkko Nikula 	dma_mapped = master->can_dma &&
1086b6ced294SJarkko Nikula 		     master->can_dma(master, message->spi, transfer) &&
1087b6ced294SJarkko Nikula 		     master->cur_msg_mapped;
1088b6ced294SJarkko Nikula 	if (dma_mapped) {
1089ca632f55SGrant Likely 
1090ca632f55SGrant Likely 		/* Ensure we have the correct interrupt handler */
1091cd7bed00SMika Westerberg 		drv_data->transfer_handler = pxa2xx_spi_dma_transfer;
1092ca632f55SGrant Likely 
10937d1f1bf6SAndy Shevchenko 		err = pxa2xx_spi_dma_prepare(drv_data, dma_burst);
10947d1f1bf6SAndy Shevchenko 		if (err) {
10957d1f1bf6SAndy Shevchenko 			message->status = err;
10967d1f1bf6SAndy Shevchenko 			giveback(drv_data);
10977d1f1bf6SAndy Shevchenko 			return;
10987d1f1bf6SAndy Shevchenko 		}
1099ca632f55SGrant Likely 
1100ca632f55SGrant Likely 		/* Clear status and start DMA engine */
1101ca632f55SGrant Likely 		cr1 = chip->cr1 | dma_thresh | drv_data->dma_cr1;
1102c039dd27SJarkko Nikula 		pxa2xx_spi_write(drv_data, SSSR, drv_data->clear_sr);
1103cd7bed00SMika Westerberg 
1104cd7bed00SMika Westerberg 		pxa2xx_spi_dma_start(drv_data);
1105ca632f55SGrant Likely 	} else {
1106ca632f55SGrant Likely 		/* Ensure we have the correct interrupt handler	*/
1107ca632f55SGrant Likely 		drv_data->transfer_handler = interrupt_transfer;
1108ca632f55SGrant Likely 
1109ca632f55SGrant Likely 		/* Clear status  */
1110ca632f55SGrant Likely 		cr1 = chip->cr1 | chip->threshold | drv_data->int_cr1;
1111ca632f55SGrant Likely 		write_SSSR_CS(drv_data, drv_data->clear_sr);
1112ca632f55SGrant Likely 	}
1113ca632f55SGrant Likely 
1114ee03672dSJarkko Nikula 	/* NOTE:  PXA25x_SSP _could_ use external clocking ... */
1115ee03672dSJarkko Nikula 	cr0 = pxa2xx_configure_sscr0(drv_data, clk_div, bits);
1116ee03672dSJarkko Nikula 	if (!pxa25x_ssp_comp(drv_data))
1117ee03672dSJarkko Nikula 		dev_dbg(&message->spi->dev, "%u Hz actual, %s\n",
11182d7537d8SJarkko Nikula 			master->max_speed_hz
1119ee03672dSJarkko Nikula 				/ (1 + ((cr0 & SSCR0_SCR(0xfff)) >> 8)),
1120b6ced294SJarkko Nikula 			dma_mapped ? "DMA" : "PIO");
1121ee03672dSJarkko Nikula 	else
1122ee03672dSJarkko Nikula 		dev_dbg(&message->spi->dev, "%u Hz actual, %s\n",
11232d7537d8SJarkko Nikula 			master->max_speed_hz / 2
1124ee03672dSJarkko Nikula 				/ (1 + ((cr0 & SSCR0_SCR(0x0ff)) >> 8)),
1125b6ced294SJarkko Nikula 			dma_mapped ? "DMA" : "PIO");
1126ee03672dSJarkko Nikula 
1127a0d2642eSMika Westerberg 	if (is_lpss_ssp(drv_data)) {
1128c039dd27SJarkko Nikula 		if ((pxa2xx_spi_read(drv_data, SSIRF) & 0xff)
1129c039dd27SJarkko Nikula 		    != chip->lpss_rx_threshold)
1130c039dd27SJarkko Nikula 			pxa2xx_spi_write(drv_data, SSIRF,
1131c039dd27SJarkko Nikula 					 chip->lpss_rx_threshold);
1132c039dd27SJarkko Nikula 		if ((pxa2xx_spi_read(drv_data, SSITF) & 0xffff)
1133c039dd27SJarkko Nikula 		    != chip->lpss_tx_threshold)
1134c039dd27SJarkko Nikula 			pxa2xx_spi_write(drv_data, SSITF,
1135c039dd27SJarkko Nikula 					 chip->lpss_tx_threshold);
1136a0d2642eSMika Westerberg 	}
1137a0d2642eSMika Westerberg 
1138e5262d05SWeike Chen 	if (is_quark_x1000_ssp(drv_data) &&
1139c039dd27SJarkko Nikula 	    (pxa2xx_spi_read(drv_data, DDS_RATE) != chip->dds_rate))
1140c039dd27SJarkko Nikula 		pxa2xx_spi_write(drv_data, DDS_RATE, chip->dds_rate);
1141e5262d05SWeike Chen 
1142ca632f55SGrant Likely 	/* see if we need to reload the config registers */
1143c039dd27SJarkko Nikula 	if ((pxa2xx_spi_read(drv_data, SSCR0) != cr0)
1144c039dd27SJarkko Nikula 	    || (pxa2xx_spi_read(drv_data, SSCR1) & change_mask)
1145c039dd27SJarkko Nikula 	    != (cr1 & change_mask)) {
1146ca632f55SGrant Likely 		/* stop the SSP, and update the other bits */
1147c039dd27SJarkko Nikula 		pxa2xx_spi_write(drv_data, SSCR0, cr0 & ~SSCR0_SSE);
1148ca632f55SGrant Likely 		if (!pxa25x_ssp_comp(drv_data))
1149c039dd27SJarkko Nikula 			pxa2xx_spi_write(drv_data, SSTO, chip->timeout);
1150ca632f55SGrant Likely 		/* first set CR1 without interrupt and service enables */
1151c039dd27SJarkko Nikula 		pxa2xx_spi_write(drv_data, SSCR1, cr1 & change_mask);
1152ca632f55SGrant Likely 		/* restart the SSP */
1153c039dd27SJarkko Nikula 		pxa2xx_spi_write(drv_data, SSCR0, cr0);
1154ca632f55SGrant Likely 
1155ca632f55SGrant Likely 	} else {
1156ca632f55SGrant Likely 		if (!pxa25x_ssp_comp(drv_data))
1157c039dd27SJarkko Nikula 			pxa2xx_spi_write(drv_data, SSTO, chip->timeout);
1158ca632f55SGrant Likely 	}
1159ca632f55SGrant Likely 
1160ca632f55SGrant Likely 	cs_assert(drv_data);
1161ca632f55SGrant Likely 
1162ca632f55SGrant Likely 	/* after chip select, release the data by enabling service
1163ca632f55SGrant Likely 	 * requests and interrupts, without changing any mode bits */
1164c039dd27SJarkko Nikula 	pxa2xx_spi_write(drv_data, SSCR1, cr1);
1165ca632f55SGrant Likely }
1166ca632f55SGrant Likely 
11677f86bde9SMika Westerberg static int pxa2xx_spi_transfer_one_message(struct spi_master *master,
11687f86bde9SMika Westerberg 					   struct spi_message *msg)
1169ca632f55SGrant Likely {
11707f86bde9SMika Westerberg 	struct driver_data *drv_data = spi_master_get_devdata(master);
1171ca632f55SGrant Likely 
1172ca632f55SGrant Likely 	/* Initial message state*/
11734fc0caacSJarkko Nikula 	msg->state = START_STATE;
11744fc0caacSJarkko Nikula 	drv_data->cur_transfer = list_entry(msg->transfers.next,
1175ca632f55SGrant Likely 						struct spi_transfer,
1176ca632f55SGrant Likely 						transfer_list);
1177ca632f55SGrant Likely 
1178ca632f55SGrant Likely 	/* Mark as busy and launch transfers */
1179ca632f55SGrant Likely 	tasklet_schedule(&drv_data->pump_transfers);
1180ca632f55SGrant Likely 	return 0;
1181ca632f55SGrant Likely }
1182ca632f55SGrant Likely 
11837d94a505SMika Westerberg static int pxa2xx_spi_unprepare_transfer(struct spi_master *master)
11847d94a505SMika Westerberg {
11857d94a505SMika Westerberg 	struct driver_data *drv_data = spi_master_get_devdata(master);
11867d94a505SMika Westerberg 
11877d94a505SMika Westerberg 	/* Disable the SSP now */
1188c039dd27SJarkko Nikula 	pxa2xx_spi_write(drv_data, SSCR0,
1189c039dd27SJarkko Nikula 			 pxa2xx_spi_read(drv_data, SSCR0) & ~SSCR0_SSE);
11907d94a505SMika Westerberg 
11917d94a505SMika Westerberg 	return 0;
11927d94a505SMika Westerberg }
11937d94a505SMika Westerberg 
1194ca632f55SGrant Likely static int setup_cs(struct spi_device *spi, struct chip_data *chip,
1195ca632f55SGrant Likely 		    struct pxa2xx_spi_chip *chip_info)
1196ca632f55SGrant Likely {
1197ca632f55SGrant Likely 	int err = 0;
1198ca632f55SGrant Likely 
1199ca632f55SGrant Likely 	if (chip == NULL || chip_info == NULL)
1200ca632f55SGrant Likely 		return 0;
1201ca632f55SGrant Likely 
1202ca632f55SGrant Likely 	/* NOTE: setup() can be called multiple times, possibly with
1203ca632f55SGrant Likely 	 * different chip_info, release previously requested GPIO
1204ca632f55SGrant Likely 	 */
1205ca632f55SGrant Likely 	if (gpio_is_valid(chip->gpio_cs))
1206ca632f55SGrant Likely 		gpio_free(chip->gpio_cs);
1207ca632f55SGrant Likely 
1208ca632f55SGrant Likely 	/* If (*cs_control) is provided, ignore GPIO chip select */
1209ca632f55SGrant Likely 	if (chip_info->cs_control) {
1210ca632f55SGrant Likely 		chip->cs_control = chip_info->cs_control;
1211ca632f55SGrant Likely 		return 0;
1212ca632f55SGrant Likely 	}
1213ca632f55SGrant Likely 
1214ca632f55SGrant Likely 	if (gpio_is_valid(chip_info->gpio_cs)) {
1215ca632f55SGrant Likely 		err = gpio_request(chip_info->gpio_cs, "SPI_CS");
1216ca632f55SGrant Likely 		if (err) {
1217f6bd03a7SJarkko Nikula 			dev_err(&spi->dev, "failed to request chip select GPIO%d\n",
1218f6bd03a7SJarkko Nikula 				chip_info->gpio_cs);
1219ca632f55SGrant Likely 			return err;
1220ca632f55SGrant Likely 		}
1221ca632f55SGrant Likely 
1222ca632f55SGrant Likely 		chip->gpio_cs = chip_info->gpio_cs;
1223ca632f55SGrant Likely 		chip->gpio_cs_inverted = spi->mode & SPI_CS_HIGH;
1224ca632f55SGrant Likely 
1225ca632f55SGrant Likely 		err = gpio_direction_output(chip->gpio_cs,
1226ca632f55SGrant Likely 					!chip->gpio_cs_inverted);
1227ca632f55SGrant Likely 	}
1228ca632f55SGrant Likely 
1229ca632f55SGrant Likely 	return err;
1230ca632f55SGrant Likely }
1231ca632f55SGrant Likely 
1232ca632f55SGrant Likely static int setup(struct spi_device *spi)
1233ca632f55SGrant Likely {
1234bffc967eSJarkko Nikula 	struct pxa2xx_spi_chip *chip_info;
1235ca632f55SGrant Likely 	struct chip_data *chip;
1236dccf7369SJarkko Nikula 	const struct lpss_config *config;
1237ca632f55SGrant Likely 	struct driver_data *drv_data = spi_master_get_devdata(spi->master);
1238a0d2642eSMika Westerberg 	uint tx_thres, tx_hi_thres, rx_thres;
1239a0d2642eSMika Westerberg 
1240e5262d05SWeike Chen 	switch (drv_data->ssp_type) {
1241e5262d05SWeike Chen 	case QUARK_X1000_SSP:
1242e5262d05SWeike Chen 		tx_thres = TX_THRESH_QUARK_X1000_DFLT;
1243e5262d05SWeike Chen 		tx_hi_thres = 0;
1244e5262d05SWeike Chen 		rx_thres = RX_THRESH_QUARK_X1000_DFLT;
1245e5262d05SWeike Chen 		break;
1246*7c7289a4SAndy Shevchenko 	case CE4100_SSP:
1247*7c7289a4SAndy Shevchenko 		tx_thres = TX_THRESH_CE4100_DFLT;
1248*7c7289a4SAndy Shevchenko 		tx_hi_thres = 0;
1249*7c7289a4SAndy Shevchenko 		rx_thres = RX_THRESH_CE4100_DFLT;
1250*7c7289a4SAndy Shevchenko 		break;
125103fbf488SJarkko Nikula 	case LPSS_LPT_SSP:
125203fbf488SJarkko Nikula 	case LPSS_BYT_SSP:
125330f3a6abSMika Westerberg 	case LPSS_BSW_SSP:
125434cadd9cSJarkko Nikula 	case LPSS_SPT_SSP:
1255b7c08cf8SJarkko Nikula 	case LPSS_BXT_SSP:
1256dccf7369SJarkko Nikula 		config = lpss_get_config(drv_data);
1257dccf7369SJarkko Nikula 		tx_thres = config->tx_threshold_lo;
1258dccf7369SJarkko Nikula 		tx_hi_thres = config->tx_threshold_hi;
1259dccf7369SJarkko Nikula 		rx_thres = config->rx_threshold;
1260e5262d05SWeike Chen 		break;
1261e5262d05SWeike Chen 	default:
1262a0d2642eSMika Westerberg 		tx_thres = TX_THRESH_DFLT;
1263a0d2642eSMika Westerberg 		tx_hi_thres = 0;
1264a0d2642eSMika Westerberg 		rx_thres = RX_THRESH_DFLT;
1265e5262d05SWeike Chen 		break;
1266a0d2642eSMika Westerberg 	}
1267ca632f55SGrant Likely 
1268ca632f55SGrant Likely 	/* Only alloc on first setup */
1269ca632f55SGrant Likely 	chip = spi_get_ctldata(spi);
1270ca632f55SGrant Likely 	if (!chip) {
1271ca632f55SGrant Likely 		chip = kzalloc(sizeof(struct chip_data), GFP_KERNEL);
12729deae459SJingoo Han 		if (!chip)
1273ca632f55SGrant Likely 			return -ENOMEM;
1274ca632f55SGrant Likely 
1275ca632f55SGrant Likely 		if (drv_data->ssp_type == CE4100_SSP) {
1276ca632f55SGrant Likely 			if (spi->chip_select > 4) {
1277f6bd03a7SJarkko Nikula 				dev_err(&spi->dev,
1278f6bd03a7SJarkko Nikula 					"failed setup: cs number must not be > 4.\n");
1279ca632f55SGrant Likely 				kfree(chip);
1280ca632f55SGrant Likely 				return -EINVAL;
1281ca632f55SGrant Likely 			}
1282ca632f55SGrant Likely 
1283ca632f55SGrant Likely 			chip->frm = spi->chip_select;
1284ca632f55SGrant Likely 		} else
1285ca632f55SGrant Likely 			chip->gpio_cs = -1;
1286c64e1265SDan O'Donovan 		chip->enable_dma = drv_data->master_info->enable_dma;
1287ca632f55SGrant Likely 		chip->timeout = TIMOUT_DFLT;
1288ca632f55SGrant Likely 	}
1289ca632f55SGrant Likely 
1290ca632f55SGrant Likely 	/* protocol drivers may change the chip settings, so...
1291ca632f55SGrant Likely 	 * if chip_info exists, use it */
1292ca632f55SGrant Likely 	chip_info = spi->controller_data;
1293ca632f55SGrant Likely 
1294ca632f55SGrant Likely 	/* chip_info isn't always needed */
1295ca632f55SGrant Likely 	chip->cr1 = 0;
1296ca632f55SGrant Likely 	if (chip_info) {
1297ca632f55SGrant Likely 		if (chip_info->timeout)
1298ca632f55SGrant Likely 			chip->timeout = chip_info->timeout;
1299ca632f55SGrant Likely 		if (chip_info->tx_threshold)
1300ca632f55SGrant Likely 			tx_thres = chip_info->tx_threshold;
1301a0d2642eSMika Westerberg 		if (chip_info->tx_hi_threshold)
1302a0d2642eSMika Westerberg 			tx_hi_thres = chip_info->tx_hi_threshold;
1303ca632f55SGrant Likely 		if (chip_info->rx_threshold)
1304ca632f55SGrant Likely 			rx_thres = chip_info->rx_threshold;
1305ca632f55SGrant Likely 		chip->dma_threshold = 0;
1306ca632f55SGrant Likely 		if (chip_info->enable_loopback)
1307ca632f55SGrant Likely 			chip->cr1 = SSCR1_LBM;
1308ca632f55SGrant Likely 	}
1309ca632f55SGrant Likely 
1310a0d2642eSMika Westerberg 	chip->lpss_rx_threshold = SSIRF_RxThresh(rx_thres);
1311a0d2642eSMika Westerberg 	chip->lpss_tx_threshold = SSITF_TxLoThresh(tx_thres)
1312a0d2642eSMika Westerberg 				| SSITF_TxHiThresh(tx_hi_thres);
1313a0d2642eSMika Westerberg 
1314ca632f55SGrant Likely 	/* set dma burst and threshold outside of chip_info path so that if
1315ca632f55SGrant Likely 	 * chip_info goes away after setting chip->enable_dma, the
1316ca632f55SGrant Likely 	 * burst and threshold can still respond to changes in bits_per_word */
1317ca632f55SGrant Likely 	if (chip->enable_dma) {
1318ca632f55SGrant Likely 		/* set up legal burst and threshold for dma */
1319cd7bed00SMika Westerberg 		if (pxa2xx_spi_set_dma_burst_and_threshold(chip, spi,
1320cd7bed00SMika Westerberg 						spi->bits_per_word,
1321ca632f55SGrant Likely 						&chip->dma_burst_size,
1322ca632f55SGrant Likely 						&chip->dma_threshold)) {
1323f6bd03a7SJarkko Nikula 			dev_warn(&spi->dev,
1324f6bd03a7SJarkko Nikula 				 "in setup: DMA burst size reduced to match bits_per_word\n");
1325ca632f55SGrant Likely 		}
1326ca632f55SGrant Likely 	}
1327ca632f55SGrant Likely 
1328e5262d05SWeike Chen 	switch (drv_data->ssp_type) {
1329e5262d05SWeike Chen 	case QUARK_X1000_SSP:
1330e5262d05SWeike Chen 		chip->threshold = (QUARK_X1000_SSCR1_RxTresh(rx_thres)
1331e5262d05SWeike Chen 				   & QUARK_X1000_SSCR1_RFT)
1332e5262d05SWeike Chen 				   | (QUARK_X1000_SSCR1_TxTresh(tx_thres)
1333e5262d05SWeike Chen 				   & QUARK_X1000_SSCR1_TFT);
1334e5262d05SWeike Chen 		break;
1335*7c7289a4SAndy Shevchenko 	case CE4100_SSP:
1336*7c7289a4SAndy Shevchenko 		chip->threshold = (CE4100_SSCR1_RxTresh(rx_thres) & CE4100_SSCR1_RFT) |
1337*7c7289a4SAndy Shevchenko 			(CE4100_SSCR1_TxTresh(tx_thres) & CE4100_SSCR1_TFT);
1338*7c7289a4SAndy Shevchenko 		break;
1339e5262d05SWeike Chen 	default:
1340e5262d05SWeike Chen 		chip->threshold = (SSCR1_RxTresh(rx_thres) & SSCR1_RFT) |
1341e5262d05SWeike Chen 			(SSCR1_TxTresh(tx_thres) & SSCR1_TFT);
1342e5262d05SWeike Chen 		break;
1343e5262d05SWeike Chen 	}
1344e5262d05SWeike Chen 
1345ca632f55SGrant Likely 	chip->cr1 &= ~(SSCR1_SPO | SSCR1_SPH);
1346ca632f55SGrant Likely 	chip->cr1 |= (((spi->mode & SPI_CPHA) != 0) ? SSCR1_SPH : 0)
1347ca632f55SGrant Likely 			| (((spi->mode & SPI_CPOL) != 0) ? SSCR1_SPO : 0);
1348ca632f55SGrant Likely 
1349b833172fSMika Westerberg 	if (spi->mode & SPI_LOOP)
1350b833172fSMika Westerberg 		chip->cr1 |= SSCR1_LBM;
1351b833172fSMika Westerberg 
1352ca632f55SGrant Likely 	if (spi->bits_per_word <= 8) {
1353ca632f55SGrant Likely 		chip->n_bytes = 1;
1354ca632f55SGrant Likely 		chip->read = u8_reader;
1355ca632f55SGrant Likely 		chip->write = u8_writer;
1356ca632f55SGrant Likely 	} else if (spi->bits_per_word <= 16) {
1357ca632f55SGrant Likely 		chip->n_bytes = 2;
1358ca632f55SGrant Likely 		chip->read = u16_reader;
1359ca632f55SGrant Likely 		chip->write = u16_writer;
1360ca632f55SGrant Likely 	} else if (spi->bits_per_word <= 32) {
1361ca632f55SGrant Likely 		chip->n_bytes = 4;
1362ca632f55SGrant Likely 		chip->read = u32_reader;
1363ca632f55SGrant Likely 		chip->write = u32_writer;
1364ca632f55SGrant Likely 	}
1365ca632f55SGrant Likely 
1366ca632f55SGrant Likely 	spi_set_ctldata(spi, chip);
1367ca632f55SGrant Likely 
1368ca632f55SGrant Likely 	if (drv_data->ssp_type == CE4100_SSP)
1369ca632f55SGrant Likely 		return 0;
1370ca632f55SGrant Likely 
1371ca632f55SGrant Likely 	return setup_cs(spi, chip, chip_info);
1372ca632f55SGrant Likely }
1373ca632f55SGrant Likely 
1374ca632f55SGrant Likely static void cleanup(struct spi_device *spi)
1375ca632f55SGrant Likely {
1376ca632f55SGrant Likely 	struct chip_data *chip = spi_get_ctldata(spi);
1377ca632f55SGrant Likely 	struct driver_data *drv_data = spi_master_get_devdata(spi->master);
1378ca632f55SGrant Likely 
1379ca632f55SGrant Likely 	if (!chip)
1380ca632f55SGrant Likely 		return;
1381ca632f55SGrant Likely 
1382ca632f55SGrant Likely 	if (drv_data->ssp_type != CE4100_SSP && gpio_is_valid(chip->gpio_cs))
1383ca632f55SGrant Likely 		gpio_free(chip->gpio_cs);
1384ca632f55SGrant Likely 
1385ca632f55SGrant Likely 	kfree(chip);
1386ca632f55SGrant Likely }
1387ca632f55SGrant Likely 
13880db64215SJarkko Nikula #ifdef CONFIG_PCI
1389a3496855SMika Westerberg #ifdef CONFIG_ACPI
139003fbf488SJarkko Nikula 
13918422ddf7SMathias Krause static const struct acpi_device_id pxa2xx_spi_acpi_match[] = {
139203fbf488SJarkko Nikula 	{ "INT33C0", LPSS_LPT_SSP },
139303fbf488SJarkko Nikula 	{ "INT33C1", LPSS_LPT_SSP },
139403fbf488SJarkko Nikula 	{ "INT3430", LPSS_LPT_SSP },
139503fbf488SJarkko Nikula 	{ "INT3431", LPSS_LPT_SSP },
139603fbf488SJarkko Nikula 	{ "80860F0E", LPSS_BYT_SSP },
139730f3a6abSMika Westerberg 	{ "8086228E", LPSS_BSW_SSP },
139803fbf488SJarkko Nikula 	{ },
139903fbf488SJarkko Nikula };
140003fbf488SJarkko Nikula MODULE_DEVICE_TABLE(acpi, pxa2xx_spi_acpi_match);
140103fbf488SJarkko Nikula 
14020db64215SJarkko Nikula static int pxa2xx_spi_get_port_id(struct acpi_device *adev)
14030db64215SJarkko Nikula {
14040db64215SJarkko Nikula 	unsigned int devid;
14050db64215SJarkko Nikula 	int port_id = -1;
14060db64215SJarkko Nikula 
14070db64215SJarkko Nikula 	if (adev && adev->pnp.unique_id &&
14080db64215SJarkko Nikula 	    !kstrtouint(adev->pnp.unique_id, 0, &devid))
14090db64215SJarkko Nikula 		port_id = devid;
14100db64215SJarkko Nikula 	return port_id;
14110db64215SJarkko Nikula }
14120db64215SJarkko Nikula #else /* !CONFIG_ACPI */
14130db64215SJarkko Nikula static int pxa2xx_spi_get_port_id(struct acpi_device *adev)
14140db64215SJarkko Nikula {
14150db64215SJarkko Nikula 	return -1;
14160db64215SJarkko Nikula }
14170db64215SJarkko Nikula #endif
14180db64215SJarkko Nikula 
141934cadd9cSJarkko Nikula /*
142034cadd9cSJarkko Nikula  * PCI IDs of compound devices that integrate both host controller and private
142134cadd9cSJarkko Nikula  * integrated DMA engine. Please note these are not used in module
142234cadd9cSJarkko Nikula  * autoloading and probing in this module but matching the LPSS SSP type.
142334cadd9cSJarkko Nikula  */
142434cadd9cSJarkko Nikula static const struct pci_device_id pxa2xx_spi_pci_compound_match[] = {
142534cadd9cSJarkko Nikula 	/* SPT-LP */
142634cadd9cSJarkko Nikula 	{ PCI_VDEVICE(INTEL, 0x9d29), LPSS_SPT_SSP },
142734cadd9cSJarkko Nikula 	{ PCI_VDEVICE(INTEL, 0x9d2a), LPSS_SPT_SSP },
142834cadd9cSJarkko Nikula 	/* SPT-H */
142934cadd9cSJarkko Nikula 	{ PCI_VDEVICE(INTEL, 0xa129), LPSS_SPT_SSP },
143034cadd9cSJarkko Nikula 	{ PCI_VDEVICE(INTEL, 0xa12a), LPSS_SPT_SSP },
1431704d2b07SMika Westerberg 	/* KBL-H */
1432704d2b07SMika Westerberg 	{ PCI_VDEVICE(INTEL, 0xa2a9), LPSS_SPT_SSP },
1433704d2b07SMika Westerberg 	{ PCI_VDEVICE(INTEL, 0xa2aa), LPSS_SPT_SSP },
1434c1b03f11SJarkko Nikula 	/* BXT A-Step */
1435b7c08cf8SJarkko Nikula 	{ PCI_VDEVICE(INTEL, 0x0ac2), LPSS_BXT_SSP },
1436b7c08cf8SJarkko Nikula 	{ PCI_VDEVICE(INTEL, 0x0ac4), LPSS_BXT_SSP },
1437b7c08cf8SJarkko Nikula 	{ PCI_VDEVICE(INTEL, 0x0ac6), LPSS_BXT_SSP },
1438c1b03f11SJarkko Nikula 	/* BXT B-Step */
1439c1b03f11SJarkko Nikula 	{ PCI_VDEVICE(INTEL, 0x1ac2), LPSS_BXT_SSP },
1440c1b03f11SJarkko Nikula 	{ PCI_VDEVICE(INTEL, 0x1ac4), LPSS_BXT_SSP },
1441c1b03f11SJarkko Nikula 	{ PCI_VDEVICE(INTEL, 0x1ac6), LPSS_BXT_SSP },
1442b7c08cf8SJarkko Nikula 	/* APL */
1443b7c08cf8SJarkko Nikula 	{ PCI_VDEVICE(INTEL, 0x5ac2), LPSS_BXT_SSP },
1444b7c08cf8SJarkko Nikula 	{ PCI_VDEVICE(INTEL, 0x5ac4), LPSS_BXT_SSP },
1445b7c08cf8SJarkko Nikula 	{ PCI_VDEVICE(INTEL, 0x5ac6), LPSS_BXT_SSP },
144694e5c23dSAxel Lin 	{ },
144734cadd9cSJarkko Nikula };
144834cadd9cSJarkko Nikula 
144934cadd9cSJarkko Nikula static bool pxa2xx_spi_idma_filter(struct dma_chan *chan, void *param)
145034cadd9cSJarkko Nikula {
145134cadd9cSJarkko Nikula 	struct device *dev = param;
145234cadd9cSJarkko Nikula 
145334cadd9cSJarkko Nikula 	if (dev != chan->device->dev->parent)
145434cadd9cSJarkko Nikula 		return false;
145534cadd9cSJarkko Nikula 
145634cadd9cSJarkko Nikula 	return true;
145734cadd9cSJarkko Nikula }
145834cadd9cSJarkko Nikula 
1459a3496855SMika Westerberg static struct pxa2xx_spi_master *
14600db64215SJarkko Nikula pxa2xx_spi_init_pdata(struct platform_device *pdev)
1461a3496855SMika Westerberg {
1462a3496855SMika Westerberg 	struct pxa2xx_spi_master *pdata;
1463a3496855SMika Westerberg 	struct acpi_device *adev;
1464a3496855SMika Westerberg 	struct ssp_device *ssp;
1465a3496855SMika Westerberg 	struct resource *res;
146634cadd9cSJarkko Nikula 	const struct acpi_device_id *adev_id = NULL;
146734cadd9cSJarkko Nikula 	const struct pci_device_id *pcidev_id = NULL;
14683b8b6d05SJarkko Nikula 	int type;
1469a3496855SMika Westerberg 
1470b9f6940aSJarkko Nikula 	adev = ACPI_COMPANION(&pdev->dev);
1471a3496855SMika Westerberg 
147234cadd9cSJarkko Nikula 	if (dev_is_pci(pdev->dev.parent))
147334cadd9cSJarkko Nikula 		pcidev_id = pci_match_id(pxa2xx_spi_pci_compound_match,
147434cadd9cSJarkko Nikula 					 to_pci_dev(pdev->dev.parent));
14750db64215SJarkko Nikula 	else if (adev)
147634cadd9cSJarkko Nikula 		adev_id = acpi_match_device(pdev->dev.driver->acpi_match_table,
147734cadd9cSJarkko Nikula 					    &pdev->dev);
14780db64215SJarkko Nikula 	else
14790db64215SJarkko Nikula 		return NULL;
148034cadd9cSJarkko Nikula 
148134cadd9cSJarkko Nikula 	if (adev_id)
148234cadd9cSJarkko Nikula 		type = (int)adev_id->driver_data;
148334cadd9cSJarkko Nikula 	else if (pcidev_id)
148434cadd9cSJarkko Nikula 		type = (int)pcidev_id->driver_data;
148503fbf488SJarkko Nikula 	else
148603fbf488SJarkko Nikula 		return NULL;
148703fbf488SJarkko Nikula 
1488cc0ee987SMika Westerberg 	pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
14899deae459SJingoo Han 	if (!pdata)
1490a3496855SMika Westerberg 		return NULL;
1491a3496855SMika Westerberg 
1492a3496855SMika Westerberg 	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1493a3496855SMika Westerberg 	if (!res)
1494a3496855SMika Westerberg 		return NULL;
1495a3496855SMika Westerberg 
1496a3496855SMika Westerberg 	ssp = &pdata->ssp;
1497a3496855SMika Westerberg 
1498a3496855SMika Westerberg 	ssp->phys_base = res->start;
1499cbfd6a21SSachin Kamat 	ssp->mmio_base = devm_ioremap_resource(&pdev->dev, res);
1500cbfd6a21SSachin Kamat 	if (IS_ERR(ssp->mmio_base))
15016dc81f6fSMika Westerberg 		return NULL;
1502a3496855SMika Westerberg 
150334cadd9cSJarkko Nikula 	if (pcidev_id) {
150434cadd9cSJarkko Nikula 		pdata->tx_param = pdev->dev.parent;
150534cadd9cSJarkko Nikula 		pdata->rx_param = pdev->dev.parent;
150634cadd9cSJarkko Nikula 		pdata->dma_filter = pxa2xx_spi_idma_filter;
150734cadd9cSJarkko Nikula 	}
150834cadd9cSJarkko Nikula 
1509a3496855SMika Westerberg 	ssp->clk = devm_clk_get(&pdev->dev, NULL);
1510a3496855SMika Westerberg 	ssp->irq = platform_get_irq(pdev, 0);
151103fbf488SJarkko Nikula 	ssp->type = type;
1512a3496855SMika Westerberg 	ssp->pdev = pdev;
15130db64215SJarkko Nikula 	ssp->port_id = pxa2xx_spi_get_port_id(adev);
1514a3496855SMika Westerberg 
1515a3496855SMika Westerberg 	pdata->num_chipselect = 1;
1516cddb339bSMika Westerberg 	pdata->enable_dma = true;
1517a3496855SMika Westerberg 
1518a3496855SMika Westerberg 	return pdata;
1519a3496855SMika Westerberg }
1520a3496855SMika Westerberg 
15210db64215SJarkko Nikula #else /* !CONFIG_PCI */
1522a3496855SMika Westerberg static inline struct pxa2xx_spi_master *
15230db64215SJarkko Nikula pxa2xx_spi_init_pdata(struct platform_device *pdev)
1524a3496855SMika Westerberg {
1525a3496855SMika Westerberg 	return NULL;
1526a3496855SMika Westerberg }
1527a3496855SMika Westerberg #endif
1528a3496855SMika Westerberg 
15290c27d9cfSMika Westerberg static int pxa2xx_spi_fw_translate_cs(struct spi_master *master, unsigned cs)
15300c27d9cfSMika Westerberg {
15310c27d9cfSMika Westerberg 	struct driver_data *drv_data = spi_master_get_devdata(master);
15320c27d9cfSMika Westerberg 
15330c27d9cfSMika Westerberg 	if (has_acpi_companion(&drv_data->pdev->dev)) {
15340c27d9cfSMika Westerberg 		switch (drv_data->ssp_type) {
15350c27d9cfSMika Westerberg 		/*
15360c27d9cfSMika Westerberg 		 * For Atoms the ACPI DeviceSelection used by the Windows
15370c27d9cfSMika Westerberg 		 * driver starts from 1 instead of 0 so translate it here
15380c27d9cfSMika Westerberg 		 * to match what Linux expects.
15390c27d9cfSMika Westerberg 		 */
15400c27d9cfSMika Westerberg 		case LPSS_BYT_SSP:
154130f3a6abSMika Westerberg 		case LPSS_BSW_SSP:
15420c27d9cfSMika Westerberg 			return cs - 1;
15430c27d9cfSMika Westerberg 
15440c27d9cfSMika Westerberg 		default:
15450c27d9cfSMika Westerberg 			break;
15460c27d9cfSMika Westerberg 		}
15470c27d9cfSMika Westerberg 	}
15480c27d9cfSMika Westerberg 
15490c27d9cfSMika Westerberg 	return cs;
15500c27d9cfSMika Westerberg }
15510c27d9cfSMika Westerberg 
1552fd4a319bSGrant Likely static int pxa2xx_spi_probe(struct platform_device *pdev)
1553ca632f55SGrant Likely {
1554ca632f55SGrant Likely 	struct device *dev = &pdev->dev;
1555ca632f55SGrant Likely 	struct pxa2xx_spi_master *platform_info;
1556ca632f55SGrant Likely 	struct spi_master *master;
1557ca632f55SGrant Likely 	struct driver_data *drv_data;
1558ca632f55SGrant Likely 	struct ssp_device *ssp;
15598b136baaSJarkko Nikula 	const struct lpss_config *config;
1560ca632f55SGrant Likely 	int status;
1561c039dd27SJarkko Nikula 	u32 tmp;
1562ca632f55SGrant Likely 
1563851bacf5SMika Westerberg 	platform_info = dev_get_platdata(dev);
1564851bacf5SMika Westerberg 	if (!platform_info) {
15650db64215SJarkko Nikula 		platform_info = pxa2xx_spi_init_pdata(pdev);
1566a3496855SMika Westerberg 		if (!platform_info) {
1567851bacf5SMika Westerberg 			dev_err(&pdev->dev, "missing platform data\n");
1568851bacf5SMika Westerberg 			return -ENODEV;
1569851bacf5SMika Westerberg 		}
1570a3496855SMika Westerberg 	}
1571ca632f55SGrant Likely 
1572ca632f55SGrant Likely 	ssp = pxa_ssp_request(pdev->id, pdev->name);
1573851bacf5SMika Westerberg 	if (!ssp)
1574851bacf5SMika Westerberg 		ssp = &platform_info->ssp;
1575851bacf5SMika Westerberg 
1576851bacf5SMika Westerberg 	if (!ssp->mmio_base) {
1577851bacf5SMika Westerberg 		dev_err(&pdev->dev, "failed to get ssp\n");
1578ca632f55SGrant Likely 		return -ENODEV;
1579ca632f55SGrant Likely 	}
1580ca632f55SGrant Likely 
1581757fe8d5SJarkko Nikula 	master = spi_alloc_master(dev, sizeof(struct driver_data));
1582ca632f55SGrant Likely 	if (!master) {
1583ca632f55SGrant Likely 		dev_err(&pdev->dev, "cannot alloc spi_master\n");
1584ca632f55SGrant Likely 		pxa_ssp_free(ssp);
1585ca632f55SGrant Likely 		return -ENOMEM;
1586ca632f55SGrant Likely 	}
1587ca632f55SGrant Likely 	drv_data = spi_master_get_devdata(master);
1588ca632f55SGrant Likely 	drv_data->master = master;
1589ca632f55SGrant Likely 	drv_data->master_info = platform_info;
1590ca632f55SGrant Likely 	drv_data->pdev = pdev;
1591ca632f55SGrant Likely 	drv_data->ssp = ssp;
1592ca632f55SGrant Likely 
1593ca632f55SGrant Likely 	master->dev.of_node = pdev->dev.of_node;
1594ca632f55SGrant Likely 	/* the spi->mode bits understood by this driver: */
1595b833172fSMika Westerberg 	master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_CS_HIGH | SPI_LOOP;
1596ca632f55SGrant Likely 
1597851bacf5SMika Westerberg 	master->bus_num = ssp->port_id;
1598ca632f55SGrant Likely 	master->dma_alignment = DMA_ALIGNMENT;
1599ca632f55SGrant Likely 	master->cleanup = cleanup;
1600ca632f55SGrant Likely 	master->setup = setup;
16017f86bde9SMika Westerberg 	master->transfer_one_message = pxa2xx_spi_transfer_one_message;
16027d94a505SMika Westerberg 	master->unprepare_transfer_hardware = pxa2xx_spi_unprepare_transfer;
16030c27d9cfSMika Westerberg 	master->fw_translate_cs = pxa2xx_spi_fw_translate_cs;
16047dd62787SMark Brown 	master->auto_runtime_pm = true;
16058c3ad488SJarkko Nikula 	master->flags = SPI_MASTER_MUST_RX | SPI_MASTER_MUST_TX;
1606ca632f55SGrant Likely 
1607ca632f55SGrant Likely 	drv_data->ssp_type = ssp->type;
1608ca632f55SGrant Likely 
1609ca632f55SGrant Likely 	drv_data->ioaddr = ssp->mmio_base;
1610ca632f55SGrant Likely 	drv_data->ssdr_physical = ssp->phys_base + SSDR;
1611ca632f55SGrant Likely 	if (pxa25x_ssp_comp(drv_data)) {
1612e5262d05SWeike Chen 		switch (drv_data->ssp_type) {
1613e5262d05SWeike Chen 		case QUARK_X1000_SSP:
1614e5262d05SWeike Chen 			master->bits_per_word_mask = SPI_BPW_RANGE_MASK(4, 32);
1615e5262d05SWeike Chen 			break;
1616e5262d05SWeike Chen 		default:
161724778be2SStephen Warren 			master->bits_per_word_mask = SPI_BPW_RANGE_MASK(4, 16);
1618e5262d05SWeike Chen 			break;
1619e5262d05SWeike Chen 		}
1620e5262d05SWeike Chen 
1621ca632f55SGrant Likely 		drv_data->int_cr1 = SSCR1_TIE | SSCR1_RIE;
1622ca632f55SGrant Likely 		drv_data->dma_cr1 = 0;
1623ca632f55SGrant Likely 		drv_data->clear_sr = SSSR_ROR;
1624ca632f55SGrant Likely 		drv_data->mask_sr = SSSR_RFS | SSSR_TFS | SSSR_ROR;
1625ca632f55SGrant Likely 	} else {
162624778be2SStephen Warren 		master->bits_per_word_mask = SPI_BPW_RANGE_MASK(4, 32);
1627ca632f55SGrant Likely 		drv_data->int_cr1 = SSCR1_TIE | SSCR1_RIE | SSCR1_TINTE;
16285928808eSMika Westerberg 		drv_data->dma_cr1 = DEFAULT_DMA_CR1;
1629ca632f55SGrant Likely 		drv_data->clear_sr = SSSR_ROR | SSSR_TINT;
1630ca632f55SGrant Likely 		drv_data->mask_sr = SSSR_TINT | SSSR_RFS | SSSR_TFS | SSSR_ROR;
1631ca632f55SGrant Likely 	}
1632ca632f55SGrant Likely 
1633ca632f55SGrant Likely 	status = request_irq(ssp->irq, ssp_int, IRQF_SHARED, dev_name(dev),
1634ca632f55SGrant Likely 			drv_data);
1635ca632f55SGrant Likely 	if (status < 0) {
1636ca632f55SGrant Likely 		dev_err(&pdev->dev, "cannot get IRQ %d\n", ssp->irq);
1637ca632f55SGrant Likely 		goto out_error_master_alloc;
1638ca632f55SGrant Likely 	}
1639ca632f55SGrant Likely 
1640ca632f55SGrant Likely 	/* Setup DMA if requested */
1641ca632f55SGrant Likely 	if (platform_info->enable_dma) {
1642cd7bed00SMika Westerberg 		status = pxa2xx_spi_dma_setup(drv_data);
1643cd7bed00SMika Westerberg 		if (status) {
1644cddb339bSMika Westerberg 			dev_dbg(dev, "no DMA channels available, using PIO\n");
1645cd7bed00SMika Westerberg 			platform_info->enable_dma = false;
1646b6ced294SJarkko Nikula 		} else {
1647b6ced294SJarkko Nikula 			master->can_dma = pxa2xx_spi_can_dma;
1648ca632f55SGrant Likely 		}
1649ca632f55SGrant Likely 	}
1650ca632f55SGrant Likely 
1651ca632f55SGrant Likely 	/* Enable SOC clock */
16523343b7a6SMika Westerberg 	clk_prepare_enable(ssp->clk);
16533343b7a6SMika Westerberg 
16540eca7cf2SJarkko Nikula 	master->max_speed_hz = clk_get_rate(ssp->clk);
1655ca632f55SGrant Likely 
1656ca632f55SGrant Likely 	/* Load default SSP configuration */
1657c039dd27SJarkko Nikula 	pxa2xx_spi_write(drv_data, SSCR0, 0);
1658e5262d05SWeike Chen 	switch (drv_data->ssp_type) {
1659e5262d05SWeike Chen 	case QUARK_X1000_SSP:
1660*7c7289a4SAndy Shevchenko 		tmp = QUARK_X1000_SSCR1_RxTresh(RX_THRESH_QUARK_X1000_DFLT) |
1661*7c7289a4SAndy Shevchenko 		      QUARK_X1000_SSCR1_TxTresh(TX_THRESH_QUARK_X1000_DFLT);
1662c039dd27SJarkko Nikula 		pxa2xx_spi_write(drv_data, SSCR1, tmp);
1663e5262d05SWeike Chen 
1664e5262d05SWeike Chen 		/* using the Motorola SPI protocol and use 8 bit frame */
1665*7c7289a4SAndy Shevchenko 		tmp = QUARK_X1000_SSCR0_Motorola | QUARK_X1000_SSCR0_DataSize(8);
1666*7c7289a4SAndy Shevchenko 		pxa2xx_spi_write(drv_data, SSCR0, tmp);
1667e5262d05SWeike Chen 		break;
1668*7c7289a4SAndy Shevchenko 	case CE4100_SSP:
1669*7c7289a4SAndy Shevchenko 		tmp = CE4100_SSCR1_RxTresh(RX_THRESH_CE4100_DFLT) |
1670*7c7289a4SAndy Shevchenko 		      CE4100_SSCR1_TxTresh(TX_THRESH_CE4100_DFLT);
1671*7c7289a4SAndy Shevchenko 		pxa2xx_spi_write(drv_data, SSCR1, tmp);
1672*7c7289a4SAndy Shevchenko 		tmp = SSCR0_SCR(2) | SSCR0_Motorola | SSCR0_DataSize(8);
1673*7c7289a4SAndy Shevchenko 		pxa2xx_spi_write(drv_data, SSCR0, tmp);
1674e5262d05SWeike Chen 	default:
1675c039dd27SJarkko Nikula 		tmp = SSCR1_RxTresh(RX_THRESH_DFLT) |
1676c039dd27SJarkko Nikula 		      SSCR1_TxTresh(TX_THRESH_DFLT);
1677c039dd27SJarkko Nikula 		pxa2xx_spi_write(drv_data, SSCR1, tmp);
1678c039dd27SJarkko Nikula 		tmp = SSCR0_SCR(2) | SSCR0_Motorola | SSCR0_DataSize(8);
1679c039dd27SJarkko Nikula 		pxa2xx_spi_write(drv_data, SSCR0, tmp);
1680e5262d05SWeike Chen 		break;
1681e5262d05SWeike Chen 	}
1682e5262d05SWeike Chen 
1683ca632f55SGrant Likely 	if (!pxa25x_ssp_comp(drv_data))
1684c039dd27SJarkko Nikula 		pxa2xx_spi_write(drv_data, SSTO, 0);
1685e5262d05SWeike Chen 
1686e5262d05SWeike Chen 	if (!is_quark_x1000_ssp(drv_data))
1687c039dd27SJarkko Nikula 		pxa2xx_spi_write(drv_data, SSPSP, 0);
1688ca632f55SGrant Likely 
16898b136baaSJarkko Nikula 	if (is_lpss_ssp(drv_data)) {
16908b136baaSJarkko Nikula 		lpss_ssp_setup(drv_data);
16918b136baaSJarkko Nikula 		config = lpss_get_config(drv_data);
16928b136baaSJarkko Nikula 		if (config->reg_capabilities >= 0) {
16938b136baaSJarkko Nikula 			tmp = __lpss_ssp_read_priv(drv_data,
16948b136baaSJarkko Nikula 						   config->reg_capabilities);
16958b136baaSJarkko Nikula 			tmp &= LPSS_CAPS_CS_EN_MASK;
16968b136baaSJarkko Nikula 			tmp >>= LPSS_CAPS_CS_EN_SHIFT;
16978b136baaSJarkko Nikula 			platform_info->num_chipselect = ffz(tmp);
169830f3a6abSMika Westerberg 		} else if (config->cs_num) {
169930f3a6abSMika Westerberg 			platform_info->num_chipselect = config->cs_num;
17008b136baaSJarkko Nikula 		}
17018b136baaSJarkko Nikula 	}
17028b136baaSJarkko Nikula 	master->num_chipselect = platform_info->num_chipselect;
17038b136baaSJarkko Nikula 
17047f86bde9SMika Westerberg 	tasklet_init(&drv_data->pump_transfers, pump_transfers,
17057f86bde9SMika Westerberg 		     (unsigned long)drv_data);
1706ca632f55SGrant Likely 
1707836d1a22SAntonio Ospite 	pm_runtime_set_autosuspend_delay(&pdev->dev, 50);
1708836d1a22SAntonio Ospite 	pm_runtime_use_autosuspend(&pdev->dev);
1709836d1a22SAntonio Ospite 	pm_runtime_set_active(&pdev->dev);
1710836d1a22SAntonio Ospite 	pm_runtime_enable(&pdev->dev);
1711836d1a22SAntonio Ospite 
1712ca632f55SGrant Likely 	/* Register with the SPI framework */
1713ca632f55SGrant Likely 	platform_set_drvdata(pdev, drv_data);
1714a807fcd0SJingoo Han 	status = devm_spi_register_master(&pdev->dev, master);
1715ca632f55SGrant Likely 	if (status != 0) {
1716ca632f55SGrant Likely 		dev_err(&pdev->dev, "problem registering spi master\n");
17177f86bde9SMika Westerberg 		goto out_error_clock_enabled;
1718ca632f55SGrant Likely 	}
1719ca632f55SGrant Likely 
1720ca632f55SGrant Likely 	return status;
1721ca632f55SGrant Likely 
1722ca632f55SGrant Likely out_error_clock_enabled:
17233343b7a6SMika Westerberg 	clk_disable_unprepare(ssp->clk);
1724cd7bed00SMika Westerberg 	pxa2xx_spi_dma_release(drv_data);
1725ca632f55SGrant Likely 	free_irq(ssp->irq, drv_data);
1726ca632f55SGrant Likely 
1727ca632f55SGrant Likely out_error_master_alloc:
1728ca632f55SGrant Likely 	spi_master_put(master);
1729ca632f55SGrant Likely 	pxa_ssp_free(ssp);
1730ca632f55SGrant Likely 	return status;
1731ca632f55SGrant Likely }
1732ca632f55SGrant Likely 
1733ca632f55SGrant Likely static int pxa2xx_spi_remove(struct platform_device *pdev)
1734ca632f55SGrant Likely {
1735ca632f55SGrant Likely 	struct driver_data *drv_data = platform_get_drvdata(pdev);
1736ca632f55SGrant Likely 	struct ssp_device *ssp;
1737ca632f55SGrant Likely 
1738ca632f55SGrant Likely 	if (!drv_data)
1739ca632f55SGrant Likely 		return 0;
1740ca632f55SGrant Likely 	ssp = drv_data->ssp;
1741ca632f55SGrant Likely 
17427d94a505SMika Westerberg 	pm_runtime_get_sync(&pdev->dev);
17437d94a505SMika Westerberg 
1744ca632f55SGrant Likely 	/* Disable the SSP at the peripheral and SOC level */
1745c039dd27SJarkko Nikula 	pxa2xx_spi_write(drv_data, SSCR0, 0);
17463343b7a6SMika Westerberg 	clk_disable_unprepare(ssp->clk);
1747ca632f55SGrant Likely 
1748ca632f55SGrant Likely 	/* Release DMA */
1749cd7bed00SMika Westerberg 	if (drv_data->master_info->enable_dma)
1750cd7bed00SMika Westerberg 		pxa2xx_spi_dma_release(drv_data);
1751ca632f55SGrant Likely 
17527d94a505SMika Westerberg 	pm_runtime_put_noidle(&pdev->dev);
17537d94a505SMika Westerberg 	pm_runtime_disable(&pdev->dev);
17547d94a505SMika Westerberg 
1755ca632f55SGrant Likely 	/* Release IRQ */
1756ca632f55SGrant Likely 	free_irq(ssp->irq, drv_data);
1757ca632f55SGrant Likely 
1758ca632f55SGrant Likely 	/* Release SSP */
1759ca632f55SGrant Likely 	pxa_ssp_free(ssp);
1760ca632f55SGrant Likely 
1761ca632f55SGrant Likely 	return 0;
1762ca632f55SGrant Likely }
1763ca632f55SGrant Likely 
1764ca632f55SGrant Likely static void pxa2xx_spi_shutdown(struct platform_device *pdev)
1765ca632f55SGrant Likely {
1766ca632f55SGrant Likely 	int status = 0;
1767ca632f55SGrant Likely 
1768ca632f55SGrant Likely 	if ((status = pxa2xx_spi_remove(pdev)) != 0)
1769ca632f55SGrant Likely 		dev_err(&pdev->dev, "shutdown failed with %d\n", status);
1770ca632f55SGrant Likely }
1771ca632f55SGrant Likely 
1772382cebb0SMika Westerberg #ifdef CONFIG_PM_SLEEP
1773ca632f55SGrant Likely static int pxa2xx_spi_suspend(struct device *dev)
1774ca632f55SGrant Likely {
1775ca632f55SGrant Likely 	struct driver_data *drv_data = dev_get_drvdata(dev);
1776ca632f55SGrant Likely 	struct ssp_device *ssp = drv_data->ssp;
1777bffc967eSJarkko Nikula 	int status;
1778ca632f55SGrant Likely 
17797f86bde9SMika Westerberg 	status = spi_master_suspend(drv_data->master);
1780ca632f55SGrant Likely 	if (status != 0)
1781ca632f55SGrant Likely 		return status;
1782c039dd27SJarkko Nikula 	pxa2xx_spi_write(drv_data, SSCR0, 0);
17832b9375b9SDmitry Eremin-Solenikov 
17842b9375b9SDmitry Eremin-Solenikov 	if (!pm_runtime_suspended(dev))
17853343b7a6SMika Westerberg 		clk_disable_unprepare(ssp->clk);
1786ca632f55SGrant Likely 
1787ca632f55SGrant Likely 	return 0;
1788ca632f55SGrant Likely }
1789ca632f55SGrant Likely 
1790ca632f55SGrant Likely static int pxa2xx_spi_resume(struct device *dev)
1791ca632f55SGrant Likely {
1792ca632f55SGrant Likely 	struct driver_data *drv_data = dev_get_drvdata(dev);
1793ca632f55SGrant Likely 	struct ssp_device *ssp = drv_data->ssp;
1794bffc967eSJarkko Nikula 	int status;
1795ca632f55SGrant Likely 
1796ca632f55SGrant Likely 	/* Enable the SSP clock */
17972b9375b9SDmitry Eremin-Solenikov 	if (!pm_runtime_suspended(dev))
17983343b7a6SMika Westerberg 		clk_prepare_enable(ssp->clk);
1799ca632f55SGrant Likely 
1800c50325f7SChew, Chiau Ee 	/* Restore LPSS private register bits */
180148421adfSJarkko Nikula 	if (is_lpss_ssp(drv_data))
1802c50325f7SChew, Chiau Ee 		lpss_ssp_setup(drv_data);
1803c50325f7SChew, Chiau Ee 
1804ca632f55SGrant Likely 	/* Start the queue running */
18057f86bde9SMika Westerberg 	status = spi_master_resume(drv_data->master);
1806ca632f55SGrant Likely 	if (status != 0) {
1807ca632f55SGrant Likely 		dev_err(dev, "problem starting queue (%d)\n", status);
1808ca632f55SGrant Likely 		return status;
1809ca632f55SGrant Likely 	}
1810ca632f55SGrant Likely 
1811ca632f55SGrant Likely 	return 0;
1812ca632f55SGrant Likely }
18137d94a505SMika Westerberg #endif
18147d94a505SMika Westerberg 
1815ec833050SRafael J. Wysocki #ifdef CONFIG_PM
18167d94a505SMika Westerberg static int pxa2xx_spi_runtime_suspend(struct device *dev)
18177d94a505SMika Westerberg {
18187d94a505SMika Westerberg 	struct driver_data *drv_data = dev_get_drvdata(dev);
18197d94a505SMika Westerberg 
18207d94a505SMika Westerberg 	clk_disable_unprepare(drv_data->ssp->clk);
18217d94a505SMika Westerberg 	return 0;
18227d94a505SMika Westerberg }
18237d94a505SMika Westerberg 
18247d94a505SMika Westerberg static int pxa2xx_spi_runtime_resume(struct device *dev)
18257d94a505SMika Westerberg {
18267d94a505SMika Westerberg 	struct driver_data *drv_data = dev_get_drvdata(dev);
18277d94a505SMika Westerberg 
18287d94a505SMika Westerberg 	clk_prepare_enable(drv_data->ssp->clk);
18297d94a505SMika Westerberg 	return 0;
18307d94a505SMika Westerberg }
18317d94a505SMika Westerberg #endif
1832ca632f55SGrant Likely 
1833ca632f55SGrant Likely static const struct dev_pm_ops pxa2xx_spi_pm_ops = {
18347d94a505SMika Westerberg 	SET_SYSTEM_SLEEP_PM_OPS(pxa2xx_spi_suspend, pxa2xx_spi_resume)
18357d94a505SMika Westerberg 	SET_RUNTIME_PM_OPS(pxa2xx_spi_runtime_suspend,
18367d94a505SMika Westerberg 			   pxa2xx_spi_runtime_resume, NULL)
1837ca632f55SGrant Likely };
1838ca632f55SGrant Likely 
1839ca632f55SGrant Likely static struct platform_driver driver = {
1840ca632f55SGrant Likely 	.driver = {
1841ca632f55SGrant Likely 		.name	= "pxa2xx-spi",
1842ca632f55SGrant Likely 		.pm	= &pxa2xx_spi_pm_ops,
1843a3496855SMika Westerberg 		.acpi_match_table = ACPI_PTR(pxa2xx_spi_acpi_match),
1844ca632f55SGrant Likely 	},
1845ca632f55SGrant Likely 	.probe = pxa2xx_spi_probe,
1846ca632f55SGrant Likely 	.remove = pxa2xx_spi_remove,
1847ca632f55SGrant Likely 	.shutdown = pxa2xx_spi_shutdown,
1848ca632f55SGrant Likely };
1849ca632f55SGrant Likely 
1850ca632f55SGrant Likely static int __init pxa2xx_spi_init(void)
1851ca632f55SGrant Likely {
1852ca632f55SGrant Likely 	return platform_driver_register(&driver);
1853ca632f55SGrant Likely }
1854ca632f55SGrant Likely subsys_initcall(pxa2xx_spi_init);
1855ca632f55SGrant Likely 
1856ca632f55SGrant Likely static void __exit pxa2xx_spi_exit(void)
1857ca632f55SGrant Likely {
1858ca632f55SGrant Likely 	platform_driver_unregister(&driver);
1859ca632f55SGrant Likely }
1860ca632f55SGrant Likely module_exit(pxa2xx_spi_exit);
1861