i2c-pxa.c 26.5 KB
Newer Older
Russell King's avatar
Russell King committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32
/*
 *  i2c_adap_pxa.c
 *
 *  I2C adapter for the PXA I2C bus access.
 *
 *  Copyright (C) 2002 Intrinsyc Software Inc.
 *  Copyright (C) 2004-2005 Deep Blue Solutions Ltd.
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License version 2 as
 *  published by the Free Software Foundation.
 *
 *  History:
 *    Apr 2002: Initial version [CS]
 *    Jun 2002: Properly seperated algo/adap [FB]
 *    Jan 2003: Fixed several bugs concerning interrupt handling [Kai-Uwe Bloem]
 *    Jan 2003: added limited signal handling [Kai-Uwe Bloem]
 *    Sep 2004: Major rework to ensure efficient bus handling [RMK]
 *    Dec 2004: Added support for PXA27x and slave device probing [Liam Girdwood]
 *    Feb 2005: Rework slave mode handling [RMK]
 */
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/i2c.h>
#include <linux/i2c-id.h>
#include <linux/init.h>
#include <linux/time.h>
#include <linux/sched.h>
#include <linux/delay.h>
#include <linux/errno.h>
#include <linux/interrupt.h>
#include <linux/i2c-pxa.h>
33
#include <linux/platform_device.h>
34 35
#include <linux/err.h>
#include <linux/clk.h>
Russell King's avatar
Russell King committed
36

37
#include <mach/hardware.h>
Russell King's avatar
Russell King committed
38
#include <asm/irq.h>
39
#include <asm/io.h>
40
#include <mach/i2c.h>
41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78

/*
 * I2C registers and bit definitions
 */
#define IBMR		(0x00)
#define IDBR		(0x08)
#define ICR		(0x10)
#define ISR		(0x18)
#define ISAR		(0x20)

#define ICR_START	(1 << 0)	   /* start bit */
#define ICR_STOP	(1 << 1)	   /* stop bit */
#define ICR_ACKNAK	(1 << 2)	   /* send ACK(0) or NAK(1) */
#define ICR_TB		(1 << 3)	   /* transfer byte bit */
#define ICR_MA		(1 << 4)	   /* master abort */
#define ICR_SCLE	(1 << 5)	   /* master clock enable */
#define ICR_IUE		(1 << 6)	   /* unit enable */
#define ICR_GCD		(1 << 7)	   /* general call disable */
#define ICR_ITEIE	(1 << 8)	   /* enable tx interrupts */
#define ICR_IRFIE	(1 << 9)	   /* enable rx interrupts */
#define ICR_BEIE	(1 << 10)	   /* enable bus error ints */
#define ICR_SSDIE	(1 << 11)	   /* slave STOP detected int enable */
#define ICR_ALDIE	(1 << 12)	   /* enable arbitration interrupt */
#define ICR_SADIE	(1 << 13)	   /* slave address detected int enable */
#define ICR_UR		(1 << 14)	   /* unit reset */
#define ICR_FM		(1 << 15)	   /* fast mode */

#define ISR_RWM		(1 << 0)	   /* read/write mode */
#define ISR_ACKNAK	(1 << 1)	   /* ack/nak status */
#define ISR_UB		(1 << 2)	   /* unit busy */
#define ISR_IBB		(1 << 3)	   /* bus busy */
#define ISR_SSD		(1 << 4)	   /* slave stop detected */
#define ISR_ALD		(1 << 5)	   /* arbitration loss detected */
#define ISR_ITE		(1 << 6)	   /* tx buffer empty */
#define ISR_IRF		(1 << 7)	   /* rx buffer full */
#define ISR_GCAD	(1 << 8)	   /* general call address detected */
#define ISR_SAD		(1 << 9)	   /* slave address detected */
#define ISR_BED		(1 << 10)	   /* bus error no ACK/NAK */
Russell King's avatar
Russell King committed
79 80 81 82 83 84 85 86 87 88 89

struct pxa_i2c {
	spinlock_t		lock;
	wait_queue_head_t	wait;
	struct i2c_msg		*msg;
	unsigned int		msg_num;
	unsigned int		msg_idx;
	unsigned int		msg_ptr;
	unsigned int		slave_addr;

	struct i2c_adapter	adap;
90
	struct clk		*clk;
Russell King's avatar
Russell King committed
91 92 93 94 95 96 97
#ifdef CONFIG_I2C_PXA_SLAVE
	struct i2c_slave_client *slave;
#endif

	unsigned int		irqlogidx;
	u32			isrlog[32];
	u32			icrlog[32];
98 99

	void __iomem		*reg_base;
100
	unsigned int		reg_shift;
101 102 103 104 105

	unsigned long		iobase;
	unsigned long		iosize;

	int			irq;
106 107
	unsigned int		use_pio :1;
	unsigned int		fast_mode :1;
Russell King's avatar
Russell King committed
108 109
};

110 111 112 113 114
#define _IBMR(i2c)	((i2c)->reg_base + (0x0 << (i2c)->reg_shift))
#define _IDBR(i2c)	((i2c)->reg_base + (0x4 << (i2c)->reg_shift))
#define _ICR(i2c)	((i2c)->reg_base + (0x8 << (i2c)->reg_shift))
#define _ISR(i2c)	((i2c)->reg_base + (0xc << (i2c)->reg_shift))
#define _ISAR(i2c)	((i2c)->reg_base + (0x10 << (i2c)->reg_shift))
115

Russell King's avatar
Russell King committed
116 117 118 119 120 121 122 123 124 125 126 127
/*
 * I2C Slave mode address
 */
#define I2C_PXA_SLAVE_ADDR      0x1

#ifdef DEBUG

struct bits {
	u32	mask;
	const char *set;
	const char *unset;
};
128
#define PXA_BIT(m, s, u)	{ .mask = m, .set = s, .unset = u }
Russell King's avatar
Russell King committed
129 130 131 132 133 134 135 136 137 138 139 140 141 142

static inline void
decode_bits(const char *prefix, const struct bits *bits, int num, u32 val)
{
	printk("%s %08x: ", prefix, val);
	while (num--) {
		const char *str = val & bits->mask ? bits->set : bits->unset;
		if (str)
			printk("%s ", str);
		bits++;
	}
}

static const struct bits isr_bits[] = {
143 144 145 146 147 148 149 150 151 152 153
	PXA_BIT(ISR_RWM,	"RX",		"TX"),
	PXA_BIT(ISR_ACKNAK,	"NAK",		"ACK"),
	PXA_BIT(ISR_UB,		"Bsy",		"Rdy"),
	PXA_BIT(ISR_IBB,	"BusBsy",	"BusRdy"),
	PXA_BIT(ISR_SSD,	"SlaveStop",	NULL),
	PXA_BIT(ISR_ALD,	"ALD",		NULL),
	PXA_BIT(ISR_ITE,	"TxEmpty",	NULL),
	PXA_BIT(ISR_IRF,	"RxFull",	NULL),
	PXA_BIT(ISR_GCAD,	"GenCall",	NULL),
	PXA_BIT(ISR_SAD,	"SlaveAddr",	NULL),
	PXA_BIT(ISR_BED,	"BusErr",	NULL),
Russell King's avatar
Russell King committed
154 155 156 157
};

static void decode_ISR(unsigned int val)
{
158
	decode_bits(KERN_DEBUG "ISR", isr_bits, ARRAY_SIZE(isr_bits), val);
Russell King's avatar
Russell King committed
159 160 161 162
	printk("\n");
}

static const struct bits icr_bits[] = {
163 164 165 166 167 168 169 170 171 172 173 174 175 176 177
	PXA_BIT(ICR_START,  "START",	NULL),
	PXA_BIT(ICR_STOP,   "STOP",	NULL),
	PXA_BIT(ICR_ACKNAK, "ACKNAK",	NULL),
	PXA_BIT(ICR_TB,     "TB",	NULL),
	PXA_BIT(ICR_MA,     "MA",	NULL),
	PXA_BIT(ICR_SCLE,   "SCLE",	"scle"),
	PXA_BIT(ICR_IUE,    "IUE",	"iue"),
	PXA_BIT(ICR_GCD,    "GCD",	NULL),
	PXA_BIT(ICR_ITEIE,  "ITEIE",	NULL),
	PXA_BIT(ICR_IRFIE,  "IRFIE",	NULL),
	PXA_BIT(ICR_BEIE,   "BEIE",	NULL),
	PXA_BIT(ICR_SSDIE,  "SSDIE",	NULL),
	PXA_BIT(ICR_ALDIE,  "ALDIE",	NULL),
	PXA_BIT(ICR_SADIE,  "SADIE",	NULL),
	PXA_BIT(ICR_UR,     "UR",		"ur"),
Russell King's avatar
Russell King committed
178 179
};

180
#ifdef CONFIG_I2C_PXA_SLAVE
Russell King's avatar
Russell King committed
181 182
static void decode_ICR(unsigned int val)
{
183
	decode_bits(KERN_DEBUG "ICR", icr_bits, ARRAY_SIZE(icr_bits), val);
Russell King's avatar
Russell King committed
184 185
	printk("\n");
}
186
#endif
Russell King's avatar
Russell King committed
187 188 189 190 191

static unsigned int i2c_debug = DEBUG;

static void i2c_pxa_show_state(struct pxa_i2c *i2c, int lno, const char *fname)
{
192 193
	dev_dbg(&i2c->adap.dev, "state:%s:%d: ISR=%08x, ICR=%08x, IBMR=%02x\n", fname, lno,
		readl(_ISR(i2c)), readl(_ICR(i2c)), readl(_IBMR(i2c)));
Russell King's avatar
Russell King committed
194 195
}

196
#define show_state(i2c) i2c_pxa_show_state(i2c, __LINE__, __func__)
Russell King's avatar
Russell King committed
197 198 199 200 201 202 203 204
#else
#define i2c_debug	0

#define show_state(i2c) do { } while (0)
#define decode_ISR(val) do { } while (0)
#define decode_ICR(val) do { } while (0)
#endif

205
#define eedbg(lvl, x...) do { if ((lvl) < 1) { printk(KERN_DEBUG "" x); } } while(0)
Russell King's avatar
Russell King committed
206 207

static void i2c_pxa_master_complete(struct pxa_i2c *i2c, int ret);
Mike Rapoport's avatar
Mike Rapoport committed
208
static irqreturn_t i2c_pxa_handler(int this_irq, void *dev_id);
Russell King's avatar
Russell King committed
209 210 211 212 213 214 215

static void i2c_pxa_scream_blue_murder(struct pxa_i2c *i2c, const char *why)
{
	unsigned int i;
	printk("i2c: error: %s\n", why);
	printk("i2c: msg_num: %d msg_idx: %d msg_ptr: %d\n",
		i2c->msg_num, i2c->msg_idx, i2c->msg_ptr);
216
	printk("i2c: ICR: %08x ISR: %08x\n"
217
	       "i2c: log: ", readl(_ICR(i2c)), readl(_ISR(i2c)));
Russell King's avatar
Russell King committed
218 219 220 221 222 223 224
	for (i = 0; i < i2c->irqlogidx; i++)
		printk("[%08x:%08x] ", i2c->isrlog[i], i2c->icrlog[i]);
	printk("\n");
}

static inline int i2c_pxa_is_slavemode(struct pxa_i2c *i2c)
{
225
	return !(readl(_ICR(i2c)) & ICR_SCLE);
Russell King's avatar
Russell King committed
226 227 228 229
}

static void i2c_pxa_abort(struct pxa_i2c *i2c)
{
230
	int i = 250;
Russell King's avatar
Russell King committed
231 232

	if (i2c_pxa_is_slavemode(i2c)) {
233
		dev_dbg(&i2c->adap.dev, "%s: called in slave mode\n", __func__);
Russell King's avatar
Russell King committed
234 235 236
		return;
	}

237
	while ((i > 0) && (readl(_IBMR(i2c)) & 0x1) == 0) {
238
		unsigned long icr = readl(_ICR(i2c));
Russell King's avatar
Russell King committed
239 240 241 242

		icr &= ~ICR_START;
		icr |= ICR_ACKNAK | ICR_STOP | ICR_TB;

243
		writel(icr, _ICR(i2c));
Russell King's avatar
Russell King committed
244 245 246

		show_state(i2c);

247 248
		mdelay(1);
		i --;
Russell King's avatar
Russell King committed
249 250
	}

251 252
	writel(readl(_ICR(i2c)) & ~(ICR_MA | ICR_START | ICR_STOP),
	       _ICR(i2c));
Russell King's avatar
Russell King committed
253 254 255 256 257 258
}

static int i2c_pxa_wait_bus_not_busy(struct pxa_i2c *i2c)
{
	int timeout = DEF_TIMEOUT;

259 260
	while (timeout-- && readl(_ISR(i2c)) & (ISR_IBB | ISR_UB)) {
		if ((readl(_ISR(i2c)) & ISR_SAD) != 0)
Russell King's avatar
Russell King committed
261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278
			timeout += 4;

		msleep(2);
		show_state(i2c);
	}

	if (timeout <= 0)
		show_state(i2c);

	return timeout <= 0 ? I2C_RETRY : 0;
}

static int i2c_pxa_wait_master(struct pxa_i2c *i2c)
{
	unsigned long timeout = jiffies + HZ*4;

	while (time_before(jiffies, timeout)) {
		if (i2c_debug > 1)
279
			dev_dbg(&i2c->adap.dev, "%s: %ld: ISR=%08x, ICR=%08x, IBMR=%02x\n",
280
				__func__, (long)jiffies, readl(_ISR(i2c)), readl(_ICR(i2c)), readl(_IBMR(i2c)));
Russell King's avatar
Russell King committed
281

282
		if (readl(_ISR(i2c)) & ISR_SAD) {
Russell King's avatar
Russell King committed
283
			if (i2c_debug > 0)
284
				dev_dbg(&i2c->adap.dev, "%s: Slave detected\n", __func__);
Russell King's avatar
Russell King committed
285 286 287 288 289 290 291
			goto out;
		}

		/* wait for unit and bus being not busy, and we also do a
		 * quick check of the i2c lines themselves to ensure they've
		 * gone high...
		 */
292
		if ((readl(_ISR(i2c)) & (ISR_UB | ISR_IBB)) == 0 && readl(_IBMR(i2c)) == 3) {
Russell King's avatar
Russell King committed
293
			if (i2c_debug > 0)
294
				dev_dbg(&i2c->adap.dev, "%s: done\n", __func__);
Russell King's avatar
Russell King committed
295 296 297 298 299 300 301
			return 1;
		}

		msleep(1);
	}

	if (i2c_debug > 0)
302
		dev_dbg(&i2c->adap.dev, "%s: did not free\n", __func__);
Russell King's avatar
Russell King committed
303 304 305 306 307 308 309
 out:
	return 0;
}

static int i2c_pxa_set_master(struct pxa_i2c *i2c)
{
	if (i2c_debug)
310
		dev_dbg(&i2c->adap.dev, "setting to bus master\n");
Russell King's avatar
Russell King committed
311

312
	if ((readl(_ISR(i2c)) & (ISR_UB | ISR_IBB)) != 0) {
313
		dev_dbg(&i2c->adap.dev, "%s: unit is busy\n", __func__);
Russell King's avatar
Russell King committed
314
		if (!i2c_pxa_wait_master(i2c)) {
315
			dev_dbg(&i2c->adap.dev, "%s: error: unit busy\n", __func__);
Russell King's avatar
Russell King committed
316 317 318 319
			return I2C_RETRY;
		}
	}

320
	writel(readl(_ICR(i2c)) | ICR_SCLE, _ICR(i2c));
Russell King's avatar
Russell King committed
321 322 323 324 325 326 327 328 329 330 331 332 333 334
	return 0;
}

#ifdef CONFIG_I2C_PXA_SLAVE
static int i2c_pxa_wait_slave(struct pxa_i2c *i2c)
{
	unsigned long timeout = jiffies + HZ*1;

	/* wait for stop */

	show_state(i2c);

	while (time_before(jiffies, timeout)) {
		if (i2c_debug > 1)
335
			dev_dbg(&i2c->adap.dev, "%s: %ld: ISR=%08x, ICR=%08x, IBMR=%02x\n",
336
				__func__, (long)jiffies, readl(_ISR(i2c)), readl(_ICR(i2c)), readl(_IBMR(i2c)));
Russell King's avatar
Russell King committed
337

338 339 340
		if ((readl(_ISR(i2c)) & (ISR_UB|ISR_IBB)) == 0 ||
		    (readl(_ISR(i2c)) & ISR_SAD) != 0 ||
		    (readl(_ICR(i2c)) & ICR_SCLE) == 0) {
Russell King's avatar
Russell King committed
341
			if (i2c_debug > 1)
342
				dev_dbg(&i2c->adap.dev, "%s: done\n", __func__);
Russell King's avatar
Russell King committed
343 344 345 346 347 348 349
			return 1;
		}

		msleep(1);
	}

	if (i2c_debug > 0)
350
		dev_dbg(&i2c->adap.dev, "%s: did not free\n", __func__);
Russell King's avatar
Russell King committed
351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367
	return 0;
}

/*
 * clear the hold on the bus, and take of anything else
 * that has been configured
 */
static void i2c_pxa_set_slave(struct pxa_i2c *i2c, int errcode)
{
	show_state(i2c);

	if (errcode < 0) {
		udelay(100);   /* simple delay */
	} else {
		/* we need to wait for the stop condition to end */

		/* if we where in stop, then clear... */
368
		if (readl(_ICR(i2c)) & ICR_STOP) {
Russell King's avatar
Russell King committed
369
			udelay(100);
370
			writel(readl(_ICR(i2c)) & ~ICR_STOP, _ICR(i2c));
Russell King's avatar
Russell King committed
371 372 373
		}

		if (!i2c_pxa_wait_slave(i2c)) {
374 375
			dev_err(&i2c->adap.dev, "%s: wait timedout\n",
				__func__);
Russell King's avatar
Russell King committed
376 377 378 379
			return;
		}
	}

380 381
	writel(readl(_ICR(i2c)) & ~(ICR_STOP|ICR_ACKNAK|ICR_MA), _ICR(i2c));
	writel(readl(_ICR(i2c)) & ~ICR_SCLE, _ICR(i2c));
Russell King's avatar
Russell King committed
382 383

	if (i2c_debug) {
384 385
		dev_dbg(&i2c->adap.dev, "ICR now %08x, ISR %08x\n", readl(_ICR(i2c)), readl(_ISR(i2c)));
		decode_ICR(readl(_ICR(i2c)));
Russell King's avatar
Russell King committed
386 387 388 389 390 391 392 393 394 395 396 397 398 399
	}
}
#else
#define i2c_pxa_set_slave(i2c, err)	do { } while (0)
#endif

static void i2c_pxa_reset(struct pxa_i2c *i2c)
{
	pr_debug("Resetting I2C Controller Unit\n");

	/* abort any transfer currently under way */
	i2c_pxa_abort(i2c);

	/* reset according to 9.8 */
400 401 402
	writel(ICR_UR, _ICR(i2c));
	writel(I2C_ISR_INIT, _ISR(i2c));
	writel(readl(_ICR(i2c)) & ~ICR_UR, _ICR(i2c));
Russell King's avatar
Russell King committed
403

404
	writel(i2c->slave_addr, _ISAR(i2c));
Russell King's avatar
Russell King committed
405 406

	/* set control register values */
407
	writel(I2C_ICR_INIT | (i2c->fast_mode ? ICR_FM : 0), _ICR(i2c));
Russell King's avatar
Russell King committed
408 409

#ifdef CONFIG_I2C_PXA_SLAVE
410
	dev_info(&i2c->adap.dev, "Enabling slave mode\n");
411
	writel(readl(_ICR(i2c)) | ICR_SADIE | ICR_ALDIE | ICR_SSDIE, _ICR(i2c));
Russell King's avatar
Russell King committed
412 413 414 415 416
#endif

	i2c_pxa_set_slave(i2c, 0);

	/* enable unit */
417
	writel(readl(_ICR(i2c)) | ICR_IUE, _ICR(i2c));
Russell King's avatar
Russell King committed
418 419 420 421 422 423 424 425 426 427 428 429 430 431
	udelay(100);
}


#ifdef CONFIG_I2C_PXA_SLAVE
/*
 * PXA I2C Slave mode
 */

static void i2c_pxa_slave_txempty(struct pxa_i2c *i2c, u32 isr)
{
	if (isr & ISR_BED) {
		/* what should we do here? */
	} else {
432 433 434 435
		int ret = 0;

		if (i2c->slave != NULL)
			ret = i2c->slave->read(i2c->slave->data);
Russell King's avatar
Russell King committed
436

437 438
		writel(ret, _IDBR(i2c));
		writel(readl(_ICR(i2c)) | ICR_TB, _ICR(i2c));   /* allow next byte */
Russell King's avatar
Russell King committed
439 440 441 442 443
	}
}

static void i2c_pxa_slave_rxfull(struct pxa_i2c *i2c, u32 isr)
{
444
	unsigned int byte = readl(_IDBR(i2c));
Russell King's avatar
Russell King committed
445 446 447 448

	if (i2c->slave != NULL)
		i2c->slave->write(i2c->slave->data, byte);

449
	writel(readl(_ICR(i2c)) | ICR_TB, _ICR(i2c));
Russell King's avatar
Russell King committed
450 451 452 453 454 455 456
}

static void i2c_pxa_slave_start(struct pxa_i2c *i2c, u32 isr)
{
	int timeout;

	if (i2c_debug > 0)
457
		dev_dbg(&i2c->adap.dev, "SAD, mode is slave-%cx\n",
Russell King's avatar
Russell King committed
458 459 460 461 462 463 464 465 466 467 468
		       (isr & ISR_RWM) ? 'r' : 't');

	if (i2c->slave != NULL)
		i2c->slave->event(i2c->slave->data,
				 (isr & ISR_RWM) ? I2C_SLAVE_EVENT_START_READ : I2C_SLAVE_EVENT_START_WRITE);

	/*
	 * slave could interrupt in the middle of us generating a
	 * start condition... if this happens, we'd better back off
	 * and stop holding the poor thing up
	 */
469 470
	writel(readl(_ICR(i2c)) & ~(ICR_START|ICR_STOP), _ICR(i2c));
	writel(readl(_ICR(i2c)) | ICR_TB, _ICR(i2c));
Russell King's avatar
Russell King committed
471 472 473 474

	timeout = 0x10000;

	while (1) {
475
		if ((readl(_IBMR(i2c)) & 2) == 2)
Russell King's avatar
Russell King committed
476 477 478 479 480
			break;

		timeout--;

		if (timeout <= 0) {
481
			dev_err(&i2c->adap.dev, "timeout waiting for SCL high\n");
Russell King's avatar
Russell King committed
482 483 484 485
			break;
		}
	}

486
	writel(readl(_ICR(i2c)) & ~ICR_SCLE, _ICR(i2c));
Russell King's avatar
Russell King committed
487 488 489 490 491
}

static void i2c_pxa_slave_stop(struct pxa_i2c *i2c)
{
	if (i2c_debug > 2)
492
		dev_dbg(&i2c->adap.dev, "ISR: SSD (Slave Stop)\n");
Russell King's avatar
Russell King committed
493 494 495 496 497

	if (i2c->slave != NULL)
		i2c->slave->event(i2c->slave->data, I2C_SLAVE_EVENT_STOP);

	if (i2c_debug > 2)
498
		dev_dbg(&i2c->adap.dev, "ISR: SSD (Slave Stop) acked\n");
Russell King's avatar
Russell King committed
499 500 501 502 503 504 505 506 507 508 509 510 511 512

	/*
	 * If we have a master-mode message waiting,
	 * kick it off now that the slave has completed.
	 */
	if (i2c->msg)
		i2c_pxa_master_complete(i2c, I2C_RETRY);
}
#else
static void i2c_pxa_slave_txempty(struct pxa_i2c *i2c, u32 isr)
{
	if (isr & ISR_BED) {
		/* what should we do here? */
	} else {
513 514
		writel(0, _IDBR(i2c));
		writel(readl(_ICR(i2c)) | ICR_TB, _ICR(i2c));
Russell King's avatar
Russell King committed
515 516 517 518 519
	}
}

static void i2c_pxa_slave_rxfull(struct pxa_i2c *i2c, u32 isr)
{
520
	writel(readl(_ICR(i2c)) | ICR_TB | ICR_ACKNAK, _ICR(i2c));
Russell King's avatar
Russell King committed
521 522 523 524 525 526 527 528 529 530 531
}

static void i2c_pxa_slave_start(struct pxa_i2c *i2c, u32 isr)
{
	int timeout;

	/*
	 * slave could interrupt in the middle of us generating a
	 * start condition... if this happens, we'd better back off
	 * and stop holding the poor thing up
	 */
532 533
	writel(readl(_ICR(i2c)) & ~(ICR_START|ICR_STOP), _ICR(i2c));
	writel(readl(_ICR(i2c)) | ICR_TB | ICR_ACKNAK, _ICR(i2c));
Russell King's avatar
Russell King committed
534 535 536 537

	timeout = 0x10000;

	while (1) {
538
		if ((readl(_IBMR(i2c)) & 2) == 2)
Russell King's avatar
Russell King committed
539 540 541 542 543
			break;

		timeout--;

		if (timeout <= 0) {
544
			dev_err(&i2c->adap.dev, "timeout waiting for SCL high\n");
Russell King's avatar
Russell King committed
545 546 547 548
			break;
		}
	}

549
	writel(readl(_ICR(i2c)) & ~ICR_SCLE, _ICR(i2c));
Russell King's avatar
Russell King committed
550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579
}

static void i2c_pxa_slave_stop(struct pxa_i2c *i2c)
{
	if (i2c->msg)
		i2c_pxa_master_complete(i2c, I2C_RETRY);
}
#endif

/*
 * PXA I2C Master mode
 */

static inline unsigned int i2c_pxa_addr_byte(struct i2c_msg *msg)
{
	unsigned int addr = (msg->addr & 0x7f) << 1;

	if (msg->flags & I2C_M_RD)
		addr |= 1;

	return addr;
}

static inline void i2c_pxa_start_message(struct pxa_i2c *i2c)
{
	u32 icr;

	/*
	 * Step 1: target slave address into IDBR
	 */
580
	writel(i2c_pxa_addr_byte(i2c->msg), _IDBR(i2c));
Russell King's avatar
Russell King committed
581 582 583 584

	/*
	 * Step 2: initiate the write.
	 */
585 586
	icr = readl(_ICR(i2c)) & ~(ICR_STOP | ICR_ALDIE);
	writel(icr | ICR_START | ICR_TB, _ICR(i2c));
Russell King's avatar
Russell King committed
587 588
}

Jean Delvare's avatar
Jean Delvare committed
589 590 591 592 593 594 595 596 597
static inline void i2c_pxa_stop_message(struct pxa_i2c *i2c)
{
	u32 icr;

	/*
	 * Clear the STOP and ACK flags
	 */
	icr = readl(_ICR(i2c));
	icr &= ~(ICR_STOP | ICR_ACKNAK);
Russell King's avatar
Russell King committed
598
	writel(icr, _ICR(i2c));
Jean Delvare's avatar
Jean Delvare committed
599 600
}

Mike Rapoport's avatar
Mike Rapoport committed
601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639 640 641 642 643 644 645 646
static int i2c_pxa_pio_set_master(struct pxa_i2c *i2c)
{
	/* make timeout the same as for interrupt based functions */
	long timeout = 2 * DEF_TIMEOUT;

	/*
	 * Wait for the bus to become free.
	 */
	while (timeout-- && readl(_ISR(i2c)) & (ISR_IBB | ISR_UB)) {
		udelay(1000);
		show_state(i2c);
	}

	if (timeout <= 0) {
		show_state(i2c);
		dev_err(&i2c->adap.dev,
			"i2c_pxa: timeout waiting for bus free\n");
		return I2C_RETRY;
	}

	/*
	 * Set master mode.
	 */
	writel(readl(_ICR(i2c)) | ICR_SCLE, _ICR(i2c));

	return 0;
}

static int i2c_pxa_do_pio_xfer(struct pxa_i2c *i2c,
			       struct i2c_msg *msg, int num)
{
	unsigned long timeout = 500000; /* 5 seconds */
	int ret = 0;

	ret = i2c_pxa_pio_set_master(i2c);
	if (ret)
		goto out;

	i2c->msg = msg;
	i2c->msg_num = num;
	i2c->msg_idx = 0;
	i2c->msg_ptr = 0;
	i2c->irqlogidx = 0;

	i2c_pxa_start_message(i2c);

Roel Kluin's avatar
Roel Kluin committed
647
	while (i2c->msg_num > 0 && --timeout) {
Mike Rapoport's avatar
Mike Rapoport committed
648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665
		i2c_pxa_handler(0, i2c);
		udelay(10);
	}

	i2c_pxa_stop_message(i2c);

	/*
	 * We place the return code in i2c->msg_idx.
	 */
	ret = i2c->msg_idx;

out:
	if (timeout == 0)
		i2c_pxa_scream_blue_murder(i2c, "timeout");

	return ret;
}

Russell King's avatar
Russell King committed
666
/*
667
 * We are protected by the adapter bus mutex.
Russell King's avatar
Russell King committed
668 669 670 671 672 673 674 675 676 677 678
 */
static int i2c_pxa_do_xfer(struct pxa_i2c *i2c, struct i2c_msg *msg, int num)
{
	long timeout;
	int ret;

	/*
	 * Wait for the bus to become free.
	 */
	ret = i2c_pxa_wait_bus_not_busy(i2c);
	if (ret) {
679
		dev_err(&i2c->adap.dev, "i2c_pxa: timeout waiting for bus free\n");
Russell King's avatar
Russell King committed
680 681 682 683 684 685 686 687
		goto out;
	}

	/*
	 * Set master mode.
	 */
	ret = i2c_pxa_set_master(i2c);
	if (ret) {
688
		dev_err(&i2c->adap.dev, "i2c_pxa_set_master: error %d\n", ret);
Russell King's avatar
Russell King committed
689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707
		goto out;
	}

	spin_lock_irq(&i2c->lock);

	i2c->msg = msg;
	i2c->msg_num = num;
	i2c->msg_idx = 0;
	i2c->msg_ptr = 0;
	i2c->irqlogidx = 0;

	i2c_pxa_start_message(i2c);

	spin_unlock_irq(&i2c->lock);

	/*
	 * The rest of the processing occurs in the interrupt handler.
	 */
	timeout = wait_event_timeout(i2c->wait, i2c->msg_num == 0, HZ * 5);
Jean Delvare's avatar
Jean Delvare committed
708
	i2c_pxa_stop_message(i2c);
Russell King's avatar
Russell King committed
709 710 711 712 713 714 715 716 717 718 719 720 721

	/*
	 * We place the return code in i2c->msg_idx.
	 */
	ret = i2c->msg_idx;

	if (timeout == 0)
		i2c_pxa_scream_blue_murder(i2c, "timeout");

 out:
	return ret;
}

Mike Rapoport's avatar
Mike Rapoport committed
722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750
static int i2c_pxa_pio_xfer(struct i2c_adapter *adap,
			    struct i2c_msg msgs[], int num)
{
	struct pxa_i2c *i2c = adap->algo_data;
	int ret, i;

	/* If the I2C controller is disabled we need to reset it
	  (probably due to a suspend/resume destroying state). We do
	  this here as we can then avoid worrying about resuming the
	  controller before its users. */
	if (!(readl(_ICR(i2c)) & ICR_IUE))
		i2c_pxa_reset(i2c);

	for (i = adap->retries; i >= 0; i--) {
		ret = i2c_pxa_do_pio_xfer(i2c, msgs, num);
		if (ret != I2C_RETRY)
			goto out;

		if (i2c_debug)
			dev_dbg(&adap->dev, "Retrying transmission\n");
		udelay(100);
	}
	i2c_pxa_scream_blue_murder(i2c, "exhausted retries");
	ret = -EREMOTEIO;
 out:
	i2c_pxa_set_slave(i2c, ret);
	return ret;
}

Russell King's avatar
Russell King committed
751 752 753 754 755 756 757 758 759 760 761
/*
 * i2c_pxa_master_complete - complete the message and wake up.
 */
static void i2c_pxa_master_complete(struct pxa_i2c *i2c, int ret)
{
	i2c->msg_ptr = 0;
	i2c->msg = NULL;
	i2c->msg_idx ++;
	i2c->msg_num = 0;
	if (ret)
		i2c->msg_idx = ret;
Mike Rapoport's avatar
Mike Rapoport committed
762 763
	if (!i2c->use_pio)
		wake_up(&i2c->wait);
Russell King's avatar
Russell King committed
764 765 766 767
}

static void i2c_pxa_irq_txempty(struct pxa_i2c *i2c, u32 isr)
{
768
	u32 icr = readl(_ICR(i2c)) & ~(ICR_START|ICR_STOP|ICR_ACKNAK|ICR_TB);
Russell King's avatar
Russell King committed
769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818

 again:
	/*
	 * If ISR_ALD is set, we lost arbitration.
	 */
	if (isr & ISR_ALD) {
		/*
		 * Do we need to do anything here?  The PXA docs
		 * are vague about what happens.
		 */
		i2c_pxa_scream_blue_murder(i2c, "ALD set");

		/*
		 * We ignore this error.  We seem to see spurious ALDs
		 * for seemingly no reason.  If we handle them as I think
		 * they should, we end up causing an I2C error, which
		 * is painful for some systems.
		 */
		return; /* ignore */
	}

	if (isr & ISR_BED) {
		int ret = BUS_ERROR;

		/*
		 * I2C bus error - either the device NAK'd us, or
		 * something more serious happened.  If we were NAK'd
		 * on the initial address phase, we can retry.
		 */
		if (isr & ISR_ACKNAK) {
			if (i2c->msg_ptr == 0 && i2c->msg_idx == 0)
				ret = I2C_RETRY;
			else
				ret = XFER_NAKED;
		}
		i2c_pxa_master_complete(i2c, ret);
	} else if (isr & ISR_RWM) {
		/*
		 * Read mode.  We have just sent the address byte, and
		 * now we must initiate the transfer.
		 */
		if (i2c->msg_ptr == i2c->msg->len - 1 &&
		    i2c->msg_idx == i2c->msg_num - 1)
			icr |= ICR_STOP | ICR_ACKNAK;

		icr |= ICR_ALDIE | ICR_TB;
	} else if (i2c->msg_ptr < i2c->msg->len) {
		/*
		 * Write mode.  Write the next data byte.
		 */
819
		writel(i2c->msg->buf[i2c->msg_ptr++], _IDBR(i2c));
Russell King's avatar
Russell King committed
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

		icr |= ICR_ALDIE | ICR_TB;

		/*
		 * If this is the last byte of the last message, send
		 * a STOP.
		 */
		if (i2c->msg_ptr == i2c->msg->len &&
		    i2c->msg_idx == i2c->msg_num - 1)
			icr |= ICR_STOP;
	} else if (i2c->msg_idx < i2c->msg_num - 1) {
		/*
		 * Next segment of the message.
		 */
		i2c->msg_ptr = 0;
		i2c->msg_idx ++;
		i2c->msg++;

		/*
		 * If we aren't doing a repeated start and address,
		 * go back and try to send the next byte.  Note that
		 * we do not support switching the R/W direction here.
		 */
		if (i2c->msg->flags & I2C_M_NOSTART)
			goto again;

		/*
		 * Write the next address.
		 */
849
		writel(i2c_pxa_addr_byte(i2c->msg), _IDBR(i2c));
Russell King's avatar
Russell King committed
850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869

		/*
		 * And trigger a repeated start, and send the byte.
		 */
		icr &= ~ICR_ALDIE;
		icr |= ICR_START | ICR_TB;
	} else {
		if (i2c->msg->len == 0) {
			/*
			 * Device probes have a message length of zero
			 * and need the bus to be reset before it can
			 * be used again.
			 */
			i2c_pxa_reset(i2c);
		}
		i2c_pxa_master_complete(i2c, 0);
	}

	i2c->icrlog[i2c->irqlogidx-1] = icr;

870
	writel(icr, _ICR(i2c));
Russell King's avatar
Russell King committed
871 872 873 874 875
	show_state(i2c);
}

static void i2c_pxa_irq_rxfull(struct pxa_i2c *i2c, u32 isr)
{
876
	u32 icr = readl(_ICR(i2c)) & ~(ICR_START|ICR_STOP|ICR_ACKNAK|ICR_TB);
Russell King's avatar
Russell King committed
877 878 879 880

	/*
	 * Read the byte.
	 */
881
	i2c->msg->buf[i2c->msg_ptr++] = readl(_IDBR(i2c));
Russell King's avatar
Russell King committed
882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897

	if (i2c->msg_ptr < i2c->msg->len) {
		/*
		 * If this is the last byte of the last
		 * message, send a STOP.
		 */
		if (i2c->msg_ptr == i2c->msg->len - 1)
			icr |= ICR_STOP | ICR_ACKNAK;

		icr |= ICR_ALDIE | ICR_TB;
	} else {
		i2c_pxa_master_complete(i2c, 0);
	}

	i2c->icrlog[i2c->irqlogidx-1] = icr;

898
	writel(icr, _ICR(i2c));
Russell King's avatar
Russell King committed
899 900
}

901
static irqreturn_t i2c_pxa_handler(int this_irq, void *dev_id)
Russell King's avatar
Russell King committed
902 903
{
	struct pxa_i2c *i2c = dev_id;
904
	u32 isr = readl(_ISR(i2c));
Russell King's avatar
Russell King committed
905 906

	if (i2c_debug > 2 && 0) {
907
		dev_dbg(&i2c->adap.dev, "%s: ISR=%08x, ICR=%08x, IBMR=%02x\n",
908
			__func__, isr, readl(_ICR(i2c)), readl(_IBMR(i2c)));
Russell King's avatar
Russell King committed
909 910 911
		decode_ISR(isr);
	}

912
	if (i2c->irqlogidx < ARRAY_SIZE(i2c->isrlog))
Russell King's avatar
Russell King committed
913 914 915 916 917 918 919
		i2c->isrlog[i2c->irqlogidx++] = isr;

	show_state(i2c);

	/*
	 * Always clear all pending IRQs.
	 */
920
	writel(isr & (ISR_SSD|ISR_ALD|ISR_ITE|ISR_IRF|ISR_SAD|ISR_BED), _ISR(i2c));
Russell King's avatar
Russell King committed
921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955

	if (isr & ISR_SAD)
		i2c_pxa_slave_start(i2c, isr);
	if (isr & ISR_SSD)
		i2c_pxa_slave_stop(i2c);

	if (i2c_pxa_is_slavemode(i2c)) {
		if (isr & ISR_ITE)
			i2c_pxa_slave_txempty(i2c, isr);
		if (isr & ISR_IRF)
			i2c_pxa_slave_rxfull(i2c, isr);
	} else if (i2c->msg) {
		if (isr & ISR_ITE)
			i2c_pxa_irq_txempty(i2c, isr);
		if (isr & ISR_IRF)
			i2c_pxa_irq_rxfull(i2c, isr);
	} else {
		i2c_pxa_scream_blue_murder(i2c, "spurious irq");
	}

	return IRQ_HANDLED;
}


static int i2c_pxa_xfer(struct i2c_adapter *adap, struct i2c_msg msgs[], int num)
{
	struct pxa_i2c *i2c = adap->algo_data;
	int ret, i;

	for (i = adap->retries; i >= 0; i--) {
		ret = i2c_pxa_do_xfer(i2c, msgs, num);
		if (ret != I2C_RETRY)
			goto out;

		if (i2c_debug)
956
			dev_dbg(&adap->dev, "Retrying transmission\n");
Russell King's avatar
Russell King committed
957 958 959 960 961 962 963 964 965
		udelay(100);
	}
	i2c_pxa_scream_blue_murder(i2c, "exhausted retries");
	ret = -EREMOTEIO;
 out:
	i2c_pxa_set_slave(i2c, ret);
	return ret;
}

966 967 968 969 970
static u32 i2c_pxa_functionality(struct i2c_adapter *adap)
{
	return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
}

971
static const struct i2c_algorithm i2c_pxa_algorithm = {
Russell King's avatar
Russell King committed
972
	.master_xfer	= i2c_pxa_xfer,
973
	.functionality	= i2c_pxa_functionality,
Russell King's avatar
Russell King committed
974 975
};

Mike Rapoport's avatar
Mike Rapoport committed
976 977 978 979 980
static const struct i2c_algorithm i2c_pxa_pio_algorithm = {
	.master_xfer	= i2c_pxa_pio_xfer,
	.functionality	= i2c_pxa_functionality,
};

981
#define res_len(r)		((r)->end - (r)->start + 1)
982
static int i2c_pxa_probe(struct platform_device *dev)
Russell King's avatar
Russell King committed
983
{
984
	struct pxa_i2c *i2c;
985
	struct resource *res;
986
	struct i2c_pxa_platform_data *plat = dev->dev.platform_data;
Russell King's avatar
Russell King committed
987
	int ret;
988
	int irq;
Russell King's avatar
Russell King committed
989

990 991 992 993 994 995 996 997
	res = platform_get_resource(dev, IORESOURCE_MEM, 0);
	irq = platform_get_irq(dev, 0);
	if (res == NULL || irq < 0)
		return -ENODEV;

	if (!request_mem_region(res->start, res_len(res), res->name))
		return -ENOMEM;

998
	i2c = kzalloc(sizeof(struct pxa_i2c), GFP_KERNEL);
999 1000 1001 1002 1003
	if (!i2c) {
		ret = -ENOMEM;
		goto emalloc;
	}

1004 1005 1006 1007
	i2c->adap.owner   = THIS_MODULE;
	i2c->adap.retries = 5;

	spin_lock_init(&i2c->lock);
1008
	init_waitqueue_head(&i2c->wait);
1009

Wolfram Sang's avatar
Wolfram Sang committed
1010 1011 1012 1013 1014 1015 1016 1017
	/*
	 * If "dev->id" is negative we consider it as zero.
	 * The reason to do so is to avoid sysfs names that only make
	 * sense when there are multiple adapters.
	 */
	i2c->adap.nr = dev->id != -1 ? dev->id : 0;
	snprintf(i2c->adap.name, sizeof(i2c->adap.name), "pxa_i2c-i2c.%u",
		 i2c->adap.nr);
1018

1019
	i2c->clk = clk_get(&dev->dev, NULL);
1020 1021 1022 1023 1024
	if (IS_ERR(i2c->clk)) {
		ret = PTR_ERR(i2c->clk);
		goto eclk;
	}

1025 1026 1027 1028 1029
	i2c->reg_base = ioremap(res->start, res_len(res));
	if (!i2c->reg_base) {
		ret = -EIO;
		goto eremap;
	}
1030
	i2c->reg_shift = (cpu_is_pxa3xx() && (dev->id == 1)) ? 0 : 1;
1031 1032 1033 1034 1035

	i2c->iobase = res->start;
	i2c->iosize = res_len(res);

	i2c->irq = irq;
Russell King's avatar
Russell King committed
1036 1037 1038 1039 1040 1041

	i2c->slave_addr = I2C_PXA_SLAVE_ADDR;

#ifdef CONFIG_I2C_PXA_SLAVE
	if (plat) {
		i2c->slave_addr = plat->slave_addr;
1042
		i2c->slave = plat->slave;
Russell King's avatar
Russell King committed
1043 1044 1045
	}
#endif

1046
	clk_enable(i2c->clk);
1047

Mike Rapoport's avatar
Mike Rapoport committed
1048 1049 1050
	if (plat) {
		i2c->adap.class = plat->class;
		i2c->use_pio = plat->use_pio;
1051
		i2c->fast_mode = plat->fast_mode;
Mike Rapoport's avatar
Mike Rapoport committed
1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062
	}

	if (i2c->use_pio) {
		i2c->adap.algo = &i2c_pxa_pio_algorithm;
	} else {
		i2c->adap.algo = &i2c_pxa_algorithm;
		ret = request_irq(irq, i2c_pxa_handler, IRQF_DISABLED,
				  i2c->adap.name, i2c);
		if (ret)
			goto ereqirq;
	}
1063

Russell King's avatar
Russell King committed
1064 1065 1066
	i2c_pxa_reset(i2c);

	i2c->adap.algo_data = i2c;
1067
	i2c->adap.dev.parent = &dev->dev;
Russell King's avatar
Russell King committed
1068

1069
	ret = i2c_add_numbered_adapter(&i2c->adap);
Russell King's avatar
Russell King committed
1070 1071
	if (ret < 0) {
		printk(KERN_INFO "I2C: Failed to add bus\n");
1072
		goto eadapt;
Russell King's avatar
Russell King committed
1073 1074
	}

1075
	platform_set_drvdata(dev, i2c);
Russell King's avatar
Russell King committed
1076 1077 1078

#ifdef CONFIG_I2C_PXA_SLAVE
	printk(KERN_INFO "I2C: %s: PXA I2C adapter, slave address %d\n",
1079
	       dev_name(&i2c->adap.dev), i2c->slave_addr);
Russell King's avatar
Russell King committed
1080 1081
#else
	printk(KERN_INFO "I2C: %s: PXA I2C adapter\n",
1082
	       dev_name(&i2c->adap.dev));
Russell King's avatar
Russell King committed
1083 1084 1085
#endif
	return 0;

1086
eadapt:
Mike Rapoport's avatar
Mike Rapoport committed
1087 1088
	if (!i2c->use_pio)
		free_irq(irq, i2c);
1089
ereqirq:
1090
	clk_disable(i2c->clk);
Wolfram Sang's avatar
Wolfram Sang committed
1091
	iounmap(i2c->reg_base);
1092
eremap:
1093 1094
	clk_put(i2c->clk);
eclk:
1095 1096 1097
	kfree(i2c);
emalloc:
	release_mem_region(res->start, res_len(res));
Russell King's avatar
Russell King committed
1098 1099 1100
	return ret;
}

Wolfram Sang's avatar
Wolfram Sang committed
1101
static int __exit i2c_pxa_remove(struct platform_device *dev)
Russell King's avatar
Russell King committed
1102
{
1103
	struct pxa_i2c *i2c = platform_get_drvdata(dev);
Russell King's avatar
Russell King committed
1104

1105
	platform_set_drvdata(dev, NULL);
Russell King's avatar
Russell King committed
1106 1107

	i2c_del_adapter(&i2c->adap);
Mike Rapoport's avatar
Mike Rapoport committed
1108 1109
	if (!i2c->use_pio)
		free_irq(i2c->irq, i2c);
1110 1111 1112 1113

	clk_disable(i2c->clk);
	clk_put(i2c->clk);

Wolfram Sang's avatar
Wolfram Sang committed
1114
	iounmap(i2c->reg_base);
1115 1116
	release_mem_region(i2c->iobase, i2c->iosize);
	kfree(i2c);
Russell King's avatar
Russell King committed
1117 1118 1119 1120

	return 0;
}

1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142
#ifdef CONFIG_PM
static int i2c_pxa_suspend_late(struct platform_device *dev, pm_message_t state)
{
	struct pxa_i2c *i2c = platform_get_drvdata(dev);
	clk_disable(i2c->clk);
	return 0;
}

static int i2c_pxa_resume_early(struct platform_device *dev)
{
	struct pxa_i2c *i2c = platform_get_drvdata(dev);

	clk_enable(i2c->clk);
	i2c_pxa_reset(i2c);

	return 0;
}
#else
#define i2c_pxa_suspend_late NULL
#define i2c_pxa_resume_early NULL
#endif

1143
static struct platform_driver i2c_pxa_driver = {
Russell King's avatar
Russell King committed
1144
	.probe		= i2c_pxa_probe,
Wolfram Sang's avatar
Wolfram Sang committed
1145
	.remove		= __exit_p(i2c_pxa_remove),
1146 1147
	.suspend_late	= i2c_pxa_suspend_late,
	.resume_early	= i2c_pxa_resume_early,
1148 1149
	.driver		= {
		.name	= "pxa2xx-i2c",
Wolfram Sang's avatar
Wolfram Sang committed
1150
		.owner	= THIS_MODULE,
1151
	},
Russell King's avatar
Russell King committed
1152 1153 1154 1155
};

static int __init i2c_adap_pxa_init(void)
{
1156
	return platform_driver_register(&i2c_pxa_driver);
Russell King's avatar
Russell King committed
1157 1158
}

Wolfram Sang's avatar
Wolfram Sang committed
1159
static void __exit i2c_adap_pxa_exit(void)
Russell King's avatar
Russell King committed
1160
{
1161
	platform_driver_unregister(&i2c_pxa_driver);
Russell King's avatar
Russell King committed
1162 1163
}

1164
MODULE_LICENSE("GPL");
1165
MODULE_ALIAS("platform:pxa2xx-i2c");
1166

Uli Luckas's avatar
Uli Luckas committed
1167
subsys_initcall(i2c_adap_pxa_init);
Russell King's avatar
Russell King committed
1168
module_exit(i2c_adap_pxa_exit);