twl-core.c revision 14e5c82ca32870698b7cbe54196e00682d929ca5
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#define twl_has_usb()	true
100#else
101#define twl_has_usb()	false
102#endif
103
104#if defined(CONFIG_TWL4030_WATCHDOG) || \
105	defined(CONFIG_TWL4030_WATCHDOG_MODULE)
106#define twl_has_watchdog()        true
107#else
108#define twl_has_watchdog()        false
109#endif
110
111#if defined(CONFIG_TWL4030_CODEC) || defined(CONFIG_TWL4030_CODEC_MODULE) ||\
112	defined(CONFIG_SND_SOC_TWL6030) || defined(CONFIG_SND_SOC_TWL6030_MODULE)
113#define twl_has_codec()	true
114#else
115#define twl_has_codec()	false
116#endif
117
118/* Triton Core internal information (BEGIN) */
119
120/* Last - for index max*/
121#define TWL4030_MODULE_LAST		TWL4030_MODULE_SECURED_REG
122
123#define TWL_NUM_SLAVES		4
124
125#if defined(CONFIG_INPUT_TWL4030_PWRBUTTON) \
126	|| defined(CONFIG_INPUT_TWL4030_PWRBUTTON_MODULE)
127#define twl_has_pwrbutton()	true
128#else
129#define twl_has_pwrbutton()	false
130#endif
131
132#define SUB_CHIP_ID0 0
133#define SUB_CHIP_ID1 1
134#define SUB_CHIP_ID2 2
135#define SUB_CHIP_ID3 3
136
137#define TWL_MODULE_LAST TWL4030_MODULE_LAST
138
139/* Base Address defns for twl4030_map[] */
140
141/* subchip/slave 0 - USB ID */
142#define TWL4030_BASEADD_USB		0x0000
143
144/* subchip/slave 1 - AUD ID */
145#define TWL4030_BASEADD_AUDIO_VOICE	0x0000
146#define TWL4030_BASEADD_GPIO		0x0098
147#define TWL4030_BASEADD_INTBR		0x0085
148#define TWL4030_BASEADD_PIH		0x0080
149#define TWL4030_BASEADD_TEST		0x004C
150
151/* subchip/slave 2 - AUX ID */
152#define TWL4030_BASEADD_INTERRUPTS	0x00B9
153#define TWL4030_BASEADD_LED		0x00EE
154#define TWL4030_BASEADD_MADC		0x0000
155#define TWL4030_BASEADD_MAIN_CHARGE	0x0074
156#define TWL4030_BASEADD_PRECHARGE	0x00AA
157#define TWL4030_BASEADD_PWM0		0x00F8
158#define TWL4030_BASEADD_PWM1		0x00FB
159#define TWL4030_BASEADD_PWMA		0x00EF
160#define TWL4030_BASEADD_PWMB		0x00F1
161#define TWL4030_BASEADD_KEYPAD		0x00D2
162
163#define TWL5031_BASEADD_ACCESSORY	0x0074 /* Replaces Main Charge */
164#define TWL5031_BASEADD_INTERRUPTS	0x00B9 /* Different than TWL4030's
165						  one */
166
167/* subchip/slave 3 - POWER ID */
168#define TWL4030_BASEADD_BACKUP		0x0014
169#define TWL4030_BASEADD_INT		0x002E
170#define TWL4030_BASEADD_PM_MASTER	0x0036
171#define TWL4030_BASEADD_PM_RECEIVER	0x005B
172#define TWL4030_BASEADD_RTC		0x001C
173#define TWL4030_BASEADD_SECURED_REG	0x0000
174
175/* Triton Core internal information (END) */
176
177
178/* subchip/slave 0 0x48 - POWER */
179#define TWL6030_BASEADD_RTC		0x0000
180#define TWL6030_BASEADD_MEM		0x0017
181#define TWL6030_BASEADD_PM_MASTER	0x001F
182#define TWL6030_BASEADD_PM_SLAVE_MISC	0x0030 /* PM_RECEIVER */
183#define TWL6030_BASEADD_PM_MISC		0x00E2
184#define TWL6030_BASEADD_PM_PUPD		0x00F0
185
186/* subchip/slave 1 0x49 - FEATURE */
187#define TWL6030_BASEADD_USB		0x0000
188#define TWL6030_BASEADD_GPADC_CTRL	0x002E
189#define TWL6030_BASEADD_AUX		0x0090
190#define TWL6030_BASEADD_PWM		0x00BA
191#define TWL6030_BASEADD_GASGAUGE	0x00C0
192#define TWL6030_BASEADD_PIH		0x00D0
193#define TWL6030_BASEADD_CHARGER		0x00E0
194
195/* subchip/slave 2 0x4A - DFT */
196#define TWL6030_BASEADD_DIEID		0x00C0
197
198/* subchip/slave 3 0x4B - AUDIO */
199#define TWL6030_BASEADD_AUDIO		0x0000
200#define TWL6030_BASEADD_RSV		0x0000
201
202/* Few power values */
203#define R_CFG_BOOT			0x05
204#define R_PROTECT_KEY			0x0E
205
206/* access control values for R_PROTECT_KEY */
207#define KEY_UNLOCK1			0xce
208#define KEY_UNLOCK2			0xec
209#define KEY_LOCK			0x00
210
211/* some fields in R_CFG_BOOT */
212#define HFCLK_FREQ_19p2_MHZ		(1 << 0)
213#define HFCLK_FREQ_26_MHZ		(2 << 0)
214#define HFCLK_FREQ_38p4_MHZ		(3 << 0)
215#define HIGH_PERF_SQ			(1 << 3)
216#define CK32K_LOWPWR_EN			(1 << 7)
217
218
219/* chip-specific feature flags, for i2c_device_id.driver_data */
220#define TWL4030_VAUX2		BIT(0)	/* pre-5030 voltage ranges */
221#define TPS_SUBSET		BIT(1)	/* tps659[23]0 have fewer LDOs */
222#define TWL5031			BIT(2)  /* twl5031 has different registers */
223#define TWL6030_CLASS		BIT(3)	/* TWL6030 class */
224
225/*----------------------------------------------------------------------*/
226
227/* is driver active, bound to a chip? */
228static bool inuse;
229
230static unsigned int twl_id;
231unsigned int twl_rev(void)
232{
233	return twl_id;
234}
235EXPORT_SYMBOL(twl_rev);
236
237/* Structure for each TWL4030/TWL6030 Slave */
238struct twl_client {
239	struct i2c_client *client;
240	u8 address;
241
242	/* max numb of i2c_msg required is for read =2 */
243	struct i2c_msg xfer_msg[2];
244
245	/* To lock access to xfer_msg */
246	struct mutex xfer_lock;
247};
248
249static struct twl_client twl_modules[TWL_NUM_SLAVES];
250
251
252/* mapping the module id to slave id and base address */
253struct twl_mapping {
254	unsigned char sid;	/* Slave ID */
255	unsigned char base;	/* base address */
256};
257struct twl_mapping *twl_map;
258
259static struct twl_mapping twl4030_map[TWL4030_MODULE_LAST + 1] = {
260	/*
261	 * NOTE:  don't change this table without updating the
262	 * <linux/i2c/twl.h> defines for TWL4030_MODULE_*
263	 * so they continue to match the order in this table.
264	 */
265
266	{ 0, TWL4030_BASEADD_USB },
267
268	{ 1, TWL4030_BASEADD_AUDIO_VOICE },
269	{ 1, TWL4030_BASEADD_GPIO },
270	{ 1, TWL4030_BASEADD_INTBR },
271	{ 1, TWL4030_BASEADD_PIH },
272	{ 1, TWL4030_BASEADD_TEST },
273
274	{ 2, TWL4030_BASEADD_KEYPAD },
275	{ 2, TWL4030_BASEADD_MADC },
276	{ 2, TWL4030_BASEADD_INTERRUPTS },
277	{ 2, TWL4030_BASEADD_LED },
278	{ 2, TWL4030_BASEADD_MAIN_CHARGE },
279	{ 2, TWL4030_BASEADD_PRECHARGE },
280	{ 2, TWL4030_BASEADD_PWM0 },
281	{ 2, TWL4030_BASEADD_PWM1 },
282	{ 2, TWL4030_BASEADD_PWMA },
283	{ 2, TWL4030_BASEADD_PWMB },
284	{ 2, TWL5031_BASEADD_ACCESSORY },
285	{ 2, TWL5031_BASEADD_INTERRUPTS },
286
287	{ 3, TWL4030_BASEADD_BACKUP },
288	{ 3, TWL4030_BASEADD_INT },
289	{ 3, TWL4030_BASEADD_PM_MASTER },
290	{ 3, TWL4030_BASEADD_PM_RECEIVER },
291	{ 3, TWL4030_BASEADD_RTC },
292	{ 3, TWL4030_BASEADD_SECURED_REG },
293};
294
295static struct twl_mapping twl6030_map[] = {
296	/*
297	 * NOTE:  don't change this table without updating the
298	 * <linux/i2c/twl.h> defines for TWL4030_MODULE_*
299	 * so they continue to match the order in this table.
300	 */
301	{ SUB_CHIP_ID1, TWL6030_BASEADD_USB },
302	{ SUB_CHIP_ID3, TWL6030_BASEADD_AUDIO },
303	{ SUB_CHIP_ID2, TWL6030_BASEADD_DIEID },
304	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
305	{ SUB_CHIP_ID1, TWL6030_BASEADD_PIH },
306
307	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
308	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
309	{ SUB_CHIP_ID1, TWL6030_BASEADD_GPADC_CTRL },
310	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
311	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
312
313	{ SUB_CHIP_ID1, TWL6030_BASEADD_CHARGER },
314	{ SUB_CHIP_ID1, TWL6030_BASEADD_GASGAUGE },
315	{ SUB_CHIP_ID1, TWL6030_BASEADD_PWM },
316	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
317	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
318
319	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
320	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
321	{ SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
322	{ SUB_CHIP_ID0, TWL6030_BASEADD_PM_MASTER },
323	{ SUB_CHIP_ID0, TWL6030_BASEADD_PM_SLAVE_MISC },
324
325	{ SUB_CHIP_ID0, TWL6030_BASEADD_RTC },
326	{ SUB_CHIP_ID0, TWL6030_BASEADD_MEM },
327};
328
329/*----------------------------------------------------------------------*/
330
331/* Exported Functions */
332
333/**
334 * twl_i2c_write - Writes a n bit register in TWL4030/TWL5030/TWL60X0
335 * @mod_no: module number
336 * @value: an array of num_bytes+1 containing data to write
337 * @reg: register address (just offset will do)
338 * @num_bytes: number of bytes to transfer
339 *
340 * IMPORTANT: for 'value' parameter: Allocate value num_bytes+1 and
341 * valid data starts at Offset 1.
342 *
343 * Returns the result of operation - 0 is success
344 */
345int twl_i2c_write(u8 mod_no, u8 *value, u8 reg, unsigned num_bytes)
346{
347	int ret;
348	int sid;
349	struct twl_client *twl;
350	struct i2c_msg *msg;
351
352	if (unlikely(mod_no > TWL_MODULE_LAST)) {
353		pr_err("%s: invalid module number %d\n", DRIVER_NAME, mod_no);
354		return -EPERM;
355	}
356	sid = twl_map[mod_no].sid;
357	twl = &twl_modules[sid];
358
359	if (unlikely(!inuse)) {
360		pr_err("%s: client %d is not initialized\n", DRIVER_NAME, sid);
361		return -EPERM;
362	}
363	mutex_lock(&twl->xfer_lock);
364	/*
365	 * [MSG1]: fill the register address data
366	 * fill the data Tx buffer
367	 */
368	msg = &twl->xfer_msg[0];
369	msg->addr = twl->address;
370	msg->len = num_bytes + 1;
371	msg->flags = 0;
372	msg->buf = value;
373	/* over write the first byte of buffer with the register address */
374	*value = twl_map[mod_no].base + reg;
375	ret = i2c_transfer(twl->client->adapter, twl->xfer_msg, 1);
376	mutex_unlock(&twl->xfer_lock);
377
378	/* i2c_transfer returns number of messages transferred */
379	if (ret != 1) {
380		pr_err("%s: i2c_write failed to transfer all messages\n",
381			DRIVER_NAME);
382		if (ret < 0)
383			return ret;
384		else
385			return -EIO;
386	} else {
387		return 0;
388	}
389}
390EXPORT_SYMBOL(twl_i2c_write);
391
392/**
393 * twl_i2c_read - Reads a n bit register in TWL4030/TWL5030/TWL60X0
394 * @mod_no: module number
395 * @value: an array of num_bytes containing data to be read
396 * @reg: register address (just offset will do)
397 * @num_bytes: number of bytes to transfer
398 *
399 * Returns result of operation - num_bytes is success else failure.
400 */
401int twl_i2c_read(u8 mod_no, u8 *value, u8 reg, unsigned num_bytes)
402{
403	int ret;
404	u8 val;
405	int sid;
406	struct twl_client *twl;
407	struct i2c_msg *msg;
408
409	if (unlikely(mod_no > TWL_MODULE_LAST)) {
410		pr_err("%s: invalid module number %d\n", DRIVER_NAME, mod_no);
411		return -EPERM;
412	}
413	sid = twl_map[mod_no].sid;
414	twl = &twl_modules[sid];
415
416	if (unlikely(!inuse)) {
417		pr_err("%s: client %d is not initialized\n", DRIVER_NAME, sid);
418		return -EPERM;
419	}
420	mutex_lock(&twl->xfer_lock);
421	/* [MSG1] fill the register address data */
422	msg = &twl->xfer_msg[0];
423	msg->addr = twl->address;
424	msg->len = 1;
425	msg->flags = 0;	/* Read the register value */
426	val = twl_map[mod_no].base + reg;
427	msg->buf = &val;
428	/* [MSG2] fill the data rx buffer */
429	msg = &twl->xfer_msg[1];
430	msg->addr = twl->address;
431	msg->flags = I2C_M_RD;	/* Read the register value */
432	msg->len = num_bytes;	/* only n bytes */
433	msg->buf = value;
434	ret = i2c_transfer(twl->client->adapter, twl->xfer_msg, 2);
435	mutex_unlock(&twl->xfer_lock);
436
437	/* i2c_transfer returns number of messages transferred */
438	if (ret != 2) {
439		pr_err("%s: i2c_read failed to transfer all messages\n",
440			DRIVER_NAME);
441		if (ret < 0)
442			return ret;
443		else
444			return -EIO;
445	} else {
446		return 0;
447	}
448}
449EXPORT_SYMBOL(twl_i2c_read);
450
451/**
452 * twl_i2c_write_u8 - Writes a 8 bit register in TWL4030/TWL5030/TWL60X0
453 * @mod_no: module number
454 * @value: the value to be written 8 bit
455 * @reg: register address (just offset will do)
456 *
457 * Returns result of operation - 0 is success
458 */
459int twl_i2c_write_u8(u8 mod_no, u8 value, u8 reg)
460{
461
462	/* 2 bytes offset 1 contains the data offset 0 is used by i2c_write */
463	u8 temp_buffer[2] = { 0 };
464	/* offset 1 contains the data */
465	temp_buffer[1] = value;
466	return twl_i2c_write(mod_no, temp_buffer, reg, 1);
467}
468EXPORT_SYMBOL(twl_i2c_write_u8);
469
470/**
471 * twl_i2c_read_u8 - Reads a 8 bit register from TWL4030/TWL5030/TWL60X0
472 * @mod_no: module number
473 * @value: the value read 8 bit
474 * @reg: register address (just offset will do)
475 *
476 * Returns result of operation - 0 is success
477 */
478int twl_i2c_read_u8(u8 mod_no, u8 *value, u8 reg)
479{
480	return twl_i2c_read(mod_no, value, reg, 1);
481}
482EXPORT_SYMBOL(twl_i2c_read_u8);
483
484/*----------------------------------------------------------------------*/
485
486static struct device *
487add_numbered_child(unsigned chip, const char *name, int num,
488		void *pdata, unsigned pdata_len,
489		bool can_wakeup, int irq0, int irq1)
490{
491	struct platform_device	*pdev;
492	struct twl_client	*twl = &twl_modules[chip];
493	int			status;
494
495	pdev = platform_device_alloc(name, num);
496	if (!pdev) {
497		dev_dbg(&twl->client->dev, "can't alloc dev\n");
498		status = -ENOMEM;
499		goto err;
500	}
501
502	device_init_wakeup(&pdev->dev, can_wakeup);
503	pdev->dev.parent = &twl->client->dev;
504
505	if (pdata) {
506		status = platform_device_add_data(pdev, pdata, pdata_len);
507		if (status < 0) {
508			dev_dbg(&pdev->dev, "can't add platform_data\n");
509			goto err;
510		}
511	}
512
513	if (irq0) {
514		struct resource r[2] = {
515			{ .start = irq0, .flags = IORESOURCE_IRQ, },
516			{ .start = irq1, .flags = IORESOURCE_IRQ, },
517		};
518
519		status = platform_device_add_resources(pdev, r, irq1 ? 2 : 1);
520		if (status < 0) {
521			dev_dbg(&pdev->dev, "can't add irqs\n");
522			goto err;
523		}
524	}
525
526	status = platform_device_add(pdev);
527
528err:
529	if (status < 0) {
530		platform_device_put(pdev);
531		dev_err(&twl->client->dev, "can't add %s dev\n", name);
532		return ERR_PTR(status);
533	}
534	return &pdev->dev;
535}
536
537static inline struct device *add_child(unsigned chip, const char *name,
538		void *pdata, unsigned pdata_len,
539		bool can_wakeup, int irq0, int irq1)
540{
541	return add_numbered_child(chip, name, -1, pdata, pdata_len,
542		can_wakeup, irq0, irq1);
543}
544
545static struct device *
546add_regulator_linked(int num, struct regulator_init_data *pdata,
547		struct regulator_consumer_supply *consumers,
548		unsigned num_consumers)
549{
550	unsigned sub_chip_id;
551	/* regulator framework demands init_data ... */
552	if (!pdata)
553		return NULL;
554
555	if (consumers) {
556		pdata->consumer_supplies = consumers;
557		pdata->num_consumer_supplies = num_consumers;
558	}
559
560	/* NOTE:  we currently ignore regulator IRQs, e.g. for short circuits */
561	sub_chip_id = twl_map[TWL_MODULE_PM_MASTER].sid;
562	return add_numbered_child(sub_chip_id, "twl_reg", num,
563		pdata, sizeof(*pdata), false, 0, 0);
564}
565
566static struct device *
567add_regulator(int num, struct regulator_init_data *pdata)
568{
569	return add_regulator_linked(num, pdata, NULL, 0);
570}
571
572/*
573 * NOTE:  We know the first 8 IRQs after pdata->base_irq are
574 * for the PIH, and the next are for the PWR_INT SIH, since
575 * that's how twl_init_irq() sets things up.
576 */
577
578static int
579add_children(struct twl4030_platform_data *pdata, unsigned long features)
580{
581	struct device	*child;
582	unsigned sub_chip_id;
583
584	if (twl_has_gpio() && pdata->gpio) {
585		child = add_child(SUB_CHIP_ID1, "twl4030_gpio",
586				pdata->gpio, sizeof(*pdata->gpio),
587				false, pdata->irq_base + GPIO_INTR_OFFSET, 0);
588		if (IS_ERR(child))
589			return PTR_ERR(child);
590	}
591
592	if (twl_has_keypad() && pdata->keypad) {
593		child = add_child(SUB_CHIP_ID2, "twl4030_keypad",
594				pdata->keypad, sizeof(*pdata->keypad),
595				true, pdata->irq_base + KEYPAD_INTR_OFFSET, 0);
596		if (IS_ERR(child))
597			return PTR_ERR(child);
598	}
599
600	if (twl_has_madc() && pdata->madc) {
601		child = add_child(2, "twl4030_madc",
602				pdata->madc, sizeof(*pdata->madc),
603				true, pdata->irq_base + MADC_INTR_OFFSET, 0);
604		if (IS_ERR(child))
605			return PTR_ERR(child);
606	}
607
608	if (twl_has_rtc()) {
609		/*
610		 * REVISIT platform_data here currently might expose the
611		 * "msecure" line ... but for now we just expect board
612		 * setup to tell the chip "it's always ok to SET_TIME".
613		 * Eventually, Linux might become more aware of such
614		 * HW security concerns, and "least privilege".
615		 */
616		sub_chip_id = twl_map[TWL_MODULE_RTC].sid;
617		child = add_child(sub_chip_id, "twl_rtc",
618				NULL, 0,
619				true, pdata->irq_base + RTC_INTR_OFFSET, 0);
620		if (IS_ERR(child))
621			return PTR_ERR(child);
622	}
623
624	if (twl_has_usb() && pdata->usb && twl_class_is_4030()) {
625
626		static struct regulator_consumer_supply usb1v5 = {
627			.supply =	"usb1v5",
628		};
629		static struct regulator_consumer_supply usb1v8 = {
630			.supply =	"usb1v8",
631		};
632		static struct regulator_consumer_supply usb3v1 = {
633			.supply =	"usb3v1",
634		};
635
636	/* First add the regulators so that they can be used by transceiver */
637		if (twl_has_regulator()) {
638			/* this is a template that gets copied */
639			struct regulator_init_data usb_fixed = {
640				.constraints.valid_modes_mask =
641					REGULATOR_MODE_NORMAL
642					| REGULATOR_MODE_STANDBY,
643				.constraints.valid_ops_mask =
644					REGULATOR_CHANGE_MODE
645					| REGULATOR_CHANGE_STATUS,
646			};
647
648			child = add_regulator_linked(TWL4030_REG_VUSB1V5,
649						      &usb_fixed, &usb1v5, 1);
650			if (IS_ERR(child))
651				return PTR_ERR(child);
652
653			child = add_regulator_linked(TWL4030_REG_VUSB1V8,
654						      &usb_fixed, &usb1v8, 1);
655			if (IS_ERR(child))
656				return PTR_ERR(child);
657
658			child = add_regulator_linked(TWL4030_REG_VUSB3V1,
659						      &usb_fixed, &usb3v1, 1);
660			if (IS_ERR(child))
661				return PTR_ERR(child);
662
663		}
664
665		child = add_child(0, "twl4030_usb",
666				pdata->usb, sizeof(*pdata->usb),
667				true,
668				/* irq0 = USB_PRES, irq1 = USB */
669				pdata->irq_base + USB_PRES_INTR_OFFSET,
670				pdata->irq_base + USB_INTR_OFFSET);
671
672		if (IS_ERR(child))
673			return PTR_ERR(child);
674
675		/* we need to connect regulators to this transceiver */
676		if (twl_has_regulator() && child) {
677			usb1v5.dev = child;
678			usb1v8.dev = child;
679			usb3v1.dev = child;
680		}
681	}
682
683	if (twl_has_watchdog()) {
684		child = add_child(0, "twl4030_wdt", NULL, 0, false, 0, 0);
685		if (IS_ERR(child))
686			return PTR_ERR(child);
687	}
688
689	if (twl_has_pwrbutton()) {
690		child = add_child(1, "twl4030_pwrbutton",
691				NULL, 0, true, pdata->irq_base + 8 + 0, 0);
692		if (IS_ERR(child))
693			return PTR_ERR(child);
694	}
695
696	if (twl_has_codec() && pdata->codec && twl_class_is_4030()) {
697		sub_chip_id = twl_map[TWL_MODULE_AUDIO_VOICE].sid;
698		child = add_child(sub_chip_id, "twl4030_codec",
699				pdata->codec, sizeof(*pdata->codec),
700				false, 0, 0);
701		if (IS_ERR(child))
702			return PTR_ERR(child);
703	}
704
705	/* Phoenix*/
706	if (twl_has_codec() && pdata->codec && twl_class_is_6030()) {
707		sub_chip_id = twl_map[TWL_MODULE_AUDIO_VOICE].sid;
708		child = add_child(sub_chip_id, "twl6030_codec",
709				pdata->codec, sizeof(*pdata->codec),
710				false, 0, 0);
711		if (IS_ERR(child))
712			return PTR_ERR(child);
713	}
714
715	/* twl4030 regulators */
716	if (twl_has_regulator() && twl_class_is_4030()) {
717		child = add_regulator(TWL4030_REG_VPLL1, pdata->vpll1);
718		if (IS_ERR(child))
719			return PTR_ERR(child);
720
721		child = add_regulator(TWL4030_REG_VIO, pdata->vio);
722		if (IS_ERR(child))
723			return PTR_ERR(child);
724
725		child = add_regulator(TWL4030_REG_VDD1, pdata->vdd1);
726		if (IS_ERR(child))
727			return PTR_ERR(child);
728
729		child = add_regulator(TWL4030_REG_VDD2, pdata->vdd2);
730		if (IS_ERR(child))
731			return PTR_ERR(child);
732
733		child = add_regulator(TWL4030_REG_VMMC1, pdata->vmmc1);
734		if (IS_ERR(child))
735			return PTR_ERR(child);
736
737		child = add_regulator(TWL4030_REG_VDAC, pdata->vdac);
738		if (IS_ERR(child))
739			return PTR_ERR(child);
740
741		child = add_regulator((features & TWL4030_VAUX2)
742					? TWL4030_REG_VAUX2_4030
743					: TWL4030_REG_VAUX2,
744				pdata->vaux2);
745		if (IS_ERR(child))
746			return PTR_ERR(child);
747
748		child = add_regulator(TWL4030_REG_VINTANA1, pdata->vintana1);
749		if (IS_ERR(child))
750			return PTR_ERR(child);
751
752		child = add_regulator(TWL4030_REG_VINTANA2, pdata->vintana2);
753		if (IS_ERR(child))
754			return PTR_ERR(child);
755
756		child = add_regulator(TWL4030_REG_VINTDIG, pdata->vintdig);
757		if (IS_ERR(child))
758			return PTR_ERR(child);
759	}
760
761	/* maybe add LDOs that are omitted on cost-reduced parts */
762	if (twl_has_regulator() && !(features & TPS_SUBSET)
763	  && twl_class_is_4030()) {
764		child = add_regulator(TWL4030_REG_VPLL2, pdata->vpll2);
765		if (IS_ERR(child))
766			return PTR_ERR(child);
767
768		child = add_regulator(TWL4030_REG_VMMC2, pdata->vmmc2);
769		if (IS_ERR(child))
770			return PTR_ERR(child);
771
772		child = add_regulator(TWL4030_REG_VSIM, pdata->vsim);
773		if (IS_ERR(child))
774			return PTR_ERR(child);
775
776		child = add_regulator(TWL4030_REG_VAUX1, pdata->vaux1);
777		if (IS_ERR(child))
778			return PTR_ERR(child);
779
780		child = add_regulator(TWL4030_REG_VAUX3, pdata->vaux3);
781		if (IS_ERR(child))
782			return PTR_ERR(child);
783
784		child = add_regulator(TWL4030_REG_VAUX4, pdata->vaux4);
785		if (IS_ERR(child))
786			return PTR_ERR(child);
787	}
788
789	/* twl6030 regulators */
790	if (twl_has_regulator() && twl_class_is_6030()) {
791		child = add_regulator(TWL6030_REG_VMMC, pdata->vmmc);
792		if (IS_ERR(child))
793			return PTR_ERR(child);
794
795		child = add_regulator(TWL6030_REG_VPP, pdata->vpp);
796		if (IS_ERR(child))
797			return PTR_ERR(child);
798
799		child = add_regulator(TWL6030_REG_VUSIM, pdata->vusim);
800		if (IS_ERR(child))
801			return PTR_ERR(child);
802
803		child = add_regulator(TWL6030_REG_VANA, pdata->vana);
804		if (IS_ERR(child))
805			return PTR_ERR(child);
806
807		child = add_regulator(TWL6030_REG_VCXIO, pdata->vcxio);
808		if (IS_ERR(child))
809			return PTR_ERR(child);
810
811		child = add_regulator(TWL6030_REG_VDAC, pdata->vdac);
812		if (IS_ERR(child))
813			return PTR_ERR(child);
814
815		child = add_regulator(TWL6030_REG_VUSB, pdata->vusb);
816		if (IS_ERR(child))
817			return PTR_ERR(child);
818
819		child = add_regulator(TWL6030_REG_VAUX1_6030, pdata->vaux1);
820		if (IS_ERR(child))
821			return PTR_ERR(child);
822
823		child = add_regulator(TWL6030_REG_VAUX2_6030, pdata->vaux2);
824		if (IS_ERR(child))
825			return PTR_ERR(child);
826
827		child = add_regulator(TWL6030_REG_VAUX3_6030, pdata->vaux3);
828		if (IS_ERR(child))
829			return PTR_ERR(child);
830	}
831
832	return 0;
833}
834
835/*----------------------------------------------------------------------*/
836
837/*
838 * These three functions initialize the on-chip clock framework,
839 * letting it generate the right frequencies for USB, MADC, and
840 * other purposes.
841 */
842static inline int __init protect_pm_master(void)
843{
844	int e = 0;
845
846	e = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, KEY_LOCK,
847			R_PROTECT_KEY);
848	return e;
849}
850
851static inline int __init unprotect_pm_master(void)
852{
853	int e = 0;
854
855	e |= twl_i2c_write_u8(TWL_MODULE_PM_MASTER, KEY_UNLOCK1,
856			R_PROTECT_KEY);
857	e |= twl_i2c_write_u8(TWL_MODULE_PM_MASTER, KEY_UNLOCK2,
858			R_PROTECT_KEY);
859	return e;
860}
861
862static void clocks_init(struct device *dev,
863			struct twl4030_clock_init_data *clock)
864{
865	int e = 0;
866	struct clk *osc;
867	u32 rate;
868	u8 ctrl = HFCLK_FREQ_26_MHZ;
869
870#if defined(CONFIG_ARCH_OMAP2) || defined(CONFIG_ARCH_OMAP3)
871	if (cpu_is_omap2430())
872		osc = clk_get(dev, "osc_ck");
873	else
874		osc = clk_get(dev, "osc_sys_ck");
875
876	if (IS_ERR(osc)) {
877		printk(KERN_WARNING "Skipping twl internal clock init and "
878				"using bootloader value (unknown osc rate)\n");
879		return;
880	}
881
882	rate = clk_get_rate(osc);
883	clk_put(osc);
884
885#else
886	/* REVISIT for non-OMAP systems, pass the clock rate from
887	 * board init code, using platform_data.
888	 */
889	osc = ERR_PTR(-EIO);
890
891	printk(KERN_WARNING "Skipping twl internal clock init and "
892	       "using bootloader value (unknown osc rate)\n");
893
894	return;
895#endif
896
897	switch (rate) {
898	case 19200000:
899		ctrl = HFCLK_FREQ_19p2_MHZ;
900		break;
901	case 26000000:
902		ctrl = HFCLK_FREQ_26_MHZ;
903		break;
904	case 38400000:
905		ctrl = HFCLK_FREQ_38p4_MHZ;
906		break;
907	}
908
909	ctrl |= HIGH_PERF_SQ;
910	if (clock && clock->ck32k_lowpwr_enable)
911		ctrl |= CK32K_LOWPWR_EN;
912
913	e |= unprotect_pm_master();
914	/* effect->MADC+USB ck en */
915	e |= twl_i2c_write_u8(TWL_MODULE_PM_MASTER, ctrl, R_CFG_BOOT);
916	e |= protect_pm_master();
917
918	if (e < 0)
919		pr_err("%s: clock init err [%d]\n", DRIVER_NAME, e);
920}
921
922/*----------------------------------------------------------------------*/
923
924int twl4030_init_irq(int irq_num, unsigned irq_base, unsigned irq_end);
925int twl4030_exit_irq(void);
926int twl4030_init_chip_irq(const char *chip);
927int twl6030_init_irq(int irq_num, unsigned irq_base, unsigned irq_end);
928int twl6030_exit_irq(void);
929
930static int twl_remove(struct i2c_client *client)
931{
932	unsigned i;
933	int status;
934
935	if (twl_class_is_4030())
936		status = twl4030_exit_irq();
937	else
938		status = twl6030_exit_irq();
939
940	if (status < 0)
941		return status;
942
943	for (i = 0; i < TWL_NUM_SLAVES; i++) {
944		struct twl_client	*twl = &twl_modules[i];
945
946		if (twl->client && twl->client != client)
947			i2c_unregister_device(twl->client);
948		twl_modules[i].client = NULL;
949	}
950	inuse = false;
951	return 0;
952}
953
954/* NOTE:  this driver only handles a single twl4030/tps659x0 chip */
955static int __init
956twl_probe(struct i2c_client *client, const struct i2c_device_id *id)
957{
958	int				status;
959	unsigned			i;
960	struct twl4030_platform_data	*pdata = client->dev.platform_data;
961
962	if (!pdata) {
963		dev_dbg(&client->dev, "no platform data?\n");
964		return -EINVAL;
965	}
966
967	if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C) == 0) {
968		dev_dbg(&client->dev, "can't talk I2C?\n");
969		return -EIO;
970	}
971
972	if (inuse) {
973		dev_dbg(&client->dev, "driver is already in use\n");
974		return -EBUSY;
975	}
976
977	for (i = 0; i < TWL_NUM_SLAVES; i++) {
978		struct twl_client	*twl = &twl_modules[i];
979
980		twl->address = client->addr + i;
981		if (i == 0)
982			twl->client = client;
983		else {
984			twl->client = i2c_new_dummy(client->adapter,
985					twl->address);
986			if (!twl->client) {
987				dev_err(&client->dev,
988					"can't attach client %d\n", i);
989				status = -ENOMEM;
990				goto fail;
991			}
992		}
993		mutex_init(&twl->xfer_lock);
994	}
995	inuse = true;
996	if ((id->driver_data) & TWL6030_CLASS) {
997		twl_id = TWL6030_CLASS_ID;
998		twl_map = &twl6030_map[0];
999	} else {
1000		twl_id = TWL4030_CLASS_ID;
1001		twl_map = &twl4030_map[0];
1002	}
1003
1004	/* setup clock framework */
1005	clocks_init(&client->dev, pdata->clock);
1006
1007	/* load power event scripts */
1008	if (twl_has_power() && pdata->power)
1009		twl4030_power_init(pdata->power);
1010
1011	/* Maybe init the T2 Interrupt subsystem */
1012	if (client->irq
1013			&& pdata->irq_base
1014			&& pdata->irq_end > pdata->irq_base) {
1015		if (twl_class_is_4030()) {
1016			twl4030_init_chip_irq(id->name);
1017			status = twl4030_init_irq(client->irq, pdata->irq_base,
1018			pdata->irq_end);
1019		} else {
1020			status = twl6030_init_irq(client->irq, pdata->irq_base,
1021			pdata->irq_end);
1022		}
1023
1024		if (status < 0)
1025			goto fail;
1026	}
1027
1028	status = add_children(pdata, id->driver_data);
1029fail:
1030	if (status < 0)
1031		twl_remove(client);
1032	return status;
1033}
1034
1035static const struct i2c_device_id twl_ids[] = {
1036	{ "twl4030", TWL4030_VAUX2 },	/* "Triton 2" */
1037	{ "twl5030", 0 },		/* T2 updated */
1038	{ "twl5031", TWL5031 },		/* TWL5030 updated */
1039	{ "tps65950", 0 },		/* catalog version of twl5030 */
1040	{ "tps65930", TPS_SUBSET },	/* fewer LDOs and DACs; no charger */
1041	{ "tps65920", TPS_SUBSET },	/* fewer LDOs; no codec or charger */
1042	{ "twl6030", TWL6030_CLASS },	/* "Phoenix power chip" */
1043	{ /* end of list */ },
1044};
1045MODULE_DEVICE_TABLE(i2c, twl_ids);
1046
1047/* One Client Driver , 4 Clients */
1048static struct i2c_driver twl_driver = {
1049	.driver.name	= DRIVER_NAME,
1050	.id_table	= twl_ids,
1051	.probe		= twl_probe,
1052	.remove		= twl_remove,
1053};
1054
1055static int __init twl_init(void)
1056{
1057	return i2c_add_driver(&twl_driver);
1058}
1059subsys_initcall(twl_init);
1060
1061static void __exit twl_exit(void)
1062{
1063	i2c_del_driver(&twl_driver);
1064}
1065module_exit(twl_exit);
1066
1067MODULE_AUTHOR("Texas Instruments, Inc.");
1068MODULE_DESCRIPTION("I2C Core interface for TWL");
1069MODULE_LICENSE("GPL");
1070