1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31#include <linux/init.h>
32#include <linux/mutex.h>
33#include <linux/module.h>
34#include <linux/platform_device.h>
35#include <linux/regmap.h>
36#include <linux/clk.h>
37#include <linux/err.h>
38#include <linux/device.h>
39#include <linux/of.h>
40#include <linux/of_irq.h>
41#include <linux/of_platform.h>
42#include <linux/irq.h>
43#include <linux/irqdomain.h>
44
45#include <linux/regulator/machine.h>
46
47#include <linux/i2c.h>
48#include <linux/i2c/twl.h>
49
50
51#include <linux/mfd/twl4030-audio.h>
52
53#include "twl-core.h"
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68#define DRIVER_NAME "twl"
69
70
71
72
73
74
75#define TWL4030_BASEADD_USB 0x0000
76
77
78#define TWL4030_BASEADD_AUDIO_VOICE 0x0000
79#define TWL4030_BASEADD_GPIO 0x0098
80#define TWL4030_BASEADD_INTBR 0x0085
81#define TWL4030_BASEADD_PIH 0x0080
82#define TWL4030_BASEADD_TEST 0x004C
83
84
85#define TWL4030_BASEADD_INTERRUPTS 0x00B9
86#define TWL4030_BASEADD_LED 0x00EE
87#define TWL4030_BASEADD_MADC 0x0000
88#define TWL4030_BASEADD_MAIN_CHARGE 0x0074
89#define TWL4030_BASEADD_PRECHARGE 0x00AA
90#define TWL4030_BASEADD_PWM 0x00F8
91#define TWL4030_BASEADD_KEYPAD 0x00D2
92
93#define TWL5031_BASEADD_ACCESSORY 0x0074
94#define TWL5031_BASEADD_INTERRUPTS 0x00B9
95
96
97
98#define TWL4030_BASEADD_BACKUP 0x0014
99#define TWL4030_BASEADD_INT 0x002E
100#define TWL4030_BASEADD_PM_MASTER 0x0036
101#define TWL4030_BASEADD_PM_RECEIVER 0x005B
102#define TWL4030_BASEADD_RTC 0x001C
103#define TWL4030_BASEADD_SECURED_REG 0x0000
104
105
106
107
108
109#define TWL6030_BASEADD_RTC 0x0000
110#define TWL6030_BASEADD_SECURED_REG 0x0017
111#define TWL6030_BASEADD_PM_MASTER 0x001F
112#define TWL6030_BASEADD_PM_SLAVE_MISC 0x0030
113#define TWL6030_BASEADD_PM_MISC 0x00E2
114#define TWL6030_BASEADD_PM_PUPD 0x00F0
115
116
117#define TWL6030_BASEADD_USB 0x0000
118#define TWL6030_BASEADD_GPADC_CTRL 0x002E
119#define TWL6030_BASEADD_AUX 0x0090
120#define TWL6030_BASEADD_PWM 0x00BA
121#define TWL6030_BASEADD_GASGAUGE 0x00C0
122#define TWL6030_BASEADD_PIH 0x00D0
123#define TWL6030_BASEADD_CHARGER 0x00E0
124#define TWL6032_BASEADD_CHARGER 0x00DA
125#define TWL6030_BASEADD_LED 0x00F4
126
127
128#define TWL6030_BASEADD_DIEID 0x00C0
129
130
131#define TWL6030_BASEADD_AUDIO 0x0000
132#define TWL6030_BASEADD_RSV 0x0000
133#define TWL6030_BASEADD_ZERO 0x0000
134
135
136#define R_CFG_BOOT 0x05
137
138
139#define HFCLK_FREQ_19p2_MHZ (1 << 0)
140#define HFCLK_FREQ_26_MHZ (2 << 0)
141#define HFCLK_FREQ_38p4_MHZ (3 << 0)
142#define HIGH_PERF_SQ (1 << 3)
143#define CK32K_LOWPWR_EN (1 << 7)
144
145
146
147
148struct twl_client {
149 struct i2c_client *client;
150 struct regmap *regmap;
151};
152
153
154struct twl_mapping {
155 unsigned char sid;
156 unsigned char base;
157};
158
159struct twl_private {
160 bool ready;
161 u32 twl_idcode;
162 unsigned int twl_id;
163
164 struct twl_mapping *twl_map;
165 struct twl_client *twl_modules;
166};
167
168static struct twl_private *twl_priv;
169
170static struct twl_mapping twl4030_map[] = {
171
172
173
174
175
176
177
178 { 0, TWL4030_BASEADD_USB },
179 { 1, TWL4030_BASEADD_PIH },
180 { 2, TWL4030_BASEADD_MAIN_CHARGE },
181 { 3, TWL4030_BASEADD_PM_MASTER },
182 { 3, TWL4030_BASEADD_PM_RECEIVER },
183
184 { 3, TWL4030_BASEADD_RTC },
185 { 2, TWL4030_BASEADD_PWM },
186 { 2, TWL4030_BASEADD_LED },
187 { 3, TWL4030_BASEADD_SECURED_REG },
188
189
190 { 1, TWL4030_BASEADD_AUDIO_VOICE },
191 { 1, TWL4030_BASEADD_GPIO },
192 { 1, TWL4030_BASEADD_INTBR },
193 { 1, TWL4030_BASEADD_TEST },
194 { 2, TWL4030_BASEADD_KEYPAD },
195
196 { 2, TWL4030_BASEADD_MADC },
197 { 2, TWL4030_BASEADD_INTERRUPTS },
198 { 2, TWL4030_BASEADD_PRECHARGE },
199 { 3, TWL4030_BASEADD_BACKUP },
200 { 3, TWL4030_BASEADD_INT },
201
202 { 2, TWL5031_BASEADD_ACCESSORY },
203 { 2, TWL5031_BASEADD_INTERRUPTS },
204};
205
206static struct reg_default twl4030_49_defaults[] = {
207
208 { 0x01, 0x00},
209 { 0x02, 0x00},
210
211 { 0x04, 0x00},
212 { 0x05, 0x00},
213 { 0x06, 0x00},
214 { 0x07, 0x00},
215 { 0x08, 0x00},
216 { 0x09, 0x00},
217 { 0x0a, 0x0f},
218 { 0x0b, 0x0f},
219 { 0x0c, 0x0f},
220 { 0x0d, 0x0f},
221 { 0x0e, 0x00},
222 { 0x0f, 0x00},
223 { 0x10, 0x3f},
224 { 0x11, 0x3f},
225 { 0x12, 0x3f},
226 { 0x13, 0x3f},
227 { 0x14, 0x25},
228 { 0x15, 0x00},
229 { 0x16, 0x00},
230 { 0x17, 0x00},
231 { 0x18, 0x00},
232 { 0x19, 0x32},
233 { 0x1a, 0x32},
234 { 0x1b, 0x32},
235 { 0x1c, 0x32},
236 { 0x1d, 0x00},
237 { 0x1e, 0x00},
238 { 0x1f, 0x55},
239 { 0x20, 0x00},
240 { 0x21, 0x00},
241 { 0x22, 0x00},
242 { 0x23, 0x00},
243 { 0x24, 0x00},
244 { 0x25, 0x00},
245 { 0x26, 0x00},
246 { 0x27, 0x00},
247 { 0x28, 0x00},
248 { 0x29, 0x00},
249 { 0x2a, 0x00},
250 { 0x2b, 0x05},
251 { 0x2c, 0x00},
252 { 0x2d, 0x00},
253 { 0x2e, 0x00},
254 { 0x2f, 0x00},
255 { 0x30, 0x13},
256 { 0x31, 0x00},
257 { 0x32, 0x00},
258 { 0x33, 0x00},
259 { 0x34, 0x00},
260 { 0x35, 0x79},
261 { 0x36, 0x11},
262 { 0x37, 0x00},
263 { 0x38, 0x00},
264 { 0x39, 0x00},
265 { 0x3a, 0x06},
266 { 0x3b, 0x00},
267 { 0x3c, 0x44},
268 { 0x3d, 0x69},
269 { 0x3e, 0x00},
270 { 0x3f, 0x00},
271
272 { 0x43, 0x00},
273 { 0x44, 0x32},
274 { 0x45, 0x00},
275 { 0x46, 0x00},
276 { 0x47, 0x00},
277 { 0x48, 0x00},
278 { 0x49, 0x00},
279
280};
281
282static bool twl4030_49_nop_reg(struct device *dev, unsigned int reg)
283{
284 switch (reg) {
285 case 0:
286 case 3:
287 case 40:
288 case 41:
289 case 42:
290 return false;
291 default:
292 return true;
293 }
294}
295
296static const struct regmap_range twl4030_49_volatile_ranges[] = {
297 regmap_reg_range(TWL4030_BASEADD_TEST, 0xff),
298};
299
300static const struct regmap_access_table twl4030_49_volatile_table = {
301 .yes_ranges = twl4030_49_volatile_ranges,
302 .n_yes_ranges = ARRAY_SIZE(twl4030_49_volatile_ranges),
303};
304
305static struct regmap_config twl4030_regmap_config[4] = {
306 {
307
308 .reg_bits = 8,
309 .val_bits = 8,
310 .max_register = 0xff,
311 },
312 {
313
314 .reg_bits = 8,
315 .val_bits = 8,
316 .max_register = 0xff,
317
318 .readable_reg = twl4030_49_nop_reg,
319 .writeable_reg = twl4030_49_nop_reg,
320
321 .volatile_table = &twl4030_49_volatile_table,
322
323 .reg_defaults = twl4030_49_defaults,
324 .num_reg_defaults = ARRAY_SIZE(twl4030_49_defaults),
325 .cache_type = REGCACHE_RBTREE,
326 },
327 {
328
329 .reg_bits = 8,
330 .val_bits = 8,
331 .max_register = 0xff,
332 },
333 {
334
335 .reg_bits = 8,
336 .val_bits = 8,
337 .max_register = 0xff,
338 },
339};
340
341static struct twl_mapping twl6030_map[] = {
342
343
344
345
346
347
348
349 { 1, TWL6030_BASEADD_USB },
350 { 1, TWL6030_BASEADD_PIH },
351 { 1, TWL6030_BASEADD_CHARGER },
352 { 0, TWL6030_BASEADD_PM_MASTER },
353 { 0, TWL6030_BASEADD_PM_SLAVE_MISC },
354
355 { 0, TWL6030_BASEADD_RTC },
356 { 1, TWL6030_BASEADD_PWM },
357 { 1, TWL6030_BASEADD_LED },
358 { 0, TWL6030_BASEADD_SECURED_REG },
359
360
361 { 0, TWL6030_BASEADD_ZERO },
362 { 1, TWL6030_BASEADD_ZERO },
363 { 2, TWL6030_BASEADD_ZERO },
364 { 1, TWL6030_BASEADD_GPADC_CTRL },
365 { 1, TWL6030_BASEADD_GASGAUGE },
366};
367
368static struct regmap_config twl6030_regmap_config[3] = {
369 {
370
371 .reg_bits = 8,
372 .val_bits = 8,
373 .max_register = 0xff,
374 },
375 {
376
377 .reg_bits = 8,
378 .val_bits = 8,
379 .max_register = 0xff,
380 },
381 {
382
383 .reg_bits = 8,
384 .val_bits = 8,
385 .max_register = 0xff,
386 },
387};
388
389
390
391static inline int twl_get_num_slaves(void)
392{
393 if (twl_class_is_4030())
394 return 4;
395 else
396 return 3;
397}
398
399static inline int twl_get_last_module(void)
400{
401 if (twl_class_is_4030())
402 return TWL4030_MODULE_LAST;
403 else
404 return TWL6030_MODULE_LAST;
405}
406
407
408
409unsigned int twl_rev(void)
410{
411 return twl_priv ? twl_priv->twl_id : 0;
412}
413EXPORT_SYMBOL(twl_rev);
414
415
416
417
418
419
420
421static struct regmap *twl_get_regmap(u8 mod_no)
422{
423 int sid;
424 struct twl_client *twl;
425
426 if (unlikely(!twl_priv || !twl_priv->ready)) {
427 pr_err("%s: not initialized\n", DRIVER_NAME);
428 return NULL;
429 }
430 if (unlikely(mod_no >= twl_get_last_module())) {
431 pr_err("%s: invalid module number %d\n", DRIVER_NAME, mod_no);
432 return NULL;
433 }
434
435 sid = twl_priv->twl_map[mod_no].sid;
436 twl = &twl_priv->twl_modules[sid];
437
438 return twl->regmap;
439}
440
441
442
443
444
445
446
447
448
449
450int twl_i2c_write(u8 mod_no, u8 *value, u8 reg, unsigned num_bytes)
451{
452 struct regmap *regmap = twl_get_regmap(mod_no);
453 int ret;
454
455 if (!regmap)
456 return -EPERM;
457
458 ret = regmap_bulk_write(regmap, twl_priv->twl_map[mod_no].base + reg,
459 value, num_bytes);
460
461 if (ret)
462 pr_err("%s: Write failed (mod %d, reg 0x%02x count %d)\n",
463 DRIVER_NAME, mod_no, reg, num_bytes);
464
465 return ret;
466}
467EXPORT_SYMBOL(twl_i2c_write);
468
469
470
471
472
473
474
475
476
477
478int twl_i2c_read(u8 mod_no, u8 *value, u8 reg, unsigned num_bytes)
479{
480 struct regmap *regmap = twl_get_regmap(mod_no);
481 int ret;
482
483 if (!regmap)
484 return -EPERM;
485
486 ret = regmap_bulk_read(regmap, twl_priv->twl_map[mod_no].base + reg,
487 value, num_bytes);
488
489 if (ret)
490 pr_err("%s: Read failed (mod %d, reg 0x%02x count %d)\n",
491 DRIVER_NAME, mod_no, reg, num_bytes);
492
493 return ret;
494}
495EXPORT_SYMBOL(twl_i2c_read);
496
497
498
499
500
501
502
503
504
505int twl_set_regcache_bypass(u8 mod_no, bool enable)
506{
507 struct regmap *regmap = twl_get_regmap(mod_no);
508
509 if (!regmap)
510 return -EPERM;
511
512 regcache_cache_bypass(regmap, enable);
513
514 return 0;
515}
516EXPORT_SYMBOL(twl_set_regcache_bypass);
517
518
519
520
521
522
523
524
525static int twl_read_idcode_register(void)
526{
527 int err;
528
529 err = twl_i2c_write_u8(TWL4030_MODULE_INTBR, TWL_EEPROM_R_UNLOCK,
530 REG_UNLOCK_TEST_REG);
531 if (err) {
532 pr_err("TWL4030 Unable to unlock IDCODE registers -%d\n", err);
533 goto fail;
534 }
535
536 err = twl_i2c_read(TWL4030_MODULE_INTBR, (u8 *)(&twl_priv->twl_idcode),
537 REG_IDCODE_7_0, 4);
538 if (err) {
539 pr_err("TWL4030: unable to read IDCODE -%d\n", err);
540 goto fail;
541 }
542
543 err = twl_i2c_write_u8(TWL4030_MODULE_INTBR, 0x0, REG_UNLOCK_TEST_REG);
544 if (err)
545 pr_err("TWL4030 Unable to relock IDCODE registers -%d\n", err);
546fail:
547 return err;
548}
549
550
551
552
553
554
555int twl_get_type(void)
556{
557 return TWL_SIL_TYPE(twl_priv->twl_idcode);
558}
559EXPORT_SYMBOL_GPL(twl_get_type);
560
561
562
563
564
565
566int twl_get_version(void)
567{
568 return TWL_SIL_REV(twl_priv->twl_idcode);
569}
570EXPORT_SYMBOL_GPL(twl_get_version);
571
572
573
574
575
576
577int twl_get_hfclk_rate(void)
578{
579 u8 ctrl;
580 int rate;
581
582 twl_i2c_read_u8(TWL_MODULE_PM_MASTER, &ctrl, R_CFG_BOOT);
583
584 switch (ctrl & 0x3) {
585 case HFCLK_FREQ_19p2_MHZ:
586 rate = 19200000;
587 break;
588 case HFCLK_FREQ_26_MHZ:
589 rate = 26000000;
590 break;
591 case HFCLK_FREQ_38p4_MHZ:
592 rate = 38400000;
593 break;
594 default:
595 pr_err("TWL4030: HFCLK is not configured\n");
596 rate = -EINVAL;
597 break;
598 }
599
600 return rate;
601}
602EXPORT_SYMBOL_GPL(twl_get_hfclk_rate);
603
604static struct device *
605add_numbered_child(unsigned mod_no, const char *name, int num,
606 void *pdata, unsigned pdata_len,
607 bool can_wakeup, int irq0, int irq1)
608{
609 struct platform_device *pdev;
610 struct twl_client *twl;
611 int status, sid;
612
613 if (unlikely(mod_no >= twl_get_last_module())) {
614 pr_err("%s: invalid module number %d\n", DRIVER_NAME, mod_no);
615 return ERR_PTR(-EPERM);
616 }
617 sid = twl_priv->twl_map[mod_no].sid;
618 twl = &twl_priv->twl_modules[sid];
619
620 pdev = platform_device_alloc(name, num);
621 if (!pdev) {
622 dev_dbg(&twl->client->dev, "can't alloc dev\n");
623 status = -ENOMEM;
624 goto err;
625 }
626
627 pdev->dev.parent = &twl->client->dev;
628
629 if (pdata) {
630 status = platform_device_add_data(pdev, pdata, pdata_len);
631 if (status < 0) {
632 dev_dbg(&pdev->dev, "can't add platform_data\n");
633 goto err;
634 }
635 }
636
637 if (irq0) {
638 struct resource r[2] = {
639 { .start = irq0, .flags = IORESOURCE_IRQ, },
640 { .start = irq1, .flags = IORESOURCE_IRQ, },
641 };
642
643 status = platform_device_add_resources(pdev, r, irq1 ? 2 : 1);
644 if (status < 0) {
645 dev_dbg(&pdev->dev, "can't add irqs\n");
646 goto err;
647 }
648 }
649
650 status = platform_device_add(pdev);
651 if (status == 0)
652 device_init_wakeup(&pdev->dev, can_wakeup);
653
654err:
655 if (status < 0) {
656 platform_device_put(pdev);
657 dev_err(&twl->client->dev, "can't add %s dev\n", name);
658 return ERR_PTR(status);
659 }
660 return &pdev->dev;
661}
662
663static inline struct device *add_child(unsigned mod_no, const char *name,
664 void *pdata, unsigned pdata_len,
665 bool can_wakeup, int irq0, int irq1)
666{
667 return add_numbered_child(mod_no, name, -1, pdata, pdata_len,
668 can_wakeup, irq0, irq1);
669}
670
671static struct device *
672add_regulator_linked(int num, struct regulator_init_data *pdata,
673 struct regulator_consumer_supply *consumers,
674 unsigned num_consumers, unsigned long features)
675{
676 struct twl_regulator_driver_data drv_data;
677
678
679 if (!pdata)
680 return NULL;
681
682 if (consumers) {
683 pdata->consumer_supplies = consumers;
684 pdata->num_consumer_supplies = num_consumers;
685 }
686
687 if (pdata->driver_data) {
688
689 struct twl_regulator_driver_data *tmp;
690 tmp = pdata->driver_data;
691 tmp->features |= features;
692 } else {
693
694 drv_data.features = features;
695 drv_data.set_voltage = NULL;
696 drv_data.get_voltage = NULL;
697 drv_data.data = NULL;
698 pdata->driver_data = &drv_data;
699 }
700
701
702 return add_numbered_child(TWL_MODULE_PM_MASTER, "twl_reg", num,
703 pdata, sizeof(*pdata), false, 0, 0);
704}
705
706static struct device *
707add_regulator(int num, struct regulator_init_data *pdata,
708 unsigned long features)
709{
710 return add_regulator_linked(num, pdata, NULL, 0, features);
711}
712
713
714
715
716
717
718
719static int
720add_children(struct twl4030_platform_data *pdata, unsigned irq_base,
721 unsigned long features)
722{
723 struct device *child;
724
725 if (IS_ENABLED(CONFIG_GPIO_TWL4030) && pdata->gpio) {
726 child = add_child(TWL4030_MODULE_GPIO, "twl4030_gpio",
727 pdata->gpio, sizeof(*pdata->gpio),
728 false, irq_base + GPIO_INTR_OFFSET, 0);
729 if (IS_ERR(child))
730 return PTR_ERR(child);
731 }
732
733 if (IS_ENABLED(CONFIG_KEYBOARD_TWL4030) && pdata->keypad) {
734 child = add_child(TWL4030_MODULE_KEYPAD, "twl4030_keypad",
735 pdata->keypad, sizeof(*pdata->keypad),
736 true, irq_base + KEYPAD_INTR_OFFSET, 0);
737 if (IS_ERR(child))
738 return PTR_ERR(child);
739 }
740
741 if (IS_ENABLED(CONFIG_TWL4030_MADC) && pdata->madc &&
742 twl_class_is_4030()) {
743 child = add_child(TWL4030_MODULE_MADC, "twl4030_madc",
744 pdata->madc, sizeof(*pdata->madc),
745 true, irq_base + MADC_INTR_OFFSET, 0);
746 if (IS_ERR(child))
747 return PTR_ERR(child);
748 }
749
750 if (IS_ENABLED(CONFIG_RTC_DRV_TWL4030)) {
751
752
753
754
755
756
757
758 child = add_child(TWL_MODULE_RTC, "twl_rtc", NULL, 0,
759 true, irq_base + RTC_INTR_OFFSET, 0);
760 if (IS_ERR(child))
761 return PTR_ERR(child);
762 }
763
764 if (IS_ENABLED(CONFIG_PWM_TWL)) {
765 child = add_child(TWL_MODULE_PWM, "twl-pwm", NULL, 0,
766 false, 0, 0);
767 if (IS_ERR(child))
768 return PTR_ERR(child);
769 }
770
771 if (IS_ENABLED(CONFIG_PWM_TWL_LED)) {
772 child = add_child(TWL_MODULE_LED, "twl-pwmled", NULL, 0,
773 false, 0, 0);
774 if (IS_ERR(child))
775 return PTR_ERR(child);
776 }
777
778 if (IS_ENABLED(CONFIG_TWL4030_USB) && pdata->usb &&
779 twl_class_is_4030()) {
780
781 static struct regulator_consumer_supply usb1v5 = {
782 .supply = "usb1v5",
783 };
784 static struct regulator_consumer_supply usb1v8 = {
785 .supply = "usb1v8",
786 };
787 static struct regulator_consumer_supply usb3v1[] = {
788 { .supply = "usb3v1" },
789 { .supply = "bci3v1" },
790 };
791
792
793 if (IS_ENABLED(CONFIG_REGULATOR_TWL4030)) {
794
795 struct regulator_init_data usb_fixed = {
796 .constraints.valid_modes_mask =
797 REGULATOR_MODE_NORMAL
798 | REGULATOR_MODE_STANDBY,
799 .constraints.valid_ops_mask =
800 REGULATOR_CHANGE_MODE
801 | REGULATOR_CHANGE_STATUS,
802 };
803
804 child = add_regulator_linked(TWL4030_REG_VUSB1V5,
805 &usb_fixed, &usb1v5, 1,
806 features);
807 if (IS_ERR(child))
808 return PTR_ERR(child);
809
810 child = add_regulator_linked(TWL4030_REG_VUSB1V8,
811 &usb_fixed, &usb1v8, 1,
812 features);
813 if (IS_ERR(child))
814 return PTR_ERR(child);
815
816 child = add_regulator_linked(TWL4030_REG_VUSB3V1,
817 &usb_fixed, usb3v1, 2,
818 features);
819 if (IS_ERR(child))
820 return PTR_ERR(child);
821
822 }
823
824 child = add_child(TWL_MODULE_USB, "twl4030_usb",
825 pdata->usb, sizeof(*pdata->usb), true,
826
827 irq_base + USB_PRES_INTR_OFFSET,
828 irq_base + USB_INTR_OFFSET);
829
830 if (IS_ERR(child))
831 return PTR_ERR(child);
832
833
834 if (IS_ENABLED(CONFIG_REGULATOR_TWL4030) && child) {
835 usb1v5.dev_name = dev_name(child);
836 usb1v8.dev_name = dev_name(child);
837 usb3v1[0].dev_name = dev_name(child);
838 }
839 }
840
841 if (IS_ENABLED(CONFIG_TWL4030_WATCHDOG) && twl_class_is_4030()) {
842 child = add_child(TWL_MODULE_PM_RECEIVER, "twl4030_wdt", NULL,
843 0, false, 0, 0);
844 if (IS_ERR(child))
845 return PTR_ERR(child);
846 }
847
848 if (IS_ENABLED(CONFIG_INPUT_TWL4030_PWRBUTTON) && twl_class_is_4030()) {
849 child = add_child(TWL_MODULE_PM_MASTER, "twl4030_pwrbutton",
850 NULL, 0, true, irq_base + 8 + 0, 0);
851 if (IS_ERR(child))
852 return PTR_ERR(child);
853 }
854
855 if (IS_ENABLED(CONFIG_MFD_TWL4030_AUDIO) && pdata->audio &&
856 twl_class_is_4030()) {
857 child = add_child(TWL4030_MODULE_AUDIO_VOICE, "twl4030-audio",
858 pdata->audio, sizeof(*pdata->audio),
859 false, 0, 0);
860 if (IS_ERR(child))
861 return PTR_ERR(child);
862 }
863
864
865 if (IS_ENABLED(CONFIG_REGULATOR_TWL4030) && twl_class_is_4030()) {
866 child = add_regulator(TWL4030_REG_VPLL1, pdata->vpll1,
867 features);
868 if (IS_ERR(child))
869 return PTR_ERR(child);
870
871 child = add_regulator(TWL4030_REG_VIO, pdata->vio,
872 features);
873 if (IS_ERR(child))
874 return PTR_ERR(child);
875
876 child = add_regulator(TWL4030_REG_VDD1, pdata->vdd1,
877 features);
878 if (IS_ERR(child))
879 return PTR_ERR(child);
880
881 child = add_regulator(TWL4030_REG_VDD2, pdata->vdd2,
882 features);
883 if (IS_ERR(child))
884 return PTR_ERR(child);
885
886 child = add_regulator(TWL4030_REG_VMMC1, pdata->vmmc1,
887 features);
888 if (IS_ERR(child))
889 return PTR_ERR(child);
890
891 child = add_regulator(TWL4030_REG_VDAC, pdata->vdac,
892 features);
893 if (IS_ERR(child))
894 return PTR_ERR(child);
895
896 child = add_regulator((features & TWL4030_VAUX2)
897 ? TWL4030_REG_VAUX2_4030
898 : TWL4030_REG_VAUX2,
899 pdata->vaux2, features);
900 if (IS_ERR(child))
901 return PTR_ERR(child);
902
903 child = add_regulator(TWL4030_REG_VINTANA1, pdata->vintana1,
904 features);
905 if (IS_ERR(child))
906 return PTR_ERR(child);
907
908 child = add_regulator(TWL4030_REG_VINTANA2, pdata->vintana2,
909 features);
910 if (IS_ERR(child))
911 return PTR_ERR(child);
912
913 child = add_regulator(TWL4030_REG_VINTDIG, pdata->vintdig,
914 features);
915 if (IS_ERR(child))
916 return PTR_ERR(child);
917 }
918
919
920 if (IS_ENABLED(CONFIG_REGULATOR_TWL4030) && !(features & TPS_SUBSET)
921 && twl_class_is_4030()) {
922 child = add_regulator(TWL4030_REG_VPLL2, pdata->vpll2,
923 features);
924 if (IS_ERR(child))
925 return PTR_ERR(child);
926
927 child = add_regulator(TWL4030_REG_VMMC2, pdata->vmmc2,
928 features);
929 if (IS_ERR(child))
930 return PTR_ERR(child);
931
932 child = add_regulator(TWL4030_REG_VSIM, pdata->vsim,
933 features);
934 if (IS_ERR(child))
935 return PTR_ERR(child);
936
937 child = add_regulator(TWL4030_REG_VAUX1, pdata->vaux1,
938 features);
939 if (IS_ERR(child))
940 return PTR_ERR(child);
941
942 child = add_regulator(TWL4030_REG_VAUX3, pdata->vaux3,
943 features);
944 if (IS_ERR(child))
945 return PTR_ERR(child);
946
947 child = add_regulator(TWL4030_REG_VAUX4, pdata->vaux4,
948 features);
949 if (IS_ERR(child))
950 return PTR_ERR(child);
951 }
952
953 if (IS_ENABLED(CONFIG_CHARGER_TWL4030) && pdata->bci &&
954 !(features & (TPS_SUBSET | TWL5031))) {
955 child = add_child(TWL_MODULE_MAIN_CHARGE, "twl4030_bci",
956 pdata->bci, sizeof(*pdata->bci), false,
957
958 irq_base + BCI_PRES_INTR_OFFSET,
959 irq_base + BCI_INTR_OFFSET);
960 if (IS_ERR(child))
961 return PTR_ERR(child);
962 }
963
964 if (IS_ENABLED(CONFIG_TWL4030_POWER) && pdata->power) {
965 child = add_child(TWL_MODULE_PM_MASTER, "twl4030_power",
966 pdata->power, sizeof(*pdata->power), false,
967 0, 0);
968 if (IS_ERR(child))
969 return PTR_ERR(child);
970 }
971
972 return 0;
973}
974
975
976
977
978
979
980
981
982static inline int __init protect_pm_master(void)
983{
984 int e = 0;
985
986 e = twl_i2c_write_u8(TWL_MODULE_PM_MASTER, 0,
987 TWL4030_PM_MASTER_PROTECT_KEY);
988 return e;
989}
990
991static inline int __init unprotect_pm_master(void)
992{
993 int e = 0;
994
995 e |= twl_i2c_write_u8(TWL_MODULE_PM_MASTER, TWL4030_PM_MASTER_KEY_CFG1,
996 TWL4030_PM_MASTER_PROTECT_KEY);
997 e |= twl_i2c_write_u8(TWL_MODULE_PM_MASTER, TWL4030_PM_MASTER_KEY_CFG2,
998 TWL4030_PM_MASTER_PROTECT_KEY);
999
1000 return e;
1001}
1002
1003static void clocks_init(struct device *dev,
1004 struct twl4030_clock_init_data *clock)
1005{
1006 int e = 0;
1007 struct clk *osc;
1008 u32 rate;
1009 u8 ctrl = HFCLK_FREQ_26_MHZ;
1010
1011 osc = clk_get(dev, "fck");
1012 if (IS_ERR(osc)) {
1013 printk(KERN_WARNING "Skipping twl internal clock init and "
1014 "using bootloader value (unknown osc rate)\n");
1015 return;
1016 }
1017
1018 rate = clk_get_rate(osc);
1019 clk_put(osc);
1020
1021 switch (rate) {
1022 case 19200000:
1023 ctrl = HFCLK_FREQ_19p2_MHZ;
1024 break;
1025 case 26000000:
1026 ctrl = HFCLK_FREQ_26_MHZ;
1027 break;
1028 case 38400000:
1029 ctrl = HFCLK_FREQ_38p4_MHZ;
1030 break;
1031 }
1032
1033 ctrl |= HIGH_PERF_SQ;
1034 if (clock && clock->ck32k_lowpwr_enable)
1035 ctrl |= CK32K_LOWPWR_EN;
1036
1037 e |= unprotect_pm_master();
1038
1039 e |= twl_i2c_write_u8(TWL_MODULE_PM_MASTER, ctrl, R_CFG_BOOT);
1040 e |= protect_pm_master();
1041
1042 if (e < 0)
1043 pr_err("%s: clock init err [%d]\n", DRIVER_NAME, e);
1044}
1045
1046
1047
1048
1049static int twl_remove(struct i2c_client *client)
1050{
1051 unsigned i, num_slaves;
1052 int status;
1053
1054 if (twl_class_is_4030())
1055 status = twl4030_exit_irq();
1056 else
1057 status = twl6030_exit_irq();
1058
1059 if (status < 0)
1060 return status;
1061
1062 num_slaves = twl_get_num_slaves();
1063 for (i = 0; i < num_slaves; i++) {
1064 struct twl_client *twl = &twl_priv->twl_modules[i];
1065
1066 if (twl->client && twl->client != client)
1067 i2c_unregister_device(twl->client);
1068 twl->client = NULL;
1069 }
1070 twl_priv->ready = false;
1071 return 0;
1072}
1073
1074static struct of_dev_auxdata twl_auxdata_lookup[] = {
1075 OF_DEV_AUXDATA("ti,twl4030-gpio", 0, "twl4030-gpio", NULL),
1076 { },
1077};
1078
1079
1080static int
1081twl_probe(struct i2c_client *client, const struct i2c_device_id *id)
1082{
1083 struct twl4030_platform_data *pdata = dev_get_platdata(&client->dev);
1084 struct device_node *node = client->dev.of_node;
1085 struct platform_device *pdev;
1086 struct regmap_config *twl_regmap_config;
1087 int irq_base = 0;
1088 int status;
1089 unsigned i, num_slaves;
1090
1091 if (!node && !pdata) {
1092 dev_err(&client->dev, "no platform data\n");
1093 return -EINVAL;
1094 }
1095
1096 if (twl_priv) {
1097 dev_dbg(&client->dev, "only one instance of %s allowed\n",
1098 DRIVER_NAME);
1099 return -EBUSY;
1100 }
1101
1102 pdev = platform_device_alloc(DRIVER_NAME, -1);
1103 if (!pdev) {
1104 dev_err(&client->dev, "can't alloc pdev\n");
1105 return -ENOMEM;
1106 }
1107
1108 status = platform_device_add(pdev);
1109 if (status) {
1110 platform_device_put(pdev);
1111 return status;
1112 }
1113
1114 if (i2c_check_functionality(client->adapter, I2C_FUNC_I2C) == 0) {
1115 dev_dbg(&client->dev, "can't talk I2C?\n");
1116 status = -EIO;
1117 goto free;
1118 }
1119
1120 twl_priv = devm_kzalloc(&client->dev, sizeof(struct twl_private),
1121 GFP_KERNEL);
1122 if (!twl_priv) {
1123 status = -ENOMEM;
1124 goto free;
1125 }
1126
1127 if ((id->driver_data) & TWL6030_CLASS) {
1128 twl_priv->twl_id = TWL6030_CLASS_ID;
1129 twl_priv->twl_map = &twl6030_map[0];
1130
1131 if ((id->driver_data) & TWL6032_SUBCLASS)
1132 twl_priv->twl_map[TWL_MODULE_MAIN_CHARGE].base =
1133 TWL6032_BASEADD_CHARGER;
1134 twl_regmap_config = twl6030_regmap_config;
1135 } else {
1136 twl_priv->twl_id = TWL4030_CLASS_ID;
1137 twl_priv->twl_map = &twl4030_map[0];
1138 twl_regmap_config = twl4030_regmap_config;
1139 }
1140
1141 num_slaves = twl_get_num_slaves();
1142 twl_priv->twl_modules = devm_kzalloc(&client->dev,
1143 sizeof(struct twl_client) * num_slaves,
1144 GFP_KERNEL);
1145 if (!twl_priv->twl_modules) {
1146 status = -ENOMEM;
1147 goto free;
1148 }
1149
1150 for (i = 0; i < num_slaves; i++) {
1151 struct twl_client *twl = &twl_priv->twl_modules[i];
1152
1153 if (i == 0) {
1154 twl->client = client;
1155 } else {
1156 twl->client = i2c_new_dummy(client->adapter,
1157 client->addr + i);
1158 if (!twl->client) {
1159 dev_err(&client->dev,
1160 "can't attach client %d\n", i);
1161 status = -ENOMEM;
1162 goto fail;
1163 }
1164 }
1165
1166 twl->regmap = devm_regmap_init_i2c(twl->client,
1167 &twl_regmap_config[i]);
1168 if (IS_ERR(twl->regmap)) {
1169 status = PTR_ERR(twl->regmap);
1170 dev_err(&client->dev,
1171 "Failed to allocate regmap %d, err: %d\n", i,
1172 status);
1173 goto fail;
1174 }
1175 }
1176
1177 twl_priv->ready = true;
1178
1179
1180 clocks_init(&pdev->dev, pdata ? pdata->clock : NULL);
1181
1182
1183 if (twl_class_is_4030()) {
1184 status = twl_read_idcode_register();
1185 WARN(status < 0, "Error: reading twl_idcode register value\n");
1186 }
1187
1188
1189 if (client->irq) {
1190 if (twl_class_is_4030()) {
1191 twl4030_init_chip_irq(id->name);
1192 irq_base = twl4030_init_irq(&client->dev, client->irq);
1193 } else {
1194 irq_base = twl6030_init_irq(&client->dev, client->irq);
1195 }
1196
1197 if (irq_base < 0) {
1198 status = irq_base;
1199 goto fail;
1200 }
1201 }
1202
1203
1204
1205
1206
1207
1208 if (twl_class_is_4030()) {
1209 u8 temp;
1210
1211 twl_i2c_read_u8(TWL4030_MODULE_INTBR, &temp, REG_GPPUPDCTR1);
1212 temp &= ~(SR_I2C_SDA_CTRL_PU | SR_I2C_SCL_CTRL_PU | \
1213 I2C_SDA_CTRL_PU | I2C_SCL_CTRL_PU);
1214 twl_i2c_write_u8(TWL4030_MODULE_INTBR, temp, REG_GPPUPDCTR1);
1215 }
1216
1217 if (node) {
1218 if (pdata)
1219 twl_auxdata_lookup[0].platform_data = pdata->gpio;
1220 status = of_platform_populate(node, NULL, twl_auxdata_lookup,
1221 &client->dev);
1222 } else {
1223 status = add_children(pdata, irq_base, id->driver_data);
1224 }
1225
1226fail:
1227 if (status < 0)
1228 twl_remove(client);
1229free:
1230 if (status < 0)
1231 platform_device_unregister(pdev);
1232
1233 return status;
1234}
1235
1236static const struct i2c_device_id twl_ids[] = {
1237 { "twl4030", TWL4030_VAUX2 },
1238 { "twl5030", 0 },
1239 { "twl5031", TWL5031 },
1240 { "tps65950", 0 },
1241 { "tps65930", TPS_SUBSET },
1242 { "tps65920", TPS_SUBSET },
1243 { "tps65921", TPS_SUBSET },
1244
1245 { "twl6030", TWL6030_CLASS },
1246 { "twl6032", TWL6030_CLASS | TWL6032_SUBCLASS },
1247 { },
1248};
1249MODULE_DEVICE_TABLE(i2c, twl_ids);
1250
1251
1252static struct i2c_driver twl_driver = {
1253 .driver.name = DRIVER_NAME,
1254 .id_table = twl_ids,
1255 .probe = twl_probe,
1256 .remove = twl_remove,
1257};
1258
1259module_i2c_driver(twl_driver);
1260
1261MODULE_AUTHOR("Texas Instruments, Inc.");
1262MODULE_DESCRIPTION("I2C Core interface for TWL");
1263MODULE_LICENSE("GPL");
1264