1 /* 2 * TI Palmas MFD Driver 3 * 4 * Copyright 2011-2012 Texas Instruments Inc. 5 * 6 * Author: Graeme Gregory <gg@slimlogic.co.uk> 7 * 8 * This program is free software; you can redistribute it and/or modify it 9 * under the terms of the GNU General Public License as published by the 10 * Free Software Foundation; either version 2 of the License, or (at your 11 * option) any later version. 12 * 13 */ 14 15 #include <linux/module.h> 16 #include <linux/moduleparam.h> 17 #include <linux/init.h> 18 #include <linux/slab.h> 19 #include <linux/i2c.h> 20 #include <linux/interrupt.h> 21 #include <linux/irq.h> 22 #include <linux/regmap.h> 23 #include <linux/err.h> 24 #include <linux/mfd/core.h> 25 #include <linux/mfd/palmas.h> 26 #include <linux/of_device.h> 27 28 static const struct regmap_config palmas_regmap_config[PALMAS_NUM_CLIENTS] = { 29 { 30 .reg_bits = 8, 31 .val_bits = 8, 32 .max_register = PALMAS_BASE_TO_REG(PALMAS_PU_PD_OD_BASE, 33 PALMAS_PRIMARY_SECONDARY_PAD3), 34 }, 35 { 36 .reg_bits = 8, 37 .val_bits = 8, 38 .max_register = PALMAS_BASE_TO_REG(PALMAS_GPADC_BASE, 39 PALMAS_GPADC_SMPS_VSEL_MONITORING), 40 }, 41 { 42 .reg_bits = 8, 43 .val_bits = 8, 44 .max_register = PALMAS_BASE_TO_REG(PALMAS_TRIM_GPADC_BASE, 45 PALMAS_GPADC_TRIM16), 46 }, 47 }; 48 49 static const struct regmap_irq tps65917_irqs[] = { 50 /* INT1 IRQs */ 51 [TPS65917_RESERVED1] = { 52 .mask = TPS65917_RESERVED, 53 }, 54 [TPS65917_PWRON_IRQ] = { 55 .mask = TPS65917_INT1_STATUS_PWRON, 56 }, 57 [TPS65917_LONG_PRESS_KEY_IRQ] = { 58 .mask = TPS65917_INT1_STATUS_LONG_PRESS_KEY, 59 }, 60 [TPS65917_RESERVED2] = { 61 .mask = TPS65917_RESERVED, 62 }, 63 [TPS65917_PWRDOWN_IRQ] = { 64 .mask = TPS65917_INT1_STATUS_PWRDOWN, 65 }, 66 [TPS65917_HOTDIE_IRQ] = { 67 .mask = TPS65917_INT1_STATUS_HOTDIE, 68 }, 69 [TPS65917_VSYS_MON_IRQ] = { 70 .mask = TPS65917_INT1_STATUS_VSYS_MON, 71 }, 72 [TPS65917_RESERVED3] = { 73 .mask = TPS65917_RESERVED, 74 }, 75 /* INT2 IRQs*/ 76 [TPS65917_RESERVED4] = { 77 .mask = TPS65917_RESERVED, 78 .reg_offset = 1, 79 }, 80 [TPS65917_OTP_ERROR_IRQ] = { 81 .mask = TPS65917_INT2_STATUS_OTP_ERROR, 82 .reg_offset = 1, 83 }, 84 [TPS65917_WDT_IRQ] = { 85 .mask = TPS65917_INT2_STATUS_WDT, 86 .reg_offset = 1, 87 }, 88 [TPS65917_RESERVED5] = { 89 .mask = TPS65917_RESERVED, 90 .reg_offset = 1, 91 }, 92 [TPS65917_RESET_IN_IRQ] = { 93 .mask = TPS65917_INT2_STATUS_RESET_IN, 94 .reg_offset = 1, 95 }, 96 [TPS65917_FSD_IRQ] = { 97 .mask = TPS65917_INT2_STATUS_FSD, 98 .reg_offset = 1, 99 }, 100 [TPS65917_SHORT_IRQ] = { 101 .mask = TPS65917_INT2_STATUS_SHORT, 102 .reg_offset = 1, 103 }, 104 [TPS65917_RESERVED6] = { 105 .mask = TPS65917_RESERVED, 106 .reg_offset = 1, 107 }, 108 /* INT3 IRQs */ 109 [TPS65917_GPADC_AUTO_0_IRQ] = { 110 .mask = TPS65917_INT3_STATUS_GPADC_AUTO_0, 111 .reg_offset = 2, 112 }, 113 [TPS65917_GPADC_AUTO_1_IRQ] = { 114 .mask = TPS65917_INT3_STATUS_GPADC_AUTO_1, 115 .reg_offset = 2, 116 }, 117 [TPS65917_GPADC_EOC_SW_IRQ] = { 118 .mask = TPS65917_INT3_STATUS_GPADC_EOC_SW, 119 .reg_offset = 2, 120 }, 121 [TPS65917_RESREVED6] = { 122 .mask = TPS65917_RESERVED6, 123 .reg_offset = 2, 124 }, 125 [TPS65917_RESERVED7] = { 126 .mask = TPS65917_RESERVED, 127 .reg_offset = 2, 128 }, 129 [TPS65917_RESERVED8] = { 130 .mask = TPS65917_RESERVED, 131 .reg_offset = 2, 132 }, 133 [TPS65917_RESERVED9] = { 134 .mask = TPS65917_RESERVED, 135 .reg_offset = 2, 136 }, 137 [TPS65917_VBUS_IRQ] = { 138 .mask = TPS65917_INT3_STATUS_VBUS, 139 .reg_offset = 2, 140 }, 141 /* INT4 IRQs */ 142 [TPS65917_GPIO_0_IRQ] = { 143 .mask = TPS65917_INT4_STATUS_GPIO_0, 144 .reg_offset = 3, 145 }, 146 [TPS65917_GPIO_1_IRQ] = { 147 .mask = TPS65917_INT4_STATUS_GPIO_1, 148 .reg_offset = 3, 149 }, 150 [TPS65917_GPIO_2_IRQ] = { 151 .mask = TPS65917_INT4_STATUS_GPIO_2, 152 .reg_offset = 3, 153 }, 154 [TPS65917_GPIO_3_IRQ] = { 155 .mask = TPS65917_INT4_STATUS_GPIO_3, 156 .reg_offset = 3, 157 }, 158 [TPS65917_GPIO_4_IRQ] = { 159 .mask = TPS65917_INT4_STATUS_GPIO_4, 160 .reg_offset = 3, 161 }, 162 [TPS65917_GPIO_5_IRQ] = { 163 .mask = TPS65917_INT4_STATUS_GPIO_5, 164 .reg_offset = 3, 165 }, 166 [TPS65917_GPIO_6_IRQ] = { 167 .mask = TPS65917_INT4_STATUS_GPIO_6, 168 .reg_offset = 3, 169 }, 170 [TPS65917_RESERVED10] = { 171 .mask = TPS65917_RESERVED10, 172 .reg_offset = 3, 173 }, 174 }; 175 176 static const struct regmap_irq palmas_irqs[] = { 177 /* INT1 IRQs */ 178 [PALMAS_CHARG_DET_N_VBUS_OVV_IRQ] = { 179 .mask = PALMAS_INT1_STATUS_CHARG_DET_N_VBUS_OVV, 180 }, 181 [PALMAS_PWRON_IRQ] = { 182 .mask = PALMAS_INT1_STATUS_PWRON, 183 }, 184 [PALMAS_LONG_PRESS_KEY_IRQ] = { 185 .mask = PALMAS_INT1_STATUS_LONG_PRESS_KEY, 186 }, 187 [PALMAS_RPWRON_IRQ] = { 188 .mask = PALMAS_INT1_STATUS_RPWRON, 189 }, 190 [PALMAS_PWRDOWN_IRQ] = { 191 .mask = PALMAS_INT1_STATUS_PWRDOWN, 192 }, 193 [PALMAS_HOTDIE_IRQ] = { 194 .mask = PALMAS_INT1_STATUS_HOTDIE, 195 }, 196 [PALMAS_VSYS_MON_IRQ] = { 197 .mask = PALMAS_INT1_STATUS_VSYS_MON, 198 }, 199 [PALMAS_VBAT_MON_IRQ] = { 200 .mask = PALMAS_INT1_STATUS_VBAT_MON, 201 }, 202 /* INT2 IRQs*/ 203 [PALMAS_RTC_ALARM_IRQ] = { 204 .mask = PALMAS_INT2_STATUS_RTC_ALARM, 205 .reg_offset = 1, 206 }, 207 [PALMAS_RTC_TIMER_IRQ] = { 208 .mask = PALMAS_INT2_STATUS_RTC_TIMER, 209 .reg_offset = 1, 210 }, 211 [PALMAS_WDT_IRQ] = { 212 .mask = PALMAS_INT2_STATUS_WDT, 213 .reg_offset = 1, 214 }, 215 [PALMAS_BATREMOVAL_IRQ] = { 216 .mask = PALMAS_INT2_STATUS_BATREMOVAL, 217 .reg_offset = 1, 218 }, 219 [PALMAS_RESET_IN_IRQ] = { 220 .mask = PALMAS_INT2_STATUS_RESET_IN, 221 .reg_offset = 1, 222 }, 223 [PALMAS_FBI_BB_IRQ] = { 224 .mask = PALMAS_INT2_STATUS_FBI_BB, 225 .reg_offset = 1, 226 }, 227 [PALMAS_SHORT_IRQ] = { 228 .mask = PALMAS_INT2_STATUS_SHORT, 229 .reg_offset = 1, 230 }, 231 [PALMAS_VAC_ACOK_IRQ] = { 232 .mask = PALMAS_INT2_STATUS_VAC_ACOK, 233 .reg_offset = 1, 234 }, 235 /* INT3 IRQs */ 236 [PALMAS_GPADC_AUTO_0_IRQ] = { 237 .mask = PALMAS_INT3_STATUS_GPADC_AUTO_0, 238 .reg_offset = 2, 239 }, 240 [PALMAS_GPADC_AUTO_1_IRQ] = { 241 .mask = PALMAS_INT3_STATUS_GPADC_AUTO_1, 242 .reg_offset = 2, 243 }, 244 [PALMAS_GPADC_EOC_SW_IRQ] = { 245 .mask = PALMAS_INT3_STATUS_GPADC_EOC_SW, 246 .reg_offset = 2, 247 }, 248 [PALMAS_GPADC_EOC_RT_IRQ] = { 249 .mask = PALMAS_INT3_STATUS_GPADC_EOC_RT, 250 .reg_offset = 2, 251 }, 252 [PALMAS_ID_OTG_IRQ] = { 253 .mask = PALMAS_INT3_STATUS_ID_OTG, 254 .reg_offset = 2, 255 }, 256 [PALMAS_ID_IRQ] = { 257 .mask = PALMAS_INT3_STATUS_ID, 258 .reg_offset = 2, 259 }, 260 [PALMAS_VBUS_OTG_IRQ] = { 261 .mask = PALMAS_INT3_STATUS_VBUS_OTG, 262 .reg_offset = 2, 263 }, 264 [PALMAS_VBUS_IRQ] = { 265 .mask = PALMAS_INT3_STATUS_VBUS, 266 .reg_offset = 2, 267 }, 268 /* INT4 IRQs */ 269 [PALMAS_GPIO_0_IRQ] = { 270 .mask = PALMAS_INT4_STATUS_GPIO_0, 271 .reg_offset = 3, 272 }, 273 [PALMAS_GPIO_1_IRQ] = { 274 .mask = PALMAS_INT4_STATUS_GPIO_1, 275 .reg_offset = 3, 276 }, 277 [PALMAS_GPIO_2_IRQ] = { 278 .mask = PALMAS_INT4_STATUS_GPIO_2, 279 .reg_offset = 3, 280 }, 281 [PALMAS_GPIO_3_IRQ] = { 282 .mask = PALMAS_INT4_STATUS_GPIO_3, 283 .reg_offset = 3, 284 }, 285 [PALMAS_GPIO_4_IRQ] = { 286 .mask = PALMAS_INT4_STATUS_GPIO_4, 287 .reg_offset = 3, 288 }, 289 [PALMAS_GPIO_5_IRQ] = { 290 .mask = PALMAS_INT4_STATUS_GPIO_5, 291 .reg_offset = 3, 292 }, 293 [PALMAS_GPIO_6_IRQ] = { 294 .mask = PALMAS_INT4_STATUS_GPIO_6, 295 .reg_offset = 3, 296 }, 297 [PALMAS_GPIO_7_IRQ] = { 298 .mask = PALMAS_INT4_STATUS_GPIO_7, 299 .reg_offset = 3, 300 }, 301 }; 302 303 static struct regmap_irq_chip palmas_irq_chip = { 304 .name = "palmas", 305 .irqs = palmas_irqs, 306 .num_irqs = ARRAY_SIZE(palmas_irqs), 307 308 .num_regs = 4, 309 .irq_reg_stride = 5, 310 .status_base = PALMAS_BASE_TO_REG(PALMAS_INTERRUPT_BASE, 311 PALMAS_INT1_STATUS), 312 .mask_base = PALMAS_BASE_TO_REG(PALMAS_INTERRUPT_BASE, 313 PALMAS_INT1_MASK), 314 }; 315 316 static struct regmap_irq_chip tps65917_irq_chip = { 317 .name = "tps65917", 318 .irqs = tps65917_irqs, 319 .num_irqs = ARRAY_SIZE(tps65917_irqs), 320 321 .num_regs = 4, 322 .irq_reg_stride = 5, 323 .status_base = PALMAS_BASE_TO_REG(PALMAS_INTERRUPT_BASE, 324 PALMAS_INT1_STATUS), 325 .mask_base = PALMAS_BASE_TO_REG(PALMAS_INTERRUPT_BASE, 326 PALMAS_INT1_MASK), 327 }; 328 329 int palmas_ext_control_req_config(struct palmas *palmas, 330 enum palmas_external_requestor_id id, int ext_ctrl, bool enable) 331 { 332 struct palmas_pmic_driver_data *pmic_ddata = palmas->pmic_ddata; 333 int preq_mask_bit = 0; 334 int reg_add = 0; 335 int bit_pos, ret; 336 337 if (!(ext_ctrl & PALMAS_EXT_REQ)) 338 return 0; 339 340 if (id >= PALMAS_EXTERNAL_REQSTR_ID_MAX) 341 return 0; 342 343 if (ext_ctrl & PALMAS_EXT_CONTROL_NSLEEP) { 344 reg_add = PALMAS_NSLEEP_RES_ASSIGN; 345 preq_mask_bit = 0; 346 } else if (ext_ctrl & PALMAS_EXT_CONTROL_ENABLE1) { 347 reg_add = PALMAS_ENABLE1_RES_ASSIGN; 348 preq_mask_bit = 1; 349 } else if (ext_ctrl & PALMAS_EXT_CONTROL_ENABLE2) { 350 reg_add = PALMAS_ENABLE2_RES_ASSIGN; 351 preq_mask_bit = 2; 352 } 353 354 bit_pos = pmic_ddata->sleep_req_info[id].bit_pos; 355 reg_add += pmic_ddata->sleep_req_info[id].reg_offset; 356 if (enable) 357 ret = palmas_update_bits(palmas, PALMAS_RESOURCE_BASE, 358 reg_add, BIT(bit_pos), BIT(bit_pos)); 359 else 360 ret = palmas_update_bits(palmas, PALMAS_RESOURCE_BASE, 361 reg_add, BIT(bit_pos), 0); 362 if (ret < 0) { 363 dev_err(palmas->dev, "Resource reg 0x%02x update failed %d\n", 364 reg_add, ret); 365 return ret; 366 } 367 368 /* Unmask the PREQ */ 369 ret = palmas_update_bits(palmas, PALMAS_PMU_CONTROL_BASE, 370 PALMAS_POWER_CTRL, BIT(preq_mask_bit), 0); 371 if (ret < 0) { 372 dev_err(palmas->dev, "POWER_CTRL register update failed %d\n", 373 ret); 374 return ret; 375 } 376 return ret; 377 } 378 EXPORT_SYMBOL_GPL(palmas_ext_control_req_config); 379 380 static int palmas_set_pdata_irq_flag(struct i2c_client *i2c, 381 struct palmas_platform_data *pdata) 382 { 383 struct irq_data *irq_data = irq_get_irq_data(i2c->irq); 384 if (!irq_data) { 385 dev_err(&i2c->dev, "Invalid IRQ: %d\n", i2c->irq); 386 return -EINVAL; 387 } 388 389 pdata->irq_flags = irqd_get_trigger_type(irq_data); 390 dev_info(&i2c->dev, "Irq flag is 0x%08x\n", pdata->irq_flags); 391 return 0; 392 } 393 394 static void palmas_dt_to_pdata(struct i2c_client *i2c, 395 struct palmas_platform_data *pdata) 396 { 397 struct device_node *node = i2c->dev.of_node; 398 int ret; 399 u32 prop; 400 401 ret = of_property_read_u32(node, "ti,mux-pad1", &prop); 402 if (!ret) { 403 pdata->mux_from_pdata = 1; 404 pdata->pad1 = prop; 405 } 406 407 ret = of_property_read_u32(node, "ti,mux-pad2", &prop); 408 if (!ret) { 409 pdata->mux_from_pdata = 1; 410 pdata->pad2 = prop; 411 } 412 413 /* The default for this register is all masked */ 414 ret = of_property_read_u32(node, "ti,power-ctrl", &prop); 415 if (!ret) 416 pdata->power_ctrl = prop; 417 else 418 pdata->power_ctrl = PALMAS_POWER_CTRL_NSLEEP_MASK | 419 PALMAS_POWER_CTRL_ENABLE1_MASK | 420 PALMAS_POWER_CTRL_ENABLE2_MASK; 421 if (i2c->irq) 422 palmas_set_pdata_irq_flag(i2c, pdata); 423 424 pdata->pm_off = of_property_read_bool(node, 425 "ti,system-power-controller"); 426 } 427 428 static struct palmas *palmas_dev; 429 static void palmas_power_off(void) 430 { 431 unsigned int addr; 432 int ret, slave; 433 434 if (!palmas_dev) 435 return; 436 437 slave = PALMAS_BASE_TO_SLAVE(PALMAS_PMU_CONTROL_BASE); 438 addr = PALMAS_BASE_TO_REG(PALMAS_PMU_CONTROL_BASE, PALMAS_DEV_CTRL); 439 440 ret = regmap_update_bits( 441 palmas_dev->regmap[slave], 442 addr, 443 PALMAS_DEV_CTRL_DEV_ON, 444 0); 445 446 if (ret) 447 pr_err("%s: Unable to write to DEV_CTRL_DEV_ON: %d\n", 448 __func__, ret); 449 } 450 451 static unsigned int palmas_features = PALMAS_PMIC_FEATURE_SMPS10_BOOST; 452 static unsigned int tps659038_features; 453 454 struct palmas_driver_data { 455 unsigned int *features; 456 struct regmap_irq_chip *irq_chip; 457 }; 458 459 static struct palmas_driver_data palmas_data = { 460 .features = &palmas_features, 461 .irq_chip = &palmas_irq_chip, 462 }; 463 464 static struct palmas_driver_data tps659038_data = { 465 .features = &tps659038_features, 466 .irq_chip = &palmas_irq_chip, 467 }; 468 469 static struct palmas_driver_data tps65917_data = { 470 .features = &tps659038_features, 471 .irq_chip = &tps65917_irq_chip, 472 }; 473 474 static const struct of_device_id of_palmas_match_tbl[] = { 475 { 476 .compatible = "ti,palmas", 477 .data = &palmas_data, 478 }, 479 { 480 .compatible = "ti,tps659038", 481 .data = &tps659038_data, 482 }, 483 { 484 .compatible = "ti,tps65917", 485 .data = &tps65917_data, 486 }, 487 { }, 488 }; 489 MODULE_DEVICE_TABLE(of, of_palmas_match_tbl); 490 491 static int palmas_i2c_probe(struct i2c_client *i2c, 492 const struct i2c_device_id *id) 493 { 494 struct palmas *palmas; 495 struct palmas_platform_data *pdata; 496 struct palmas_driver_data *driver_data; 497 struct device_node *node = i2c->dev.of_node; 498 int ret = 0, i; 499 unsigned int reg, addr; 500 int slave; 501 const struct of_device_id *match; 502 503 pdata = dev_get_platdata(&i2c->dev); 504 505 if (node && !pdata) { 506 pdata = devm_kzalloc(&i2c->dev, sizeof(*pdata), GFP_KERNEL); 507 508 if (!pdata) 509 return -ENOMEM; 510 511 palmas_dt_to_pdata(i2c, pdata); 512 } 513 514 if (!pdata) 515 return -EINVAL; 516 517 palmas = devm_kzalloc(&i2c->dev, sizeof(struct palmas), GFP_KERNEL); 518 if (palmas == NULL) 519 return -ENOMEM; 520 521 i2c_set_clientdata(i2c, palmas); 522 palmas->dev = &i2c->dev; 523 palmas->irq = i2c->irq; 524 525 match = of_match_device(of_palmas_match_tbl, &i2c->dev); 526 527 if (!match) 528 return -ENODATA; 529 530 driver_data = (struct palmas_driver_data *)match->data; 531 palmas->features = *driver_data->features; 532 533 for (i = 0; i < PALMAS_NUM_CLIENTS; i++) { 534 if (i == 0) 535 palmas->i2c_clients[i] = i2c; 536 else { 537 palmas->i2c_clients[i] = 538 i2c_new_dummy(i2c->adapter, 539 i2c->addr + i); 540 if (!palmas->i2c_clients[i]) { 541 dev_err(palmas->dev, 542 "can't attach client %d\n", i); 543 ret = -ENOMEM; 544 goto err_i2c; 545 } 546 palmas->i2c_clients[i]->dev.of_node = of_node_get(node); 547 } 548 palmas->regmap[i] = devm_regmap_init_i2c(palmas->i2c_clients[i], 549 &palmas_regmap_config[i]); 550 if (IS_ERR(palmas->regmap[i])) { 551 ret = PTR_ERR(palmas->regmap[i]); 552 dev_err(palmas->dev, 553 "Failed to allocate regmap %d, err: %d\n", 554 i, ret); 555 goto err_i2c; 556 } 557 } 558 559 if (!palmas->irq) { 560 dev_warn(palmas->dev, "IRQ missing: skipping irq request\n"); 561 goto no_irq; 562 } 563 564 /* Change interrupt line output polarity */ 565 if (pdata->irq_flags & IRQ_TYPE_LEVEL_HIGH) 566 reg = PALMAS_POLARITY_CTRL_INT_POLARITY; 567 else 568 reg = 0; 569 ret = palmas_update_bits(palmas, PALMAS_PU_PD_OD_BASE, 570 PALMAS_POLARITY_CTRL, PALMAS_POLARITY_CTRL_INT_POLARITY, 571 reg); 572 if (ret < 0) { 573 dev_err(palmas->dev, "POLARITY_CTRL updat failed: %d\n", ret); 574 goto err_i2c; 575 } 576 577 /* Change IRQ into clear on read mode for efficiency */ 578 slave = PALMAS_BASE_TO_SLAVE(PALMAS_INTERRUPT_BASE); 579 addr = PALMAS_BASE_TO_REG(PALMAS_INTERRUPT_BASE, PALMAS_INT_CTRL); 580 reg = PALMAS_INT_CTRL_INT_CLEAR; 581 582 regmap_write(palmas->regmap[slave], addr, reg); 583 584 ret = regmap_add_irq_chip(palmas->regmap[slave], palmas->irq, 585 IRQF_ONESHOT | pdata->irq_flags, 0, 586 driver_data->irq_chip, &palmas->irq_data); 587 if (ret < 0) 588 goto err_i2c; 589 590 no_irq: 591 slave = PALMAS_BASE_TO_SLAVE(PALMAS_PU_PD_OD_BASE); 592 addr = PALMAS_BASE_TO_REG(PALMAS_PU_PD_OD_BASE, 593 PALMAS_PRIMARY_SECONDARY_PAD1); 594 595 if (pdata->mux_from_pdata) { 596 reg = pdata->pad1; 597 ret = regmap_write(palmas->regmap[slave], addr, reg); 598 if (ret) 599 goto err_irq; 600 } else { 601 ret = regmap_read(palmas->regmap[slave], addr, ®); 602 if (ret) 603 goto err_irq; 604 } 605 606 if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_0)) 607 palmas->gpio_muxed |= PALMAS_GPIO_0_MUXED; 608 if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_MASK)) 609 palmas->gpio_muxed |= PALMAS_GPIO_1_MUXED; 610 else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_MASK) == 611 (2 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_SHIFT)) 612 palmas->led_muxed |= PALMAS_LED1_MUXED; 613 else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_MASK) == 614 (3 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_SHIFT)) 615 palmas->pwm_muxed |= PALMAS_PWM1_MUXED; 616 if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_MASK)) 617 palmas->gpio_muxed |= PALMAS_GPIO_2_MUXED; 618 else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_MASK) == 619 (2 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_SHIFT)) 620 palmas->led_muxed |= PALMAS_LED2_MUXED; 621 else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_MASK) == 622 (3 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_SHIFT)) 623 palmas->pwm_muxed |= PALMAS_PWM2_MUXED; 624 if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_3)) 625 palmas->gpio_muxed |= PALMAS_GPIO_3_MUXED; 626 627 addr = PALMAS_BASE_TO_REG(PALMAS_PU_PD_OD_BASE, 628 PALMAS_PRIMARY_SECONDARY_PAD2); 629 630 if (pdata->mux_from_pdata) { 631 reg = pdata->pad2; 632 ret = regmap_write(palmas->regmap[slave], addr, reg); 633 if (ret) 634 goto err_irq; 635 } else { 636 ret = regmap_read(palmas->regmap[slave], addr, ®); 637 if (ret) 638 goto err_irq; 639 } 640 641 if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_4)) 642 palmas->gpio_muxed |= PALMAS_GPIO_4_MUXED; 643 if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_5_MASK)) 644 palmas->gpio_muxed |= PALMAS_GPIO_5_MUXED; 645 if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_6)) 646 palmas->gpio_muxed |= PALMAS_GPIO_6_MUXED; 647 if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_7_MASK)) 648 palmas->gpio_muxed |= PALMAS_GPIO_7_MUXED; 649 650 dev_info(palmas->dev, "Muxing GPIO %x, PWM %x, LED %x\n", 651 palmas->gpio_muxed, palmas->pwm_muxed, 652 palmas->led_muxed); 653 654 reg = pdata->power_ctrl; 655 656 slave = PALMAS_BASE_TO_SLAVE(PALMAS_PMU_CONTROL_BASE); 657 addr = PALMAS_BASE_TO_REG(PALMAS_PMU_CONTROL_BASE, PALMAS_POWER_CTRL); 658 659 ret = regmap_write(palmas->regmap[slave], addr, reg); 660 if (ret) 661 goto err_irq; 662 663 /* 664 * If we are probing with DT do this the DT way and return here 665 * otherwise continue and add devices using mfd helpers. 666 */ 667 if (node) { 668 ret = of_platform_populate(node, NULL, NULL, &i2c->dev); 669 if (ret < 0) { 670 goto err_irq; 671 } else if (pdata->pm_off && !pm_power_off) { 672 palmas_dev = palmas; 673 pm_power_off = palmas_power_off; 674 } 675 } 676 677 return ret; 678 679 err_irq: 680 regmap_del_irq_chip(palmas->irq, palmas->irq_data); 681 err_i2c: 682 for (i = 1; i < PALMAS_NUM_CLIENTS; i++) { 683 if (palmas->i2c_clients[i]) 684 i2c_unregister_device(palmas->i2c_clients[i]); 685 } 686 return ret; 687 } 688 689 static int palmas_i2c_remove(struct i2c_client *i2c) 690 { 691 struct palmas *palmas = i2c_get_clientdata(i2c); 692 int i; 693 694 regmap_del_irq_chip(palmas->irq, palmas->irq_data); 695 696 for (i = 1; i < PALMAS_NUM_CLIENTS; i++) { 697 if (palmas->i2c_clients[i]) 698 i2c_unregister_device(palmas->i2c_clients[i]); 699 } 700 701 if (palmas == palmas_dev) { 702 pm_power_off = NULL; 703 palmas_dev = NULL; 704 } 705 706 return 0; 707 } 708 709 static const struct i2c_device_id palmas_i2c_id[] = { 710 { "palmas", }, 711 { "twl6035", }, 712 { "twl6037", }, 713 { "tps65913", }, 714 { /* end */ } 715 }; 716 MODULE_DEVICE_TABLE(i2c, palmas_i2c_id); 717 718 static struct i2c_driver palmas_i2c_driver = { 719 .driver = { 720 .name = "palmas", 721 .of_match_table = of_palmas_match_tbl, 722 }, 723 .probe = palmas_i2c_probe, 724 .remove = palmas_i2c_remove, 725 .id_table = palmas_i2c_id, 726 }; 727 728 static int __init palmas_i2c_init(void) 729 { 730 return i2c_add_driver(&palmas_i2c_driver); 731 } 732 /* init early so consumer devices can complete system boot */ 733 subsys_initcall(palmas_i2c_init); 734 735 static void __exit palmas_i2c_exit(void) 736 { 737 i2c_del_driver(&palmas_i2c_driver); 738 } 739 module_exit(palmas_i2c_exit); 740 741 MODULE_AUTHOR("Graeme Gregory <gg@slimlogic.co.uk>"); 742 MODULE_DESCRIPTION("Palmas chip family multi-function driver"); 743 MODULE_LICENSE("GPL"); 744