drivers/mfd/palmas.c

   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         u8 powerhold_mask;
 434         struct device_node *np = palmas_dev->dev->of_node;
 435
 436         if (of_property_read_bool(np, "ti,palmas-override-powerhold")) {
 437                 addr = PALMAS_BASE_TO_REG(PALMAS_PU_PD_OD_BASE,
 438                                           PALMAS_PRIMARY_SECONDARY_PAD2);
 439                 slave = PALMAS_BASE_TO_SLAVE(PALMAS_PU_PD_OD_BASE);
 440
 441                 if (of_device_is_compatible(np, "ti,tps65917"))
 442                         powerhold_mask =
 443                                 TPS65917_PRIMARY_SECONDARY_PAD2_GPIO_5_MASK;
 444                 else
 445                         powerhold_mask =
 446                                 PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_7_MASK;
 447
 448                 ret = regmap_update_bits(palmas_dev->regmap[slave], addr,
 449                                          powerhold_mask, 0);
 450                 if (ret)
 451                         dev_err(palmas_dev->dev,
 452                                 "Unable to write PRIMARY_SECONDARY_PAD2 %d\n",
 453                                 ret);
 454         }
 455
 456         slave = PALMAS_BASE_TO_SLAVE(PALMAS_PMU_CONTROL_BASE);
 457         addr = PALMAS_BASE_TO_REG(PALMAS_PMU_CONTROL_BASE, PALMAS_DEV_CTRL);
 458
 459         ret = regmap_update_bits(
 460                         palmas_dev->regmap[slave],
 461                         addr,
 462                         PALMAS_DEV_CTRL_DEV_ON,
 463                         0);
 464
 465         if (ret)
 466                 pr_err("%s: Unable to write to DEV_CTRL_DEV_ON: %d\n",
 467                                 __func__, ret);
 468 }
 469
 470 static unsigned int palmas_features = PALMAS_PMIC_FEATURE_SMPS10_BOOST;
 471 static unsigned int tps659038_features;
 472
 473 struct palmas_driver_data {
 474         unsigned int *features;
 475         struct regmap_irq_chip *irq_chip;
 476 };
 477
 478 static struct palmas_driver_data palmas_data = {
 479         .features = &palmas_features,
 480         .irq_chip = &palmas_irq_chip,
 481 };
 482
 483 static struct palmas_driver_data tps659038_data = {
 484         .features = &tps659038_features,
 485         .irq_chip = &palmas_irq_chip,
 486 };
 487
 488 static struct palmas_driver_data tps65917_data = {
 489         .features = &tps659038_features,
 490         .irq_chip = &tps65917_irq_chip,
 491 };
 492
 493 static const struct of_device_id of_palmas_match_tbl[] = {
 494         {
 495                 .compatible = "ti,palmas",
 496                 .data = &palmas_data,
 497         },
 498         {
 499                 .compatible = "ti,tps659038",
 500                 .data = &tps659038_data,
 501         },
 502         {
 503                 .compatible = "ti,tps65917",
 504                 .data = &tps65917_data,
 505         },
 506         { },
 507 };
 508 MODULE_DEVICE_TABLE(of, of_palmas_match_tbl);
 509
 510 static int palmas_i2c_probe(struct i2c_client *i2c,
 511                             const struct i2c_device_id *id)
 512 {
 513         struct palmas *palmas;
 514         struct palmas_platform_data *pdata;
 515         struct palmas_driver_data *driver_data;
 516         struct device_node *node = i2c->dev.of_node;
 517         int ret = 0, i;
 518         unsigned int reg, addr;
 519         int slave;
 520         const struct of_device_id *match;
 521
 522         pdata = dev_get_platdata(&i2c->dev);
 523
 524         if (node && !pdata) {
 525                 pdata = devm_kzalloc(&i2c->dev, sizeof(*pdata), GFP_KERNEL);
 526
 527                 if (!pdata)
 528                         return -ENOMEM;
 529
 530                 palmas_dt_to_pdata(i2c, pdata);
 531         }
 532
 533         if (!pdata)
 534                 return -EINVAL;
 535
 536         palmas = devm_kzalloc(&i2c->dev, sizeof(struct palmas), GFP_KERNEL);
 537         if (palmas == NULL)
 538                 return -ENOMEM;
 539
 540         i2c_set_clientdata(i2c, palmas);
 541         palmas->dev = &i2c->dev;
 542         palmas->irq = i2c->irq;
 543
 544         match = of_match_device(of_palmas_match_tbl, &i2c->dev);
 545
 546         if (!match)
 547                 return -ENODATA;
 548
 549         driver_data = (struct palmas_driver_data *)match->data;
 550         palmas->features = *driver_data->features;
 551
 552         for (i = 0; i < PALMAS_NUM_CLIENTS; i++) {
 553                 if (i == 0)
 554                         palmas->i2c_clients[i] = i2c;
 555                 else {
 556                         palmas->i2c_clients[i] =
 557                                         i2c_new_dummy(i2c->adapter,
 558                                                         i2c->addr + i);
 559                         if (!palmas->i2c_clients[i]) {
 560                                 dev_err(palmas->dev,
 561                                         "can't attach client %d\n", i);
 562                                 ret = -ENOMEM;
 563                                 goto err_i2c;
 564                         }
 565                         palmas->i2c_clients[i]->dev.of_node = of_node_get(node);
 566                 }
 567                 palmas->regmap[i] = devm_regmap_init_i2c(palmas->i2c_clients[i],
 568                                 &palmas_regmap_config[i]);
 569                 if (IS_ERR(palmas->regmap[i])) {
 570                         ret = PTR_ERR(palmas->regmap[i]);
 571                         dev_err(palmas->dev,
 572                                 "Failed to allocate regmap %d, err: %d\n",
 573                                 i, ret);
 574                         goto err_i2c;
 575                 }
 576         }
 577
 578         if (!palmas->irq) {
 579                 dev_warn(palmas->dev, "IRQ missing: skipping irq request\n");
 580                 goto no_irq;
 581         }
 582
 583         /* Change interrupt line output polarity */
 584         if (pdata->irq_flags & IRQ_TYPE_LEVEL_HIGH)
 585                 reg = PALMAS_POLARITY_CTRL_INT_POLARITY;
 586         else
 587                 reg = 0;
 588         ret = palmas_update_bits(palmas, PALMAS_PU_PD_OD_BASE,
 589                         PALMAS_POLARITY_CTRL, PALMAS_POLARITY_CTRL_INT_POLARITY,
 590                         reg);
 591         if (ret < 0) {
 592                 dev_err(palmas->dev, "POLARITY_CTRL update failed: %d\n", ret);
 593                 goto err_i2c;
 594         }
 595
 596         /* Change IRQ into clear on read mode for efficiency */
 597         slave = PALMAS_BASE_TO_SLAVE(PALMAS_INTERRUPT_BASE);
 598         addr = PALMAS_BASE_TO_REG(PALMAS_INTERRUPT_BASE, PALMAS_INT_CTRL);
 599         reg = PALMAS_INT_CTRL_INT_CLEAR;
 600
 601         regmap_write(palmas->regmap[slave], addr, reg);
 602
 603         ret = regmap_add_irq_chip(palmas->regmap[slave], palmas->irq,
 604                                   IRQF_ONESHOT | pdata->irq_flags, 0,
 605                                   driver_data->irq_chip, &palmas->irq_data);
 606         if (ret < 0)
 607                 goto err_i2c;
 608
 609 no_irq:
 610         slave = PALMAS_BASE_TO_SLAVE(PALMAS_PU_PD_OD_BASE);
 611         addr = PALMAS_BASE_TO_REG(PALMAS_PU_PD_OD_BASE,
 612                         PALMAS_PRIMARY_SECONDARY_PAD1);
 613
 614         if (pdata->mux_from_pdata) {
 615                 reg = pdata->pad1;
 616                 ret = regmap_write(palmas->regmap[slave], addr, reg);
 617                 if (ret)
 618                         goto err_irq;
 619         } else {
 620                 ret = regmap_read(palmas->regmap[slave], addr, &reg);
 621                 if (ret)
 622                         goto err_irq;
 623         }
 624
 625         if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_0))
 626                 palmas->gpio_muxed |= PALMAS_GPIO_0_MUXED;
 627         if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_MASK))
 628                 palmas->gpio_muxed |= PALMAS_GPIO_1_MUXED;
 629         else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_MASK) ==
 630                         (2 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_SHIFT))
 631                 palmas->led_muxed |= PALMAS_LED1_MUXED;
 632         else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_MASK) ==
 633                         (3 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_1_SHIFT))
 634                 palmas->pwm_muxed |= PALMAS_PWM1_MUXED;
 635         if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_MASK))
 636                 palmas->gpio_muxed |= PALMAS_GPIO_2_MUXED;
 637         else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_MASK) ==
 638                         (2 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_SHIFT))
 639                 palmas->led_muxed |= PALMAS_LED2_MUXED;
 640         else if ((reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_MASK) ==
 641                         (3 << PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_2_SHIFT))
 642                 palmas->pwm_muxed |= PALMAS_PWM2_MUXED;
 643         if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD1_GPIO_3))
 644                 palmas->gpio_muxed |= PALMAS_GPIO_3_MUXED;
 645
 646         addr = PALMAS_BASE_TO_REG(PALMAS_PU_PD_OD_BASE,
 647                         PALMAS_PRIMARY_SECONDARY_PAD2);
 648
 649         if (pdata->mux_from_pdata) {
 650                 reg = pdata->pad2;
 651                 ret = regmap_write(palmas->regmap[slave], addr, reg);
 652                 if (ret)
 653                         goto err_irq;
 654         } else {
 655                 ret = regmap_read(palmas->regmap[slave], addr, &reg);
 656                 if (ret)
 657                         goto err_irq;
 658         }
 659
 660         if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_4))
 661                 palmas->gpio_muxed |= PALMAS_GPIO_4_MUXED;
 662         if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_5_MASK))
 663                 palmas->gpio_muxed |= PALMAS_GPIO_5_MUXED;
 664         if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_6))
 665                 palmas->gpio_muxed |= PALMAS_GPIO_6_MUXED;
 666         if (!(reg & PALMAS_PRIMARY_SECONDARY_PAD2_GPIO_7_MASK))
 667                 palmas->gpio_muxed |= PALMAS_GPIO_7_MUXED;
 668
 669         dev_info(palmas->dev, "Muxing GPIO %x, PWM %x, LED %x\n",
 670                         palmas->gpio_muxed, palmas->pwm_muxed,
 671                         palmas->led_muxed);
 672
 673         reg = pdata->power_ctrl;
 674
 675         slave = PALMAS_BASE_TO_SLAVE(PALMAS_PMU_CONTROL_BASE);
 676         addr = PALMAS_BASE_TO_REG(PALMAS_PMU_CONTROL_BASE, PALMAS_POWER_CTRL);
 677
 678         ret = regmap_write(palmas->regmap[slave], addr, reg);
 679         if (ret)
 680                 goto err_irq;
 681
 682         /*
 683          * If we are probing with DT do this the DT way and return here
 684          * otherwise continue and add devices using mfd helpers.
 685          */
 686         if (node) {
 687                 ret = devm_of_platform_populate(&i2c->dev);
 688                 if (ret < 0) {
 689                         goto err_irq;
 690                 } else if (pdata->pm_off && !pm_power_off) {
 691                         palmas_dev = palmas;
 692                         pm_power_off = palmas_power_off;
 693                 }
 694         }
 695
 696         return ret;
 697
 698 err_irq:
 699         regmap_del_irq_chip(palmas->irq, palmas->irq_data);
 700 err_i2c:
 701         for (i = 1; i < PALMAS_NUM_CLIENTS; i++) {
 702                 if (palmas->i2c_clients[i])
 703                         i2c_unregister_device(palmas->i2c_clients[i]);
 704         }
 705         return ret;
 706 }
 707
 708 static int palmas_i2c_remove(struct i2c_client *i2c)
 709 {
 710         struct palmas *palmas = i2c_get_clientdata(i2c);
 711         int i;
 712
 713         regmap_del_irq_chip(palmas->irq, palmas->irq_data);
 714
 715         for (i = 1; i < PALMAS_NUM_CLIENTS; i++) {
 716                 if (palmas->i2c_clients[i])
 717                         i2c_unregister_device(palmas->i2c_clients[i]);
 718         }
 719
 720         if (palmas == palmas_dev) {
 721                 pm_power_off = NULL;
 722                 palmas_dev = NULL;
 723         }
 724
 725         return 0;
 726 }
 727
 728 static const struct i2c_device_id palmas_i2c_id[] = {
 729         { "palmas", },
 730         { "twl6035", },
 731         { "twl6037", },
 732         { "tps65913", },
 733         { /* end */ }
 734 };
 735 MODULE_DEVICE_TABLE(i2c, palmas_i2c_id);
 736
 737 static struct i2c_driver palmas_i2c_driver = {
 738         .driver = {
 739                    .name = "palmas",
 740                    .of_match_table = of_palmas_match_tbl,
 741         },
 742         .probe = palmas_i2c_probe,
 743         .remove = palmas_i2c_remove,
 744         .id_table = palmas_i2c_id,
 745 };
 746
 747 static int __init palmas_i2c_init(void)
 748 {
 749         return i2c_add_driver(&palmas_i2c_driver);
 750 }
 751 /* init early so consumer devices can complete system boot */
 752 subsys_initcall(palmas_i2c_init);
 753
 754 static void __exit palmas_i2c_exit(void)
 755 {
 756         i2c_del_driver(&palmas_i2c_driver);
 757 }
 758 module_exit(palmas_i2c_exit);
 759
 760 MODULE_AUTHOR("Graeme Gregory <gg@slimlogic.co.uk>");
 761 MODULE_DESCRIPTION("Palmas chip family multi-function driver");
 762 MODULE_LICENSE("GPL");