static irqreturn_t tps65090_charger_isr(int irq, void *dev_id) { struct tps65090_charger *charger = dev_id; int ret; uint8_t status1 = 0; uint8_t intrsts = 0; ret = tps65090_read(charger->dev->parent, TPS65090_REG_CG_STATUS1, &status1); if (ret < 0) { dev_err(charger->dev, "%s(): Error in reading reg 0x%x\n", __func__, TPS65090_REG_CG_STATUS1); return IRQ_HANDLED; } msleep(75); ret = tps65090_read(charger->dev->parent, TPS65090_REG_INTR_STS, &intrsts); if (ret < 0) { dev_err(charger->dev, "%s(): Error in reading reg 0x%x\n", __func__, TPS65090_REG_INTR_STS); return IRQ_HANDLED; } if (intrsts & TPS65090_VACG) { ret = tps65090_enable_charging(charger); if (ret < 0) return IRQ_HANDLED; charger->ac_online = 1; } else { charger->ac_online = 0; } /* Clear interrupts. */ if (!charger->passive_mode) { ret = tps65090_write(charger->dev->parent, TPS65090_REG_INTR_STS, 0x00); if (ret < 0) { dev_err(charger->dev, "%s(): Error in writing reg 0x%x\n", __func__, TPS65090_REG_INTR_STS); } } if (charger->prev_ac_online != charger->ac_online) power_supply_changed(&charger->ac); return IRQ_HANDLED; }
static int tps65090_charger_probe(struct platform_device *pdev) { struct tps65090_charger *cdata; struct tps65090_platform_data *pdata; uint8_t status1 = 0; int ret; int irq; pdata = dev_get_platdata(pdev->dev.parent); if (IS_ENABLED(CONFIG_OF) && !pdata && pdev->dev.of_node) pdata = tps65090_parse_dt_charger_data(pdev); if (!pdata) { dev_err(&pdev->dev, "%s():no platform data available\n", __func__); return -ENODEV; } cdata = devm_kzalloc(&pdev->dev, sizeof(*cdata), GFP_KERNEL); if (!cdata) { dev_err(&pdev->dev, "failed to allocate memory status\n"); return -ENOMEM; } platform_set_drvdata(pdev, cdata); cdata->dev = &pdev->dev; cdata->pdata = pdata; cdata->ac.name = "tps65090-ac"; cdata->ac.type = POWER_SUPPLY_TYPE_MAINS; cdata->ac.get_property = tps65090_ac_get_property; cdata->ac.properties = tps65090_ac_props; cdata->ac.num_properties = ARRAY_SIZE(tps65090_ac_props); cdata->ac.supplied_to = pdata->supplied_to; cdata->ac.num_supplicants = pdata->num_supplicants; cdata->ac.of_node = pdev->dev.of_node; ret = power_supply_register(&pdev->dev, &cdata->ac); if (ret) { dev_err(&pdev->dev, "failed: power supply register\n"); return ret; } irq = platform_get_irq(pdev, 0); if (irq <= 0) { dev_warn(&pdev->dev, "Unable to get charger irq = %d\n", irq); ret = irq; goto fail_unregister_supply; } cdata->irq = irq; ret = devm_request_threaded_irq(&pdev->dev, irq, NULL, tps65090_charger_isr, 0, "tps65090-charger", cdata); if (ret) { dev_err(cdata->dev, "Unable to register irq %d err %d\n", irq, ret); goto fail_unregister_supply; } ret = tps65090_config_charger(cdata); if (ret < 0) { dev_err(&pdev->dev, "charger config failed, err %d\n", ret); goto fail_unregister_supply; } /* Check for charger presence */ ret = tps65090_read(cdata->dev->parent, TPS65090_REG_CG_STATUS1, &status1); if (ret < 0) { dev_err(cdata->dev, "%s(): Error in reading reg 0x%x", __func__, TPS65090_REG_CG_STATUS1); goto fail_unregister_supply; } if (status1 != 0) { ret = tps65090_enable_charging(cdata); if (ret < 0) { dev_err(cdata->dev, "error enabling charger\n"); goto fail_unregister_supply; } cdata->ac_online = 1; power_supply_changed(&cdata->ac); } return 0; fail_unregister_supply: power_supply_unregister(&cdata->ac); return ret; }