drivers/power/supply/axp20x_usb_power.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * AXP20x PMIC USB power supply status driver
   4  *
   5  * Copyright (C) 2015 Hans de Goede <hdegoede@redhat.com>
   6  * Copyright (C) 2014 Bruno Prémont <bonbons@linux-vserver.org>
   7  */
   8
   9 #include <linux/bitops.h>
  10 #include <linux/device.h>
  11 #include <linux/init.h>
  12 #include <linux/interrupt.h>
  13 #include <linux/kernel.h>
  14 #include <linux/mfd/axp20x.h>
  15 #include <linux/module.h>
  16 #include <linux/of.h>
  17 #include <linux/of_device.h>
  18 #include <linux/platform_device.h>
  19 #include <linux/pm.h>
  20 #include <linux/power_supply.h>
  21 #include <linux/regmap.h>
  22 #include <linux/slab.h>
  23 #include <linux/iio/consumer.h>
  24 #include <linux/workqueue.h>
  25
  26 #define DRVNAME "axp20x-usb-power-supply"
  27
  28 #define AXP20X_PWR_STATUS_VBUS_PRESENT  BIT(5)
  29 #define AXP20X_PWR_STATUS_VBUS_USED     BIT(4)
  30
  31 #define AXP20X_USB_STATUS_VBUS_VALID    BIT(2)
  32
  33 #define AXP20X_VBUS_PATH_SEL            BIT(7)
  34 #define AXP20X_VBUS_PATH_SEL_OFFSET     7
  35
  36 #define AXP20X_VBUS_VHOLD_uV(b)         (4000000 + (((b) >> 3) & 7) * 100000)
  37 #define AXP20X_VBUS_VHOLD_MASK          GENMASK(5, 3)
  38 #define AXP20X_VBUS_VHOLD_OFFSET        3
  39 #define AXP20X_VBUS_CLIMIT_MASK         3
  40 #define AXP20X_VBUS_CLIMIT_900mA        0
  41 #define AXP20X_VBUS_CLIMIT_500mA        1
  42 #define AXP20X_VBUS_CLIMIT_100mA        2
  43 #define AXP20X_VBUS_CLIMIT_NONE         3
  44
  45 #define AXP813_VBUS_CLIMIT_900mA        0
  46 #define AXP813_VBUS_CLIMIT_1500mA       1
  47 #define AXP813_VBUS_CLIMIT_2000mA       2
  48 #define AXP813_VBUS_CLIMIT_2500mA       3
  49
  50 #define AXP20X_ADC_EN1_VBUS_CURR        BIT(2)
  51 #define AXP20X_ADC_EN1_VBUS_VOLT        BIT(3)
  52
  53 #define AXP20X_VBUS_MON_VBUS_VALID      BIT(3)
  54
  55 #define AXP813_BC_EN            BIT(0)
  56
  57 /*
  58  * Note do not raise the debounce time, we must report Vusb high within
  59  * 100ms otherwise we get Vbus errors in musb.
  60  */
  61 #define DEBOUNCE_TIME                   msecs_to_jiffies(50)
  62
  63 struct axp20x_usb_power {
  64         struct regmap *regmap;
  65         struct power_supply *supply;
  66         enum axp20x_variants axp20x_id;
  67         struct iio_channel *vbus_v;
  68         struct iio_channel *vbus_i;
  69         struct delayed_work vbus_detect;
  70         unsigned int old_status;
  71         unsigned int online;
  72         unsigned int num_irqs;
  73         unsigned int irqs[];
  74 };
  75
  76 static bool axp20x_usb_vbus_needs_polling(struct axp20x_usb_power *power)
  77 {
  78         /*
  79          * Polling is only necessary while VBUS is offline. While online, a
  80          * present->absent transition implies an online->offline transition
  81          * and will trigger the VBUS_REMOVAL IRQ.
  82          */
  83         if (power->axp20x_id >= AXP221_ID && !power->online)
  84                 return true;
  85
  86         return false;
  87 }
  88
  89 static irqreturn_t axp20x_usb_power_irq(int irq, void *devid)
  90 {
  91         struct axp20x_usb_power *power = devid;
  92
  93         power_supply_changed(power->supply);
  94
  95         mod_delayed_work(system_power_efficient_wq, &power->vbus_detect, DEBOUNCE_TIME);
  96
  97         return IRQ_HANDLED;
  98 }
  99
 100 static void axp20x_usb_power_poll_vbus(struct work_struct *work)
 101 {
 102         struct axp20x_usb_power *power =
 103                 container_of(work, struct axp20x_usb_power, vbus_detect.work);
 104         unsigned int val;
 105         int ret;
 106
 107         ret = regmap_read(power->regmap, AXP20X_PWR_INPUT_STATUS, &val);
 108         if (ret)
 109                 goto out;
 110
 111         val &= (AXP20X_PWR_STATUS_VBUS_PRESENT | AXP20X_PWR_STATUS_VBUS_USED);
 112         if (val != power->old_status)
 113                 power_supply_changed(power->supply);
 114
 115         power->old_status = val;
 116         power->online = val & AXP20X_PWR_STATUS_VBUS_USED;
 117
 118 out:
 119         if (axp20x_usb_vbus_needs_polling(power))
 120                 mod_delayed_work(system_power_efficient_wq, &power->vbus_detect, DEBOUNCE_TIME);
 121 }
 122
 123 static int axp20x_get_current_max(struct axp20x_usb_power *power, int *val)
 124 {
 125         unsigned int v;
 126         int ret = regmap_read(power->regmap, AXP20X_VBUS_IPSOUT_MGMT, &v);
 127
 128         if (ret)
 129                 return ret;
 130
 131         switch (v & AXP20X_VBUS_CLIMIT_MASK) {
 132         case AXP20X_VBUS_CLIMIT_100mA:
 133                 if (power->axp20x_id == AXP221_ID)
 134                         *val = -1; /* No 100mA limit */
 135                 else
 136                         *val = 100000;
 137                 break;
 138         case AXP20X_VBUS_CLIMIT_500mA:
 139                 *val = 500000;
 140                 break;
 141         case AXP20X_VBUS_CLIMIT_900mA:
 142                 *val = 900000;
 143                 break;
 144         case AXP20X_VBUS_CLIMIT_NONE:
 145                 *val = -1;
 146                 break;
 147         }
 148
 149         return 0;
 150 }
 151
 152 static int axp813_get_current_max(struct axp20x_usb_power *power, int *val)
 153 {
 154         unsigned int v;
 155         int ret = regmap_read(power->regmap, AXP20X_VBUS_IPSOUT_MGMT, &v);
 156
 157         if (ret)
 158                 return ret;
 159
 160         switch (v & AXP20X_VBUS_CLIMIT_MASK) {
 161         case AXP813_VBUS_CLIMIT_900mA:
 162                 *val = 900000;
 163                 break;
 164         case AXP813_VBUS_CLIMIT_1500mA:
 165                 *val = 1500000;
 166                 break;
 167         case AXP813_VBUS_CLIMIT_2000mA:
 168                 *val = 2000000;
 169                 break;
 170         case AXP813_VBUS_CLIMIT_2500mA:
 171                 *val = 2500000;
 172                 break;
 173         }
 174         return 0;
 175 }
 176
 177 static int axp20x_usb_power_get_property(struct power_supply *psy,
 178         enum power_supply_property psp, union power_supply_propval *val)
 179 {
 180         struct axp20x_usb_power *power = power_supply_get_drvdata(psy);
 181         unsigned int input, v;
 182         int ret;
 183
 184         switch (psp) {
 185         case POWER_SUPPLY_PROP_VOLTAGE_MIN:
 186                 ret = regmap_read(power->regmap, AXP20X_VBUS_IPSOUT_MGMT, &v);
 187                 if (ret)
 188                         return ret;
 189
 190                 val->intval = AXP20X_VBUS_VHOLD_uV(v);
 191                 return 0;
 192         case POWER_SUPPLY_PROP_VOLTAGE_NOW:
 193                 if (IS_ENABLED(CONFIG_AXP20X_ADC)) {
 194                         ret = iio_read_channel_processed(power->vbus_v,
 195                                                          &val->intval);
 196                         if (ret)
 197                                 return ret;
 198
 199                         /*
 200                          * IIO framework gives mV but Power Supply framework
 201                          * gives uV.
 202                          */
 203                         val->intval *= 1000;
 204                         return 0;
 205                 }
 206
 207                 ret = axp20x_read_variable_width(power->regmap,
 208                                                  AXP20X_VBUS_V_ADC_H, 12);
 209                 if (ret < 0)
 210                         return ret;
 211
 212                 val->intval = ret * 1700; /* 1 step = 1.7 mV */
 213                 return 0;
 214         case POWER_SUPPLY_PROP_CURRENT_MAX:
 215                 if (power->axp20x_id == AXP813_ID)
 216                         return axp813_get_current_max(power, &val->intval);
 217                 return axp20x_get_current_max(power, &val->intval);
 218         case POWER_SUPPLY_PROP_CURRENT_NOW:
 219                 if (IS_ENABLED(CONFIG_AXP20X_ADC)) {
 220                         ret = iio_read_channel_processed(power->vbus_i,
 221                                                          &val->intval);
 222                         if (ret)
 223                                 return ret;
 224
 225                         /*
 226                          * IIO framework gives mA but Power Supply framework
 227                          * gives uA.
 228                          */
 229                         val->intval *= 1000;
 230                         return 0;
 231                 }
 232
 233                 ret = axp20x_read_variable_width(power->regmap,
 234                                                  AXP20X_VBUS_I_ADC_H, 12);
 235                 if (ret < 0)
 236                         return ret;
 237
 238                 val->intval = ret * 375; /* 1 step = 0.375 mA */
 239                 return 0;
 240         default:
 241                 break;
 242         }
 243
 244         /* All the properties below need the input-status reg value */
 245         ret = regmap_read(power->regmap, AXP20X_PWR_INPUT_STATUS, &input);
 246         if (ret)
 247                 return ret;
 248
 249         switch (psp) {
 250         case POWER_SUPPLY_PROP_HEALTH:
 251                 if (!(input & AXP20X_PWR_STATUS_VBUS_PRESENT)) {
 252                         val->intval = POWER_SUPPLY_HEALTH_UNKNOWN;
 253                         break;
 254                 }
 255
 256                 val->intval = POWER_SUPPLY_HEALTH_GOOD;
 257
 258                 if (power->axp20x_id == AXP202_ID) {
 259                         ret = regmap_read(power->regmap,
 260                                           AXP20X_USB_OTG_STATUS, &v);
 261                         if (ret)
 262                                 return ret;
 263
 264                         if (!(v & AXP20X_USB_STATUS_VBUS_VALID))
 265                                 val->intval =
 266                                         POWER_SUPPLY_HEALTH_UNSPEC_FAILURE;
 267                 }
 268                 break;
 269         case POWER_SUPPLY_PROP_PRESENT:
 270                 val->intval = !!(input & AXP20X_PWR_STATUS_VBUS_PRESENT);
 271                 break;
 272         case POWER_SUPPLY_PROP_ONLINE:
 273                 val->intval = !!(input & AXP20X_PWR_STATUS_VBUS_USED);
 274                 break;
 275         default:
 276                 return -EINVAL;
 277         }
 278
 279         return 0;
 280 }
 281
 282 static int axp813_usb_power_set_online(struct axp20x_usb_power *power,
 283                                        int intval)
 284 {
 285         int val = !intval << AXP20X_VBUS_PATH_SEL_OFFSET;
 286
 287         return regmap_update_bits(power->regmap,
 288                                   AXP20X_VBUS_IPSOUT_MGMT,
 289                                   AXP20X_VBUS_PATH_SEL, val);
 290 }
 291
 292 static int axp20x_usb_power_set_voltage_min(struct axp20x_usb_power *power,
 293                                             int intval)
 294 {
 295         int val;
 296
 297         switch (intval) {
 298         case 4000000:
 299         case 4100000:
 300         case 4200000:
 301         case 4300000:
 302         case 4400000:
 303         case 4500000:
 304         case 4600000:
 305         case 4700000:
 306                 val = (intval - 4000000) / 100000;
 307                 return regmap_update_bits(power->regmap,
 308                                           AXP20X_VBUS_IPSOUT_MGMT,
 309                                           AXP20X_VBUS_VHOLD_MASK,
 310                                           val << AXP20X_VBUS_VHOLD_OFFSET);
 311         default:
 312                 return -EINVAL;
 313         }
 314
 315         return -EINVAL;
 316 }
 317
 318 static int axp813_usb_power_set_current_max(struct axp20x_usb_power *power,
 319                                             int intval)
 320 {
 321         int val;
 322
 323         switch (intval) {
 324         case 900000:
 325                 return regmap_update_bits(power->regmap,
 326                                           AXP20X_VBUS_IPSOUT_MGMT,
 327                                           AXP20X_VBUS_CLIMIT_MASK,
 328                                           AXP813_VBUS_CLIMIT_900mA);
 329         case 1500000:
 330         case 2000000:
 331         case 2500000:
 332                 val = (intval - 1000000) / 500000;
 333                 return regmap_update_bits(power->regmap,
 334                                           AXP20X_VBUS_IPSOUT_MGMT,
 335                                           AXP20X_VBUS_CLIMIT_MASK, val);
 336         default:
 337                 return -EINVAL;
 338         }
 339
 340         return -EINVAL;
 341 }
 342
 343 static int axp20x_usb_power_set_current_max(struct axp20x_usb_power *power,
 344                                             int intval)
 345 {
 346         int val;
 347
 348         switch (intval) {
 349         case 100000:
 350                 if (power->axp20x_id == AXP221_ID)
 351                         return -EINVAL;
 352                 fallthrough;
 353         case 500000:
 354         case 900000:
 355                 val = (900000 - intval) / 400000;
 356                 return regmap_update_bits(power->regmap,
 357                                           AXP20X_VBUS_IPSOUT_MGMT,
 358                                           AXP20X_VBUS_CLIMIT_MASK, val);
 359         default:
 360                 return -EINVAL;
 361         }
 362
 363         return -EINVAL;
 364 }
 365
 366 static int axp20x_usb_power_set_property(struct power_supply *psy,
 367                                          enum power_supply_property psp,
 368                                          const union power_supply_propval *val)
 369 {
 370         struct axp20x_usb_power *power = power_supply_get_drvdata(psy);
 371
 372         switch (psp) {
 373         case POWER_SUPPLY_PROP_ONLINE:
 374                 if (power->axp20x_id != AXP813_ID)
 375                         return -EINVAL;
 376                 return axp813_usb_power_set_online(power, val->intval);
 377
 378         case POWER_SUPPLY_PROP_VOLTAGE_MIN:
 379                 return axp20x_usb_power_set_voltage_min(power, val->intval);
 380
 381         case POWER_SUPPLY_PROP_CURRENT_MAX:
 382                 if (power->axp20x_id == AXP813_ID)
 383                         return axp813_usb_power_set_current_max(power,
 384                                                                 val->intval);
 385                 return axp20x_usb_power_set_current_max(power, val->intval);
 386
 387         default:
 388                 return -EINVAL;
 389         }
 390
 391         return -EINVAL;
 392 }
 393
 394 static int axp20x_usb_power_prop_writeable(struct power_supply *psy,
 395                                            enum power_supply_property psp)
 396 {
 397         struct axp20x_usb_power *power = power_supply_get_drvdata(psy);
 398
 399         /*
 400          * The VBUS path select flag works differently on AXP288 and newer:
 401          *  - On AXP20x and AXP22x, the flag enables VBUS (ignoring N_VBUSEN).
 402          *  - On AXP288 and AXP8xx, the flag disables VBUS (ignoring N_VBUSEN).
 403          * We only expose the control on variants where it can be used to force
 404          * the VBUS input offline.
 405          */
 406         if (psp == POWER_SUPPLY_PROP_ONLINE)
 407                 return power->axp20x_id == AXP813_ID;
 408
 409         return psp == POWER_SUPPLY_PROP_VOLTAGE_MIN ||
 410                psp == POWER_SUPPLY_PROP_CURRENT_MAX;
 411 }
 412
 413 static enum power_supply_property axp20x_usb_power_properties[] = {
 414         POWER_SUPPLY_PROP_HEALTH,
 415         POWER_SUPPLY_PROP_PRESENT,
 416         POWER_SUPPLY_PROP_ONLINE,
 417         POWER_SUPPLY_PROP_VOLTAGE_MIN,
 418         POWER_SUPPLY_PROP_VOLTAGE_NOW,
 419         POWER_SUPPLY_PROP_CURRENT_MAX,
 420         POWER_SUPPLY_PROP_CURRENT_NOW,
 421 };
 422
 423 static enum power_supply_property axp22x_usb_power_properties[] = {
 424         POWER_SUPPLY_PROP_HEALTH,
 425         POWER_SUPPLY_PROP_PRESENT,
 426         POWER_SUPPLY_PROP_ONLINE,
 427         POWER_SUPPLY_PROP_VOLTAGE_MIN,
 428         POWER_SUPPLY_PROP_CURRENT_MAX,
 429 };
 430
 431 static const struct power_supply_desc axp20x_usb_power_desc = {
 432         .name = "axp20x-usb",
 433         .type = POWER_SUPPLY_TYPE_USB,
 434         .properties = axp20x_usb_power_properties,
 435         .num_properties = ARRAY_SIZE(axp20x_usb_power_properties),
 436         .property_is_writeable = axp20x_usb_power_prop_writeable,
 437         .get_property = axp20x_usb_power_get_property,
 438         .set_property = axp20x_usb_power_set_property,
 439 };
 440
 441 static const struct power_supply_desc axp22x_usb_power_desc = {
 442         .name = "axp20x-usb",
 443         .type = POWER_SUPPLY_TYPE_USB,
 444         .properties = axp22x_usb_power_properties,
 445         .num_properties = ARRAY_SIZE(axp22x_usb_power_properties),
 446         .property_is_writeable = axp20x_usb_power_prop_writeable,
 447         .get_property = axp20x_usb_power_get_property,
 448         .set_property = axp20x_usb_power_set_property,
 449 };
 450
 451 static const char * const axp20x_irq_names[] = {
 452         "VBUS_PLUGIN",
 453         "VBUS_REMOVAL",
 454         "VBUS_VALID",
 455         "VBUS_NOT_VALID",
 456 };
 457
 458 static const char * const axp22x_irq_names[] = {
 459         "VBUS_PLUGIN",
 460         "VBUS_REMOVAL",
 461 };
 462
 463 struct axp_data {
 464         const struct power_supply_desc  *power_desc;
 465         const char * const              *irq_names;
 466         unsigned int                    num_irq_names;
 467         enum axp20x_variants            axp20x_id;
 468 };
 469
 470 static const struct axp_data axp202_data = {
 471         .power_desc     = &axp20x_usb_power_desc,
 472         .irq_names      = axp20x_irq_names,
 473         .num_irq_names  = ARRAY_SIZE(axp20x_irq_names),
 474         .axp20x_id      = AXP202_ID,
 475 };
 476
 477 static const struct axp_data axp221_data = {
 478         .power_desc     = &axp22x_usb_power_desc,
 479         .irq_names      = axp22x_irq_names,
 480         .num_irq_names  = ARRAY_SIZE(axp22x_irq_names),
 481         .axp20x_id      = AXP221_ID,
 482 };
 483
 484 static const struct axp_data axp223_data = {
 485         .power_desc     = &axp22x_usb_power_desc,
 486         .irq_names      = axp22x_irq_names,
 487         .num_irq_names  = ARRAY_SIZE(axp22x_irq_names),
 488         .axp20x_id      = AXP223_ID,
 489 };
 490
 491 static const struct axp_data axp813_data = {
 492         .power_desc     = &axp22x_usb_power_desc,
 493         .irq_names      = axp22x_irq_names,
 494         .num_irq_names  = ARRAY_SIZE(axp22x_irq_names),
 495         .axp20x_id      = AXP813_ID,
 496 };
 497
 498 #ifdef CONFIG_PM_SLEEP
 499 static int axp20x_usb_power_suspend(struct device *dev)
 500 {
 501         struct axp20x_usb_power *power = dev_get_drvdata(dev);
 502         int i = 0;
 503
 504         /*
 505          * Allow wake via VBUS_PLUGIN only.
 506          *
 507          * As nested threaded IRQs are not automatically disabled during
 508          * suspend, we must explicitly disable the remainder of the IRQs.
 509          */
 510         if (device_may_wakeup(&power->supply->dev))
 511                 enable_irq_wake(power->irqs[i++]);
 512         while (i < power->num_irqs)
 513                 disable_irq(power->irqs[i++]);
 514
 515         return 0;
 516 }
 517
 518 static int axp20x_usb_power_resume(struct device *dev)
 519 {
 520         struct axp20x_usb_power *power = dev_get_drvdata(dev);
 521         int i = 0;
 522
 523         if (device_may_wakeup(&power->supply->dev))
 524                 disable_irq_wake(power->irqs[i++]);
 525         while (i < power->num_irqs)
 526                 enable_irq(power->irqs[i++]);
 527
 528         mod_delayed_work(system_power_efficient_wq, &power->vbus_detect, DEBOUNCE_TIME);
 529
 530         return 0;
 531 }
 532 #endif
 533
 534 static SIMPLE_DEV_PM_OPS(axp20x_usb_power_pm_ops, axp20x_usb_power_suspend,
 535                                                   axp20x_usb_power_resume);
 536
 537 static int configure_iio_channels(struct platform_device *pdev,
 538                                   struct axp20x_usb_power *power)
 539 {
 540         power->vbus_v = devm_iio_channel_get(&pdev->dev, "vbus_v");
 541         if (IS_ERR(power->vbus_v)) {
 542                 if (PTR_ERR(power->vbus_v) == -ENODEV)
 543                         return -EPROBE_DEFER;
 544                 return PTR_ERR(power->vbus_v);
 545         }
 546
 547         power->vbus_i = devm_iio_channel_get(&pdev->dev, "vbus_i");
 548         if (IS_ERR(power->vbus_i)) {
 549                 if (PTR_ERR(power->vbus_i) == -ENODEV)
 550                         return -EPROBE_DEFER;
 551                 return PTR_ERR(power->vbus_i);
 552         }
 553
 554         return 0;
 555 }
 556
 557 static int configure_adc_registers(struct axp20x_usb_power *power)
 558 {
 559         /* Enable vbus voltage and current measurement */
 560         return regmap_update_bits(power->regmap, AXP20X_ADC_EN1,
 561                                   AXP20X_ADC_EN1_VBUS_CURR |
 562                                   AXP20X_ADC_EN1_VBUS_VOLT,
 563                                   AXP20X_ADC_EN1_VBUS_CURR |
 564                                   AXP20X_ADC_EN1_VBUS_VOLT);
 565 }
 566
 567 static int axp20x_usb_power_probe(struct platform_device *pdev)
 568 {
 569         struct axp20x_dev *axp20x = dev_get_drvdata(pdev->dev.parent);
 570         struct power_supply_config psy_cfg = {};
 571         struct axp20x_usb_power *power;
 572         const struct axp_data *axp_data;
 573         int i, irq, ret;
 574
 575         if (!of_device_is_available(pdev->dev.of_node))
 576                 return -ENODEV;
 577
 578         if (!axp20x) {
 579                 dev_err(&pdev->dev, "Parent drvdata not set\n");
 580                 return -EINVAL;
 581         }
 582
 583         axp_data = of_device_get_match_data(&pdev->dev);
 584
 585         power = devm_kzalloc(&pdev->dev,
 586                              struct_size(power, irqs, axp_data->num_irq_names),
 587                              GFP_KERNEL);
 588         if (!power)
 589                 return -ENOMEM;
 590
 591         platform_set_drvdata(pdev, power);
 592
 593         power->axp20x_id = axp_data->axp20x_id;
 594         power->regmap = axp20x->regmap;
 595         power->num_irqs = axp_data->num_irq_names;
 596         INIT_DELAYED_WORK(&power->vbus_detect, axp20x_usb_power_poll_vbus);
 597
 598         if (power->axp20x_id == AXP202_ID) {
 599                 /* Enable vbus valid checking */
 600                 ret = regmap_update_bits(power->regmap, AXP20X_VBUS_MON,
 601                                          AXP20X_VBUS_MON_VBUS_VALID,
 602                                          AXP20X_VBUS_MON_VBUS_VALID);
 603                 if (ret)
 604                         return ret;
 605
 606                 if (IS_ENABLED(CONFIG_AXP20X_ADC))
 607                         ret = configure_iio_channels(pdev, power);
 608                 else
 609                         ret = configure_adc_registers(power);
 610
 611                 if (ret)
 612                         return ret;
 613         }
 614
 615         if (power->axp20x_id == AXP813_ID) {
 616                 /* Enable USB Battery Charging specification detection */
 617                 regmap_update_bits(axp20x->regmap, AXP288_BC_GLOBAL,
 618                                    AXP813_BC_EN, AXP813_BC_EN);
 619         }
 620
 621         psy_cfg.of_node = pdev->dev.of_node;
 622         psy_cfg.drv_data = power;
 623
 624         power->supply = devm_power_supply_register(&pdev->dev,
 625                                                    axp_data->power_desc,
 626                                                    &psy_cfg);
 627         if (IS_ERR(power->supply))
 628                 return PTR_ERR(power->supply);
 629
 630         /* Request irqs after registering, as irqs may trigger immediately */
 631         for (i = 0; i < axp_data->num_irq_names; i++) {
 632                 irq = platform_get_irq_byname(pdev, axp_data->irq_names[i]);
 633                 if (irq < 0) {
 634                         dev_err(&pdev->dev, "No IRQ for %s: %d\n",
 635                                 axp_data->irq_names[i], irq);
 636                         return irq;
 637                 }
 638                 power->irqs[i] = regmap_irq_get_virq(axp20x->regmap_irqc, irq);
 639                 ret = devm_request_any_context_irq(&pdev->dev, power->irqs[i],
 640                                                    axp20x_usb_power_irq, 0,
 641                                                    DRVNAME, power);
 642                 if (ret < 0) {
 643                         dev_err(&pdev->dev, "Error requesting %s IRQ: %d\n",
 644                                 axp_data->irq_names[i], ret);
 645                         return ret;
 646                 }
 647         }
 648
 649         if (axp20x_usb_vbus_needs_polling(power))
 650                 queue_delayed_work(system_power_efficient_wq, &power->vbus_detect, 0);
 651
 652         return 0;
 653 }
 654
 655 static int axp20x_usb_power_remove(struct platform_device *pdev)
 656 {
 657         struct axp20x_usb_power *power = platform_get_drvdata(pdev);
 658
 659         cancel_delayed_work_sync(&power->vbus_detect);
 660
 661         return 0;
 662 }
 663
 664 static const struct of_device_id axp20x_usb_power_match[] = {
 665         {
 666                 .compatible = "x-powers,axp202-usb-power-supply",
 667                 .data = &axp202_data,
 668         }, {
 669                 .compatible = "x-powers,axp221-usb-power-supply",
 670                 .data = &axp221_data,
 671         }, {
 672                 .compatible = "x-powers,axp223-usb-power-supply",
 673                 .data = &axp223_data,
 674         }, {
 675                 .compatible = "x-powers,axp813-usb-power-supply",
 676                 .data = &axp813_data,
 677         }, { /* sentinel */ }
 678 };
 679 MODULE_DEVICE_TABLE(of, axp20x_usb_power_match);
 680
 681 static struct platform_driver axp20x_usb_power_driver = {
 682         .probe = axp20x_usb_power_probe,
 683         .remove = axp20x_usb_power_remove,
 684         .driver = {
 685                 .name           = DRVNAME,
 686                 .of_match_table = axp20x_usb_power_match,
 687                 .pm             = &axp20x_usb_power_pm_ops,
 688         },
 689 };
 690
 691 module_platform_driver(axp20x_usb_power_driver);
 692
 693 MODULE_AUTHOR("Hans de Goede <hdegoede@redhat.com>");
 694 MODULE_DESCRIPTION("AXP20x PMIC USB power supply status driver");
 695 MODULE_LICENSE("GPL");