Linux Audio

Check our new training course

Loading...
v6.8
   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/dbx500-prcmu.h>
 
  23#include <linux/of.h>
 
  24
  25/*
  26 * Interrupt register offsets
  27 * Bank : 0x0E
  28 */
  29#define AB8500_IT_SOURCE1_REG		0x00
  30#define AB8500_IT_SOURCE2_REG		0x01
  31#define AB8500_IT_SOURCE3_REG		0x02
  32#define AB8500_IT_SOURCE4_REG		0x03
  33#define AB8500_IT_SOURCE5_REG		0x04
  34#define AB8500_IT_SOURCE6_REG		0x05
  35#define AB8500_IT_SOURCE7_REG		0x06
  36#define AB8500_IT_SOURCE8_REG		0x07
  37#define AB9540_IT_SOURCE13_REG		0x0C
  38#define AB8500_IT_SOURCE19_REG		0x12
  39#define AB8500_IT_SOURCE20_REG		0x13
  40#define AB8500_IT_SOURCE21_REG		0x14
  41#define AB8500_IT_SOURCE22_REG		0x15
  42#define AB8500_IT_SOURCE23_REG		0x16
  43#define AB8500_IT_SOURCE24_REG		0x17
  44
  45/*
  46 * latch registers
  47 */
  48#define AB8500_IT_LATCH1_REG		0x20
  49#define AB8500_IT_LATCH2_REG		0x21
  50#define AB8500_IT_LATCH3_REG		0x22
  51#define AB8500_IT_LATCH4_REG		0x23
  52#define AB8500_IT_LATCH5_REG		0x24
  53#define AB8500_IT_LATCH6_REG		0x25
  54#define AB8500_IT_LATCH7_REG		0x26
  55#define AB8500_IT_LATCH8_REG		0x27
  56#define AB8500_IT_LATCH9_REG		0x28
  57#define AB8500_IT_LATCH10_REG		0x29
  58#define AB8500_IT_LATCH12_REG		0x2B
  59#define AB9540_IT_LATCH13_REG		0x2C
  60#define AB8500_IT_LATCH19_REG		0x32
  61#define AB8500_IT_LATCH20_REG		0x33
  62#define AB8500_IT_LATCH21_REG		0x34
  63#define AB8500_IT_LATCH22_REG		0x35
  64#define AB8500_IT_LATCH23_REG		0x36
  65#define AB8500_IT_LATCH24_REG		0x37
  66
  67/*
  68 * mask registers
  69 */
  70
  71#define AB8500_IT_MASK1_REG		0x40
  72#define AB8500_IT_MASK2_REG		0x41
  73#define AB8500_IT_MASK3_REG		0x42
  74#define AB8500_IT_MASK4_REG		0x43
  75#define AB8500_IT_MASK5_REG		0x44
  76#define AB8500_IT_MASK6_REG		0x45
  77#define AB8500_IT_MASK7_REG		0x46
  78#define AB8500_IT_MASK8_REG		0x47
  79#define AB8500_IT_MASK9_REG		0x48
  80#define AB8500_IT_MASK10_REG		0x49
  81#define AB8500_IT_MASK11_REG		0x4A
  82#define AB8500_IT_MASK12_REG		0x4B
  83#define AB8500_IT_MASK13_REG		0x4C
  84#define AB8500_IT_MASK14_REG		0x4D
  85#define AB8500_IT_MASK15_REG		0x4E
  86#define AB8500_IT_MASK16_REG		0x4F
  87#define AB8500_IT_MASK17_REG		0x50
  88#define AB8500_IT_MASK18_REG		0x51
  89#define AB8500_IT_MASK19_REG		0x52
  90#define AB8500_IT_MASK20_REG		0x53
  91#define AB8500_IT_MASK21_REG		0x54
  92#define AB8500_IT_MASK22_REG		0x55
  93#define AB8500_IT_MASK23_REG		0x56
  94#define AB8500_IT_MASK24_REG		0x57
  95#define AB8500_IT_MASK25_REG		0x58
  96
  97/*
  98 * latch hierarchy registers
  99 */
 100#define AB8500_IT_LATCHHIER1_REG	0x60
 101#define AB8500_IT_LATCHHIER2_REG	0x61
 102#define AB8500_IT_LATCHHIER3_REG	0x62
 103#define AB8540_IT_LATCHHIER4_REG	0x63
 104
 105#define AB8500_IT_LATCHHIER_NUM		3
 106#define AB8540_IT_LATCHHIER_NUM		4
 107
 108#define AB8500_REV_REG			0x80
 109#define AB8500_IC_NAME_REG		0x82
 110#define AB8500_SWITCH_OFF_STATUS	0x00
 111
 112#define AB8500_TURN_ON_STATUS		0x00
 113#define AB8505_TURN_ON_STATUS_2		0x04
 114
 115#define AB8500_CH_USBCH_STAT1_REG	0x02
 116#define VBUS_DET_DBNC100		0x02
 117#define VBUS_DET_DBNC1			0x01
 118
 119static DEFINE_SPINLOCK(on_stat_lock);
 120static u8 turn_on_stat_mask = 0xFF;
 121static u8 turn_on_stat_set;
 
 
 
 
 
 
 122
 123#define AB9540_MODEM_CTRL2_REG			0x23
 124#define AB9540_MODEM_CTRL2_SWDBBRSTN_BIT	BIT(2)
 125
 126/*
 127 * Map interrupt numbers to the LATCH and MASK register offsets, Interrupt
 128 * numbers are indexed into this array with (num / 8). The interupts are
 129 * defined in linux/mfd/ab8500.h
 130 *
 131 * This is one off from the register names, i.e. AB8500_IT_MASK1_REG is at
 132 * offset 0.
 133 */
 134/* AB8500 support */
 135static const int ab8500_irq_regoffset[AB8500_NUM_IRQ_REGS] = {
 136	0, 1, 2, 3, 4, 6, 7, 8, 9, 11, 18, 19, 20, 21,
 137};
 138
 139/* AB9540 / AB8505 support */
 140static const int ab9540_irq_regoffset[AB9540_NUM_IRQ_REGS] = {
 141	0, 1, 2, 3, 4, 6, 7, 8, 9, 11, 18, 19, 20, 21, 12, 13, 24, 5, 22, 23
 142};
 143
 144/* AB8540 support */
 145static const int ab8540_irq_regoffset[AB8540_NUM_IRQ_REGS] = {
 146	0, 1, 2, 3, 4, -1, -1, -1, -1, 11, 18, 19, 20, 21, 12, 13, 24, 5, 22,
 147	23, 25, 26, 27, 28, 29, 30, 31,
 148};
 149
 150static const char ab8500_version_str[][7] = {
 151	[AB8500_VERSION_AB8500] = "AB8500",
 152	[AB8500_VERSION_AB8505] = "AB8505",
 153	[AB8500_VERSION_AB9540] = "AB9540",
 154	[AB8500_VERSION_AB8540] = "AB8540",
 155};
 156
 157static int ab8500_prcmu_write(struct ab8500 *ab8500, u16 addr, u8 data)
 158{
 159	int ret;
 160
 161	ret = prcmu_abb_write((u8)(addr >> 8), (u8)(addr & 0xFF), &data, 1);
 162	if (ret < 0)
 163		dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
 164	return ret;
 165}
 166
 167static int ab8500_prcmu_write_masked(struct ab8500 *ab8500, u16 addr, u8 mask,
 168	u8 data)
 169{
 170	int ret;
 171
 172	ret = prcmu_abb_write_masked((u8)(addr >> 8), (u8)(addr & 0xFF), &data,
 173		&mask, 1);
 174	if (ret < 0)
 175		dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
 176	return ret;
 177}
 178
 179static int ab8500_prcmu_read(struct ab8500 *ab8500, u16 addr)
 180{
 181	int ret;
 182	u8 data;
 183
 184	ret = prcmu_abb_read((u8)(addr >> 8), (u8)(addr & 0xFF), &data, 1);
 185	if (ret < 0) {
 186		dev_err(ab8500->dev, "prcmu i2c error %d\n", ret);
 187		return ret;
 188	}
 189	return (int)data;
 190}
 191
 192static int ab8500_get_chip_id(struct device *dev)
 193{
 194	struct ab8500 *ab8500;
 195
 196	if (!dev)
 197		return -EINVAL;
 198	ab8500 = dev_get_drvdata(dev->parent);
 199	return ab8500 ? (int)ab8500->chip_id : -EINVAL;
 200}
 201
 202static int set_register_interruptible(struct ab8500 *ab8500, u8 bank,
 203	u8 reg, u8 data)
 204{
 205	int ret;
 206	/*
 207	 * Put the u8 bank and u8 register together into a an u16.
 208	 * The bank on higher 8 bits and register in lower 8 bits.
 209	 */
 210	u16 addr = ((u16)bank) << 8 | reg;
 211
 212	dev_vdbg(ab8500->dev, "wr: addr %#x <= %#x\n", addr, data);
 213
 214	mutex_lock(&ab8500->lock);
 215
 216	ret = ab8500->write(ab8500, addr, data);
 217	if (ret < 0)
 218		dev_err(ab8500->dev, "failed to write reg %#x: %d\n",
 219			addr, ret);
 220	mutex_unlock(&ab8500->lock);
 221
 222	return ret;
 223}
 224
 225static int ab8500_set_register(struct device *dev, u8 bank,
 226	u8 reg, u8 value)
 227{
 228	int ret;
 229	struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
 230
 231	atomic_inc(&ab8500->transfer_ongoing);
 232	ret = set_register_interruptible(ab8500, bank, reg, value);
 233	atomic_dec(&ab8500->transfer_ongoing);
 234	return ret;
 235}
 236
 237static int get_register_interruptible(struct ab8500 *ab8500, u8 bank,
 238	u8 reg, u8 *value)
 239{
 240	int ret;
 241	u16 addr = ((u16)bank) << 8 | reg;
 242
 243	mutex_lock(&ab8500->lock);
 244
 245	ret = ab8500->read(ab8500, addr);
 246	if (ret < 0)
 247		dev_err(ab8500->dev, "failed to read reg %#x: %d\n",
 248			addr, ret);
 249	else
 250		*value = ret;
 251
 252	mutex_unlock(&ab8500->lock);
 253	dev_vdbg(ab8500->dev, "rd: addr %#x => data %#x\n", addr, ret);
 254
 255	return (ret < 0) ? ret : 0;
 256}
 257
 258static int ab8500_get_register(struct device *dev, u8 bank,
 259	u8 reg, u8 *value)
 260{
 261	int ret;
 262	struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
 263
 264	atomic_inc(&ab8500->transfer_ongoing);
 265	ret = get_register_interruptible(ab8500, bank, reg, value);
 266	atomic_dec(&ab8500->transfer_ongoing);
 267	return ret;
 268}
 269
 270static int mask_and_set_register_interruptible(struct ab8500 *ab8500, u8 bank,
 271	u8 reg, u8 bitmask, u8 bitvalues)
 272{
 273	int ret;
 274	u16 addr = ((u16)bank) << 8 | reg;
 275
 276	mutex_lock(&ab8500->lock);
 277
 278	if (ab8500->write_masked == NULL) {
 279		u8 data;
 280
 281		ret = ab8500->read(ab8500, addr);
 282		if (ret < 0) {
 283			dev_err(ab8500->dev, "failed to read reg %#x: %d\n",
 284				addr, ret);
 285			goto out;
 286		}
 287
 288		data = (u8)ret;
 289		data = (~bitmask & data) | (bitmask & bitvalues);
 290
 291		ret = ab8500->write(ab8500, addr, data);
 292		if (ret < 0)
 293			dev_err(ab8500->dev, "failed to write reg %#x: %d\n",
 294				addr, ret);
 295
 296		dev_vdbg(ab8500->dev, "mask: addr %#x => data %#x\n", addr,
 297			data);
 298		goto out;
 299	}
 300	ret = ab8500->write_masked(ab8500, addr, bitmask, bitvalues);
 301	if (ret < 0)
 302		dev_err(ab8500->dev, "failed to modify reg %#x: %d\n", addr,
 303			ret);
 304out:
 305	mutex_unlock(&ab8500->lock);
 306	return ret;
 307}
 308
 309static int ab8500_mask_and_set_register(struct device *dev,
 310	u8 bank, u8 reg, u8 bitmask, u8 bitvalues)
 311{
 312	int ret;
 313	struct ab8500 *ab8500 = dev_get_drvdata(dev->parent);
 314
 315	atomic_inc(&ab8500->transfer_ongoing);
 316	ret = mask_and_set_register_interruptible(ab8500, bank, reg,
 317						 bitmask, bitvalues);
 318	atomic_dec(&ab8500->transfer_ongoing);
 319	return ret;
 320}
 321
 322static struct abx500_ops ab8500_ops = {
 323	.get_chip_id = ab8500_get_chip_id,
 324	.get_register = ab8500_get_register,
 325	.set_register = ab8500_set_register,
 326	.get_register_page = NULL,
 327	.set_register_page = NULL,
 328	.mask_and_set_register = ab8500_mask_and_set_register,
 329	.event_registers_startup_state_get = NULL,
 330	.startup_irq_enabled = NULL,
 331	.dump_all_banks = ab8500_dump_all_banks,
 332};
 333
 334static void ab8500_irq_lock(struct irq_data *data)
 335{
 336	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
 337
 338	mutex_lock(&ab8500->irq_lock);
 339	atomic_inc(&ab8500->transfer_ongoing);
 340}
 341
 342static void ab8500_irq_sync_unlock(struct irq_data *data)
 343{
 344	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
 345	int i;
 346
 347	for (i = 0; i < ab8500->mask_size; i++) {
 348		u8 old = ab8500->oldmask[i];
 349		u8 new = ab8500->mask[i];
 350		int reg;
 351
 352		if (new == old)
 353			continue;
 354
 355		/*
 356		 * Interrupt register 12 doesn't exist prior to AB8500 version
 357		 * 2.0
 358		 */
 359		if (ab8500->irq_reg_offset[i] == 11 &&
 360			is_ab8500_1p1_or_earlier(ab8500))
 361			continue;
 362
 363		if (ab8500->irq_reg_offset[i] < 0)
 364			continue;
 365
 366		ab8500->oldmask[i] = new;
 367
 368		reg = AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i];
 369		set_register_interruptible(ab8500, AB8500_INTERRUPT, reg, new);
 370	}
 371	atomic_dec(&ab8500->transfer_ongoing);
 372	mutex_unlock(&ab8500->irq_lock);
 373}
 374
 375static void ab8500_irq_mask(struct irq_data *data)
 376{
 377	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
 378	int offset = data->hwirq;
 379	int index = offset / 8;
 380	int mask = 1 << (offset % 8);
 381
 382	ab8500->mask[index] |= mask;
 383
 384	/* The AB8500 GPIOs have two interrupts each (rising & falling). */
 385	if (offset >= AB8500_INT_GPIO6R && offset <= AB8500_INT_GPIO41R)
 386		ab8500->mask[index + 2] |= mask;
 387	if (offset >= AB9540_INT_GPIO50R && offset <= AB9540_INT_GPIO54R)
 388		ab8500->mask[index + 1] |= mask;
 389	if (offset == AB8540_INT_GPIO43R || offset == AB8540_INT_GPIO44R)
 390		/* Here the falling IRQ is one bit lower */
 391		ab8500->mask[index] |= (mask << 1);
 392}
 393
 394static void ab8500_irq_unmask(struct irq_data *data)
 395{
 396	struct ab8500 *ab8500 = irq_data_get_irq_chip_data(data);
 397	unsigned int type = irqd_get_trigger_type(data);
 398	int offset = data->hwirq;
 399	int index = offset / 8;
 400	int mask = 1 << (offset % 8);
 401
 402	if (type & IRQ_TYPE_EDGE_RISING)
 403		ab8500->mask[index] &= ~mask;
 404
 405	/* The AB8500 GPIOs have two interrupts each (rising & falling). */
 406	if (type & IRQ_TYPE_EDGE_FALLING) {
 407		if (offset >= AB8500_INT_GPIO6R && offset <= AB8500_INT_GPIO41R)
 408			ab8500->mask[index + 2] &= ~mask;
 409		else if (offset >= AB9540_INT_GPIO50R &&
 410			 offset <= AB9540_INT_GPIO54R)
 411			ab8500->mask[index + 1] &= ~mask;
 412		else if (offset == AB8540_INT_GPIO43R ||
 413			 offset == AB8540_INT_GPIO44R)
 414			/* Here the falling IRQ is one bit lower */
 415			ab8500->mask[index] &= ~(mask << 1);
 416		else
 417			ab8500->mask[index] &= ~mask;
 418	} else {
 419		/* Satisfies the case where type is not set. */
 420		ab8500->mask[index] &= ~mask;
 421	}
 422}
 423
 424static int ab8500_irq_set_type(struct irq_data *data, unsigned int type)
 425{
 426	return 0;
 427}
 428
 429static struct irq_chip ab8500_irq_chip = {
 430	.name			= "ab8500",
 431	.irq_bus_lock		= ab8500_irq_lock,
 432	.irq_bus_sync_unlock	= ab8500_irq_sync_unlock,
 433	.irq_mask		= ab8500_irq_mask,
 434	.irq_disable		= ab8500_irq_mask,
 435	.irq_unmask		= ab8500_irq_unmask,
 436	.irq_set_type		= ab8500_irq_set_type,
 437};
 438
 439static void update_latch_offset(u8 *offset, int i)
 440{
 441	/* Fix inconsistent ITFromLatch25 bit mapping... */
 442	if (unlikely(*offset == 17))
 443		*offset = 24;
 444	/* Fix inconsistent ab8540 bit mapping... */
 445	if (unlikely(*offset == 16))
 446		*offset = 25;
 447	if ((i == 3) && (*offset >= 24))
 448		*offset += 2;
 449}
 450
 451static int ab8500_handle_hierarchical_line(struct ab8500 *ab8500,
 452					int latch_offset, u8 latch_val)
 453{
 454	int int_bit, line, i;
 455
 456	for (i = 0; i < ab8500->mask_size; i++)
 457		if (ab8500->irq_reg_offset[i] == latch_offset)
 458			break;
 459
 460	if (i >= ab8500->mask_size) {
 461		dev_err(ab8500->dev, "Register offset 0x%2x not declared\n",
 462				latch_offset);
 463		return -ENXIO;
 464	}
 465
 466	/* ignore masked out interrupts */
 467	latch_val &= ~ab8500->mask[i];
 468
 469	while (latch_val) {
 470		int_bit = __ffs(latch_val);
 471		line = (i << 3) + int_bit;
 472		latch_val &= ~(1 << int_bit);
 473
 474		/*
 475		 * This handles the falling edge hwirqs from the GPIO
 476		 * lines. Route them back to the line registered for the
 477		 * rising IRQ, as this is merely a flag for the same IRQ
 478		 * in linux terms.
 479		 */
 480		if (line >= AB8500_INT_GPIO6F && line <= AB8500_INT_GPIO41F)
 481			line -= 16;
 482		if (line >= AB9540_INT_GPIO50F && line <= AB9540_INT_GPIO54F)
 483			line -= 8;
 484		if (line == AB8540_INT_GPIO43F || line == AB8540_INT_GPIO44F)
 485			line += 1;
 486
 487		handle_nested_irq(irq_find_mapping(ab8500->domain, line));
 488	}
 489
 490	return 0;
 491}
 492
 493static int ab8500_handle_hierarchical_latch(struct ab8500 *ab8500,
 494					int hier_offset, u8 hier_val)
 495{
 496	int latch_bit, status;
 497	u8 latch_offset, latch_val;
 498
 499	do {
 500		latch_bit = __ffs(hier_val);
 501		latch_offset = (hier_offset << 3) + latch_bit;
 502
 503		update_latch_offset(&latch_offset, hier_offset);
 504
 505		status = get_register_interruptible(ab8500,
 506				AB8500_INTERRUPT,
 507				AB8500_IT_LATCH1_REG + latch_offset,
 508				&latch_val);
 509		if (status < 0 || latch_val == 0)
 510			goto discard;
 511
 512		status = ab8500_handle_hierarchical_line(ab8500,
 513				latch_offset, latch_val);
 514		if (status < 0)
 515			return status;
 516discard:
 517		hier_val &= ~(1 << latch_bit);
 518	} while (hier_val);
 519
 520	return 0;
 521}
 522
 523static irqreturn_t ab8500_hierarchical_irq(int irq, void *dev)
 524{
 525	struct ab8500 *ab8500 = dev;
 526	u8 i;
 527
 528	dev_vdbg(ab8500->dev, "interrupt\n");
 529
 530	/*  Hierarchical interrupt version */
 531	for (i = 0; i < (ab8500->it_latchhier_num); i++) {
 532		int status;
 533		u8 hier_val;
 534
 535		status = get_register_interruptible(ab8500, AB8500_INTERRUPT,
 536			AB8500_IT_LATCHHIER1_REG + i, &hier_val);
 537		if (status < 0 || hier_val == 0)
 538			continue;
 539
 540		status = ab8500_handle_hierarchical_latch(ab8500, i, hier_val);
 541		if (status < 0)
 542			break;
 543	}
 544	return IRQ_HANDLED;
 545}
 546
 547static int ab8500_irq_map(struct irq_domain *d, unsigned int virq,
 548				irq_hw_number_t hwirq)
 549{
 550	struct ab8500 *ab8500 = d->host_data;
 551
 552	if (!ab8500)
 553		return -EINVAL;
 554
 555	irq_set_chip_data(virq, ab8500);
 556	irq_set_chip_and_handler(virq, &ab8500_irq_chip,
 557				handle_simple_irq);
 558	irq_set_nested_thread(virq, 1);
 559	irq_set_noprobe(virq);
 560
 561	return 0;
 562}
 563
 564static const struct irq_domain_ops ab8500_irq_ops = {
 565	.map    = ab8500_irq_map,
 566	.xlate  = irq_domain_xlate_twocell,
 567};
 568
 569static int ab8500_irq_init(struct ab8500 *ab8500, struct device_node *np)
 570{
 571	int num_irqs;
 572
 573	if (is_ab8540(ab8500))
 574		num_irqs = AB8540_NR_IRQS;
 575	else if (is_ab9540(ab8500))
 576		num_irqs = AB9540_NR_IRQS;
 577	else if (is_ab8505(ab8500))
 578		num_irqs = AB8505_NR_IRQS;
 579	else
 580		num_irqs = AB8500_NR_IRQS;
 581
 582	/* If ->irq_base is zero this will give a linear mapping */
 583	ab8500->domain = irq_domain_add_simple(ab8500->dev->of_node,
 584					       num_irqs, 0,
 585					       &ab8500_irq_ops, ab8500);
 586
 587	if (!ab8500->domain) {
 588		dev_err(ab8500->dev, "Failed to create irqdomain\n");
 589		return -ENODEV;
 590	}
 591
 592	return 0;
 593}
 594
 595int ab8500_suspend(struct ab8500 *ab8500)
 596{
 597	if (atomic_read(&ab8500->transfer_ongoing))
 598		return -EINVAL;
 599
 600	return 0;
 601}
 602
 603static const struct mfd_cell ab8500_bm_devs[] = {
 604	MFD_CELL_OF("ab8500-charger", NULL, NULL, 0, 0,
 605		    "stericsson,ab8500-charger"),
 606	MFD_CELL_OF("ab8500-btemp", NULL, NULL, 0, 0,
 607		    "stericsson,ab8500-btemp"),
 608	MFD_CELL_OF("ab8500-fg", NULL, NULL, 0, 0,
 609		    "stericsson,ab8500-fg"),
 610	MFD_CELL_OF("ab8500-chargalg", NULL, NULL, 0, 0,
 611		    "stericsson,ab8500-chargalg"),
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 612};
 613
 614static const struct mfd_cell ab8500_devs[] = {
 615	MFD_CELL_OF("ab8500-sysctrl",
 616		    NULL, NULL, 0, 0, "stericsson,ab8500-sysctrl"),
 617	MFD_CELL_OF("ab8500-ext-regulator",
 618		    NULL, NULL, 0, 0, "stericsson,ab8500-ext-regulator"),
 619	MFD_CELL_OF("ab8500-regulator",
 620		    NULL, NULL, 0, 0, "stericsson,ab8500-regulator"),
 621	MFD_CELL_OF("ab8500-clk",
 622		    NULL, NULL, 0, 0, "stericsson,ab8500-clk"),
 623	MFD_CELL_OF("ab8500-gpadc",
 624		    NULL, NULL, 0, 0, "stericsson,ab8500-gpadc"),
 625	MFD_CELL_OF("ab8500-rtc",
 626		    NULL, NULL, 0, 0, "stericsson,ab8500-rtc"),
 627	MFD_CELL_OF("ab8500-acc-det",
 628		    NULL, NULL, 0, 0, "stericsson,ab8500-acc-det"),
 629	MFD_CELL_OF("ab8500-poweron-key",
 630		    NULL, NULL, 0, 0, "stericsson,ab8500-poweron-key"),
 631	MFD_CELL_OF("ab8500-pwm",
 632		    NULL, NULL, 0, 1, "stericsson,ab8500-pwm"),
 633	MFD_CELL_OF("ab8500-pwm",
 634		    NULL, NULL, 0, 2, "stericsson,ab8500-pwm"),
 635	MFD_CELL_OF("ab8500-pwm",
 636		    NULL, NULL, 0, 3, "stericsson,ab8500-pwm"),
 637	MFD_CELL_OF("ab8500-denc",
 638		    NULL, NULL, 0, 0, "stericsson,ab8500-denc"),
 639	MFD_CELL_OF("pinctrl-ab8500",
 640		    NULL, NULL, 0, 0, "stericsson,ab8500-gpio"),
 641	MFD_CELL_OF("abx500-temp",
 642		    NULL, NULL, 0, 0, "stericsson,abx500-temp"),
 643	MFD_CELL_OF("ab8500-usb",
 644		    NULL, NULL, 0, 0, "stericsson,ab8500-usb"),
 645	MFD_CELL_OF("ab8500-codec",
 646		    NULL, NULL, 0, 0, "stericsson,ab8500-codec"),
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 647};
 648
 649static const struct mfd_cell ab9540_devs[] = {
 
 
 
 
 
 650	{
 651		.name = "ab8500-sysctrl",
 652	},
 653	{
 654		.name = "ab8500-ext-regulator",
 655	},
 656	{
 657		.name = "ab8500-regulator",
 658	},
 659	{
 660		.name = "abx500-clk",
 661		.of_compatible = "stericsson,abx500-clk",
 662	},
 663	{
 664		.name = "ab8500-gpadc",
 665		.of_compatible = "stericsson,ab8500-gpadc",
 666	},
 667	{
 668		.name = "ab8500-rtc",
 669	},
 670	{
 671		.name = "ab8500-acc-det",
 672	},
 673	{
 674		.name = "ab8500-poweron-key",
 675	},
 676	{
 677		.name = "ab8500-pwm",
 678		.id = 1,
 679	},
 680	{
 681		.name = "abx500-temp",
 682	},
 683	{
 684		.name = "pinctrl-ab9540",
 685		.of_compatible = "stericsson,ab9540-gpio",
 686	},
 687	{
 688		.name = "ab9540-usb",
 689	},
 690	{
 691		.name = "ab9540-codec",
 692	},
 693	{
 694		.name = "ab-iddet",
 695	},
 696};
 697
 698/* Device list for ab8505  */
 699static const struct mfd_cell ab8505_devs[] = {
 
 
 
 
 
 700	{
 701		.name = "ab8500-sysctrl",
 702		.of_compatible = "stericsson,ab8500-sysctrl",
 703	},
 704	{
 705		.name = "ab8500-regulator",
 706		.of_compatible = "stericsson,ab8505-regulator",
 707	},
 708	{
 709		.name = "abx500-clk",
 710		.of_compatible = "stericsson,ab8500-clk",
 711	},
 712	{
 713		.name = "ab8500-gpadc",
 714		.of_compatible = "stericsson,ab8500-gpadc",
 715	},
 716	{
 717		.name = "ab8500-rtc",
 718		.of_compatible = "stericsson,ab8500-rtc",
 719	},
 720	{
 721		.name = "ab8500-acc-det",
 722		.of_compatible = "stericsson,ab8500-acc-det",
 723	},
 724	{
 725		.name = "ab8500-poweron-key",
 726		.of_compatible = "stericsson,ab8500-poweron-key",
 727	},
 728	{
 729		.name = "ab8500-pwm",
 730		.of_compatible = "stericsson,ab8500-pwm",
 731		.id = 1,
 732	},
 733	{
 734		.name = "pinctrl-ab8505",
 735		.of_compatible = "stericsson,ab8505-gpio",
 736	},
 737	{
 738		.name = "ab8500-usb",
 739		.of_compatible = "stericsson,ab8500-usb",
 740	},
 741	{
 742		.name = "ab8500-codec",
 743		.of_compatible = "stericsson,ab8500-codec",
 744	},
 745	{
 746		.name = "ab-iddet",
 747	},
 748};
 749
 750static const struct mfd_cell ab8540_devs[] = {
 
 
 
 
 
 751	{
 752		.name = "ab8500-sysctrl",
 753	},
 754	{
 755		.name = "ab8500-ext-regulator",
 756	},
 757	{
 758		.name = "ab8500-regulator",
 759	},
 760	{
 761		.name = "abx500-clk",
 762		.of_compatible = "stericsson,abx500-clk",
 763	},
 764	{
 765		.name = "ab8500-gpadc",
 766		.of_compatible = "stericsson,ab8500-gpadc",
 767	},
 768	{
 769		.name = "ab8500-acc-det",
 770	},
 771	{
 772		.name = "ab8500-poweron-key",
 773	},
 774	{
 775		.name = "ab8500-pwm",
 776		.id = 1,
 777	},
 778	{
 779		.name = "abx500-temp",
 780	},
 781	{
 782		.name = "pinctrl-ab8540",
 783	},
 784	{
 785		.name = "ab8540-usb",
 786	},
 787	{
 788		.name = "ab8540-codec",
 789	},
 790	{
 791		.name = "ab-iddet",
 792	},
 793};
 794
 795static const struct mfd_cell ab8540_cut1_devs[] = {
 796	{
 797		.name = "ab8500-rtc",
 798		.of_compatible = "stericsson,ab8500-rtc",
 799	},
 800};
 801
 802static const struct mfd_cell ab8540_cut2_devs[] = {
 803	{
 804		.name = "ab8540-rtc",
 805		.of_compatible = "stericsson,ab8540-rtc",
 806	},
 807};
 808
 809static ssize_t chip_id_show(struct device *dev,
 810			    struct device_attribute *attr, char *buf)
 811{
 812	struct ab8500 *ab8500;
 813
 814	ab8500 = dev_get_drvdata(dev);
 815
 816	return sprintf(buf, "%#x\n", ab8500 ? ab8500->chip_id : -EINVAL);
 817}
 818
 819/*
 820 * ab8500 has switched off due to (SWITCH_OFF_STATUS):
 821 * 0x01 Swoff bit programming
 822 * 0x02 Thermal protection activation
 823 * 0x04 Vbat lower then BattOk falling threshold
 824 * 0x08 Watchdog expired
 825 * 0x10 Non presence of 32kHz clock
 826 * 0x20 Battery level lower than power on reset threshold
 827 * 0x40 Power on key 1 pressed longer than 10 seconds
 828 * 0x80 DB8500 thermal shutdown
 829 */
 830static ssize_t switch_off_status_show(struct device *dev,
 831				      struct device_attribute *attr, char *buf)
 832{
 833	int ret;
 834	u8 value;
 835	struct ab8500 *ab8500;
 836
 837	ab8500 = dev_get_drvdata(dev);
 838	ret = get_register_interruptible(ab8500, AB8500_RTC,
 839		AB8500_SWITCH_OFF_STATUS, &value);
 840	if (ret < 0)
 841		return ret;
 842	return sprintf(buf, "%#x\n", value);
 843}
 844
 845/* use mask and set to override the register turn_on_stat value */
 846void ab8500_override_turn_on_stat(u8 mask, u8 set)
 847{
 848	spin_lock(&on_stat_lock);
 849	turn_on_stat_mask = mask;
 850	turn_on_stat_set = set;
 851	spin_unlock(&on_stat_lock);
 852}
 853
 854/*
 855 * ab8500 has turned on due to (TURN_ON_STATUS):
 856 * 0x01 PORnVbat
 857 * 0x02 PonKey1dbF
 858 * 0x04 PonKey2dbF
 859 * 0x08 RTCAlarm
 860 * 0x10 MainChDet
 861 * 0x20 VbusDet
 862 * 0x40 UsbIDDetect
 863 * 0x80 Reserved
 864 */
 865static ssize_t turn_on_status_show(struct device *dev,
 866				   struct device_attribute *attr, char *buf)
 867{
 868	int ret;
 869	u8 value;
 870	struct ab8500 *ab8500;
 871
 872	ab8500 = dev_get_drvdata(dev);
 873	ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
 874		AB8500_TURN_ON_STATUS, &value);
 875	if (ret < 0)
 876		return ret;
 877
 878	/*
 879	 * In L9540, turn_on_status register is not updated correctly if
 880	 * the device is rebooted with AC/USB charger connected. Due to
 881	 * this, the device boots android instead of entering into charge
 882	 * only mode. Read the AC/USB status register to detect the charger
 883	 * presence and update the turn on status manually.
 884	 */
 885	if (is_ab9540(ab8500)) {
 886		spin_lock(&on_stat_lock);
 887		value = (value & turn_on_stat_mask) | turn_on_stat_set;
 888		spin_unlock(&on_stat_lock);
 889	}
 890
 891	return sprintf(buf, "%#x\n", value);
 892}
 893
 894static ssize_t turn_on_status_2_show(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		AB8505_TURN_ON_STATUS_2, &value);
 904	if (ret < 0)
 905		return ret;
 906	return sprintf(buf, "%#x\n", (value & 0x1));
 907}
 908
 909static ssize_t dbbrstn_show(struct device *dev,
 910			    struct device_attribute *attr, char *buf)
 911{
 912	struct ab8500 *ab8500;
 913	int ret;
 914	u8 value;
 915
 916	ab8500 = dev_get_drvdata(dev);
 917
 918	ret = get_register_interruptible(ab8500, AB8500_REGU_CTRL2,
 919		AB9540_MODEM_CTRL2_REG, &value);
 920	if (ret < 0)
 921		return ret;
 922
 923	return sprintf(buf, "%d\n",
 924			(value & AB9540_MODEM_CTRL2_SWDBBRSTN_BIT) ? 1 : 0);
 925}
 926
 927static ssize_t dbbrstn_store(struct device *dev,
 928	struct device_attribute *attr, const char *buf, size_t count)
 929{
 930	struct ab8500 *ab8500;
 931	int ret = count;
 932	int err;
 933	u8 bitvalues;
 934
 935	ab8500 = dev_get_drvdata(dev);
 936
 937	if (count > 0) {
 938		switch (buf[0]) {
 939		case '0':
 940			bitvalues = 0;
 941			break;
 942		case '1':
 943			bitvalues = AB9540_MODEM_CTRL2_SWDBBRSTN_BIT;
 944			break;
 945		default:
 946			goto exit;
 947		}
 948
 949		err = mask_and_set_register_interruptible(ab8500,
 950			AB8500_REGU_CTRL2, AB9540_MODEM_CTRL2_REG,
 951			AB9540_MODEM_CTRL2_SWDBBRSTN_BIT, bitvalues);
 952		if (err)
 953			dev_info(ab8500->dev,
 954				"Failed to set DBBRSTN %c, err %#x\n",
 955				buf[0], err);
 956	}
 957
 958exit:
 959	return ret;
 960}
 961
 962static DEVICE_ATTR_RO(chip_id);
 963static DEVICE_ATTR_RO(switch_off_status);
 964static DEVICE_ATTR_RO(turn_on_status);
 965static DEVICE_ATTR_RO(turn_on_status_2);
 966static DEVICE_ATTR_RW(dbbrstn);
 
 967
 968static struct attribute *ab8500_sysfs_entries[] = {
 969	&dev_attr_chip_id.attr,
 970	&dev_attr_switch_off_status.attr,
 971	&dev_attr_turn_on_status.attr,
 972	NULL,
 973};
 974
 975static struct attribute *ab8505_sysfs_entries[] = {
 976	&dev_attr_turn_on_status_2.attr,
 977	NULL,
 978};
 979
 980static struct attribute *ab9540_sysfs_entries[] = {
 981	&dev_attr_chip_id.attr,
 982	&dev_attr_switch_off_status.attr,
 983	&dev_attr_turn_on_status.attr,
 984	&dev_attr_dbbrstn.attr,
 985	NULL,
 986};
 987
 988static const struct attribute_group ab8500_attr_group = {
 989	.attrs	= ab8500_sysfs_entries,
 990};
 991
 992static const struct attribute_group ab8505_attr_group = {
 993	.attrs	= ab8505_sysfs_entries,
 994};
 995
 996static const struct attribute_group ab9540_attr_group = {
 997	.attrs	= ab9540_sysfs_entries,
 998};
 999
1000static int ab8500_probe(struct platform_device *pdev)
1001{
1002	static const char * const switch_off_status[] = {
1003		"Swoff bit programming",
1004		"Thermal protection activation",
1005		"Vbat lower then BattOk falling threshold",
1006		"Watchdog expired",
1007		"Non presence of 32kHz clock",
1008		"Battery level lower than power on reset threshold",
1009		"Power on key 1 pressed longer than 10 seconds",
1010		"DB8500 thermal shutdown"};
1011	static const char * const turn_on_status[] = {
1012		"Battery rising (Vbat)",
1013		"Power On Key 1 dbF",
1014		"Power On Key 2 dbF",
1015		"RTC Alarm",
1016		"Main Charger Detect",
1017		"Vbus Detect (USB)",
1018		"USB ID Detect",
1019		"UART Factory Mode Detect"};
1020	const struct platform_device_id *platid = platform_get_device_id(pdev);
1021	enum ab8500_version version = AB8500_VERSION_UNDEFINED;
1022	struct device_node *np = pdev->dev.of_node;
1023	struct ab8500 *ab8500;
 
1024	int ret;
1025	int i;
1026	int irq;
1027	u8 value;
1028
1029	ab8500 = devm_kzalloc(&pdev->dev, sizeof(*ab8500), GFP_KERNEL);
1030	if (!ab8500)
1031		return -ENOMEM;
1032
1033	ab8500->dev = &pdev->dev;
1034
1035	irq = platform_get_irq(pdev, 0);
1036	if (irq < 0)
1037		return irq;
 
 
1038
1039	ab8500->irq = irq;
1040
1041	ab8500->read = ab8500_prcmu_read;
1042	ab8500->write = ab8500_prcmu_write;
1043	ab8500->write_masked = ab8500_prcmu_write_masked;
1044
1045	mutex_init(&ab8500->lock);
1046	mutex_init(&ab8500->irq_lock);
1047	atomic_set(&ab8500->transfer_ongoing, 0);
1048
1049	platform_set_drvdata(pdev, ab8500);
1050
1051	if (platid)
1052		version = platid->driver_data;
1053
1054	if (version != AB8500_VERSION_UNDEFINED)
1055		ab8500->version = version;
1056	else {
1057		ret = get_register_interruptible(ab8500, AB8500_MISC,
1058			AB8500_IC_NAME_REG, &value);
1059		if (ret < 0) {
1060			dev_err(&pdev->dev, "could not probe HW\n");
1061			return ret;
1062		}
1063
1064		ab8500->version = value;
1065	}
1066
1067	ret = get_register_interruptible(ab8500, AB8500_MISC,
1068		AB8500_REV_REG, &value);
1069	if (ret < 0)
1070		return ret;
1071
1072	ab8500->chip_id = value;
1073
1074	dev_info(ab8500->dev, "detected chip, %s rev. %1x.%1x\n",
1075			ab8500_version_str[ab8500->version],
1076			ab8500->chip_id >> 4,
1077			ab8500->chip_id & 0x0F);
1078
1079	/* Configure AB8540 */
1080	if (is_ab8540(ab8500)) {
1081		ab8500->mask_size = AB8540_NUM_IRQ_REGS;
1082		ab8500->irq_reg_offset = ab8540_irq_regoffset;
1083		ab8500->it_latchhier_num = AB8540_IT_LATCHHIER_NUM;
1084	} /* Configure AB8500 or AB9540 IRQ */
1085	else if (is_ab9540(ab8500) || is_ab8505(ab8500)) {
1086		ab8500->mask_size = AB9540_NUM_IRQ_REGS;
1087		ab8500->irq_reg_offset = ab9540_irq_regoffset;
1088		ab8500->it_latchhier_num = AB8500_IT_LATCHHIER_NUM;
1089	} else {
1090		ab8500->mask_size = AB8500_NUM_IRQ_REGS;
1091		ab8500->irq_reg_offset = ab8500_irq_regoffset;
1092		ab8500->it_latchhier_num = AB8500_IT_LATCHHIER_NUM;
1093	}
1094	ab8500->mask = devm_kzalloc(&pdev->dev, ab8500->mask_size,
1095				    GFP_KERNEL);
1096	if (!ab8500->mask)
1097		return -ENOMEM;
1098	ab8500->oldmask = devm_kzalloc(&pdev->dev, ab8500->mask_size,
1099				       GFP_KERNEL);
1100	if (!ab8500->oldmask)
1101		return -ENOMEM;
1102
1103	/*
1104	 * ab8500 has switched off due to (SWITCH_OFF_STATUS):
1105	 * 0x01 Swoff bit programming
1106	 * 0x02 Thermal protection activation
1107	 * 0x04 Vbat lower then BattOk falling threshold
1108	 * 0x08 Watchdog expired
1109	 * 0x10 Non presence of 32kHz clock
1110	 * 0x20 Battery level lower than power on reset threshold
1111	 * 0x40 Power on key 1 pressed longer than 10 seconds
1112	 * 0x80 DB8500 thermal shutdown
1113	 */
1114
1115	ret = get_register_interruptible(ab8500, AB8500_RTC,
1116		AB8500_SWITCH_OFF_STATUS, &value);
1117	if (ret < 0)
1118		return ret;
1119	dev_info(ab8500->dev, "switch off cause(s) (%#x): ", value);
1120
1121	if (value) {
1122		for (i = 0; i < ARRAY_SIZE(switch_off_status); i++) {
1123			if (value & 1)
1124				pr_cont(" \"%s\"", switch_off_status[i]);
1125			value = value >> 1;
1126
1127		}
1128		pr_cont("\n");
1129	} else {
1130		pr_cont(" None\n");
1131	}
1132	ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
1133		AB8500_TURN_ON_STATUS, &value);
1134	if (ret < 0)
1135		return ret;
1136	dev_info(ab8500->dev, "turn on reason(s) (%#x): ", value);
1137
1138	if (value) {
1139		for (i = 0; i < ARRAY_SIZE(turn_on_status); i++) {
1140			if (value & 1)
1141				pr_cont("\"%s\" ", turn_on_status[i]);
1142			value = value >> 1;
1143		}
1144		pr_cont("\n");
1145	} else {
1146		pr_cont("None\n");
1147	}
1148
1149	if (is_ab9540(ab8500)) {
1150		ret = get_register_interruptible(ab8500, AB8500_CHARGER,
1151			AB8500_CH_USBCH_STAT1_REG, &value);
1152		if (ret < 0)
1153			return ret;
1154		if ((value & VBUS_DET_DBNC1) && (value & VBUS_DET_DBNC100))
1155			ab8500_override_turn_on_stat(~AB8500_POW_KEY_1_ON,
1156						     AB8500_VBUS_DET);
1157	}
1158
1159	/* Clear and mask all interrupts */
1160	for (i = 0; i < ab8500->mask_size; i++) {
1161		/*
1162		 * Interrupt register 12 doesn't exist prior to AB8500 version
1163		 * 2.0
1164		 */
1165		if (ab8500->irq_reg_offset[i] == 11 &&
1166				is_ab8500_1p1_or_earlier(ab8500))
1167			continue;
1168
1169		if (ab8500->irq_reg_offset[i] < 0)
1170			continue;
1171
1172		get_register_interruptible(ab8500, AB8500_INTERRUPT,
1173			AB8500_IT_LATCH1_REG + ab8500->irq_reg_offset[i],
1174			&value);
1175		set_register_interruptible(ab8500, AB8500_INTERRUPT,
1176			AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i], 0xff);
1177	}
1178
1179	ret = abx500_register_ops(ab8500->dev, &ab8500_ops);
1180	if (ret)
1181		return ret;
1182
1183	for (i = 0; i < ab8500->mask_size; i++)
1184		ab8500->mask[i] = ab8500->oldmask[i] = 0xff;
1185
1186	ret = ab8500_irq_init(ab8500, np);
1187	if (ret)
1188		return ret;
1189
1190	ret = devm_request_threaded_irq(&pdev->dev, ab8500->irq, NULL,
1191			ab8500_hierarchical_irq,
1192			IRQF_ONESHOT | IRQF_NO_SUSPEND,
1193			"ab8500", ab8500);
1194	if (ret)
1195		return ret;
1196
1197	if (is_ab9540(ab8500))
1198		ret = mfd_add_devices(ab8500->dev, 0, ab9540_devs,
1199				ARRAY_SIZE(ab9540_devs), NULL,
1200				0, ab8500->domain);
1201	else if (is_ab8540(ab8500)) {
1202		ret = mfd_add_devices(ab8500->dev, 0, ab8540_devs,
1203			      ARRAY_SIZE(ab8540_devs), NULL,
1204			      0, ab8500->domain);
1205		if (ret)
1206			return ret;
1207
1208		if (is_ab8540_1p2_or_earlier(ab8500))
1209			ret = mfd_add_devices(ab8500->dev, 0, ab8540_cut1_devs,
1210			      ARRAY_SIZE(ab8540_cut1_devs), NULL,
1211			      0, ab8500->domain);
1212		else /* ab8540 >= cut2 */
1213			ret = mfd_add_devices(ab8500->dev, 0, ab8540_cut2_devs,
1214			      ARRAY_SIZE(ab8540_cut2_devs), NULL,
1215			      0, ab8500->domain);
1216	} else if (is_ab8505(ab8500))
1217		ret = mfd_add_devices(ab8500->dev, 0, ab8505_devs,
1218			      ARRAY_SIZE(ab8505_devs), NULL,
1219			      0, ab8500->domain);
1220	else
1221		ret = mfd_add_devices(ab8500->dev, 0, ab8500_devs,
1222				ARRAY_SIZE(ab8500_devs), NULL,
1223				0, ab8500->domain);
1224	if (ret)
1225		return ret;
1226
1227	/* Add battery management devices */
1228	ret = mfd_add_devices(ab8500->dev, 0, ab8500_bm_devs,
1229			      ARRAY_SIZE(ab8500_bm_devs), NULL,
1230			      0, ab8500->domain);
1231	if (ret)
1232		dev_err(ab8500->dev, "error adding bm devices\n");
 
 
1233
1234	if (((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
1235			ab8500->chip_id >= AB8500_CUT2P0) || is_ab8540(ab8500))
1236		ret = sysfs_create_group(&ab8500->dev->kobj,
1237					&ab9540_attr_group);
1238	else
1239		ret = sysfs_create_group(&ab8500->dev->kobj,
1240					&ab8500_attr_group);
1241
1242	if ((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
1243			ab8500->chip_id >= AB8500_CUT2P0)
1244		ret = sysfs_create_group(&ab8500->dev->kobj,
1245					 &ab8505_attr_group);
1246
1247	if (ret)
1248		dev_err(ab8500->dev, "error creating sysfs entries\n");
1249
1250	return ret;
1251}
1252
1253static const struct platform_device_id ab8500_id[] = {
1254	{ "ab8500-core", AB8500_VERSION_AB8500 },
1255	{ "ab8505-core", AB8500_VERSION_AB8505 },
1256	{ "ab9540-i2c", AB8500_VERSION_AB9540 },
1257	{ "ab8540-i2c", AB8500_VERSION_AB8540 },
1258	{ }
1259};
1260
1261static struct platform_driver ab8500_core_driver = {
1262	.driver = {
1263		.name = "ab8500-core",
1264		.suppress_bind_attrs = true,
1265	},
1266	.probe	= ab8500_probe,
1267	.id_table = ab8500_id,
1268};
1269
1270static int __init ab8500_core_init(void)
1271{
1272	return platform_driver_register(&ab8500_core_driver);
1273}
1274core_initcall(ab8500_core_init);
v5.4
   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	{
 614		.name = "ab8500-charger",
 615		.of_compatible = "stericsson,ab8500-charger",
 616		.platform_data = &ab8500_bm_data,
 617		.pdata_size = sizeof(ab8500_bm_data),
 618	},
 619	{
 620		.name = "ab8500-btemp",
 621		.of_compatible = "stericsson,ab8500-btemp",
 622		.platform_data = &ab8500_bm_data,
 623		.pdata_size = sizeof(ab8500_bm_data),
 624	},
 625	{
 626		.name = "ab8500-fg",
 627		.of_compatible = "stericsson,ab8500-fg",
 628		.platform_data = &ab8500_bm_data,
 629		.pdata_size = sizeof(ab8500_bm_data),
 630	},
 631	{
 632		.name = "ab8500-chargalg",
 633		.of_compatible = "stericsson,ab8500-chargalg",
 634		.platform_data = &ab8500_bm_data,
 635		.pdata_size = sizeof(ab8500_bm_data),
 636	},
 637};
 638
 639static const struct mfd_cell ab8500_devs[] = {
 640#ifdef CONFIG_DEBUG_FS
 641	{
 642		.name = "ab8500-debug",
 643		.of_compatible = "stericsson,ab8500-debug",
 644	},
 645#endif
 646	{
 647		.name = "ab8500-sysctrl",
 648		.of_compatible = "stericsson,ab8500-sysctrl",
 649	},
 650	{
 651		.name = "ab8500-ext-regulator",
 652		.of_compatible = "stericsson,ab8500-ext-regulator",
 653	},
 654	{
 655		.name = "ab8500-regulator",
 656		.of_compatible = "stericsson,ab8500-regulator",
 657	},
 658	{
 659		.name = "ab8500-clk",
 660		.of_compatible = "stericsson,ab8500-clk",
 661	},
 662	{
 663		.name = "ab8500-gpadc",
 664		.of_compatible = "stericsson,ab8500-gpadc",
 665	},
 666	{
 667		.name = "ab8500-rtc",
 668		.of_compatible = "stericsson,ab8500-rtc",
 669	},
 670	{
 671		.name = "ab8500-acc-det",
 672		.of_compatible = "stericsson,ab8500-acc-det",
 673	},
 674	{
 675
 676		.name = "ab8500-poweron-key",
 677		.of_compatible = "stericsson,ab8500-poweron-key",
 678	},
 679	{
 680		.name = "ab8500-pwm",
 681		.of_compatible = "stericsson,ab8500-pwm",
 682		.id = 1,
 683	},
 684	{
 685		.name = "ab8500-pwm",
 686		.of_compatible = "stericsson,ab8500-pwm",
 687		.id = 2,
 688	},
 689	{
 690		.name = "ab8500-pwm",
 691		.of_compatible = "stericsson,ab8500-pwm",
 692		.id = 3,
 693	},
 694	{
 695		.name = "ab8500-denc",
 696		.of_compatible = "stericsson,ab8500-denc",
 697	},
 698	{
 699		.name = "pinctrl-ab8500",
 700		.of_compatible = "stericsson,ab8500-gpio",
 701	},
 702	{
 703		.name = "abx500-temp",
 704		.of_compatible = "stericsson,abx500-temp",
 705	},
 706	{
 707		.name = "ab8500-usb",
 708		.of_compatible = "stericsson,ab8500-usb",
 709	},
 710	{
 711		.name = "ab8500-codec",
 712		.of_compatible = "stericsson,ab8500-codec",
 713	},
 714};
 715
 716static const struct mfd_cell ab9540_devs[] = {
 717#ifdef CONFIG_DEBUG_FS
 718	{
 719		.name = "ab8500-debug",
 720	},
 721#endif
 722	{
 723		.name = "ab8500-sysctrl",
 724	},
 725	{
 726		.name = "ab8500-ext-regulator",
 727	},
 728	{
 729		.name = "ab8500-regulator",
 730	},
 731	{
 732		.name = "abx500-clk",
 733		.of_compatible = "stericsson,abx500-clk",
 734	},
 735	{
 736		.name = "ab8500-gpadc",
 737		.of_compatible = "stericsson,ab8500-gpadc",
 738	},
 739	{
 740		.name = "ab8500-rtc",
 741	},
 742	{
 743		.name = "ab8500-acc-det",
 744	},
 745	{
 746		.name = "ab8500-poweron-key",
 747	},
 748	{
 749		.name = "ab8500-pwm",
 750		.id = 1,
 751	},
 752	{
 753		.name = "abx500-temp",
 754	},
 755	{
 756		.name = "pinctrl-ab9540",
 757		.of_compatible = "stericsson,ab9540-gpio",
 758	},
 759	{
 760		.name = "ab9540-usb",
 761	},
 762	{
 763		.name = "ab9540-codec",
 764	},
 765	{
 766		.name = "ab-iddet",
 767	},
 768};
 769
 770/* Device list for ab8505  */
 771static const struct mfd_cell ab8505_devs[] = {
 772#ifdef CONFIG_DEBUG_FS
 773	{
 774		.name = "ab8500-debug",
 775	},
 776#endif
 777	{
 778		.name = "ab8500-sysctrl",
 
 779	},
 780	{
 781		.name = "ab8500-regulator",
 
 782	},
 783	{
 784		.name = "abx500-clk",
 785		.of_compatible = "stericsson,abx500-clk",
 786	},
 787	{
 788		.name = "ab8500-gpadc",
 789		.of_compatible = "stericsson,ab8500-gpadc",
 790	},
 791	{
 792		.name = "ab8500-rtc",
 
 793	},
 794	{
 795		.name = "ab8500-acc-det",
 
 796	},
 797	{
 798		.name = "ab8500-poweron-key",
 
 799	},
 800	{
 801		.name = "ab8500-pwm",
 
 802		.id = 1,
 803	},
 804	{
 805		.name = "pinctrl-ab8505",
 
 806	},
 807	{
 808		.name = "ab8500-usb",
 
 809	},
 810	{
 811		.name = "ab8500-codec",
 
 812	},
 813	{
 814		.name = "ab-iddet",
 815	},
 816};
 817
 818static const struct mfd_cell ab8540_devs[] = {
 819#ifdef CONFIG_DEBUG_FS
 820	{
 821		.name = "ab8500-debug",
 822	},
 823#endif
 824	{
 825		.name = "ab8500-sysctrl",
 826	},
 827	{
 828		.name = "ab8500-ext-regulator",
 829	},
 830	{
 831		.name = "ab8500-regulator",
 832	},
 833	{
 834		.name = "abx500-clk",
 835		.of_compatible = "stericsson,abx500-clk",
 836	},
 837	{
 838		.name = "ab8500-gpadc",
 839		.of_compatible = "stericsson,ab8500-gpadc",
 840	},
 841	{
 842		.name = "ab8500-acc-det",
 843	},
 844	{
 845		.name = "ab8500-poweron-key",
 846	},
 847	{
 848		.name = "ab8500-pwm",
 849		.id = 1,
 850	},
 851	{
 852		.name = "abx500-temp",
 853	},
 854	{
 855		.name = "pinctrl-ab8540",
 856	},
 857	{
 858		.name = "ab8540-usb",
 859	},
 860	{
 861		.name = "ab8540-codec",
 862	},
 863	{
 864		.name = "ab-iddet",
 865	},
 866};
 867
 868static const struct mfd_cell ab8540_cut1_devs[] = {
 869	{
 870		.name = "ab8500-rtc",
 871		.of_compatible = "stericsson,ab8500-rtc",
 872	},
 873};
 874
 875static const struct mfd_cell ab8540_cut2_devs[] = {
 876	{
 877		.name = "ab8540-rtc",
 878		.of_compatible = "stericsson,ab8540-rtc",
 879	},
 880};
 881
 882static ssize_t show_chip_id(struct device *dev,
 883				struct device_attribute *attr, char *buf)
 884{
 885	struct ab8500 *ab8500;
 886
 887	ab8500 = dev_get_drvdata(dev);
 888
 889	return sprintf(buf, "%#x\n", ab8500 ? ab8500->chip_id : -EINVAL);
 890}
 891
 892/*
 893 * ab8500 has switched off due to (SWITCH_OFF_STATUS):
 894 * 0x01 Swoff bit programming
 895 * 0x02 Thermal protection activation
 896 * 0x04 Vbat lower then BattOk falling threshold
 897 * 0x08 Watchdog expired
 898 * 0x10 Non presence of 32kHz clock
 899 * 0x20 Battery level lower than power on reset threshold
 900 * 0x40 Power on key 1 pressed longer than 10 seconds
 901 * 0x80 DB8500 thermal shutdown
 902 */
 903static ssize_t show_switch_off_status(struct device *dev,
 904				struct device_attribute *attr, char *buf)
 905{
 906	int ret;
 907	u8 value;
 908	struct ab8500 *ab8500;
 909
 910	ab8500 = dev_get_drvdata(dev);
 911	ret = get_register_interruptible(ab8500, AB8500_RTC,
 912		AB8500_SWITCH_OFF_STATUS, &value);
 913	if (ret < 0)
 914		return ret;
 915	return sprintf(buf, "%#x\n", value);
 916}
 917
 918/* use mask and set to override the register turn_on_stat value */
 919void ab8500_override_turn_on_stat(u8 mask, u8 set)
 920{
 921	spin_lock(&on_stat_lock);
 922	turn_on_stat_mask = mask;
 923	turn_on_stat_set = set;
 924	spin_unlock(&on_stat_lock);
 925}
 926
 927/*
 928 * ab8500 has turned on due to (TURN_ON_STATUS):
 929 * 0x01 PORnVbat
 930 * 0x02 PonKey1dbF
 931 * 0x04 PonKey2dbF
 932 * 0x08 RTCAlarm
 933 * 0x10 MainChDet
 934 * 0x20 VbusDet
 935 * 0x40 UsbIDDetect
 936 * 0x80 Reserved
 937 */
 938static ssize_t show_turn_on_status(struct device *dev,
 939				struct device_attribute *attr, char *buf)
 940{
 941	int ret;
 942	u8 value;
 943	struct ab8500 *ab8500;
 944
 945	ab8500 = dev_get_drvdata(dev);
 946	ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
 947		AB8500_TURN_ON_STATUS, &value);
 948	if (ret < 0)
 949		return ret;
 950
 951	/*
 952	 * In L9540, turn_on_status register is not updated correctly if
 953	 * the device is rebooted with AC/USB charger connected. Due to
 954	 * this, the device boots android instead of entering into charge
 955	 * only mode. Read the AC/USB status register to detect the charger
 956	 * presence and update the turn on status manually.
 957	 */
 958	if (is_ab9540(ab8500)) {
 959		spin_lock(&on_stat_lock);
 960		value = (value & turn_on_stat_mask) | turn_on_stat_set;
 961		spin_unlock(&on_stat_lock);
 962	}
 963
 964	return sprintf(buf, "%#x\n", value);
 965}
 966
 967static ssize_t show_turn_on_status_2(struct device *dev,
 968				struct device_attribute *attr, char *buf)
 969{
 970	int ret;
 971	u8 value;
 972	struct ab8500 *ab8500;
 973
 974	ab8500 = dev_get_drvdata(dev);
 975	ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
 976		AB8505_TURN_ON_STATUS_2, &value);
 977	if (ret < 0)
 978		return ret;
 979	return sprintf(buf, "%#x\n", (value & 0x1));
 980}
 981
 982static ssize_t show_ab9540_dbbrstn(struct device *dev,
 983				struct device_attribute *attr, char *buf)
 984{
 985	struct ab8500 *ab8500;
 986	int ret;
 987	u8 value;
 988
 989	ab8500 = dev_get_drvdata(dev);
 990
 991	ret = get_register_interruptible(ab8500, AB8500_REGU_CTRL2,
 992		AB9540_MODEM_CTRL2_REG, &value);
 993	if (ret < 0)
 994		return ret;
 995
 996	return sprintf(buf, "%d\n",
 997			(value & AB9540_MODEM_CTRL2_SWDBBRSTN_BIT) ? 1 : 0);
 998}
 999
1000static ssize_t store_ab9540_dbbrstn(struct device *dev,
1001	struct device_attribute *attr, const char *buf, size_t count)
1002{
1003	struct ab8500 *ab8500;
1004	int ret = count;
1005	int err;
1006	u8 bitvalues;
1007
1008	ab8500 = dev_get_drvdata(dev);
1009
1010	if (count > 0) {
1011		switch (buf[0]) {
1012		case '0':
1013			bitvalues = 0;
1014			break;
1015		case '1':
1016			bitvalues = AB9540_MODEM_CTRL2_SWDBBRSTN_BIT;
1017			break;
1018		default:
1019			goto exit;
1020		}
1021
1022		err = mask_and_set_register_interruptible(ab8500,
1023			AB8500_REGU_CTRL2, AB9540_MODEM_CTRL2_REG,
1024			AB9540_MODEM_CTRL2_SWDBBRSTN_BIT, bitvalues);
1025		if (err)
1026			dev_info(ab8500->dev,
1027				"Failed to set DBBRSTN %c, err %#x\n",
1028				buf[0], err);
1029	}
1030
1031exit:
1032	return ret;
1033}
1034
1035static DEVICE_ATTR(chip_id, S_IRUGO, show_chip_id, NULL);
1036static DEVICE_ATTR(switch_off_status, S_IRUGO, show_switch_off_status, NULL);
1037static DEVICE_ATTR(turn_on_status, S_IRUGO, show_turn_on_status, NULL);
1038static DEVICE_ATTR(turn_on_status_2, S_IRUGO, show_turn_on_status_2, NULL);
1039static DEVICE_ATTR(dbbrstn, S_IRUGO | S_IWUSR,
1040			show_ab9540_dbbrstn, store_ab9540_dbbrstn);
1041
1042static struct attribute *ab8500_sysfs_entries[] = {
1043	&dev_attr_chip_id.attr,
1044	&dev_attr_switch_off_status.attr,
1045	&dev_attr_turn_on_status.attr,
1046	NULL,
1047};
1048
1049static struct attribute *ab8505_sysfs_entries[] = {
1050	&dev_attr_turn_on_status_2.attr,
1051	NULL,
1052};
1053
1054static struct attribute *ab9540_sysfs_entries[] = {
1055	&dev_attr_chip_id.attr,
1056	&dev_attr_switch_off_status.attr,
1057	&dev_attr_turn_on_status.attr,
1058	&dev_attr_dbbrstn.attr,
1059	NULL,
1060};
1061
1062static const struct attribute_group ab8500_attr_group = {
1063	.attrs	= ab8500_sysfs_entries,
1064};
1065
1066static const struct attribute_group ab8505_attr_group = {
1067	.attrs	= ab8505_sysfs_entries,
1068};
1069
1070static const struct attribute_group ab9540_attr_group = {
1071	.attrs	= ab9540_sysfs_entries,
1072};
1073
1074static int ab8500_probe(struct platform_device *pdev)
1075{
1076	static const char * const switch_off_status[] = {
1077		"Swoff bit programming",
1078		"Thermal protection activation",
1079		"Vbat lower then BattOk falling threshold",
1080		"Watchdog expired",
1081		"Non presence of 32kHz clock",
1082		"Battery level lower than power on reset threshold",
1083		"Power on key 1 pressed longer than 10 seconds",
1084		"DB8500 thermal shutdown"};
1085	static const char * const turn_on_status[] = {
1086		"Battery rising (Vbat)",
1087		"Power On Key 1 dbF",
1088		"Power On Key 2 dbF",
1089		"RTC Alarm",
1090		"Main Charger Detect",
1091		"Vbus Detect (USB)",
1092		"USB ID Detect",
1093		"UART Factory Mode Detect"};
1094	const struct platform_device_id *platid = platform_get_device_id(pdev);
1095	enum ab8500_version version = AB8500_VERSION_UNDEFINED;
1096	struct device_node *np = pdev->dev.of_node;
1097	struct ab8500 *ab8500;
1098	struct resource *resource;
1099	int ret;
1100	int i;
 
1101	u8 value;
1102
1103	ab8500 = devm_kzalloc(&pdev->dev, sizeof(*ab8500), GFP_KERNEL);
1104	if (!ab8500)
1105		return -ENOMEM;
1106
1107	ab8500->dev = &pdev->dev;
1108
1109	resource = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
1110	if (!resource) {
1111		dev_err(&pdev->dev, "no IRQ resource\n");
1112		return -ENODEV;
1113	}
1114
1115	ab8500->irq = resource->start;
1116
1117	ab8500->read = ab8500_prcmu_read;
1118	ab8500->write = ab8500_prcmu_write;
1119	ab8500->write_masked = ab8500_prcmu_write_masked;
1120
1121	mutex_init(&ab8500->lock);
1122	mutex_init(&ab8500->irq_lock);
1123	atomic_set(&ab8500->transfer_ongoing, 0);
1124
1125	platform_set_drvdata(pdev, ab8500);
1126
1127	if (platid)
1128		version = platid->driver_data;
1129
1130	if (version != AB8500_VERSION_UNDEFINED)
1131		ab8500->version = version;
1132	else {
1133		ret = get_register_interruptible(ab8500, AB8500_MISC,
1134			AB8500_IC_NAME_REG, &value);
1135		if (ret < 0) {
1136			dev_err(&pdev->dev, "could not probe HW\n");
1137			return ret;
1138		}
1139
1140		ab8500->version = value;
1141	}
1142
1143	ret = get_register_interruptible(ab8500, AB8500_MISC,
1144		AB8500_REV_REG, &value);
1145	if (ret < 0)
1146		return ret;
1147
1148	ab8500->chip_id = value;
1149
1150	dev_info(ab8500->dev, "detected chip, %s rev. %1x.%1x\n",
1151			ab8500_version_str[ab8500->version],
1152			ab8500->chip_id >> 4,
1153			ab8500->chip_id & 0x0F);
1154
1155	/* Configure AB8540 */
1156	if (is_ab8540(ab8500)) {
1157		ab8500->mask_size = AB8540_NUM_IRQ_REGS;
1158		ab8500->irq_reg_offset = ab8540_irq_regoffset;
1159		ab8500->it_latchhier_num = AB8540_IT_LATCHHIER_NUM;
1160	} /* Configure AB8500 or AB9540 IRQ */
1161	else if (is_ab9540(ab8500) || is_ab8505(ab8500)) {
1162		ab8500->mask_size = AB9540_NUM_IRQ_REGS;
1163		ab8500->irq_reg_offset = ab9540_irq_regoffset;
1164		ab8500->it_latchhier_num = AB8500_IT_LATCHHIER_NUM;
1165	} else {
1166		ab8500->mask_size = AB8500_NUM_IRQ_REGS;
1167		ab8500->irq_reg_offset = ab8500_irq_regoffset;
1168		ab8500->it_latchhier_num = AB8500_IT_LATCHHIER_NUM;
1169	}
1170	ab8500->mask = devm_kzalloc(&pdev->dev, ab8500->mask_size,
1171				    GFP_KERNEL);
1172	if (!ab8500->mask)
1173		return -ENOMEM;
1174	ab8500->oldmask = devm_kzalloc(&pdev->dev, ab8500->mask_size,
1175				       GFP_KERNEL);
1176	if (!ab8500->oldmask)
1177		return -ENOMEM;
1178
1179	/*
1180	 * ab8500 has switched off due to (SWITCH_OFF_STATUS):
1181	 * 0x01 Swoff bit programming
1182	 * 0x02 Thermal protection activation
1183	 * 0x04 Vbat lower then BattOk falling threshold
1184	 * 0x08 Watchdog expired
1185	 * 0x10 Non presence of 32kHz clock
1186	 * 0x20 Battery level lower than power on reset threshold
1187	 * 0x40 Power on key 1 pressed longer than 10 seconds
1188	 * 0x80 DB8500 thermal shutdown
1189	 */
1190
1191	ret = get_register_interruptible(ab8500, AB8500_RTC,
1192		AB8500_SWITCH_OFF_STATUS, &value);
1193	if (ret < 0)
1194		return ret;
1195	dev_info(ab8500->dev, "switch off cause(s) (%#x): ", value);
1196
1197	if (value) {
1198		for (i = 0; i < ARRAY_SIZE(switch_off_status); i++) {
1199			if (value & 1)
1200				pr_cont(" \"%s\"", switch_off_status[i]);
1201			value = value >> 1;
1202
1203		}
1204		pr_cont("\n");
1205	} else {
1206		pr_cont(" None\n");
1207	}
1208	ret = get_register_interruptible(ab8500, AB8500_SYS_CTRL1_BLOCK,
1209		AB8500_TURN_ON_STATUS, &value);
1210	if (ret < 0)
1211		return ret;
1212	dev_info(ab8500->dev, "turn on reason(s) (%#x): ", value);
1213
1214	if (value) {
1215		for (i = 0; i < ARRAY_SIZE(turn_on_status); i++) {
1216			if (value & 1)
1217				pr_cont("\"%s\" ", turn_on_status[i]);
1218			value = value >> 1;
1219		}
1220		pr_cont("\n");
1221	} else {
1222		pr_cont("None\n");
1223	}
1224
1225	if (is_ab9540(ab8500)) {
1226		ret = get_register_interruptible(ab8500, AB8500_CHARGER,
1227			AB8500_CH_USBCH_STAT1_REG, &value);
1228		if (ret < 0)
1229			return ret;
1230		if ((value & VBUS_DET_DBNC1) && (value & VBUS_DET_DBNC100))
1231			ab8500_override_turn_on_stat(~AB8500_POW_KEY_1_ON,
1232						     AB8500_VBUS_DET);
1233	}
1234
1235	/* Clear and mask all interrupts */
1236	for (i = 0; i < ab8500->mask_size; i++) {
1237		/*
1238		 * Interrupt register 12 doesn't exist prior to AB8500 version
1239		 * 2.0
1240		 */
1241		if (ab8500->irq_reg_offset[i] == 11 &&
1242				is_ab8500_1p1_or_earlier(ab8500))
1243			continue;
1244
1245		if (ab8500->irq_reg_offset[i] < 0)
1246			continue;
1247
1248		get_register_interruptible(ab8500, AB8500_INTERRUPT,
1249			AB8500_IT_LATCH1_REG + ab8500->irq_reg_offset[i],
1250			&value);
1251		set_register_interruptible(ab8500, AB8500_INTERRUPT,
1252			AB8500_IT_MASK1_REG + ab8500->irq_reg_offset[i], 0xff);
1253	}
1254
1255	ret = abx500_register_ops(ab8500->dev, &ab8500_ops);
1256	if (ret)
1257		return ret;
1258
1259	for (i = 0; i < ab8500->mask_size; i++)
1260		ab8500->mask[i] = ab8500->oldmask[i] = 0xff;
1261
1262	ret = ab8500_irq_init(ab8500, np);
1263	if (ret)
1264		return ret;
1265
1266	ret = devm_request_threaded_irq(&pdev->dev, ab8500->irq, NULL,
1267			ab8500_hierarchical_irq,
1268			IRQF_ONESHOT | IRQF_NO_SUSPEND,
1269			"ab8500", ab8500);
1270	if (ret)
1271		return ret;
1272
1273	if (is_ab9540(ab8500))
1274		ret = mfd_add_devices(ab8500->dev, 0, ab9540_devs,
1275				ARRAY_SIZE(ab9540_devs), NULL,
1276				0, ab8500->domain);
1277	else if (is_ab8540(ab8500)) {
1278		ret = mfd_add_devices(ab8500->dev, 0, ab8540_devs,
1279			      ARRAY_SIZE(ab8540_devs), NULL,
1280			      0, ab8500->domain);
1281		if (ret)
1282			return ret;
1283
1284		if (is_ab8540_1p2_or_earlier(ab8500))
1285			ret = mfd_add_devices(ab8500->dev, 0, ab8540_cut1_devs,
1286			      ARRAY_SIZE(ab8540_cut1_devs), NULL,
1287			      0, ab8500->domain);
1288		else /* ab8540 >= cut2 */
1289			ret = mfd_add_devices(ab8500->dev, 0, ab8540_cut2_devs,
1290			      ARRAY_SIZE(ab8540_cut2_devs), NULL,
1291			      0, ab8500->domain);
1292	} else if (is_ab8505(ab8500))
1293		ret = mfd_add_devices(ab8500->dev, 0, ab8505_devs,
1294			      ARRAY_SIZE(ab8505_devs), NULL,
1295			      0, ab8500->domain);
1296	else
1297		ret = mfd_add_devices(ab8500->dev, 0, ab8500_devs,
1298				ARRAY_SIZE(ab8500_devs), NULL,
1299				0, ab8500->domain);
1300	if (ret)
1301		return ret;
1302
1303	if (!no_bm) {
1304		/* Add battery management devices */
1305		ret = mfd_add_devices(ab8500->dev, 0, ab8500_bm_devs,
1306				      ARRAY_SIZE(ab8500_bm_devs), NULL,
1307				      0, ab8500->domain);
1308		if (ret)
1309			dev_err(ab8500->dev, "error adding bm devices\n");
1310	}
1311
1312	if (((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
1313			ab8500->chip_id >= AB8500_CUT2P0) || is_ab8540(ab8500))
1314		ret = sysfs_create_group(&ab8500->dev->kobj,
1315					&ab9540_attr_group);
1316	else
1317		ret = sysfs_create_group(&ab8500->dev->kobj,
1318					&ab8500_attr_group);
1319
1320	if ((is_ab8505(ab8500) || is_ab9540(ab8500)) &&
1321			ab8500->chip_id >= AB8500_CUT2P0)
1322		ret = sysfs_create_group(&ab8500->dev->kobj,
1323					 &ab8505_attr_group);
1324
1325	if (ret)
1326		dev_err(ab8500->dev, "error creating sysfs entries\n");
1327
1328	return ret;
1329}
1330
1331static const struct platform_device_id ab8500_id[] = {
1332	{ "ab8500-core", AB8500_VERSION_AB8500 },
1333	{ "ab8505-i2c", AB8500_VERSION_AB8505 },
1334	{ "ab9540-i2c", AB8500_VERSION_AB9540 },
1335	{ "ab8540-i2c", AB8500_VERSION_AB8540 },
1336	{ }
1337};
1338
1339static struct platform_driver ab8500_core_driver = {
1340	.driver = {
1341		.name = "ab8500-core",
1342		.suppress_bind_attrs = true,
1343	},
1344	.probe	= ab8500_probe,
1345	.id_table = ab8500_id,
1346};
1347
1348static int __init ab8500_core_init(void)
1349{
1350	return platform_driver_register(&ab8500_core_driver);
1351}
1352core_initcall(ab8500_core_init);