ab8500-core.c 29.0 KB
Newer Older
R
Rabin Vincent 已提交
1 2 3 4 5 6
/*
 * Copyright (C) ST-Ericsson SA 2010
 *
 * License Terms: GNU General Public License v2
 * Author: Srinidhi Kasagar <srinidhi.kasagar@stericsson.com>
 * Author: Rabin Vincent <rabin.vincent@stericsson.com>
7
 * Author: Mattias Wallin <mattias.wallin@stericsson.com>
R
Rabin Vincent 已提交
8 9 10 11 12 13 14 15 16 17 18
 */

#include <linux/kernel.h>
#include <linux/slab.h>
#include <linux/init.h>
#include <linux/irq.h>
#include <linux/delay.h>
#include <linux/interrupt.h>
#include <linux/module.h>
#include <linux/platform_device.h>
#include <linux/mfd/core.h>
19
#include <linux/mfd/abx500.h>
20
#include <linux/mfd/abx500/ab8500.h>
21
#include <linux/regulator/ab8500.h>
R
Rabin Vincent 已提交
22 23 24 25 26

/*
 * Interrupt register offsets
 * Bank : 0x0E
 */
27 28 29 30 31 32 33 34
#define AB8500_IT_SOURCE1_REG		0x00
#define AB8500_IT_SOURCE2_REG		0x01
#define AB8500_IT_SOURCE3_REG		0x02
#define AB8500_IT_SOURCE4_REG		0x03
#define AB8500_IT_SOURCE5_REG		0x04
#define AB8500_IT_SOURCE6_REG		0x05
#define AB8500_IT_SOURCE7_REG		0x06
#define AB8500_IT_SOURCE8_REG		0x07
35
#define AB9540_IT_SOURCE13_REG		0x0C
36 37 38 39 40 41
#define AB8500_IT_SOURCE19_REG		0x12
#define AB8500_IT_SOURCE20_REG		0x13
#define AB8500_IT_SOURCE21_REG		0x14
#define AB8500_IT_SOURCE22_REG		0x15
#define AB8500_IT_SOURCE23_REG		0x16
#define AB8500_IT_SOURCE24_REG		0x17
R
Rabin Vincent 已提交
42 43 44 45

/*
 * latch registers
 */
46 47 48 49 50 51 52 53 54 55
#define AB8500_IT_LATCH1_REG		0x20
#define AB8500_IT_LATCH2_REG		0x21
#define AB8500_IT_LATCH3_REG		0x22
#define AB8500_IT_LATCH4_REG		0x23
#define AB8500_IT_LATCH5_REG		0x24
#define AB8500_IT_LATCH6_REG		0x25
#define AB8500_IT_LATCH7_REG		0x26
#define AB8500_IT_LATCH8_REG		0x27
#define AB8500_IT_LATCH9_REG		0x28
#define AB8500_IT_LATCH10_REG		0x29
56
#define AB8500_IT_LATCH12_REG		0x2B
57
#define AB9540_IT_LATCH13_REG		0x2C
58 59 60 61 62 63
#define AB8500_IT_LATCH19_REG		0x32
#define AB8500_IT_LATCH20_REG		0x33
#define AB8500_IT_LATCH21_REG		0x34
#define AB8500_IT_LATCH22_REG		0x35
#define AB8500_IT_LATCH23_REG		0x36
#define AB8500_IT_LATCH24_REG		0x37
R
Rabin Vincent 已提交
64 65 66 67 68

/*
 * mask registers
 */

69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94
#define AB8500_IT_MASK1_REG		0x40
#define AB8500_IT_MASK2_REG		0x41
#define AB8500_IT_MASK3_REG		0x42
#define AB8500_IT_MASK4_REG		0x43
#define AB8500_IT_MASK5_REG		0x44
#define AB8500_IT_MASK6_REG		0x45
#define AB8500_IT_MASK7_REG		0x46
#define AB8500_IT_MASK8_REG		0x47
#define AB8500_IT_MASK9_REG		0x48
#define AB8500_IT_MASK10_REG		0x49
#define AB8500_IT_MASK11_REG		0x4A
#define AB8500_IT_MASK12_REG		0x4B
#define AB8500_IT_MASK13_REG		0x4C
#define AB8500_IT_MASK14_REG		0x4D
#define AB8500_IT_MASK15_REG		0x4E
#define AB8500_IT_MASK16_REG		0x4F
#define AB8500_IT_MASK17_REG		0x50
#define AB8500_IT_MASK18_REG		0x51
#define AB8500_IT_MASK19_REG		0x52
#define AB8500_IT_MASK20_REG		0x53
#define AB8500_IT_MASK21_REG		0x54
#define AB8500_IT_MASK22_REG		0x55
#define AB8500_IT_MASK23_REG		0x56
#define AB8500_IT_MASK24_REG		0x57

#define AB8500_REV_REG			0x80
95
#define AB8500_IC_NAME_REG		0x82
96
#define AB8500_SWITCH_OFF_STATUS	0x00
R
Rabin Vincent 已提交
97

98 99
#define AB8500_TURN_ON_STATUS		0x00

100 101 102
#define AB9540_MODEM_CTRL2_REG			0x23
#define AB9540_MODEM_CTRL2_SWDBBRSTN_BIT	BIT(2)

R
Rabin Vincent 已提交
103 104
/*
 * Map interrupt numbers to the LATCH and MASK register offsets, Interrupt
105 106
 * numbers are indexed into this array with (num / 8). The interupts are
 * defined in linux/mfd/ab8500.h
R
Rabin Vincent 已提交
107 108 109 110
 *
 * This is one off from the register names, i.e. AB8500_IT_MASK1_REG is at
 * offset 0.
 */
111
/* AB8500 support */
R
Rabin Vincent 已提交
112
static const int ab8500_irq_regoffset[AB8500_NUM_IRQ_REGS] = {
113
	0, 1, 2, 3, 4, 6, 7, 8, 9, 11, 18, 19, 20, 21,
R
Rabin Vincent 已提交
114 115
};

116 117 118 119 120
/* AB9540 support */
static const int ab9540_irq_regoffset[AB9540_NUM_IRQ_REGS] = {
	0, 1, 2, 3, 4, 6, 7, 8, 9, 11, 18, 19, 20, 21, 12, 13, 24,
};

121 122 123 124 125 126 127
static const char ab8500_version_str[][7] = {
	[AB8500_VERSION_AB8500] = "AB8500",
	[AB8500_VERSION_AB8505] = "AB8505",
	[AB8500_VERSION_AB9540] = "AB9540",
	[AB8500_VERSION_AB8540] = "AB8540",
};

128 129
static int ab8500_get_chip_id(struct device *dev)
{
130 131 132 133 134 135
	struct ab8500 *ab8500;

	if (!dev)
		return -EINVAL;
	ab8500 = dev_get_drvdata(dev->parent);
	return ab8500 ? (int)ab8500->chip_id : -EINVAL;
136 137 138 139
}

static int set_register_interruptible(struct ab8500 *ab8500, u8 bank,
	u8 reg, u8 data)
R
Rabin Vincent 已提交
140 141
{
	int ret;
142 143 144 145 146
	/*
	 * Put the u8 bank and u8 register together into a an u16.
	 * The bank on higher 8 bits and register in lower 8 bits.
	 * */
	u16 addr = ((u16)bank) << 8 | reg;
R
Rabin Vincent 已提交
147 148 149

	dev_vdbg(ab8500->dev, "wr: addr %#x <= %#x\n", addr, data);

150
	mutex_lock(&ab8500->lock);
151

R
Rabin Vincent 已提交
152 153 154 155
	ret = ab8500->write(ab8500, addr, data);
	if (ret < 0)
		dev_err(ab8500->dev, "failed to write reg %#x: %d\n",
			addr, ret);
156
	mutex_unlock(&ab8500->lock);
R
Rabin Vincent 已提交
157 158 159 160

	return ret;
}

161 162
static int ab8500_set_register(struct device *dev, u8 bank,
	u8 reg, u8 value)
R
Rabin Vincent 已提交
163
{
164
	int ret;
165
	struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
R
Rabin Vincent 已提交
166

167 168 169 170
	atomic_inc(&ab8500->transfer_ongoing);
	ret = set_register_interruptible(ab8500, bank, reg, value);
	atomic_dec(&ab8500->transfer_ongoing);
	return ret;
R
Rabin Vincent 已提交
171 172
}

173 174
static int get_register_interruptible(struct ab8500 *ab8500, u8 bank,
	u8 reg, u8 *value)
R
Rabin Vincent 已提交
175 176
{
	int ret;
177 178 179 180
	/* put the u8 bank and u8 reg together into a an u16.
	 * bank on higher 8 bits and reg in lower */
	u16 addr = ((u16)bank) << 8 | reg;

181
	mutex_lock(&ab8500->lock);
R
Rabin Vincent 已提交
182 183 184 185 186

	ret = ab8500->read(ab8500, addr);
	if (ret < 0)
		dev_err(ab8500->dev, "failed to read reg %#x: %d\n",
			addr, ret);
187 188
	else
		*value = ret;
R
Rabin Vincent 已提交
189

190
	mutex_unlock(&ab8500->lock);
R
Rabin Vincent 已提交
191 192 193 194 195
	dev_vdbg(ab8500->dev, "rd: addr %#x => data %#x\n", addr, ret);

	return ret;
}

196 197
static int ab8500_get_register(struct device *dev, u8 bank,
	u8 reg, u8 *value)
R
Rabin Vincent 已提交
198
{
199
	int ret;
200
	struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
R
Rabin Vincent 已提交
201

202 203 204 205
	atomic_inc(&ab8500->transfer_ongoing);
	ret = get_register_interruptible(ab8500, bank, reg, value);
	atomic_dec(&ab8500->transfer_ongoing);
	return ret;
R
Rabin Vincent 已提交
206
}
207 208 209

static int mask_and_set_register_interruptible(struct ab8500 *ab8500, u8 bank,
	u8 reg, u8 bitmask, u8 bitvalues)
R
Rabin Vincent 已提交
210 211
{
	int ret;
212 213 214
	/* put the u8 bank and u8 reg together into a an u16.
	 * bank on higher 8 bits and reg in lower */
	u16 addr = ((u16)bank) << 8 | reg;
R
Rabin Vincent 已提交
215

216
	mutex_lock(&ab8500->lock);
R
Rabin Vincent 已提交
217

218 219
	if (ab8500->write_masked == NULL) {
		u8 data;
R
Rabin Vincent 已提交
220

221 222 223 224 225 226
		ret = ab8500->read(ab8500, addr);
		if (ret < 0) {
			dev_err(ab8500->dev, "failed to read reg %#x: %d\n",
				addr, ret);
			goto out;
		}
R
Rabin Vincent 已提交
227

228 229 230 231 232 233 234
		data = (u8)ret;
		data = (~bitmask & data) | (bitmask & bitvalues);

		ret = ab8500->write(ab8500, addr, data);
		if (ret < 0)
			dev_err(ab8500->dev, "failed to write reg %#x: %d\n",
				addr, ret);
R
Rabin Vincent 已提交
235

236 237 238 239 240 241 242 243
		dev_vdbg(ab8500->dev, "mask: addr %#x => data %#x\n", addr,
			data);
		goto out;
	}
	ret = ab8500->write_masked(ab8500, addr, bitmask, bitvalues);
	if (ret < 0)
		dev_err(ab8500->dev, "failed to modify reg %#x: %d\n", addr,
			ret);
R
Rabin Vincent 已提交
244 245 246 247
out:
	mutex_unlock(&ab8500->lock);
	return ret;
}
248 249 250 251

static int ab8500_mask_and_set_register(struct device *dev,
	u8 bank, u8 reg, u8 bitmask, u8 bitvalues)
{
252
	int ret;
253 254
	struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);

255 256 257 258 259
	atomic_inc(&ab8500->transfer_ongoing);
	ret= mask_and_set_register_interruptible(ab8500, bank, reg,
						 bitmask, bitvalues);
	atomic_dec(&ab8500->transfer_ongoing);
	return ret;
260 261 262 263 264 265 266 267 268 269 270 271
}

static struct abx500_ops ab8500_ops = {
	.get_chip_id = ab8500_get_chip_id,
	.get_register = ab8500_get_register,
	.set_register = ab8500_set_register,
	.get_register_page = NULL,
	.set_register_page = NULL,
	.mask_and_set_register = ab8500_mask_and_set_register,
	.event_registers_startup_state_get = NULL,
	.startup_irq_enabled = NULL,
};
R
Rabin Vincent 已提交
272

273
static void ab8500_irq_lock(struct irq_data *data)
R
Rabin Vincent 已提交
274
{
275
	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
R
Rabin Vincent 已提交
276 277

	mutex_lock(&ab8500->irq_lock);
278
	atomic_inc(&ab8500->transfer_ongoing);
R
Rabin Vincent 已提交
279 280
}

281
static void ab8500_irq_sync_unlock(struct irq_data *data)
R
Rabin Vincent 已提交
282
{
283
	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
R
Rabin Vincent 已提交
284 285
	int i;

286
	for (i = 0; i < ab8500->mask_size; i++) {
R
Rabin Vincent 已提交
287 288 289 290 291 292 293
		u8 old = ab8500->oldmask[i];
		u8 new = ab8500->mask[i];
		int reg;

		if (new == old)
			continue;

294 295 296 297 298 299
		/*
		 * Interrupt register 12 doesn't exist prior to AB8500 version
		 * 2.0
		 */
		if (ab8500->irq_reg_offset[i] == 11 &&
			is_ab8500_1p1_or_earlier(ab8500))
300 301
			continue;

R
Rabin Vincent 已提交
302 303
		ab8500->oldmask[i] = new;

304
		reg = AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i];
305
		set_register_interruptible(ab8500, AB8500_INTERRUPT, reg, new);
R
Rabin Vincent 已提交
306
	}
307
	atomic_dec(&ab8500->transfer_ongoing);
R
Rabin Vincent 已提交
308 309 310
	mutex_unlock(&ab8500->irq_lock);
}

311
static void ab8500_irq_mask(struct irq_data *data)
R
Rabin Vincent 已提交
312
{
313 314
	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
	int offset = data->irq - ab8500->irq_base;
R
Rabin Vincent 已提交
315 316 317 318 319 320
	int index = offset / 8;
	int mask = 1 << (offset % 8);

	ab8500->mask[index] |= mask;
}

321
static void ab8500_irq_unmask(struct irq_data *data)
R
Rabin Vincent 已提交
322
{
323 324
	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
	int offset = data->irq - ab8500->irq_base;
R
Rabin Vincent 已提交
325 326 327 328 329 330 331 332
	int index = offset / 8;
	int mask = 1 << (offset % 8);

	ab8500->mask[index] &= ~mask;
}

static struct irq_chip ab8500_irq_chip = {
	.name			= "ab8500",
333 334 335
	.irq_bus_lock		= ab8500_irq_lock,
	.irq_bus_sync_unlock	= ab8500_irq_sync_unlock,
	.irq_mask		= ab8500_irq_mask,
336
	.irq_disable		= ab8500_irq_mask,
337
	.irq_unmask		= ab8500_irq_unmask,
R
Rabin Vincent 已提交
338 339 340 341 342 343 344 345 346
};

static irqreturn_t ab8500_irq(int irq, void *dev)
{
	struct ab8500 *ab8500 = dev;
	int i;

	dev_vdbg(ab8500->dev, "interrupt\n");

347 348
	atomic_inc(&ab8500->transfer_ongoing);

349 350
	for (i = 0; i < ab8500->mask_size; i++) {
		int regoffset = ab8500->irq_reg_offset[i];
R
Rabin Vincent 已提交
351
		int status;
352
		u8 value;
R
Rabin Vincent 已提交
353

354 355 356 357 358
		/*
		 * Interrupt register 12 doesn't exist prior to AB8500 version
		 * 2.0
		 */
		if (regoffset == 11 && is_ab8500_1p1_or_earlier(ab8500))
359 360
			continue;

361 362 363
		status = get_register_interruptible(ab8500, AB8500_INTERRUPT,
			AB8500_IT_LATCH1_REG + regoffset, &value);
		if (status < 0 || value == 0)
R
Rabin Vincent 已提交
364 365 366
			continue;

		do {
367
			int bit = __ffs(value);
R
Rabin Vincent 已提交
368 369 370
			int line = i * 8 + bit;

			handle_nested_irq(ab8500->irq_base + line);
371
			value &= ~(1 << bit);
372

373
		} while (value);
R
Rabin Vincent 已提交
374
	}
375
	atomic_dec(&ab8500->transfer_ongoing);
R
Rabin Vincent 已提交
376 377 378 379 380 381 382
	return IRQ_HANDLED;
}

static int ab8500_irq_init(struct ab8500 *ab8500)
{
	int base = ab8500->irq_base;
	int irq;
383
	int num_irqs;
R
Rabin Vincent 已提交
384

385 386
	if (is_ab9540(ab8500))
		num_irqs = AB9540_NR_IRQS;
387 388
	else if (is_ab8505(ab8500))
		num_irqs = AB8505_NR_IRQS;
389 390
	else
		num_irqs = AB8500_NR_IRQS;
391 392

	for (irq = base; irq < base + num_irqs; irq++) {
T
Thomas Gleixner 已提交
393 394
		irq_set_chip_data(irq, ab8500);
		irq_set_chip_and_handler(irq, &ab8500_irq_chip,
R
Rabin Vincent 已提交
395
					 handle_simple_irq);
T
Thomas Gleixner 已提交
396
		irq_set_nested_thread(irq, 1);
R
Rabin Vincent 已提交
397 398 399
#ifdef CONFIG_ARM
		set_irq_flags(irq, IRQF_VALID);
#else
T
Thomas Gleixner 已提交
400
		irq_set_noprobe(irq);
R
Rabin Vincent 已提交
401 402 403 404 405 406 407 408 409 410
#endif
	}

	return 0;
}

static void ab8500_irq_remove(struct ab8500 *ab8500)
{
	int base = ab8500->irq_base;
	int irq;
411 412
	int num_irqs;

413 414
	if (is_ab9540(ab8500))
		num_irqs = AB9540_NR_IRQS;
415 416
	else if (is_ab8505(ab8500))
		num_irqs = AB8505_NR_IRQS;
417 418
	else
		num_irqs = AB8500_NR_IRQS;
R
Rabin Vincent 已提交
419

420
	for (irq = base; irq < base + num_irqs; irq++) {
R
Rabin Vincent 已提交
421 422 423
#ifdef CONFIG_ARM
		set_irq_flags(irq, 0);
#endif
T
Thomas Gleixner 已提交
424 425
		irq_set_chip_and_handler(irq, NULL, NULL);
		irq_set_chip_data(irq, NULL);
R
Rabin Vincent 已提交
426 427 428
	}
}

429 430 431 432 433 434 435 436
int ab8500_suspend(struct ab8500 *ab8500)
{
	if (atomic_read(&ab8500->transfer_ongoing))
		return -EINVAL;
	else
		return 0;
}

437
/* AB8500 GPIO Resources */
438
static struct resource __devinitdata ab8500_gpio_resources[] = {
439 440 441 442 443 444 445 446
	{
		.name	= "GPIO_INT6",
		.start	= AB8500_INT_GPIO6R,
		.end	= AB8500_INT_GPIO41F,
		.flags	= IORESOURCE_IRQ,
	}
};

447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468
/* AB9540 GPIO Resources */
static struct resource __devinitdata ab9540_gpio_resources[] = {
	{
		.name	= "GPIO_INT6",
		.start	= AB8500_INT_GPIO6R,
		.end	= AB8500_INT_GPIO41F,
		.flags	= IORESOURCE_IRQ,
	},
	{
		.name	= "GPIO_INT14",
		.start	= AB9540_INT_GPIO50R,
		.end	= AB9540_INT_GPIO54R,
		.flags	= IORESOURCE_IRQ,
	},
	{
		.name	= "GPIO_INT15",
		.start	= AB9540_INT_GPIO50F,
		.end	= AB9540_INT_GPIO54F,
		.flags	= IORESOURCE_IRQ,
	}
};

469
static struct resource __devinitdata ab8500_gpadc_resources[] = {
R
Rabin Vincent 已提交
470 471 472 473 474 475 476 477 478 479 480 481 482 483
	{
		.name	= "HW_CONV_END",
		.start	= AB8500_INT_GP_HW_ADC_CONV_END,
		.end	= AB8500_INT_GP_HW_ADC_CONV_END,
		.flags	= IORESOURCE_IRQ,
	},
	{
		.name	= "SW_CONV_END",
		.start	= AB8500_INT_GP_SW_ADC_CONV_END,
		.end	= AB8500_INT_GP_SW_ADC_CONV_END,
		.flags	= IORESOURCE_IRQ,
	},
};

484
static struct resource __devinitdata ab8500_rtc_resources[] = {
R
Rabin Vincent 已提交
485 486 487 488 489 490 491 492 493 494 495 496 497 498
	{
		.name	= "60S",
		.start	= AB8500_INT_RTC_60S,
		.end	= AB8500_INT_RTC_60S,
		.flags	= IORESOURCE_IRQ,
	},
	{
		.name	= "ALARM",
		.start	= AB8500_INT_RTC_ALARM,
		.end	= AB8500_INT_RTC_ALARM,
		.flags	= IORESOURCE_IRQ,
	},
};

499
static struct resource __devinitdata ab8500_poweronkey_db_resources[] = {
500 501 502 503 504 505 506 507 508 509 510 511 512 513
	{
		.name	= "ONKEY_DBF",
		.start	= AB8500_INT_PON_KEY1DB_F,
		.end	= AB8500_INT_PON_KEY1DB_F,
		.flags	= IORESOURCE_IRQ,
	},
	{
		.name	= "ONKEY_DBR",
		.start	= AB8500_INT_PON_KEY1DB_R,
		.end	= AB8500_INT_PON_KEY1DB_R,
		.flags	= IORESOURCE_IRQ,
	},
};

514
static struct resource __devinitdata ab8500_av_acc_detect_resources[] = {
515
	{
516 517 518 519
	       .name = "ACC_DETECT_1DB_F",
	       .start = AB8500_INT_ACC_DETECT_1DB_F,
	       .end = AB8500_INT_ACC_DETECT_1DB_F,
	       .flags = IORESOURCE_IRQ,
520 521
	},
	{
522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543
	       .name = "ACC_DETECT_1DB_R",
	       .start = AB8500_INT_ACC_DETECT_1DB_R,
	       .end = AB8500_INT_ACC_DETECT_1DB_R,
	       .flags = IORESOURCE_IRQ,
	},
	{
	       .name = "ACC_DETECT_21DB_F",
	       .start = AB8500_INT_ACC_DETECT_21DB_F,
	       .end = AB8500_INT_ACC_DETECT_21DB_F,
	       .flags = IORESOURCE_IRQ,
	},
	{
	       .name = "ACC_DETECT_21DB_R",
	       .start = AB8500_INT_ACC_DETECT_21DB_R,
	       .end = AB8500_INT_ACC_DETECT_21DB_R,
	       .flags = IORESOURCE_IRQ,
	},
	{
	       .name = "ACC_DETECT_22DB_F",
	       .start = AB8500_INT_ACC_DETECT_22DB_F,
	       .end = AB8500_INT_ACC_DETECT_22DB_F,
	       .flags = IORESOURCE_IRQ,
544
	},
545 546 547 548 549 550 551 552 553
	{
	       .name = "ACC_DETECT_22DB_R",
	       .start = AB8500_INT_ACC_DETECT_22DB_R,
	       .end = AB8500_INT_ACC_DETECT_22DB_R,
	       .flags = IORESOURCE_IRQ,
	},
};

static struct resource __devinitdata ab8500_charger_resources[] = {
554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572
	{
		.name = "MAIN_CH_UNPLUG_DET",
		.start = AB8500_INT_MAIN_CH_UNPLUG_DET,
		.end = AB8500_INT_MAIN_CH_UNPLUG_DET,
		.flags = IORESOURCE_IRQ,
	},
	{
		.name = "MAIN_CHARGE_PLUG_DET",
		.start = AB8500_INT_MAIN_CH_PLUG_DET,
		.end = AB8500_INT_MAIN_CH_PLUG_DET,
		.flags = IORESOURCE_IRQ,
	},
	{
		.name = "VBUS_DET_R",
		.start = AB8500_INT_VBUS_DET_R,
		.end = AB8500_INT_VBUS_DET_R,
		.flags = IORESOURCE_IRQ,
	},
	{
573 574 575
		.name = "VBUS_DET_F",
		.start = AB8500_INT_VBUS_DET_F,
		.end = AB8500_INT_VBUS_DET_F,
576 577 578
		.flags = IORESOURCE_IRQ,
	},
	{
579 580 581 582 583
		.name = "USB_LINK_STATUS",
		.start = AB8500_INT_USB_LINK_STATUS,
		.end = AB8500_INT_USB_LINK_STATUS,
		.flags = IORESOURCE_IRQ,
	},
584 585 586 587 588 589 590
	{
		.name = "VBUS_OVV",
		.start = AB8500_INT_VBUS_OVV,
		.end = AB8500_INT_VBUS_OVV,
		.flags = IORESOURCE_IRQ,
	},
	{
591 592 593
		.name = "USB_CH_TH_PROT_R",
		.start = AB8500_INT_USB_CH_TH_PROT_R,
		.end = AB8500_INT_USB_CH_TH_PROT_R,
594 595 596
		.flags = IORESOURCE_IRQ,
	},
	{
597 598 599
		.name = "USB_CH_TH_PROT_F",
		.start = AB8500_INT_USB_CH_TH_PROT_F,
		.end = AB8500_INT_USB_CH_TH_PROT_F,
600 601 602
		.flags = IORESOURCE_IRQ,
	},
	{
603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621
		.name = "MAIN_EXT_CH_NOT_OK",
		.start = AB8500_INT_MAIN_EXT_CH_NOT_OK,
		.end = AB8500_INT_MAIN_EXT_CH_NOT_OK,
		.flags = IORESOURCE_IRQ,
	},
	{
		.name = "MAIN_CH_TH_PROT_R",
		.start = AB8500_INT_MAIN_CH_TH_PROT_R,
		.end = AB8500_INT_MAIN_CH_TH_PROT_R,
		.flags = IORESOURCE_IRQ,
	},
	{
		.name = "MAIN_CH_TH_PROT_F",
		.start = AB8500_INT_MAIN_CH_TH_PROT_F,
		.end = AB8500_INT_MAIN_CH_TH_PROT_F,
		.flags = IORESOURCE_IRQ,
	},
	{
		.name = "USB_CHARGER_NOT_OKR",
622 623
		.start = AB8500_INT_USB_CHARGER_NOT_OKR,
		.end = AB8500_INT_USB_CHARGER_NOT_OKR,
624 625 626 627 628 629 630 631 632 633 634 635 636 637 638
		.flags = IORESOURCE_IRQ,
	},
	{
		.name = "CH_WD_EXP",
		.start = AB8500_INT_CH_WD_EXP,
		.end = AB8500_INT_CH_WD_EXP,
		.flags = IORESOURCE_IRQ,
	},
};

static struct resource __devinitdata ab8500_btemp_resources[] = {
	{
		.name = "BAT_CTRL_INDB",
		.start = AB8500_INT_BAT_CTRL_INDB,
		.end = AB8500_INT_BAT_CTRL_INDB,
639 640 641 642 643 644 645 646 647 648 649 650 651 652 653
		.flags = IORESOURCE_IRQ,
	},
	{
		.name = "BTEMP_LOW",
		.start = AB8500_INT_BTEMP_LOW,
		.end = AB8500_INT_BTEMP_LOW,
		.flags = IORESOURCE_IRQ,
	},
	{
		.name = "BTEMP_HIGH",
		.start = AB8500_INT_BTEMP_HIGH,
		.end = AB8500_INT_BTEMP_HIGH,
		.flags = IORESOURCE_IRQ,
	},
	{
654 655 656
		.name = "BTEMP_LOW_MEDIUM",
		.start = AB8500_INT_BTEMP_LOW_MEDIUM,
		.end = AB8500_INT_BTEMP_LOW_MEDIUM,
657 658 659
		.flags = IORESOURCE_IRQ,
	},
	{
660 661 662
		.name = "BTEMP_MEDIUM_HIGH",
		.start = AB8500_INT_BTEMP_MEDIUM_HIGH,
		.end = AB8500_INT_BTEMP_MEDIUM_HIGH,
663 664
		.flags = IORESOURCE_IRQ,
	},
665 666 667
};

static struct resource __devinitdata ab8500_fg_resources[] = {
668
	{
669 670 671
		.name = "NCONV_ACCU",
		.start = AB8500_INT_CCN_CONV_ACC,
		.end = AB8500_INT_CCN_CONV_ACC,
672 673 674
		.flags = IORESOURCE_IRQ,
	},
	{
675 676 677
		.name = "BATT_OVV",
		.start = AB8500_INT_BATT_OVV,
		.end = AB8500_INT_BATT_OVV,
678 679 680
		.flags = IORESOURCE_IRQ,
	},
	{
681 682 683 684 685 686 687 688 689 690 691 692 693 694 695
		.name = "LOW_BAT_F",
		.start = AB8500_INT_LOW_BAT_F,
		.end = AB8500_INT_LOW_BAT_F,
		.flags = IORESOURCE_IRQ,
	},
	{
		.name = "LOW_BAT_R",
		.start = AB8500_INT_LOW_BAT_R,
		.end = AB8500_INT_LOW_BAT_R,
		.flags = IORESOURCE_IRQ,
	},
	{
		.name = "CC_INT_CALIB",
		.start = AB8500_INT_CC_INT_CALIB,
		.end = AB8500_INT_CC_INT_CALIB,
696 697
		.flags = IORESOURCE_IRQ,
	},
698 699 700 701 702 703
	{
		.name = "CCEOC",
		.start = AB8500_INT_CCEOC,
		.end = AB8500_INT_CCEOC,
		.flags = IORESOURCE_IRQ,
	},
704 705
};

706 707
static struct resource __devinitdata ab8500_chargalg_resources[] = {};

708
#ifdef CONFIG_DEBUG_FS
709
static struct resource __devinitdata ab8500_debug_resources[] = {
710 711 712 713 714 715 716 717
	{
		.name	= "IRQ_FIRST",
		.start	= AB8500_INT_MAIN_EXT_CH_NOT_OK,
		.end	= AB8500_INT_MAIN_EXT_CH_NOT_OK,
		.flags	= IORESOURCE_IRQ,
	},
	{
		.name	= "IRQ_LAST",
718 719
		.start	= AB8500_INT_XTAL32K_KO,
		.end	= AB8500_INT_XTAL32K_KO,
720 721 722
		.flags	= IORESOURCE_IRQ,
	},
};
723
#endif
724

725
static struct resource __devinitdata ab8500_usb_resources[] = {
726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749
	{
		.name = "ID_WAKEUP_R",
		.start = AB8500_INT_ID_WAKEUP_R,
		.end = AB8500_INT_ID_WAKEUP_R,
		.flags = IORESOURCE_IRQ,
	},
	{
		.name = "ID_WAKEUP_F",
		.start = AB8500_INT_ID_WAKEUP_F,
		.end = AB8500_INT_ID_WAKEUP_F,
		.flags = IORESOURCE_IRQ,
	},
	{
		.name = "VBUS_DET_F",
		.start = AB8500_INT_VBUS_DET_F,
		.end = AB8500_INT_VBUS_DET_F,
		.flags = IORESOURCE_IRQ,
	},
	{
		.name = "VBUS_DET_R",
		.start = AB8500_INT_VBUS_DET_R,
		.end = AB8500_INT_VBUS_DET_R,
		.flags = IORESOURCE_IRQ,
	},
750 751 752 753 754 755
	{
		.name = "USB_LINK_STATUS",
		.start = AB8500_INT_USB_LINK_STATUS,
		.end = AB8500_INT_USB_LINK_STATUS,
		.flags = IORESOURCE_IRQ,
	},
756 757 758 759 760 761 762 763 764 765 766 767
	{
		.name = "USB_ADP_PROBE_PLUG",
		.start = AB8500_INT_ADP_PROBE_PLUG,
		.end = AB8500_INT_ADP_PROBE_PLUG,
		.flags = IORESOURCE_IRQ,
	},
	{
		.name = "USB_ADP_PROBE_UNPLUG",
		.start = AB8500_INT_ADP_PROBE_UNPLUG,
		.end = AB8500_INT_ADP_PROBE_UNPLUG,
		.flags = IORESOURCE_IRQ,
	},
768 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
static struct resource __devinitdata ab8505_iddet_resources[] = {
	{
		.name  = "KeyDeglitch",
		.start = AB8505_INT_KEYDEGLITCH,
		.end   = AB8505_INT_KEYDEGLITCH,
		.flags = IORESOURCE_IRQ,
	},
	{
		.name  = "KP",
		.start = AB8505_INT_KP,
		.end   = AB8505_INT_KP,
		.flags = IORESOURCE_IRQ,
	},
	{
		.name  = "IKP",
		.start = AB8505_INT_IKP,
		.end   = AB8505_INT_IKP,
		.flags = IORESOURCE_IRQ,
	},
	{
		.name  = "IKR",
		.start = AB8505_INT_IKR,
		.end   = AB8505_INT_IKR,
		.flags = IORESOURCE_IRQ,
	},
	{
		.name  = "KeyStuck",
		.start = AB8505_INT_KEYSTUCK,
		.end   = AB8505_INT_KEYSTUCK,
		.flags = IORESOURCE_IRQ,
	},
};

803
static struct resource __devinitdata ab8500_temp_resources[] = {
804 805 806 807 808 809 810 811
	{
		.name  = "AB8500_TEMP_WARM",
		.start = AB8500_INT_TEMP_WARM,
		.end   = AB8500_INT_TEMP_WARM,
		.flags = IORESOURCE_IRQ,
	},
};

812
static struct mfd_cell __devinitdata abx500_common_devs[] = {
M
Mattias Wallin 已提交
813 814 815
#ifdef CONFIG_DEBUG_FS
	{
		.name = "ab8500-debug",
816 817
		.num_resources = ARRAY_SIZE(ab8500_debug_resources),
		.resources = ab8500_debug_resources,
M
Mattias Wallin 已提交
818 819
	},
#endif
820 821 822 823 824 825
	{
		.name = "ab8500-sysctrl",
	},
	{
		.name = "ab8500-regulator",
	},
R
Rabin Vincent 已提交
826 827 828 829 830 831 832 833 834 835
	{
		.name = "ab8500-gpadc",
		.num_resources = ARRAY_SIZE(ab8500_gpadc_resources),
		.resources = ab8500_gpadc_resources,
	},
	{
		.name = "ab8500-rtc",
		.num_resources = ARRAY_SIZE(ab8500_rtc_resources),
		.resources = ab8500_rtc_resources,
	},
836
	{
837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860
		.name = "ab8500-charger",
		.num_resources = ARRAY_SIZE(ab8500_charger_resources),
		.resources = ab8500_charger_resources,
	},
	{
		.name = "ab8500-btemp",
		.num_resources = ARRAY_SIZE(ab8500_btemp_resources),
		.resources = ab8500_btemp_resources,
	},
	{
		.name = "ab8500-fg",
		.num_resources = ARRAY_SIZE(ab8500_fg_resources),
		.resources = ab8500_fg_resources,
	},
	{
		.name = "ab8500-chargalg",
		.num_resources = ARRAY_SIZE(ab8500_chargalg_resources),
		.resources = ab8500_chargalg_resources,
	},
	{
		.name = "ab8500-acc-det",
		.num_resources = ARRAY_SIZE(ab8500_av_acc_detect_resources),
		.resources = ab8500_av_acc_detect_resources,
	},
861 862 863 864 865
	{
		.name = "ab8500-poweron-key",
		.num_resources = ARRAY_SIZE(ab8500_poweronkey_db_resources),
		.resources = ab8500_poweronkey_db_resources,
	},
A
Arun Murthy 已提交
866 867 868 869 870 871 872 873 874 875 876 877
	{
		.name = "ab8500-pwm",
		.id = 1,
	},
	{
		.name = "ab8500-pwm",
		.id = 2,
	},
	{
		.name = "ab8500-pwm",
		.id = 3,
	},
878
	{ .name = "ab8500-leds", },
879
	{
880 881 882 883 884 885
		.name = "ab8500-denc",
	},
	{
		.name = "ab8500-temp",
		.num_resources = ARRAY_SIZE(ab8500_temp_resources),
		.resources = ab8500_temp_resources,
886
	},
R
Rabin Vincent 已提交
887 888
};

889 890 891 892 893 894 895 896 897 898 899
static struct mfd_cell __devinitdata ab8500_devs[] = {
	{
		.name = "ab8500-gpio",
		.num_resources = ARRAY_SIZE(ab8500_gpio_resources),
		.resources = ab8500_gpio_resources,
	},
	{
		.name = "ab8500-usb",
		.num_resources = ARRAY_SIZE(ab8500_usb_resources),
		.resources = ab8500_usb_resources,
	},
900 901 902
	{
		.name = "ab8500-codec",
	},
903 904 905 906 907 908 909 910 911 912 913 914 915
};

static struct mfd_cell __devinitdata ab9540_devs[] = {
	{
		.name = "ab8500-gpio",
		.num_resources = ARRAY_SIZE(ab9540_gpio_resources),
		.resources = ab9540_gpio_resources,
	},
	{
		.name = "ab9540-usb",
		.num_resources = ARRAY_SIZE(ab8500_usb_resources),
		.resources = ab8500_usb_resources,
	},
916 917 918 919 920 921 922 923 924 925 926 927
	{
		.name = "ab9540-codec",
	},
};

/* Device list common to ab9540 and ab8505 */
static struct mfd_cell __devinitdata ab9540_ab8505_devs[] = {
	{
		.name = "ab-iddet",
		.num_resources = ARRAY_SIZE(ab8505_iddet_resources),
		.resources = ab8505_iddet_resources,
	},
928 929
};

930 931 932 933 934 935 936 937 938
static ssize_t show_chip_id(struct device *dev,
				struct device_attribute *attr, char *buf)
{
	struct ab8500 *ab8500;

	ab8500 = dev_get_drvdata(dev);
	return sprintf(buf, "%#x\n", ab8500 ? ab8500->chip_id : -EINVAL);
}

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
/*
 * ab8500 has switched off due to (SWITCH_OFF_STATUS):
 * 0x01 Swoff bit programming
 * 0x02 Thermal protection activation
 * 0x04 Vbat lower then BattOk falling threshold
 * 0x08 Watchdog expired
 * 0x10 Non presence of 32kHz clock
 * 0x20 Battery level lower than power on reset threshold
 * 0x40 Power on key 1 pressed longer than 10 seconds
 * 0x80 DB8500 thermal shutdown
 */
static ssize_t show_switch_off_status(struct device *dev,
				struct device_attribute *attr, char *buf)
{
	int ret;
	u8 value;
	struct ab8500 *ab8500;

	ab8500 = dev_get_drvdata(dev);
	ret = get_register_interruptible(ab8500, AB8500_RTC,
		AB8500_SWITCH_OFF_STATUS, &value);
	if (ret < 0)
		return ret;
	return sprintf(buf, "%#x\n", value);
}

965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990
/*
 * ab8500 has turned on due to (TURN_ON_STATUS):
 * 0x01 PORnVbat
 * 0x02 PonKey1dbF
 * 0x04 PonKey2dbF
 * 0x08 RTCAlarm
 * 0x10 MainChDet
 * 0x20 VbusDet
 * 0x40 UsbIDDetect
 * 0x80 Reserved
 */
static ssize_t show_turn_on_status(struct device *dev,
				struct device_attribute *attr, char *buf)
{
	int ret;
	u8 value;
	struct ab8500 *ab8500;

	ab8500 = dev_get_drvdata(dev);
	ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
		AB8500_TURN_ON_STATUS, &value);
	if (ret < 0)
		return ret;
	return sprintf(buf, "%#x\n", value);
}

991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043
static ssize_t show_ab9540_dbbrstn(struct device *dev,
				struct device_attribute *attr, char *buf)
{
	struct ab8500 *ab8500;
	int ret;
	u8 value;

	ab8500 = dev_get_drvdata(dev);

	ret = get_register_interruptible(ab8500, AB8500_REGU_CTRL2,
		AB9540_MODEM_CTRL2_REG, &value);
	if (ret < 0)
		return ret;

	return sprintf(buf, "%d\n",
			(value & AB9540_MODEM_CTRL2_SWDBBRSTN_BIT) ? 1 : 0);
}

static ssize_t store_ab9540_dbbrstn(struct device *dev,
	struct device_attribute *attr, const char *buf, size_t count)
{
	struct ab8500 *ab8500;
	int ret = count;
	int err;
	u8 bitvalues;

	ab8500 = dev_get_drvdata(dev);

	if (count > 0) {
		switch (buf[0]) {
		case '0':
			bitvalues = 0;
			break;
		case '1':
			bitvalues = AB9540_MODEM_CTRL2_SWDBBRSTN_BIT;
			break;
		default:
			goto exit;
		}

		err = mask_and_set_register_interruptible(ab8500,
			AB8500_REGU_CTRL2, AB9540_MODEM_CTRL2_REG,
			AB9540_MODEM_CTRL2_SWDBBRSTN_BIT, bitvalues);
		if (err)
			dev_info(ab8500->dev,
				"Failed to set DBBRSTN %c, err %#x\n",
				buf[0], err);
	}

exit:
	return ret;
}

1044
static DEVICE_ATTR(chip_id, S_IRUGO, show_chip_id, NULL);
1045
static DEVICE_ATTR(switch_off_status, S_IRUGO, show_switch_off_status, NULL);
1046
static DEVICE_ATTR(turn_on_status, S_IRUGO, show_turn_on_status, NULL);
1047 1048
static DEVICE_ATTR(dbbrstn, S_IRUGO | S_IWUSR,
			show_ab9540_dbbrstn, store_ab9540_dbbrstn);
1049 1050 1051

static struct attribute *ab8500_sysfs_entries[] = {
	&dev_attr_chip_id.attr,
1052
	&dev_attr_switch_off_status.attr,
1053
	&dev_attr_turn_on_status.attr,
1054 1055 1056
	NULL,
};

1057 1058 1059 1060 1061 1062 1063 1064
static struct attribute *ab9540_sysfs_entries[] = {
	&dev_attr_chip_id.attr,
	&dev_attr_switch_off_status.attr,
	&dev_attr_turn_on_status.attr,
	&dev_attr_dbbrstn.attr,
	NULL,
};

1065 1066 1067 1068
static struct attribute_group ab8500_attr_group = {
	.attrs	= ab8500_sysfs_entries,
};

1069 1070 1071 1072
static struct attribute_group ab9540_attr_group = {
	.attrs	= ab9540_sysfs_entries,
};

1073
int __devinit ab8500_init(struct ab8500 *ab8500, enum ab8500_version version)
R
Rabin Vincent 已提交
1074 1075 1076 1077
{
	struct ab8500_platform_data *plat = dev_get_platdata(ab8500->dev);
	int ret;
	int i;
1078
	u8 value;
R
Rabin Vincent 已提交
1079 1080 1081 1082 1083 1084

	if (plat)
		ab8500->irq_base = plat->irq_base;

	mutex_init(&ab8500->lock);
	mutex_init(&ab8500->irq_lock);
1085
	atomic_set(&ab8500->transfer_ongoing, 0);
R
Rabin Vincent 已提交
1086

1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097
	if (version != AB8500_VERSION_UNDEFINED)
		ab8500->version = version;
	else {
		ret = get_register_interruptible(ab8500, AB8500_MISC,
			AB8500_IC_NAME_REG, &value);
		if (ret < 0)
			return ret;

		ab8500->version = value;
	}

1098 1099
	ret = get_register_interruptible(ab8500, AB8500_MISC,
		AB8500_REV_REG, &value);
R
Rabin Vincent 已提交
1100 1101 1102
	if (ret < 0)
		return ret;

1103
	ab8500->chip_id = value;
R
Rabin Vincent 已提交
1104

1105 1106 1107 1108 1109
	dev_info(ab8500->dev, "detected chip, %s rev. %1x.%1x\n",
			ab8500_version_str[ab8500->version],
			ab8500->chip_id >> 4,
			ab8500->chip_id & 0x0F);

1110
	/* Configure AB8500 or AB9540 IRQ */
1111
	if (is_ab9540(ab8500) || is_ab8505(ab8500)) {
1112 1113 1114 1115 1116 1117
		ab8500->mask_size = AB9540_NUM_IRQ_REGS;
		ab8500->irq_reg_offset = ab9540_irq_regoffset;
	} else {
		ab8500->mask_size = AB8500_NUM_IRQ_REGS;
		ab8500->irq_reg_offset = ab8500_irq_regoffset;
	}
1118 1119 1120 1121 1122 1123 1124 1125
	ab8500->mask = kzalloc(ab8500->mask_size, GFP_KERNEL);
	if (!ab8500->mask)
		return -ENOMEM;
	ab8500->oldmask = kzalloc(ab8500->mask_size, GFP_KERNEL);
	if (!ab8500->oldmask) {
		ret = -ENOMEM;
		goto out_freemask;
	}
1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143
	/*
	 * ab8500 has switched off due to (SWITCH_OFF_STATUS):
	 * 0x01 Swoff bit programming
	 * 0x02 Thermal protection activation
	 * 0x04 Vbat lower then BattOk falling threshold
	 * 0x08 Watchdog expired
	 * 0x10 Non presence of 32kHz clock
	 * 0x20 Battery level lower than power on reset threshold
	 * 0x40 Power on key 1 pressed longer than 10 seconds
	 * 0x80 DB8500 thermal shutdown
	 */

	ret = get_register_interruptible(ab8500, AB8500_RTC,
		AB8500_SWITCH_OFF_STATUS, &value);
	if (ret < 0)
		return ret;
	dev_info(ab8500->dev, "switch off status: %#x", value);

R
Rabin Vincent 已提交
1144 1145 1146 1147
	if (plat && plat->init)
		plat->init(ab8500);

	/* Clear and mask all interrupts */
1148
	for (i = 0; i < ab8500->mask_size; i++) {
1149 1150 1151 1152 1153 1154
		/*
		 * Interrupt register 12 doesn't exist prior to AB8500 version
		 * 2.0
		 */
		if (ab8500->irq_reg_offset[i] == 11 &&
				is_ab8500_1p1_or_earlier(ab8500))
1155
			continue;
R
Rabin Vincent 已提交
1156

1157
		get_register_interruptible(ab8500, AB8500_INTERRUPT,
1158
			AB8500_IT_LATCH1_REG + ab8500->irq_reg_offset[i],
1159
			&value);
1160
		set_register_interruptible(ab8500, AB8500_INTERRUPT,
1161
			AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i], 0xff);
R
Rabin Vincent 已提交
1162 1163
	}

1164 1165
	ret = abx500_register_ops(ab8500->dev, &ab8500_ops);
	if (ret)
1166
		goto out_freeoldmask;
1167

1168
	for (i = 0; i < ab8500->mask_size; i++)
R
Rabin Vincent 已提交
1169 1170 1171 1172 1173
		ab8500->mask[i] = ab8500->oldmask[i] = 0xff;

	if (ab8500->irq_base) {
		ret = ab8500_irq_init(ab8500);
		if (ret)
1174
			goto out_freeoldmask;
R
Rabin Vincent 已提交
1175 1176

		ret = request_threaded_irq(ab8500->irq, NULL, ab8500_irq,
1177 1178
					   IRQF_ONESHOT | IRQF_NO_SUSPEND,
					   "ab8500", ab8500);
R
Rabin Vincent 已提交
1179 1180 1181 1182
		if (ret)
			goto out_removeirq;
	}

1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195
	ret = mfd_add_devices(ab8500->dev, 0, abx500_common_devs,
			      ARRAY_SIZE(abx500_common_devs), NULL,
			      ab8500->irq_base);

	if (ret)
		goto out_freeirq;

	if (is_ab9540(ab8500))
		ret = mfd_add_devices(ab8500->dev, 0, ab9540_devs,
			      ARRAY_SIZE(ab9540_devs), NULL,
			      ab8500->irq_base);
	else
		ret = mfd_add_devices(ab8500->dev, 0, ab8500_devs,
1196 1197 1198 1199 1200 1201
			      ARRAY_SIZE(ab8500_devs), NULL,
			      ab8500->irq_base);

	if (is_ab9540(ab8500) || is_ab8505(ab8500))
		ret = mfd_add_devices(ab8500->dev, 0, ab9540_ab8505_devs,
			      ARRAY_SIZE(ab9540_ab8505_devs), NULL,
R
Rabin Vincent 已提交
1202
			      ab8500->irq_base);
1203

R
Rabin Vincent 已提交
1204 1205 1206
	if (ret)
		goto out_freeirq;

1207 1208 1209 1210 1211 1212
	if (is_ab9540(ab8500))
		ret = sysfs_create_group(&ab8500->dev->kobj,
					&ab9540_attr_group);
	else
		ret = sysfs_create_group(&ab8500->dev->kobj,
					&ab8500_attr_group);
1213 1214
	if (ret)
		dev_err(ab8500->dev, "error creating sysfs entries\n");
1215 1216
	else
		return ret;
R
Rabin Vincent 已提交
1217 1218

out_freeirq:
L
Linus Walleij 已提交
1219
	if (ab8500->irq_base)
R
Rabin Vincent 已提交
1220 1221
		free_irq(ab8500->irq, ab8500);
out_removeirq:
L
Linus Walleij 已提交
1222
	if (ab8500->irq_base)
R
Rabin Vincent 已提交
1223
		ab8500_irq_remove(ab8500);
1224 1225 1226 1227
out_freeoldmask:
	kfree(ab8500->oldmask);
out_freemask:
	kfree(ab8500->mask);
L
Linus Walleij 已提交
1228

R
Rabin Vincent 已提交
1229 1230 1231 1232 1233
	return ret;
}

int __devexit ab8500_exit(struct ab8500 *ab8500)
{
1234 1235 1236 1237
	if (is_ab9540(ab8500))
		sysfs_remove_group(&ab8500->dev->kobj, &ab9540_attr_group);
	else
		sysfs_remove_group(&ab8500->dev->kobj, &ab8500_attr_group);
R
Rabin Vincent 已提交
1238 1239 1240 1241 1242
	mfd_remove_devices(ab8500->dev);
	if (ab8500->irq_base) {
		free_irq(ab8500->irq, ab8500);
		ab8500_irq_remove(ab8500);
	}
1243 1244
	kfree(ab8500->oldmask);
	kfree(ab8500->mask);
R
Rabin Vincent 已提交
1245 1246 1247 1248

	return 0;
}

1249
MODULE_AUTHOR("Mattias Wallin, Srinidhi Kasagar, Rabin Vincent");
R
Rabin Vincent 已提交
1250 1251
MODULE_DESCRIPTION("AB8500 MFD core");
MODULE_LICENSE("GPL v2");