]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blob - drivers/mfd/twl-core.c
projects / mirror_ubuntu-artful-kernel.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
Merge branch 'for-linus' of git://git.kernel.org/pub/scm/linux/kernel/git/dtor/input
[mirror_ubuntu-artful-kernel.git] / drivers / mfd / twl-core.c
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 /* chip-specific feature flags, for i2c_device_id.driver_data */
229 #define TWL4030_VAUX2 BIT(0) /* pre-5030 voltage ranges */
230 #define TPS_SUBSET BIT(1) /* tps659[23]0 have fewer LDOs */
231 #define TWL5031 BIT(2) /* twl5031 has different registers */
232 #define TWL6030_CLASS BIT(3) /* TWL6030 class */
233
234 /*----------------------------------------------------------------------*/
235
236 /* is driver active, bound to a chip? */
237 static bool inuse;
238
239 /* TWL IDCODE Register value */
240 static u32 twl_idcode;
241
242 static unsigned int twl_id;
243 unsigned int twl_rev(void)
244 {
245 return twl_id;
246 }
247 EXPORT_SYMBOL(twl_rev);
248
249 /* Structure for each TWL4030/TWL6030 Slave */
250 struct twl_client {
251 struct i2c_client *client;
252 u8 address;
253
254 /* max numb of i2c_msg required is for read =2 */
255 struct i2c_msg xfer_msg[2];
256
257 /* To lock access to xfer_msg */
258 struct mutex xfer_lock;
259 };
260
261 static struct twl_client twl_modules[TWL_NUM_SLAVES];
262
263 /* mapping the module id to slave id and base address */
264 struct twl_mapping {
265 unsigned char sid; /* Slave ID */
266 unsigned char base; /* base address */
267 };
268 static struct twl_mapping *twl_map;
269
270 static struct twl_mapping twl4030_map[TWL4030_MODULE_LAST + 1] = {
271 /*
272 * NOTE: don't change this table without updating the
273 * <linux/i2c/twl.h> defines for TWL4030_MODULE_*
274 * so they continue to match the order in this table.
275 */
276
277 { 0, TWL4030_BASEADD_USB },
278
279 { 1, TWL4030_BASEADD_AUDIO_VOICE },
280 { 1, TWL4030_BASEADD_GPIO },
281 { 1, TWL4030_BASEADD_INTBR },
282 { 1, TWL4030_BASEADD_PIH },
283 { 1, TWL4030_BASEADD_TEST },
284
285 { 2, TWL4030_BASEADD_KEYPAD },
286 { 2, TWL4030_BASEADD_MADC },
287 { 2, TWL4030_BASEADD_INTERRUPTS },
288 { 2, TWL4030_BASEADD_LED },
289 { 2, TWL4030_BASEADD_MAIN_CHARGE },
290 { 2, TWL4030_BASEADD_PRECHARGE },
291 { 2, TWL4030_BASEADD_PWM0 },
292 { 2, TWL4030_BASEADD_PWM1 },
293 { 2, TWL4030_BASEADD_PWMA },
294 { 2, TWL4030_BASEADD_PWMB },
295 { 2, TWL5031_BASEADD_ACCESSORY },
296 { 2, TWL5031_BASEADD_INTERRUPTS },
297
298 { 3, TWL4030_BASEADD_BACKUP },
299 { 3, TWL4030_BASEADD_INT },
300 { 3, TWL4030_BASEADD_PM_MASTER },
301 { 3, TWL4030_BASEADD_PM_RECEIVER },
302 { 3, TWL4030_BASEADD_RTC },
303 { 3, TWL4030_BASEADD_SECURED_REG },
304 };
305
306 static struct twl_mapping twl6030_map[] = {
307 /*
308 * NOTE: don't change this table without updating the
309 * <linux/i2c/twl.h> defines for TWL4030_MODULE_*
310 * so they continue to match the order in this table.
311 */
312 { SUB_CHIP_ID1, TWL6030_BASEADD_USB },
313 { SUB_CHIP_ID_INVAL, TWL6030_BASEADD_AUDIO },
314 { SUB_CHIP_ID2, TWL6030_BASEADD_DIEID },
315 { SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
316 { SUB_CHIP_ID1, TWL6030_BASEADD_PIH },
317
318 { SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
319 { SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
320 { SUB_CHIP_ID1, TWL6030_BASEADD_GPADC_CTRL },
321 { SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
322 { SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
323
324 { SUB_CHIP_ID1, TWL6030_BASEADD_CHARGER },
325 { SUB_CHIP_ID1, TWL6030_BASEADD_GASGAUGE },
326 { SUB_CHIP_ID1, TWL6030_BASEADD_PWM },
327 { SUB_CHIP_ID0, TWL6030_BASEADD_ZERO },
328 { SUB_CHIP_ID1, TWL6030_BASEADD_ZERO },
329
330 { SUB_CHIP_ID2, TWL6030_BASEADD_ZERO },
331 { SUB_CHIP_ID2, TWL6030_BASEADD_ZERO },
332 { SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
333 { SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
334 { SUB_CHIP_ID2, TWL6030_BASEADD_RSV },
335 { SUB_CHIP_ID0, TWL6030_BASEADD_PM_MASTER },
336 { SUB_CHIP_ID0, TWL6030_BASEADD_PM_SLAVE_MISC },
337
338 { SUB_CHIP_ID0, TWL6030_BASEADD_RTC },
339 { SUB_CHIP_ID0, TWL6030_BASEADD_MEM },
340 { SUB_CHIP_ID1, TWL6025_BASEADD_CHARGER },
341 };
342
343 /*----------------------------------------------------------------------*/
344
345 /* Exported Functions */
346
347 /**
348 * twl_i2c_write - Writes a n bit register in TWL4030/TWL5030/TWL60X0
349 * @mod_no: module number
350 * @value: an array of num_bytes+1 containing data to write
351 * @reg: register address (just offset will do)
352 * @num_bytes: number of bytes to transfer
353 *
354 * IMPORTANT: for 'value' parameter: Allocate value num_bytes+1 and
355 * valid data starts at Offset 1.
356 *
357 * Returns the result of operation - 0 is success
358 */
359 int twl_i2c_write(u8 mod_no, u8 *value, u8 reg, unsigned num_bytes)
360 {
361 int ret;
362 int sid;
363 struct twl_client *twl;
364 struct i2c_msg *msg;
365
366 if (unlikely(mod_no > TWL_MODULE_LAST)) {
367 pr_err("%s: invalid module number %d\n", DRIVER_NAME, mod_no);
368 return -EPERM;
369 }
370 if (unlikely(!inuse)) {
371 pr_err("%s: not initialized\n", DRIVER_NAME);
372 return -EPERM;
373 }
374 sid = twl_map[mod_no].sid;
375 if (unlikely(sid == SUB_CHIP_ID_INVAL)) {
376 pr_err("%s: module %d is not part of the pmic\n",
377 DRIVER_NAME, mod_no);
378 return -EINVAL;
379 }
380 twl = &twl_modules[sid];
381
382 mutex_lock(&twl->xfer_lock);
383 /*
384 * [MSG1]: fill the register address data
385 * fill the data Tx buffer
386 */
387 msg = &twl->xfer_msg[0];
388 msg->addr = twl->address;
389 msg->len = num_bytes + 1;
390 msg->flags = 0;
391 msg->buf = value;
392 /* over write the first byte of buffer with the register address */
393 *value = twl_map[mod_no].base + reg;
394 ret = i2c_transfer(twl->client->adapter, twl->xfer_msg, 1);
395 mutex_unlock(&twl->xfer_lock);
396
397 /* i2c_transfer returns number of messages transferred */
398 if (ret != 1) {
399 pr_err("%s: i2c_write failed to transfer all messages\n",
400 DRIVER_NAME);
401 if (ret < 0)
402 return ret;
403 else
404 return -EIO;
405 } else {
406 return 0;
407 }
408 }
409 EXPORT_SYMBOL(twl_i2c_write);
410
411 /**
412 * twl_i2c_read - Reads a n bit register in TWL4030/TWL5030/TWL60X0
413 * @mod_no: module number
414 * @value: an array of num_bytes containing data to be read
415 * @reg: register address (just offset will do)
416 * @num_bytes: number of bytes to transfer
417 *
418 * Returns result of operation - num_bytes is success else failure.
419 */
420 int twl_i2c_read(u8 mod_no, u8 *value, u8 reg, unsigned num_bytes)
421 {
422 int ret;
423 u8 val;
424 int sid;
425 struct twl_client *twl;
426 struct i2c_msg *msg;
427
428 if (unlikely(mod_no > TWL_MODULE_LAST)) {
429 pr_err("%s: invalid module number %d\n", DRIVER_NAME, mod_no);
430 return -EPERM;
431 }
432 if (unlikely(!inuse)) {
433 pr_err("%s: not initialized\n", DRIVER_NAME);
434 return -EPERM;
435 }
436 sid = twl_map[mod_no].sid;
437 if (unlikely(sid == SUB_CHIP_ID_INVAL)) {
438 pr_err("%s: module %d is not part of the pmic\n",
439 DRIVER_NAME, mod_no);
440 return -EINVAL;
441 }
442 twl = &twl_modules[sid];
443
444 mutex_lock(&twl->xfer_lock);
445 /* [MSG1] fill the register address data */
446 msg = &twl->xfer_msg[0];
447 msg->addr = twl->address;
448 msg->len = 1;
449 msg->flags = 0; /* Read the register value */
450 val = twl_map[mod_no].base + reg;
451 msg->buf = &val;
452 /* [MSG2] fill the data rx buffer */
453 msg = &twl->xfer_msg[1];
454 msg->addr = twl->address;
455 msg->flags = I2C_M_RD; /* Read the register value */
456 msg->len = num_bytes; /* only n bytes */
457 msg->buf = value;
458 ret = i2c_transfer(twl->client->adapter, twl->xfer_msg, 2);
459 mutex_unlock(&twl->xfer_lock);
460
461 /* i2c_transfer returns number of messages transferred */
462 if (ret != 2) {
463 pr_err("%s: i2c_read failed to transfer all messages\n",
464 DRIVER_NAME);
465 if (ret < 0)
466 return ret;
467 else
468 return -EIO;
469 } else {
470 return 0;
471 }
472 }
473 EXPORT_SYMBOL(twl_i2c_read);
474
475 /**
476 * twl_i2c_write_u8 - Writes a 8 bit register in TWL4030/TWL5030/TWL60X0
477 * @mod_no: module number
478 * @value: the value to be written 8 bit
479 * @reg: register address (just offset will do)
480 *
481 * Returns result of operation - 0 is success
482 */
483 int twl_i2c_write_u8(u8 mod_no, u8 value, u8 reg)
484 {
485
486 /* 2 bytes offset 1 contains the data offset 0 is used by i2c_write */
487 u8 temp_buffer[2] = { 0 };
488 /* offset 1 contains the data */
489 temp_buffer[1] = value;
490 return twl_i2c_write(mod_no, temp_buffer, reg, 1);
491 }
492 EXPORT_SYMBOL(twl_i2c_write_u8);
493
494 /**
495 * twl_i2c_read_u8 - Reads a 8 bit register from TWL4030/TWL5030/TWL60X0
496 * @mod_no: module number
497 * @value: the value read 8 bit
498 * @reg: register address (just offset will do)
499 *
500 * Returns result of operation - 0 is success
501 */
502 int twl_i2c_read_u8(u8 mod_no, u8 *value, u8 reg)
503 {
504 return twl_i2c_read(mod_no, value, reg, 1);
505 }
506 EXPORT_SYMBOL(twl_i2c_read_u8);
507
508 /*----------------------------------------------------------------------*/
509
510 /**
511 * twl_read_idcode_register - API to read the IDCODE register.
512 *
513 * Unlocks the IDCODE register and read the 32 bit value.
514 */
515 static int twl_read_idcode_register(void)
516 {
517 int err;
518
519 err = twl_i2c_write_u8(TWL4030_MODULE_INTBR, TWL_EEPROM_R_UNLOCK,
520 REG_UNLOCK_TEST_REG);
521 if (err) {
522 pr_err("TWL4030 Unable to unlock IDCODE registers -%d\n", err);
523 goto fail;
524 }
525
526 err = twl_i2c_read(TWL4030_MODULE_INTBR, (u8 *)(&twl_idcode),
527 REG_IDCODE_7_0, 4);
528 if (err) {
529 pr_err("TWL4030: unable to read IDCODE -%d\n", err);
530 goto fail;
531 }
532
533 err = twl_i2c_write_u8(TWL4030_MODULE_INTBR, 0x0, REG_UNLOCK_TEST_REG);
534 if (err)
535 pr_err("TWL4030 Unable to relock IDCODE registers -%d\n", err);
536 fail:
537 return err;
538 }
539
540 /**
541 * twl_get_type - API to get TWL Si type.
542 *
543 * Api to get the TWL Si type from IDCODE value.
544 */
545 int twl_get_type(void)
546 {
547 return TWL_SIL_TYPE(twl_idcode);
548 }
549 EXPORT_SYMBOL_GPL(twl_get_type);
550
551 /**
552 * twl_get_version - API to get TWL Si version.
553 *
554 * Api to get the TWL Si version from IDCODE value.
555 */
556 int twl_get_version(void)
557 {
558 return TWL_SIL_REV(twl_idcode);
559 }
560 EXPORT_SYMBOL_GPL(twl_get_version);
561
562 static struct device *
563 add_numbered_child(unsigned chip, const char *name, int num,
564 void *pdata, unsigned pdata_len,
565 bool can_wakeup, int irq0, int irq1)
566 {
567 struct platform_device *pdev;
568 struct twl_client *twl = &twl_modules[chip];
569 int status;
570
571 pdev = platform_device_alloc(name, num);
572 if (!pdev) {
573 dev_dbg(&twl->client->dev, "can't alloc dev\n");
574 status = -ENOMEM;
575 goto err;
576 }
577
578 device_init_wakeup(&pdev->dev, can_wakeup);
579 pdev->dev.parent = &twl->client->dev;
580
581 if (pdata) {
582 status = platform_device_add_data(pdev, pdata, pdata_len);
583 if (status < 0) {
584 dev_dbg(&pdev->dev, "can't add platform_data\n");
585 goto err;
586 }
587 }
588
589 if (irq0) {
590 struct resource r[2] = {
591 { .start = irq0, .flags = IORESOURCE_IRQ, },
592 { .start = irq1, .flags = IORESOURCE_IRQ, },
593 };
594
595 status = platform_device_add_resources(pdev, r, irq1 ? 2 : 1);
596 if (status < 0) {
597 dev_dbg(&pdev->dev, "can't add irqs\n");
598 goto err;
599 }
600 }
601
602 status = platform_device_add(pdev);
603
604 err:
605 if (status < 0) {
606 platform_device_put(pdev);
607 dev_err(&twl->client->dev, "can't add %s dev\n", name);
608 return ERR_PTR(status);
609 }
610 return &pdev->dev;
611 }
612
613 static inline struct device *add_child(unsigned chip, const char *name,
614 void *pdata, unsigned pdata_len,
615 bool can_wakeup, int irq0, int irq1)
616 {
617 return add_numbered_child(chip, name, -1, pdata, pdata_len,
618 can_wakeup, irq0, irq1);
619 }
620
621 static struct device *
622 add_regulator_linked(int num, struct regulator_init_data *pdata,
623 struct regulator_consumer_supply *consumers,
624 unsigned num_consumers, unsigned long features)
625 {
626 unsigned sub_chip_id;
627 struct twl_regulator_driver_data drv_data;
628
629 /* regulator framework demands init_data ... */
630 if (!pdata)
631 return NULL;
632
633 if (consumers) {
634 pdata->consumer_supplies = consumers;
635 pdata->num_consumer_supplies = num_consumers;
636 }
637
638 if (pdata->driver_data) {
639 /* If we have existing drv_data, just add the flags */
640 struct twl_regulator_driver_data *tmp;
641 tmp = pdata->driver_data;
642 tmp->features |= features;
643 } else {
644 /* add new driver data struct, used only during init */
645 drv_data.features = features;
646 drv_data.set_voltage = NULL;
647 drv_data.get_voltage = NULL;
648 drv_data.data = NULL;
649 pdata->driver_data = &drv_data;
650 }
651
652 /* NOTE: we currently ignore regulator IRQs, e.g. for short circuits */
653 sub_chip_id = twl_map[TWL_MODULE_PM_MASTER].sid;
654 return add_numbered_child(sub_chip_id, "twl_reg", num,
655 pdata, sizeof(*pdata), false, 0, 0);
656 }
657
658 static struct device *
659 add_regulator(int num, struct regulator_init_data *pdata,
660 unsigned long features)
661 {
662 return add_regulator_linked(num, pdata, NULL, 0, features);
663 }
664
665 /*
666 * NOTE: We know the first 8 IRQs after pdata->base_irq are
667 * for the PIH, and the next are for the PWR_INT SIH, since
668 * that's how twl_init_irq() sets things up.
669 */
670
671 static int
672 add_children(struct twl4030_platform_data *pdata, unsigned irq_base,
673 unsigned long features)
674 {
675 struct device *child;
676 unsigned sub_chip_id;
677
678 if (twl_has_gpio() && pdata->gpio) {
679 child = add_child(SUB_CHIP_ID1, "twl4030_gpio",
680 pdata->gpio, sizeof(*pdata->gpio),
681 false, irq_base + GPIO_INTR_OFFSET, 0);
682 if (IS_ERR(child))
683 return PTR_ERR(child);
684 }
685
686 if (twl_has_keypad() && pdata->keypad) {
687 child = add_child(SUB_CHIP_ID2, "twl4030_keypad",
688 pdata->keypad, sizeof(*pdata->keypad),
689 true, irq_base + KEYPAD_INTR_OFFSET, 0);
690 if (IS_ERR(child))
691 return PTR_ERR(child);
692 }
693
694 if (twl_has_madc() && pdata->madc) {
695 child = add_child(2, "twl4030_madc",
696 pdata->madc, sizeof(*pdata->madc),
697 true, irq_base + MADC_INTR_OFFSET, 0);
698 if (IS_ERR(child))
699 return PTR_ERR(child);
700 }
701
702 if (twl_has_rtc()) {
703 /*
704 * REVISIT platform_data here currently might expose the
705 * "msecure" line ... but for now we just expect board
706 * setup to tell the chip "it's always ok to SET_TIME".
707 * Eventually, Linux might become more aware of such
708 * HW security concerns, and "least privilege".
709 */
710 sub_chip_id = twl_map[TWL_MODULE_RTC].sid;
711 child = add_child(sub_chip_id, "twl_rtc",
712 NULL, 0,
713 true, irq_base + RTC_INTR_OFFSET, 0);
714 if (IS_ERR(child))
715 return PTR_ERR(child);
716 }
717
718 if (twl_has_usb() && pdata->usb && twl_class_is_4030()) {
719
720 static struct regulator_consumer_supply usb1v5 = {
721 .supply = "usb1v5",
722 };
723 static struct regulator_consumer_supply usb1v8 = {
724 .supply = "usb1v8",
725 };
726 static struct regulator_consumer_supply usb3v1 = {
727 .supply = "usb3v1",
728 };
729
730 /* First add the regulators so that they can be used by transceiver */
731 if (twl_has_regulator()) {
732 /* this is a template that gets copied */
733 struct regulator_init_data usb_fixed = {
734 .constraints.valid_modes_mask =
735 REGULATOR_MODE_NORMAL
736 | REGULATOR_MODE_STANDBY,
737 .constraints.valid_ops_mask =
738 REGULATOR_CHANGE_MODE
739 | REGULATOR_CHANGE_STATUS,
740 };
741
742 child = add_regulator_linked(TWL4030_REG_VUSB1V5,
743 &usb_fixed, &usb1v5, 1,
744 features);
745 if (IS_ERR(child))
746 return PTR_ERR(child);
747
748 child = add_regulator_linked(TWL4030_REG_VUSB1V8,
749 &usb_fixed, &usb1v8, 1,
750 features);
751 if (IS_ERR(child))
752 return PTR_ERR(child);
753
754 child = add_regulator_linked(TWL4030_REG_VUSB3V1,
755 &usb_fixed, &usb3v1, 1,
756 features);
757 if (IS_ERR(child))
758 return PTR_ERR(child);
759
760 }
761
762 child = add_child(0, "twl4030_usb",
763 pdata->usb, sizeof(*pdata->usb),
764 true,
765 /* irq0 = USB_PRES, irq1 = USB */
766 irq_base + USB_PRES_INTR_OFFSET,
767 irq_base + USB_INTR_OFFSET);
768
769 if (IS_ERR(child))
770 return PTR_ERR(child);
771
772 /* we need to connect regulators to this transceiver */
773 if (twl_has_regulator() && child) {
774 usb1v5.dev_name = dev_name(child);
775 usb1v8.dev_name = dev_name(child);
776 usb3v1.dev_name = dev_name(child);
777 }
778 }
779 if (twl_has_usb() && pdata->usb && twl_class_is_6030()) {
780
781 static struct regulator_consumer_supply usb3v3;
782 int regulator;
783
784 if (twl_has_regulator()) {
785 /* this is a template that gets copied */
786 struct regulator_init_data usb_fixed = {
787 .constraints.valid_modes_mask =
788 REGULATOR_MODE_NORMAL
789 | REGULATOR_MODE_STANDBY,
790 .constraints.valid_ops_mask =
791 REGULATOR_CHANGE_MODE
792 | REGULATOR_CHANGE_STATUS,
793 };
794
795 if (features & TWL6025_SUBCLASS) {
796 usb3v3.supply = "ldousb";
797 regulator = TWL6025_REG_LDOUSB;
798 } else {
799 usb3v3.supply = "vusb";
800 regulator = TWL6030_REG_VUSB;
801 }
802 child = add_regulator_linked(regulator, &usb_fixed,
803 &usb3v3, 1,
804 features);
805 if (IS_ERR(child))
806 return PTR_ERR(child);
807 }
808
809 pdata->usb->features = features;
810
811 child = add_child(0, "twl6030_usb",
812 pdata->usb, sizeof(*pdata->usb),
813 true,
814 /* irq1 = VBUS_PRES, irq0 = USB ID */
815 irq_base + USBOTG_INTR_OFFSET,
816 irq_base + USB_PRES_INTR_OFFSET);
817
818 if (IS_ERR(child))
819 return PTR_ERR(child);
820 /* we need to connect regulators to this transceiver */
821 if (twl_has_regulator() && child)
822 usb3v3.dev_name = dev_name(child);
823 } else if (twl_has_regulator() && twl_class_is_6030()) {
824 if (features & TWL6025_SUBCLASS)
825 child = add_regulator(TWL6025_REG_LDOUSB,
826 pdata->ldousb, features);
827 else
828 child = add_regulator(TWL6030_REG_VUSB,
829 pdata->vusb, features);
830
831 if (IS_ERR(child))
832 return PTR_ERR(child);
833 }
834
835 if (twl_has_watchdog() && twl_class_is_4030()) {
836 child = add_child(0, "twl4030_wdt", NULL, 0, false, 0, 0);
837 if (IS_ERR(child))
838 return PTR_ERR(child);
839 }
840
841 if (twl_has_pwrbutton() && twl_class_is_4030()) {
842 child = add_child(1, "twl4030_pwrbutton",
843 NULL, 0, true, irq_base + 8 + 0, 0);
844 if (IS_ERR(child))
845 return PTR_ERR(child);
846 }
847
848 if (twl_has_codec() && pdata->audio && twl_class_is_4030()) {
849 sub_chip_id = twl_map[TWL_MODULE_AUDIO_VOICE].sid;
850 child = add_child(sub_chip_id, "twl4030-audio",
851 pdata->audio, sizeof(*pdata->audio),
852 false, 0, 0);
853 if (IS_ERR(child))
854 return PTR_ERR(child);
855 }
856
857 /* twl4030 regulators */
858 if (twl_has_regulator() && twl_class_is_4030()) {
859 child = add_regulator(TWL4030_REG_VPLL1, pdata->vpll1,
860 features);
861 if (IS_ERR(child))
862 return PTR_ERR(child);
863
864 child = add_regulator(TWL4030_REG_VIO, pdata->vio,
865 features);
866 if (IS_ERR(child))
867 return PTR_ERR(child);
868
869 child = add_regulator(TWL4030_REG_VDD1, pdata->vdd1,
870 features);
871 if (IS_ERR(child))
872 return PTR_ERR(child);
873
874 child = add_regulator(TWL4030_REG_VDD2, pdata->vdd2,
875 features);
876 if (IS_ERR(child))
877 return PTR_ERR(child);
878
879 child = add_regulator(TWL4030_REG_VMMC1, pdata->vmmc1,
880 features);
881 if (IS_ERR(child))
882 return PTR_ERR(child);
883
884 child = add_regulator(TWL4030_REG_VDAC, pdata->vdac,
885 features);
886 if (IS_ERR(child))
887 return PTR_ERR(child);
888
889 child = add_regulator((features & TWL4030_VAUX2)
890 ? TWL4030_REG_VAUX2_4030
891 : TWL4030_REG_VAUX2,
892 pdata->vaux2, features);
893 if (IS_ERR(child))
894 return PTR_ERR(child);
895
896 child = add_regulator(TWL4030_REG_VINTANA1, pdata->vintana1,
897 features);
898 if (IS_ERR(child))
899 return PTR_ERR(child);
900
901 child = add_regulator(TWL4030_REG_VINTANA2, pdata->vintana2,
902 features);
903 if (IS_ERR(child))
904 return PTR_ERR(child);
905
906 child = add_regulator(TWL4030_REG_VINTDIG, pdata->vintdig,
907 features);
908 if (IS_ERR(child))
909 return PTR_ERR(child);
910 }
911
912 /* maybe add LDOs that are omitted on cost-reduced parts */
913 if (twl_has_regulator() && !(features & TPS_SUBSET)
914 && twl_class_is_4030()) {
915 child = add_regulator(TWL4030_REG_VPLL2, pdata->vpll2,
916 features);
917 if (IS_ERR(child))
918 return PTR_ERR(child);
919
920 child = add_regulator(TWL4030_REG_VMMC2, pdata->vmmc2,
921 features);
922 if (IS_ERR(child))
923 return PTR_ERR(child);
924
925 child = add_regulator(TWL4030_REG_VSIM, pdata->vsim,
926 features);
927 if (IS_ERR(child))
928 return PTR_ERR(child);
929
930 child = add_regulator(TWL4030_REG_VAUX1, pdata->vaux1,
931 features);
932 if (IS_ERR(child))
933 return PTR_ERR(child);
934
935 child = add_regulator(TWL4030_REG_VAUX3, pdata->vaux3,
936 features);
937 if (IS_ERR(child))
938 return PTR_ERR(child);
939
940 child = add_regulator(TWL4030_REG_VAUX4, pdata->vaux4,
941 features);
942 if (IS_ERR(child))
943 return PTR_ERR(child);
944 }
945
946 /* twl6030 regulators */
947 if (twl_has_regulator() && twl_class_is_6030() &&
948 !(features & TWL6025_SUBCLASS)) {
949 child = add_regulator(TWL6030_REG_VDD1, pdata->vdd1,
950 features);
951 if (IS_ERR(child))
952 return PTR_ERR(child);
953
954 child = add_regulator(TWL6030_REG_VDD2, pdata->vdd2,
955 features);
956 if (IS_ERR(child))
957 return PTR_ERR(child);
958
959 child = add_regulator(TWL6030_REG_VDD3, pdata->vdd3,
960 features);
961 if (IS_ERR(child))
962 return PTR_ERR(child);
963
964 child = add_regulator(TWL6030_REG_V1V8, pdata->v1v8,
965 features);
966 if (IS_ERR(child))
967 return PTR_ERR(child);
968
969 child = add_regulator(TWL6030_REG_V2V1, pdata->v2v1,
970 features);
971 if (IS_ERR(child))
972 return PTR_ERR(child);
973
974 child = add_regulator(TWL6030_REG_VMMC, pdata->vmmc,
975 features);
976 if (IS_ERR(child))
977 return PTR_ERR(child);
978
979 child = add_regulator(TWL6030_REG_VPP, pdata->vpp,
980 features);
981 if (IS_ERR(child))
982 return PTR_ERR(child);
983
984 child = add_regulator(TWL6030_REG_VUSIM, pdata->vusim,
985 features);
986 if (IS_ERR(child))
987 return PTR_ERR(child);
988
989 child = add_regulator(TWL6030_REG_VCXIO, pdata->vcxio,
990 features);
991 if (IS_ERR(child))
992 return PTR_ERR(child);
993
994 child = add_regulator(TWL6030_REG_VDAC, pdata->vdac,
995 features);
996 if (IS_ERR(child))
997 return PTR_ERR(child);
998
999 child = add_regulator(TWL6030_REG_VAUX1_6030, pdata->vaux1,
1000 features);
1001 if (IS_ERR(child))
1002 return PTR_ERR(child);
1003
1004 child = add_regulator(TWL6030_REG_VAUX2_6030, pdata->vaux2,
1005 features);
1006 if (IS_ERR(child))
1007 return PTR_ERR(child);
1008
1009 child = add_regulator(TWL6030_REG_VAUX3_6030, pdata->vaux3,
1010 features);
1011 if (IS_ERR(child))
1012 return PTR_ERR(child);
1013
1014 child = add_regulator(TWL6030_REG_CLK32KG, pdata->clk32kg,
1015 features);
1016 if (IS_ERR(child))
1017 return PTR_ERR(child);
1018 }
1019
1020 /* 6030 and 6025 share this regulator */
1021 if (twl_has_regulator() && twl_class_is_6030()) {
1022 child = add_regulator(TWL6030_REG_VANA, pdata->vana,
1023 features);
1024 if (IS_ERR(child))
1025 return PTR_ERR(child);
1026 }
1027
1028 /* twl6025 regulators */
1029 if (twl_has_regulator() && twl_class_is_6030() &&
1030 (features & TWL6025_SUBCLASS)) {
1031 child = add_regulator(TWL6025_REG_LDO5, pdata->ldo5,
1032 features);
1033 if (IS_ERR(child))
1034 return PTR_ERR(child);
1035
1036 child = add_regulator(TWL6025_REG_LDO1, pdata->ldo1,
1037 features);
1038 if (IS_ERR(child))
1039 return PTR_ERR(child);
1040
1041 child = add_regulator(TWL6025_REG_LDO7, pdata->ldo7,
1042 features);
1043 if (IS_ERR(child))
1044 return PTR_ERR(child);
1045
1046 child = add_regulator(TWL6025_REG_LDO6, pdata->ldo6,
1047 features);
1048 if (IS_ERR(child))
1049 return PTR_ERR(child);
1050
1051 child = add_regulator(TWL6025_REG_LDOLN, pdata->ldoln,
1052 features);
1053 if (IS_ERR(child))
1054 return PTR_ERR(child);
1055
1056 child = add_regulator(TWL6025_REG_LDO2, pdata->ldo2,
1057 features);
1058 if (IS_ERR(child))
1059 return PTR_ERR(child);
1060
1061 child = add_regulator(TWL6025_REG_LDO4, pdata->ldo4,
1062 features);
1063 if (IS_ERR(child))
1064 return PTR_ERR(child);
1065
1066 child = add_regulator(TWL6025_REG_LDO3, pdata->ldo3,
1067 features);
1068 if (IS_ERR(child))
1069 return PTR_ERR(child);
1070
1071 child = add_regulator(TWL6025_REG_SMPS3, pdata->smps3,
1072 features);
1073 if (IS_ERR(child))
1074 return PTR_ERR(child);
1075
1076 child = add_regulator(TWL6025_REG_SMPS4, pdata->smps4,
1077 features);
1078 if (IS_ERR(child))
1079 return PTR_ERR(child);
1080
1081 child = add_regulator(TWL6025_REG_VIO, pdata->vio6025,
1082 features);
1083 if (IS_ERR(child))
1084 return PTR_ERR(child);
1085
1086 }
1087
1088 if (twl_has_bci() && pdata->bci &&
1089 !(features & (TPS_SUBSET | TWL5031))) {
1090 child = add_child(3, "twl4030_bci",
1091 pdata->bci, sizeof(*pdata->bci), false,
1092 /* irq0 = CHG_PRES, irq1 = BCI */
1093 irq_base + BCI_PRES_INTR_OFFSET,
1094 irq_base + BCI_INTR_OFFSET);
1095 if (IS_ERR(child))
1096 return PTR_ERR(child);
1097 }
1098
1099 return 0;
1100 }
1101
1102 /*----------------------------------------------------------------------*/
1103
1104 /*
1105 * These three functions initialize the on-chip clock framework,
1106 * letting it generate the right frequencies for USB, MADC, and
1107 * other purposes.
1108 */
1109 static inline int __init protect_pm_master(void)
1110 {
1111 int e = 0;
1112
1113 e = twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER, 0,
1114 TWL4030_PM_MASTER_PROTECT_KEY);
1115 return e;
1116 }
1117
1118 static inline int __init unprotect_pm_master(void)
1119 {
1120 int e = 0;
1121
1122 e |= twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER,
1123 TWL4030_PM_MASTER_KEY_CFG1,
1124 TWL4030_PM_MASTER_PROTECT_KEY);
1125 e |= twl_i2c_write_u8(TWL4030_MODULE_PM_MASTER,
1126 TWL4030_PM_MASTER_KEY_CFG2,
1127 TWL4030_PM_MASTER_PROTECT_KEY);
1128
1129 return e;
1130 }
1131
1132 static void clocks_init(struct device *dev,
1133 struct twl4030_clock_init_data *clock)
1134 {
1135 int e = 0;
1136 struct clk *osc;
1137 u32 rate;
1138 u8 ctrl = HFCLK_FREQ_26_MHZ;
1139
1140 #if defined(CONFIG_ARCH_OMAP2) || defined(CONFIG_ARCH_OMAP3)
1141 if (cpu_is_omap2430())
1142 osc = clk_get(dev, "osc_ck");
1143 else
1144 osc = clk_get(dev, "osc_sys_ck");
1145
1146 if (IS_ERR(osc)) {
1147 printk(KERN_WARNING "Skipping twl internal clock init and "
1148 "using bootloader value (unknown osc rate)\n");
1149 return;
1150 }
1151
1152 rate = clk_get_rate(osc);
1153 clk_put(osc);
1154
1155 #else
1156 /* REVISIT for non-OMAP systems, pass the clock rate from
1157 * board init code, using platform_data.
1158 */
1159 osc = ERR_PTR(-EIO);
1160
1161 printk(KERN_WARNING "Skipping twl internal clock init and "
1162 "using bootloader value (unknown osc rate)\n");
1163
1164 return;
1165 #endif
1166
1167 switch (rate) {
1168 case 19200000:
1169 ctrl = HFCLK_FREQ_19p2_MHZ;
1170 break;
1171 case 26000000:
1172 ctrl = HFCLK_FREQ_26_MHZ;
1173 break;
1174 case 38400000:
1175 ctrl = HFCLK_FREQ_38p4_MHZ;
1176 break;
1177 }
1178
1179 ctrl |= HIGH_PERF_SQ;
1180 if (clock && clock->ck32k_lowpwr_enable)
1181 ctrl |= CK32K_LOWPWR_EN;
1182
1183 e |= unprotect_pm_master();
1184 /* effect->MADC+USB ck en */
1185 e |= twl_i2c_write_u8(TWL_MODULE_PM_MASTER, ctrl, R_CFG_BOOT);
1186 e |= protect_pm_master();
1187
1188 if (e < 0)
1189 pr_err("%s: clock init err [%d]\n", DRIVER_NAME, e);
1190 }
1191
1192 /*----------------------------------------------------------------------*/
1193
1194
1195 static int twl_remove(struct i2c_client *client)
1196 {
1197 unsigned i, num_slaves;
1198 int status;
1199
1200 if (twl_class_is_4030()) {
1201 status = twl4030_exit_irq();
1202 num_slaves = TWL_NUM_SLAVES;
1203 } else {
1204 status = twl6030_exit_irq();
1205 num_slaves = TWL_NUM_SLAVES - 1;
1206 }
1207
1208 if (status < 0)
1209 return status;
1210
1211 for (i = 0; i < num_slaves; i++) {
1212 struct twl_client *twl = &twl_modules[i];
1213
1214 if (twl->client && twl->client != client)
1215 i2c_unregister_device(twl->client);
1216 twl_modules[i].client = NULL;
1217 }
1218 inuse = false;
1219 return 0;
1220 }
1221
1222 /* NOTE: This driver only handles a single twl4030/tps659x0 chip */
1223 static int __devinit
1224 twl_probe(struct i2c_client *client, const struct i2c_device_id *id)
1225 {
1226 struct twl4030_platform_data *pdata = client->dev.platform_data;
1227 struct device_node *node = client->dev.of_node;
1228 int irq_base = 0;
1229 int status;
1230 unsigned i, num_slaves;
1231
1232 if (node && !pdata) {
1233 /*
1234 * XXX: Temporary pdata until the information is correctly
1235 * retrieved by every TWL modules from DT.
1236 */
1237 pdata = devm_kzalloc(&client->dev,
1238 sizeof(struct twl4030_platform_data),
1239 GFP_KERNEL);
1240 if (!pdata)
1241 return -ENOMEM;
1242 }
1243
1244 if (!pdata) {
1245 dev_dbg(&client->dev, "no platform data?\n");
1246 return -EINVAL;
1247 }
1248
1249 if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C) == 0) {
1250 dev_dbg(&client->dev, "can't talk I2C?\n");
1251 return -EIO;
1252 }
1253
1254 if (inuse) {
1255 dev_dbg(&client->dev, "driver is already in use\n");
1256 return -EBUSY;
1257 }
1258
1259 if ((id->driver_data) & TWL6030_CLASS) {
1260 twl_id = TWL6030_CLASS_ID;
1261 twl_map = &twl6030_map[0];
1262 num_slaves = TWL_NUM_SLAVES - 1;
1263 } else {
1264 twl_id = TWL4030_CLASS_ID;
1265 twl_map = &twl4030_map[0];
1266 num_slaves = TWL_NUM_SLAVES;
1267 }
1268
1269 for (i = 0; i < num_slaves; i++) {
1270 struct twl_client *twl = &twl_modules[i];
1271
1272 twl->address = client->addr + i;
1273 if (i == 0) {
1274 twl->client = client;
1275 } else {
1276 twl->client = i2c_new_dummy(client->adapter,
1277 twl->address);
1278 if (!twl->client) {
1279 dev_err(&client->dev,
1280 "can't attach client %d\n", i);
1281 status = -ENOMEM;
1282 goto fail;
1283 }
1284 }
1285 mutex_init(&twl->xfer_lock);
1286 }
1287
1288 inuse = true;
1289
1290 /* setup clock framework */
1291 clocks_init(&client->dev, pdata->clock);
1292
1293 /* read TWL IDCODE Register */
1294 if (twl_id == TWL4030_CLASS_ID) {
1295 status = twl_read_idcode_register();
1296 WARN(status < 0, "Error: reading twl_idcode register value\n");
1297 }
1298
1299 /* load power event scripts */
1300 if (twl_has_power() && pdata->power)
1301 twl4030_power_init(pdata->power);
1302
1303 /* Maybe init the T2 Interrupt subsystem */
1304 if (client->irq) {
1305 if (twl_class_is_4030()) {
1306 twl4030_init_chip_irq(id->name);
1307 irq_base = twl4030_init_irq(&client->dev, client->irq);
1308 } else {
1309 irq_base = twl6030_init_irq(&client->dev, client->irq);
1310 }
1311
1312 if (irq_base < 0) {
1313 status = irq_base;
1314 goto fail;
1315 }
1316 }
1317
1318 /*
1319 * Disable TWL4030/TWL5030 I2C Pull-up on I2C1 and I2C4(SR) interface.
1320 * Program I2C_SCL_CTRL_PU(bit 0)=0, I2C_SDA_CTRL_PU (bit 2)=0,
1321 * SR_I2C_SCL_CTRL_PU(bit 4)=0 and SR_I2C_SDA_CTRL_PU(bit 6)=0.
1322 */
1323 if (twl_class_is_4030()) {
1324 u8 temp;
1325
1326 twl_i2c_read_u8(TWL4030_MODULE_INTBR, &temp, REG_GPPUPDCTR1);
1327 temp &= ~(SR_I2C_SDA_CTRL_PU | SR_I2C_SCL_CTRL_PU | \
1328 I2C_SDA_CTRL_PU | I2C_SCL_CTRL_PU);
1329 twl_i2c_write_u8(TWL4030_MODULE_INTBR, temp, REG_GPPUPDCTR1);
1330 }
1331
1332 status = -ENODEV;
1333 if (node)
1334 status = of_platform_populate(node, NULL, NULL, &client->dev);
1335 if (status)
1336 status = add_children(pdata, irq_base, id->driver_data);
1337
1338 fail:
1339 if (status < 0)
1340 twl_remove(client);
1341
1342 return status;
1343 }
1344
1345 static const struct i2c_device_id twl_ids[] = {
1346 { "twl4030", TWL4030_VAUX2 }, /* "Triton 2" */
1347 { "twl5030", 0 }, /* T2 updated */
1348 { "twl5031", TWL5031 }, /* TWL5030 updated */
1349 { "tps65950", 0 }, /* catalog version of twl5030 */
1350 { "tps65930", TPS_SUBSET }, /* fewer LDOs and DACs; no charger */
1351 { "tps65920", TPS_SUBSET }, /* fewer LDOs; no codec or charger */
1352 { "tps65921", TPS_SUBSET }, /* fewer LDOs; no codec, no LED
1353 and vibrator. Charger in USB module*/
1354 { "twl6030", TWL6030_CLASS }, /* "Phoenix power chip" */
1355 { "twl6025", TWL6030_CLASS | TWL6025_SUBCLASS }, /* "Phoenix lite" */
1356 { /* end of list */ },
1357 };
1358 MODULE_DEVICE_TABLE(i2c, twl_ids);
1359
1360 /* One Client Driver , 4 Clients */
1361 static struct i2c_driver twl_driver = {
1362 .driver.name = DRIVER_NAME,
1363 .id_table = twl_ids,
1364 .probe = twl_probe,
1365 .remove = twl_remove,
1366 };
1367
1368 static int __init twl_init(void)
1369 {
1370 return i2c_add_driver(&twl_driver);
1371 }
1372 subsys_initcall(twl_init);
1373
1374 static void __exit twl_exit(void)
1375 {
1376 i2c_del_driver(&twl_driver);
1377 }
1378 module_exit(twl_exit);
1379
1380 MODULE_AUTHOR("Texas Instruments, Inc.");
1381 MODULE_DESCRIPTION("I2C Core interface for TWL");
1382 MODULE_LICENSE("GPL");
Ubuntu Artful kernel mirror