Linux Audio

Check our new training course

Embedded Linux training

Mar 31-Apr 8, 2025
Register
Loading...
v5.9
   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 * Copyright (C) ST-Ericsson SA 2010
   4 *
 
   5 * Author: Srinidhi Kasagar <srinidhi.kasagar@stericsson.com>
   6 * Author: Rabin Vincent <rabin.vincent@stericsson.com>
   7 * Author: Mattias Wallin <mattias.wallin@stericsson.com>
   8 */
   9
  10#include <linux/kernel.h>
  11#include <linux/slab.h>
  12#include <linux/init.h>
  13#include <linux/irq.h>
  14#include <linux/irqdomain.h>
  15#include <linux/delay.h>
  16#include <linux/interrupt.h>
  17#include <linux/moduleparam.h>
  18#include <linux/platform_device.h>
  19#include <linux/mfd/core.h>
  20#include <linux/mfd/abx500.h>
  21#include <linux/mfd/abx500/ab8500.h>
  22#include <linux/mfd/abx500/ab8500-bm.h>
  23#include <linux/mfd/dbx500-prcmu.h>
  24#include <linux/regulator/ab8500.h>
  25#include <linux/of.h>
  26#include <linux/of_device.h>
  27
  28/*
  29 * Interrupt register offsets
  30 * Bank : 0x0E
  31 */
  32#define AB8500_IT_SOURCE1_REG		0x00
  33#define AB8500_IT_SOURCE2_REG		0x01
  34#define AB8500_IT_SOURCE3_REG		0x02
  35#define AB8500_IT_SOURCE4_REG		0x03
  36#define AB8500_IT_SOURCE5_REG		0x04
  37#define AB8500_IT_SOURCE6_REG		0x05
  38#define AB8500_IT_SOURCE7_REG		0x06
  39#define AB8500_IT_SOURCE8_REG		0x07
  40#define AB9540_IT_SOURCE13_REG		0x0C
  41#define AB8500_IT_SOURCE19_REG		0x12
  42#define AB8500_IT_SOURCE20_REG		0x13
  43#define AB8500_IT_SOURCE21_REG		0x14
  44#define AB8500_IT_SOURCE22_REG		0x15
  45#define AB8500_IT_SOURCE23_REG		0x16
  46#define AB8500_IT_SOURCE24_REG		0x17
  47
  48/*
  49 * latch registers
  50 */
  51#define AB8500_IT_LATCH1_REG		0x20
  52#define AB8500_IT_LATCH2_REG		0x21
  53#define AB8500_IT_LATCH3_REG		0x22
  54#define AB8500_IT_LATCH4_REG		0x23
  55#define AB8500_IT_LATCH5_REG		0x24
  56#define AB8500_IT_LATCH6_REG		0x25
  57#define AB8500_IT_LATCH7_REG		0x26
  58#define AB8500_IT_LATCH8_REG		0x27
  59#define AB8500_IT_LATCH9_REG		0x28
  60#define AB8500_IT_LATCH10_REG		0x29
  61#define AB8500_IT_LATCH12_REG		0x2B
  62#define AB9540_IT_LATCH13_REG		0x2C
  63#define AB8500_IT_LATCH19_REG		0x32
  64#define AB8500_IT_LATCH20_REG		0x33
  65#define AB8500_IT_LATCH21_REG		0x34
  66#define AB8500_IT_LATCH22_REG		0x35
  67#define AB8500_IT_LATCH23_REG		0x36
  68#define AB8500_IT_LATCH24_REG		0x37
  69
  70/*
  71 * mask registers
  72 */
  73
  74#define AB8500_IT_MASK1_REG		0x40
  75#define AB8500_IT_MASK2_REG		0x41
  76#define AB8500_IT_MASK3_REG		0x42
  77#define AB8500_IT_MASK4_REG		0x43
  78#define AB8500_IT_MASK5_REG		0x44
  79#define AB8500_IT_MASK6_REG		0x45
  80#define AB8500_IT_MASK7_REG		0x46
  81#define AB8500_IT_MASK8_REG		0x47
  82#define AB8500_IT_MASK9_REG		0x48
  83#define AB8500_IT_MASK10_REG		0x49
  84#define AB8500_IT_MASK11_REG		0x4A
  85#define AB8500_IT_MASK12_REG		0x4B
  86#define AB8500_IT_MASK13_REG		0x4C
  87#define AB8500_IT_MASK14_REG		0x4D
  88#define AB8500_IT_MASK15_REG		0x4E
  89#define AB8500_IT_MASK16_REG		0x4F
  90#define AB8500_IT_MASK17_REG		0x50
  91#define AB8500_IT_MASK18_REG		0x51
  92#define AB8500_IT_MASK19_REG		0x52
  93#define AB8500_IT_MASK20_REG		0x53
  94#define AB8500_IT_MASK21_REG		0x54
  95#define AB8500_IT_MASK22_REG		0x55
  96#define AB8500_IT_MASK23_REG		0x56
  97#define AB8500_IT_MASK24_REG		0x57
  98#define AB8500_IT_MASK25_REG		0x58
  99
 100/*
 101 * latch hierarchy registers
 102 */
 103#define AB8500_IT_LATCHHIER1_REG	0x60
 104#define AB8500_IT_LATCHHIER2_REG	0x61
 105#define AB8500_IT_LATCHHIER3_REG	0x62
 106#define AB8540_IT_LATCHHIER4_REG	0x63
 107
 108#define AB8500_IT_LATCHHIER_NUM		3
 109#define AB8540_IT_LATCHHIER_NUM		4
 110
 111#define AB8500_REV_REG			0x80
 112#define AB8500_IC_NAME_REG		0x82
 113#define AB8500_SWITCH_OFF_STATUS	0x00
 114
 115#define AB8500_TURN_ON_STATUS		0x00
 116#define AB8505_TURN_ON_STATUS_2		0x04
 117
 118#define AB8500_CH_USBCH_STAT1_REG	0x02
 119#define VBUS_DET_DBNC100		0x02
 120#define VBUS_DET_DBNC1			0x01
 121
 122static DEFINE_SPINLOCK(on_stat_lock);
 123static u8 turn_on_stat_mask = 0xFF;
 124static u8 turn_on_stat_set;
 125static bool no_bm; /* No battery management */
 126/*
 127 * not really modular, but the easiest way to keep compat with existing
 128 * bootargs behaviour is to continue using module_param here.
 129 */
 130module_param(no_bm, bool, S_IRUGO);
 131
 132#define AB9540_MODEM_CTRL2_REG			0x23
 133#define AB9540_MODEM_CTRL2_SWDBBRSTN_BIT	BIT(2)
 134
 135/*
 136 * Map interrupt numbers to the LATCH and MASK register offsets, Interrupt
 137 * numbers are indexed into this array with (num / 8). The interupts are
 138 * defined in linux/mfd/ab8500.h
 139 *
 140 * This is one off from the register names, i.e. AB8500_IT_MASK1_REG is at
 141 * offset 0.
 142 */
 143/* AB8500 support */
 144static const int ab8500_irq_regoffset[AB8500_NUM_IRQ_REGS] = {
 145	0, 1, 2, 3, 4, 6, 7, 8, 9, 11, 18, 19, 20, 21,
 146};
 147
 148/* AB9540 / AB8505 support */
 149static const int ab9540_irq_regoffset[AB9540_NUM_IRQ_REGS] = {
 150	0, 1, 2, 3, 4, 6, 7, 8, 9, 11, 18, 19, 20, 21, 12, 13, 24, 5, 22, 23
 151};
 152
 153/* AB8540 support */
 154static const int ab8540_irq_regoffset[AB8540_NUM_IRQ_REGS] = {
 155	0, 1, 2, 3, 4, -1, -1, -1, -1, 11, 18, 19, 20, 21, 12, 13, 24, 5, 22,
 156	23, 25, 26, 27, 28, 29, 30, 31,
 157};
 158
 159static const char ab8500_version_str[][7] = {
 160	[AB8500_VERSION_AB8500] = "AB8500",
 161	[AB8500_VERSION_AB8505] = "AB8505",
 162	[AB8500_VERSION_AB9540] = "AB9540",
 163	[AB8500_VERSION_AB8540] = "AB8540",
 164};
 165
 166static int ab8500_prcmu_write(struct ab8500 *ab8500, u16 addr, u8 data)
 167{
 168	int ret;
 169
 170	ret = prcmu_abb_write((u8)(addr >> 8), (u8)(addr & 0xFF), &data, 1);
 171	if (ret < 0)
 172		dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
 173	return ret;
 174}
 175
 176static int ab8500_prcmu_write_masked(struct ab8500 *ab8500, u16 addr, u8 mask,
 177	u8 data)
 178{
 179	int ret;
 180
 181	ret = prcmu_abb_write_masked((u8)(addr >> 8), (u8)(addr & 0xFF), &data,
 182		&mask, 1);
 183	if (ret < 0)
 184		dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
 185	return ret;
 186}
 187
 188static int ab8500_prcmu_read(struct ab8500 *ab8500, u16 addr)
 189{
 190	int ret;
 191	u8 data;
 192
 193	ret = prcmu_abb_read((u8)(addr >> 8), (u8)(addr & 0xFF), &data, 1);
 194	if (ret < 0) {
 195		dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
 196		return ret;
 197	}
 198	return (int)data;
 199}
 200
 201static int ab8500_get_chip_id(struct device *dev)
 202{
 203	struct ab8500 *ab8500;
 204
 205	if (!dev)
 206		return -EINVAL;
 207	ab8500 = dev_get_drvdata(dev->parent);
 208	return ab8500 ? (int)ab8500->chip_id : -EINVAL;
 209}
 210
 211static int set_register_interruptible(struct ab8500 *ab8500, u8 bank,
 212	u8 reg, u8 data)
 213{
 214	int ret;
 215	/*
 216	 * Put the u8 bank and u8 register together into a an u16.
 217	 * The bank on higher 8 bits and register in lower 8 bits.
 218	 */
 219	u16 addr = ((u16)bank) << 8 | reg;
 220
 221	dev_vdbg(ab8500->dev, "wr: addr %#x <= %#x\n", addr, data);
 222
 223	mutex_lock(&ab8500->lock);
 224
 225	ret = ab8500->write(ab8500, addr, data);
 226	if (ret < 0)
 227		dev_err(ab8500->dev, "failed to write reg %#x: %d\n",
 228			addr, ret);
 229	mutex_unlock(&ab8500->lock);
 230
 231	return ret;
 232}
 233
 234static int ab8500_set_register(struct device *dev, u8 bank,
 235	u8 reg, u8 value)
 236{
 237	int ret;
 238	struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
 239
 240	atomic_inc(&ab8500->transfer_ongoing);
 241	ret = set_register_interruptible(ab8500, bank, reg, value);
 242	atomic_dec(&ab8500->transfer_ongoing);
 243	return ret;
 244}
 245
 246static int get_register_interruptible(struct ab8500 *ab8500, u8 bank,
 247	u8 reg, u8 *value)
 248{
 249	int ret;
 
 
 250	u16 addr = ((u16)bank) << 8 | reg;
 251
 252	mutex_lock(&ab8500->lock);
 253
 254	ret = ab8500->read(ab8500, addr);
 255	if (ret < 0)
 256		dev_err(ab8500->dev, "failed to read reg %#x: %d\n",
 257			addr, ret);
 258	else
 259		*value = ret;
 260
 261	mutex_unlock(&ab8500->lock);
 262	dev_vdbg(ab8500->dev, "rd: addr %#x => data %#x\n", addr, ret);
 263
 264	return (ret < 0) ? ret : 0;
 265}
 266
 267static int ab8500_get_register(struct device *dev, u8 bank,
 268	u8 reg, u8 *value)
 269{
 270	int ret;
 271	struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
 272
 273	atomic_inc(&ab8500->transfer_ongoing);
 274	ret = get_register_interruptible(ab8500, bank, reg, value);
 275	atomic_dec(&ab8500->transfer_ongoing);
 276	return ret;
 277}
 278
 279static int mask_and_set_register_interruptible(struct ab8500 *ab8500, u8 bank,
 280	u8 reg, u8 bitmask, u8 bitvalues)
 281{
 282	int ret;
 
 
 283	u16 addr = ((u16)bank) << 8 | reg;
 284
 285	mutex_lock(&ab8500->lock);
 286
 287	if (ab8500->write_masked == NULL) {
 288		u8 data;
 289
 290		ret = ab8500->read(ab8500, addr);
 291		if (ret < 0) {
 292			dev_err(ab8500->dev, "failed to read reg %#x: %d\n",
 293				addr, ret);
 294			goto out;
 295		}
 296
 297		data = (u8)ret;
 298		data = (~bitmask & data) | (bitmask & bitvalues);
 299
 300		ret = ab8500->write(ab8500, addr, data);
 301		if (ret < 0)
 302			dev_err(ab8500->dev, "failed to write reg %#x: %d\n",
 303				addr, ret);
 304
 305		dev_vdbg(ab8500->dev, "mask: addr %#x => data %#x\n", addr,
 306			data);
 307		goto out;
 308	}
 309	ret = ab8500->write_masked(ab8500, addr, bitmask, bitvalues);
 310	if (ret < 0)
 311		dev_err(ab8500->dev, "failed to modify reg %#x: %d\n", addr,
 312			ret);
 313out:
 314	mutex_unlock(&ab8500->lock);
 315	return ret;
 316}
 317
 318static int ab8500_mask_and_set_register(struct device *dev,
 319	u8 bank, u8 reg, u8 bitmask, u8 bitvalues)
 320{
 321	int ret;
 322	struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
 323
 324	atomic_inc(&ab8500->transfer_ongoing);
 325	ret = mask_and_set_register_interruptible(ab8500, bank, reg,
 326						 bitmask, bitvalues);
 327	atomic_dec(&ab8500->transfer_ongoing);
 328	return ret;
 329}
 330
 331static struct abx500_ops ab8500_ops = {
 332	.get_chip_id = ab8500_get_chip_id,
 333	.get_register = ab8500_get_register,
 334	.set_register = ab8500_set_register,
 335	.get_register_page = NULL,
 336	.set_register_page = NULL,
 337	.mask_and_set_register = ab8500_mask_and_set_register,
 338	.event_registers_startup_state_get = NULL,
 339	.startup_irq_enabled = NULL,
 340	.dump_all_banks = ab8500_dump_all_banks,
 341};
 342
 343static void ab8500_irq_lock(struct irq_data *data)
 344{
 345	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
 346
 347	mutex_lock(&ab8500->irq_lock);
 348	atomic_inc(&ab8500->transfer_ongoing);
 349}
 350
 351static void ab8500_irq_sync_unlock(struct irq_data *data)
 352{
 353	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
 354	int i;
 355
 356	for (i = 0; i < ab8500->mask_size; i++) {
 357		u8 old = ab8500->oldmask[i];
 358		u8 new = ab8500->mask[i];
 359		int reg;
 360
 361		if (new == old)
 362			continue;
 363
 364		/*
 365		 * Interrupt register 12 doesn't exist prior to AB8500 version
 366		 * 2.0
 367		 */
 368		if (ab8500->irq_reg_offset[i] == 11 &&
 369			is_ab8500_1p1_or_earlier(ab8500))
 370			continue;
 371
 372		if (ab8500->irq_reg_offset[i] < 0)
 373			continue;
 374
 375		ab8500->oldmask[i] = new;
 376
 377		reg = AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i];
 378		set_register_interruptible(ab8500, AB8500_INTERRUPT, reg, new);
 379	}
 380	atomic_dec(&ab8500->transfer_ongoing);
 381	mutex_unlock(&ab8500->irq_lock);
 382}
 383
 384static void ab8500_irq_mask(struct irq_data *data)
 385{
 386	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
 387	int offset = data->hwirq;
 388	int index = offset / 8;
 389	int mask = 1 << (offset % 8);
 390
 391	ab8500->mask[index] |= mask;
 392
 393	/* The AB8500 GPIOs have two interrupts each (rising & falling). */
 394	if (offset >= AB8500_INT_GPIO6R && offset <= AB8500_INT_GPIO41R)
 395		ab8500->mask[index + 2] |= mask;
 396	if (offset >= AB9540_INT_GPIO50R && offset <= AB9540_INT_GPIO54R)
 397		ab8500->mask[index + 1] |= mask;
 398	if (offset == AB8540_INT_GPIO43R || offset == AB8540_INT_GPIO44R)
 399		/* Here the falling IRQ is one bit lower */
 400		ab8500->mask[index] |= (mask << 1);
 401}
 402
 403static void ab8500_irq_unmask(struct irq_data *data)
 404{
 405	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
 406	unsigned int type = irqd_get_trigger_type(data);
 407	int offset = data->hwirq;
 408	int index = offset / 8;
 409	int mask = 1 << (offset % 8);
 410
 411	if (type & IRQ_TYPE_EDGE_RISING)
 412		ab8500->mask[index] &= ~mask;
 413
 414	/* The AB8500 GPIOs have two interrupts each (rising & falling). */
 415	if (type & IRQ_TYPE_EDGE_FALLING) {
 416		if (offset >= AB8500_INT_GPIO6R && offset <= AB8500_INT_GPIO41R)
 417			ab8500->mask[index + 2] &= ~mask;
 418		else if (offset >= AB9540_INT_GPIO50R &&
 419			 offset <= AB9540_INT_GPIO54R)
 420			ab8500->mask[index + 1] &= ~mask;
 421		else if (offset == AB8540_INT_GPIO43R ||
 422			 offset == AB8540_INT_GPIO44R)
 423			/* Here the falling IRQ is one bit lower */
 424			ab8500->mask[index] &= ~(mask << 1);
 425		else
 426			ab8500->mask[index] &= ~mask;
 427	} else {
 428		/* Satisfies the case where type is not set. */
 429		ab8500->mask[index] &= ~mask;
 430	}
 431}
 432
 433static int ab8500_irq_set_type(struct irq_data *data, unsigned int type)
 434{
 435	return 0;
 436}
 437
 438static struct irq_chip ab8500_irq_chip = {
 439	.name			= "ab8500",
 440	.irq_bus_lock		= ab8500_irq_lock,
 441	.irq_bus_sync_unlock	= ab8500_irq_sync_unlock,
 442	.irq_mask		= ab8500_irq_mask,
 443	.irq_disable		= ab8500_irq_mask,
 444	.irq_unmask		= ab8500_irq_unmask,
 445	.irq_set_type		= ab8500_irq_set_type,
 446};
 447
 448static void update_latch_offset(u8 *offset, int i)
 449{
 450	/* Fix inconsistent ITFromLatch25 bit mapping... */
 451	if (unlikely(*offset == 17))
 452		*offset = 24;
 453	/* Fix inconsistent ab8540 bit mapping... */
 454	if (unlikely(*offset == 16))
 455		*offset = 25;
 456	if ((i == 3) && (*offset >= 24))
 457		*offset += 2;
 458}
 459
 460static int ab8500_handle_hierarchical_line(struct ab8500 *ab8500,
 461					int latch_offset, u8 latch_val)
 462{
 463	int int_bit, line, i;
 464
 465	for (i = 0; i < ab8500->mask_size; i++)
 466		if (ab8500->irq_reg_offset[i] == latch_offset)
 467			break;
 468
 469	if (i >= ab8500->mask_size) {
 470		dev_err(ab8500->dev, "Register offset 0x%2x not declared\n",
 471				latch_offset);
 472		return -ENXIO;
 473	}
 474
 475	/* ignore masked out interrupts */
 476	latch_val &= ~ab8500->mask[i];
 477
 478	while (latch_val) {
 479		int_bit = __ffs(latch_val);
 480		line = (i << 3) + int_bit;
 481		latch_val &= ~(1 << int_bit);
 482
 483		/*
 484		 * This handles the falling edge hwirqs from the GPIO
 485		 * lines. Route them back to the line registered for the
 486		 * rising IRQ, as this is merely a flag for the same IRQ
 487		 * in linux terms.
 488		 */
 489		if (line >= AB8500_INT_GPIO6F && line <= AB8500_INT_GPIO41F)
 490			line -= 16;
 491		if (line >= AB9540_INT_GPIO50F && line <= AB9540_INT_GPIO54F)
 492			line -= 8;
 493		if (line == AB8540_INT_GPIO43F || line == AB8540_INT_GPIO44F)
 494			line += 1;
 495
 496		handle_nested_irq(irq_create_mapping(ab8500->domain, line));
 497	}
 498
 499	return 0;
 500}
 501
 502static int ab8500_handle_hierarchical_latch(struct ab8500 *ab8500,
 503					int hier_offset, u8 hier_val)
 504{
 505	int latch_bit, status;
 506	u8 latch_offset, latch_val;
 507
 508	do {
 509		latch_bit = __ffs(hier_val);
 510		latch_offset = (hier_offset << 3) + latch_bit;
 511
 512		update_latch_offset(&latch_offset, hier_offset);
 513
 514		status = get_register_interruptible(ab8500,
 515				AB8500_INTERRUPT,
 516				AB8500_IT_LATCH1_REG + latch_offset,
 517				&latch_val);
 518		if (status < 0 || latch_val == 0)
 519			goto discard;
 520
 521		status = ab8500_handle_hierarchical_line(ab8500,
 522				latch_offset, latch_val);
 523		if (status < 0)
 524			return status;
 525discard:
 526		hier_val &= ~(1 << latch_bit);
 527	} while (hier_val);
 528
 529	return 0;
 530}
 531
 532static irqreturn_t ab8500_hierarchical_irq(int irq, void *dev)
 533{
 534	struct ab8500 *ab8500 = dev;
 535	u8 i;
 536
 537	dev_vdbg(ab8500->dev, "interrupt\n");
 538
 539	/*  Hierarchical interrupt version */
 540	for (i = 0; i < (ab8500->it_latchhier_num); i++) {
 541		int status;
 542		u8 hier_val;
 543
 544		status = get_register_interruptible(ab8500, AB8500_INTERRUPT,
 545			AB8500_IT_LATCHHIER1_REG + i, &hier_val);
 546		if (status < 0 || hier_val == 0)
 547			continue;
 548
 549		status = ab8500_handle_hierarchical_latch(ab8500, i, hier_val);
 550		if (status < 0)
 551			break;
 552	}
 553	return IRQ_HANDLED;
 554}
 555
 556static int ab8500_irq_map(struct irq_domain *d, unsigned int virq,
 557				irq_hw_number_t hwirq)
 558{
 559	struct ab8500 *ab8500 = d->host_data;
 560
 561	if (!ab8500)
 562		return -EINVAL;
 563
 564	irq_set_chip_data(virq, ab8500);
 565	irq_set_chip_and_handler(virq, &ab8500_irq_chip,
 566				handle_simple_irq);
 567	irq_set_nested_thread(virq, 1);
 
 
 
 568	irq_set_noprobe(virq);
 
 569
 570	return 0;
 571}
 572
 573static const struct irq_domain_ops ab8500_irq_ops = {
 574	.map    = ab8500_irq_map,
 575	.xlate  = irq_domain_xlate_twocell,
 576};
 577
 578static int ab8500_irq_init(struct ab8500 *ab8500, struct device_node *np)
 579{
 580	int num_irqs;
 581
 582	if (is_ab8540(ab8500))
 583		num_irqs = AB8540_NR_IRQS;
 584	else if (is_ab9540(ab8500))
 585		num_irqs = AB9540_NR_IRQS;
 586	else if (is_ab8505(ab8500))
 587		num_irqs = AB8505_NR_IRQS;
 588	else
 589		num_irqs = AB8500_NR_IRQS;
 590
 591	/* If ->irq_base is zero this will give a linear mapping */
 592	ab8500->domain = irq_domain_add_simple(ab8500->dev->of_node,
 593					       num_irqs, 0,
 594					       &ab8500_irq_ops, ab8500);
 595
 596	if (!ab8500->domain) {
 597		dev_err(ab8500->dev, "Failed to create irqdomain\n");
 598		return -ENODEV;
 599	}
 600
 601	return 0;
 602}
 603
 604int ab8500_suspend(struct ab8500 *ab8500)
 605{
 606	if (atomic_read(&ab8500->transfer_ongoing))
 607		return -EINVAL;
 608
 609	return 0;
 610}
 611
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 612static const struct mfd_cell ab8500_bm_devs[] = {
 613	OF_MFD_CELL("ab8500-charger", NULL, &ab8500_bm_data,
 614		    sizeof(ab8500_bm_data), 0, "stericsson,ab8500-charger"),
 615	OF_MFD_CELL("ab8500-btemp", NULL, &ab8500_bm_data,
 616		    sizeof(ab8500_bm_data), 0, "stericsson,ab8500-btemp"),
 617	OF_MFD_CELL("ab8500-fg", NULL, &ab8500_bm_data,
 618		    sizeof(ab8500_bm_data), 0, "stericsson,ab8500-fg"),
 619	OF_MFD_CELL("ab8500-chargalg", NULL, &ab8500_bm_data,
 620		    sizeof(ab8500_bm_data), 0, "stericsson,ab8500-chargalg"),
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 621};
 622
 623static const struct mfd_cell ab8500_devs[] = {
 624#ifdef CONFIG_DEBUG_FS
 625	OF_MFD_CELL("ab8500-debug",
 626		    NULL, NULL, 0, 0, "stericsson,ab8500-debug"),
 
 
 
 
 627#endif
 628	OF_MFD_CELL("ab8500-sysctrl",
 629		    NULL, NULL, 0, 0, "stericsson,ab8500-sysctrl"),
 630	OF_MFD_CELL("ab8500-ext-regulator",
 631		    NULL, NULL, 0, 0, "stericsson,ab8500-ext-regulator"),
 632	OF_MFD_CELL("ab8500-regulator",
 633		    NULL, NULL, 0, 0, "stericsson,ab8500-regulator"),
 634	OF_MFD_CELL("ab8500-clk",
 635		    NULL, NULL, 0, 0, "stericsson,ab8500-clk"),
 636	OF_MFD_CELL("ab8500-gpadc",
 637		    NULL, NULL, 0, 0, "stericsson,ab8500-gpadc"),
 638	OF_MFD_CELL("ab8500-rtc",
 639		    NULL, NULL, 0, 0, "stericsson,ab8500-rtc"),
 640	OF_MFD_CELL("ab8500-acc-det",
 641		    NULL, NULL, 0, 0, "stericsson,ab8500-acc-det"),
 642	OF_MFD_CELL("ab8500-poweron-key",
 643		    NULL, NULL, 0, 0, "stericsson,ab8500-poweron-key"),
 644	OF_MFD_CELL("ab8500-pwm",
 645		    NULL, NULL, 0, 1, "stericsson,ab8500-pwm"),
 646	OF_MFD_CELL("ab8500-pwm",
 647		    NULL, NULL, 0, 2, "stericsson,ab8500-pwm"),
 648	OF_MFD_CELL("ab8500-pwm",
 649		    NULL, NULL, 0, 3, "stericsson,ab8500-pwm"),
 650	OF_MFD_CELL("ab8500-denc",
 651		    NULL, NULL, 0, 0, "stericsson,ab8500-denc"),
 652	OF_MFD_CELL("pinctrl-ab8500",
 653		    NULL, NULL, 0, 0, "stericsson,ab8500-gpio"),
 654	OF_MFD_CELL("abx500-temp",
 655		    NULL, NULL, 0, 0, "stericsson,abx500-temp"),
 656	OF_MFD_CELL("ab8500-usb",
 657		    NULL, NULL, 0, 0, "stericsson,ab8500-usb"),
 658	OF_MFD_CELL("ab8500-codec",
 659		    NULL, NULL, 0, 0, "stericsson,ab8500-codec"),
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 660};
 661
 662static const struct mfd_cell ab9540_devs[] = {
 663#ifdef CONFIG_DEBUG_FS
 664	{
 665		.name = "ab8500-debug",
 
 
 666	},
 667#endif
 668	{
 669		.name = "ab8500-sysctrl",
 670	},
 671	{
 672		.name = "ab8500-ext-regulator",
 673	},
 674	{
 675		.name = "ab8500-regulator",
 676	},
 677	{
 678		.name = "abx500-clk",
 679		.of_compatible = "stericsson,abx500-clk",
 680	},
 681	{
 682		.name = "ab8500-gpadc",
 683		.of_compatible = "stericsson,ab8500-gpadc",
 
 
 684	},
 685	{
 686		.name = "ab8500-rtc",
 
 
 687	},
 688	{
 689		.name = "ab8500-acc-det",
 
 
 690	},
 691	{
 692		.name = "ab8500-poweron-key",
 
 
 693	},
 694	{
 695		.name = "ab8500-pwm",
 696		.id = 1,
 697	},
 698	{
 699		.name = "abx500-temp",
 
 
 700	},
 701	{
 702		.name = "pinctrl-ab9540",
 703		.of_compatible = "stericsson,ab9540-gpio",
 704	},
 705	{
 706		.name = "ab9540-usb",
 
 
 707	},
 708	{
 709		.name = "ab9540-codec",
 710	},
 711	{
 712		.name = "ab-iddet",
 
 
 713	},
 714};
 715
 716/* Device list for ab8505  */
 717static const struct mfd_cell ab8505_devs[] = {
 718#ifdef CONFIG_DEBUG_FS
 719	{
 720		.name = "ab8500-debug",
 721		.of_compatible = "stericsson,ab8500-debug",
 
 722	},
 723#endif
 724	{
 725		.name = "ab8500-sysctrl",
 726		.of_compatible = "stericsson,ab8500-sysctrl",
 727	},
 728	{
 729		.name = "ab8500-regulator",
 730		.of_compatible = "stericsson,ab8505-regulator",
 731	},
 732	{
 733		.name = "abx500-clk",
 734		.of_compatible = "stericsson,ab8500-clk",
 735	},
 736	{
 737		.name = "ab8500-gpadc",
 738		.of_compatible = "stericsson,ab8500-gpadc",
 
 
 739	},
 740	{
 741		.name = "ab8500-rtc",
 742		.of_compatible = "stericsson,ab8500-rtc",
 
 743	},
 744	{
 745		.name = "ab8500-acc-det",
 746		.of_compatible = "stericsson,ab8500-acc-det",
 
 747	},
 748	{
 749		.name = "ab8500-poweron-key",
 750		.of_compatible = "stericsson,ab8500-poweron-key",
 
 751	},
 752	{
 753		.name = "ab8500-pwm",
 754		.of_compatible = "stericsson,ab8500-pwm",
 755		.id = 1,
 756	},
 757	{
 758		.name = "pinctrl-ab8505",
 759		.of_compatible = "stericsson,ab8505-gpio",
 760	},
 761	{
 762		.name = "ab8500-usb",
 763		.of_compatible = "stericsson,ab8500-usb",
 
 764	},
 765	{
 766		.name = "ab8500-codec",
 767		.of_compatible = "stericsson,ab8500-codec",
 768	},
 769	{
 770		.name = "ab-iddet",
 
 
 771	},
 772};
 773
 774static const struct mfd_cell ab8540_devs[] = {
 775#ifdef CONFIG_DEBUG_FS
 776	{
 777		.name = "ab8500-debug",
 
 
 778	},
 779#endif
 780	{
 781		.name = "ab8500-sysctrl",
 782	},
 783	{
 784		.name = "ab8500-ext-regulator",
 785	},
 786	{
 787		.name = "ab8500-regulator",
 788	},
 789	{
 790		.name = "abx500-clk",
 791		.of_compatible = "stericsson,abx500-clk",
 792	},
 793	{
 794		.name = "ab8500-gpadc",
 795		.of_compatible = "stericsson,ab8500-gpadc",
 
 
 796	},
 797	{
 798		.name = "ab8500-acc-det",
 
 
 799	},
 800	{
 801		.name = "ab8500-poweron-key",
 
 
 802	},
 803	{
 804		.name = "ab8500-pwm",
 805		.id = 1,
 806	},
 807	{
 808		.name = "abx500-temp",
 
 
 809	},
 810	{
 811		.name = "pinctrl-ab8540",
 812	},
 813	{
 814		.name = "ab8540-usb",
 
 
 815	},
 816	{
 817		.name = "ab8540-codec",
 818	},
 819	{
 820		.name = "ab-iddet",
 
 
 821	},
 822};
 823
 824static const struct mfd_cell ab8540_cut1_devs[] = {
 825	{
 826		.name = "ab8500-rtc",
 827		.of_compatible = "stericsson,ab8500-rtc",
 
 
 828	},
 829};
 830
 831static const struct mfd_cell ab8540_cut2_devs[] = {
 832	{
 833		.name = "ab8540-rtc",
 834		.of_compatible = "stericsson,ab8540-rtc",
 
 
 835	},
 836};
 837
 838static ssize_t show_chip_id(struct device *dev,
 839				struct device_attribute *attr, char *buf)
 840{
 841	struct ab8500 *ab8500;
 842
 843	ab8500 = dev_get_drvdata(dev);
 844
 845	return sprintf(buf, "%#x\n", ab8500 ? ab8500->chip_id : -EINVAL);
 846}
 847
 848/*
 849 * ab8500 has switched off due to (SWITCH_OFF_STATUS):
 850 * 0x01 Swoff bit programming
 851 * 0x02 Thermal protection activation
 852 * 0x04 Vbat lower then BattOk falling threshold
 853 * 0x08 Watchdog expired
 854 * 0x10 Non presence of 32kHz clock
 855 * 0x20 Battery level lower than power on reset threshold
 856 * 0x40 Power on key 1 pressed longer than 10 seconds
 857 * 0x80 DB8500 thermal shutdown
 858 */
 859static ssize_t show_switch_off_status(struct device *dev,
 860				struct device_attribute *attr, char *buf)
 861{
 862	int ret;
 863	u8 value;
 864	struct ab8500 *ab8500;
 865
 866	ab8500 = dev_get_drvdata(dev);
 867	ret = get_register_interruptible(ab8500, AB8500_RTC,
 868		AB8500_SWITCH_OFF_STATUS, &value);
 869	if (ret < 0)
 870		return ret;
 871	return sprintf(buf, "%#x\n", value);
 872}
 873
 874/* use mask and set to override the register turn_on_stat value */
 875void ab8500_override_turn_on_stat(u8 mask, u8 set)
 876{
 877	spin_lock(&on_stat_lock);
 878	turn_on_stat_mask = mask;
 879	turn_on_stat_set = set;
 880	spin_unlock(&on_stat_lock);
 881}
 882
 883/*
 884 * ab8500 has turned on due to (TURN_ON_STATUS):
 885 * 0x01 PORnVbat
 886 * 0x02 PonKey1dbF
 887 * 0x04 PonKey2dbF
 888 * 0x08 RTCAlarm
 889 * 0x10 MainChDet
 890 * 0x20 VbusDet
 891 * 0x40 UsbIDDetect
 892 * 0x80 Reserved
 893 */
 894static ssize_t show_turn_on_status(struct device *dev,
 895				struct device_attribute *attr, char *buf)
 896{
 897	int ret;
 898	u8 value;
 899	struct ab8500 *ab8500;
 900
 901	ab8500 = dev_get_drvdata(dev);
 902	ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
 903		AB8500_TURN_ON_STATUS, &value);
 904	if (ret < 0)
 905		return ret;
 906
 907	/*
 908	 * In L9540, turn_on_status register is not updated correctly if
 909	 * the device is rebooted with AC/USB charger connected. Due to
 910	 * this, the device boots android instead of entering into charge
 911	 * only mode. Read the AC/USB status register to detect the charger
 912	 * presence and update the turn on status manually.
 913	 */
 914	if (is_ab9540(ab8500)) {
 915		spin_lock(&on_stat_lock);
 916		value = (value & turn_on_stat_mask) | turn_on_stat_set;
 917		spin_unlock(&on_stat_lock);
 918	}
 919
 920	return sprintf(buf, "%#x\n", value);
 921}
 922
 923static ssize_t show_turn_on_status_2(struct device *dev,
 924				struct device_attribute *attr, char *buf)
 925{
 926	int ret;
 927	u8 value;
 928	struct ab8500 *ab8500;
 929
 930	ab8500 = dev_get_drvdata(dev);
 931	ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
 932		AB8505_TURN_ON_STATUS_2, &value);
 933	if (ret < 0)
 934		return ret;
 935	return sprintf(buf, "%#x\n", (value & 0x1));
 936}
 937
 938static ssize_t show_ab9540_dbbrstn(struct device *dev,
 939				struct device_attribute *attr, char *buf)
 940{
 941	struct ab8500 *ab8500;
 942	int ret;
 943	u8 value;
 944
 945	ab8500 = dev_get_drvdata(dev);
 946
 947	ret = get_register_interruptible(ab8500, AB8500_REGU_CTRL2,
 948		AB9540_MODEM_CTRL2_REG, &value);
 949	if (ret < 0)
 950		return ret;
 951
 952	return sprintf(buf, "%d\n",
 953			(value & AB9540_MODEM_CTRL2_SWDBBRSTN_BIT) ? 1 : 0);
 954}
 955
 956static ssize_t store_ab9540_dbbrstn(struct device *dev,
 957	struct device_attribute *attr, const char *buf, size_t count)
 958{
 959	struct ab8500 *ab8500;
 960	int ret = count;
 961	int err;
 962	u8 bitvalues;
 963
 964	ab8500 = dev_get_drvdata(dev);
 965
 966	if (count > 0) {
 967		switch (buf[0]) {
 968		case '0':
 969			bitvalues = 0;
 970			break;
 971		case '1':
 972			bitvalues = AB9540_MODEM_CTRL2_SWDBBRSTN_BIT;
 973			break;
 974		default:
 975			goto exit;
 976		}
 977
 978		err = mask_and_set_register_interruptible(ab8500,
 979			AB8500_REGU_CTRL2, AB9540_MODEM_CTRL2_REG,
 980			AB9540_MODEM_CTRL2_SWDBBRSTN_BIT, bitvalues);
 981		if (err)
 982			dev_info(ab8500->dev,
 983				"Failed to set DBBRSTN %c, err %#x\n",
 984				buf[0], err);
 985	}
 986
 987exit:
 988	return ret;
 989}
 990
 991static DEVICE_ATTR(chip_id, S_IRUGO, show_chip_id, NULL);
 992static DEVICE_ATTR(switch_off_status, S_IRUGO, show_switch_off_status, NULL);
 993static DEVICE_ATTR(turn_on_status, S_IRUGO, show_turn_on_status, NULL);
 994static DEVICE_ATTR(turn_on_status_2, S_IRUGO, show_turn_on_status_2, NULL);
 995static DEVICE_ATTR(dbbrstn, S_IRUGO | S_IWUSR,
 996			show_ab9540_dbbrstn, store_ab9540_dbbrstn);
 997
 998static struct attribute *ab8500_sysfs_entries[] = {
 999	&dev_attr_chip_id.attr,
1000	&dev_attr_switch_off_status.attr,
1001	&dev_attr_turn_on_status.attr,
1002	NULL,
1003};
1004
1005static struct attribute *ab8505_sysfs_entries[] = {
1006	&dev_attr_turn_on_status_2.attr,
1007	NULL,
1008};
1009
1010static struct attribute *ab9540_sysfs_entries[] = {
1011	&dev_attr_chip_id.attr,
1012	&dev_attr_switch_off_status.attr,
1013	&dev_attr_turn_on_status.attr,
1014	&dev_attr_dbbrstn.attr,
1015	NULL,
1016};
1017
1018static const struct attribute_group ab8500_attr_group = {
1019	.attrs	= ab8500_sysfs_entries,
1020};
1021
1022static const struct attribute_group ab8505_attr_group = {
1023	.attrs	= ab8505_sysfs_entries,
1024};
1025
1026static const struct attribute_group ab9540_attr_group = {
1027	.attrs	= ab9540_sysfs_entries,
1028};
1029
1030static int ab8500_probe(struct platform_device *pdev)
1031{
1032	static const char * const switch_off_status[] = {
1033		"Swoff bit programming",
1034		"Thermal protection activation",
1035		"Vbat lower then BattOk falling threshold",
1036		"Watchdog expired",
1037		"Non presence of 32kHz clock",
1038		"Battery level lower than power on reset threshold",
1039		"Power on key 1 pressed longer than 10 seconds",
1040		"DB8500 thermal shutdown"};
1041	static const char * const turn_on_status[] = {
1042		"Battery rising (Vbat)",
1043		"Power On Key 1 dbF",
1044		"Power On Key 2 dbF",
1045		"RTC Alarm",
1046		"Main Charger Detect",
1047		"Vbus Detect (USB)",
1048		"USB ID Detect",
1049		"UART Factory Mode Detect"};
 
1050	const struct platform_device_id *platid = platform_get_device_id(pdev);
1051	enum ab8500_version version = AB8500_VERSION_UNDEFINED;
1052	struct device_node *np = pdev->dev.of_node;
1053	struct ab8500 *ab8500;
1054	struct resource *resource;
1055	int ret;
1056	int i;
1057	u8 value;
1058
1059	ab8500 = devm_kzalloc(&pdev->dev, sizeof(*ab8500), GFP_KERNEL);
1060	if (!ab8500)
1061		return -ENOMEM;
1062
1063	ab8500->dev = &pdev->dev;
1064
1065	resource = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
1066	if (!resource) {
1067		dev_err(&pdev->dev, "no IRQ resource\n");
1068		return -ENODEV;
1069	}
1070
1071	ab8500->irq = resource->start;
1072
1073	ab8500->read = ab8500_prcmu_read;
1074	ab8500->write = ab8500_prcmu_write;
1075	ab8500->write_masked = ab8500_prcmu_write_masked;
1076
1077	mutex_init(&ab8500->lock);
1078	mutex_init(&ab8500->irq_lock);
1079	atomic_set(&ab8500->transfer_ongoing, 0);
1080
1081	platform_set_drvdata(pdev, ab8500);
1082
1083	if (platid)
1084		version = platid->driver_data;
1085
1086	if (version != AB8500_VERSION_UNDEFINED)
1087		ab8500->version = version;
1088	else {
1089		ret = get_register_interruptible(ab8500, AB8500_MISC,
1090			AB8500_IC_NAME_REG, &value);
1091		if (ret < 0) {
1092			dev_err(&pdev->dev, "could not probe HW\n");
1093			return ret;
1094		}
1095
1096		ab8500->version = value;
1097	}
1098
1099	ret = get_register_interruptible(ab8500, AB8500_MISC,
1100		AB8500_REV_REG, &value);
1101	if (ret < 0)
1102		return ret;
1103
1104	ab8500->chip_id = value;
1105
1106	dev_info(ab8500->dev, "detected chip, %s rev. %1x.%1x\n",
1107			ab8500_version_str[ab8500->version],
1108			ab8500->chip_id >> 4,
1109			ab8500->chip_id & 0x0F);
1110
1111	/* Configure AB8540 */
1112	if (is_ab8540(ab8500)) {
1113		ab8500->mask_size = AB8540_NUM_IRQ_REGS;
1114		ab8500->irq_reg_offset = ab8540_irq_regoffset;
1115		ab8500->it_latchhier_num = AB8540_IT_LATCHHIER_NUM;
1116	} /* Configure AB8500 or AB9540 IRQ */
1117	else if (is_ab9540(ab8500) || is_ab8505(ab8500)) {
1118		ab8500->mask_size = AB9540_NUM_IRQ_REGS;
1119		ab8500->irq_reg_offset = ab9540_irq_regoffset;
1120		ab8500->it_latchhier_num = AB8500_IT_LATCHHIER_NUM;
1121	} else {
1122		ab8500->mask_size = AB8500_NUM_IRQ_REGS;
1123		ab8500->irq_reg_offset = ab8500_irq_regoffset;
1124		ab8500->it_latchhier_num = AB8500_IT_LATCHHIER_NUM;
1125	}
1126	ab8500->mask = devm_kzalloc(&pdev->dev, ab8500->mask_size,
1127				    GFP_KERNEL);
1128	if (!ab8500->mask)
1129		return -ENOMEM;
1130	ab8500->oldmask = devm_kzalloc(&pdev->dev, ab8500->mask_size,
1131				       GFP_KERNEL);
1132	if (!ab8500->oldmask)
1133		return -ENOMEM;
1134
1135	/*
1136	 * ab8500 has switched off due to (SWITCH_OFF_STATUS):
1137	 * 0x01 Swoff bit programming
1138	 * 0x02 Thermal protection activation
1139	 * 0x04 Vbat lower then BattOk falling threshold
1140	 * 0x08 Watchdog expired
1141	 * 0x10 Non presence of 32kHz clock
1142	 * 0x20 Battery level lower than power on reset threshold
1143	 * 0x40 Power on key 1 pressed longer than 10 seconds
1144	 * 0x80 DB8500 thermal shutdown
1145	 */
1146
1147	ret = get_register_interruptible(ab8500, AB8500_RTC,
1148		AB8500_SWITCH_OFF_STATUS, &value);
1149	if (ret < 0)
1150		return ret;
1151	dev_info(ab8500->dev, "switch off cause(s) (%#x): ", value);
1152
1153	if (value) {
1154		for (i = 0; i < ARRAY_SIZE(switch_off_status); i++) {
1155			if (value & 1)
1156				pr_cont(" \"%s\"", switch_off_status[i]);
 
1157			value = value >> 1;
1158
1159		}
1160		pr_cont("\n");
1161	} else {
1162		pr_cont(" None\n");
1163	}
1164	ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
1165		AB8500_TURN_ON_STATUS, &value);
1166	if (ret < 0)
1167		return ret;
1168	dev_info(ab8500->dev, "turn on reason(s) (%#x): ", value);
1169
1170	if (value) {
1171		for (i = 0; i < ARRAY_SIZE(turn_on_status); i++) {
1172			if (value & 1)
1173				pr_cont("\"%s\" ", turn_on_status[i]);
1174			value = value >> 1;
1175		}
1176		pr_cont("\n");
1177	} else {
1178		pr_cont("None\n");
1179	}
1180
 
 
 
1181	if (is_ab9540(ab8500)) {
1182		ret = get_register_interruptible(ab8500, AB8500_CHARGER,
1183			AB8500_CH_USBCH_STAT1_REG, &value);
1184		if (ret < 0)
1185			return ret;
1186		if ((value & VBUS_DET_DBNC1) && (value & VBUS_DET_DBNC100))
1187			ab8500_override_turn_on_stat(~AB8500_POW_KEY_1_ON,
1188						     AB8500_VBUS_DET);
1189	}
1190
1191	/* Clear and mask all interrupts */
1192	for (i = 0; i < ab8500->mask_size; i++) {
1193		/*
1194		 * Interrupt register 12 doesn't exist prior to AB8500 version
1195		 * 2.0
1196		 */
1197		if (ab8500->irq_reg_offset[i] == 11 &&
1198				is_ab8500_1p1_or_earlier(ab8500))
1199			continue;
1200
1201		if (ab8500->irq_reg_offset[i] < 0)
1202			continue;
1203
1204		get_register_interruptible(ab8500, AB8500_INTERRUPT,
1205			AB8500_IT_LATCH1_REG + ab8500->irq_reg_offset[i],
1206			&value);
1207		set_register_interruptible(ab8500, AB8500_INTERRUPT,
1208			AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i], 0xff);
1209	}
1210
1211	ret = abx500_register_ops(ab8500->dev, &ab8500_ops);
1212	if (ret)
1213		return ret;
1214
1215	for (i = 0; i < ab8500->mask_size; i++)
1216		ab8500->mask[i] = ab8500->oldmask[i] = 0xff;
1217
1218	ret = ab8500_irq_init(ab8500, np);
1219	if (ret)
1220		return ret;
1221
1222	ret = devm_request_threaded_irq(&pdev->dev, ab8500->irq, NULL,
1223			ab8500_hierarchical_irq,
1224			IRQF_ONESHOT | IRQF_NO_SUSPEND,
1225			"ab8500", ab8500);
1226	if (ret)
1227		return ret;
1228
 
 
 
 
 
 
1229	if (is_ab9540(ab8500))
1230		ret = mfd_add_devices(ab8500->dev, 0, ab9540_devs,
1231				ARRAY_SIZE(ab9540_devs), NULL,
1232				0, ab8500->domain);
1233	else if (is_ab8540(ab8500)) {
1234		ret = mfd_add_devices(ab8500->dev, 0, ab8540_devs,
1235			      ARRAY_SIZE(ab8540_devs), NULL,
1236			      0, ab8500->domain);
1237		if (ret)
1238			return ret;
1239
1240		if (is_ab8540_1p2_or_earlier(ab8500))
1241			ret = mfd_add_devices(ab8500->dev, 0, ab8540_cut1_devs,
1242			      ARRAY_SIZE(ab8540_cut1_devs), NULL,
1243			      0, ab8500->domain);
1244		else /* ab8540 >= cut2 */
1245			ret = mfd_add_devices(ab8500->dev, 0, ab8540_cut2_devs,
1246			      ARRAY_SIZE(ab8540_cut2_devs), NULL,
1247			      0, ab8500->domain);
1248	} else if (is_ab8505(ab8500))
1249		ret = mfd_add_devices(ab8500->dev, 0, ab8505_devs,
1250			      ARRAY_SIZE(ab8505_devs), NULL,
1251			      0, ab8500->domain);
1252	else
1253		ret = mfd_add_devices(ab8500->dev, 0, ab8500_devs,
1254				ARRAY_SIZE(ab8500_devs), NULL,
1255				0, ab8500->domain);
1256	if (ret)
1257		return ret;
1258
1259	if (!no_bm) {
1260		/* Add battery management devices */
1261		ret = mfd_add_devices(ab8500->dev, 0, ab8500_bm_devs,
1262				      ARRAY_SIZE(ab8500_bm_devs), NULL,
1263				      0, ab8500->domain);
1264		if (ret)
1265			dev_err(ab8500->dev, "error adding bm devices\n");
1266	}
1267
1268	if (((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
1269			ab8500->chip_id >= AB8500_CUT2P0) || is_ab8540(ab8500))
1270		ret = sysfs_create_group(&ab8500->dev->kobj,
1271					&ab9540_attr_group);
1272	else
1273		ret = sysfs_create_group(&ab8500->dev->kobj,
1274					&ab8500_attr_group);
1275
1276	if ((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
1277			ab8500->chip_id >= AB8500_CUT2P0)
1278		ret = sysfs_create_group(&ab8500->dev->kobj,
1279					 &ab8505_attr_group);
1280
1281	if (ret)
1282		dev_err(ab8500->dev, "error creating sysfs entries\n");
1283
1284	return ret;
1285}
1286
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1287static const struct platform_device_id ab8500_id[] = {
1288	{ "ab8500-core", AB8500_VERSION_AB8500 },
1289	{ "ab8505-core", AB8500_VERSION_AB8505 },
1290	{ "ab9540-i2c", AB8500_VERSION_AB9540 },
1291	{ "ab8540-i2c", AB8500_VERSION_AB8540 },
1292	{ }
1293};
1294
1295static struct platform_driver ab8500_core_driver = {
1296	.driver = {
1297		.name = "ab8500-core",
1298		.suppress_bind_attrs = true,
1299	},
1300	.probe	= ab8500_probe,
 
1301	.id_table = ab8500_id,
1302};
1303
1304static int __init ab8500_core_init(void)
1305{
1306	return platform_driver_register(&ab8500_core_driver);
1307}
 
 
 
 
 
1308core_initcall(ab8500_core_init);
v3.15
 
   1/*
   2 * Copyright (C) ST-Ericsson SA 2010
   3 *
   4 * License Terms: GNU General Public License v2
   5 * Author: Srinidhi Kasagar <srinidhi.kasagar@stericsson.com>
   6 * Author: Rabin Vincent <rabin.vincent@stericsson.com>
   7 * Author: Mattias Wallin <mattias.wallin@stericsson.com>
   8 */
   9
  10#include <linux/kernel.h>
  11#include <linux/slab.h>
  12#include <linux/init.h>
  13#include <linux/irq.h>
  14#include <linux/irqdomain.h>
  15#include <linux/delay.h>
  16#include <linux/interrupt.h>
  17#include <linux/module.h>
  18#include <linux/platform_device.h>
  19#include <linux/mfd/core.h>
  20#include <linux/mfd/abx500.h>
  21#include <linux/mfd/abx500/ab8500.h>
  22#include <linux/mfd/abx500/ab8500-bm.h>
  23#include <linux/mfd/dbx500-prcmu.h>
  24#include <linux/regulator/ab8500.h>
  25#include <linux/of.h>
  26#include <linux/of_device.h>
  27
  28/*
  29 * Interrupt register offsets
  30 * Bank : 0x0E
  31 */
  32#define AB8500_IT_SOURCE1_REG		0x00
  33#define AB8500_IT_SOURCE2_REG		0x01
  34#define AB8500_IT_SOURCE3_REG		0x02
  35#define AB8500_IT_SOURCE4_REG		0x03
  36#define AB8500_IT_SOURCE5_REG		0x04
  37#define AB8500_IT_SOURCE6_REG		0x05
  38#define AB8500_IT_SOURCE7_REG		0x06
  39#define AB8500_IT_SOURCE8_REG		0x07
  40#define AB9540_IT_SOURCE13_REG		0x0C
  41#define AB8500_IT_SOURCE19_REG		0x12
  42#define AB8500_IT_SOURCE20_REG		0x13
  43#define AB8500_IT_SOURCE21_REG		0x14
  44#define AB8500_IT_SOURCE22_REG		0x15
  45#define AB8500_IT_SOURCE23_REG		0x16
  46#define AB8500_IT_SOURCE24_REG		0x17
  47
  48/*
  49 * latch registers
  50 */
  51#define AB8500_IT_LATCH1_REG		0x20
  52#define AB8500_IT_LATCH2_REG		0x21
  53#define AB8500_IT_LATCH3_REG		0x22
  54#define AB8500_IT_LATCH4_REG		0x23
  55#define AB8500_IT_LATCH5_REG		0x24
  56#define AB8500_IT_LATCH6_REG		0x25
  57#define AB8500_IT_LATCH7_REG		0x26
  58#define AB8500_IT_LATCH8_REG		0x27
  59#define AB8500_IT_LATCH9_REG		0x28
  60#define AB8500_IT_LATCH10_REG		0x29
  61#define AB8500_IT_LATCH12_REG		0x2B
  62#define AB9540_IT_LATCH13_REG		0x2C
  63#define AB8500_IT_LATCH19_REG		0x32
  64#define AB8500_IT_LATCH20_REG		0x33
  65#define AB8500_IT_LATCH21_REG		0x34
  66#define AB8500_IT_LATCH22_REG		0x35
  67#define AB8500_IT_LATCH23_REG		0x36
  68#define AB8500_IT_LATCH24_REG		0x37
  69
  70/*
  71 * mask registers
  72 */
  73
  74#define AB8500_IT_MASK1_REG		0x40
  75#define AB8500_IT_MASK2_REG		0x41
  76#define AB8500_IT_MASK3_REG		0x42
  77#define AB8500_IT_MASK4_REG		0x43
  78#define AB8500_IT_MASK5_REG		0x44
  79#define AB8500_IT_MASK6_REG		0x45
  80#define AB8500_IT_MASK7_REG		0x46
  81#define AB8500_IT_MASK8_REG		0x47
  82#define AB8500_IT_MASK9_REG		0x48
  83#define AB8500_IT_MASK10_REG		0x49
  84#define AB8500_IT_MASK11_REG		0x4A
  85#define AB8500_IT_MASK12_REG		0x4B
  86#define AB8500_IT_MASK13_REG		0x4C
  87#define AB8500_IT_MASK14_REG		0x4D
  88#define AB8500_IT_MASK15_REG		0x4E
  89#define AB8500_IT_MASK16_REG		0x4F
  90#define AB8500_IT_MASK17_REG		0x50
  91#define AB8500_IT_MASK18_REG		0x51
  92#define AB8500_IT_MASK19_REG		0x52
  93#define AB8500_IT_MASK20_REG		0x53
  94#define AB8500_IT_MASK21_REG		0x54
  95#define AB8500_IT_MASK22_REG		0x55
  96#define AB8500_IT_MASK23_REG		0x56
  97#define AB8500_IT_MASK24_REG		0x57
  98#define AB8500_IT_MASK25_REG		0x58
  99
 100/*
 101 * latch hierarchy registers
 102 */
 103#define AB8500_IT_LATCHHIER1_REG	0x60
 104#define AB8500_IT_LATCHHIER2_REG	0x61
 105#define AB8500_IT_LATCHHIER3_REG	0x62
 106#define AB8540_IT_LATCHHIER4_REG	0x63
 107
 108#define AB8500_IT_LATCHHIER_NUM		3
 109#define AB8540_IT_LATCHHIER_NUM		4
 110
 111#define AB8500_REV_REG			0x80
 112#define AB8500_IC_NAME_REG		0x82
 113#define AB8500_SWITCH_OFF_STATUS	0x00
 114
 115#define AB8500_TURN_ON_STATUS		0x00
 116#define AB8505_TURN_ON_STATUS_2	0x04
 117
 118#define AB8500_CH_USBCH_STAT1_REG	0x02
 119#define VBUS_DET_DBNC100		0x02
 120#define VBUS_DET_DBNC1			0x01
 121
 122static DEFINE_SPINLOCK(on_stat_lock);
 123static u8 turn_on_stat_mask = 0xFF;
 124static u8 turn_on_stat_set;
 125static bool no_bm; /* No battery management */
 
 
 
 
 126module_param(no_bm, bool, S_IRUGO);
 127
 128#define AB9540_MODEM_CTRL2_REG			0x23
 129#define AB9540_MODEM_CTRL2_SWDBBRSTN_BIT	BIT(2)
 130
 131/*
 132 * Map interrupt numbers to the LATCH and MASK register offsets, Interrupt
 133 * numbers are indexed into this array with (num / 8). The interupts are
 134 * defined in linux/mfd/ab8500.h
 135 *
 136 * This is one off from the register names, i.e. AB8500_IT_MASK1_REG is at
 137 * offset 0.
 138 */
 139/* AB8500 support */
 140static const int ab8500_irq_regoffset[AB8500_NUM_IRQ_REGS] = {
 141	0, 1, 2, 3, 4, 6, 7, 8, 9, 11, 18, 19, 20, 21,
 142};
 143
 144/* AB9540 / AB8505 support */
 145static const int ab9540_irq_regoffset[AB9540_NUM_IRQ_REGS] = {
 146	0, 1, 2, 3, 4, 6, 7, 8, 9, 11, 18, 19, 20, 21, 12, 13, 24, 5, 22, 23
 147};
 148
 149/* AB8540 support */
 150static const int ab8540_irq_regoffset[AB8540_NUM_IRQ_REGS] = {
 151	0, 1, 2, 3, 4, -1, -1, -1, -1, 11, 18, 19, 20, 21, 12, 13, 24, 5, 22, 23,
 152	25, 26, 27, 28, 29, 30, 31,
 153};
 154
 155static const char ab8500_version_str[][7] = {
 156	[AB8500_VERSION_AB8500] = "AB8500",
 157	[AB8500_VERSION_AB8505] = "AB8505",
 158	[AB8500_VERSION_AB9540] = "AB9540",
 159	[AB8500_VERSION_AB8540] = "AB8540",
 160};
 161
 162static int ab8500_prcmu_write(struct ab8500 *ab8500, u16 addr, u8 data)
 163{
 164	int ret;
 165
 166	ret = prcmu_abb_write((u8)(addr >> 8), (u8)(addr & 0xFF), &data, 1);
 167	if (ret < 0)
 168		dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
 169	return ret;
 170}
 171
 172static int ab8500_prcmu_write_masked(struct ab8500 *ab8500, u16 addr, u8 mask,
 173	u8 data)
 174{
 175	int ret;
 176
 177	ret = prcmu_abb_write_masked((u8)(addr >> 8), (u8)(addr & 0xFF), &data,
 178		&mask, 1);
 179	if (ret < 0)
 180		dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
 181	return ret;
 182}
 183
 184static int ab8500_prcmu_read(struct ab8500 *ab8500, u16 addr)
 185{
 186	int ret;
 187	u8 data;
 188
 189	ret = prcmu_abb_read((u8)(addr >> 8), (u8)(addr & 0xFF), &data, 1);
 190	if (ret < 0) {
 191		dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
 192		return ret;
 193	}
 194	return (int)data;
 195}
 196
 197static int ab8500_get_chip_id(struct device *dev)
 198{
 199	struct ab8500 *ab8500;
 200
 201	if (!dev)
 202		return -EINVAL;
 203	ab8500 = dev_get_drvdata(dev->parent);
 204	return ab8500 ? (int)ab8500->chip_id : -EINVAL;
 205}
 206
 207static int set_register_interruptible(struct ab8500 *ab8500, u8 bank,
 208	u8 reg, u8 data)
 209{
 210	int ret;
 211	/*
 212	 * Put the u8 bank and u8 register together into a an u16.
 213	 * The bank on higher 8 bits and register in lower 8 bits.
 214	 * */
 215	u16 addr = ((u16)bank) << 8 | reg;
 216
 217	dev_vdbg(ab8500->dev, "wr: addr %#x <= %#x\n", addr, data);
 218
 219	mutex_lock(&ab8500->lock);
 220
 221	ret = ab8500->write(ab8500, addr, data);
 222	if (ret < 0)
 223		dev_err(ab8500->dev, "failed to write reg %#x: %d\n",
 224			addr, ret);
 225	mutex_unlock(&ab8500->lock);
 226
 227	return ret;
 228}
 229
 230static int ab8500_set_register(struct device *dev, u8 bank,
 231	u8 reg, u8 value)
 232{
 233	int ret;
 234	struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
 235
 236	atomic_inc(&ab8500->transfer_ongoing);
 237	ret = set_register_interruptible(ab8500, bank, reg, value);
 238	atomic_dec(&ab8500->transfer_ongoing);
 239	return ret;
 240}
 241
 242static int get_register_interruptible(struct ab8500 *ab8500, u8 bank,
 243	u8 reg, u8 *value)
 244{
 245	int ret;
 246	/* put the u8 bank and u8 reg together into a an u16.
 247	 * bank on higher 8 bits and reg in lower */
 248	u16 addr = ((u16)bank) << 8 | reg;
 249
 250	mutex_lock(&ab8500->lock);
 251
 252	ret = ab8500->read(ab8500, addr);
 253	if (ret < 0)
 254		dev_err(ab8500->dev, "failed to read reg %#x: %d\n",
 255			addr, ret);
 256	else
 257		*value = ret;
 258
 259	mutex_unlock(&ab8500->lock);
 260	dev_vdbg(ab8500->dev, "rd: addr %#x => data %#x\n", addr, ret);
 261
 262	return ret;
 263}
 264
 265static int ab8500_get_register(struct device *dev, u8 bank,
 266	u8 reg, u8 *value)
 267{
 268	int ret;
 269	struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
 270
 271	atomic_inc(&ab8500->transfer_ongoing);
 272	ret = get_register_interruptible(ab8500, bank, reg, value);
 273	atomic_dec(&ab8500->transfer_ongoing);
 274	return ret;
 275}
 276
 277static int mask_and_set_register_interruptible(struct ab8500 *ab8500, u8 bank,
 278	u8 reg, u8 bitmask, u8 bitvalues)
 279{
 280	int ret;
 281	/* put the u8 bank and u8 reg together into a an u16.
 282	 * bank on higher 8 bits and reg in lower */
 283	u16 addr = ((u16)bank) << 8 | reg;
 284
 285	mutex_lock(&ab8500->lock);
 286
 287	if (ab8500->write_masked == NULL) {
 288		u8 data;
 289
 290		ret = ab8500->read(ab8500, addr);
 291		if (ret < 0) {
 292			dev_err(ab8500->dev, "failed to read reg %#x: %d\n",
 293				addr, ret);
 294			goto out;
 295		}
 296
 297		data = (u8)ret;
 298		data = (~bitmask & data) | (bitmask & bitvalues);
 299
 300		ret = ab8500->write(ab8500, addr, data);
 301		if (ret < 0)
 302			dev_err(ab8500->dev, "failed to write reg %#x: %d\n",
 303				addr, ret);
 304
 305		dev_vdbg(ab8500->dev, "mask: addr %#x => data %#x\n", addr,
 306			data);
 307		goto out;
 308	}
 309	ret = ab8500->write_masked(ab8500, addr, bitmask, bitvalues);
 310	if (ret < 0)
 311		dev_err(ab8500->dev, "failed to modify reg %#x: %d\n", addr,
 312			ret);
 313out:
 314	mutex_unlock(&ab8500->lock);
 315	return ret;
 316}
 317
 318static int ab8500_mask_and_set_register(struct device *dev,
 319	u8 bank, u8 reg, u8 bitmask, u8 bitvalues)
 320{
 321	int ret;
 322	struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
 323
 324	atomic_inc(&ab8500->transfer_ongoing);
 325	ret= mask_and_set_register_interruptible(ab8500, bank, reg,
 326						 bitmask, bitvalues);
 327	atomic_dec(&ab8500->transfer_ongoing);
 328	return ret;
 329}
 330
 331static struct abx500_ops ab8500_ops = {
 332	.get_chip_id = ab8500_get_chip_id,
 333	.get_register = ab8500_get_register,
 334	.set_register = ab8500_set_register,
 335	.get_register_page = NULL,
 336	.set_register_page = NULL,
 337	.mask_and_set_register = ab8500_mask_and_set_register,
 338	.event_registers_startup_state_get = NULL,
 339	.startup_irq_enabled = NULL,
 340	.dump_all_banks = ab8500_dump_all_banks,
 341};
 342
 343static void ab8500_irq_lock(struct irq_data *data)
 344{
 345	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
 346
 347	mutex_lock(&ab8500->irq_lock);
 348	atomic_inc(&ab8500->transfer_ongoing);
 349}
 350
 351static void ab8500_irq_sync_unlock(struct irq_data *data)
 352{
 353	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
 354	int i;
 355
 356	for (i = 0; i < ab8500->mask_size; i++) {
 357		u8 old = ab8500->oldmask[i];
 358		u8 new = ab8500->mask[i];
 359		int reg;
 360
 361		if (new == old)
 362			continue;
 363
 364		/*
 365		 * Interrupt register 12 doesn't exist prior to AB8500 version
 366		 * 2.0
 367		 */
 368		if (ab8500->irq_reg_offset[i] == 11 &&
 369			is_ab8500_1p1_or_earlier(ab8500))
 370			continue;
 371
 372		if (ab8500->irq_reg_offset[i] < 0)
 373			continue;
 374
 375		ab8500->oldmask[i] = new;
 376
 377		reg = AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i];
 378		set_register_interruptible(ab8500, AB8500_INTERRUPT, reg, new);
 379	}
 380	atomic_dec(&ab8500->transfer_ongoing);
 381	mutex_unlock(&ab8500->irq_lock);
 382}
 383
 384static void ab8500_irq_mask(struct irq_data *data)
 385{
 386	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
 387	int offset = data->hwirq;
 388	int index = offset / 8;
 389	int mask = 1 << (offset % 8);
 390
 391	ab8500->mask[index] |= mask;
 392
 393	/* The AB8500 GPIOs have two interrupts each (rising & falling). */
 394	if (offset >= AB8500_INT_GPIO6R && offset <= AB8500_INT_GPIO41R)
 395		ab8500->mask[index + 2] |= mask;
 396	if (offset >= AB9540_INT_GPIO50R && offset <= AB9540_INT_GPIO54R)
 397		ab8500->mask[index + 1] |= mask;
 398	if (offset == AB8540_INT_GPIO43R || offset == AB8540_INT_GPIO44R)
 399		/* Here the falling IRQ is one bit lower */
 400		ab8500->mask[index] |= (mask << 1);
 401}
 402
 403static void ab8500_irq_unmask(struct irq_data *data)
 404{
 405	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
 406	unsigned int type = irqd_get_trigger_type(data);
 407	int offset = data->hwirq;
 408	int index = offset / 8;
 409	int mask = 1 << (offset % 8);
 410
 411	if (type & IRQ_TYPE_EDGE_RISING)
 412		ab8500->mask[index] &= ~mask;
 413
 414	/* The AB8500 GPIOs have two interrupts each (rising & falling). */
 415	if (type & IRQ_TYPE_EDGE_FALLING) {
 416		if (offset >= AB8500_INT_GPIO6R && offset <= AB8500_INT_GPIO41R)
 417			ab8500->mask[index + 2] &= ~mask;
 418		else if (offset >= AB9540_INT_GPIO50R && offset <= AB9540_INT_GPIO54R)
 
 419			ab8500->mask[index + 1] &= ~mask;
 420		else if (offset == AB8540_INT_GPIO43R || offset == AB8540_INT_GPIO44R)
 
 421			/* Here the falling IRQ is one bit lower */
 422			ab8500->mask[index] &= ~(mask << 1);
 423		else
 424			ab8500->mask[index] &= ~mask;
 425	} else {
 426		/* Satisfies the case where type is not set. */
 427		ab8500->mask[index] &= ~mask;
 428	}
 429}
 430
 431static int ab8500_irq_set_type(struct irq_data *data, unsigned int type)
 432{
 433	return 0;
 434}
 435
 436static struct irq_chip ab8500_irq_chip = {
 437	.name			= "ab8500",
 438	.irq_bus_lock		= ab8500_irq_lock,
 439	.irq_bus_sync_unlock	= ab8500_irq_sync_unlock,
 440	.irq_mask		= ab8500_irq_mask,
 441	.irq_disable		= ab8500_irq_mask,
 442	.irq_unmask		= ab8500_irq_unmask,
 443	.irq_set_type		= ab8500_irq_set_type,
 444};
 445
 446static void update_latch_offset(u8 *offset, int i)
 447{
 448	/* Fix inconsistent ITFromLatch25 bit mapping... */
 449	if (unlikely(*offset == 17))
 450			*offset = 24;
 451	/* Fix inconsistent ab8540 bit mapping... */
 452	if (unlikely(*offset == 16))
 453			*offset = 25;
 454	if ((i==3) && (*offset >= 24))
 455			*offset += 2;
 456}
 457
 458static int ab8500_handle_hierarchical_line(struct ab8500 *ab8500,
 459					int latch_offset, u8 latch_val)
 460{
 461	int int_bit, line, i;
 462
 463	for (i = 0; i < ab8500->mask_size; i++)
 464		if (ab8500->irq_reg_offset[i] == latch_offset)
 465			break;
 466
 467	if (i >= ab8500->mask_size) {
 468		dev_err(ab8500->dev, "Register offset 0x%2x not declared\n",
 469				latch_offset);
 470		return -ENXIO;
 471	}
 472
 473	/* ignore masked out interrupts */
 474	latch_val &= ~ab8500->mask[i];
 475
 476	while (latch_val) {
 477		int_bit = __ffs(latch_val);
 478		line = (i << 3) + int_bit;
 479		latch_val &= ~(1 << int_bit);
 480
 481		/*
 482		 * This handles the falling edge hwirqs from the GPIO
 483		 * lines. Route them back to the line registered for the
 484		 * rising IRQ, as this is merely a flag for the same IRQ
 485		 * in linux terms.
 486		 */
 487		if (line >= AB8500_INT_GPIO6F && line <= AB8500_INT_GPIO41F)
 488			line -= 16;
 489		if (line >= AB9540_INT_GPIO50F && line <= AB9540_INT_GPIO54F)
 490			line -= 8;
 491		if (line == AB8540_INT_GPIO43F || line == AB8540_INT_GPIO44F)
 492			line += 1;
 493
 494		handle_nested_irq(irq_create_mapping(ab8500->domain, line));
 495	}
 496
 497	return 0;
 498}
 499
 500static int ab8500_handle_hierarchical_latch(struct ab8500 *ab8500,
 501					int hier_offset, u8 hier_val)
 502{
 503	int latch_bit, status;
 504	u8 latch_offset, latch_val;
 505
 506	do {
 507		latch_bit = __ffs(hier_val);
 508		latch_offset = (hier_offset << 3) + latch_bit;
 509
 510		update_latch_offset(&latch_offset, hier_offset);
 511
 512		status = get_register_interruptible(ab8500,
 513				AB8500_INTERRUPT,
 514				AB8500_IT_LATCH1_REG + latch_offset,
 515				&latch_val);
 516		if (status < 0 || latch_val == 0)
 517			goto discard;
 518
 519		status = ab8500_handle_hierarchical_line(ab8500,
 520				latch_offset, latch_val);
 521		if (status < 0)
 522			return status;
 523discard:
 524		hier_val &= ~(1 << latch_bit);
 525	} while (hier_val);
 526
 527	return 0;
 528}
 529
 530static irqreturn_t ab8500_hierarchical_irq(int irq, void *dev)
 531{
 532	struct ab8500 *ab8500 = dev;
 533	u8 i;
 534
 535	dev_vdbg(ab8500->dev, "interrupt\n");
 536
 537	/*  Hierarchical interrupt version */
 538	for (i = 0; i < (ab8500->it_latchhier_num); i++) {
 539		int status;
 540		u8 hier_val;
 541
 542		status = get_register_interruptible(ab8500, AB8500_INTERRUPT,
 543			AB8500_IT_LATCHHIER1_REG + i, &hier_val);
 544		if (status < 0 || hier_val == 0)
 545			continue;
 546
 547		status = ab8500_handle_hierarchical_latch(ab8500, i, hier_val);
 548		if (status < 0)
 549			break;
 550	}
 551	return IRQ_HANDLED;
 552}
 553
 554static int ab8500_irq_map(struct irq_domain *d, unsigned int virq,
 555				irq_hw_number_t hwirq)
 556{
 557	struct ab8500 *ab8500 = d->host_data;
 558
 559	if (!ab8500)
 560		return -EINVAL;
 561
 562	irq_set_chip_data(virq, ab8500);
 563	irq_set_chip_and_handler(virq, &ab8500_irq_chip,
 564				handle_simple_irq);
 565	irq_set_nested_thread(virq, 1);
 566#ifdef CONFIG_ARM
 567	set_irq_flags(virq, IRQF_VALID);
 568#else
 569	irq_set_noprobe(virq);
 570#endif
 571
 572	return 0;
 573}
 574
 575static struct irq_domain_ops ab8500_irq_ops = {
 576        .map    = ab8500_irq_map,
 577        .xlate  = irq_domain_xlate_twocell,
 578};
 579
 580static int ab8500_irq_init(struct ab8500 *ab8500, struct device_node *np)
 581{
 582	int num_irqs;
 583
 584	if (is_ab8540(ab8500))
 585		num_irqs = AB8540_NR_IRQS;
 586	else if (is_ab9540(ab8500))
 587		num_irqs = AB9540_NR_IRQS;
 588	else if (is_ab8505(ab8500))
 589		num_irqs = AB8505_NR_IRQS;
 590	else
 591		num_irqs = AB8500_NR_IRQS;
 592
 593	/* If ->irq_base is zero this will give a linear mapping */
 594	ab8500->domain = irq_domain_add_simple(NULL,
 595			num_irqs, 0,
 596			&ab8500_irq_ops, ab8500);
 597
 598	if (!ab8500->domain) {
 599		dev_err(ab8500->dev, "Failed to create irqdomain\n");
 600		return -ENOSYS;
 601	}
 602
 603	return 0;
 604}
 605
 606int ab8500_suspend(struct ab8500 *ab8500)
 607{
 608	if (atomic_read(&ab8500->transfer_ongoing))
 609		return -EINVAL;
 610	else
 611		return 0;
 612}
 613
 614static struct resource ab8500_gpadc_resources[] = {
 615	{
 616		.name	= "HW_CONV_END",
 617		.start	= AB8500_INT_GP_HW_ADC_CONV_END,
 618		.end	= AB8500_INT_GP_HW_ADC_CONV_END,
 619		.flags	= IORESOURCE_IRQ,
 620	},
 621	{
 622		.name	= "SW_CONV_END",
 623		.start	= AB8500_INT_GP_SW_ADC_CONV_END,
 624		.end	= AB8500_INT_GP_SW_ADC_CONV_END,
 625		.flags	= IORESOURCE_IRQ,
 626	},
 627};
 628
 629static struct resource ab8505_gpadc_resources[] = {
 630	{
 631		.name	= "SW_CONV_END",
 632		.start	= AB8500_INT_GP_SW_ADC_CONV_END,
 633		.end	= AB8500_INT_GP_SW_ADC_CONV_END,
 634		.flags	= IORESOURCE_IRQ,
 635	},
 636};
 637
 638static struct resource ab8500_rtc_resources[] = {
 639	{
 640		.name	= "60S",
 641		.start	= AB8500_INT_RTC_60S,
 642		.end	= AB8500_INT_RTC_60S,
 643		.flags	= IORESOURCE_IRQ,
 644	},
 645	{
 646		.name	= "ALARM",
 647		.start	= AB8500_INT_RTC_ALARM,
 648		.end	= AB8500_INT_RTC_ALARM,
 649		.flags	= IORESOURCE_IRQ,
 650	},
 651};
 652
 653static struct resource ab8540_rtc_resources[] = {
 654	{
 655		.name	= "1S",
 656		.start	= AB8540_INT_RTC_1S,
 657		.end	= AB8540_INT_RTC_1S,
 658		.flags	= IORESOURCE_IRQ,
 659	},
 660	{
 661		.name	= "ALARM",
 662		.start	= AB8500_INT_RTC_ALARM,
 663		.end	= AB8500_INT_RTC_ALARM,
 664		.flags	= IORESOURCE_IRQ,
 665	},
 666};
 667
 668static struct resource ab8500_poweronkey_db_resources[] = {
 669	{
 670		.name	= "ONKEY_DBF",
 671		.start	= AB8500_INT_PON_KEY1DB_F,
 672		.end	= AB8500_INT_PON_KEY1DB_F,
 673		.flags	= IORESOURCE_IRQ,
 674	},
 675	{
 676		.name	= "ONKEY_DBR",
 677		.start	= AB8500_INT_PON_KEY1DB_R,
 678		.end	= AB8500_INT_PON_KEY1DB_R,
 679		.flags	= IORESOURCE_IRQ,
 680	},
 681};
 682
 683static struct resource ab8500_av_acc_detect_resources[] = {
 684	{
 685	       .name = "ACC_DETECT_1DB_F",
 686	       .start = AB8500_INT_ACC_DETECT_1DB_F,
 687	       .end = AB8500_INT_ACC_DETECT_1DB_F,
 688	       .flags = IORESOURCE_IRQ,
 689	},
 690	{
 691	       .name = "ACC_DETECT_1DB_R",
 692	       .start = AB8500_INT_ACC_DETECT_1DB_R,
 693	       .end = AB8500_INT_ACC_DETECT_1DB_R,
 694	       .flags = IORESOURCE_IRQ,
 695	},
 696	{
 697	       .name = "ACC_DETECT_21DB_F",
 698	       .start = AB8500_INT_ACC_DETECT_21DB_F,
 699	       .end = AB8500_INT_ACC_DETECT_21DB_F,
 700	       .flags = IORESOURCE_IRQ,
 701	},
 702	{
 703	       .name = "ACC_DETECT_21DB_R",
 704	       .start = AB8500_INT_ACC_DETECT_21DB_R,
 705	       .end = AB8500_INT_ACC_DETECT_21DB_R,
 706	       .flags = IORESOURCE_IRQ,
 707	},
 708	{
 709	       .name = "ACC_DETECT_22DB_F",
 710	       .start = AB8500_INT_ACC_DETECT_22DB_F,
 711	       .end = AB8500_INT_ACC_DETECT_22DB_F,
 712	       .flags = IORESOURCE_IRQ,
 713	},
 714	{
 715	       .name = "ACC_DETECT_22DB_R",
 716	       .start = AB8500_INT_ACC_DETECT_22DB_R,
 717	       .end = AB8500_INT_ACC_DETECT_22DB_R,
 718	       .flags = IORESOURCE_IRQ,
 719	},
 720};
 721
 722static struct resource ab8500_charger_resources[] = {
 723	{
 724		.name = "MAIN_CH_UNPLUG_DET",
 725		.start = AB8500_INT_MAIN_CH_UNPLUG_DET,
 726		.end = AB8500_INT_MAIN_CH_UNPLUG_DET,
 727		.flags = IORESOURCE_IRQ,
 728	},
 729	{
 730		.name = "MAIN_CHARGE_PLUG_DET",
 731		.start = AB8500_INT_MAIN_CH_PLUG_DET,
 732		.end = AB8500_INT_MAIN_CH_PLUG_DET,
 733		.flags = IORESOURCE_IRQ,
 734	},
 735	{
 736		.name = "VBUS_DET_R",
 737		.start = AB8500_INT_VBUS_DET_R,
 738		.end = AB8500_INT_VBUS_DET_R,
 739		.flags = IORESOURCE_IRQ,
 740	},
 741	{
 742		.name = "VBUS_DET_F",
 743		.start = AB8500_INT_VBUS_DET_F,
 744		.end = AB8500_INT_VBUS_DET_F,
 745		.flags = IORESOURCE_IRQ,
 746	},
 747	{
 748		.name = "USB_LINK_STATUS",
 749		.start = AB8500_INT_USB_LINK_STATUS,
 750		.end = AB8500_INT_USB_LINK_STATUS,
 751		.flags = IORESOURCE_IRQ,
 752	},
 753	{
 754		.name = "VBUS_OVV",
 755		.start = AB8500_INT_VBUS_OVV,
 756		.end = AB8500_INT_VBUS_OVV,
 757		.flags = IORESOURCE_IRQ,
 758	},
 759	{
 760		.name = "USB_CH_TH_PROT_R",
 761		.start = AB8500_INT_USB_CH_TH_PROT_R,
 762		.end = AB8500_INT_USB_CH_TH_PROT_R,
 763		.flags = IORESOURCE_IRQ,
 764	},
 765	{
 766		.name = "USB_CH_TH_PROT_F",
 767		.start = AB8500_INT_USB_CH_TH_PROT_F,
 768		.end = AB8500_INT_USB_CH_TH_PROT_F,
 769		.flags = IORESOURCE_IRQ,
 770	},
 771	{
 772		.name = "MAIN_EXT_CH_NOT_OK",
 773		.start = AB8500_INT_MAIN_EXT_CH_NOT_OK,
 774		.end = AB8500_INT_MAIN_EXT_CH_NOT_OK,
 775		.flags = IORESOURCE_IRQ,
 776	},
 777	{
 778		.name = "MAIN_CH_TH_PROT_R",
 779		.start = AB8500_INT_MAIN_CH_TH_PROT_R,
 780		.end = AB8500_INT_MAIN_CH_TH_PROT_R,
 781		.flags = IORESOURCE_IRQ,
 782	},
 783	{
 784		.name = "MAIN_CH_TH_PROT_F",
 785		.start = AB8500_INT_MAIN_CH_TH_PROT_F,
 786		.end = AB8500_INT_MAIN_CH_TH_PROT_F,
 787		.flags = IORESOURCE_IRQ,
 788	},
 789	{
 790		.name = "USB_CHARGER_NOT_OKR",
 791		.start = AB8500_INT_USB_CHARGER_NOT_OKR,
 792		.end = AB8500_INT_USB_CHARGER_NOT_OKR,
 793		.flags = IORESOURCE_IRQ,
 794	},
 795	{
 796		.name = "CH_WD_EXP",
 797		.start = AB8500_INT_CH_WD_EXP,
 798		.end = AB8500_INT_CH_WD_EXP,
 799		.flags = IORESOURCE_IRQ,
 800	},
 801	{
 802		.name = "VBUS_CH_DROP_END",
 803		.start = AB8500_INT_VBUS_CH_DROP_END,
 804		.end = AB8500_INT_VBUS_CH_DROP_END,
 805		.flags = IORESOURCE_IRQ,
 806	},
 807};
 808
 809static struct resource ab8500_btemp_resources[] = {
 810	{
 811		.name = "BAT_CTRL_INDB",
 812		.start = AB8500_INT_BAT_CTRL_INDB,
 813		.end = AB8500_INT_BAT_CTRL_INDB,
 814		.flags = IORESOURCE_IRQ,
 815	},
 816	{
 817		.name = "BTEMP_LOW",
 818		.start = AB8500_INT_BTEMP_LOW,
 819		.end = AB8500_INT_BTEMP_LOW,
 820		.flags = IORESOURCE_IRQ,
 821	},
 822	{
 823		.name = "BTEMP_HIGH",
 824		.start = AB8500_INT_BTEMP_HIGH,
 825		.end = AB8500_INT_BTEMP_HIGH,
 826		.flags = IORESOURCE_IRQ,
 827	},
 828	{
 829		.name = "BTEMP_LOW_MEDIUM",
 830		.start = AB8500_INT_BTEMP_LOW_MEDIUM,
 831		.end = AB8500_INT_BTEMP_LOW_MEDIUM,
 832		.flags = IORESOURCE_IRQ,
 833	},
 834	{
 835		.name = "BTEMP_MEDIUM_HIGH",
 836		.start = AB8500_INT_BTEMP_MEDIUM_HIGH,
 837		.end = AB8500_INT_BTEMP_MEDIUM_HIGH,
 838		.flags = IORESOURCE_IRQ,
 839	},
 840};
 841
 842static struct resource ab8500_fg_resources[] = {
 843	{
 844		.name = "NCONV_ACCU",
 845		.start = AB8500_INT_CCN_CONV_ACC,
 846		.end = AB8500_INT_CCN_CONV_ACC,
 847		.flags = IORESOURCE_IRQ,
 848	},
 849	{
 850		.name = "BATT_OVV",
 851		.start = AB8500_INT_BATT_OVV,
 852		.end = AB8500_INT_BATT_OVV,
 853		.flags = IORESOURCE_IRQ,
 854	},
 855	{
 856		.name = "LOW_BAT_F",
 857		.start = AB8500_INT_LOW_BAT_F,
 858		.end = AB8500_INT_LOW_BAT_F,
 859		.flags = IORESOURCE_IRQ,
 860	},
 861	{
 862		.name = "LOW_BAT_R",
 863		.start = AB8500_INT_LOW_BAT_R,
 864		.end = AB8500_INT_LOW_BAT_R,
 865		.flags = IORESOURCE_IRQ,
 866	},
 867	{
 868		.name = "CC_INT_CALIB",
 869		.start = AB8500_INT_CC_INT_CALIB,
 870		.end = AB8500_INT_CC_INT_CALIB,
 871		.flags = IORESOURCE_IRQ,
 872	},
 873	{
 874		.name = "CCEOC",
 875		.start = AB8500_INT_CCEOC,
 876		.end = AB8500_INT_CCEOC,
 877		.flags = IORESOURCE_IRQ,
 878	},
 879};
 880
 881static struct resource ab8500_chargalg_resources[] = {};
 882
 883#ifdef CONFIG_DEBUG_FS
 884static struct resource ab8500_debug_resources[] = {
 885	{
 886		.name	= "IRQ_AB8500",
 887		/*
 888		 * Number will be filled in. NOTE: this is deliberately
 889		 * not flagged as an IRQ in ordet to avoid remapping using
 890		 * the irqdomain in the MFD core, so that this IRQ passes
 891		 * unremapped to the debug code.
 892		 */
 893	},
 894	{
 895		.name	= "IRQ_FIRST",
 896		.start	= AB8500_INT_MAIN_EXT_CH_NOT_OK,
 897		.end	= AB8500_INT_MAIN_EXT_CH_NOT_OK,
 898		.flags	= IORESOURCE_IRQ,
 899	},
 900	{
 901		.name	= "IRQ_LAST",
 902		.start	= AB8500_INT_XTAL32K_KO,
 903		.end	= AB8500_INT_XTAL32K_KO,
 904		.flags	= IORESOURCE_IRQ,
 905	},
 906};
 907#endif
 908
 909static struct resource ab8500_usb_resources[] = {
 910	{
 911		.name = "ID_WAKEUP_R",
 912		.start = AB8500_INT_ID_WAKEUP_R,
 913		.end = AB8500_INT_ID_WAKEUP_R,
 914		.flags = IORESOURCE_IRQ,
 915	},
 916	{
 917		.name = "ID_WAKEUP_F",
 918		.start = AB8500_INT_ID_WAKEUP_F,
 919		.end = AB8500_INT_ID_WAKEUP_F,
 920		.flags = IORESOURCE_IRQ,
 921	},
 922	{
 923		.name = "VBUS_DET_F",
 924		.start = AB8500_INT_VBUS_DET_F,
 925		.end = AB8500_INT_VBUS_DET_F,
 926		.flags = IORESOURCE_IRQ,
 927	},
 928	{
 929		.name = "VBUS_DET_R",
 930		.start = AB8500_INT_VBUS_DET_R,
 931		.end = AB8500_INT_VBUS_DET_R,
 932		.flags = IORESOURCE_IRQ,
 933	},
 934	{
 935		.name = "USB_LINK_STATUS",
 936		.start = AB8500_INT_USB_LINK_STATUS,
 937		.end = AB8500_INT_USB_LINK_STATUS,
 938		.flags = IORESOURCE_IRQ,
 939	},
 940	{
 941		.name = "USB_ADP_PROBE_PLUG",
 942		.start = AB8500_INT_ADP_PROBE_PLUG,
 943		.end = AB8500_INT_ADP_PROBE_PLUG,
 944		.flags = IORESOURCE_IRQ,
 945	},
 946	{
 947		.name = "USB_ADP_PROBE_UNPLUG",
 948		.start = AB8500_INT_ADP_PROBE_UNPLUG,
 949		.end = AB8500_INT_ADP_PROBE_UNPLUG,
 950		.flags = IORESOURCE_IRQ,
 951	},
 952};
 953
 954static struct resource ab8505_iddet_resources[] = {
 955	{
 956		.name  = "KeyDeglitch",
 957		.start = AB8505_INT_KEYDEGLITCH,
 958		.end   = AB8505_INT_KEYDEGLITCH,
 959		.flags = IORESOURCE_IRQ,
 960	},
 961	{
 962		.name  = "KP",
 963		.start = AB8505_INT_KP,
 964		.end   = AB8505_INT_KP,
 965		.flags = IORESOURCE_IRQ,
 966	},
 967	{
 968		.name  = "IKP",
 969		.start = AB8505_INT_IKP,
 970		.end   = AB8505_INT_IKP,
 971		.flags = IORESOURCE_IRQ,
 972	},
 973	{
 974		.name  = "IKR",
 975		.start = AB8505_INT_IKR,
 976		.end   = AB8505_INT_IKR,
 977		.flags = IORESOURCE_IRQ,
 978	},
 979	{
 980		.name  = "KeyStuck",
 981		.start = AB8505_INT_KEYSTUCK,
 982		.end   = AB8505_INT_KEYSTUCK,
 983		.flags = IORESOURCE_IRQ,
 984	},
 985	{
 986		.name = "VBUS_DET_R",
 987		.start = AB8500_INT_VBUS_DET_R,
 988		.end = AB8500_INT_VBUS_DET_R,
 989		.flags = IORESOURCE_IRQ,
 990	},
 991	{
 992		.name = "VBUS_DET_F",
 993		.start = AB8500_INT_VBUS_DET_F,
 994		.end = AB8500_INT_VBUS_DET_F,
 995		.flags = IORESOURCE_IRQ,
 996	},
 997	{
 998		.name = "ID_DET_PLUGR",
 999		.start = AB8500_INT_ID_DET_PLUGR,
1000		.end = AB8500_INT_ID_DET_PLUGR,
1001		.flags = IORESOURCE_IRQ,
1002	},
1003	{
1004		.name = "ID_DET_PLUGF",
1005		.start = AB8500_INT_ID_DET_PLUGF,
1006		.end = AB8500_INT_ID_DET_PLUGF,
1007		.flags = IORESOURCE_IRQ,
1008	},
1009};
1010
1011static struct resource ab8500_temp_resources[] = {
1012	{
1013		.name  = "ABX500_TEMP_WARM",
1014		.start = AB8500_INT_TEMP_WARM,
1015		.end   = AB8500_INT_TEMP_WARM,
1016		.flags = IORESOURCE_IRQ,
1017	},
1018};
1019
1020static const struct mfd_cell ab8500_bm_devs[] = {
1021	{
1022		.name = "ab8500-charger",
1023		.of_compatible = "stericsson,ab8500-charger",
1024		.num_resources = ARRAY_SIZE(ab8500_charger_resources),
1025		.resources = ab8500_charger_resources,
1026		.platform_data = &ab8500_bm_data,
1027		.pdata_size = sizeof(ab8500_bm_data),
1028	},
1029	{
1030		.name = "ab8500-btemp",
1031		.of_compatible = "stericsson,ab8500-btemp",
1032		.num_resources = ARRAY_SIZE(ab8500_btemp_resources),
1033		.resources = ab8500_btemp_resources,
1034		.platform_data = &ab8500_bm_data,
1035		.pdata_size = sizeof(ab8500_bm_data),
1036	},
1037	{
1038		.name = "ab8500-fg",
1039		.of_compatible = "stericsson,ab8500-fg",
1040		.num_resources = ARRAY_SIZE(ab8500_fg_resources),
1041		.resources = ab8500_fg_resources,
1042		.platform_data = &ab8500_bm_data,
1043		.pdata_size = sizeof(ab8500_bm_data),
1044	},
1045	{
1046		.name = "ab8500-chargalg",
1047		.of_compatible = "stericsson,ab8500-chargalg",
1048		.num_resources = ARRAY_SIZE(ab8500_chargalg_resources),
1049		.resources = ab8500_chargalg_resources,
1050		.platform_data = &ab8500_bm_data,
1051		.pdata_size = sizeof(ab8500_bm_data),
1052	},
1053};
1054
1055static const struct mfd_cell ab8500_devs[] = {
1056#ifdef CONFIG_DEBUG_FS
1057	{
1058		.name = "ab8500-debug",
1059		.of_compatible = "stericsson,ab8500-debug",
1060		.num_resources = ARRAY_SIZE(ab8500_debug_resources),
1061		.resources = ab8500_debug_resources,
1062	},
1063#endif
1064	{
1065		.name = "ab8500-sysctrl",
1066		.of_compatible = "stericsson,ab8500-sysctrl",
1067	},
1068	{
1069		.name = "ab8500-ext-regulator",
1070		.of_compatible = "stericsson,ab8500-ext-regulator",
1071	},
1072	{
1073		.name = "ab8500-regulator",
1074		.of_compatible = "stericsson,ab8500-regulator",
1075	},
1076	{
1077		.name = "abx500-clk",
1078		.of_compatible = "stericsson,abx500-clk",
1079	},
1080	{
1081		.name = "ab8500-gpadc",
1082		.of_compatible = "stericsson,ab8500-gpadc",
1083		.num_resources = ARRAY_SIZE(ab8500_gpadc_resources),
1084		.resources = ab8500_gpadc_resources,
1085	},
1086	{
1087		.name = "ab8500-rtc",
1088		.of_compatible = "stericsson,ab8500-rtc",
1089		.num_resources = ARRAY_SIZE(ab8500_rtc_resources),
1090		.resources = ab8500_rtc_resources,
1091	},
1092	{
1093		.name = "ab8500-acc-det",
1094		.of_compatible = "stericsson,ab8500-acc-det",
1095		.num_resources = ARRAY_SIZE(ab8500_av_acc_detect_resources),
1096		.resources = ab8500_av_acc_detect_resources,
1097	},
1098	{
1099
1100		.name = "ab8500-poweron-key",
1101		.of_compatible = "stericsson,ab8500-poweron-key",
1102		.num_resources = ARRAY_SIZE(ab8500_poweronkey_db_resources),
1103		.resources = ab8500_poweronkey_db_resources,
1104	},
1105	{
1106		.name = "ab8500-pwm",
1107		.of_compatible = "stericsson,ab8500-pwm",
1108		.id = 1,
1109	},
1110	{
1111		.name = "ab8500-pwm",
1112		.of_compatible = "stericsson,ab8500-pwm",
1113		.id = 2,
1114	},
1115	{
1116		.name = "ab8500-pwm",
1117		.of_compatible = "stericsson,ab8500-pwm",
1118		.id = 3,
1119	},
1120	{
1121		.name = "ab8500-denc",
1122		.of_compatible = "stericsson,ab8500-denc",
1123	},
1124	{
1125		.name = "pinctrl-ab8500",
1126		.of_compatible = "stericsson,ab8500-gpio",
1127	},
1128	{
1129		.name = "abx500-temp",
1130		.of_compatible = "stericsson,abx500-temp",
1131		.num_resources = ARRAY_SIZE(ab8500_temp_resources),
1132		.resources = ab8500_temp_resources,
1133	},
1134	{
1135		.name = "ab8500-usb",
1136		.of_compatible = "stericsson,ab8500-usb",
1137		.num_resources = ARRAY_SIZE(ab8500_usb_resources),
1138		.resources = ab8500_usb_resources,
1139	},
1140	{
1141		.name = "ab8500-codec",
1142		.of_compatible = "stericsson,ab8500-codec",
1143	},
1144};
1145
1146static const struct mfd_cell ab9540_devs[] = {
1147#ifdef CONFIG_DEBUG_FS
1148	{
1149		.name = "ab8500-debug",
1150		.num_resources = ARRAY_SIZE(ab8500_debug_resources),
1151		.resources = ab8500_debug_resources,
1152	},
1153#endif
1154	{
1155		.name = "ab8500-sysctrl",
1156	},
1157	{
1158		.name = "ab8500-ext-regulator",
1159	},
1160	{
1161		.name = "ab8500-regulator",
1162	},
1163	{
1164		.name = "abx500-clk",
1165		.of_compatible = "stericsson,abx500-clk",
1166	},
1167	{
1168		.name = "ab8500-gpadc",
1169		.of_compatible = "stericsson,ab8500-gpadc",
1170		.num_resources = ARRAY_SIZE(ab8500_gpadc_resources),
1171		.resources = ab8500_gpadc_resources,
1172	},
1173	{
1174		.name = "ab8500-rtc",
1175		.num_resources = ARRAY_SIZE(ab8500_rtc_resources),
1176		.resources = ab8500_rtc_resources,
1177	},
1178	{
1179		.name = "ab8500-acc-det",
1180		.num_resources = ARRAY_SIZE(ab8500_av_acc_detect_resources),
1181		.resources = ab8500_av_acc_detect_resources,
1182	},
1183	{
1184		.name = "ab8500-poweron-key",
1185		.num_resources = ARRAY_SIZE(ab8500_poweronkey_db_resources),
1186		.resources = ab8500_poweronkey_db_resources,
1187	},
1188	{
1189		.name = "ab8500-pwm",
1190		.id = 1,
1191	},
1192	{
1193		.name = "abx500-temp",
1194		.num_resources = ARRAY_SIZE(ab8500_temp_resources),
1195		.resources = ab8500_temp_resources,
1196	},
1197	{
1198		.name = "pinctrl-ab9540",
1199		.of_compatible = "stericsson,ab9540-gpio",
1200	},
1201	{
1202		.name = "ab9540-usb",
1203		.num_resources = ARRAY_SIZE(ab8500_usb_resources),
1204		.resources = ab8500_usb_resources,
1205	},
1206	{
1207		.name = "ab9540-codec",
1208	},
1209	{
1210		.name = "ab-iddet",
1211		.num_resources = ARRAY_SIZE(ab8505_iddet_resources),
1212		.resources = ab8505_iddet_resources,
1213	},
1214};
1215
1216/* Device list for ab8505  */
1217static const struct mfd_cell ab8505_devs[] = {
1218#ifdef CONFIG_DEBUG_FS
1219	{
1220		.name = "ab8500-debug",
1221		.num_resources = ARRAY_SIZE(ab8500_debug_resources),
1222		.resources = ab8500_debug_resources,
1223	},
1224#endif
1225	{
1226		.name = "ab8500-sysctrl",
 
1227	},
1228	{
1229		.name = "ab8500-regulator",
 
1230	},
1231	{
1232		.name = "abx500-clk",
1233		.of_compatible = "stericsson,abx500-clk",
1234	},
1235	{
1236		.name = "ab8500-gpadc",
1237		.of_compatible = "stericsson,ab8500-gpadc",
1238		.num_resources = ARRAY_SIZE(ab8505_gpadc_resources),
1239		.resources = ab8505_gpadc_resources,
1240	},
1241	{
1242		.name = "ab8500-rtc",
1243		.num_resources = ARRAY_SIZE(ab8500_rtc_resources),
1244		.resources = ab8500_rtc_resources,
1245	},
1246	{
1247		.name = "ab8500-acc-det",
1248		.num_resources = ARRAY_SIZE(ab8500_av_acc_detect_resources),
1249		.resources = ab8500_av_acc_detect_resources,
1250	},
1251	{
1252		.name = "ab8500-poweron-key",
1253		.num_resources = ARRAY_SIZE(ab8500_poweronkey_db_resources),
1254		.resources = ab8500_poweronkey_db_resources,
1255	},
1256	{
1257		.name = "ab8500-pwm",
 
1258		.id = 1,
1259	},
1260	{
1261		.name = "pinctrl-ab8505",
 
1262	},
1263	{
1264		.name = "ab8500-usb",
1265		.num_resources = ARRAY_SIZE(ab8500_usb_resources),
1266		.resources = ab8500_usb_resources,
1267	},
1268	{
1269		.name = "ab8500-codec",
 
1270	},
1271	{
1272		.name = "ab-iddet",
1273		.num_resources = ARRAY_SIZE(ab8505_iddet_resources),
1274		.resources = ab8505_iddet_resources,
1275	},
1276};
1277
1278static const struct mfd_cell ab8540_devs[] = {
1279#ifdef CONFIG_DEBUG_FS
1280	{
1281		.name = "ab8500-debug",
1282		.num_resources = ARRAY_SIZE(ab8500_debug_resources),
1283		.resources = ab8500_debug_resources,
1284	},
1285#endif
1286	{
1287		.name = "ab8500-sysctrl",
1288	},
1289	{
1290		.name = "ab8500-ext-regulator",
1291	},
1292	{
1293		.name = "ab8500-regulator",
1294	},
1295	{
1296		.name = "abx500-clk",
1297		.of_compatible = "stericsson,abx500-clk",
1298	},
1299	{
1300		.name = "ab8500-gpadc",
1301		.of_compatible = "stericsson,ab8500-gpadc",
1302		.num_resources = ARRAY_SIZE(ab8505_gpadc_resources),
1303		.resources = ab8505_gpadc_resources,
1304	},
1305	{
1306		.name = "ab8500-acc-det",
1307		.num_resources = ARRAY_SIZE(ab8500_av_acc_detect_resources),
1308		.resources = ab8500_av_acc_detect_resources,
1309	},
1310	{
1311		.name = "ab8500-poweron-key",
1312		.num_resources = ARRAY_SIZE(ab8500_poweronkey_db_resources),
1313		.resources = ab8500_poweronkey_db_resources,
1314	},
1315	{
1316		.name = "ab8500-pwm",
1317		.id = 1,
1318	},
1319	{
1320		.name = "abx500-temp",
1321		.num_resources = ARRAY_SIZE(ab8500_temp_resources),
1322		.resources = ab8500_temp_resources,
1323	},
1324	{
1325		.name = "pinctrl-ab8540",
1326	},
1327	{
1328		.name = "ab8540-usb",
1329		.num_resources = ARRAY_SIZE(ab8500_usb_resources),
1330		.resources = ab8500_usb_resources,
1331	},
1332	{
1333		.name = "ab8540-codec",
1334	},
1335	{
1336		.name = "ab-iddet",
1337		.num_resources = ARRAY_SIZE(ab8505_iddet_resources),
1338		.resources = ab8505_iddet_resources,
1339	},
1340};
1341
1342static const struct mfd_cell ab8540_cut1_devs[] = {
1343	{
1344		.name = "ab8500-rtc",
1345		.of_compatible = "stericsson,ab8500-rtc",
1346		.num_resources = ARRAY_SIZE(ab8500_rtc_resources),
1347		.resources = ab8500_rtc_resources,
1348	},
1349};
1350
1351static const struct mfd_cell ab8540_cut2_devs[] = {
1352	{
1353		.name = "ab8540-rtc",
1354		.of_compatible = "stericsson,ab8540-rtc",
1355		.num_resources = ARRAY_SIZE(ab8540_rtc_resources),
1356		.resources = ab8540_rtc_resources,
1357	},
1358};
1359
1360static ssize_t show_chip_id(struct device *dev,
1361				struct device_attribute *attr, char *buf)
1362{
1363	struct ab8500 *ab8500;
1364
1365	ab8500 = dev_get_drvdata(dev);
1366
1367	return sprintf(buf, "%#x\n", ab8500 ? ab8500->chip_id : -EINVAL);
1368}
1369
1370/*
1371 * ab8500 has switched off due to (SWITCH_OFF_STATUS):
1372 * 0x01 Swoff bit programming
1373 * 0x02 Thermal protection activation
1374 * 0x04 Vbat lower then BattOk falling threshold
1375 * 0x08 Watchdog expired
1376 * 0x10 Non presence of 32kHz clock
1377 * 0x20 Battery level lower than power on reset threshold
1378 * 0x40 Power on key 1 pressed longer than 10 seconds
1379 * 0x80 DB8500 thermal shutdown
1380 */
1381static ssize_t show_switch_off_status(struct device *dev,
1382				struct device_attribute *attr, char *buf)
1383{
1384	int ret;
1385	u8 value;
1386	struct ab8500 *ab8500;
1387
1388	ab8500 = dev_get_drvdata(dev);
1389	ret = get_register_interruptible(ab8500, AB8500_RTC,
1390		AB8500_SWITCH_OFF_STATUS, &value);
1391	if (ret < 0)
1392		return ret;
1393	return sprintf(buf, "%#x\n", value);
1394}
1395
1396/* use mask and set to override the register turn_on_stat value */
1397void ab8500_override_turn_on_stat(u8 mask, u8 set)
1398{
1399	spin_lock(&on_stat_lock);
1400	turn_on_stat_mask = mask;
1401	turn_on_stat_set = set;
1402	spin_unlock(&on_stat_lock);
1403}
1404
1405/*
1406 * ab8500 has turned on due to (TURN_ON_STATUS):
1407 * 0x01 PORnVbat
1408 * 0x02 PonKey1dbF
1409 * 0x04 PonKey2dbF
1410 * 0x08 RTCAlarm
1411 * 0x10 MainChDet
1412 * 0x20 VbusDet
1413 * 0x40 UsbIDDetect
1414 * 0x80 Reserved
1415 */
1416static ssize_t show_turn_on_status(struct device *dev,
1417				struct device_attribute *attr, char *buf)
1418{
1419	int ret;
1420	u8 value;
1421	struct ab8500 *ab8500;
1422
1423	ab8500 = dev_get_drvdata(dev);
1424	ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
1425		AB8500_TURN_ON_STATUS, &value);
1426	if (ret < 0)
1427		return ret;
1428
1429	/*
1430	 * In L9540, turn_on_status register is not updated correctly if
1431	 * the device is rebooted with AC/USB charger connected. Due to
1432	 * this, the device boots android instead of entering into charge
1433	 * only mode. Read the AC/USB status register to detect the charger
1434	 * presence and update the turn on status manually.
1435	 */
1436	if (is_ab9540(ab8500)) {
1437		spin_lock(&on_stat_lock);
1438		value = (value & turn_on_stat_mask) | turn_on_stat_set;
1439		spin_unlock(&on_stat_lock);
1440	}
1441
1442	return sprintf(buf, "%#x\n", value);
1443}
1444
1445static ssize_t show_turn_on_status_2(struct device *dev,
1446				struct device_attribute *attr, char *buf)
1447{
1448	int ret;
1449	u8 value;
1450	struct ab8500 *ab8500;
1451
1452	ab8500 = dev_get_drvdata(dev);
1453	ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
1454		AB8505_TURN_ON_STATUS_2, &value);
1455	if (ret < 0)
1456		return ret;
1457	return sprintf(buf, "%#x\n", (value & 0x1));
1458}
1459
1460static ssize_t show_ab9540_dbbrstn(struct device *dev,
1461				struct device_attribute *attr, char *buf)
1462{
1463	struct ab8500 *ab8500;
1464	int ret;
1465	u8 value;
1466
1467	ab8500 = dev_get_drvdata(dev);
1468
1469	ret = get_register_interruptible(ab8500, AB8500_REGU_CTRL2,
1470		AB9540_MODEM_CTRL2_REG, &value);
1471	if (ret < 0)
1472		return ret;
1473
1474	return sprintf(buf, "%d\n",
1475			(value & AB9540_MODEM_CTRL2_SWDBBRSTN_BIT) ? 1 : 0);
1476}
1477
1478static ssize_t store_ab9540_dbbrstn(struct device *dev,
1479	struct device_attribute *attr, const char *buf, size_t count)
1480{
1481	struct ab8500 *ab8500;
1482	int ret = count;
1483	int err;
1484	u8 bitvalues;
1485
1486	ab8500 = dev_get_drvdata(dev);
1487
1488	if (count > 0) {
1489		switch (buf[0]) {
1490		case '0':
1491			bitvalues = 0;
1492			break;
1493		case '1':
1494			bitvalues = AB9540_MODEM_CTRL2_SWDBBRSTN_BIT;
1495			break;
1496		default:
1497			goto exit;
1498		}
1499
1500		err = mask_and_set_register_interruptible(ab8500,
1501			AB8500_REGU_CTRL2, AB9540_MODEM_CTRL2_REG,
1502			AB9540_MODEM_CTRL2_SWDBBRSTN_BIT, bitvalues);
1503		if (err)
1504			dev_info(ab8500->dev,
1505				"Failed to set DBBRSTN %c, err %#x\n",
1506				buf[0], err);
1507	}
1508
1509exit:
1510	return ret;
1511}
1512
1513static DEVICE_ATTR(chip_id, S_IRUGO, show_chip_id, NULL);
1514static DEVICE_ATTR(switch_off_status, S_IRUGO, show_switch_off_status, NULL);
1515static DEVICE_ATTR(turn_on_status, S_IRUGO, show_turn_on_status, NULL);
1516static DEVICE_ATTR(turn_on_status_2, S_IRUGO, show_turn_on_status_2, NULL);
1517static DEVICE_ATTR(dbbrstn, S_IRUGO | S_IWUSR,
1518			show_ab9540_dbbrstn, store_ab9540_dbbrstn);
1519
1520static struct attribute *ab8500_sysfs_entries[] = {
1521	&dev_attr_chip_id.attr,
1522	&dev_attr_switch_off_status.attr,
1523	&dev_attr_turn_on_status.attr,
1524	NULL,
1525};
1526
1527static struct attribute *ab8505_sysfs_entries[] = {
1528	&dev_attr_turn_on_status_2.attr,
1529	NULL,
1530};
1531
1532static struct attribute *ab9540_sysfs_entries[] = {
1533	&dev_attr_chip_id.attr,
1534	&dev_attr_switch_off_status.attr,
1535	&dev_attr_turn_on_status.attr,
1536	&dev_attr_dbbrstn.attr,
1537	NULL,
1538};
1539
1540static struct attribute_group ab8500_attr_group = {
1541	.attrs	= ab8500_sysfs_entries,
1542};
1543
1544static struct attribute_group ab8505_attr_group = {
1545	.attrs	= ab8505_sysfs_entries,
1546};
1547
1548static struct attribute_group ab9540_attr_group = {
1549	.attrs	= ab9540_sysfs_entries,
1550};
1551
1552static int ab8500_probe(struct platform_device *pdev)
1553{
1554	static char *switch_off_status[] = {
1555		"Swoff bit programming",
1556		"Thermal protection activation",
1557		"Vbat lower then BattOk falling threshold",
1558		"Watchdog expired",
1559		"Non presence of 32kHz clock",
1560		"Battery level lower than power on reset threshold",
1561		"Power on key 1 pressed longer than 10 seconds",
1562		"DB8500 thermal shutdown"};
1563	static char *turn_on_status[] = {
1564		"Battery rising (Vbat)",
1565		"Power On Key 1 dbF",
1566		"Power On Key 2 dbF",
1567		"RTC Alarm",
1568		"Main Charger Detect",
1569		"Vbus Detect (USB)",
1570		"USB ID Detect",
1571		"UART Factory Mode Detect"};
1572	struct ab8500_platform_data *plat = dev_get_platdata(&pdev->dev);
1573	const struct platform_device_id *platid = platform_get_device_id(pdev);
1574	enum ab8500_version version = AB8500_VERSION_UNDEFINED;
1575	struct device_node *np = pdev->dev.of_node;
1576	struct ab8500 *ab8500;
1577	struct resource *resource;
1578	int ret;
1579	int i;
1580	u8 value;
1581
1582	ab8500 = devm_kzalloc(&pdev->dev, sizeof *ab8500, GFP_KERNEL);
1583	if (!ab8500)
1584		return -ENOMEM;
1585
1586	ab8500->dev = &pdev->dev;
1587
1588	resource = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
1589	if (!resource) {
1590		dev_err(&pdev->dev, "no IRQ resource\n");
1591		return -ENODEV;
1592	}
1593
1594	ab8500->irq = resource->start;
1595
1596	ab8500->read = ab8500_prcmu_read;
1597	ab8500->write = ab8500_prcmu_write;
1598	ab8500->write_masked = ab8500_prcmu_write_masked;
1599
1600	mutex_init(&ab8500->lock);
1601	mutex_init(&ab8500->irq_lock);
1602	atomic_set(&ab8500->transfer_ongoing, 0);
1603
1604	platform_set_drvdata(pdev, ab8500);
1605
1606	if (platid)
1607		version = platid->driver_data;
1608
1609	if (version != AB8500_VERSION_UNDEFINED)
1610		ab8500->version = version;
1611	else {
1612		ret = get_register_interruptible(ab8500, AB8500_MISC,
1613			AB8500_IC_NAME_REG, &value);
1614		if (ret < 0) {
1615			dev_err(&pdev->dev, "could not probe HW\n");
1616			return ret;
1617		}
1618
1619		ab8500->version = value;
1620	}
1621
1622	ret = get_register_interruptible(ab8500, AB8500_MISC,
1623		AB8500_REV_REG, &value);
1624	if (ret < 0)
1625		return ret;
1626
1627	ab8500->chip_id = value;
1628
1629	dev_info(ab8500->dev, "detected chip, %s rev. %1x.%1x\n",
1630			ab8500_version_str[ab8500->version],
1631			ab8500->chip_id >> 4,
1632			ab8500->chip_id & 0x0F);
1633
1634	/* Configure AB8540 */
1635	if (is_ab8540(ab8500)) {
1636		ab8500->mask_size = AB8540_NUM_IRQ_REGS;
1637		ab8500->irq_reg_offset = ab8540_irq_regoffset;
1638		ab8500->it_latchhier_num = AB8540_IT_LATCHHIER_NUM;
1639	}/* Configure AB8500 or AB9540 IRQ */
1640	else if (is_ab9540(ab8500) || is_ab8505(ab8500)) {
1641		ab8500->mask_size = AB9540_NUM_IRQ_REGS;
1642		ab8500->irq_reg_offset = ab9540_irq_regoffset;
1643		ab8500->it_latchhier_num = AB8500_IT_LATCHHIER_NUM;
1644	} else {
1645		ab8500->mask_size = AB8500_NUM_IRQ_REGS;
1646		ab8500->irq_reg_offset = ab8500_irq_regoffset;
1647		ab8500->it_latchhier_num = AB8500_IT_LATCHHIER_NUM;
1648	}
1649	ab8500->mask = devm_kzalloc(&pdev->dev, ab8500->mask_size, GFP_KERNEL);
 
1650	if (!ab8500->mask)
1651		return -ENOMEM;
1652	ab8500->oldmask = devm_kzalloc(&pdev->dev, ab8500->mask_size, GFP_KERNEL);
 
1653	if (!ab8500->oldmask)
1654		return -ENOMEM;
1655
1656	/*
1657	 * ab8500 has switched off due to (SWITCH_OFF_STATUS):
1658	 * 0x01 Swoff bit programming
1659	 * 0x02 Thermal protection activation
1660	 * 0x04 Vbat lower then BattOk falling threshold
1661	 * 0x08 Watchdog expired
1662	 * 0x10 Non presence of 32kHz clock
1663	 * 0x20 Battery level lower than power on reset threshold
1664	 * 0x40 Power on key 1 pressed longer than 10 seconds
1665	 * 0x80 DB8500 thermal shutdown
1666	 */
1667
1668	ret = get_register_interruptible(ab8500, AB8500_RTC,
1669		AB8500_SWITCH_OFF_STATUS, &value);
1670	if (ret < 0)
1671		return ret;
1672	dev_info(ab8500->dev, "switch off cause(s) (%#x): ", value);
1673
1674	if (value) {
1675		for (i = 0; i < ARRAY_SIZE(switch_off_status); i++) {
1676			if (value & 1)
1677				printk(KERN_CONT " \"%s\"",
1678				       switch_off_status[i]);
1679			value = value >> 1;
1680
1681		}
1682		printk(KERN_CONT "\n");
1683	} else {
1684		printk(KERN_CONT " None\n");
1685	}
1686	ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
1687		AB8500_TURN_ON_STATUS, &value);
1688	if (ret < 0)
1689		return ret;
1690	dev_info(ab8500->dev, "turn on reason(s) (%#x): ", value);
1691
1692	if (value) {
1693		for (i = 0; i < ARRAY_SIZE(turn_on_status); i++) {
1694			if (value & 1)
1695				printk("\"%s\" ", turn_on_status[i]);
1696			value = value >> 1;
1697		}
1698		printk("\n");
1699	} else {
1700		printk("None\n");
1701	}
1702
1703	if (plat && plat->init)
1704		plat->init(ab8500);
1705
1706	if (is_ab9540(ab8500)) {
1707		ret = get_register_interruptible(ab8500, AB8500_CHARGER,
1708			AB8500_CH_USBCH_STAT1_REG, &value);
1709		if (ret < 0)
1710			return ret;
1711		if ((value & VBUS_DET_DBNC1) && (value & VBUS_DET_DBNC100))
1712			ab8500_override_turn_on_stat(~AB8500_POW_KEY_1_ON,
1713						     AB8500_VBUS_DET);
1714	}
1715
1716	/* Clear and mask all interrupts */
1717	for (i = 0; i < ab8500->mask_size; i++) {
1718		/*
1719		 * Interrupt register 12 doesn't exist prior to AB8500 version
1720		 * 2.0
1721		 */
1722		if (ab8500->irq_reg_offset[i] == 11 &&
1723				is_ab8500_1p1_or_earlier(ab8500))
1724			continue;
1725
1726		if (ab8500->irq_reg_offset[i] < 0)
1727			continue;
1728
1729		get_register_interruptible(ab8500, AB8500_INTERRUPT,
1730			AB8500_IT_LATCH1_REG + ab8500->irq_reg_offset[i],
1731			&value);
1732		set_register_interruptible(ab8500, AB8500_INTERRUPT,
1733			AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i], 0xff);
1734	}
1735
1736	ret = abx500_register_ops(ab8500->dev, &ab8500_ops);
1737	if (ret)
1738		return ret;
1739
1740	for (i = 0; i < ab8500->mask_size; i++)
1741		ab8500->mask[i] = ab8500->oldmask[i] = 0xff;
1742
1743	ret = ab8500_irq_init(ab8500, np);
1744	if (ret)
1745		return ret;
1746
1747	ret = devm_request_threaded_irq(&pdev->dev, ab8500->irq, NULL,
1748			ab8500_hierarchical_irq,
1749			IRQF_ONESHOT | IRQF_NO_SUSPEND,
1750			"ab8500", ab8500);
1751	if (ret)
1752		return ret;
1753
1754#if CONFIG_DEBUG_FS
1755	/* Pass to debugfs */
1756	ab8500_debug_resources[0].start = ab8500->irq;
1757	ab8500_debug_resources[0].end = ab8500->irq;
1758#endif
1759
1760	if (is_ab9540(ab8500))
1761		ret = mfd_add_devices(ab8500->dev, 0, ab9540_devs,
1762				ARRAY_SIZE(ab9540_devs), NULL,
1763				0, ab8500->domain);
1764	else if (is_ab8540(ab8500)) {
1765		ret = mfd_add_devices(ab8500->dev, 0, ab8540_devs,
1766			      ARRAY_SIZE(ab8540_devs), NULL,
1767			      0, ab8500->domain);
1768		if (ret)
1769			return ret;
1770
1771		if (is_ab8540_1p2_or_earlier(ab8500))
1772			ret = mfd_add_devices(ab8500->dev, 0, ab8540_cut1_devs,
1773			      ARRAY_SIZE(ab8540_cut1_devs), NULL,
1774			      0, ab8500->domain);
1775		else /* ab8540 >= cut2 */
1776			ret = mfd_add_devices(ab8500->dev, 0, ab8540_cut2_devs,
1777			      ARRAY_SIZE(ab8540_cut2_devs), NULL,
1778			      0, ab8500->domain);
1779	} else if (is_ab8505(ab8500))
1780		ret = mfd_add_devices(ab8500->dev, 0, ab8505_devs,
1781			      ARRAY_SIZE(ab8505_devs), NULL,
1782			      0, ab8500->domain);
1783	else
1784		ret = mfd_add_devices(ab8500->dev, 0, ab8500_devs,
1785				ARRAY_SIZE(ab8500_devs), NULL,
1786				0, ab8500->domain);
1787	if (ret)
1788		return ret;
1789
1790	if (!no_bm) {
1791		/* Add battery management devices */
1792		ret = mfd_add_devices(ab8500->dev, 0, ab8500_bm_devs,
1793				      ARRAY_SIZE(ab8500_bm_devs), NULL,
1794				      0, ab8500->domain);
1795		if (ret)
1796			dev_err(ab8500->dev, "error adding bm devices\n");
1797	}
1798
1799	if (((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
1800			ab8500->chip_id >= AB8500_CUT2P0) || is_ab8540(ab8500))
1801		ret = sysfs_create_group(&ab8500->dev->kobj,
1802					&ab9540_attr_group);
1803	else
1804		ret = sysfs_create_group(&ab8500->dev->kobj,
1805					&ab8500_attr_group);
1806
1807	if ((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
1808			ab8500->chip_id >= AB8500_CUT2P0)
1809		ret = sysfs_create_group(&ab8500->dev->kobj,
1810					 &ab8505_attr_group);
1811
1812	if (ret)
1813		dev_err(ab8500->dev, "error creating sysfs entries\n");
1814
1815	return ret;
1816}
1817
1818static int ab8500_remove(struct platform_device *pdev)
1819{
1820	struct ab8500 *ab8500 = platform_get_drvdata(pdev);
1821
1822	if (((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
1823			ab8500->chip_id >= AB8500_CUT2P0) || is_ab8540(ab8500))
1824		sysfs_remove_group(&ab8500->dev->kobj, &ab9540_attr_group);
1825	else
1826		sysfs_remove_group(&ab8500->dev->kobj, &ab8500_attr_group);
1827
1828	if ((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
1829			ab8500->chip_id >= AB8500_CUT2P0)
1830		sysfs_remove_group(&ab8500->dev->kobj, &ab8505_attr_group);
1831
1832	mfd_remove_devices(ab8500->dev);
1833
1834	return 0;
1835}
1836
1837static const struct platform_device_id ab8500_id[] = {
1838	{ "ab8500-core", AB8500_VERSION_AB8500 },
1839	{ "ab8505-i2c", AB8500_VERSION_AB8505 },
1840	{ "ab9540-i2c", AB8500_VERSION_AB9540 },
1841	{ "ab8540-i2c", AB8500_VERSION_AB8540 },
1842	{ }
1843};
1844
1845static struct platform_driver ab8500_core_driver = {
1846	.driver = {
1847		.name = "ab8500-core",
1848		.owner = THIS_MODULE,
1849	},
1850	.probe	= ab8500_probe,
1851	.remove	= ab8500_remove,
1852	.id_table = ab8500_id,
1853};
1854
1855static int __init ab8500_core_init(void)
1856{
1857	return platform_driver_register(&ab8500_core_driver);
1858}
1859
1860static void __exit ab8500_core_exit(void)
1861{
1862	platform_driver_unregister(&ab8500_core_driver);
1863}
1864core_initcall(ab8500_core_init);
1865module_exit(ab8500_core_exit);
1866
1867MODULE_AUTHOR("Mattias Wallin, Srinidhi Kasagar, Rabin Vincent");
1868MODULE_DESCRIPTION("AB8500 MFD core");
1869MODULE_LICENSE("GPL v2");