twl-core.c 35.1 KB
Newer Older
D
David Brownell 已提交
1
/*
B
Balaji T K 已提交
2 3
 * twl_core.c - driver for TWL4030/TWL5030/TWL60X0/TPS659x0 PM
 * and audio CODEC devices
D
David Brownell 已提交
4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32
 *
 * Copyright (C) 2005-2006 Texas Instruments, Inc.
 *
 * Modifications to defer interrupt handling to a kernel thread:
 * Copyright (C) 2006 MontaVista Software, Inc.
 *
 * Based on tlv320aic23.c:
 * Copyright (c) by Kai Svahn <kai.svahn@nokia.com>
 *
 * Code cleanup and modifications to IRQ handler.
 * by syed khasim <x0khasim@ti.com>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
 */

#include <linux/init.h>
#include <linux/mutex.h>
33
#include <linux/module.h>
D
David Brownell 已提交
34 35
#include <linux/platform_device.h>
#include <linux/clk.h>
D
David Brownell 已提交
36
#include <linux/err.h>
37 38 39 40 41
#include <linux/device.h>
#include <linux/of.h>
#include <linux/of_irq.h>
#include <linux/of_platform.h>
#include <linux/irqdomain.h>
D
David Brownell 已提交
42

43 44
#include <linux/regulator/machine.h>

D
David Brownell 已提交
45
#include <linux/i2c.h>
46
#include <linux/i2c/twl.h>
D
David Brownell 已提交
47

48
#if defined(CONFIG_ARCH_OMAP2) || defined(CONFIG_ARCH_OMAP3)
49
#include <plat/cpu.h>
S
Samuel Ortiz 已提交
50
#endif
D
David Brownell 已提交
51 52 53 54 55 56 57 58 59 60 61 62 63 64

/*
 * The TWL4030 "Triton 2" is one of a family of a multi-function "Power
 * Management and System Companion Device" chips originally designed for
 * use in OMAP2 and OMAP 3 based systems.  Its control interfaces use I2C,
 * often at around 3 Mbit/sec, including for interrupt handling.
 *
 * This driver core provides genirq support for the interrupts emitted,
 * by the various modules, and exports register access primitives.
 *
 * FIXME this driver currently requires use of the first interrupt line
 * (and associated registers).
 */

B
Balaji T K 已提交
65
#define DRIVER_NAME			"twl"
D
David Brownell 已提交
66 67 68 69 70 71 72 73 74 75 76 77 78

#if defined(CONFIG_KEYBOARD_TWL4030) || defined(CONFIG_KEYBOARD_TWL4030_MODULE)
#define twl_has_keypad()	true
#else
#define twl_has_keypad()	false
#endif

#if defined(CONFIG_GPIO_TWL4030) || defined(CONFIG_GPIO_TWL4030_MODULE)
#define twl_has_gpio()	true
#else
#define twl_has_gpio()	false
#endif

79 80 81 82 83 84 85
#if defined(CONFIG_REGULATOR_TWL4030) \
	|| defined(CONFIG_REGULATOR_TWL4030_MODULE)
#define twl_has_regulator()	true
#else
#define twl_has_regulator()	false
#endif

D
David Brownell 已提交
86 87 88 89 90 91
#if defined(CONFIG_TWL4030_MADC) || defined(CONFIG_TWL4030_MADC_MODULE)
#define twl_has_madc()	true
#else
#define twl_has_madc()	false
#endif

92 93 94 95 96 97
#ifdef CONFIG_TWL4030_POWER
#define twl_has_power()        true
#else
#define twl_has_power()        false
#endif

D
David Brownell 已提交
98 99 100 101 102 103
#if defined(CONFIG_RTC_DRV_TWL4030) || defined(CONFIG_RTC_DRV_TWL4030_MODULE)
#define twl_has_rtc()	true
#else
#define twl_has_rtc()	false
#endif

104 105
#if defined(CONFIG_TWL4030_USB) || defined(CONFIG_TWL4030_USB_MODULE) ||\
	defined(CONFIG_TWL6030_USB) || defined(CONFIG_TWL6030_USB_MODULE)
D
David Brownell 已提交
106 107 108 109 110
#define twl_has_usb()	true
#else
#define twl_has_usb()	false
#endif

111 112 113 114 115 116
#if defined(CONFIG_TWL4030_WATCHDOG) || \
	defined(CONFIG_TWL4030_WATCHDOG_MODULE)
#define twl_has_watchdog()        true
#else
#define twl_has_watchdog()        false
#endif
D
David Brownell 已提交
117

118
#if defined(CONFIG_MFD_TWL4030_AUDIO) || defined(CONFIG_MFD_TWL4030_AUDIO_MODULE) ||\
119
	defined(CONFIG_TWL6040_CORE) || defined(CONFIG_TWL6040_CORE_MODULE)
120 121 122 123 124
#define twl_has_codec()	true
#else
#define twl_has_codec()	false
#endif

125 126 127 128 129 130
#if defined(CONFIG_CHARGER_TWL4030) || defined(CONFIG_CHARGER_TWL4030_MODULE)
#define twl_has_bci()	true
#else
#define twl_has_bci()	false
#endif

D
David Brownell 已提交
131 132 133 134 135
/* Triton Core internal information (BEGIN) */

/* Last - for index max*/
#define TWL4030_MODULE_LAST		TWL4030_MODULE_SECURED_REG

B
Balaji T K 已提交
136
#define TWL_NUM_SLAVES		4
D
David Brownell 已提交
137

138
#if defined(CONFIG_INPUT_TWL4030_PWRBUTTON) \
139
	|| defined(CONFIG_INPUT_TWL4030_PWRBUTTON_MODULE)
140 141 142 143
#define twl_has_pwrbutton()	true
#else
#define twl_has_pwrbutton()	false
#endif
D
David Brownell 已提交
144

B
Balaji T K 已提交
145 146 147 148 149 150 151
#define SUB_CHIP_ID0 0
#define SUB_CHIP_ID1 1
#define SUB_CHIP_ID2 2
#define SUB_CHIP_ID3 3

#define TWL_MODULE_LAST TWL4030_MODULE_LAST

152 153 154
#define TWL4030_NR_IRQS    8
#define TWL6030_NR_IRQS    20

D
David Brownell 已提交
155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178
/* Base Address defns for twl4030_map[] */

/* subchip/slave 0 - USB ID */
#define TWL4030_BASEADD_USB		0x0000

/* subchip/slave 1 - AUD ID */
#define TWL4030_BASEADD_AUDIO_VOICE	0x0000
#define TWL4030_BASEADD_GPIO		0x0098
#define TWL4030_BASEADD_INTBR		0x0085
#define TWL4030_BASEADD_PIH		0x0080
#define TWL4030_BASEADD_TEST		0x004C

/* subchip/slave 2 - AUX ID */
#define TWL4030_BASEADD_INTERRUPTS	0x00B9
#define TWL4030_BASEADD_LED		0x00EE
#define TWL4030_BASEADD_MADC		0x0000
#define TWL4030_BASEADD_MAIN_CHARGE	0x0074
#define TWL4030_BASEADD_PRECHARGE	0x00AA
#define TWL4030_BASEADD_PWM0		0x00F8
#define TWL4030_BASEADD_PWM1		0x00FB
#define TWL4030_BASEADD_PWMA		0x00EF
#define TWL4030_BASEADD_PWMB		0x00F1
#define TWL4030_BASEADD_KEYPAD		0x00D2

I
Ilkka Koskinen 已提交
179 180 181 182
#define TWL5031_BASEADD_ACCESSORY	0x0074 /* Replaces Main Charge */
#define TWL5031_BASEADD_INTERRUPTS	0x00B9 /* Different than TWL4030's
						  one */

D
David Brownell 已提交
183 184 185 186 187 188 189 190 191 192 193
/* subchip/slave 3 - POWER ID */
#define TWL4030_BASEADD_BACKUP		0x0014
#define TWL4030_BASEADD_INT		0x002E
#define TWL4030_BASEADD_PM_MASTER	0x0036
#define TWL4030_BASEADD_PM_RECEIVER	0x005B
#define TWL4030_BASEADD_RTC		0x001C
#define TWL4030_BASEADD_SECURED_REG	0x0000

/* Triton Core internal information (END) */


194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209
/* subchip/slave 0 0x48 - POWER */
#define TWL6030_BASEADD_RTC		0x0000
#define TWL6030_BASEADD_MEM		0x0017
#define TWL6030_BASEADD_PM_MASTER	0x001F
#define TWL6030_BASEADD_PM_SLAVE_MISC	0x0030 /* PM_RECEIVER */
#define TWL6030_BASEADD_PM_MISC		0x00E2
#define TWL6030_BASEADD_PM_PUPD		0x00F0

/* subchip/slave 1 0x49 - FEATURE */
#define TWL6030_BASEADD_USB		0x0000
#define TWL6030_BASEADD_GPADC_CTRL	0x002E
#define TWL6030_BASEADD_AUX		0x0090
#define TWL6030_BASEADD_PWM		0x00BA
#define TWL6030_BASEADD_GASGAUGE	0x00C0
#define TWL6030_BASEADD_PIH		0x00D0
#define TWL6030_BASEADD_CHARGER		0x00E0
210
#define TWL6025_BASEADD_CHARGER		0x00DA
211 212 213 214 215 216 217

/* subchip/slave 2 0x4A - DFT */
#define TWL6030_BASEADD_DIEID		0x00C0

/* subchip/slave 3 0x4B - AUDIO */
#define TWL6030_BASEADD_AUDIO		0x0000
#define TWL6030_BASEADD_RSV		0x0000
218
#define TWL6030_BASEADD_ZERO		0x0000
219

D
David Brownell 已提交
220 221 222 223 224 225 226 227
/* Few power values */
#define R_CFG_BOOT			0x05

/* some fields in R_CFG_BOOT */
#define HFCLK_FREQ_19p2_MHZ		(1 << 0)
#define HFCLK_FREQ_26_MHZ		(2 << 0)
#define HFCLK_FREQ_38p4_MHZ		(3 << 0)
#define HIGH_PERF_SQ			(1 << 3)
228
#define CK32K_LOWPWR_EN			(1 << 7)
D
David Brownell 已提交
229 230


231 232 233
/* chip-specific feature flags, for i2c_device_id.driver_data */
#define TWL4030_VAUX2		BIT(0)	/* pre-5030 voltage ranges */
#define TPS_SUBSET		BIT(1)	/* tps659[23]0 have fewer LDOs */
I
Ilkka Koskinen 已提交
234
#define TWL5031			BIT(2)  /* twl5031 has different registers */
235
#define TWL6030_CLASS		BIT(3)	/* TWL6030 class */
236

D
David Brownell 已提交
237 238 239 240 241
/*----------------------------------------------------------------------*/

/* is driver active, bound to a chip? */
static bool inuse;

242 243 244
/* TWL IDCODE Register value */
static u32 twl_idcode;

245 246 247 248 249 250 251 252
static unsigned int twl_id;
unsigned int twl_rev(void)
{
	return twl_id;
}
EXPORT_SYMBOL(twl_rev);

/* Structure for each TWL4030/TWL6030 Slave */
B
Balaji T K 已提交
253
struct twl_client {
D
David Brownell 已提交
254 255 256 257 258 259 260 261 262 263
	struct i2c_client *client;
	u8 address;

	/* max numb of i2c_msg required is for read =2 */
	struct i2c_msg xfer_msg[2];

	/* To lock access to xfer_msg */
	struct mutex xfer_lock;
};

B
Balaji T K 已提交
264
static struct twl_client twl_modules[TWL_NUM_SLAVES];
D
David Brownell 已提交
265

266
static struct irq_domain domain;
D
David Brownell 已提交
267 268

/* mapping the module id to slave id and base address */
B
Balaji T K 已提交
269
struct twl_mapping {
D
David Brownell 已提交
270 271 272
	unsigned char sid;	/* Slave ID */
	unsigned char base;	/* base address */
};
273
static struct twl_mapping *twl_map;
D
David Brownell 已提交
274

B
Balaji T K 已提交
275
static struct twl_mapping twl4030_map[TWL4030_MODULE_LAST + 1] = {
D
David Brownell 已提交
276 277
	/*
	 * NOTE:  don't change this table without updating the
278
	 * <linux/i2c/twl.h> defines for TWL4030_MODULE_*
D
David Brownell 已提交
279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299
	 * so they continue to match the order in this table.
	 */

	{ 0, TWL4030_BASEADD_USB },

	{ 1, TWL4030_BASEADD_AUDIO_VOICE },
	{ 1, TWL4030_BASEADD_GPIO },
	{ 1, TWL4030_BASEADD_INTBR },
	{ 1, TWL4030_BASEADD_PIH },
	{ 1, TWL4030_BASEADD_TEST },

	{ 2, TWL4030_BASEADD_KEYPAD },
	{ 2, TWL4030_BASEADD_MADC },
	{ 2, TWL4030_BASEADD_INTERRUPTS },
	{ 2, TWL4030_BASEADD_LED },
	{ 2, TWL4030_BASEADD_MAIN_CHARGE },
	{ 2, TWL4030_BASEADD_PRECHARGE },
	{ 2, TWL4030_BASEADD_PWM0 },
	{ 2, TWL4030_BASEADD_PWM1 },
	{ 2, TWL4030_BASEADD_PWMA },
	{ 2, TWL4030_BASEADD_PWMB },
I
Ilkka Koskinen 已提交
300 301
	{ 2, TWL5031_BASEADD_ACCESSORY },
	{ 2, TWL5031_BASEADD_INTERRUPTS },
D
David Brownell 已提交
302 303 304 305 306 307 308 309 310

	{ 3, TWL4030_BASEADD_BACKUP },
	{ 3, TWL4030_BASEADD_INT },
	{ 3, TWL4030_BASEADD_PM_MASTER },
	{ 3, TWL4030_BASEADD_PM_RECEIVER },
	{ 3, TWL4030_BASEADD_RTC },
	{ 3, TWL4030_BASEADD_SECURED_REG },
};

311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331
static struct twl_mapping twl6030_map[] = {
	/*
	 * NOTE:  don't change this table without updating the
	 * <linux/i2c/twl.h> defines for TWL4030_MODULE_*
	 * so they continue to match the order in this table.
	 */
	{ SUB_CHIP_ID1, TWL6030_BASEADD_USB },
	{ SUB_CHIP_ID3, TWL6030_BASEADD_AUDIO },
	{ SUB_CHIP_ID2, TWL6030_BASEADD_DIEID },
	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
	{ SUB_CHIP_ID1, TWL6030_BASEADD_PIH },

	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
	{ SUB_CHIP_ID1, TWL6030_BASEADD_GPADC_CTRL },
	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },

	{ SUB_CHIP_ID1, TWL6030_BASEADD_CHARGER },
	{ SUB_CHIP_ID1, TWL6030_BASEADD_GASGAUGE },
	{ SUB_CHIP_ID1, TWL6030_BASEADD_PWM },
332 333
	{ SUB_CHIP_ID0, TWL6030_BASEADD_ZERO },
	{ SUB_CHIP_ID1, TWL6030_BASEADD_ZERO },
334

335 336
	{ SUB_CHIP_ID2, TWL6030_BASEADD_ZERO },
	{ SUB_CHIP_ID2, TWL6030_BASEADD_ZERO },
337 338 339 340 341 342 343 344
	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
	{ SUB_CHIP_ID0, TWL6030_BASEADD_PM_MASTER },
	{ SUB_CHIP_ID0, TWL6030_BASEADD_PM_SLAVE_MISC },

	{ SUB_CHIP_ID0, TWL6030_BASEADD_RTC },
	{ SUB_CHIP_ID0, TWL6030_BASEADD_MEM },
345
	{ SUB_CHIP_ID1, TWL6025_BASEADD_CHARGER },
346 347
};

D
David Brownell 已提交
348 349 350 351 352
/*----------------------------------------------------------------------*/

/* Exported Functions */

/**
B
Balaji T K 已提交
353
 * twl_i2c_write - Writes a n bit register in TWL4030/TWL5030/TWL60X0
D
David Brownell 已提交
354 355 356 357 358 359 360 361 362 363
 * @mod_no: module number
 * @value: an array of num_bytes+1 containing data to write
 * @reg: register address (just offset will do)
 * @num_bytes: number of bytes to transfer
 *
 * IMPORTANT: for 'value' parameter: Allocate value num_bytes+1 and
 * valid data starts at Offset 1.
 *
 * Returns the result of operation - 0 is success
 */
B
Balaji T K 已提交
364
int twl_i2c_write(u8 mod_no, u8 *value, u8 reg, unsigned num_bytes)
D
David Brownell 已提交
365 366 367
{
	int ret;
	int sid;
B
Balaji T K 已提交
368
	struct twl_client *twl;
D
David Brownell 已提交
369 370
	struct i2c_msg *msg;

B
Balaji T K 已提交
371
	if (unlikely(mod_no > TWL_MODULE_LAST)) {
D
David Brownell 已提交
372 373 374 375
		pr_err("%s: invalid module number %d\n", DRIVER_NAME, mod_no);
		return -EPERM;
	}
	if (unlikely(!inuse)) {
376
		pr_err("%s: not initialized\n", DRIVER_NAME);
D
David Brownell 已提交
377 378
		return -EPERM;
	}
379 380 381
	sid = twl_map[mod_no].sid;
	twl = &twl_modules[sid];

D
David Brownell 已提交
382 383 384 385 386 387 388 389 390 391 392
	mutex_lock(&twl->xfer_lock);
	/*
	 * [MSG1]: fill the register address data
	 * fill the data Tx buffer
	 */
	msg = &twl->xfer_msg[0];
	msg->addr = twl->address;
	msg->len = num_bytes + 1;
	msg->flags = 0;
	msg->buf = value;
	/* over write the first byte of buffer with the register address */
393
	*value = twl_map[mod_no].base + reg;
D
David Brownell 已提交
394 395 396
	ret = i2c_transfer(twl->client->adapter, twl->xfer_msg, 1);
	mutex_unlock(&twl->xfer_lock);

397 398 399 400 401 402 403 404 405 406 407
	/* i2c_transfer returns number of messages transferred */
	if (ret != 1) {
		pr_err("%s: i2c_write failed to transfer all messages\n",
			DRIVER_NAME);
		if (ret < 0)
			return ret;
		else
			return -EIO;
	} else {
		return 0;
	}
D
David Brownell 已提交
408
}
B
Balaji T K 已提交
409
EXPORT_SYMBOL(twl_i2c_write);
D
David Brownell 已提交
410 411

/**
B
Balaji T K 已提交
412
 * twl_i2c_read - Reads a n bit register in TWL4030/TWL5030/TWL60X0
D
David Brownell 已提交
413 414 415 416 417 418 419
 * @mod_no: module number
 * @value: an array of num_bytes containing data to be read
 * @reg: register address (just offset will do)
 * @num_bytes: number of bytes to transfer
 *
 * Returns result of operation - num_bytes is success else failure.
 */
B
Balaji T K 已提交
420
int twl_i2c_read(u8 mod_no, u8 *value, u8 reg, unsigned num_bytes)
D
David Brownell 已提交
421 422 423 424
{
	int ret;
	u8 val;
	int sid;
B
Balaji T K 已提交
425
	struct twl_client *twl;
D
David Brownell 已提交
426 427
	struct i2c_msg *msg;

B
Balaji T K 已提交
428
	if (unlikely(mod_no > TWL_MODULE_LAST)) {
D
David Brownell 已提交
429 430 431 432
		pr_err("%s: invalid module number %d\n", DRIVER_NAME, mod_no);
		return -EPERM;
	}
	if (unlikely(!inuse)) {
433
		pr_err("%s: not initialized\n", DRIVER_NAME);
D
David Brownell 已提交
434 435
		return -EPERM;
	}
436 437 438
	sid = twl_map[mod_no].sid;
	twl = &twl_modules[sid];

D
David Brownell 已提交
439 440 441 442 443 444
	mutex_lock(&twl->xfer_lock);
	/* [MSG1] fill the register address data */
	msg = &twl->xfer_msg[0];
	msg->addr = twl->address;
	msg->len = 1;
	msg->flags = 0;	/* Read the register value */
445
	val = twl_map[mod_no].base + reg;
D
David Brownell 已提交
446 447 448 449 450 451 452 453 454 455
	msg->buf = &val;
	/* [MSG2] fill the data rx buffer */
	msg = &twl->xfer_msg[1];
	msg->addr = twl->address;
	msg->flags = I2C_M_RD;	/* Read the register value */
	msg->len = num_bytes;	/* only n bytes */
	msg->buf = value;
	ret = i2c_transfer(twl->client->adapter, twl->xfer_msg, 2);
	mutex_unlock(&twl->xfer_lock);

456 457 458 459 460 461 462 463 464 465 466
	/* i2c_transfer returns number of messages transferred */
	if (ret != 2) {
		pr_err("%s: i2c_read failed to transfer all messages\n",
			DRIVER_NAME);
		if (ret < 0)
			return ret;
		else
			return -EIO;
	} else {
		return 0;
	}
D
David Brownell 已提交
467
}
B
Balaji T K 已提交
468
EXPORT_SYMBOL(twl_i2c_read);
D
David Brownell 已提交
469 470

/**
B
Balaji T K 已提交
471
 * twl_i2c_write_u8 - Writes a 8 bit register in TWL4030/TWL5030/TWL60X0
D
David Brownell 已提交
472 473 474 475 476 477
 * @mod_no: module number
 * @value: the value to be written 8 bit
 * @reg: register address (just offset will do)
 *
 * Returns result of operation - 0 is success
 */
B
Balaji T K 已提交
478
int twl_i2c_write_u8(u8 mod_no, u8 value, u8 reg)
D
David Brownell 已提交
479 480 481 482 483 484
{

	/* 2 bytes offset 1 contains the data offset 0 is used by i2c_write */
	u8 temp_buffer[2] = { 0 };
	/* offset 1 contains the data */
	temp_buffer[1] = value;
B
Balaji T K 已提交
485
	return twl_i2c_write(mod_no, temp_buffer, reg, 1);
D
David Brownell 已提交
486
}
B
Balaji T K 已提交
487
EXPORT_SYMBOL(twl_i2c_write_u8);
D
David Brownell 已提交
488 489

/**
B
Balaji T K 已提交
490
 * twl_i2c_read_u8 - Reads a 8 bit register from TWL4030/TWL5030/TWL60X0
D
David Brownell 已提交
491 492 493 494 495 496
 * @mod_no: module number
 * @value: the value read 8 bit
 * @reg: register address (just offset will do)
 *
 * Returns result of operation - 0 is success
 */
B
Balaji T K 已提交
497
int twl_i2c_read_u8(u8 mod_no, u8 *value, u8 reg)
D
David Brownell 已提交
498
{
B
Balaji T K 已提交
499
	return twl_i2c_read(mod_no, value, reg, 1);
D
David Brownell 已提交
500
}
B
Balaji T K 已提交
501
EXPORT_SYMBOL(twl_i2c_read_u8);
D
David Brownell 已提交
502 503 504

/*----------------------------------------------------------------------*/

505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556
/**
 * twl_read_idcode_register - API to read the IDCODE register.
 *
 * Unlocks the IDCODE register and read the 32 bit value.
 */
static int twl_read_idcode_register(void)
{
	int err;

	err = twl_i2c_write_u8(TWL4030_MODULE_INTBR, TWL_EEPROM_R_UNLOCK,
						REG_UNLOCK_TEST_REG);
	if (err) {
		pr_err("TWL4030 Unable to unlock IDCODE registers -%d\n", err);
		goto fail;
	}

	err = twl_i2c_read(TWL4030_MODULE_INTBR, (u8 *)(&twl_idcode),
						REG_IDCODE_7_0, 4);
	if (err) {
		pr_err("TWL4030: unable to read IDCODE -%d\n", err);
		goto fail;
	}

	err = twl_i2c_write_u8(TWL4030_MODULE_INTBR, 0x0, REG_UNLOCK_TEST_REG);
	if (err)
		pr_err("TWL4030 Unable to relock IDCODE registers -%d\n", err);
fail:
	return err;
}

/**
 * twl_get_type - API to get TWL Si type.
 *
 * Api to get the TWL Si type from IDCODE value.
 */
int twl_get_type(void)
{
	return TWL_SIL_TYPE(twl_idcode);
}
EXPORT_SYMBOL_GPL(twl_get_type);

/**
 * twl_get_version - API to get TWL Si version.
 *
 * Api to get the TWL Si version from IDCODE value.
 */
int twl_get_version(void)
{
	return TWL_SIL_REV(twl_idcode);
}
EXPORT_SYMBOL_GPL(twl_get_version);

557 558
static struct device *
add_numbered_child(unsigned chip, const char *name, int num,
559 560
		void *pdata, unsigned pdata_len,
		bool can_wakeup, int irq0, int irq1)
D
David Brownell 已提交
561
{
562
	struct platform_device	*pdev;
B
Balaji T K 已提交
563
	struct twl_client	*twl = &twl_modules[chip];
564 565
	int			status;

566
	pdev = platform_device_alloc(name, num);
567 568 569 570 571
	if (!pdev) {
		dev_dbg(&twl->client->dev, "can't alloc dev\n");
		status = -ENOMEM;
		goto err;
	}
D
David Brownell 已提交
572

573 574
	device_init_wakeup(&pdev->dev, can_wakeup);
	pdev->dev.parent = &twl->client->dev;
D
David Brownell 已提交
575

576 577 578 579
	if (pdata) {
		status = platform_device_add_data(pdev, pdata, pdata_len);
		if (status < 0) {
			dev_dbg(&pdev->dev, "can't add platform_data\n");
D
David Brownell 已提交
580 581
			goto err;
		}
582
	}
D
David Brownell 已提交
583

584 585 586 587 588
	if (irq0) {
		struct resource r[2] = {
			{ .start = irq0, .flags = IORESOURCE_IRQ, },
			{ .start = irq1, .flags = IORESOURCE_IRQ, },
		};
D
David Brownell 已提交
589

590
		status = platform_device_add_resources(pdev, r, irq1 ? 2 : 1);
D
David Brownell 已提交
591
		if (status < 0) {
592
			dev_dbg(&pdev->dev, "can't add irqs\n");
D
David Brownell 已提交
593 594 595 596
			goto err;
		}
	}

597
	status = platform_device_add(pdev);
D
David Brownell 已提交
598

599 600 601 602 603 604 605 606
err:
	if (status < 0) {
		platform_device_put(pdev);
		dev_err(&twl->client->dev, "can't add %s dev\n", name);
		return ERR_PTR(status);
	}
	return &pdev->dev;
}
D
David Brownell 已提交
607

608 609 610 611 612 613 614 615 616 617 618
static inline struct device *add_child(unsigned chip, const char *name,
		void *pdata, unsigned pdata_len,
		bool can_wakeup, int irq0, int irq1)
{
	return add_numbered_child(chip, name, -1, pdata, pdata_len,
		can_wakeup, irq0, irq1);
}

static struct device *
add_regulator_linked(int num, struct regulator_init_data *pdata,
		struct regulator_consumer_supply *consumers,
619
		unsigned num_consumers, unsigned long features)
620
{
621
	unsigned sub_chip_id;
622 623 624 625
	/* regulator framework demands init_data ... */
	if (!pdata)
		return NULL;

626
	if (consumers) {
627 628 629 630
		pdata->consumer_supplies = consumers;
		pdata->num_consumer_supplies = num_consumers;
	}

631 632
	pdata->driver_data = (void *)features;

633
	/* NOTE:  we currently ignore regulator IRQs, e.g. for short circuits */
634 635
	sub_chip_id = twl_map[TWL_MODULE_PM_MASTER].sid;
	return add_numbered_child(sub_chip_id, "twl_reg", num,
636 637 638 639
		pdata, sizeof(*pdata), false, 0, 0);
}

static struct device *
640 641
add_regulator(int num, struct regulator_init_data *pdata,
		unsigned long features)
642
{
643
	return add_regulator_linked(num, pdata, NULL, 0, features);
644 645
}

646 647 648 649 650
/*
 * NOTE:  We know the first 8 IRQs after pdata->base_irq are
 * for the PIH, and the next are for the PWR_INT SIH, since
 * that's how twl_init_irq() sets things up.
 */
D
David Brownell 已提交
651

652 653
static int
add_children(struct twl4030_platform_data *pdata, unsigned long features)
654 655
{
	struct device	*child;
656
	unsigned sub_chip_id;
D
David Brownell 已提交
657

658
	if (twl_has_gpio() && pdata->gpio) {
B
Balaji T K 已提交
659
		child = add_child(SUB_CHIP_ID1, "twl4030_gpio",
660
				pdata->gpio, sizeof(*pdata->gpio),
B
Balaji T K 已提交
661
				false, pdata->irq_base + GPIO_INTR_OFFSET, 0);
662 663
		if (IS_ERR(child))
			return PTR_ERR(child);
D
David Brownell 已提交
664 665 666
	}

	if (twl_has_keypad() && pdata->keypad) {
B
Balaji T K 已提交
667
		child = add_child(SUB_CHIP_ID2, "twl4030_keypad",
668
				pdata->keypad, sizeof(*pdata->keypad),
B
Balaji T K 已提交
669
				true, pdata->irq_base + KEYPAD_INTR_OFFSET, 0);
670 671
		if (IS_ERR(child))
			return PTR_ERR(child);
D
David Brownell 已提交
672 673 674
	}

	if (twl_has_madc() && pdata->madc) {
675 676
		child = add_child(2, "twl4030_madc",
				pdata->madc, sizeof(*pdata->madc),
B
Balaji T K 已提交
677
				true, pdata->irq_base + MADC_INTR_OFFSET, 0);
678 679
		if (IS_ERR(child))
			return PTR_ERR(child);
D
David Brownell 已提交
680 681 682 683
	}

	if (twl_has_rtc()) {
		/*
684
		 * REVISIT platform_data here currently might expose the
D
David Brownell 已提交
685
		 * "msecure" line ... but for now we just expect board
686
		 * setup to tell the chip "it's always ok to SET_TIME".
D
David Brownell 已提交
687 688 689
		 * Eventually, Linux might become more aware of such
		 * HW security concerns, and "least privilege".
		 */
690 691
		sub_chip_id = twl_map[TWL_MODULE_RTC].sid;
		child = add_child(sub_chip_id, "twl_rtc",
692
				NULL, 0,
B
Balaji T K 已提交
693
				true, pdata->irq_base + RTC_INTR_OFFSET, 0);
694 695
		if (IS_ERR(child))
			return PTR_ERR(child);
D
David Brownell 已提交
696 697
	}

698
	if (twl_has_usb() && pdata->usb && twl_class_is_4030()) {
699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722

		static struct regulator_consumer_supply usb1v5 = {
			.supply =	"usb1v5",
		};
		static struct regulator_consumer_supply usb1v8 = {
			.supply =	"usb1v8",
		};
		static struct regulator_consumer_supply usb3v1 = {
			.supply =	"usb3v1",
		};

	/* First add the regulators so that they can be used by transceiver */
		if (twl_has_regulator()) {
			/* this is a template that gets copied */
			struct regulator_init_data usb_fixed = {
				.constraints.valid_modes_mask =
					REGULATOR_MODE_NORMAL
					| REGULATOR_MODE_STANDBY,
				.constraints.valid_ops_mask =
					REGULATOR_CHANGE_MODE
					| REGULATOR_CHANGE_STATUS,
			};

			child = add_regulator_linked(TWL4030_REG_VUSB1V5,
723 724
						      &usb_fixed, &usb1v5, 1,
						      features);
725 726 727 728
			if (IS_ERR(child))
				return PTR_ERR(child);

			child = add_regulator_linked(TWL4030_REG_VUSB1V8,
729 730
						      &usb_fixed, &usb1v8, 1,
						      features);
731 732 733 734
			if (IS_ERR(child))
				return PTR_ERR(child);

			child = add_regulator_linked(TWL4030_REG_VUSB3V1,
735 736
						      &usb_fixed, &usb3v1, 1,
						      features);
737 738 739 740 741
			if (IS_ERR(child))
				return PTR_ERR(child);

		}

742 743 744 745
		child = add_child(0, "twl4030_usb",
				pdata->usb, sizeof(*pdata->usb),
				true,
				/* irq0 = USB_PRES, irq1 = USB */
B
Balaji T K 已提交
746 747
				pdata->irq_base + USB_PRES_INTR_OFFSET,
				pdata->irq_base + USB_INTR_OFFSET);
748

749 750
		if (IS_ERR(child))
			return PTR_ERR(child);
751 752

		/* we need to connect regulators to this transceiver */
753 754 755 756 757
		if (twl_has_regulator() && child) {
			usb1v5.dev = child;
			usb1v8.dev = child;
			usb3v1.dev = child;
		}
758
	}
759 760
	if (twl_has_usb() && pdata->usb && twl_class_is_6030()) {

761 762
		static struct regulator_consumer_supply usb3v3;
		int regulator;
763 764 765 766 767 768 769 770 771 772 773 774

		if (twl_has_regulator()) {
			/* this is a template that gets copied */
			struct regulator_init_data usb_fixed = {
				.constraints.valid_modes_mask =
					REGULATOR_MODE_NORMAL
					| REGULATOR_MODE_STANDBY,
				.constraints.valid_ops_mask =
					REGULATOR_CHANGE_MODE
					| REGULATOR_CHANGE_STATUS,
			};

775 776 777 778 779 780 781 782 783 784
			if (features & TWL6025_SUBCLASS) {
				usb3v3.supply =	"ldousb";
				regulator = TWL6025_REG_LDOUSB;
			} else {
				usb3v3.supply = "vusb";
				regulator = TWL6030_REG_VUSB;
			}
			child = add_regulator_linked(regulator, &usb_fixed,
							&usb3v3, 1,
							features);
785 786 787 788
			if (IS_ERR(child))
				return PTR_ERR(child);
		}

789 790
		pdata->usb->features = features;

791 792 793 794 795 796 797 798 799 800 801 802
		child = add_child(0, "twl6030_usb",
			pdata->usb, sizeof(*pdata->usb),
			true,
			/* irq1 = VBUS_PRES, irq0 = USB ID */
			pdata->irq_base + USBOTG_INTR_OFFSET,
			pdata->irq_base + USB_PRES_INTR_OFFSET);

		if (IS_ERR(child))
			return PTR_ERR(child);
		/* we need to connect regulators to this transceiver */
		if (twl_has_regulator() && child)
			usb3v3.dev = child;
803 804 805 806 807 808 809
	} else if (twl_has_regulator() && twl_class_is_6030()) {
		if (features & TWL6025_SUBCLASS)
			child = add_regulator(TWL6025_REG_LDOUSB,
						pdata->ldousb, features);
		else
			child = add_regulator(TWL6030_REG_VUSB,
						pdata->vusb, features);
810

811 812
			if (IS_ERR(child))
					return PTR_ERR(child);
813
	}
814

815
	if (twl_has_watchdog() && twl_class_is_4030()) {
816 817
		child = add_child(0, "twl4030_wdt", NULL, 0, false, 0, 0);
		if (IS_ERR(child))
818 819 820
			return PTR_ERR(child);
	}

821
	if (twl_has_pwrbutton() && twl_class_is_4030()) {
822 823 824
		child = add_child(1, "twl4030_pwrbutton",
				NULL, 0, true, pdata->irq_base + 8 + 0, 0);
		if (IS_ERR(child))
825 826 827
			return PTR_ERR(child);
	}

828
	if (twl_has_codec() && pdata->audio && twl_class_is_4030()) {
829
		sub_chip_id = twl_map[TWL_MODULE_AUDIO_VOICE].sid;
830
		child = add_child(sub_chip_id, "twl4030-audio",
831
				pdata->audio, sizeof(*pdata->audio),
832 833 834 835 836
				false, 0, 0);
		if (IS_ERR(child))
			return PTR_ERR(child);
	}

837
	if (twl_has_codec() && pdata->audio && twl_class_is_6030()) {
838
		sub_chip_id = twl_map[TWL_MODULE_AUDIO_VOICE].sid;
839
		child = add_child(sub_chip_id, "twl6040",
840
				pdata->audio, sizeof(*pdata->audio),
841 842 843 844 845
				false, 0, 0);
		if (IS_ERR(child))
			return PTR_ERR(child);
	}

846 847
	/* twl4030 regulators */
	if (twl_has_regulator() && twl_class_is_4030()) {
848 849
		child = add_regulator(TWL4030_REG_VPLL1, pdata->vpll1,
					features);
850 851
		if (IS_ERR(child))
			return PTR_ERR(child);
852

853 854
		child = add_regulator(TWL4030_REG_VIO, pdata->vio,
					features);
855 856 857
		if (IS_ERR(child))
			return PTR_ERR(child);

858 859
		child = add_regulator(TWL4030_REG_VDD1, pdata->vdd1,
					features);
860 861 862
		if (IS_ERR(child))
			return PTR_ERR(child);

863 864
		child = add_regulator(TWL4030_REG_VDD2, pdata->vdd2,
					features);
865 866
		if (IS_ERR(child))
			return PTR_ERR(child);
867

868 869
		child = add_regulator(TWL4030_REG_VMMC1, pdata->vmmc1,
					features);
870 871 872
		if (IS_ERR(child))
			return PTR_ERR(child);

873 874
		child = add_regulator(TWL4030_REG_VDAC, pdata->vdac,
					features);
875 876 877 878 879 880
		if (IS_ERR(child))
			return PTR_ERR(child);

		child = add_regulator((features & TWL4030_VAUX2)
					? TWL4030_REG_VAUX2_4030
					: TWL4030_REG_VAUX2,
881
				pdata->vaux2, features);
882 883
		if (IS_ERR(child))
			return PTR_ERR(child);
884

885 886
		child = add_regulator(TWL4030_REG_VINTANA1, pdata->vintana1,
					features);
887 888 889
		if (IS_ERR(child))
			return PTR_ERR(child);

890 891
		child = add_regulator(TWL4030_REG_VINTANA2, pdata->vintana2,
					features);
892 893 894
		if (IS_ERR(child))
			return PTR_ERR(child);

895 896
		child = add_regulator(TWL4030_REG_VINTDIG, pdata->vintdig,
					features);
897 898
		if (IS_ERR(child))
			return PTR_ERR(child);
899 900 901
	}

	/* maybe add LDOs that are omitted on cost-reduced parts */
902 903
	if (twl_has_regulator() && !(features & TPS_SUBSET)
	  && twl_class_is_4030()) {
904 905
		child = add_regulator(TWL4030_REG_VPLL2, pdata->vpll2,
					features);
906 907 908
		if (IS_ERR(child))
			return PTR_ERR(child);

909 910
		child = add_regulator(TWL4030_REG_VMMC2, pdata->vmmc2,
					features);
911 912 913
		if (IS_ERR(child))
			return PTR_ERR(child);

914 915
		child = add_regulator(TWL4030_REG_VSIM, pdata->vsim,
					features);
916 917 918
		if (IS_ERR(child))
			return PTR_ERR(child);

919 920
		child = add_regulator(TWL4030_REG_VAUX1, pdata->vaux1,
					features);
921 922 923
		if (IS_ERR(child))
			return PTR_ERR(child);

924 925
		child = add_regulator(TWL4030_REG_VAUX3, pdata->vaux3,
					features);
926 927 928
		if (IS_ERR(child))
			return PTR_ERR(child);

929 930
		child = add_regulator(TWL4030_REG_VAUX4, pdata->vaux4,
					features);
931 932
		if (IS_ERR(child))
			return PTR_ERR(child);
D
David Brownell 已提交
933 934
	}

935
	/* twl6030 regulators */
936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984
	if (twl_has_regulator() && twl_class_is_6030() &&
			!(features & TWL6025_SUBCLASS)) {
		child = add_regulator(TWL6030_REG_VMMC, pdata->vmmc,
					features);
		if (IS_ERR(child))
			return PTR_ERR(child);

		child = add_regulator(TWL6030_REG_VPP, pdata->vpp,
					features);
		if (IS_ERR(child))
			return PTR_ERR(child);

		child = add_regulator(TWL6030_REG_VUSIM, pdata->vusim,
					features);
		if (IS_ERR(child))
			return PTR_ERR(child);

		child = add_regulator(TWL6030_REG_VCXIO, pdata->vcxio,
					features);
		if (IS_ERR(child))
			return PTR_ERR(child);

		child = add_regulator(TWL6030_REG_VDAC, pdata->vdac,
					features);
		if (IS_ERR(child))
			return PTR_ERR(child);

		child = add_regulator(TWL6030_REG_VAUX1_6030, pdata->vaux1,
					features);
		if (IS_ERR(child))
			return PTR_ERR(child);

		child = add_regulator(TWL6030_REG_VAUX2_6030, pdata->vaux2,
					features);
		if (IS_ERR(child))
			return PTR_ERR(child);

		child = add_regulator(TWL6030_REG_VAUX3_6030, pdata->vaux3,
					features);
		if (IS_ERR(child))
			return PTR_ERR(child);

		child = add_regulator(TWL6030_REG_CLK32KG, pdata->clk32kg,
					features);
		if (IS_ERR(child))
			return PTR_ERR(child);
	}

	/* 6030 and 6025 share this regulator */
985
	if (twl_has_regulator() && twl_class_is_6030()) {
986 987 988 989 990 991 992 993 994 995 996
		child = add_regulator(TWL6030_REG_VANA, pdata->vana,
					features);
		if (IS_ERR(child))
			return PTR_ERR(child);
	}

	/* twl6025 regulators */
	if (twl_has_regulator() && twl_class_is_6030() &&
			(features & TWL6025_SUBCLASS)) {
		child = add_regulator(TWL6025_REG_LDO5, pdata->ldo5,
					features);
997 998 999
		if (IS_ERR(child))
			return PTR_ERR(child);

1000 1001
		child = add_regulator(TWL6025_REG_LDO1, pdata->ldo1,
					features);
1002 1003 1004
		if (IS_ERR(child))
			return PTR_ERR(child);

1005 1006
		child = add_regulator(TWL6025_REG_LDO7, pdata->ldo7,
					features);
1007 1008 1009
		if (IS_ERR(child))
			return PTR_ERR(child);

1010 1011
		child = add_regulator(TWL6025_REG_LDO6, pdata->ldo6,
					features);
1012 1013 1014
		if (IS_ERR(child))
			return PTR_ERR(child);

1015 1016
		child = add_regulator(TWL6025_REG_LDOLN, pdata->ldoln,
					features);
1017 1018 1019
		if (IS_ERR(child))
			return PTR_ERR(child);

1020 1021
		child = add_regulator(TWL6025_REG_LDO2, pdata->ldo2,
					features);
1022 1023 1024
		if (IS_ERR(child))
			return PTR_ERR(child);

1025 1026
		child = add_regulator(TWL6025_REG_LDO4, pdata->ldo4,
					features);
1027 1028 1029
		if (IS_ERR(child))
			return PTR_ERR(child);

1030 1031
		child = add_regulator(TWL6025_REG_LDO3, pdata->ldo3,
					features);
1032 1033 1034
		if (IS_ERR(child))
			return PTR_ERR(child);

1035 1036
		child = add_regulator(TWL6025_REG_SMPS3, pdata->smps3,
					features);
1037 1038
		if (IS_ERR(child))
			return PTR_ERR(child);
1039

1040 1041
		child = add_regulator(TWL6025_REG_SMPS4, pdata->smps4,
					features);
1042 1043
		if (IS_ERR(child))
			return PTR_ERR(child);
1044 1045 1046 1047 1048 1049

		child = add_regulator(TWL6025_REG_VIO, pdata->vio6025,
					features);
		if (IS_ERR(child))
			return PTR_ERR(child);

1050 1051
	}

1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062
	if (twl_has_bci() && pdata->bci &&
			!(features & (TPS_SUBSET | TWL5031))) {
		child = add_child(3, "twl4030_bci",
				pdata->bci, sizeof(*pdata->bci), false,
				/* irq0 = CHG_PRES, irq1 = BCI */
				pdata->irq_base + BCI_PRES_INTR_OFFSET,
				pdata->irq_base + BCI_INTR_OFFSET);
		if (IS_ERR(child))
			return PTR_ERR(child);
	}

1063
	return 0;
D
David Brownell 已提交
1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076
}

/*----------------------------------------------------------------------*/

/*
 * These three functions initialize the on-chip clock framework,
 * letting it generate the right frequencies for USB, MADC, and
 * other purposes.
 */
static inline int __init protect_pm_master(void)
{
	int e = 0;

1077 1078
	e = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, 0,
			TWL4030_PM_MASTER_PROTECT_KEY);
D
David Brownell 已提交
1079 1080 1081 1082 1083 1084 1085
	return e;
}

static inline int __init unprotect_pm_master(void)
{
	int e = 0;

1086 1087 1088 1089 1090 1091 1092
	e |= twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER,
			TWL4030_PM_MASTER_KEY_CFG1,
			TWL4030_PM_MASTER_PROTECT_KEY);
	e |= twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER,
			TWL4030_PM_MASTER_KEY_CFG2,
			TWL4030_PM_MASTER_PROTECT_KEY);

D
David Brownell 已提交
1093 1094 1095
	return e;
}

1096 1097
static void clocks_init(struct device *dev,
			struct twl4030_clock_init_data *clock)
D
David Brownell 已提交
1098 1099 1100 1101 1102 1103 1104 1105
{
	int e = 0;
	struct clk *osc;
	u32 rate;
	u8 ctrl = HFCLK_FREQ_26_MHZ;

#if defined(CONFIG_ARCH_OMAP2) || defined(CONFIG_ARCH_OMAP3)
	if (cpu_is_omap2430())
R
Russell King 已提交
1106
		osc = clk_get(dev, "osc_ck");
D
David Brownell 已提交
1107
	else
R
Russell King 已提交
1108
		osc = clk_get(dev, "osc_sys_ck");
1109

D
David Brownell 已提交
1110
	if (IS_ERR(osc)) {
B
Balaji T K 已提交
1111
		printk(KERN_WARNING "Skipping twl internal clock init and "
D
David Brownell 已提交
1112 1113 1114 1115 1116 1117 1118
				"using bootloader value (unknown osc rate)\n");
		return;
	}

	rate = clk_get_rate(osc);
	clk_put(osc);

1119 1120 1121 1122 1123 1124
#else
	/* REVISIT for non-OMAP systems, pass the clock rate from
	 * board init code, using platform_data.
	 */
	osc = ERR_PTR(-EIO);

B
Balaji T K 已提交
1125
	printk(KERN_WARNING "Skipping twl internal clock init and "
1126 1127 1128 1129 1130
	       "using bootloader value (unknown osc rate)\n");

	return;
#endif

D
David Brownell 已提交
1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143
	switch (rate) {
	case 19200000:
		ctrl = HFCLK_FREQ_19p2_MHZ;
		break;
	case 26000000:
		ctrl = HFCLK_FREQ_26_MHZ;
		break;
	case 38400000:
		ctrl = HFCLK_FREQ_38p4_MHZ;
		break;
	}

	ctrl |= HIGH_PERF_SQ;
1144 1145 1146
	if (clock && clock->ck32k_lowpwr_enable)
		ctrl |= CK32K_LOWPWR_EN;

D
David Brownell 已提交
1147 1148
	e |= unprotect_pm_master();
	/* effect->MADC+USB ck en */
B
Balaji T K 已提交
1149
	e |= twl_i2c_write_u8(TWL_MODULE_PM_MASTER, ctrl, R_CFG_BOOT);
D
David Brownell 已提交
1150 1151 1152 1153 1154 1155 1156 1157
	e |= protect_pm_master();

	if (e < 0)
		pr_err("%s: clock init err [%d]\n", DRIVER_NAME, e);
}

/*----------------------------------------------------------------------*/

1158 1159 1160 1161 1162
int twl4030_init_irq(int irq_num, unsigned irq_base, unsigned irq_end);
int twl4030_exit_irq(void);
int twl4030_init_chip_irq(const char *chip);
int twl6030_init_irq(int irq_num, unsigned irq_base, unsigned irq_end);
int twl6030_exit_irq(void);
D
David Brownell 已提交
1163

B
Balaji T K 已提交
1164
static int twl_remove(struct i2c_client *client)
D
David Brownell 已提交
1165 1166
{
	unsigned i;
D
David Brownell 已提交
1167
	int status;
D
David Brownell 已提交
1168

1169 1170 1171 1172 1173
	if (twl_class_is_4030())
		status = twl4030_exit_irq();
	else
		status = twl6030_exit_irq();

D
David Brownell 已提交
1174 1175
	if (status < 0)
		return status;
D
David Brownell 已提交
1176

B
Balaji T K 已提交
1177 1178
	for (i = 0; i < TWL_NUM_SLAVES; i++) {
		struct twl_client	*twl = &twl_modules[i];
D
David Brownell 已提交
1179 1180 1181

		if (twl->client && twl->client != client)
			i2c_unregister_device(twl->client);
B
Balaji T K 已提交
1182
		twl_modules[i].client = NULL;
D
David Brownell 已提交
1183 1184 1185 1186 1187 1188
	}
	inuse = false;
	return 0;
}

/* NOTE:  this driver only handles a single twl4030/tps659x0 chip */
1189
static int __devinit
B
Balaji T K 已提交
1190
twl_probe(struct i2c_client *client, const struct i2c_device_id *id)
D
David Brownell 已提交
1191 1192 1193 1194
{
	int				status;
	unsigned			i;
	struct twl4030_platform_data	*pdata = client->dev.platform_data;
1195
	struct device_node		*node = client->dev.of_node;
1196
	u8 temp;
1197
	int ret = 0;
1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213
	int nr_irqs = TWL4030_NR_IRQS;

	if ((id->driver_data) & TWL6030_CLASS)
		nr_irqs = TWL6030_NR_IRQS;

	if (node && !pdata) {
		/*
		 * XXX: Temporary pdata until the information is correctly
		 * retrieved by every TWL modules from DT.
		 */
		pdata = devm_kzalloc(&client->dev,
				     sizeof(struct twl4030_platform_data),
				     GFP_KERNEL);
		if (!pdata)
			return -ENOMEM;
	}
D
David Brownell 已提交
1214 1215 1216 1217 1218 1219

	if (!pdata) {
		dev_dbg(&client->dev, "no platform data?\n");
		return -EINVAL;
	}

1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236
	status = irq_alloc_descs(-1, pdata->irq_base, nr_irqs, 0);
	if (IS_ERR_VALUE(status)) {
		dev_err(&client->dev, "Fail to allocate IRQ descs\n");
		return status;
	}

	pdata->irq_base = status;
	pdata->irq_end = pdata->irq_base + nr_irqs;

	domain.irq_base = pdata->irq_base;
	domain.nr_irq = nr_irqs;
#ifdef CONFIG_OF_IRQ
	domain.of_node = of_node_get(node);
	domain.ops = &irq_domain_simple_ops;
#endif
	irq_domain_add(&domain);

D
David Brownell 已提交
1237 1238 1239 1240 1241
	if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C) == 0) {
		dev_dbg(&client->dev, "can't talk I2C?\n");
		return -EIO;
	}

D
David Brownell 已提交
1242
	if (inuse) {
D
David Brownell 已提交
1243 1244 1245 1246
		dev_dbg(&client->dev, "driver is already in use\n");
		return -EBUSY;
	}

B
Balaji T K 已提交
1247 1248
	for (i = 0; i < TWL_NUM_SLAVES; i++) {
		struct twl_client	*twl = &twl_modules[i];
D
David Brownell 已提交
1249 1250 1251 1252 1253 1254 1255 1256

		twl->address = client->addr + i;
		if (i == 0)
			twl->client = client;
		else {
			twl->client = i2c_new_dummy(client->adapter,
					twl->address);
			if (!twl->client) {
1257
				dev_err(&client->dev,
D
David Brownell 已提交
1258 1259 1260 1261 1262 1263 1264 1265
					"can't attach client %d\n", i);
				status = -ENOMEM;
				goto fail;
			}
		}
		mutex_init(&twl->xfer_lock);
	}
	inuse = true;
1266 1267 1268 1269 1270 1271 1272
	if ((id->driver_data) & TWL6030_CLASS) {
		twl_id = TWL6030_CLASS_ID;
		twl_map = &twl6030_map[0];
	} else {
		twl_id = TWL4030_CLASS_ID;
		twl_map = &twl4030_map[0];
	}
D
David Brownell 已提交
1273 1274

	/* setup clock framework */
1275
	clocks_init(&client->dev, pdata->clock);
D
David Brownell 已提交
1276

1277 1278 1279 1280 1281 1282
	/* read TWL IDCODE Register */
	if (twl_id == TWL4030_CLASS_ID) {
		ret = twl_read_idcode_register();
		WARN(ret < 0, "Error: reading twl_idcode register value\n");
	}

1283 1284 1285 1286
	/* load power event scripts */
	if (twl_has_power() && pdata->power)
		twl4030_power_init(pdata->power);

D
David Brownell 已提交
1287 1288 1289 1290
	/* Maybe init the T2 Interrupt subsystem */
	if (client->irq
			&& pdata->irq_base
			&& pdata->irq_end > pdata->irq_base) {
1291 1292 1293 1294 1295 1296 1297 1298 1299
		if (twl_class_is_4030()) {
			twl4030_init_chip_irq(id->name);
			status = twl4030_init_irq(client->irq, pdata->irq_base,
			pdata->irq_end);
		} else {
			status = twl6030_init_irq(client->irq, pdata->irq_base,
			pdata->irq_end);
		}

D
David Brownell 已提交
1300 1301
		if (status < 0)
			goto fail;
D
David Brownell 已提交
1302 1303
	}

1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315
	/* Disable TWL4030/TWL5030 I2C Pull-up on I2C1 and I2C4(SR) interface.
	 * Program I2C_SCL_CTRL_PU(bit 0)=0, I2C_SDA_CTRL_PU (bit 2)=0,
	 * SR_I2C_SCL_CTRL_PU(bit 4)=0 and SR_I2C_SDA_CTRL_PU(bit 6)=0.
	 */

	if (twl_class_is_4030()) {
		twl_i2c_read_u8(TWL4030_MODULE_INTBR, &temp, REG_GPPUPDCTR1);
		temp &= ~(SR_I2C_SDA_CTRL_PU | SR_I2C_SCL_CTRL_PU | \
		I2C_SDA_CTRL_PU | I2C_SCL_CTRL_PU);
		twl_i2c_write_u8(TWL4030_MODULE_INTBR, temp, REG_GPPUPDCTR1);
	}

1316 1317 1318 1319 1320 1321 1322
#ifdef CONFIG_OF_DEVICE
	if (node)
		status = of_platform_populate(node, NULL, NULL, &client->dev);
	else
#endif
		status = add_children(pdata, id->driver_data);

D
David Brownell 已提交
1323 1324
fail:
	if (status < 0)
B
Balaji T K 已提交
1325
		twl_remove(client);
D
David Brownell 已提交
1326 1327 1328
	return status;
}

B
Balaji T K 已提交
1329
static const struct i2c_device_id twl_ids[] = {
1330 1331
	{ "twl4030", TWL4030_VAUX2 },	/* "Triton 2" */
	{ "twl5030", 0 },		/* T2 updated */
I
Ilkka Koskinen 已提交
1332
	{ "twl5031", TWL5031 },		/* TWL5030 updated */
1333 1334 1335
	{ "tps65950", 0 },		/* catalog version of twl5030 */
	{ "tps65930", TPS_SUBSET },	/* fewer LDOs and DACs; no charger */
	{ "tps65920", TPS_SUBSET },	/* fewer LDOs; no codec or charger */
1336 1337
	{ "tps65921", TPS_SUBSET },	/* fewer LDOs; no codec, no LED
					   and vibrator. Charger in USB module*/
1338
	{ "twl6030", TWL6030_CLASS },	/* "Phoenix power chip" */
1339
	{ "twl6025", TWL6030_CLASS | TWL6025_SUBCLASS }, /* "Phoenix lite" */
D
David Brownell 已提交
1340 1341
	{ /* end of list */ },
};
B
Balaji T K 已提交
1342
MODULE_DEVICE_TABLE(i2c, twl_ids);
D
David Brownell 已提交
1343 1344

/* One Client Driver , 4 Clients */
B
Balaji T K 已提交
1345
static struct i2c_driver twl_driver = {
D
David Brownell 已提交
1346
	.driver.name	= DRIVER_NAME,
B
Balaji T K 已提交
1347 1348 1349
	.id_table	= twl_ids,
	.probe		= twl_probe,
	.remove		= twl_remove,
D
David Brownell 已提交
1350 1351
};

B
Balaji T K 已提交
1352
static int __init twl_init(void)
D
David Brownell 已提交
1353
{
B
Balaji T K 已提交
1354
	return i2c_add_driver(&twl_driver);
D
David Brownell 已提交
1355
}
B
Balaji T K 已提交
1356
subsys_initcall(twl_init);
D
David Brownell 已提交
1357

B
Balaji T K 已提交
1358
static void __exit twl_exit(void)
D
David Brownell 已提交
1359
{
B
Balaji T K 已提交
1360
	i2c_del_driver(&twl_driver);
D
David Brownell 已提交
1361
}
B
Balaji T K 已提交
1362
module_exit(twl_exit);
D
David Brownell 已提交
1363 1364

MODULE_AUTHOR("Texas Instruments, Inc.");
B
Balaji T K 已提交
1365
MODULE_DESCRIPTION("I2C Core interface for TWL");
D
David Brownell 已提交
1366
MODULE_LICENSE("GPL");