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