drivers/mfd/palmas.c

   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_device(i2c->adapter,
 553                                                         i2c->addr + i);
 554                         if (IS_ERR(palmas->i2c_clients[i])) {
 555                                 dev_err(palmas->dev,
 556                                         "can't attach client %d\n", i);
 557                                 ret = PTR_ERR(palmas->i2c_clients[i]);
 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, &reg);
 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, &reg);
 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");