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