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? */ 237static bool inuse; 238 239/* TWL IDCODE Register value */ 240static u32 twl_idcode; 241 242static unsigned int twl_id; 243unsigned int twl_rev(void) 244{ 245 return twl_id; 246} 247EXPORT_SYMBOL(twl_rev); 248 249/* Structure for each TWL4030/TWL6030 Slave */ 250struct 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 261static struct twl_client twl_modules[TWL_NUM_SLAVES]; 262 263/* mapping the module id to slave id and base address */ 264struct twl_mapping { 265 unsigned char sid; /* Slave ID */ 266 unsigned char base; /* base address */ 267}; 268static struct twl_mapping *twl_map; 269 270static 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 306static 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 */ 359int 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} 409EXPORT_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 */ 420int 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} 473EXPORT_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 */ 483int 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} 492EXPORT_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 */ 502int twl_i2c_read_u8(u8 mod_no, u8 *value, u8 reg) 503{ 504 return twl_i2c_read(mod_no, value, reg, 1); 505} 506EXPORT_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 */ 515static 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); 536fail: 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 */ 545int twl_get_type(void) 546{ 547 return TWL_SIL_TYPE(twl_idcode); 548} 549EXPORT_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 */ 556int twl_get_version(void) 557{ 558 return TWL_SIL_REV(twl_idcode); 559} 560EXPORT_SYMBOL_GPL(twl_get_version); 561 562static struct device * 563add_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 604err: 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 613static 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 621static struct device * 622add_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 658static struct device * 659add_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 671static int 672add_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 */ 1109static 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 1118static 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 1132static 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 1195static 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 */ 1223static int __devinit 1224twl_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 1338fail: 1339 if (status < 0) 1340 twl_remove(client); 1341 1342 return status; 1343} 1344 1345static 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}; 1358MODULE_DEVICE_TABLE(i2c, twl_ids); 1359 1360/* One Client Driver , 4 Clients */ 1361static 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 1368static int __init twl_init(void) 1369{ 1370 return i2c_add_driver(&twl_driver); 1371} 1372subsys_initcall(twl_init); 1373 1374static void __exit twl_exit(void) 1375{ 1376 i2c_del_driver(&twl_driver); 1377} 1378module_exit(twl_exit); 1379 1380MODULE_AUTHOR("Texas Instruments, Inc."); 1381MODULE_DESCRIPTION("I2C Core interface for TWL"); 1382MODULE_LICENSE("GPL"); 1383