Linux Audio

Check our new training course

Loading...
v3.1
   1/*
   2 * twl_core.c - driver for TWL4030/TWL5030/TWL60X0/TPS659x0 PM
   3 * and audio CODEC devices
   4 *
   5 * Copyright (C) 2005-2006 Texas Instruments, Inc.
   6 *
   7 * Modifications to defer interrupt handling to a kernel thread:
   8 * Copyright (C) 2006 MontaVista Software, Inc.
   9 *
  10 * Based on tlv320aic23.c:
  11 * Copyright (c) by Kai Svahn <kai.svahn@nokia.com>
  12 *
  13 * Code cleanup and modifications to IRQ handler.
  14 * by syed khasim <x0khasim@ti.com>
  15 *
  16 * This program is free software; you can redistribute it and/or modify
  17 * it under the terms of the GNU General Public License as published by
  18 * the Free Software Foundation; either version 2 of the License, or
  19 * (at your option) any later version.
  20 *
  21 * This program is distributed in the hope that it will be useful,
  22 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  23 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  24 * GNU General Public License for more details.
  25 *
  26 * You should have received a copy of the GNU General Public License
  27 * along with this program; if not, write to the Free Software
  28 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  29 */
  30
  31#include <linux/init.h>
  32#include <linux/mutex.h>
 
  33#include <linux/platform_device.h>
  34#include <linux/clk.h>
  35#include <linux/err.h>
 
 
 
 
 
 
  36
  37#include <linux/regulator/machine.h>
  38
  39#include <linux/i2c.h>
  40#include <linux/i2c/twl.h>
  41
  42#if defined(CONFIG_ARCH_OMAP2) || defined(CONFIG_ARCH_OMAP3)
  43#include <plat/cpu.h>
  44#endif
  45
  46/*
  47 * The TWL4030 "Triton 2" is one of a family of a multi-function "Power
  48 * Management and System Companion Device" chips originally designed for
  49 * use in OMAP2 and OMAP 3 based systems.  Its control interfaces use I2C,
  50 * often at around 3 Mbit/sec, including for interrupt handling.
  51 *
  52 * This driver core provides genirq support for the interrupts emitted,
  53 * by the various modules, and exports register access primitives.
  54 *
  55 * FIXME this driver currently requires use of the first interrupt line
  56 * (and associated registers).
  57 */
  58
  59#define DRIVER_NAME			"twl"
  60
  61#if defined(CONFIG_KEYBOARD_TWL4030) || defined(CONFIG_KEYBOARD_TWL4030_MODULE)
  62#define twl_has_keypad()	true
  63#else
  64#define twl_has_keypad()	false
  65#endif
  66
  67#if defined(CONFIG_GPIO_TWL4030) || defined(CONFIG_GPIO_TWL4030_MODULE)
  68#define twl_has_gpio()	true
  69#else
  70#define twl_has_gpio()	false
  71#endif
  72
  73#if defined(CONFIG_REGULATOR_TWL4030) \
  74	|| defined(CONFIG_REGULATOR_TWL4030_MODULE)
  75#define twl_has_regulator()	true
  76#else
  77#define twl_has_regulator()	false
  78#endif
  79
  80#if defined(CONFIG_TWL4030_MADC) || defined(CONFIG_TWL4030_MADC_MODULE)
  81#define twl_has_madc()	true
  82#else
  83#define twl_has_madc()	false
  84#endif
  85
  86#ifdef CONFIG_TWL4030_POWER
  87#define twl_has_power()        true
  88#else
  89#define twl_has_power()        false
  90#endif
  91
  92#if defined(CONFIG_RTC_DRV_TWL4030) || defined(CONFIG_RTC_DRV_TWL4030_MODULE)
  93#define twl_has_rtc()	true
  94#else
  95#define twl_has_rtc()	false
  96#endif
  97
  98#if defined(CONFIG_TWL4030_USB) || defined(CONFIG_TWL4030_USB_MODULE) ||\
  99	defined(CONFIG_TWL6030_USB) || defined(CONFIG_TWL6030_USB_MODULE)
 100#define twl_has_usb()	true
 101#else
 102#define twl_has_usb()	false
 103#endif
 104
 105#if defined(CONFIG_TWL4030_WATCHDOG) || \
 106	defined(CONFIG_TWL4030_WATCHDOG_MODULE)
 107#define twl_has_watchdog()        true
 108#else
 109#define twl_has_watchdog()        false
 110#endif
 111
 112#if defined(CONFIG_TWL4030_CODEC) || defined(CONFIG_TWL4030_CODEC_MODULE) ||\
 113	defined(CONFIG_TWL6040_CORE) || defined(CONFIG_TWL6040_CORE_MODULE)
 114#define twl_has_codec()	true
 115#else
 116#define twl_has_codec()	false
 117#endif
 118
 119#if defined(CONFIG_CHARGER_TWL4030) || defined(CONFIG_CHARGER_TWL4030_MODULE)
 120#define twl_has_bci()	true
 121#else
 122#define twl_has_bci()	false
 123#endif
 124
 125/* Triton Core internal information (BEGIN) */
 126
 127/* Last - for index max*/
 128#define TWL4030_MODULE_LAST		TWL4030_MODULE_SECURED_REG
 129
 130#define TWL_NUM_SLAVES		4
 131
 132#if defined(CONFIG_INPUT_TWL4030_PWRBUTTON) \
 133	|| defined(CONFIG_INPUT_TWL4030_PWRBUTTON_MODULE)
 134#define twl_has_pwrbutton()	true
 135#else
 136#define twl_has_pwrbutton()	false
 137#endif
 138
 139#define SUB_CHIP_ID0 0
 140#define SUB_CHIP_ID1 1
 141#define SUB_CHIP_ID2 2
 142#define SUB_CHIP_ID3 3
 
 143
 144#define TWL_MODULE_LAST TWL4030_MODULE_LAST
 145
 146/* Base Address defns for twl4030_map[] */
 147
 148/* subchip/slave 0 - USB ID */
 149#define TWL4030_BASEADD_USB		0x0000
 150
 151/* subchip/slave 1 - AUD ID */
 152#define TWL4030_BASEADD_AUDIO_VOICE	0x0000
 153#define TWL4030_BASEADD_GPIO		0x0098
 154#define TWL4030_BASEADD_INTBR		0x0085
 155#define TWL4030_BASEADD_PIH		0x0080
 156#define TWL4030_BASEADD_TEST		0x004C
 157
 158/* subchip/slave 2 - AUX ID */
 159#define TWL4030_BASEADD_INTERRUPTS	0x00B9
 160#define TWL4030_BASEADD_LED		0x00EE
 161#define TWL4030_BASEADD_MADC		0x0000
 162#define TWL4030_BASEADD_MAIN_CHARGE	0x0074
 163#define TWL4030_BASEADD_PRECHARGE	0x00AA
 164#define TWL4030_BASEADD_PWM0		0x00F8
 165#define TWL4030_BASEADD_PWM1		0x00FB
 166#define TWL4030_BASEADD_PWMA		0x00EF
 167#define TWL4030_BASEADD_PWMB		0x00F1
 168#define TWL4030_BASEADD_KEYPAD		0x00D2
 169
 170#define TWL5031_BASEADD_ACCESSORY	0x0074 /* Replaces Main Charge */
 171#define TWL5031_BASEADD_INTERRUPTS	0x00B9 /* Different than TWL4030's
 172						  one */
 173
 174/* subchip/slave 3 - POWER ID */
 175#define TWL4030_BASEADD_BACKUP		0x0014
 176#define TWL4030_BASEADD_INT		0x002E
 177#define TWL4030_BASEADD_PM_MASTER	0x0036
 178#define TWL4030_BASEADD_PM_RECEIVER	0x005B
 179#define TWL4030_BASEADD_RTC		0x001C
 180#define TWL4030_BASEADD_SECURED_REG	0x0000
 181
 182/* Triton Core internal information (END) */
 183
 184
 185/* subchip/slave 0 0x48 - POWER */
 186#define TWL6030_BASEADD_RTC		0x0000
 187#define TWL6030_BASEADD_MEM		0x0017
 188#define TWL6030_BASEADD_PM_MASTER	0x001F
 189#define TWL6030_BASEADD_PM_SLAVE_MISC	0x0030 /* PM_RECEIVER */
 190#define TWL6030_BASEADD_PM_MISC		0x00E2
 191#define TWL6030_BASEADD_PM_PUPD		0x00F0
 192
 193/* subchip/slave 1 0x49 - FEATURE */
 194#define TWL6030_BASEADD_USB		0x0000
 195#define TWL6030_BASEADD_GPADC_CTRL	0x002E
 196#define TWL6030_BASEADD_AUX		0x0090
 197#define TWL6030_BASEADD_PWM		0x00BA
 198#define TWL6030_BASEADD_GASGAUGE	0x00C0
 199#define TWL6030_BASEADD_PIH		0x00D0
 200#define TWL6030_BASEADD_CHARGER		0x00E0
 201#define TWL6025_BASEADD_CHARGER		0x00DA
 202
 203/* subchip/slave 2 0x4A - DFT */
 204#define TWL6030_BASEADD_DIEID		0x00C0
 205
 206/* subchip/slave 3 0x4B - AUDIO */
 207#define TWL6030_BASEADD_AUDIO		0x0000
 208#define TWL6030_BASEADD_RSV		0x0000
 209#define TWL6030_BASEADD_ZERO		0x0000
 210
 211/* Few power values */
 212#define R_CFG_BOOT			0x05
 213
 214/* some fields in R_CFG_BOOT */
 215#define HFCLK_FREQ_19p2_MHZ		(1 << 0)
 216#define HFCLK_FREQ_26_MHZ		(2 << 0)
 217#define HFCLK_FREQ_38p4_MHZ		(3 << 0)
 218#define HIGH_PERF_SQ			(1 << 3)
 219#define CK32K_LOWPWR_EN			(1 << 7)
 220
 221
 222/* chip-specific feature flags, for i2c_device_id.driver_data */
 223#define TWL4030_VAUX2		BIT(0)	/* pre-5030 voltage ranges */
 224#define TPS_SUBSET		BIT(1)	/* tps659[23]0 have fewer LDOs */
 225#define TWL5031			BIT(2)  /* twl5031 has different registers */
 226#define TWL6030_CLASS		BIT(3)	/* TWL6030 class */
 227
 228/*----------------------------------------------------------------------*/
 229
 230/* is driver active, bound to a chip? */
 231static bool inuse;
 232
 233/* TWL IDCODE Register value */
 234static u32 twl_idcode;
 235
 236static unsigned int twl_id;
 237unsigned int twl_rev(void)
 238{
 239	return twl_id;
 240}
 241EXPORT_SYMBOL(twl_rev);
 242
 243/* Structure for each TWL4030/TWL6030 Slave */
 244struct twl_client {
 245	struct i2c_client *client;
 246	u8 address;
 247
 248	/* max numb of i2c_msg required is for read =2 */
 249	struct i2c_msg xfer_msg[2];
 250
 251	/* To lock access to xfer_msg */
 252	struct mutex xfer_lock;
 253};
 254
 255static struct twl_client twl_modules[TWL_NUM_SLAVES];
 256
 257
 258/* mapping the module id to slave id and base address */
 259struct twl_mapping {
 260	unsigned char sid;	/* Slave ID */
 261	unsigned char base;	/* base address */
 262};
 263static struct twl_mapping *twl_map;
 264
 265static struct twl_mapping twl4030_map[TWL4030_MODULE_LAST + 1] = {
 266	/*
 267	 * NOTE:  don't change this table without updating the
 268	 * <linux/i2c/twl.h> defines for TWL4030_MODULE_*
 269	 * so they continue to match the order in this table.
 270	 */
 271
 272	{ 0, TWL4030_BASEADD_USB },
 273
 274	{ 1, TWL4030_BASEADD_AUDIO_VOICE },
 275	{ 1, TWL4030_BASEADD_GPIO },
 276	{ 1, TWL4030_BASEADD_INTBR },
 277	{ 1, TWL4030_BASEADD_PIH },
 278	{ 1, TWL4030_BASEADD_TEST },
 279
 280	{ 2, TWL4030_BASEADD_KEYPAD },
 281	{ 2, TWL4030_BASEADD_MADC },
 282	{ 2, TWL4030_BASEADD_INTERRUPTS },
 283	{ 2, TWL4030_BASEADD_LED },
 284	{ 2, TWL4030_BASEADD_MAIN_CHARGE },
 285	{ 2, TWL4030_BASEADD_PRECHARGE },
 286	{ 2, TWL4030_BASEADD_PWM0 },
 287	{ 2, TWL4030_BASEADD_PWM1 },
 288	{ 2, TWL4030_BASEADD_PWMA },
 289	{ 2, TWL4030_BASEADD_PWMB },
 290	{ 2, TWL5031_BASEADD_ACCESSORY },
 291	{ 2, TWL5031_BASEADD_INTERRUPTS },
 292
 293	{ 3, TWL4030_BASEADD_BACKUP },
 294	{ 3, TWL4030_BASEADD_INT },
 295	{ 3, TWL4030_BASEADD_PM_MASTER },
 296	{ 3, TWL4030_BASEADD_PM_RECEIVER },
 297	{ 3, TWL4030_BASEADD_RTC },
 298	{ 3, TWL4030_BASEADD_SECURED_REG },
 299};
 300
 301static struct twl_mapping twl6030_map[] = {
 302	/*
 303	 * NOTE:  don't change this table without updating the
 304	 * <linux/i2c/twl.h> defines for TWL4030_MODULE_*
 305	 * so they continue to match the order in this table.
 306	 */
 307	{ SUB_CHIP_ID1, TWL6030_BASEADD_USB },
 308	{ SUB_CHIP_ID3, TWL6030_BASEADD_AUDIO },
 309	{ SUB_CHIP_ID2, TWL6030_BASEADD_DIEID },
 310	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
 311	{ SUB_CHIP_ID1, TWL6030_BASEADD_PIH },
 312
 313	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
 314	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
 315	{ SUB_CHIP_ID1, TWL6030_BASEADD_GPADC_CTRL },
 316	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
 317	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
 318
 319	{ SUB_CHIP_ID1, TWL6030_BASEADD_CHARGER },
 320	{ SUB_CHIP_ID1, TWL6030_BASEADD_GASGAUGE },
 321	{ SUB_CHIP_ID1, TWL6030_BASEADD_PWM },
 322	{ SUB_CHIP_ID0, TWL6030_BASEADD_ZERO },
 323	{ SUB_CHIP_ID1, TWL6030_BASEADD_ZERO },
 324
 325	{ SUB_CHIP_ID2, TWL6030_BASEADD_ZERO },
 326	{ SUB_CHIP_ID2, TWL6030_BASEADD_ZERO },
 327	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
 328	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
 329	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
 330	{ SUB_CHIP_ID0, TWL6030_BASEADD_PM_MASTER },
 331	{ SUB_CHIP_ID0, TWL6030_BASEADD_PM_SLAVE_MISC },
 332
 333	{ SUB_CHIP_ID0, TWL6030_BASEADD_RTC },
 334	{ SUB_CHIP_ID0, TWL6030_BASEADD_MEM },
 335	{ SUB_CHIP_ID1, TWL6025_BASEADD_CHARGER },
 336};
 337
 338/*----------------------------------------------------------------------*/
 339
 340/* Exported Functions */
 341
 342/**
 343 * twl_i2c_write - Writes a n bit register in TWL4030/TWL5030/TWL60X0
 344 * @mod_no: module number
 345 * @value: an array of num_bytes+1 containing data to write
 346 * @reg: register address (just offset will do)
 347 * @num_bytes: number of bytes to transfer
 348 *
 349 * IMPORTANT: for 'value' parameter: Allocate value num_bytes+1 and
 350 * valid data starts at Offset 1.
 351 *
 352 * Returns the result of operation - 0 is success
 353 */
 354int twl_i2c_write(u8 mod_no, u8 *value, u8 reg, unsigned num_bytes)
 355{
 356	int ret;
 357	int sid;
 358	struct twl_client *twl;
 359	struct i2c_msg *msg;
 360
 361	if (unlikely(mod_no > TWL_MODULE_LAST)) {
 362		pr_err("%s: invalid module number %d\n", DRIVER_NAME, mod_no);
 363		return -EPERM;
 364	}
 365	sid = twl_map[mod_no].sid;
 366	twl = &twl_modules[sid];
 367
 368	if (unlikely(!inuse)) {
 369		pr_err("%s: client %d is not initialized\n", DRIVER_NAME, sid);
 370		return -EPERM;
 371	}
 
 
 
 
 
 
 
 
 372	mutex_lock(&twl->xfer_lock);
 373	/*
 374	 * [MSG1]: fill the register address data
 375	 * fill the data Tx buffer
 376	 */
 377	msg = &twl->xfer_msg[0];
 378	msg->addr = twl->address;
 379	msg->len = num_bytes + 1;
 380	msg->flags = 0;
 381	msg->buf = value;
 382	/* over write the first byte of buffer with the register address */
 383	*value = twl_map[mod_no].base + reg;
 384	ret = i2c_transfer(twl->client->adapter, twl->xfer_msg, 1);
 385	mutex_unlock(&twl->xfer_lock);
 386
 387	/* i2c_transfer returns number of messages transferred */
 388	if (ret != 1) {
 389		pr_err("%s: i2c_write failed to transfer all messages\n",
 390			DRIVER_NAME);
 391		if (ret < 0)
 392			return ret;
 393		else
 394			return -EIO;
 395	} else {
 396		return 0;
 397	}
 398}
 399EXPORT_SYMBOL(twl_i2c_write);
 400
 401/**
 402 * twl_i2c_read - Reads a n bit register in TWL4030/TWL5030/TWL60X0
 403 * @mod_no: module number
 404 * @value: an array of num_bytes containing data to be read
 405 * @reg: register address (just offset will do)
 406 * @num_bytes: number of bytes to transfer
 407 *
 408 * Returns result of operation - num_bytes is success else failure.
 409 */
 410int twl_i2c_read(u8 mod_no, u8 *value, u8 reg, unsigned num_bytes)
 411{
 412	int ret;
 413	u8 val;
 414	int sid;
 415	struct twl_client *twl;
 416	struct i2c_msg *msg;
 417
 418	if (unlikely(mod_no > TWL_MODULE_LAST)) {
 419		pr_err("%s: invalid module number %d\n", DRIVER_NAME, mod_no);
 420		return -EPERM;
 421	}
 422	sid = twl_map[mod_no].sid;
 423	twl = &twl_modules[sid];
 424
 425	if (unlikely(!inuse)) {
 426		pr_err("%s: client %d is not initialized\n", DRIVER_NAME, sid);
 427		return -EPERM;
 428	}
 
 
 
 
 
 
 
 
 429	mutex_lock(&twl->xfer_lock);
 430	/* [MSG1] fill the register address data */
 431	msg = &twl->xfer_msg[0];
 432	msg->addr = twl->address;
 433	msg->len = 1;
 434	msg->flags = 0;	/* Read the register value */
 435	val = twl_map[mod_no].base + reg;
 436	msg->buf = &val;
 437	/* [MSG2] fill the data rx buffer */
 438	msg = &twl->xfer_msg[1];
 439	msg->addr = twl->address;
 440	msg->flags = I2C_M_RD;	/* Read the register value */
 441	msg->len = num_bytes;	/* only n bytes */
 442	msg->buf = value;
 443	ret = i2c_transfer(twl->client->adapter, twl->xfer_msg, 2);
 444	mutex_unlock(&twl->xfer_lock);
 445
 446	/* i2c_transfer returns number of messages transferred */
 447	if (ret != 2) {
 448		pr_err("%s: i2c_read failed to transfer all messages\n",
 449			DRIVER_NAME);
 450		if (ret < 0)
 451			return ret;
 452		else
 453			return -EIO;
 454	} else {
 455		return 0;
 456	}
 457}
 458EXPORT_SYMBOL(twl_i2c_read);
 459
 460/**
 461 * twl_i2c_write_u8 - Writes a 8 bit register in TWL4030/TWL5030/TWL60X0
 462 * @mod_no: module number
 463 * @value: the value to be written 8 bit
 464 * @reg: register address (just offset will do)
 465 *
 466 * Returns result of operation - 0 is success
 467 */
 468int twl_i2c_write_u8(u8 mod_no, u8 value, u8 reg)
 469{
 470
 471	/* 2 bytes offset 1 contains the data offset 0 is used by i2c_write */
 472	u8 temp_buffer[2] = { 0 };
 473	/* offset 1 contains the data */
 474	temp_buffer[1] = value;
 475	return twl_i2c_write(mod_no, temp_buffer, reg, 1);
 476}
 477EXPORT_SYMBOL(twl_i2c_write_u8);
 478
 479/**
 480 * twl_i2c_read_u8 - Reads a 8 bit register from TWL4030/TWL5030/TWL60X0
 481 * @mod_no: module number
 482 * @value: the value read 8 bit
 483 * @reg: register address (just offset will do)
 484 *
 485 * Returns result of operation - 0 is success
 486 */
 487int twl_i2c_read_u8(u8 mod_no, u8 *value, u8 reg)
 488{
 489	return twl_i2c_read(mod_no, value, reg, 1);
 490}
 491EXPORT_SYMBOL(twl_i2c_read_u8);
 492
 493/*----------------------------------------------------------------------*/
 494
 495/**
 496 * twl_read_idcode_register - API to read the IDCODE register.
 497 *
 498 * Unlocks the IDCODE register and read the 32 bit value.
 499 */
 500static int twl_read_idcode_register(void)
 501{
 502	int err;
 503
 504	err = twl_i2c_write_u8(TWL4030_MODULE_INTBR, TWL_EEPROM_R_UNLOCK,
 505						REG_UNLOCK_TEST_REG);
 506	if (err) {
 507		pr_err("TWL4030 Unable to unlock IDCODE registers -%d\n", err);
 508		goto fail;
 509	}
 510
 511	err = twl_i2c_read(TWL4030_MODULE_INTBR, (u8 *)(&twl_idcode),
 512						REG_IDCODE_7_0, 4);
 513	if (err) {
 514		pr_err("TWL4030: unable to read IDCODE -%d\n", err);
 515		goto fail;
 516	}
 517
 518	err = twl_i2c_write_u8(TWL4030_MODULE_INTBR, 0x0, REG_UNLOCK_TEST_REG);
 519	if (err)
 520		pr_err("TWL4030 Unable to relock IDCODE registers -%d\n", err);
 521fail:
 522	return err;
 523}
 524
 525/**
 526 * twl_get_type - API to get TWL Si type.
 527 *
 528 * Api to get the TWL Si type from IDCODE value.
 529 */
 530int twl_get_type(void)
 531{
 532	return TWL_SIL_TYPE(twl_idcode);
 533}
 534EXPORT_SYMBOL_GPL(twl_get_type);
 535
 536/**
 537 * twl_get_version - API to get TWL Si version.
 538 *
 539 * Api to get the TWL Si version from IDCODE value.
 540 */
 541int twl_get_version(void)
 542{
 543	return TWL_SIL_REV(twl_idcode);
 544}
 545EXPORT_SYMBOL_GPL(twl_get_version);
 546
 547static struct device *
 548add_numbered_child(unsigned chip, const char *name, int num,
 549		void *pdata, unsigned pdata_len,
 550		bool can_wakeup, int irq0, int irq1)
 551{
 552	struct platform_device	*pdev;
 553	struct twl_client	*twl = &twl_modules[chip];
 554	int			status;
 555
 556	pdev = platform_device_alloc(name, num);
 557	if (!pdev) {
 558		dev_dbg(&twl->client->dev, "can't alloc dev\n");
 559		status = -ENOMEM;
 560		goto err;
 561	}
 562
 563	device_init_wakeup(&pdev->dev, can_wakeup);
 564	pdev->dev.parent = &twl->client->dev;
 565
 566	if (pdata) {
 567		status = platform_device_add_data(pdev, pdata, pdata_len);
 568		if (status < 0) {
 569			dev_dbg(&pdev->dev, "can't add platform_data\n");
 570			goto err;
 571		}
 572	}
 573
 574	if (irq0) {
 575		struct resource r[2] = {
 576			{ .start = irq0, .flags = IORESOURCE_IRQ, },
 577			{ .start = irq1, .flags = IORESOURCE_IRQ, },
 578		};
 579
 580		status = platform_device_add_resources(pdev, r, irq1 ? 2 : 1);
 581		if (status < 0) {
 582			dev_dbg(&pdev->dev, "can't add irqs\n");
 583			goto err;
 584		}
 585	}
 586
 587	status = platform_device_add(pdev);
 588
 589err:
 590	if (status < 0) {
 591		platform_device_put(pdev);
 592		dev_err(&twl->client->dev, "can't add %s dev\n", name);
 593		return ERR_PTR(status);
 594	}
 595	return &pdev->dev;
 596}
 597
 598static inline struct device *add_child(unsigned chip, const char *name,
 599		void *pdata, unsigned pdata_len,
 600		bool can_wakeup, int irq0, int irq1)
 601{
 602	return add_numbered_child(chip, name, -1, pdata, pdata_len,
 603		can_wakeup, irq0, irq1);
 604}
 605
 606static struct device *
 607add_regulator_linked(int num, struct regulator_init_data *pdata,
 608		struct regulator_consumer_supply *consumers,
 609		unsigned num_consumers, unsigned long features)
 610{
 611	unsigned sub_chip_id;
 
 
 612	/* regulator framework demands init_data ... */
 613	if (!pdata)
 614		return NULL;
 615
 616	if (consumers) {
 617		pdata->consumer_supplies = consumers;
 618		pdata->num_consumer_supplies = num_consumers;
 619	}
 620
 621	pdata->driver_data = (void *)features;
 
 
 
 
 
 
 
 
 
 
 
 
 622
 623	/* NOTE:  we currently ignore regulator IRQs, e.g. for short circuits */
 624	sub_chip_id = twl_map[TWL_MODULE_PM_MASTER].sid;
 625	return add_numbered_child(sub_chip_id, "twl_reg", num,
 626		pdata, sizeof(*pdata), false, 0, 0);
 627}
 628
 629static struct device *
 630add_regulator(int num, struct regulator_init_data *pdata,
 631		unsigned long features)
 632{
 633	return add_regulator_linked(num, pdata, NULL, 0, features);
 634}
 635
 636/*
 637 * NOTE:  We know the first 8 IRQs after pdata->base_irq are
 638 * for the PIH, and the next are for the PWR_INT SIH, since
 639 * that's how twl_init_irq() sets things up.
 640 */
 641
 642static int
 643add_children(struct twl4030_platform_data *pdata, unsigned long features)
 
 644{
 645	struct device	*child;
 646	unsigned sub_chip_id;
 647
 648	if (twl_has_gpio() && pdata->gpio) {
 649		child = add_child(SUB_CHIP_ID1, "twl4030_gpio",
 650				pdata->gpio, sizeof(*pdata->gpio),
 651				false, pdata->irq_base + GPIO_INTR_OFFSET, 0);
 652		if (IS_ERR(child))
 653			return PTR_ERR(child);
 654	}
 655
 656	if (twl_has_keypad() && pdata->keypad) {
 657		child = add_child(SUB_CHIP_ID2, "twl4030_keypad",
 658				pdata->keypad, sizeof(*pdata->keypad),
 659				true, pdata->irq_base + KEYPAD_INTR_OFFSET, 0);
 660		if (IS_ERR(child))
 661			return PTR_ERR(child);
 662	}
 663
 664	if (twl_has_madc() && pdata->madc) {
 665		child = add_child(2, "twl4030_madc",
 666				pdata->madc, sizeof(*pdata->madc),
 667				true, pdata->irq_base + MADC_INTR_OFFSET, 0);
 668		if (IS_ERR(child))
 669			return PTR_ERR(child);
 670	}
 671
 672	if (twl_has_rtc()) {
 673		/*
 674		 * REVISIT platform_data here currently might expose the
 675		 * "msecure" line ... but for now we just expect board
 676		 * setup to tell the chip "it's always ok to SET_TIME".
 677		 * Eventually, Linux might become more aware of such
 678		 * HW security concerns, and "least privilege".
 679		 */
 680		sub_chip_id = twl_map[TWL_MODULE_RTC].sid;
 681		child = add_child(sub_chip_id, "twl_rtc",
 682				NULL, 0,
 683				true, pdata->irq_base + RTC_INTR_OFFSET, 0);
 684		if (IS_ERR(child))
 685			return PTR_ERR(child);
 686	}
 687
 688	if (twl_has_usb() && pdata->usb && twl_class_is_4030()) {
 689
 690		static struct regulator_consumer_supply usb1v5 = {
 691			.supply =	"usb1v5",
 692		};
 693		static struct regulator_consumer_supply usb1v8 = {
 694			.supply =	"usb1v8",
 695		};
 696		static struct regulator_consumer_supply usb3v1 = {
 697			.supply =	"usb3v1",
 698		};
 699
 700	/* First add the regulators so that they can be used by transceiver */
 701		if (twl_has_regulator()) {
 702			/* this is a template that gets copied */
 703			struct regulator_init_data usb_fixed = {
 704				.constraints.valid_modes_mask =
 705					REGULATOR_MODE_NORMAL
 706					| REGULATOR_MODE_STANDBY,
 707				.constraints.valid_ops_mask =
 708					REGULATOR_CHANGE_MODE
 709					| REGULATOR_CHANGE_STATUS,
 710			};
 711
 712			child = add_regulator_linked(TWL4030_REG_VUSB1V5,
 713						      &usb_fixed, &usb1v5, 1,
 714						      features);
 715			if (IS_ERR(child))
 716				return PTR_ERR(child);
 717
 718			child = add_regulator_linked(TWL4030_REG_VUSB1V8,
 719						      &usb_fixed, &usb1v8, 1,
 720						      features);
 721			if (IS_ERR(child))
 722				return PTR_ERR(child);
 723
 724			child = add_regulator_linked(TWL4030_REG_VUSB3V1,
 725						      &usb_fixed, &usb3v1, 1,
 726						      features);
 727			if (IS_ERR(child))
 728				return PTR_ERR(child);
 729
 730		}
 731
 732		child = add_child(0, "twl4030_usb",
 733				pdata->usb, sizeof(*pdata->usb),
 734				true,
 735				/* irq0 = USB_PRES, irq1 = USB */
 736				pdata->irq_base + USB_PRES_INTR_OFFSET,
 737				pdata->irq_base + USB_INTR_OFFSET);
 738
 739		if (IS_ERR(child))
 740			return PTR_ERR(child);
 741
 742		/* we need to connect regulators to this transceiver */
 743		if (twl_has_regulator() && child) {
 744			usb1v5.dev = child;
 745			usb1v8.dev = child;
 746			usb3v1.dev = child;
 747		}
 748	}
 749	if (twl_has_usb() && pdata->usb && twl_class_is_6030()) {
 750
 751		static struct regulator_consumer_supply usb3v3;
 752		int regulator;
 753
 754		if (twl_has_regulator()) {
 755			/* this is a template that gets copied */
 756			struct regulator_init_data usb_fixed = {
 757				.constraints.valid_modes_mask =
 758					REGULATOR_MODE_NORMAL
 759					| REGULATOR_MODE_STANDBY,
 760				.constraints.valid_ops_mask =
 761					REGULATOR_CHANGE_MODE
 762					| REGULATOR_CHANGE_STATUS,
 763			};
 764
 765			if (features & TWL6025_SUBCLASS) {
 766				usb3v3.supply =	"ldousb";
 767				regulator = TWL6025_REG_LDOUSB;
 768			} else {
 769				usb3v3.supply = "vusb";
 770				regulator = TWL6030_REG_VUSB;
 771			}
 772			child = add_regulator_linked(regulator, &usb_fixed,
 773							&usb3v3, 1,
 774							features);
 775			if (IS_ERR(child))
 776				return PTR_ERR(child);
 777		}
 778
 779		pdata->usb->features = features;
 780
 781		child = add_child(0, "twl6030_usb",
 782			pdata->usb, sizeof(*pdata->usb),
 783			true,
 784			/* irq1 = VBUS_PRES, irq0 = USB ID */
 785			pdata->irq_base + USBOTG_INTR_OFFSET,
 786			pdata->irq_base + USB_PRES_INTR_OFFSET);
 787
 788		if (IS_ERR(child))
 789			return PTR_ERR(child);
 790		/* we need to connect regulators to this transceiver */
 791		if (twl_has_regulator() && child)
 792			usb3v3.dev = child;
 793	} else if (twl_has_regulator() && twl_class_is_6030()) {
 794		if (features & TWL6025_SUBCLASS)
 795			child = add_regulator(TWL6025_REG_LDOUSB,
 796						pdata->ldousb, features);
 797		else
 798			child = add_regulator(TWL6030_REG_VUSB,
 799						pdata->vusb, features);
 800
 801			if (IS_ERR(child))
 802					return PTR_ERR(child);
 803	}
 804
 805	if (twl_has_watchdog() && twl_class_is_4030()) {
 806		child = add_child(0, "twl4030_wdt", NULL, 0, false, 0, 0);
 807		if (IS_ERR(child))
 808			return PTR_ERR(child);
 809	}
 810
 811	if (twl_has_pwrbutton() && twl_class_is_4030()) {
 812		child = add_child(1, "twl4030_pwrbutton",
 813				NULL, 0, true, pdata->irq_base + 8 + 0, 0);
 814		if (IS_ERR(child))
 815			return PTR_ERR(child);
 816	}
 817
 818	if (twl_has_codec() && pdata->audio && twl_class_is_4030()) {
 819		sub_chip_id = twl_map[TWL_MODULE_AUDIO_VOICE].sid;
 820		child = add_child(sub_chip_id, "twl4030-audio",
 821				pdata->audio, sizeof(*pdata->audio),
 822				false, 0, 0);
 823		if (IS_ERR(child))
 824			return PTR_ERR(child);
 825	}
 826
 827	if (twl_has_codec() && pdata->audio && twl_class_is_6030()) {
 828		sub_chip_id = twl_map[TWL_MODULE_AUDIO_VOICE].sid;
 829		child = add_child(sub_chip_id, "twl6040",
 830				pdata->audio, sizeof(*pdata->audio),
 831				false, 0, 0);
 832		if (IS_ERR(child))
 833			return PTR_ERR(child);
 834	}
 835
 836	/* twl4030 regulators */
 837	if (twl_has_regulator() && twl_class_is_4030()) {
 838		child = add_regulator(TWL4030_REG_VPLL1, pdata->vpll1,
 839					features);
 840		if (IS_ERR(child))
 841			return PTR_ERR(child);
 842
 843		child = add_regulator(TWL4030_REG_VIO, pdata->vio,
 844					features);
 845		if (IS_ERR(child))
 846			return PTR_ERR(child);
 847
 848		child = add_regulator(TWL4030_REG_VDD1, pdata->vdd1,
 849					features);
 850		if (IS_ERR(child))
 851			return PTR_ERR(child);
 852
 853		child = add_regulator(TWL4030_REG_VDD2, pdata->vdd2,
 854					features);
 855		if (IS_ERR(child))
 856			return PTR_ERR(child);
 857
 858		child = add_regulator(TWL4030_REG_VMMC1, pdata->vmmc1,
 859					features);
 860		if (IS_ERR(child))
 861			return PTR_ERR(child);
 862
 863		child = add_regulator(TWL4030_REG_VDAC, pdata->vdac,
 864					features);
 865		if (IS_ERR(child))
 866			return PTR_ERR(child);
 867
 868		child = add_regulator((features & TWL4030_VAUX2)
 869					? TWL4030_REG_VAUX2_4030
 870					: TWL4030_REG_VAUX2,
 871				pdata->vaux2, features);
 872		if (IS_ERR(child))
 873			return PTR_ERR(child);
 874
 875		child = add_regulator(TWL4030_REG_VINTANA1, pdata->vintana1,
 876					features);
 877		if (IS_ERR(child))
 878			return PTR_ERR(child);
 879
 880		child = add_regulator(TWL4030_REG_VINTANA2, pdata->vintana2,
 881					features);
 882		if (IS_ERR(child))
 883			return PTR_ERR(child);
 884
 885		child = add_regulator(TWL4030_REG_VINTDIG, pdata->vintdig,
 886					features);
 887		if (IS_ERR(child))
 888			return PTR_ERR(child);
 889	}
 890
 891	/* maybe add LDOs that are omitted on cost-reduced parts */
 892	if (twl_has_regulator() && !(features & TPS_SUBSET)
 893	  && twl_class_is_4030()) {
 894		child = add_regulator(TWL4030_REG_VPLL2, pdata->vpll2,
 895					features);
 896		if (IS_ERR(child))
 897			return PTR_ERR(child);
 898
 899		child = add_regulator(TWL4030_REG_VMMC2, pdata->vmmc2,
 900					features);
 901		if (IS_ERR(child))
 902			return PTR_ERR(child);
 903
 904		child = add_regulator(TWL4030_REG_VSIM, pdata->vsim,
 905					features);
 906		if (IS_ERR(child))
 907			return PTR_ERR(child);
 908
 909		child = add_regulator(TWL4030_REG_VAUX1, pdata->vaux1,
 910					features);
 911		if (IS_ERR(child))
 912			return PTR_ERR(child);
 913
 914		child = add_regulator(TWL4030_REG_VAUX3, pdata->vaux3,
 915					features);
 916		if (IS_ERR(child))
 917			return PTR_ERR(child);
 918
 919		child = add_regulator(TWL4030_REG_VAUX4, pdata->vaux4,
 920					features);
 921		if (IS_ERR(child))
 922			return PTR_ERR(child);
 923	}
 924
 925	/* twl6030 regulators */
 926	if (twl_has_regulator() && twl_class_is_6030() &&
 927			!(features & TWL6025_SUBCLASS)) {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 928		child = add_regulator(TWL6030_REG_VMMC, pdata->vmmc,
 929					features);
 930		if (IS_ERR(child))
 931			return PTR_ERR(child);
 932
 933		child = add_regulator(TWL6030_REG_VPP, pdata->vpp,
 934					features);
 935		if (IS_ERR(child))
 936			return PTR_ERR(child);
 937
 938		child = add_regulator(TWL6030_REG_VUSIM, pdata->vusim,
 939					features);
 940		if (IS_ERR(child))
 941			return PTR_ERR(child);
 942
 943		child = add_regulator(TWL6030_REG_VCXIO, pdata->vcxio,
 944					features);
 945		if (IS_ERR(child))
 946			return PTR_ERR(child);
 947
 948		child = add_regulator(TWL6030_REG_VDAC, pdata->vdac,
 949					features);
 950		if (IS_ERR(child))
 951			return PTR_ERR(child);
 952
 953		child = add_regulator(TWL6030_REG_VAUX1_6030, pdata->vaux1,
 954					features);
 955		if (IS_ERR(child))
 956			return PTR_ERR(child);
 957
 958		child = add_regulator(TWL6030_REG_VAUX2_6030, pdata->vaux2,
 959					features);
 960		if (IS_ERR(child))
 961			return PTR_ERR(child);
 962
 963		child = add_regulator(TWL6030_REG_VAUX3_6030, pdata->vaux3,
 964					features);
 965		if (IS_ERR(child))
 966			return PTR_ERR(child);
 967
 968		child = add_regulator(TWL6030_REG_CLK32KG, pdata->clk32kg,
 969					features);
 970		if (IS_ERR(child))
 971			return PTR_ERR(child);
 972	}
 973
 974	/* 6030 and 6025 share this regulator */
 975	if (twl_has_regulator() && twl_class_is_6030()) {
 976		child = add_regulator(TWL6030_REG_VANA, pdata->vana,
 977					features);
 978		if (IS_ERR(child))
 979			return PTR_ERR(child);
 980	}
 981
 982	/* twl6025 regulators */
 983	if (twl_has_regulator() && twl_class_is_6030() &&
 984			(features & TWL6025_SUBCLASS)) {
 985		child = add_regulator(TWL6025_REG_LDO5, pdata->ldo5,
 986					features);
 987		if (IS_ERR(child))
 988			return PTR_ERR(child);
 989
 990		child = add_regulator(TWL6025_REG_LDO1, pdata->ldo1,
 991					features);
 992		if (IS_ERR(child))
 993			return PTR_ERR(child);
 994
 995		child = add_regulator(TWL6025_REG_LDO7, pdata->ldo7,
 996					features);
 997		if (IS_ERR(child))
 998			return PTR_ERR(child);
 999
1000		child = add_regulator(TWL6025_REG_LDO6, pdata->ldo6,
1001					features);
1002		if (IS_ERR(child))
1003			return PTR_ERR(child);
1004
1005		child = add_regulator(TWL6025_REG_LDOLN, pdata->ldoln,
1006					features);
1007		if (IS_ERR(child))
1008			return PTR_ERR(child);
1009
1010		child = add_regulator(TWL6025_REG_LDO2, pdata->ldo2,
1011					features);
1012		if (IS_ERR(child))
1013			return PTR_ERR(child);
1014
1015		child = add_regulator(TWL6025_REG_LDO4, pdata->ldo4,
1016					features);
1017		if (IS_ERR(child))
1018			return PTR_ERR(child);
1019
1020		child = add_regulator(TWL6025_REG_LDO3, pdata->ldo3,
1021					features);
1022		if (IS_ERR(child))
1023			return PTR_ERR(child);
1024
1025		child = add_regulator(TWL6025_REG_SMPS3, pdata->smps3,
1026					features);
1027		if (IS_ERR(child))
1028			return PTR_ERR(child);
1029
1030		child = add_regulator(TWL6025_REG_SMPS4, pdata->smps4,
1031					features);
1032		if (IS_ERR(child))
1033			return PTR_ERR(child);
1034
1035		child = add_regulator(TWL6025_REG_VIO, pdata->vio6025,
1036					features);
1037		if (IS_ERR(child))
1038			return PTR_ERR(child);
1039
1040	}
1041
1042	if (twl_has_bci() && pdata->bci &&
1043			!(features & (TPS_SUBSET | TWL5031))) {
1044		child = add_child(3, "twl4030_bci",
1045				pdata->bci, sizeof(*pdata->bci), false,
1046				/* irq0 = CHG_PRES, irq1 = BCI */
1047				pdata->irq_base + BCI_PRES_INTR_OFFSET,
1048				pdata->irq_base + BCI_INTR_OFFSET);
1049		if (IS_ERR(child))
1050			return PTR_ERR(child);
1051	}
1052
1053	return 0;
1054}
1055
1056/*----------------------------------------------------------------------*/
1057
1058/*
1059 * These three functions initialize the on-chip clock framework,
1060 * letting it generate the right frequencies for USB, MADC, and
1061 * other purposes.
1062 */
1063static inline int __init protect_pm_master(void)
1064{
1065	int e = 0;
1066
1067	e = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, 0,
1068			TWL4030_PM_MASTER_PROTECT_KEY);
1069	return e;
1070}
1071
1072static inline int __init unprotect_pm_master(void)
1073{
1074	int e = 0;
1075
1076	e |= twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER,
1077			TWL4030_PM_MASTER_KEY_CFG1,
1078			TWL4030_PM_MASTER_PROTECT_KEY);
1079	e |= twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER,
1080			TWL4030_PM_MASTER_KEY_CFG2,
1081			TWL4030_PM_MASTER_PROTECT_KEY);
1082
1083	return e;
1084}
1085
1086static void clocks_init(struct device *dev,
1087			struct twl4030_clock_init_data *clock)
1088{
1089	int e = 0;
1090	struct clk *osc;
1091	u32 rate;
1092	u8 ctrl = HFCLK_FREQ_26_MHZ;
1093
1094#if defined(CONFIG_ARCH_OMAP2) || defined(CONFIG_ARCH_OMAP3)
1095	if (cpu_is_omap2430())
1096		osc = clk_get(dev, "osc_ck");
1097	else
1098		osc = clk_get(dev, "osc_sys_ck");
1099
1100	if (IS_ERR(osc)) {
1101		printk(KERN_WARNING "Skipping twl internal clock init and "
1102				"using bootloader value (unknown osc rate)\n");
1103		return;
1104	}
1105
1106	rate = clk_get_rate(osc);
1107	clk_put(osc);
1108
1109#else
1110	/* REVISIT for non-OMAP systems, pass the clock rate from
1111	 * board init code, using platform_data.
1112	 */
1113	osc = ERR_PTR(-EIO);
1114
1115	printk(KERN_WARNING "Skipping twl internal clock init and "
1116	       "using bootloader value (unknown osc rate)\n");
1117
1118	return;
1119#endif
1120
1121	switch (rate) {
1122	case 19200000:
1123		ctrl = HFCLK_FREQ_19p2_MHZ;
1124		break;
1125	case 26000000:
1126		ctrl = HFCLK_FREQ_26_MHZ;
1127		break;
1128	case 38400000:
1129		ctrl = HFCLK_FREQ_38p4_MHZ;
1130		break;
1131	}
1132
1133	ctrl |= HIGH_PERF_SQ;
1134	if (clock && clock->ck32k_lowpwr_enable)
1135		ctrl |= CK32K_LOWPWR_EN;
1136
1137	e |= unprotect_pm_master();
1138	/* effect->MADC+USB ck en */
1139	e |= twl_i2c_write_u8(TWL_MODULE_PM_MASTER, ctrl, R_CFG_BOOT);
1140	e |= protect_pm_master();
1141
1142	if (e < 0)
1143		pr_err("%s: clock init err [%d]\n", DRIVER_NAME, e);
1144}
1145
1146/*----------------------------------------------------------------------*/
1147
1148int twl4030_init_irq(int irq_num, unsigned irq_base, unsigned irq_end);
1149int twl4030_exit_irq(void);
1150int twl4030_init_chip_irq(const char *chip);
1151int twl6030_init_irq(int irq_num, unsigned irq_base, unsigned irq_end);
1152int twl6030_exit_irq(void);
1153
1154static int twl_remove(struct i2c_client *client)
1155{
1156	unsigned i;
1157	int status;
1158
1159	if (twl_class_is_4030())
1160		status = twl4030_exit_irq();
1161	else
 
1162		status = twl6030_exit_irq();
 
 
1163
1164	if (status < 0)
1165		return status;
1166
1167	for (i = 0; i < TWL_NUM_SLAVES; i++) {
1168		struct twl_client	*twl = &twl_modules[i];
1169
1170		if (twl->client && twl->client != client)
1171			i2c_unregister_device(twl->client);
1172		twl_modules[i].client = NULL;
1173	}
1174	inuse = false;
1175	return 0;
1176}
1177
1178/* NOTE:  this driver only handles a single twl4030/tps659x0 chip */
1179static int __devinit
1180twl_probe(struct i2c_client *client, const struct i2c_device_id *id)
1181{
1182	int				status;
1183	unsigned			i;
1184	struct twl4030_platform_data	*pdata = client->dev.platform_data;
1185	u8 temp;
1186	int ret = 0;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1187
1188	if (!pdata) {
1189		dev_dbg(&client->dev, "no platform data?\n");
1190		return -EINVAL;
1191	}
1192
1193	if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C) == 0) {
1194		dev_dbg(&client->dev, "can't talk I2C?\n");
1195		return -EIO;
1196	}
1197
1198	if (inuse) {
1199		dev_dbg(&client->dev, "driver is already in use\n");
1200		return -EBUSY;
1201	}
1202
1203	for (i = 0; i < TWL_NUM_SLAVES; i++) {
1204		struct twl_client	*twl = &twl_modules[i];
 
 
 
 
 
 
 
 
 
 
1205
1206		twl->address = client->addr + i;
1207		if (i == 0)
1208			twl->client = client;
1209		else {
1210			twl->client = i2c_new_dummy(client->adapter,
1211					twl->address);
1212			if (!twl->client) {
1213				dev_err(&client->dev,
1214					"can't attach client %d\n", i);
1215				status = -ENOMEM;
1216				goto fail;
1217			}
1218		}
1219		mutex_init(&twl->xfer_lock);
1220	}
 
1221	inuse = true;
1222	if ((id->driver_data) & TWL6030_CLASS) {
1223		twl_id = TWL6030_CLASS_ID;
1224		twl_map = &twl6030_map[0];
1225	} else {
1226		twl_id = TWL4030_CLASS_ID;
1227		twl_map = &twl4030_map[0];
1228	}
1229
1230	/* setup clock framework */
1231	clocks_init(&client->dev, pdata->clock);
1232
1233	/* read TWL IDCODE Register */
1234	if (twl_id == TWL4030_CLASS_ID) {
1235		ret = twl_read_idcode_register();
1236		WARN(ret < 0, "Error: reading twl_idcode register value\n");
1237	}
1238
1239	/* load power event scripts */
1240	if (twl_has_power() && pdata->power)
1241		twl4030_power_init(pdata->power);
1242
1243	/* Maybe init the T2 Interrupt subsystem */
1244	if (client->irq
1245			&& pdata->irq_base
1246			&& pdata->irq_end > pdata->irq_base) {
1247		if (twl_class_is_4030()) {
1248			twl4030_init_chip_irq(id->name);
1249			status = twl4030_init_irq(client->irq, pdata->irq_base,
1250			pdata->irq_end);
1251		} else {
1252			status = twl6030_init_irq(client->irq, pdata->irq_base,
1253			pdata->irq_end);
1254		}
1255
1256		if (status < 0)
 
1257			goto fail;
 
1258	}
1259
1260	/* Disable TWL4030/TWL5030 I2C Pull-up on I2C1 and I2C4(SR) interface.
 
1261	 * Program I2C_SCL_CTRL_PU(bit 0)=0, I2C_SDA_CTRL_PU (bit 2)=0,
1262	 * SR_I2C_SCL_CTRL_PU(bit 4)=0 and SR_I2C_SDA_CTRL_PU(bit 6)=0.
1263	 */
1264
1265	if (twl_class_is_4030()) {
 
 
1266		twl_i2c_read_u8(TWL4030_MODULE_INTBR, &temp, REG_GPPUPDCTR1);
1267		temp &= ~(SR_I2C_SDA_CTRL_PU | SR_I2C_SCL_CTRL_PU | \
1268		I2C_SDA_CTRL_PU | I2C_SCL_CTRL_PU);
1269		twl_i2c_write_u8(TWL4030_MODULE_INTBR, temp, REG_GPPUPDCTR1);
1270	}
1271
1272	status = add_children(pdata, id->driver_data);
 
 
 
 
 
1273fail:
1274	if (status < 0)
1275		twl_remove(client);
 
1276	return status;
1277}
1278
1279static const struct i2c_device_id twl_ids[] = {
1280	{ "twl4030", TWL4030_VAUX2 },	/* "Triton 2" */
1281	{ "twl5030", 0 },		/* T2 updated */
1282	{ "twl5031", TWL5031 },		/* TWL5030 updated */
1283	{ "tps65950", 0 },		/* catalog version of twl5030 */
1284	{ "tps65930", TPS_SUBSET },	/* fewer LDOs and DACs; no charger */
1285	{ "tps65920", TPS_SUBSET },	/* fewer LDOs; no codec or charger */
1286	{ "tps65921", TPS_SUBSET },	/* fewer LDOs; no codec, no LED
1287					   and vibrator. Charger in USB module*/
1288	{ "twl6030", TWL6030_CLASS },	/* "Phoenix power chip" */
1289	{ "twl6025", TWL6030_CLASS | TWL6025_SUBCLASS }, /* "Phoenix lite" */
1290	{ /* end of list */ },
1291};
1292MODULE_DEVICE_TABLE(i2c, twl_ids);
1293
1294/* One Client Driver , 4 Clients */
1295static struct i2c_driver twl_driver = {
1296	.driver.name	= DRIVER_NAME,
1297	.id_table	= twl_ids,
1298	.probe		= twl_probe,
1299	.remove		= twl_remove,
1300};
1301
1302static int __init twl_init(void)
1303{
1304	return i2c_add_driver(&twl_driver);
1305}
1306subsys_initcall(twl_init);
1307
1308static void __exit twl_exit(void)
1309{
1310	i2c_del_driver(&twl_driver);
1311}
1312module_exit(twl_exit);
1313
1314MODULE_AUTHOR("Texas Instruments, Inc.");
1315MODULE_DESCRIPTION("I2C Core interface for TWL");
1316MODULE_LICENSE("GPL");
v3.5.6
   1/*
   2 * twl_core.c - driver for TWL4030/TWL5030/TWL60X0/TPS659x0 PM
   3 * and audio CODEC devices
   4 *
   5 * Copyright (C) 2005-2006 Texas Instruments, Inc.
   6 *
   7 * Modifications to defer interrupt handling to a kernel thread:
   8 * Copyright (C) 2006 MontaVista Software, Inc.
   9 *
  10 * Based on tlv320aic23.c:
  11 * Copyright (c) by Kai Svahn <kai.svahn@nokia.com>
  12 *
  13 * Code cleanup and modifications to IRQ handler.
  14 * by syed khasim <x0khasim@ti.com>
  15 *
  16 * This program is free software; you can redistribute it and/or modify
  17 * it under the terms of the GNU General Public License as published by
  18 * the Free Software Foundation; either version 2 of the License, or
  19 * (at your option) any later version.
  20 *
  21 * This program is distributed in the hope that it will be useful,
  22 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  23 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  24 * GNU General Public License for more details.
  25 *
  26 * You should have received a copy of the GNU General Public License
  27 * along with this program; if not, write to the Free Software
  28 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  29 */
  30
  31#include <linux/init.h>
  32#include <linux/mutex.h>
  33#include <linux/module.h>
  34#include <linux/platform_device.h>
  35#include <linux/clk.h>
  36#include <linux/err.h>
  37#include <linux/device.h>
  38#include <linux/of.h>
  39#include <linux/of_irq.h>
  40#include <linux/of_platform.h>
  41#include <linux/irq.h>
  42#include <linux/irqdomain.h>
  43
  44#include <linux/regulator/machine.h>
  45
  46#include <linux/i2c.h>
  47#include <linux/i2c/twl.h>
  48
  49#include "twl-core.h"
 
 
  50
  51/*
  52 * The TWL4030 "Triton 2" is one of a family of a multi-function "Power
  53 * Management and System Companion Device" chips originally designed for
  54 * use in OMAP2 and OMAP 3 based systems.  Its control interfaces use I2C,
  55 * often at around 3 Mbit/sec, including for interrupt handling.
  56 *
  57 * This driver core provides genirq support for the interrupts emitted,
  58 * by the various modules, and exports register access primitives.
  59 *
  60 * FIXME this driver currently requires use of the first interrupt line
  61 * (and associated registers).
  62 */
  63
  64#define DRIVER_NAME			"twl"
  65
  66#if defined(CONFIG_KEYBOARD_TWL4030) || defined(CONFIG_KEYBOARD_TWL4030_MODULE)
  67#define twl_has_keypad()	true
  68#else
  69#define twl_has_keypad()	false
  70#endif
  71
  72#if defined(CONFIG_GPIO_TWL4030) || defined(CONFIG_GPIO_TWL4030_MODULE)
  73#define twl_has_gpio()	true
  74#else
  75#define twl_has_gpio()	false
  76#endif
  77
  78#if defined(CONFIG_REGULATOR_TWL4030) \
  79	|| defined(CONFIG_REGULATOR_TWL4030_MODULE)
  80#define twl_has_regulator()	true
  81#else
  82#define twl_has_regulator()	false
  83#endif
  84
  85#if defined(CONFIG_TWL4030_MADC) || defined(CONFIG_TWL4030_MADC_MODULE)
  86#define twl_has_madc()	true
  87#else
  88#define twl_has_madc()	false
  89#endif
  90
  91#ifdef CONFIG_TWL4030_POWER
  92#define twl_has_power()        true
  93#else
  94#define twl_has_power()        false
  95#endif
  96
  97#if defined(CONFIG_RTC_DRV_TWL4030) || defined(CONFIG_RTC_DRV_TWL4030_MODULE)
  98#define twl_has_rtc()	true
  99#else
 100#define twl_has_rtc()	false
 101#endif
 102
 103#if defined(CONFIG_TWL4030_USB) || defined(CONFIG_TWL4030_USB_MODULE) ||\
 104	defined(CONFIG_TWL6030_USB) || defined(CONFIG_TWL6030_USB_MODULE)
 105#define twl_has_usb()	true
 106#else
 107#define twl_has_usb()	false
 108#endif
 109
 110#if defined(CONFIG_TWL4030_WATCHDOG) || \
 111	defined(CONFIG_TWL4030_WATCHDOG_MODULE)
 112#define twl_has_watchdog()        true
 113#else
 114#define twl_has_watchdog()        false
 115#endif
 116
 117#if defined(CONFIG_MFD_TWL4030_AUDIO) || \
 118	defined(CONFIG_MFD_TWL4030_AUDIO_MODULE)
 119#define twl_has_codec()	true
 120#else
 121#define twl_has_codec()	false
 122#endif
 123
 124#if defined(CONFIG_CHARGER_TWL4030) || defined(CONFIG_CHARGER_TWL4030_MODULE)
 125#define twl_has_bci()	true
 126#else
 127#define twl_has_bci()	false
 128#endif
 129
 130/* Triton Core internal information (BEGIN) */
 131
 132/* Last - for index max*/
 133#define TWL4030_MODULE_LAST		TWL4030_MODULE_SECURED_REG
 134
 135#define TWL_NUM_SLAVES		4
 136
 137#if defined(CONFIG_INPUT_TWL4030_PWRBUTTON) \
 138	|| defined(CONFIG_INPUT_TWL4030_PWRBUTTON_MODULE)
 139#define twl_has_pwrbutton()	true
 140#else
 141#define twl_has_pwrbutton()	false
 142#endif
 143
 144#define SUB_CHIP_ID0 0
 145#define SUB_CHIP_ID1 1
 146#define SUB_CHIP_ID2 2
 147#define SUB_CHIP_ID3 3
 148#define SUB_CHIP_ID_INVAL 0xff
 149
 150#define TWL_MODULE_LAST TWL4030_MODULE_LAST
 151
 152/* Base Address defns for twl4030_map[] */
 153
 154/* subchip/slave 0 - USB ID */
 155#define TWL4030_BASEADD_USB		0x0000
 156
 157/* subchip/slave 1 - AUD ID */
 158#define TWL4030_BASEADD_AUDIO_VOICE	0x0000
 159#define TWL4030_BASEADD_GPIO		0x0098
 160#define TWL4030_BASEADD_INTBR		0x0085
 161#define TWL4030_BASEADD_PIH		0x0080
 162#define TWL4030_BASEADD_TEST		0x004C
 163
 164/* subchip/slave 2 - AUX ID */
 165#define TWL4030_BASEADD_INTERRUPTS	0x00B9
 166#define TWL4030_BASEADD_LED		0x00EE
 167#define TWL4030_BASEADD_MADC		0x0000
 168#define TWL4030_BASEADD_MAIN_CHARGE	0x0074
 169#define TWL4030_BASEADD_PRECHARGE	0x00AA
 170#define TWL4030_BASEADD_PWM0		0x00F8
 171#define TWL4030_BASEADD_PWM1		0x00FB
 172#define TWL4030_BASEADD_PWMA		0x00EF
 173#define TWL4030_BASEADD_PWMB		0x00F1
 174#define TWL4030_BASEADD_KEYPAD		0x00D2
 175
 176#define TWL5031_BASEADD_ACCESSORY	0x0074 /* Replaces Main Charge */
 177#define TWL5031_BASEADD_INTERRUPTS	0x00B9 /* Different than TWL4030's
 178						  one */
 179
 180/* subchip/slave 3 - POWER ID */
 181#define TWL4030_BASEADD_BACKUP		0x0014
 182#define TWL4030_BASEADD_INT		0x002E
 183#define TWL4030_BASEADD_PM_MASTER	0x0036
 184#define TWL4030_BASEADD_PM_RECEIVER	0x005B
 185#define TWL4030_BASEADD_RTC		0x001C
 186#define TWL4030_BASEADD_SECURED_REG	0x0000
 187
 188/* Triton Core internal information (END) */
 189
 190
 191/* subchip/slave 0 0x48 - POWER */
 192#define TWL6030_BASEADD_RTC		0x0000
 193#define TWL6030_BASEADD_MEM		0x0017
 194#define TWL6030_BASEADD_PM_MASTER	0x001F
 195#define TWL6030_BASEADD_PM_SLAVE_MISC	0x0030 /* PM_RECEIVER */
 196#define TWL6030_BASEADD_PM_MISC		0x00E2
 197#define TWL6030_BASEADD_PM_PUPD		0x00F0
 198
 199/* subchip/slave 1 0x49 - FEATURE */
 200#define TWL6030_BASEADD_USB		0x0000
 201#define TWL6030_BASEADD_GPADC_CTRL	0x002E
 202#define TWL6030_BASEADD_AUX		0x0090
 203#define TWL6030_BASEADD_PWM		0x00BA
 204#define TWL6030_BASEADD_GASGAUGE	0x00C0
 205#define TWL6030_BASEADD_PIH		0x00D0
 206#define TWL6030_BASEADD_CHARGER		0x00E0
 207#define TWL6025_BASEADD_CHARGER		0x00DA
 208
 209/* subchip/slave 2 0x4A - DFT */
 210#define TWL6030_BASEADD_DIEID		0x00C0
 211
 212/* subchip/slave 3 0x4B - AUDIO */
 213#define TWL6030_BASEADD_AUDIO		0x0000
 214#define TWL6030_BASEADD_RSV		0x0000
 215#define TWL6030_BASEADD_ZERO		0x0000
 216
 217/* Few power values */
 218#define R_CFG_BOOT			0x05
 219
 220/* some fields in R_CFG_BOOT */
 221#define HFCLK_FREQ_19p2_MHZ		(1 << 0)
 222#define HFCLK_FREQ_26_MHZ		(2 << 0)
 223#define HFCLK_FREQ_38p4_MHZ		(3 << 0)
 224#define HIGH_PERF_SQ			(1 << 3)
 225#define CK32K_LOWPWR_EN			(1 << 7)
 226
 
 
 
 
 
 
 
 227/*----------------------------------------------------------------------*/
 228
 229/* is driver active, bound to a chip? */
 230static bool inuse;
 231
 232/* TWL IDCODE Register value */
 233static u32 twl_idcode;
 234
 235static unsigned int twl_id;
 236unsigned int twl_rev(void)
 237{
 238	return twl_id;
 239}
 240EXPORT_SYMBOL(twl_rev);
 241
 242/* Structure for each TWL4030/TWL6030 Slave */
 243struct twl_client {
 244	struct i2c_client *client;
 245	u8 address;
 246
 247	/* max numb of i2c_msg required is for read =2 */
 248	struct i2c_msg xfer_msg[2];
 249
 250	/* To lock access to xfer_msg */
 251	struct mutex xfer_lock;
 252};
 253
 254static struct twl_client twl_modules[TWL_NUM_SLAVES];
 255
 
 256/* mapping the module id to slave id and base address */
 257struct twl_mapping {
 258	unsigned char sid;	/* Slave ID */
 259	unsigned char base;	/* base address */
 260};
 261static struct twl_mapping *twl_map;
 262
 263static struct twl_mapping twl4030_map[TWL4030_MODULE_LAST + 1] = {
 264	/*
 265	 * NOTE:  don't change this table without updating the
 266	 * <linux/i2c/twl.h> defines for TWL4030_MODULE_*
 267	 * so they continue to match the order in this table.
 268	 */
 269
 270	{ 0, TWL4030_BASEADD_USB },
 271
 272	{ 1, TWL4030_BASEADD_AUDIO_VOICE },
 273	{ 1, TWL4030_BASEADD_GPIO },
 274	{ 1, TWL4030_BASEADD_INTBR },
 275	{ 1, TWL4030_BASEADD_PIH },
 276	{ 1, TWL4030_BASEADD_TEST },
 277
 278	{ 2, TWL4030_BASEADD_KEYPAD },
 279	{ 2, TWL4030_BASEADD_MADC },
 280	{ 2, TWL4030_BASEADD_INTERRUPTS },
 281	{ 2, TWL4030_BASEADD_LED },
 282	{ 2, TWL4030_BASEADD_MAIN_CHARGE },
 283	{ 2, TWL4030_BASEADD_PRECHARGE },
 284	{ 2, TWL4030_BASEADD_PWM0 },
 285	{ 2, TWL4030_BASEADD_PWM1 },
 286	{ 2, TWL4030_BASEADD_PWMA },
 287	{ 2, TWL4030_BASEADD_PWMB },
 288	{ 2, TWL5031_BASEADD_ACCESSORY },
 289	{ 2, TWL5031_BASEADD_INTERRUPTS },
 290
 291	{ 3, TWL4030_BASEADD_BACKUP },
 292	{ 3, TWL4030_BASEADD_INT },
 293	{ 3, TWL4030_BASEADD_PM_MASTER },
 294	{ 3, TWL4030_BASEADD_PM_RECEIVER },
 295	{ 3, TWL4030_BASEADD_RTC },
 296	{ 3, TWL4030_BASEADD_SECURED_REG },
 297};
 298
 299static struct twl_mapping twl6030_map[] = {
 300	/*
 301	 * NOTE:  don't change this table without updating the
 302	 * <linux/i2c/twl.h> defines for TWL4030_MODULE_*
 303	 * so they continue to match the order in this table.
 304	 */
 305	{ SUB_CHIP_ID1, TWL6030_BASEADD_USB },
 306	{ SUB_CHIP_ID_INVAL, TWL6030_BASEADD_AUDIO },
 307	{ SUB_CHIP_ID2, TWL6030_BASEADD_DIEID },
 308	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
 309	{ SUB_CHIP_ID1, TWL6030_BASEADD_PIH },
 310
 311	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
 312	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
 313	{ SUB_CHIP_ID1, TWL6030_BASEADD_GPADC_CTRL },
 314	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
 315	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
 316
 317	{ SUB_CHIP_ID1, TWL6030_BASEADD_CHARGER },
 318	{ SUB_CHIP_ID1, TWL6030_BASEADD_GASGAUGE },
 319	{ SUB_CHIP_ID1, TWL6030_BASEADD_PWM },
 320	{ SUB_CHIP_ID0, TWL6030_BASEADD_ZERO },
 321	{ SUB_CHIP_ID1, TWL6030_BASEADD_ZERO },
 322
 323	{ SUB_CHIP_ID2, TWL6030_BASEADD_ZERO },
 324	{ SUB_CHIP_ID2, TWL6030_BASEADD_ZERO },
 325	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
 326	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
 327	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
 328	{ SUB_CHIP_ID0, TWL6030_BASEADD_PM_MASTER },
 329	{ SUB_CHIP_ID0, TWL6030_BASEADD_PM_SLAVE_MISC },
 330
 331	{ SUB_CHIP_ID0, TWL6030_BASEADD_RTC },
 332	{ SUB_CHIP_ID0, TWL6030_BASEADD_MEM },
 333	{ SUB_CHIP_ID1, TWL6025_BASEADD_CHARGER },
 334};
 335
 336/*----------------------------------------------------------------------*/
 337
 338/* Exported Functions */
 339
 340/**
 341 * twl_i2c_write - Writes a n bit register in TWL4030/TWL5030/TWL60X0
 342 * @mod_no: module number
 343 * @value: an array of num_bytes+1 containing data to write
 344 * @reg: register address (just offset will do)
 345 * @num_bytes: number of bytes to transfer
 346 *
 347 * IMPORTANT: for 'value' parameter: Allocate value num_bytes+1 and
 348 * valid data starts at Offset 1.
 349 *
 350 * Returns the result of operation - 0 is success
 351 */
 352int twl_i2c_write(u8 mod_no, u8 *value, u8 reg, unsigned num_bytes)
 353{
 354	int ret;
 355	int sid;
 356	struct twl_client *twl;
 357	struct i2c_msg *msg;
 358
 359	if (unlikely(mod_no > TWL_MODULE_LAST)) {
 360		pr_err("%s: invalid module number %d\n", DRIVER_NAME, mod_no);
 361		return -EPERM;
 362	}
 
 
 
 363	if (unlikely(!inuse)) {
 364		pr_err("%s: not initialized\n", DRIVER_NAME);
 365		return -EPERM;
 366	}
 367	sid = twl_map[mod_no].sid;
 368	if (unlikely(sid == SUB_CHIP_ID_INVAL)) {
 369		pr_err("%s: module %d is not part of the pmic\n",
 370		       DRIVER_NAME, mod_no);
 371		return -EINVAL;
 372	}
 373	twl = &twl_modules[sid];
 374
 375	mutex_lock(&twl->xfer_lock);
 376	/*
 377	 * [MSG1]: fill the register address data
 378	 * fill the data Tx buffer
 379	 */
 380	msg = &twl->xfer_msg[0];
 381	msg->addr = twl->address;
 382	msg->len = num_bytes + 1;
 383	msg->flags = 0;
 384	msg->buf = value;
 385	/* over write the first byte of buffer with the register address */
 386	*value = twl_map[mod_no].base + reg;
 387	ret = i2c_transfer(twl->client->adapter, twl->xfer_msg, 1);
 388	mutex_unlock(&twl->xfer_lock);
 389
 390	/* i2c_transfer returns number of messages transferred */
 391	if (ret != 1) {
 392		pr_err("%s: i2c_write failed to transfer all messages\n",
 393			DRIVER_NAME);
 394		if (ret < 0)
 395			return ret;
 396		else
 397			return -EIO;
 398	} else {
 399		return 0;
 400	}
 401}
 402EXPORT_SYMBOL(twl_i2c_write);
 403
 404/**
 405 * twl_i2c_read - Reads a n bit register in TWL4030/TWL5030/TWL60X0
 406 * @mod_no: module number
 407 * @value: an array of num_bytes containing data to be read
 408 * @reg: register address (just offset will do)
 409 * @num_bytes: number of bytes to transfer
 410 *
 411 * Returns result of operation - num_bytes is success else failure.
 412 */
 413int twl_i2c_read(u8 mod_no, u8 *value, u8 reg, unsigned num_bytes)
 414{
 415	int ret;
 416	u8 val;
 417	int sid;
 418	struct twl_client *twl;
 419	struct i2c_msg *msg;
 420
 421	if (unlikely(mod_no > TWL_MODULE_LAST)) {
 422		pr_err("%s: invalid module number %d\n", DRIVER_NAME, mod_no);
 423		return -EPERM;
 424	}
 
 
 
 425	if (unlikely(!inuse)) {
 426		pr_err("%s: not initialized\n", DRIVER_NAME);
 427		return -EPERM;
 428	}
 429	sid = twl_map[mod_no].sid;
 430	if (unlikely(sid == SUB_CHIP_ID_INVAL)) {
 431		pr_err("%s: module %d is not part of the pmic\n",
 432		       DRIVER_NAME, mod_no);
 433		return -EINVAL;
 434	}
 435	twl = &twl_modules[sid];
 436
 437	mutex_lock(&twl->xfer_lock);
 438	/* [MSG1] fill the register address data */
 439	msg = &twl->xfer_msg[0];
 440	msg->addr = twl->address;
 441	msg->len = 1;
 442	msg->flags = 0;	/* Read the register value */
 443	val = twl_map[mod_no].base + reg;
 444	msg->buf = &val;
 445	/* [MSG2] fill the data rx buffer */
 446	msg = &twl->xfer_msg[1];
 447	msg->addr = twl->address;
 448	msg->flags = I2C_M_RD;	/* Read the register value */
 449	msg->len = num_bytes;	/* only n bytes */
 450	msg->buf = value;
 451	ret = i2c_transfer(twl->client->adapter, twl->xfer_msg, 2);
 452	mutex_unlock(&twl->xfer_lock);
 453
 454	/* i2c_transfer returns number of messages transferred */
 455	if (ret != 2) {
 456		pr_err("%s: i2c_read failed to transfer all messages\n",
 457			DRIVER_NAME);
 458		if (ret < 0)
 459			return ret;
 460		else
 461			return -EIO;
 462	} else {
 463		return 0;
 464	}
 465}
 466EXPORT_SYMBOL(twl_i2c_read);
 467
 468/**
 469 * twl_i2c_write_u8 - Writes a 8 bit register in TWL4030/TWL5030/TWL60X0
 470 * @mod_no: module number
 471 * @value: the value to be written 8 bit
 472 * @reg: register address (just offset will do)
 473 *
 474 * Returns result of operation - 0 is success
 475 */
 476int twl_i2c_write_u8(u8 mod_no, u8 value, u8 reg)
 477{
 478
 479	/* 2 bytes offset 1 contains the data offset 0 is used by i2c_write */
 480	u8 temp_buffer[2] = { 0 };
 481	/* offset 1 contains the data */
 482	temp_buffer[1] = value;
 483	return twl_i2c_write(mod_no, temp_buffer, reg, 1);
 484}
 485EXPORT_SYMBOL(twl_i2c_write_u8);
 486
 487/**
 488 * twl_i2c_read_u8 - Reads a 8 bit register from TWL4030/TWL5030/TWL60X0
 489 * @mod_no: module number
 490 * @value: the value read 8 bit
 491 * @reg: register address (just offset will do)
 492 *
 493 * Returns result of operation - 0 is success
 494 */
 495int twl_i2c_read_u8(u8 mod_no, u8 *value, u8 reg)
 496{
 497	return twl_i2c_read(mod_no, value, reg, 1);
 498}
 499EXPORT_SYMBOL(twl_i2c_read_u8);
 500
 501/*----------------------------------------------------------------------*/
 502
 503/**
 504 * twl_read_idcode_register - API to read the IDCODE register.
 505 *
 506 * Unlocks the IDCODE register and read the 32 bit value.
 507 */
 508static int twl_read_idcode_register(void)
 509{
 510	int err;
 511
 512	err = twl_i2c_write_u8(TWL4030_MODULE_INTBR, TWL_EEPROM_R_UNLOCK,
 513						REG_UNLOCK_TEST_REG);
 514	if (err) {
 515		pr_err("TWL4030 Unable to unlock IDCODE registers -%d\n", err);
 516		goto fail;
 517	}
 518
 519	err = twl_i2c_read(TWL4030_MODULE_INTBR, (u8 *)(&twl_idcode),
 520						REG_IDCODE_7_0, 4);
 521	if (err) {
 522		pr_err("TWL4030: unable to read IDCODE -%d\n", err);
 523		goto fail;
 524	}
 525
 526	err = twl_i2c_write_u8(TWL4030_MODULE_INTBR, 0x0, REG_UNLOCK_TEST_REG);
 527	if (err)
 528		pr_err("TWL4030 Unable to relock IDCODE registers -%d\n", err);
 529fail:
 530	return err;
 531}
 532
 533/**
 534 * twl_get_type - API to get TWL Si type.
 535 *
 536 * Api to get the TWL Si type from IDCODE value.
 537 */
 538int twl_get_type(void)
 539{
 540	return TWL_SIL_TYPE(twl_idcode);
 541}
 542EXPORT_SYMBOL_GPL(twl_get_type);
 543
 544/**
 545 * twl_get_version - API to get TWL Si version.
 546 *
 547 * Api to get the TWL Si version from IDCODE value.
 548 */
 549int twl_get_version(void)
 550{
 551	return TWL_SIL_REV(twl_idcode);
 552}
 553EXPORT_SYMBOL_GPL(twl_get_version);
 554
 555static struct device *
 556add_numbered_child(unsigned chip, const char *name, int num,
 557		void *pdata, unsigned pdata_len,
 558		bool can_wakeup, int irq0, int irq1)
 559{
 560	struct platform_device	*pdev;
 561	struct twl_client	*twl = &twl_modules[chip];
 562	int			status;
 563
 564	pdev = platform_device_alloc(name, num);
 565	if (!pdev) {
 566		dev_dbg(&twl->client->dev, "can't alloc dev\n");
 567		status = -ENOMEM;
 568		goto err;
 569	}
 570
 571	device_init_wakeup(&pdev->dev, can_wakeup);
 572	pdev->dev.parent = &twl->client->dev;
 573
 574	if (pdata) {
 575		status = platform_device_add_data(pdev, pdata, pdata_len);
 576		if (status < 0) {
 577			dev_dbg(&pdev->dev, "can't add platform_data\n");
 578			goto err;
 579		}
 580	}
 581
 582	if (irq0) {
 583		struct resource r[2] = {
 584			{ .start = irq0, .flags = IORESOURCE_IRQ, },
 585			{ .start = irq1, .flags = IORESOURCE_IRQ, },
 586		};
 587
 588		status = platform_device_add_resources(pdev, r, irq1 ? 2 : 1);
 589		if (status < 0) {
 590			dev_dbg(&pdev->dev, "can't add irqs\n");
 591			goto err;
 592		}
 593	}
 594
 595	status = platform_device_add(pdev);
 596
 597err:
 598	if (status < 0) {
 599		platform_device_put(pdev);
 600		dev_err(&twl->client->dev, "can't add %s dev\n", name);
 601		return ERR_PTR(status);
 602	}
 603	return &pdev->dev;
 604}
 605
 606static inline struct device *add_child(unsigned chip, const char *name,
 607		void *pdata, unsigned pdata_len,
 608		bool can_wakeup, int irq0, int irq1)
 609{
 610	return add_numbered_child(chip, name, -1, pdata, pdata_len,
 611		can_wakeup, irq0, irq1);
 612}
 613
 614static struct device *
 615add_regulator_linked(int num, struct regulator_init_data *pdata,
 616		struct regulator_consumer_supply *consumers,
 617		unsigned num_consumers, unsigned long features)
 618{
 619	unsigned sub_chip_id;
 620	struct twl_regulator_driver_data drv_data;
 621
 622	/* regulator framework demands init_data ... */
 623	if (!pdata)
 624		return NULL;
 625
 626	if (consumers) {
 627		pdata->consumer_supplies = consumers;
 628		pdata->num_consumer_supplies = num_consumers;
 629	}
 630
 631	if (pdata->driver_data) {
 632		/* If we have existing drv_data, just add the flags */
 633		struct twl_regulator_driver_data *tmp;
 634		tmp = pdata->driver_data;
 635		tmp->features |= features;
 636	} else {
 637		/* add new driver data struct, used only during init */
 638		drv_data.features = features;
 639		drv_data.set_voltage = NULL;
 640		drv_data.get_voltage = NULL;
 641		drv_data.data = NULL;
 642		pdata->driver_data = &drv_data;
 643	}
 644
 645	/* NOTE:  we currently ignore regulator IRQs, e.g. for short circuits */
 646	sub_chip_id = twl_map[TWL_MODULE_PM_MASTER].sid;
 647	return add_numbered_child(sub_chip_id, "twl_reg", num,
 648		pdata, sizeof(*pdata), false, 0, 0);
 649}
 650
 651static struct device *
 652add_regulator(int num, struct regulator_init_data *pdata,
 653		unsigned long features)
 654{
 655	return add_regulator_linked(num, pdata, NULL, 0, features);
 656}
 657
 658/*
 659 * NOTE:  We know the first 8 IRQs after pdata->base_irq are
 660 * for the PIH, and the next are for the PWR_INT SIH, since
 661 * that's how twl_init_irq() sets things up.
 662 */
 663
 664static int
 665add_children(struct twl4030_platform_data *pdata, unsigned irq_base,
 666		unsigned long features)
 667{
 668	struct device	*child;
 669	unsigned sub_chip_id;
 670
 671	if (twl_has_gpio() && pdata->gpio) {
 672		child = add_child(SUB_CHIP_ID1, "twl4030_gpio",
 673				pdata->gpio, sizeof(*pdata->gpio),
 674				false, irq_base + GPIO_INTR_OFFSET, 0);
 675		if (IS_ERR(child))
 676			return PTR_ERR(child);
 677	}
 678
 679	if (twl_has_keypad() && pdata->keypad) {
 680		child = add_child(SUB_CHIP_ID2, "twl4030_keypad",
 681				pdata->keypad, sizeof(*pdata->keypad),
 682				true, irq_base + KEYPAD_INTR_OFFSET, 0);
 683		if (IS_ERR(child))
 684			return PTR_ERR(child);
 685	}
 686
 687	if (twl_has_madc() && pdata->madc) {
 688		child = add_child(2, "twl4030_madc",
 689				pdata->madc, sizeof(*pdata->madc),
 690				true, irq_base + MADC_INTR_OFFSET, 0);
 691		if (IS_ERR(child))
 692			return PTR_ERR(child);
 693	}
 694
 695	if (twl_has_rtc()) {
 696		/*
 697		 * REVISIT platform_data here currently might expose the
 698		 * "msecure" line ... but for now we just expect board
 699		 * setup to tell the chip "it's always ok to SET_TIME".
 700		 * Eventually, Linux might become more aware of such
 701		 * HW security concerns, and "least privilege".
 702		 */
 703		sub_chip_id = twl_map[TWL_MODULE_RTC].sid;
 704		child = add_child(sub_chip_id, "twl_rtc",
 705				NULL, 0,
 706				true, irq_base + RTC_INTR_OFFSET, 0);
 707		if (IS_ERR(child))
 708			return PTR_ERR(child);
 709	}
 710
 711	if (twl_has_usb() && pdata->usb && twl_class_is_4030()) {
 712
 713		static struct regulator_consumer_supply usb1v5 = {
 714			.supply =	"usb1v5",
 715		};
 716		static struct regulator_consumer_supply usb1v8 = {
 717			.supply =	"usb1v8",
 718		};
 719		static struct regulator_consumer_supply usb3v1 = {
 720			.supply =	"usb3v1",
 721		};
 722
 723	/* First add the regulators so that they can be used by transceiver */
 724		if (twl_has_regulator()) {
 725			/* this is a template that gets copied */
 726			struct regulator_init_data usb_fixed = {
 727				.constraints.valid_modes_mask =
 728					REGULATOR_MODE_NORMAL
 729					| REGULATOR_MODE_STANDBY,
 730				.constraints.valid_ops_mask =
 731					REGULATOR_CHANGE_MODE
 732					| REGULATOR_CHANGE_STATUS,
 733			};
 734
 735			child = add_regulator_linked(TWL4030_REG_VUSB1V5,
 736						      &usb_fixed, &usb1v5, 1,
 737						      features);
 738			if (IS_ERR(child))
 739				return PTR_ERR(child);
 740
 741			child = add_regulator_linked(TWL4030_REG_VUSB1V8,
 742						      &usb_fixed, &usb1v8, 1,
 743						      features);
 744			if (IS_ERR(child))
 745				return PTR_ERR(child);
 746
 747			child = add_regulator_linked(TWL4030_REG_VUSB3V1,
 748						      &usb_fixed, &usb3v1, 1,
 749						      features);
 750			if (IS_ERR(child))
 751				return PTR_ERR(child);
 752
 753		}
 754
 755		child = add_child(0, "twl4030_usb",
 756				pdata->usb, sizeof(*pdata->usb),
 757				true,
 758				/* irq0 = USB_PRES, irq1 = USB */
 759				irq_base + USB_PRES_INTR_OFFSET,
 760				irq_base + USB_INTR_OFFSET);
 761
 762		if (IS_ERR(child))
 763			return PTR_ERR(child);
 764
 765		/* we need to connect regulators to this transceiver */
 766		if (twl_has_regulator() && child) {
 767			usb1v5.dev_name = dev_name(child);
 768			usb1v8.dev_name = dev_name(child);
 769			usb3v1.dev_name = dev_name(child);
 770		}
 771	}
 772	if (twl_has_usb() && pdata->usb && twl_class_is_6030()) {
 773
 774		static struct regulator_consumer_supply usb3v3;
 775		int regulator;
 776
 777		if (twl_has_regulator()) {
 778			/* this is a template that gets copied */
 779			struct regulator_init_data usb_fixed = {
 780				.constraints.valid_modes_mask =
 781					REGULATOR_MODE_NORMAL
 782					| REGULATOR_MODE_STANDBY,
 783				.constraints.valid_ops_mask =
 784					REGULATOR_CHANGE_MODE
 785					| REGULATOR_CHANGE_STATUS,
 786			};
 787
 788			if (features & TWL6025_SUBCLASS) {
 789				usb3v3.supply =	"ldousb";
 790				regulator = TWL6025_REG_LDOUSB;
 791			} else {
 792				usb3v3.supply = "vusb";
 793				regulator = TWL6030_REG_VUSB;
 794			}
 795			child = add_regulator_linked(regulator, &usb_fixed,
 796							&usb3v3, 1,
 797							features);
 798			if (IS_ERR(child))
 799				return PTR_ERR(child);
 800		}
 801
 802		pdata->usb->features = features;
 803
 804		child = add_child(0, "twl6030_usb",
 805			pdata->usb, sizeof(*pdata->usb),
 806			true,
 807			/* irq1 = VBUS_PRES, irq0 = USB ID */
 808			irq_base + USBOTG_INTR_OFFSET,
 809			irq_base + USB_PRES_INTR_OFFSET);
 810
 811		if (IS_ERR(child))
 812			return PTR_ERR(child);
 813		/* we need to connect regulators to this transceiver */
 814		if (twl_has_regulator() && child)
 815			usb3v3.dev_name = dev_name(child);
 816	} else if (twl_has_regulator() && twl_class_is_6030()) {
 817		if (features & TWL6025_SUBCLASS)
 818			child = add_regulator(TWL6025_REG_LDOUSB,
 819						pdata->ldousb, features);
 820		else
 821			child = add_regulator(TWL6030_REG_VUSB,
 822						pdata->vusb, features);
 823
 824			if (IS_ERR(child))
 825					return PTR_ERR(child);
 826	}
 827
 828	if (twl_has_watchdog() && twl_class_is_4030()) {
 829		child = add_child(0, "twl4030_wdt", NULL, 0, false, 0, 0);
 830		if (IS_ERR(child))
 831			return PTR_ERR(child);
 832	}
 833
 834	if (twl_has_pwrbutton() && twl_class_is_4030()) {
 835		child = add_child(1, "twl4030_pwrbutton",
 836				NULL, 0, true, irq_base + 8 + 0, 0);
 837		if (IS_ERR(child))
 838			return PTR_ERR(child);
 839	}
 840
 841	if (twl_has_codec() && pdata->audio && twl_class_is_4030()) {
 842		sub_chip_id = twl_map[TWL_MODULE_AUDIO_VOICE].sid;
 843		child = add_child(sub_chip_id, "twl4030-audio",
 844				pdata->audio, sizeof(*pdata->audio),
 845				false, 0, 0);
 846		if (IS_ERR(child))
 847			return PTR_ERR(child);
 848	}
 849
 
 
 
 
 
 
 
 
 
 850	/* twl4030 regulators */
 851	if (twl_has_regulator() && twl_class_is_4030()) {
 852		child = add_regulator(TWL4030_REG_VPLL1, pdata->vpll1,
 853					features);
 854		if (IS_ERR(child))
 855			return PTR_ERR(child);
 856
 857		child = add_regulator(TWL4030_REG_VIO, pdata->vio,
 858					features);
 859		if (IS_ERR(child))
 860			return PTR_ERR(child);
 861
 862		child = add_regulator(TWL4030_REG_VDD1, pdata->vdd1,
 863					features);
 864		if (IS_ERR(child))
 865			return PTR_ERR(child);
 866
 867		child = add_regulator(TWL4030_REG_VDD2, pdata->vdd2,
 868					features);
 869		if (IS_ERR(child))
 870			return PTR_ERR(child);
 871
 872		child = add_regulator(TWL4030_REG_VMMC1, pdata->vmmc1,
 873					features);
 874		if (IS_ERR(child))
 875			return PTR_ERR(child);
 876
 877		child = add_regulator(TWL4030_REG_VDAC, pdata->vdac,
 878					features);
 879		if (IS_ERR(child))
 880			return PTR_ERR(child);
 881
 882		child = add_regulator((features & TWL4030_VAUX2)
 883					? TWL4030_REG_VAUX2_4030
 884					: TWL4030_REG_VAUX2,
 885				pdata->vaux2, features);
 886		if (IS_ERR(child))
 887			return PTR_ERR(child);
 888
 889		child = add_regulator(TWL4030_REG_VINTANA1, pdata->vintana1,
 890					features);
 891		if (IS_ERR(child))
 892			return PTR_ERR(child);
 893
 894		child = add_regulator(TWL4030_REG_VINTANA2, pdata->vintana2,
 895					features);
 896		if (IS_ERR(child))
 897			return PTR_ERR(child);
 898
 899		child = add_regulator(TWL4030_REG_VINTDIG, pdata->vintdig,
 900					features);
 901		if (IS_ERR(child))
 902			return PTR_ERR(child);
 903	}
 904
 905	/* maybe add LDOs that are omitted on cost-reduced parts */
 906	if (twl_has_regulator() && !(features & TPS_SUBSET)
 907	  && twl_class_is_4030()) {
 908		child = add_regulator(TWL4030_REG_VPLL2, pdata->vpll2,
 909					features);
 910		if (IS_ERR(child))
 911			return PTR_ERR(child);
 912
 913		child = add_regulator(TWL4030_REG_VMMC2, pdata->vmmc2,
 914					features);
 915		if (IS_ERR(child))
 916			return PTR_ERR(child);
 917
 918		child = add_regulator(TWL4030_REG_VSIM, pdata->vsim,
 919					features);
 920		if (IS_ERR(child))
 921			return PTR_ERR(child);
 922
 923		child = add_regulator(TWL4030_REG_VAUX1, pdata->vaux1,
 924					features);
 925		if (IS_ERR(child))
 926			return PTR_ERR(child);
 927
 928		child = add_regulator(TWL4030_REG_VAUX3, pdata->vaux3,
 929					features);
 930		if (IS_ERR(child))
 931			return PTR_ERR(child);
 932
 933		child = add_regulator(TWL4030_REG_VAUX4, pdata->vaux4,
 934					features);
 935		if (IS_ERR(child))
 936			return PTR_ERR(child);
 937	}
 938
 939	/* twl6030 regulators */
 940	if (twl_has_regulator() && twl_class_is_6030() &&
 941			!(features & TWL6025_SUBCLASS)) {
 942		child = add_regulator(TWL6030_REG_VDD1, pdata->vdd1,
 943					features);
 944		if (IS_ERR(child))
 945			return PTR_ERR(child);
 946
 947		child = add_regulator(TWL6030_REG_VDD2, pdata->vdd2,
 948					features);
 949		if (IS_ERR(child))
 950			return PTR_ERR(child);
 951
 952		child = add_regulator(TWL6030_REG_VDD3, pdata->vdd3,
 953					features);
 954		if (IS_ERR(child))
 955			return PTR_ERR(child);
 956
 957		child = add_regulator(TWL6030_REG_V1V8, pdata->v1v8,
 958					features);
 959		if (IS_ERR(child))
 960			return PTR_ERR(child);
 961
 962		child = add_regulator(TWL6030_REG_V2V1, pdata->v2v1,
 963					features);
 964		if (IS_ERR(child))
 965			return PTR_ERR(child);
 966
 967		child = add_regulator(TWL6030_REG_VMMC, pdata->vmmc,
 968					features);
 969		if (IS_ERR(child))
 970			return PTR_ERR(child);
 971
 972		child = add_regulator(TWL6030_REG_VPP, pdata->vpp,
 973					features);
 974		if (IS_ERR(child))
 975			return PTR_ERR(child);
 976
 977		child = add_regulator(TWL6030_REG_VUSIM, pdata->vusim,
 978					features);
 979		if (IS_ERR(child))
 980			return PTR_ERR(child);
 981
 982		child = add_regulator(TWL6030_REG_VCXIO, pdata->vcxio,
 983					features);
 984		if (IS_ERR(child))
 985			return PTR_ERR(child);
 986
 987		child = add_regulator(TWL6030_REG_VDAC, pdata->vdac,
 988					features);
 989		if (IS_ERR(child))
 990			return PTR_ERR(child);
 991
 992		child = add_regulator(TWL6030_REG_VAUX1_6030, pdata->vaux1,
 993					features);
 994		if (IS_ERR(child))
 995			return PTR_ERR(child);
 996
 997		child = add_regulator(TWL6030_REG_VAUX2_6030, pdata->vaux2,
 998					features);
 999		if (IS_ERR(child))
1000			return PTR_ERR(child);
1001
1002		child = add_regulator(TWL6030_REG_VAUX3_6030, pdata->vaux3,
1003					features);
1004		if (IS_ERR(child))
1005			return PTR_ERR(child);
1006
1007		child = add_regulator(TWL6030_REG_CLK32KG, pdata->clk32kg,
1008					features);
1009		if (IS_ERR(child))
1010			return PTR_ERR(child);
1011	}
1012
1013	/* 6030 and 6025 share this regulator */
1014	if (twl_has_regulator() && twl_class_is_6030()) {
1015		child = add_regulator(TWL6030_REG_VANA, pdata->vana,
1016					features);
1017		if (IS_ERR(child))
1018			return PTR_ERR(child);
1019	}
1020
1021	/* twl6025 regulators */
1022	if (twl_has_regulator() && twl_class_is_6030() &&
1023			(features & TWL6025_SUBCLASS)) {
1024		child = add_regulator(TWL6025_REG_LDO5, pdata->ldo5,
1025					features);
1026		if (IS_ERR(child))
1027			return PTR_ERR(child);
1028
1029		child = add_regulator(TWL6025_REG_LDO1, pdata->ldo1,
1030					features);
1031		if (IS_ERR(child))
1032			return PTR_ERR(child);
1033
1034		child = add_regulator(TWL6025_REG_LDO7, pdata->ldo7,
1035					features);
1036		if (IS_ERR(child))
1037			return PTR_ERR(child);
1038
1039		child = add_regulator(TWL6025_REG_LDO6, pdata->ldo6,
1040					features);
1041		if (IS_ERR(child))
1042			return PTR_ERR(child);
1043
1044		child = add_regulator(TWL6025_REG_LDOLN, pdata->ldoln,
1045					features);
1046		if (IS_ERR(child))
1047			return PTR_ERR(child);
1048
1049		child = add_regulator(TWL6025_REG_LDO2, pdata->ldo2,
1050					features);
1051		if (IS_ERR(child))
1052			return PTR_ERR(child);
1053
1054		child = add_regulator(TWL6025_REG_LDO4, pdata->ldo4,
1055					features);
1056		if (IS_ERR(child))
1057			return PTR_ERR(child);
1058
1059		child = add_regulator(TWL6025_REG_LDO3, pdata->ldo3,
1060					features);
1061		if (IS_ERR(child))
1062			return PTR_ERR(child);
1063
1064		child = add_regulator(TWL6025_REG_SMPS3, pdata->smps3,
1065					features);
1066		if (IS_ERR(child))
1067			return PTR_ERR(child);
1068
1069		child = add_regulator(TWL6025_REG_SMPS4, pdata->smps4,
1070					features);
1071		if (IS_ERR(child))
1072			return PTR_ERR(child);
1073
1074		child = add_regulator(TWL6025_REG_VIO, pdata->vio6025,
1075					features);
1076		if (IS_ERR(child))
1077			return PTR_ERR(child);
1078
1079	}
1080
1081	if (twl_has_bci() && pdata->bci &&
1082			!(features & (TPS_SUBSET | TWL5031))) {
1083		child = add_child(3, "twl4030_bci",
1084				pdata->bci, sizeof(*pdata->bci), false,
1085				/* irq0 = CHG_PRES, irq1 = BCI */
1086				irq_base + BCI_PRES_INTR_OFFSET,
1087				irq_base + BCI_INTR_OFFSET);
1088		if (IS_ERR(child))
1089			return PTR_ERR(child);
1090	}
1091
1092	return 0;
1093}
1094
1095/*----------------------------------------------------------------------*/
1096
1097/*
1098 * These three functions initialize the on-chip clock framework,
1099 * letting it generate the right frequencies for USB, MADC, and
1100 * other purposes.
1101 */
1102static inline int __init protect_pm_master(void)
1103{
1104	int e = 0;
1105
1106	e = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, 0,
1107			TWL4030_PM_MASTER_PROTECT_KEY);
1108	return e;
1109}
1110
1111static inline int __init unprotect_pm_master(void)
1112{
1113	int e = 0;
1114
1115	e |= twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER,
1116			TWL4030_PM_MASTER_KEY_CFG1,
1117			TWL4030_PM_MASTER_PROTECT_KEY);
1118	e |= twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER,
1119			TWL4030_PM_MASTER_KEY_CFG2,
1120			TWL4030_PM_MASTER_PROTECT_KEY);
1121
1122	return e;
1123}
1124
1125static void clocks_init(struct device *dev,
1126			struct twl4030_clock_init_data *clock)
1127{
1128	int e = 0;
1129	struct clk *osc;
1130	u32 rate;
1131	u8 ctrl = HFCLK_FREQ_26_MHZ;
1132
1133#if defined(CONFIG_ARCH_OMAP2) || defined(CONFIG_ARCH_OMAP3)
1134	if (cpu_is_omap2430())
1135		osc = clk_get(dev, "osc_ck");
1136	else
1137		osc = clk_get(dev, "osc_sys_ck");
1138
1139	if (IS_ERR(osc)) {
1140		printk(KERN_WARNING "Skipping twl internal clock init and "
1141				"using bootloader value (unknown osc rate)\n");
1142		return;
1143	}
1144
1145	rate = clk_get_rate(osc);
1146	clk_put(osc);
1147
1148#else
1149	/* REVISIT for non-OMAP systems, pass the clock rate from
1150	 * board init code, using platform_data.
1151	 */
1152	osc = ERR_PTR(-EIO);
1153
1154	printk(KERN_WARNING "Skipping twl internal clock init and "
1155	       "using bootloader value (unknown osc rate)\n");
1156
1157	return;
1158#endif
1159
1160	switch (rate) {
1161	case 19200000:
1162		ctrl = HFCLK_FREQ_19p2_MHZ;
1163		break;
1164	case 26000000:
1165		ctrl = HFCLK_FREQ_26_MHZ;
1166		break;
1167	case 38400000:
1168		ctrl = HFCLK_FREQ_38p4_MHZ;
1169		break;
1170	}
1171
1172	ctrl |= HIGH_PERF_SQ;
1173	if (clock && clock->ck32k_lowpwr_enable)
1174		ctrl |= CK32K_LOWPWR_EN;
1175
1176	e |= unprotect_pm_master();
1177	/* effect->MADC+USB ck en */
1178	e |= twl_i2c_write_u8(TWL_MODULE_PM_MASTER, ctrl, R_CFG_BOOT);
1179	e |= protect_pm_master();
1180
1181	if (e < 0)
1182		pr_err("%s: clock init err [%d]\n", DRIVER_NAME, e);
1183}
1184
1185/*----------------------------------------------------------------------*/
1186
 
 
 
 
 
1187
1188static int twl_remove(struct i2c_client *client)
1189{
1190	unsigned i, num_slaves;
1191	int status;
1192
1193	if (twl_class_is_4030()) {
1194		status = twl4030_exit_irq();
1195		num_slaves = TWL_NUM_SLAVES;
1196	} else {
1197		status = twl6030_exit_irq();
1198		num_slaves = TWL_NUM_SLAVES - 1;
1199	}
1200
1201	if (status < 0)
1202		return status;
1203
1204	for (i = 0; i < num_slaves; i++) {
1205		struct twl_client	*twl = &twl_modules[i];
1206
1207		if (twl->client && twl->client != client)
1208			i2c_unregister_device(twl->client);
1209		twl_modules[i].client = NULL;
1210	}
1211	inuse = false;
1212	return 0;
1213}
1214
1215/* NOTE: This driver only handles a single twl4030/tps659x0 chip */
1216static int __devinit
1217twl_probe(struct i2c_client *client, const struct i2c_device_id *id)
1218{
 
 
1219	struct twl4030_platform_data	*pdata = client->dev.platform_data;
1220	struct device_node		*node = client->dev.of_node;
1221	int				irq_base = 0;
1222	int				status;
1223	unsigned			i, num_slaves;
1224
1225	if (node && !pdata) {
1226		/*
1227		 * XXX: Temporary pdata until the information is correctly
1228		 * retrieved by every TWL modules from DT.
1229		 */
1230		pdata = devm_kzalloc(&client->dev,
1231				     sizeof(struct twl4030_platform_data),
1232				     GFP_KERNEL);
1233		if (!pdata)
1234			return -ENOMEM;
1235	}
1236
1237	if (!pdata) {
1238		dev_dbg(&client->dev, "no platform data?\n");
1239		return -EINVAL;
1240	}
1241
1242	if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C) == 0) {
1243		dev_dbg(&client->dev, "can't talk I2C?\n");
1244		return -EIO;
1245	}
1246
1247	if (inuse) {
1248		dev_dbg(&client->dev, "driver is already in use\n");
1249		return -EBUSY;
1250	}
1251
1252	if ((id->driver_data) & TWL6030_CLASS) {
1253		twl_id = TWL6030_CLASS_ID;
1254		twl_map = &twl6030_map[0];
1255		num_slaves = TWL_NUM_SLAVES - 1;
1256	} else {
1257		twl_id = TWL4030_CLASS_ID;
1258		twl_map = &twl4030_map[0];
1259		num_slaves = TWL_NUM_SLAVES;
1260	}
1261
1262	for (i = 0; i < num_slaves; i++) {
1263		struct twl_client *twl = &twl_modules[i];
1264
1265		twl->address = client->addr + i;
1266		if (i == 0) {
1267			twl->client = client;
1268		} else {
1269			twl->client = i2c_new_dummy(client->adapter,
1270					twl->address);
1271			if (!twl->client) {
1272				dev_err(&client->dev,
1273					"can't attach client %d\n", i);
1274				status = -ENOMEM;
1275				goto fail;
1276			}
1277		}
1278		mutex_init(&twl->xfer_lock);
1279	}
1280
1281	inuse = true;
 
 
 
 
 
 
 
1282
1283	/* setup clock framework */
1284	clocks_init(&client->dev, pdata->clock);
1285
1286	/* read TWL IDCODE Register */
1287	if (twl_id == TWL4030_CLASS_ID) {
1288		status = twl_read_idcode_register();
1289		WARN(status < 0, "Error: reading twl_idcode register value\n");
1290	}
1291
1292	/* load power event scripts */
1293	if (twl_has_power() && pdata->power)
1294		twl4030_power_init(pdata->power);
1295
1296	/* Maybe init the T2 Interrupt subsystem */
1297	if (client->irq) {
 
 
1298		if (twl_class_is_4030()) {
1299			twl4030_init_chip_irq(id->name);
1300			irq_base = twl4030_init_irq(&client->dev, client->irq);
 
1301		} else {
1302			irq_base = twl6030_init_irq(&client->dev, client->irq);
 
1303		}
1304
1305		if (irq_base < 0) {
1306			status = irq_base;
1307			goto fail;
1308		}
1309	}
1310
1311	/*
1312	 * Disable TWL4030/TWL5030 I2C Pull-up on I2C1 and I2C4(SR) interface.
1313	 * Program I2C_SCL_CTRL_PU(bit 0)=0, I2C_SDA_CTRL_PU (bit 2)=0,
1314	 * SR_I2C_SCL_CTRL_PU(bit 4)=0 and SR_I2C_SDA_CTRL_PU(bit 6)=0.
1315	 */
 
1316	if (twl_class_is_4030()) {
1317		u8 temp;
1318
1319		twl_i2c_read_u8(TWL4030_MODULE_INTBR, &temp, REG_GPPUPDCTR1);
1320		temp &= ~(SR_I2C_SDA_CTRL_PU | SR_I2C_SCL_CTRL_PU | \
1321			I2C_SDA_CTRL_PU | I2C_SCL_CTRL_PU);
1322		twl_i2c_write_u8(TWL4030_MODULE_INTBR, temp, REG_GPPUPDCTR1);
1323	}
1324
1325	status = -ENODEV;
1326	if (node)
1327		status = of_platform_populate(node, NULL, NULL, &client->dev);
1328	if (status)
1329		status = add_children(pdata, irq_base, id->driver_data);
1330
1331fail:
1332	if (status < 0)
1333		twl_remove(client);
1334
1335	return status;
1336}
1337
1338static const struct i2c_device_id twl_ids[] = {
1339	{ "twl4030", TWL4030_VAUX2 },	/* "Triton 2" */
1340	{ "twl5030", 0 },		/* T2 updated */
1341	{ "twl5031", TWL5031 },		/* TWL5030 updated */
1342	{ "tps65950", 0 },		/* catalog version of twl5030 */
1343	{ "tps65930", TPS_SUBSET },	/* fewer LDOs and DACs; no charger */
1344	{ "tps65920", TPS_SUBSET },	/* fewer LDOs; no codec or charger */
1345	{ "tps65921", TPS_SUBSET },	/* fewer LDOs; no codec, no LED
1346					   and vibrator. Charger in USB module*/
1347	{ "twl6030", TWL6030_CLASS },	/* "Phoenix power chip" */
1348	{ "twl6025", TWL6030_CLASS | TWL6025_SUBCLASS }, /* "Phoenix lite" */
1349	{ /* end of list */ },
1350};
1351MODULE_DEVICE_TABLE(i2c, twl_ids);
1352
1353/* One Client Driver , 4 Clients */
1354static struct i2c_driver twl_driver = {
1355	.driver.name	= DRIVER_NAME,
1356	.id_table	= twl_ids,
1357	.probe		= twl_probe,
1358	.remove		= twl_remove,
1359};
1360
1361static int __init twl_init(void)
1362{
1363	return i2c_add_driver(&twl_driver);
1364}
1365subsys_initcall(twl_init);
1366
1367static void __exit twl_exit(void)
1368{
1369	i2c_del_driver(&twl_driver);
1370}
1371module_exit(twl_exit);
1372
1373MODULE_AUTHOR("Texas Instruments, Inc.");
1374MODULE_DESCRIPTION("I2C Core interface for TWL");
1375MODULE_LICENSE("GPL");