spi-imx.c 33.6 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23
/*
 * Copyright 2004-2007 Freescale Semiconductor, Inc. All Rights Reserved.
 * Copyright (C) 2008 Juergen Beisert
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version 2
 * of the License, or (at your option) any later version.
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the
 * Free Software Foundation
 * 51 Franklin Street, Fifth Floor
 * Boston, MA  02110-1301, USA.
 */

#include <linux/clk.h>
#include <linux/completion.h>
#include <linux/delay.h>
R
Robin Gong 已提交
24 25
#include <linux/dmaengine.h>
#include <linux/dma-mapping.h>
26 27 28 29 30 31 32 33
#include <linux/err.h>
#include <linux/gpio.h>
#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/irq.h>
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/platform_device.h>
34
#include <linux/slab.h>
35 36 37
#include <linux/spi/spi.h>
#include <linux/spi/spi_bitbang.h>
#include <linux/types.h>
38 39 40
#include <linux/of.h>
#include <linux/of_device.h>
#include <linux/of_gpio.h>
41

R
Robin Gong 已提交
42
#include <linux/platform_data/dma-imx.h>
43
#include <linux/platform_data/spi-imx.h>
44 45 46 47 48 49 50 51 52 53 54 55 56

#define DRIVER_NAME "spi_imx"

#define MXC_CSPIRXDATA		0x00
#define MXC_CSPITXDATA		0x04
#define MXC_CSPICTRL		0x08
#define MXC_CSPIINT		0x0c
#define MXC_RESET		0x1c

/* generic defines to abstract from the different register layouts */
#define MXC_INT_RR	(1 << 0) /* Receive data ready interrupt */
#define MXC_INT_TE	(1 << 1) /* Transmit FIFO empty interrupt */

R
Robin Gong 已提交
57 58
/* The maximum  bytes that a sdma BD can transfer.*/
#define MAX_SDMA_BD_BYTES  (1 << 15)
59
struct spi_imx_config {
60 61 62 63
	unsigned int speed_hz;
	unsigned int bpw;
};

64
enum spi_imx_devtype {
65 66 67 68 69 70
	IMX1_CSPI,
	IMX21_CSPI,
	IMX27_CSPI,
	IMX31_CSPI,
	IMX35_CSPI,	/* CSPI on all i.mx except above */
	IMX51_ECSPI,	/* ECSPI on i.mx51 and later */
71 72 73 74 75 76
};

struct spi_imx_data;

struct spi_imx_devtype_data {
	void (*intctrl)(struct spi_imx_data *, int);
77
	int (*config)(struct spi_device *, struct spi_imx_config *);
78 79
	void (*trigger)(struct spi_imx_data *);
	int (*rx_available)(struct spi_imx_data *);
80
	void (*reset)(struct spi_imx_data *);
81
	enum spi_imx_devtype devtype;
82 83
};

84
struct spi_imx_data {
85
	struct spi_bitbang bitbang;
86
	struct device *dev;
87 88

	struct completion xfer_done;
89
	void __iomem *base;
90 91
	unsigned long base_phys;

92 93
	struct clk *clk_per;
	struct clk *clk_ipg;
94
	unsigned long spi_clk;
95
	unsigned int spi_bus_clk;
96

97 98
	unsigned int bytes_per_word;

99
	unsigned int count;
100 101
	void (*tx)(struct spi_imx_data *);
	void (*rx)(struct spi_imx_data *);
102 103 104 105
	void *rx_buf;
	const void *tx_buf;
	unsigned int txfifo; /* number of words pushed in tx FIFO */

R
Robin Gong 已提交
106 107
	/* DMA */
	bool usedma;
108
	u32 wml;
R
Robin Gong 已提交
109 110 111
	struct completion dma_rx_completion;
	struct completion dma_tx_completion;

112
	const struct spi_imx_devtype_data *devtype_data;
113 114
};

115 116 117 118 119 120 121 122 123 124
static inline int is_imx27_cspi(struct spi_imx_data *d)
{
	return d->devtype_data->devtype == IMX27_CSPI;
}

static inline int is_imx35_cspi(struct spi_imx_data *d)
{
	return d->devtype_data->devtype == IMX35_CSPI;
}

125 126 127 128 129
static inline int is_imx51_ecspi(struct spi_imx_data *d)
{
	return d->devtype_data->devtype == IMX51_ECSPI;
}

130 131
static inline unsigned spi_imx_get_fifosize(struct spi_imx_data *d)
{
132
	return is_imx51_ecspi(d) ? 64 : 8;
133 134
}

135
#define MXC_SPI_BUF_RX(type)						\
136
static void spi_imx_buf_rx_##type(struct spi_imx_data *spi_imx)		\
137
{									\
138
	unsigned int val = readl(spi_imx->base + MXC_CSPIRXDATA);	\
139
									\
140 141 142
	if (spi_imx->rx_buf) {						\
		*(type *)spi_imx->rx_buf = val;				\
		spi_imx->rx_buf += sizeof(type);			\
143 144 145 146
	}								\
}

#define MXC_SPI_BUF_TX(type)						\
147
static void spi_imx_buf_tx_##type(struct spi_imx_data *spi_imx)		\
148 149 150
{									\
	type val = 0;							\
									\
151 152 153
	if (spi_imx->tx_buf) {						\
		val = *(type *)spi_imx->tx_buf;				\
		spi_imx->tx_buf += sizeof(type);			\
154 155
	}								\
									\
156
	spi_imx->count -= sizeof(type);					\
157
									\
158
	writel(val, spi_imx->base + MXC_CSPITXDATA);			\
159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174
}

MXC_SPI_BUF_RX(u8)
MXC_SPI_BUF_TX(u8)
MXC_SPI_BUF_RX(u16)
MXC_SPI_BUF_TX(u16)
MXC_SPI_BUF_RX(u32)
MXC_SPI_BUF_TX(u32)

/* First entry is reserved, second entry is valid only if SDHC_SPIEN is set
 * (which is currently not the case in this driver)
 */
static int mxc_clkdivs[] = {0, 3, 4, 6, 8, 12, 16, 24, 32, 48, 64, 96, 128, 192,
	256, 384, 512, 768, 1024};

/* MX21, MX27 */
175
static unsigned int spi_imx_clkdiv_1(unsigned int fin,
176
		unsigned int fspi, unsigned int max)
177
{
178
	int i;
179 180 181 182 183 184 185 186

	for (i = 2; i < max; i++)
		if (fspi * mxc_clkdivs[i] >= fin)
			return i;

	return max;
}

187
/* MX1, MX31, MX35, MX51 CSPI */
188
static unsigned int spi_imx_clkdiv_2(unsigned int fin,
189 190 191 192 193 194 195 196 197 198 199 200 201
		unsigned int fspi)
{
	int i, div = 4;

	for (i = 0; i < 7; i++) {
		if (fspi * div >= fin)
			return i;
		div <<= 1;
	}

	return 7;
}

202 203 204 205 206
static int spi_imx_bytes_per_word(const int bpw)
{
	return DIV_ROUND_UP(bpw, BITS_PER_BYTE);
}

R
Robin Gong 已提交
207 208 209 210
static bool spi_imx_can_dma(struct spi_master *master, struct spi_device *spi,
			 struct spi_transfer *transfer)
{
	struct spi_imx_data *spi_imx = spi_master_get_devdata(master);
211
	unsigned int bpw;
212 213 214 215

	if (!master->dma_rx)
		return false;

216 217 218 219
	if (!transfer)
		return false;

	bpw = transfer->bits_per_word;
220 221 222 223 224 225 226 227 228 229 230 231 232
	if (!bpw)
		bpw = spi->bits_per_word;

	bpw = spi_imx_bytes_per_word(bpw);

	if (bpw != 1 && bpw != 2 && bpw != 4)
		return false;

	if (transfer->len < spi_imx->wml * bpw)
		return false;

	if (transfer->len % (spi_imx->wml * bpw))
		return false;
R
Robin Gong 已提交
233

234
	return true;
R
Robin Gong 已提交
235 236
}

237 238 239
#define MX51_ECSPI_CTRL		0x08
#define MX51_ECSPI_CTRL_ENABLE		(1 <<  0)
#define MX51_ECSPI_CTRL_XCH		(1 <<  2)
R
Robin Gong 已提交
240
#define MX51_ECSPI_CTRL_SMC		(1 << 3)
241 242 243 244 245 246 247 248 249 250 251
#define MX51_ECSPI_CTRL_MODE_MASK	(0xf << 4)
#define MX51_ECSPI_CTRL_POSTDIV_OFFSET	8
#define MX51_ECSPI_CTRL_PREDIV_OFFSET	12
#define MX51_ECSPI_CTRL_CS(cs)		((cs) << 18)
#define MX51_ECSPI_CTRL_BL_OFFSET	20

#define MX51_ECSPI_CONFIG	0x0c
#define MX51_ECSPI_CONFIG_SCLKPHA(cs)	(1 << ((cs) +  0))
#define MX51_ECSPI_CONFIG_SCLKPOL(cs)	(1 << ((cs) +  4))
#define MX51_ECSPI_CONFIG_SBBCTRL(cs)	(1 << ((cs) +  8))
#define MX51_ECSPI_CONFIG_SSBPOL(cs)	(1 << ((cs) + 12))
252
#define MX51_ECSPI_CONFIG_SCLKCTL(cs)	(1 << ((cs) + 20))
253 254 255 256 257

#define MX51_ECSPI_INT		0x10
#define MX51_ECSPI_INT_TEEN		(1 <<  0)
#define MX51_ECSPI_INT_RREN		(1 <<  3)

R
Robin Gong 已提交
258
#define MX51_ECSPI_DMA      0x14
259 260 261
#define MX51_ECSPI_DMA_TX_WML(wml)	((wml) & 0x3f)
#define MX51_ECSPI_DMA_RX_WML(wml)	(((wml) & 0x3f) << 16)
#define MX51_ECSPI_DMA_RXT_WML(wml)	(((wml) & 0x3f) << 24)
R
Robin Gong 已提交
262

263 264 265
#define MX51_ECSPI_DMA_TEDEN		(1 << 7)
#define MX51_ECSPI_DMA_RXDEN		(1 << 23)
#define MX51_ECSPI_DMA_RXTDEN		(1 << 31)
R
Robin Gong 已提交
266

267 268
#define MX51_ECSPI_STAT		0x18
#define MX51_ECSPI_STAT_RR		(1 <<  3)
269

270 271 272
#define MX51_ECSPI_TESTREG	0x20
#define MX51_ECSPI_TESTREG_LBC	BIT(31)

273
/* MX51 eCSPI */
274 275
static unsigned int mx51_ecspi_clkdiv(struct spi_imx_data *spi_imx,
				      unsigned int fspi, unsigned int *fres)
276 277 278 279 280 281
{
	/*
	 * there are two 4-bit dividers, the pre-divider divides by
	 * $pre, the post-divider by 2^$post
	 */
	unsigned int pre, post;
282
	unsigned int fin = spi_imx->spi_clk;
283 284 285 286 287 288 289 290 291 292 293 294

	if (unlikely(fspi > fin))
		return 0;

	post = fls(fin) - fls(fspi);
	if (fin > fspi << post)
		post++;

	/* now we have: (fin <= fspi << post) with post being minimal */

	post = max(4U, post) - 4;
	if (unlikely(post > 0xf)) {
295 296
		dev_err(spi_imx->dev, "cannot set clock freq: %u (base freq: %u)\n",
				fspi, fin);
297 298 299 300 301
		return 0xff;
	}

	pre = DIV_ROUND_UP(fin, fspi << post) - 1;

302
	dev_dbg(spi_imx->dev, "%s: fin: %u, fspi: %u, post: %u, pre: %u\n",
303
			__func__, fin, fspi, post, pre);
304 305 306 307

	/* Resulting frequency for the SCLK line. */
	*fres = (fin / (pre + 1)) >> post;

308 309
	return (pre << MX51_ECSPI_CTRL_PREDIV_OFFSET) |
		(post << MX51_ECSPI_CTRL_POSTDIV_OFFSET);
310 311
}

312
static void __maybe_unused mx51_ecspi_intctrl(struct spi_imx_data *spi_imx, int enable)
313 314 315 316
{
	unsigned val = 0;

	if (enable & MXC_INT_TE)
317
		val |= MX51_ECSPI_INT_TEEN;
318 319

	if (enable & MXC_INT_RR)
320
		val |= MX51_ECSPI_INT_RREN;
321

322
	writel(val, spi_imx->base + MX51_ECSPI_INT);
323 324
}

325
static void __maybe_unused mx51_ecspi_trigger(struct spi_imx_data *spi_imx)
326
{
327
	u32 reg;
R
Robin Gong 已提交
328

329 330
	reg = readl(spi_imx->base + MX51_ECSPI_CTRL);
	reg |= MX51_ECSPI_CTRL_XCH;
331
	writel(reg, spi_imx->base + MX51_ECSPI_CTRL);
332 333
}

334 335
static int __maybe_unused mx51_ecspi_config(struct spi_device *spi,
					    struct spi_imx_config *config)
336
{
337
	struct spi_imx_data *spi_imx = spi_master_get_devdata(spi->master);
338
	u32 ctrl = MX51_ECSPI_CTRL_ENABLE;
339
	u32 clk = config->speed_hz, delay, reg;
340
	u32 cfg = readl(spi_imx->base + MX51_ECSPI_CONFIG);
341

342 343 344 345 346 347 348
	/*
	 * The hardware seems to have a race condition when changing modes. The
	 * current assumption is that the selection of the channel arrives
	 * earlier in the hardware than the mode bits when they are written at
	 * the same time.
	 * So set master mode for all channels as we do not support slave mode.
	 */
349
	ctrl |= MX51_ECSPI_CTRL_MODE_MASK;
350 351

	/* set clock speed */
352
	ctrl |= mx51_ecspi_clkdiv(spi_imx, config->speed_hz, &clk);
353
	spi_imx->spi_bus_clk = clk;
354 355

	/* set chip select to use */
356
	ctrl |= MX51_ECSPI_CTRL_CS(spi->chip_select);
357

358
	ctrl |= (config->bpw - 1) << MX51_ECSPI_CTRL_BL_OFFSET;
359

360
	cfg |= MX51_ECSPI_CONFIG_SBBCTRL(spi->chip_select);
361

362
	if (spi->mode & SPI_CPHA)
363
		cfg |= MX51_ECSPI_CONFIG_SCLKPHA(spi->chip_select);
364
	else
365
		cfg &= ~MX51_ECSPI_CONFIG_SCLKPHA(spi->chip_select);
366

367
	if (spi->mode & SPI_CPOL) {
368 369
		cfg |= MX51_ECSPI_CONFIG_SCLKPOL(spi->chip_select);
		cfg |= MX51_ECSPI_CONFIG_SCLKCTL(spi->chip_select);
370
	} else {
371 372
		cfg &= ~MX51_ECSPI_CONFIG_SCLKPOL(spi->chip_select);
		cfg &= ~MX51_ECSPI_CONFIG_SCLKCTL(spi->chip_select);
373
	}
374
	if (spi->mode & SPI_CS_HIGH)
375
		cfg |= MX51_ECSPI_CONFIG_SSBPOL(spi->chip_select);
376
	else
377
		cfg &= ~MX51_ECSPI_CONFIG_SSBPOL(spi->chip_select);
378

379 380 381
	if (spi_imx->usedma)
		ctrl |= MX51_ECSPI_CTRL_SMC;

382 383 384
	/* CTRL register always go first to bring out controller from reset */
	writel(ctrl, spi_imx->base + MX51_ECSPI_CTRL);

385
	reg = readl(spi_imx->base + MX51_ECSPI_TESTREG);
386
	if (spi->mode & SPI_LOOP)
387 388 389 390 391
		reg |= MX51_ECSPI_TESTREG_LBC;
	else
		reg &= ~MX51_ECSPI_TESTREG_LBC;
	writel(reg, spi_imx->base + MX51_ECSPI_TESTREG);

392
	writel(cfg, spi_imx->base + MX51_ECSPI_CONFIG);
393

394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410
	/*
	 * Wait until the changes in the configuration register CONFIGREG
	 * propagate into the hardware. It takes exactly one tick of the
	 * SCLK clock, but we will wait two SCLK clock just to be sure. The
	 * effect of the delay it takes for the hardware to apply changes
	 * is noticable if the SCLK clock run very slow. In such a case, if
	 * the polarity of SCLK should be inverted, the GPIO ChipSelect might
	 * be asserted before the SCLK polarity changes, which would disrupt
	 * the SPI communication as the device on the other end would consider
	 * the change of SCLK polarity as a clock tick already.
	 */
	delay = (2 * 1000000) / clk;
	if (likely(delay < 10))	/* SCLK is faster than 100 kHz */
		udelay(delay);
	else			/* SCLK is _very_ slow */
		usleep_range(delay, delay + 10);

R
Robin Gong 已提交
411 412 413 414
	/*
	 * Configure the DMA register: setup the watermark
	 * and enable DMA request.
	 */
415

416 417 418
	writel(MX51_ECSPI_DMA_RX_WML(spi_imx->wml) |
		MX51_ECSPI_DMA_TX_WML(spi_imx->wml) |
		MX51_ECSPI_DMA_RXT_WML(spi_imx->wml) |
419 420
		MX51_ECSPI_DMA_TEDEN | MX51_ECSPI_DMA_RXDEN |
		MX51_ECSPI_DMA_RXTDEN, spi_imx->base + MX51_ECSPI_DMA);
R
Robin Gong 已提交
421

422 423 424
	return 0;
}

425
static int __maybe_unused mx51_ecspi_rx_available(struct spi_imx_data *spi_imx)
426
{
427
	return readl(spi_imx->base + MX51_ECSPI_STAT) & MX51_ECSPI_STAT_RR;
428 429
}

430
static void __maybe_unused mx51_ecspi_reset(struct spi_imx_data *spi_imx)
431 432
{
	/* drain receive buffer */
433
	while (mx51_ecspi_rx_available(spi_imx))
434 435 436
		readl(spi_imx->base + MXC_CSPIRXDATA);
}

437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459
#define MX31_INTREG_TEEN	(1 << 0)
#define MX31_INTREG_RREN	(1 << 3)

#define MX31_CSPICTRL_ENABLE	(1 << 0)
#define MX31_CSPICTRL_MASTER	(1 << 1)
#define MX31_CSPICTRL_XCH	(1 << 2)
#define MX31_CSPICTRL_POL	(1 << 4)
#define MX31_CSPICTRL_PHA	(1 << 5)
#define MX31_CSPICTRL_SSCTL	(1 << 6)
#define MX31_CSPICTRL_SSPOL	(1 << 7)
#define MX31_CSPICTRL_BC_SHIFT	8
#define MX35_CSPICTRL_BL_SHIFT	20
#define MX31_CSPICTRL_CS_SHIFT	24
#define MX35_CSPICTRL_CS_SHIFT	12
#define MX31_CSPICTRL_DR_SHIFT	16

#define MX31_CSPISTATUS		0x14
#define MX31_STATUS_RR		(1 << 3)

/* These functions also work for the i.MX35, but be aware that
 * the i.MX35 has a slightly different register layout for bits
 * we do not use here.
 */
460
static void __maybe_unused mx31_intctrl(struct spi_imx_data *spi_imx, int enable)
461 462 463 464 465 466 467 468
{
	unsigned int val = 0;

	if (enable & MXC_INT_TE)
		val |= MX31_INTREG_TEEN;
	if (enable & MXC_INT_RR)
		val |= MX31_INTREG_RREN;

469
	writel(val, spi_imx->base + MXC_CSPIINT);
470 471
}

472
static void __maybe_unused mx31_trigger(struct spi_imx_data *spi_imx)
473 474 475
{
	unsigned int reg;

476
	reg = readl(spi_imx->base + MXC_CSPICTRL);
477
	reg |= MX31_CSPICTRL_XCH;
478
	writel(reg, spi_imx->base + MXC_CSPICTRL);
479 480
}

481 482
static int __maybe_unused mx31_config(struct spi_device *spi,
				      struct spi_imx_config *config)
483
{
484
	struct spi_imx_data *spi_imx = spi_master_get_devdata(spi->master);
485 486 487 488 489
	unsigned int reg = MX31_CSPICTRL_ENABLE | MX31_CSPICTRL_MASTER;

	reg |= spi_imx_clkdiv_2(spi_imx->spi_clk, config->speed_hz) <<
		MX31_CSPICTRL_DR_SHIFT;

490
	if (is_imx35_cspi(spi_imx)) {
491 492 493 494 495
		reg |= (config->bpw - 1) << MX35_CSPICTRL_BL_SHIFT;
		reg |= MX31_CSPICTRL_SSCTL;
	} else {
		reg |= (config->bpw - 1) << MX31_CSPICTRL_BC_SHIFT;
	}
496

497
	if (spi->mode & SPI_CPHA)
498
		reg |= MX31_CSPICTRL_PHA;
499
	if (spi->mode & SPI_CPOL)
500
		reg |= MX31_CSPICTRL_POL;
501
	if (spi->mode & SPI_CS_HIGH)
502
		reg |= MX31_CSPICTRL_SSPOL;
503 504
	if (spi->cs_gpio < 0)
		reg |= (spi->cs_gpio + 32) <<
505 506
			(is_imx35_cspi(spi_imx) ? MX35_CSPICTRL_CS_SHIFT :
						  MX31_CSPICTRL_CS_SHIFT);
507 508 509 510 511 512

	writel(reg, spi_imx->base + MXC_CSPICTRL);

	return 0;
}

513
static int __maybe_unused mx31_rx_available(struct spi_imx_data *spi_imx)
514
{
515
	return readl(spi_imx->base + MX31_CSPISTATUS) & MX31_STATUS_RR;
516 517
}

518
static void __maybe_unused mx31_reset(struct spi_imx_data *spi_imx)
519 520
{
	/* drain receive buffer */
521
	while (readl(spi_imx->base + MX31_CSPISTATUS) & MX31_STATUS_RR)
522 523 524
		readl(spi_imx->base + MXC_CSPIRXDATA);
}

525 526 527 528 529 530 531 532 533 534 535 536 537 538
#define MX21_INTREG_RR		(1 << 4)
#define MX21_INTREG_TEEN	(1 << 9)
#define MX21_INTREG_RREN	(1 << 13)

#define MX21_CSPICTRL_POL	(1 << 5)
#define MX21_CSPICTRL_PHA	(1 << 6)
#define MX21_CSPICTRL_SSPOL	(1 << 8)
#define MX21_CSPICTRL_XCH	(1 << 9)
#define MX21_CSPICTRL_ENABLE	(1 << 10)
#define MX21_CSPICTRL_MASTER	(1 << 11)
#define MX21_CSPICTRL_DR_SHIFT	14
#define MX21_CSPICTRL_CS_SHIFT	19

static void __maybe_unused mx21_intctrl(struct spi_imx_data *spi_imx, int enable)
539 540 541 542
{
	unsigned int val = 0;

	if (enable & MXC_INT_TE)
543
		val |= MX21_INTREG_TEEN;
544
	if (enable & MXC_INT_RR)
545
		val |= MX21_INTREG_RREN;
546

547
	writel(val, spi_imx->base + MXC_CSPIINT);
548 549
}

550
static void __maybe_unused mx21_trigger(struct spi_imx_data *spi_imx)
551 552 553
{
	unsigned int reg;

554
	reg = readl(spi_imx->base + MXC_CSPICTRL);
555
	reg |= MX21_CSPICTRL_XCH;
556
	writel(reg, spi_imx->base + MXC_CSPICTRL);
557 558
}

559 560
static int __maybe_unused mx21_config(struct spi_device *spi,
				      struct spi_imx_config *config)
561
{
562
	struct spi_imx_data *spi_imx = spi_master_get_devdata(spi->master);
563
	unsigned int reg = MX21_CSPICTRL_ENABLE | MX21_CSPICTRL_MASTER;
564
	unsigned int max = is_imx27_cspi(spi_imx) ? 16 : 18;
565

566
	reg |= spi_imx_clkdiv_1(spi_imx->spi_clk, config->speed_hz, max) <<
567
		MX21_CSPICTRL_DR_SHIFT;
568 569
	reg |= config->bpw - 1;

570
	if (spi->mode & SPI_CPHA)
571
		reg |= MX21_CSPICTRL_PHA;
572
	if (spi->mode & SPI_CPOL)
573
		reg |= MX21_CSPICTRL_POL;
574
	if (spi->mode & SPI_CS_HIGH)
575
		reg |= MX21_CSPICTRL_SSPOL;
576 577
	if (spi->cs_gpio < 0)
		reg |= (spi->cs_gpio + 32) << MX21_CSPICTRL_CS_SHIFT;
578

579
	writel(reg, spi_imx->base + MXC_CSPICTRL);
580 581 582 583

	return 0;
}

584
static int __maybe_unused mx21_rx_available(struct spi_imx_data *spi_imx)
585
{
586
	return readl(spi_imx->base + MXC_CSPIINT) & MX21_INTREG_RR;
587 588
}

589
static void __maybe_unused mx21_reset(struct spi_imx_data *spi_imx)
590 591 592 593
{
	writel(1, spi_imx->base + MXC_RESET);
}

594 595 596 597 598 599 600 601 602 603 604
#define MX1_INTREG_RR		(1 << 3)
#define MX1_INTREG_TEEN		(1 << 8)
#define MX1_INTREG_RREN		(1 << 11)

#define MX1_CSPICTRL_POL	(1 << 4)
#define MX1_CSPICTRL_PHA	(1 << 5)
#define MX1_CSPICTRL_XCH	(1 << 8)
#define MX1_CSPICTRL_ENABLE	(1 << 9)
#define MX1_CSPICTRL_MASTER	(1 << 10)
#define MX1_CSPICTRL_DR_SHIFT	13

605
static void __maybe_unused mx1_intctrl(struct spi_imx_data *spi_imx, int enable)
606 607 608 609 610 611 612 613
{
	unsigned int val = 0;

	if (enable & MXC_INT_TE)
		val |= MX1_INTREG_TEEN;
	if (enable & MXC_INT_RR)
		val |= MX1_INTREG_RREN;

614
	writel(val, spi_imx->base + MXC_CSPIINT);
615 616
}

617
static void __maybe_unused mx1_trigger(struct spi_imx_data *spi_imx)
618 619 620
{
	unsigned int reg;

621
	reg = readl(spi_imx->base + MXC_CSPICTRL);
622
	reg |= MX1_CSPICTRL_XCH;
623
	writel(reg, spi_imx->base + MXC_CSPICTRL);
624 625
}

626 627
static int __maybe_unused mx1_config(struct spi_device *spi,
				     struct spi_imx_config *config)
628
{
629
	struct spi_imx_data *spi_imx = spi_master_get_devdata(spi->master);
630 631
	unsigned int reg = MX1_CSPICTRL_ENABLE | MX1_CSPICTRL_MASTER;

632
	reg |= spi_imx_clkdiv_2(spi_imx->spi_clk, config->speed_hz) <<
633 634 635
		MX1_CSPICTRL_DR_SHIFT;
	reg |= config->bpw - 1;

636
	if (spi->mode & SPI_CPHA)
637
		reg |= MX1_CSPICTRL_PHA;
638
	if (spi->mode & SPI_CPOL)
639 640
		reg |= MX1_CSPICTRL_POL;

641
	writel(reg, spi_imx->base + MXC_CSPICTRL);
642 643 644 645

	return 0;
}

646
static int __maybe_unused mx1_rx_available(struct spi_imx_data *spi_imx)
647
{
648
	return readl(spi_imx->base + MXC_CSPIINT) & MX1_INTREG_RR;
649 650
}

651 652 653 654 655
static void __maybe_unused mx1_reset(struct spi_imx_data *spi_imx)
{
	writel(1, spi_imx->base + MXC_RESET);
}

656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709 710 711
static struct spi_imx_devtype_data imx1_cspi_devtype_data = {
	.intctrl = mx1_intctrl,
	.config = mx1_config,
	.trigger = mx1_trigger,
	.rx_available = mx1_rx_available,
	.reset = mx1_reset,
	.devtype = IMX1_CSPI,
};

static struct spi_imx_devtype_data imx21_cspi_devtype_data = {
	.intctrl = mx21_intctrl,
	.config = mx21_config,
	.trigger = mx21_trigger,
	.rx_available = mx21_rx_available,
	.reset = mx21_reset,
	.devtype = IMX21_CSPI,
};

static struct spi_imx_devtype_data imx27_cspi_devtype_data = {
	/* i.mx27 cspi shares the functions with i.mx21 one */
	.intctrl = mx21_intctrl,
	.config = mx21_config,
	.trigger = mx21_trigger,
	.rx_available = mx21_rx_available,
	.reset = mx21_reset,
	.devtype = IMX27_CSPI,
};

static struct spi_imx_devtype_data imx31_cspi_devtype_data = {
	.intctrl = mx31_intctrl,
	.config = mx31_config,
	.trigger = mx31_trigger,
	.rx_available = mx31_rx_available,
	.reset = mx31_reset,
	.devtype = IMX31_CSPI,
};

static struct spi_imx_devtype_data imx35_cspi_devtype_data = {
	/* i.mx35 and later cspi shares the functions with i.mx31 one */
	.intctrl = mx31_intctrl,
	.config = mx31_config,
	.trigger = mx31_trigger,
	.rx_available = mx31_rx_available,
	.reset = mx31_reset,
	.devtype = IMX35_CSPI,
};

static struct spi_imx_devtype_data imx51_ecspi_devtype_data = {
	.intctrl = mx51_ecspi_intctrl,
	.config = mx51_ecspi_config,
	.trigger = mx51_ecspi_trigger,
	.rx_available = mx51_ecspi_rx_available,
	.reset = mx51_ecspi_reset,
	.devtype = IMX51_ECSPI,
};

712
static const struct platform_device_id spi_imx_devtype[] = {
713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733
	{
		.name = "imx1-cspi",
		.driver_data = (kernel_ulong_t) &imx1_cspi_devtype_data,
	}, {
		.name = "imx21-cspi",
		.driver_data = (kernel_ulong_t) &imx21_cspi_devtype_data,
	}, {
		.name = "imx27-cspi",
		.driver_data = (kernel_ulong_t) &imx27_cspi_devtype_data,
	}, {
		.name = "imx31-cspi",
		.driver_data = (kernel_ulong_t) &imx31_cspi_devtype_data,
	}, {
		.name = "imx35-cspi",
		.driver_data = (kernel_ulong_t) &imx35_cspi_devtype_data,
	}, {
		.name = "imx51-ecspi",
		.driver_data = (kernel_ulong_t) &imx51_ecspi_devtype_data,
	}, {
		/* sentinel */
	}
734 735
};

736 737 738 739 740 741 742 743 744
static const struct of_device_id spi_imx_dt_ids[] = {
	{ .compatible = "fsl,imx1-cspi", .data = &imx1_cspi_devtype_data, },
	{ .compatible = "fsl,imx21-cspi", .data = &imx21_cspi_devtype_data, },
	{ .compatible = "fsl,imx27-cspi", .data = &imx27_cspi_devtype_data, },
	{ .compatible = "fsl,imx31-cspi", .data = &imx31_cspi_devtype_data, },
	{ .compatible = "fsl,imx35-cspi", .data = &imx35_cspi_devtype_data, },
	{ .compatible = "fsl,imx51-ecspi", .data = &imx51_ecspi_devtype_data, },
	{ /* sentinel */ }
};
745
MODULE_DEVICE_TABLE(of, spi_imx_dt_ids);
746

747
static void spi_imx_chipselect(struct spi_device *spi, int is_active)
748
{
749 750
	int active = is_active != BITBANG_CS_INACTIVE;
	int dev_is_lowactive = !(spi->mode & SPI_CS_HIGH);
751

752
	if (!gpio_is_valid(spi->cs_gpio))
753 754
		return;

755
	gpio_set_value(spi->cs_gpio, dev_is_lowactive ^ active);
756 757
}

758
static void spi_imx_push(struct spi_imx_data *spi_imx)
759
{
760
	while (spi_imx->txfifo < spi_imx_get_fifosize(spi_imx)) {
761
		if (!spi_imx->count)
762
			break;
763 764
		spi_imx->tx(spi_imx);
		spi_imx->txfifo++;
765 766
	}

767
	spi_imx->devtype_data->trigger(spi_imx);
768 769
}

770
static irqreturn_t spi_imx_isr(int irq, void *dev_id)
771
{
772
	struct spi_imx_data *spi_imx = dev_id;
773

774
	while (spi_imx->devtype_data->rx_available(spi_imx)) {
775 776
		spi_imx->rx(spi_imx);
		spi_imx->txfifo--;
777 778
	}

779 780
	if (spi_imx->count) {
		spi_imx_push(spi_imx);
781 782 783
		return IRQ_HANDLED;
	}

784
	if (spi_imx->txfifo) {
785 786 787
		/* No data left to push, but still waiting for rx data,
		 * enable receive data available interrupt.
		 */
788
		spi_imx->devtype_data->intctrl(
789
				spi_imx, MXC_INT_RR);
790 791 792
		return IRQ_HANDLED;
	}

793
	spi_imx->devtype_data->intctrl(spi_imx, 0);
794
	complete(&spi_imx->xfer_done);
795 796 797 798

	return IRQ_HANDLED;
}

799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849
static int spi_imx_dma_configure(struct spi_master *master,
				 int bytes_per_word)
{
	int ret;
	enum dma_slave_buswidth buswidth;
	struct dma_slave_config rx = {}, tx = {};
	struct spi_imx_data *spi_imx = spi_master_get_devdata(master);

	if (bytes_per_word == spi_imx->bytes_per_word)
		/* Same as last time */
		return 0;

	switch (bytes_per_word) {
	case 4:
		buswidth = DMA_SLAVE_BUSWIDTH_4_BYTES;
		break;
	case 2:
		buswidth = DMA_SLAVE_BUSWIDTH_2_BYTES;
		break;
	case 1:
		buswidth = DMA_SLAVE_BUSWIDTH_1_BYTE;
		break;
	default:
		return -EINVAL;
	}

	tx.direction = DMA_MEM_TO_DEV;
	tx.dst_addr = spi_imx->base_phys + MXC_CSPITXDATA;
	tx.dst_addr_width = buswidth;
	tx.dst_maxburst = spi_imx->wml;
	ret = dmaengine_slave_config(master->dma_tx, &tx);
	if (ret) {
		dev_err(spi_imx->dev, "TX dma configuration failed with %d\n", ret);
		return ret;
	}

	rx.direction = DMA_DEV_TO_MEM;
	rx.src_addr = spi_imx->base_phys + MXC_CSPIRXDATA;
	rx.src_addr_width = buswidth;
	rx.src_maxburst = spi_imx->wml;
	ret = dmaengine_slave_config(master->dma_rx, &rx);
	if (ret) {
		dev_err(spi_imx->dev, "RX dma configuration failed with %d\n", ret);
		return ret;
	}

	spi_imx->bytes_per_word = bytes_per_word;

	return 0;
}

850
static int spi_imx_setupxfer(struct spi_device *spi,
851 852
				 struct spi_transfer *t)
{
853 854
	struct spi_imx_data *spi_imx = spi_master_get_devdata(spi->master);
	struct spi_imx_config config;
855
	int ret;
856 857 858 859

	config.bpw = t ? t->bits_per_word : spi->bits_per_word;
	config.speed_hz  = t ? t->speed_hz : spi->max_speed_hz;

S
Sascha Hauer 已提交
860 861 862 863 864
	if (!config.speed_hz)
		config.speed_hz = spi->max_speed_hz;
	if (!config.bpw)
		config.bpw = spi->bits_per_word;

865 866 867 868 869 870 871
	/* Initialize the functions for transfer */
	if (config.bpw <= 8) {
		spi_imx->rx = spi_imx_buf_rx_u8;
		spi_imx->tx = spi_imx_buf_tx_u8;
	} else if (config.bpw <= 16) {
		spi_imx->rx = spi_imx_buf_rx_u16;
		spi_imx->tx = spi_imx_buf_tx_u16;
872
	} else {
873 874
		spi_imx->rx = spi_imx_buf_rx_u32;
		spi_imx->tx = spi_imx_buf_tx_u32;
875
	}
876

877 878 879 880 881
	if (spi_imx_can_dma(spi_imx->bitbang.master, spi, t))
		spi_imx->usedma = 1;
	else
		spi_imx->usedma = 0;

882 883 884 885 886 887 888
	if (spi_imx->usedma) {
		ret = spi_imx_dma_configure(spi->master,
					    spi_imx_bytes_per_word(config.bpw));
		if (ret)
			return ret;
	}

889
	spi_imx->devtype_data->config(spi, &config);
890 891 892 893

	return 0;
}

R
Robin Gong 已提交
894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909
static void spi_imx_sdma_exit(struct spi_imx_data *spi_imx)
{
	struct spi_master *master = spi_imx->bitbang.master;

	if (master->dma_rx) {
		dma_release_channel(master->dma_rx);
		master->dma_rx = NULL;
	}

	if (master->dma_tx) {
		dma_release_channel(master->dma_tx);
		master->dma_tx = NULL;
	}
}

static int spi_imx_sdma_init(struct device *dev, struct spi_imx_data *spi_imx,
910
			     struct spi_master *master)
R
Robin Gong 已提交
911 912 913
{
	int ret;

R
Robin Gong 已提交
914 915 916 917
	/* use pio mode for i.mx6dl chip TKT238285 */
	if (of_machine_is_compatible("fsl,imx6dl"))
		return 0;

918 919
	spi_imx->wml = spi_imx_get_fifosize(spi_imx) / 2;

R
Robin Gong 已提交
920
	/* Prepare for TX DMA: */
921 922 923 924 925
	master->dma_tx = dma_request_slave_channel_reason(dev, "tx");
	if (IS_ERR(master->dma_tx)) {
		ret = PTR_ERR(master->dma_tx);
		dev_dbg(dev, "can't get the TX DMA channel, error %d!\n", ret);
		master->dma_tx = NULL;
R
Robin Gong 已提交
926 927 928 929
		goto err;
	}

	/* Prepare for RX : */
930 931 932 933 934
	master->dma_rx = dma_request_slave_channel_reason(dev, "rx");
	if (IS_ERR(master->dma_rx)) {
		ret = PTR_ERR(master->dma_rx);
		dev_dbg(dev, "can't get the RX DMA channel, error %d\n", ret);
		master->dma_rx = NULL;
R
Robin Gong 已提交
935 936 937
		goto err;
	}

938
	spi_imx_dma_configure(master, 1);
R
Robin Gong 已提交
939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966

	init_completion(&spi_imx->dma_rx_completion);
	init_completion(&spi_imx->dma_tx_completion);
	master->can_dma = spi_imx_can_dma;
	master->max_dma_len = MAX_SDMA_BD_BYTES;
	spi_imx->bitbang.master->flags = SPI_MASTER_MUST_RX |
					 SPI_MASTER_MUST_TX;

	return 0;
err:
	spi_imx_sdma_exit(spi_imx);
	return ret;
}

static void spi_imx_dma_rx_callback(void *cookie)
{
	struct spi_imx_data *spi_imx = (struct spi_imx_data *)cookie;

	complete(&spi_imx->dma_rx_completion);
}

static void spi_imx_dma_tx_callback(void *cookie)
{
	struct spi_imx_data *spi_imx = (struct spi_imx_data *)cookie;

	complete(&spi_imx->dma_tx_completion);
}

967 968 969 970 971 972 973 974 975 976 977 978 979 980
static int spi_imx_calculate_timeout(struct spi_imx_data *spi_imx, int size)
{
	unsigned long timeout = 0;

	/* Time with actual data transfer and CS change delay related to HW */
	timeout = (8 + 4) * size / spi_imx->spi_bus_clk;

	/* Add extra second for scheduler related activities */
	timeout += 1;

	/* Double calculated timeout */
	return msecs_to_jiffies(2 * timeout * MSEC_PER_SEC);
}

R
Robin Gong 已提交
981 982 983
static int spi_imx_dma_transfer(struct spi_imx_data *spi_imx,
				struct spi_transfer *transfer)
{
984
	struct dma_async_tx_descriptor *desc_tx, *desc_rx;
985
	unsigned long transfer_timeout;
986
	unsigned long timeout;
R
Robin Gong 已提交
987 988 989
	struct spi_master *master = spi_imx->bitbang.master;
	struct sg_table *tx = &transfer->tx_sg, *rx = &transfer->rx_sg;

990 991 992 993 994 995 996 997 998
	/*
	 * The TX DMA setup starts the transfer, so make sure RX is configured
	 * before TX.
	 */
	desc_rx = dmaengine_prep_slave_sg(master->dma_rx,
				rx->sgl, rx->nents, DMA_DEV_TO_MEM,
				DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
	if (!desc_rx)
		return -EINVAL;
R
Robin Gong 已提交
999

1000 1001 1002 1003 1004
	desc_rx->callback = spi_imx_dma_rx_callback;
	desc_rx->callback_param = (void *)spi_imx;
	dmaengine_submit(desc_rx);
	reinit_completion(&spi_imx->dma_rx_completion);
	dma_async_issue_pending(master->dma_rx);
R
Robin Gong 已提交
1005

1006 1007 1008 1009 1010 1011
	desc_tx = dmaengine_prep_slave_sg(master->dma_tx,
				tx->sgl, tx->nents, DMA_MEM_TO_DEV,
				DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
	if (!desc_tx) {
		dmaengine_terminate_all(master->dma_tx);
		return -EINVAL;
R
Robin Gong 已提交
1012 1013
	}

1014 1015 1016
	desc_tx->callback = spi_imx_dma_tx_callback;
	desc_tx->callback_param = (void *)spi_imx;
	dmaengine_submit(desc_tx);
R
Robin Gong 已提交
1017
	reinit_completion(&spi_imx->dma_tx_completion);
1018
	dma_async_issue_pending(master->dma_tx);
R
Robin Gong 已提交
1019

1020 1021
	transfer_timeout = spi_imx_calculate_timeout(spi_imx, transfer->len);

R
Robin Gong 已提交
1022
	/* Wait SDMA to finish the data transfer.*/
1023
	timeout = wait_for_completion_timeout(&spi_imx->dma_tx_completion,
1024
						transfer_timeout);
1025
	if (!timeout) {
1026
		dev_err(spi_imx->dev, "I/O Error in DMA TX\n");
R
Robin Gong 已提交
1027
		dmaengine_terminate_all(master->dma_tx);
1028
		dmaengine_terminate_all(master->dma_rx);
1029
		return -ETIMEDOUT;
R
Robin Gong 已提交
1030 1031
	}

1032 1033 1034 1035 1036 1037 1038 1039
	timeout = wait_for_completion_timeout(&spi_imx->dma_rx_completion,
					      transfer_timeout);
	if (!timeout) {
		dev_err(&master->dev, "I/O Error in DMA RX\n");
		spi_imx->devtype_data->reset(spi_imx);
		dmaengine_terminate_all(master->dma_rx);
		return -ETIMEDOUT;
	}
R
Robin Gong 已提交
1040

1041
	return transfer->len;
R
Robin Gong 已提交
1042 1043 1044
}

static int spi_imx_pio_transfer(struct spi_device *spi,
1045 1046
				struct spi_transfer *transfer)
{
1047
	struct spi_imx_data *spi_imx = spi_master_get_devdata(spi->master);
1048

1049 1050 1051 1052
	spi_imx->tx_buf = transfer->tx_buf;
	spi_imx->rx_buf = transfer->rx_buf;
	spi_imx->count = transfer->len;
	spi_imx->txfifo = 0;
1053

1054
	reinit_completion(&spi_imx->xfer_done);
1055

1056
	spi_imx_push(spi_imx);
1057

1058
	spi_imx->devtype_data->intctrl(spi_imx, MXC_INT_TE);
1059

1060
	wait_for_completion(&spi_imx->xfer_done);
1061 1062 1063 1064

	return transfer->len;
}

R
Robin Gong 已提交
1065 1066 1067 1068 1069
static int spi_imx_transfer(struct spi_device *spi,
				struct spi_transfer *transfer)
{
	struct spi_imx_data *spi_imx = spi_master_get_devdata(spi->master);

1070
	if (spi_imx->usedma)
S
Sascha Hauer 已提交
1071
		return spi_imx_dma_transfer(spi_imx, transfer);
1072 1073
	else
		return spi_imx_pio_transfer(spi, transfer);
R
Robin Gong 已提交
1074 1075
}

1076
static int spi_imx_setup(struct spi_device *spi)
1077
{
1078
	dev_dbg(&spi->dev, "%s: mode %d, %u bpw, %d hz\n", __func__,
1079 1080
		 spi->mode, spi->bits_per_word, spi->max_speed_hz);

1081 1082 1083
	if (gpio_is_valid(spi->cs_gpio))
		gpio_direction_output(spi->cs_gpio,
				      spi->mode & SPI_CS_HIGH ? 0 : 1);
1084

1085
	spi_imx_chipselect(spi, BITBANG_CS_INACTIVE);
1086 1087 1088 1089

	return 0;
}

1090
static void spi_imx_cleanup(struct spi_device *spi)
1091 1092 1093
{
}

1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122
static int
spi_imx_prepare_message(struct spi_master *master, struct spi_message *msg)
{
	struct spi_imx_data *spi_imx = spi_master_get_devdata(master);
	int ret;

	ret = clk_enable(spi_imx->clk_per);
	if (ret)
		return ret;

	ret = clk_enable(spi_imx->clk_ipg);
	if (ret) {
		clk_disable(spi_imx->clk_per);
		return ret;
	}

	return 0;
}

static int
spi_imx_unprepare_message(struct spi_master *master, struct spi_message *msg)
{
	struct spi_imx_data *spi_imx = spi_master_get_devdata(master);

	clk_disable(spi_imx->clk_ipg);
	clk_disable(spi_imx->clk_per);
	return 0;
}

1123
static int spi_imx_probe(struct platform_device *pdev)
1124
{
1125 1126 1127 1128 1129
	struct device_node *np = pdev->dev.of_node;
	const struct of_device_id *of_id =
			of_match_device(spi_imx_dt_ids, &pdev->dev);
	struct spi_imx_master *mxc_platform_info =
			dev_get_platdata(&pdev->dev);
1130
	struct spi_master *master;
1131
	struct spi_imx_data *spi_imx;
1132
	struct resource *res;
1133
	int i, ret, irq;
1134

1135
	if (!np && !mxc_platform_info) {
1136 1137 1138 1139
		dev_err(&pdev->dev, "can't get the platform data\n");
		return -EINVAL;
	}

1140
	master = spi_alloc_master(&pdev->dev, sizeof(struct spi_imx_data));
1141 1142 1143 1144 1145
	if (!master)
		return -ENOMEM;

	platform_set_drvdata(pdev, master);

1146
	master->bits_per_word_mask = SPI_BPW_RANGE_MASK(1, 32);
1147
	master->bus_num = np ? -1 : pdev->id;
1148

1149
	spi_imx = spi_master_get_devdata(master);
1150
	spi_imx->bitbang.master = master;
1151
	spi_imx->dev = &pdev->dev;
1152

1153 1154 1155
	spi_imx->devtype_data = of_id ? of_id->data :
		(struct spi_imx_devtype_data *)pdev->id_entry->driver_data;

1156 1157 1158 1159 1160 1161
	if (mxc_platform_info) {
		master->num_chipselect = mxc_platform_info->num_chipselect;
		master->cs_gpios = devm_kzalloc(&master->dev,
			sizeof(int) * master->num_chipselect, GFP_KERNEL);
		if (!master->cs_gpios)
			return -ENOMEM;
1162

1163 1164 1165
		for (i = 0; i < master->num_chipselect; i++)
			master->cs_gpios[i] = mxc_platform_info->chipselect[i];
 	}
1166

1167 1168 1169 1170 1171
	spi_imx->bitbang.chipselect = spi_imx_chipselect;
	spi_imx->bitbang.setup_transfer = spi_imx_setupxfer;
	spi_imx->bitbang.txrx_bufs = spi_imx_transfer;
	spi_imx->bitbang.master->setup = spi_imx_setup;
	spi_imx->bitbang.master->cleanup = spi_imx_cleanup;
1172 1173
	spi_imx->bitbang.master->prepare_message = spi_imx_prepare_message;
	spi_imx->bitbang.master->unprepare_message = spi_imx_unprepare_message;
1174 1175 1176
	spi_imx->bitbang.master->mode_bits = SPI_CPOL | SPI_CPHA | SPI_CS_HIGH;
	if (is_imx51_ecspi(spi_imx))
		spi_imx->bitbang.master->mode_bits |= SPI_LOOP;
1177

1178
	init_completion(&spi_imx->xfer_done);
1179 1180

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
F
Fabio Estevam 已提交
1181 1182 1183 1184
	spi_imx->base = devm_ioremap_resource(&pdev->dev, res);
	if (IS_ERR(spi_imx->base)) {
		ret = PTR_ERR(spi_imx->base);
		goto out_master_put;
1185
	}
1186
	spi_imx->base_phys = res->start;
1187

1188 1189 1190
	irq = platform_get_irq(pdev, 0);
	if (irq < 0) {
		ret = irq;
F
Fabio Estevam 已提交
1191
		goto out_master_put;
1192 1193
	}

1194
	ret = devm_request_irq(&pdev->dev, irq, spi_imx_isr, 0,
1195
			       dev_name(&pdev->dev), spi_imx);
1196
	if (ret) {
1197
		dev_err(&pdev->dev, "can't get irq%d: %d\n", irq, ret);
F
Fabio Estevam 已提交
1198
		goto out_master_put;
1199 1200
	}

1201 1202 1203
	spi_imx->clk_ipg = devm_clk_get(&pdev->dev, "ipg");
	if (IS_ERR(spi_imx->clk_ipg)) {
		ret = PTR_ERR(spi_imx->clk_ipg);
F
Fabio Estevam 已提交
1204
		goto out_master_put;
1205 1206
	}

1207 1208 1209
	spi_imx->clk_per = devm_clk_get(&pdev->dev, "per");
	if (IS_ERR(spi_imx->clk_per)) {
		ret = PTR_ERR(spi_imx->clk_per);
F
Fabio Estevam 已提交
1210
		goto out_master_put;
1211 1212
	}

1213 1214 1215 1216 1217 1218 1219
	ret = clk_prepare_enable(spi_imx->clk_per);
	if (ret)
		goto out_master_put;

	ret = clk_prepare_enable(spi_imx->clk_ipg);
	if (ret)
		goto out_put_per;
1220 1221

	spi_imx->spi_clk = clk_get_rate(spi_imx->clk_per);
R
Robin Gong 已提交
1222 1223 1224 1225
	/*
	 * Only validated on i.mx6 now, can remove the constrain if validated on
	 * other chips.
	 */
1226
	if (is_imx51_ecspi(spi_imx)) {
1227
		ret = spi_imx_sdma_init(&pdev->dev, spi_imx, master);
1228 1229 1230
		if (ret == -EPROBE_DEFER)
			goto out_clk_put;

1231 1232 1233 1234
		if (ret < 0)
			dev_err(&pdev->dev, "dma setup error %d, use pio\n",
				ret);
	}
1235

1236
	spi_imx->devtype_data->reset(spi_imx);
1237

1238
	spi_imx->devtype_data->intctrl(spi_imx, 0);
1239

1240
	master->dev.of_node = pdev->dev.of_node;
1241
	ret = spi_bitbang_start(&spi_imx->bitbang);
1242 1243 1244 1245 1246
	if (ret) {
		dev_err(&pdev->dev, "bitbang start failed with %d\n", ret);
		goto out_clk_put;
	}

1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259
	for (i = 0; i < master->num_chipselect; i++) {
		if (!gpio_is_valid(master->cs_gpios[i]))
			continue;

		ret = devm_gpio_request(&pdev->dev, master->cs_gpios[i],
					DRIVER_NAME);
		if (ret) {
			dev_err(&pdev->dev, "Can't get CS GPIO %i\n",
				master->cs_gpios[i]);
			goto out_clk_put;
		}
	}

1260 1261
	dev_info(&pdev->dev, "probed\n");

1262 1263
	clk_disable(spi_imx->clk_ipg);
	clk_disable(spi_imx->clk_per);
1264 1265 1266
	return ret;

out_clk_put:
1267
	clk_disable_unprepare(spi_imx->clk_ipg);
1268 1269
out_put_per:
	clk_disable_unprepare(spi_imx->clk_per);
F
Fabio Estevam 已提交
1270
out_master_put:
1271
	spi_master_put(master);
F
Fabio Estevam 已提交
1272

1273 1274 1275
	return ret;
}

1276
static int spi_imx_remove(struct platform_device *pdev)
1277 1278
{
	struct spi_master *master = platform_get_drvdata(pdev);
1279
	struct spi_imx_data *spi_imx = spi_master_get_devdata(master);
1280

1281
	spi_bitbang_stop(&spi_imx->bitbang);
1282

1283
	writel(0, spi_imx->base + MXC_CSPICTRL);
1284 1285
	clk_unprepare(spi_imx->clk_ipg);
	clk_unprepare(spi_imx->clk_per);
R
Robin Gong 已提交
1286
	spi_imx_sdma_exit(spi_imx);
1287 1288 1289 1290 1291
	spi_master_put(master);

	return 0;
}

1292
static struct platform_driver spi_imx_driver = {
1293 1294
	.driver = {
		   .name = DRIVER_NAME,
1295
		   .of_match_table = spi_imx_dt_ids,
1296
		   },
1297
	.id_table = spi_imx_devtype,
1298
	.probe = spi_imx_probe,
1299
	.remove = spi_imx_remove,
1300
};
1301
module_platform_driver(spi_imx_driver);
1302 1303 1304 1305

MODULE_DESCRIPTION("SPI Master Controller driver");
MODULE_AUTHOR("Sascha Hauer, Pengutronix");
MODULE_LICENSE("GPL");
F
Fabio Estevam 已提交
1306
MODULE_ALIAS("platform:" DRIVER_NAME);