| // SPDX-License-Identifier: GPL-2.0-only |
| // Copyright (c) 2020, The Linux Foundation. All rights reserved. |
| |
| #include <linux/module.h> |
| #include <linux/of_irq.h> |
| #include <linux/of.h> |
| #include <linux/of_device.h> |
| #include <linux/platform_device.h> |
| #include <linux/regmap.h> |
| #include <linux/regulator/driver.h> |
| #include <linux/regulator/of_regulator.h> |
| |
| #define REG_PERPH_TYPE 0x04 |
| |
| #define QCOM_LAB_TYPE 0x24 |
| #define QCOM_IBB_TYPE 0x20 |
| |
| #define PMI8998_LAB_REG_BASE 0xde00 |
| #define PMI8998_IBB_REG_BASE 0xdc00 |
| #define PMI8998_IBB_LAB_REG_OFFSET 0x200 |
| |
| #define REG_LABIBB_STATUS1 0x08 |
| #define LABIBB_STATUS1_SC_BIT BIT(6) |
| #define LABIBB_STATUS1_VREG_OK_BIT BIT(7) |
| |
| #define REG_LABIBB_INT_SET_TYPE 0x11 |
| #define REG_LABIBB_INT_POLARITY_HIGH 0x12 |
| #define REG_LABIBB_INT_POLARITY_LOW 0x13 |
| #define REG_LABIBB_INT_LATCHED_CLR 0x14 |
| #define REG_LABIBB_INT_EN_SET 0x15 |
| #define REG_LABIBB_INT_EN_CLR 0x16 |
| #define LABIBB_INT_VREG_OK BIT(0) |
| #define LABIBB_INT_VREG_TYPE_LEVEL 0 |
| |
| #define REG_LABIBB_VOLTAGE 0x41 |
| #define LABIBB_VOLTAGE_OVERRIDE_EN BIT(7) |
| #define LAB_VOLTAGE_SET_MASK GENMASK(3, 0) |
| #define IBB_VOLTAGE_SET_MASK GENMASK(5, 0) |
| |
| #define REG_LABIBB_ENABLE_CTL 0x46 |
| #define LABIBB_CONTROL_ENABLE BIT(7) |
| |
| #define REG_LABIBB_PD_CTL 0x47 |
| #define LAB_PD_CTL_MASK GENMASK(1, 0) |
| #define IBB_PD_CTL_MASK (BIT(0) | BIT(7)) |
| #define LAB_PD_CTL_STRONG_PULL BIT(0) |
| #define IBB_PD_CTL_HALF_STRENGTH BIT(0) |
| #define IBB_PD_CTL_EN BIT(7) |
| |
| #define REG_LABIBB_CURRENT_LIMIT 0x4b |
| #define LAB_CURRENT_LIMIT_MASK GENMASK(2, 0) |
| #define IBB_CURRENT_LIMIT_MASK GENMASK(4, 0) |
| #define LAB_CURRENT_LIMIT_OVERRIDE_EN BIT(3) |
| #define LABIBB_CURRENT_LIMIT_EN BIT(7) |
| |
| #define REG_IBB_PWRUP_PWRDN_CTL_1 0x58 |
| #define IBB_CTL_1_DISCHARGE_EN BIT(2) |
| |
| #define REG_LABIBB_SOFT_START_CTL 0x5f |
| #define REG_LABIBB_SEC_ACCESS 0xd0 |
| #define LABIBB_SEC_UNLOCK_CODE 0xa5 |
| |
| #define LAB_ENABLE_CTL_MASK BIT(7) |
| #define IBB_ENABLE_CTL_MASK (BIT(7) | BIT(6)) |
| |
| #define LABIBB_OFF_ON_DELAY 1000 |
| #define LAB_ENABLE_TIME (LABIBB_OFF_ON_DELAY * 2) |
| #define IBB_ENABLE_TIME (LABIBB_OFF_ON_DELAY * 10) |
| #define LABIBB_POLL_ENABLED_TIME 1000 |
| #define OCP_RECOVERY_INTERVAL_MS 500 |
| #define SC_RECOVERY_INTERVAL_MS 250 |
| #define LABIBB_MAX_OCP_COUNT 4 |
| #define LABIBB_MAX_SC_COUNT 3 |
| #define LABIBB_MAX_FATAL_COUNT 2 |
| |
| struct labibb_current_limits { |
| u32 uA_min; |
| u32 uA_step; |
| u8 ovr_val; |
| }; |
| |
| struct labibb_regulator { |
| struct regulator_desc desc; |
| struct device *dev; |
| struct regmap *regmap; |
| struct regulator_dev *rdev; |
| struct labibb_current_limits uA_limits; |
| struct delayed_work ocp_recovery_work; |
| struct delayed_work sc_recovery_work; |
| u16 base; |
| u8 type; |
| u8 dischg_sel; |
| u8 soft_start_sel; |
| int sc_irq; |
| int sc_count; |
| int ocp_irq; |
| int ocp_irq_count; |
| int fatal_count; |
| }; |
| |
| struct labibb_regulator_data { |
| const char *name; |
| u8 type; |
| u16 base; |
| const struct regulator_desc *desc; |
| }; |
| |
| static int qcom_labibb_ocp_hw_enable(struct regulator_dev *rdev) |
| { |
| struct labibb_regulator *vreg = rdev_get_drvdata(rdev); |
| int ret; |
| |
| /* Clear irq latch status to avoid spurious event */ |
| ret = regmap_update_bits(rdev->regmap, |
| vreg->base + REG_LABIBB_INT_LATCHED_CLR, |
| LABIBB_INT_VREG_OK, 1); |
| if (ret) |
| return ret; |
| |
| /* Enable OCP HW interrupt */ |
| return regmap_update_bits(rdev->regmap, |
| vreg->base + REG_LABIBB_INT_EN_SET, |
| LABIBB_INT_VREG_OK, 1); |
| } |
| |
| static int qcom_labibb_ocp_hw_disable(struct regulator_dev *rdev) |
| { |
| struct labibb_regulator *vreg = rdev_get_drvdata(rdev); |
| |
| return regmap_update_bits(rdev->regmap, |
| vreg->base + REG_LABIBB_INT_EN_CLR, |
| LABIBB_INT_VREG_OK, 1); |
| } |
| |
| /** |
| * qcom_labibb_check_ocp_status - Check the Over-Current Protection status |
| * @vreg: Main driver structure |
| * |
| * This function checks the STATUS1 register for the VREG_OK bit: if it is |
| * set, then there is no Over-Current event. |
| * |
| * Returns: Zero if there is no over-current, 1 if in over-current or |
| * negative number for error |
| */ |
| static int qcom_labibb_check_ocp_status(struct labibb_regulator *vreg) |
| { |
| u32 cur_status; |
| int ret; |
| |
| ret = regmap_read(vreg->rdev->regmap, vreg->base + REG_LABIBB_STATUS1, |
| &cur_status); |
| if (ret) |
| return ret; |
| |
| return !(cur_status & LABIBB_STATUS1_VREG_OK_BIT); |
| } |
| |
| /** |
| * qcom_labibb_ocp_recovery_worker - Handle OCP event |
| * @work: OCP work structure |
| * |
| * This is the worker function to handle the Over Current Protection |
| * hardware event; This will check if the hardware is still |
| * signaling an over-current condition and will eventually stop |
| * the regulator if such condition is still signaled after |
| * LABIBB_MAX_OCP_COUNT times. |
| * |
| * If the driver that is consuming the regulator did not take action |
| * for the OCP condition, or the hardware did not stabilize, a cut |
| * of the LAB and IBB regulators will be forced (regulators will be |
| * disabled). |
| * |
| * As last, if the writes to shut down the LAB/IBB regulators fail |
| * for more than LABIBB_MAX_FATAL_COUNT, then a kernel panic will be |
| * triggered, as a last resort to protect the hardware from burning; |
| * this, however, is expected to never happen, but this is kept to |
| * try to further ensure that we protect the hardware at all costs. |
| */ |
| static void qcom_labibb_ocp_recovery_worker(struct work_struct *work) |
| { |
| struct labibb_regulator *vreg; |
| const struct regulator_ops *ops; |
| int ret; |
| |
| vreg = container_of(work, struct labibb_regulator, |
| ocp_recovery_work.work); |
| ops = vreg->rdev->desc->ops; |
| |
| if (vreg->ocp_irq_count >= LABIBB_MAX_OCP_COUNT) { |
| /* |
| * If we tried to disable the regulator multiple times but |
| * we kept failing, there's only one last hope to save our |
| * hardware from the death: raise a kernel bug, reboot and |
| * hope that the bootloader kindly saves us. This, though |
| * is done only as paranoid checking, because failing the |
| * regmap write to disable the vreg is almost impossible, |
| * since we got here after multiple regmap R/W. |
| */ |
| BUG_ON(vreg->fatal_count > LABIBB_MAX_FATAL_COUNT); |
| dev_err(&vreg->rdev->dev, "LABIBB: CRITICAL: Disabling regulator\n"); |
| |
| /* Disable the regulator immediately to avoid damage */ |
| ret = ops->disable(vreg->rdev); |
| if (ret) { |
| vreg->fatal_count++; |
| goto reschedule; |
| } |
| enable_irq(vreg->ocp_irq); |
| vreg->fatal_count = 0; |
| return; |
| } |
| |
| ret = qcom_labibb_check_ocp_status(vreg); |
| if (ret != 0) { |
| vreg->ocp_irq_count++; |
| goto reschedule; |
| } |
| |
| ret = qcom_labibb_ocp_hw_enable(vreg->rdev); |
| if (ret) { |
| /* We cannot trust it without OCP enabled. */ |
| dev_err(vreg->dev, "Cannot enable OCP IRQ\n"); |
| vreg->ocp_irq_count++; |
| goto reschedule; |
| } |
| |
| enable_irq(vreg->ocp_irq); |
| /* Everything went fine: reset the OCP count! */ |
| vreg->ocp_irq_count = 0; |
| return; |
| |
| reschedule: |
| mod_delayed_work(system_wq, &vreg->ocp_recovery_work, |
| msecs_to_jiffies(OCP_RECOVERY_INTERVAL_MS)); |
| } |
| |
| /** |
| * qcom_labibb_ocp_isr - Interrupt routine for OverCurrent Protection |
| * @irq: Interrupt number |
| * @chip: Main driver structure |
| * |
| * Over Current Protection (OCP) will signal to the client driver |
| * that an over-current event has happened and then will schedule |
| * a recovery worker. |
| * |
| * Disabling and eventually re-enabling the regulator is expected |
| * to be done by the driver, as some hardware may be triggering an |
| * over-current condition only at first initialization or it may |
| * be expected only for a very brief amount of time, after which |
| * the attached hardware may be expected to stabilize its current |
| * draw. |
| * |
| * Returns: IRQ_HANDLED for success or IRQ_NONE for failure. |
| */ |
| static irqreturn_t qcom_labibb_ocp_isr(int irq, void *chip) |
| { |
| struct labibb_regulator *vreg = chip; |
| const struct regulator_ops *ops = vreg->rdev->desc->ops; |
| int ret; |
| |
| /* If the regulator is not enabled, this is a fake event */ |
| if (!ops->is_enabled(vreg->rdev)) |
| return IRQ_HANDLED; |
| |
| /* If we tried to recover for too many times it's not getting better */ |
| if (vreg->ocp_irq_count > LABIBB_MAX_OCP_COUNT) |
| return IRQ_NONE; |
| |
| /* |
| * If we (unlikely) can't read this register, to prevent hardware |
| * damage at all costs, we assume that the overcurrent event was |
| * real; Moreover, if the status register is not signaling OCP, |
| * it was a spurious event, so it's all ok. |
| */ |
| ret = qcom_labibb_check_ocp_status(vreg); |
| if (ret == 0) { |
| vreg->ocp_irq_count = 0; |
| goto end; |
| } |
| vreg->ocp_irq_count++; |
| |
| /* |
| * Disable the interrupt temporarily, or it will fire continuously; |
| * we will re-enable it in the recovery worker function. |
| */ |
| disable_irq_nosync(irq); |
| |
| /* Warn the user for overcurrent */ |
| dev_warn(vreg->dev, "Over-Current interrupt fired!\n"); |
| |
| /* Disable the interrupt to avoid hogging */ |
| ret = qcom_labibb_ocp_hw_disable(vreg->rdev); |
| if (ret) |
| goto end; |
| |
| /* Signal overcurrent event to drivers */ |
| regulator_notifier_call_chain(vreg->rdev, |
| REGULATOR_EVENT_OVER_CURRENT, NULL); |
| |
| end: |
| /* Schedule the recovery work */ |
| schedule_delayed_work(&vreg->ocp_recovery_work, |
| msecs_to_jiffies(OCP_RECOVERY_INTERVAL_MS)); |
| if (ret) |
| return IRQ_NONE; |
| |
| return IRQ_HANDLED; |
| } |
| |
| static int qcom_labibb_set_ocp(struct regulator_dev *rdev, int lim, |
| int severity, bool enable) |
| { |
| struct labibb_regulator *vreg = rdev_get_drvdata(rdev); |
| char *ocp_irq_name; |
| u32 irq_flags = IRQF_ONESHOT; |
| int irq_trig_low, ret; |
| |
| /* |
| * labibb supports only protection - and does not support setting |
| * limit. Furthermore, we don't support disabling protection. |
| */ |
| if (lim || severity != REGULATOR_SEVERITY_PROT || !enable) |
| return -EINVAL; |
| |
| /* If there is no OCP interrupt, there's nothing to set */ |
| if (vreg->ocp_irq <= 0) |
| return -EINVAL; |
| |
| ocp_irq_name = devm_kasprintf(vreg->dev, GFP_KERNEL, "%s-over-current", |
| vreg->desc.name); |
| if (!ocp_irq_name) |
| return -ENOMEM; |
| |
| /* IRQ polarities - LAB: trigger-low, IBB: trigger-high */ |
| switch (vreg->type) { |
| case QCOM_LAB_TYPE: |
| irq_flags |= IRQF_TRIGGER_LOW; |
| irq_trig_low = 1; |
| break; |
| case QCOM_IBB_TYPE: |
| irq_flags |= IRQF_TRIGGER_HIGH; |
| irq_trig_low = 0; |
| break; |
| default: |
| return -EINVAL; |
| } |
| |
| /* Activate OCP HW level interrupt */ |
| ret = regmap_update_bits(rdev->regmap, |
| vreg->base + REG_LABIBB_INT_SET_TYPE, |
| LABIBB_INT_VREG_OK, |
| LABIBB_INT_VREG_TYPE_LEVEL); |
| if (ret) |
| return ret; |
| |
| /* Set OCP interrupt polarity */ |
| ret = regmap_update_bits(rdev->regmap, |
| vreg->base + REG_LABIBB_INT_POLARITY_HIGH, |
| LABIBB_INT_VREG_OK, !irq_trig_low); |
| if (ret) |
| return ret; |
| ret = regmap_update_bits(rdev->regmap, |
| vreg->base + REG_LABIBB_INT_POLARITY_LOW, |
| LABIBB_INT_VREG_OK, irq_trig_low); |
| if (ret) |
| return ret; |
| |
| ret = qcom_labibb_ocp_hw_enable(rdev); |
| if (ret) |
| return ret; |
| |
| return devm_request_threaded_irq(vreg->dev, vreg->ocp_irq, NULL, |
| qcom_labibb_ocp_isr, irq_flags, |
| ocp_irq_name, vreg); |
| } |
| |
| /** |
| * qcom_labibb_check_sc_status - Check the Short Circuit Protection status |
| * @vreg: Main driver structure |
| * |
| * This function checks the STATUS1 register on both LAB and IBB regulators |
| * for the ShortCircuit bit: if it is set on *any* of them, then we have |
| * experienced a short-circuit event. |
| * |
| * Returns: Zero if there is no short-circuit, 1 if in short-circuit or |
| * negative number for error |
| */ |
| static int qcom_labibb_check_sc_status(struct labibb_regulator *vreg) |
| { |
| u32 ibb_status, ibb_reg, lab_status, lab_reg; |
| int ret; |
| |
| /* We have to work on both regulators due to PBS... */ |
| lab_reg = ibb_reg = vreg->base + REG_LABIBB_STATUS1; |
| if (vreg->type == QCOM_LAB_TYPE) |
| ibb_reg -= PMI8998_IBB_LAB_REG_OFFSET; |
| else |
| lab_reg += PMI8998_IBB_LAB_REG_OFFSET; |
| |
| ret = regmap_read(vreg->rdev->regmap, lab_reg, &lab_status); |
| if (ret) |
| return ret; |
| ret = regmap_read(vreg->rdev->regmap, ibb_reg, &ibb_status); |
| if (ret) |
| return ret; |
| |
| return !!(lab_status & LABIBB_STATUS1_SC_BIT) || |
| !!(ibb_status & LABIBB_STATUS1_SC_BIT); |
| } |
| |
| /** |
| * qcom_labibb_sc_recovery_worker - Handle Short Circuit event |
| * @work: SC work structure |
| * |
| * This is the worker function to handle the Short Circuit Protection |
| * hardware event; This will check if the hardware is still |
| * signaling a short-circuit condition and will eventually never |
| * re-enable the regulator if such condition is still signaled after |
| * LABIBB_MAX_SC_COUNT times. |
| * |
| * If the driver that is consuming the regulator did not take action |
| * for the SC condition, or the hardware did not stabilize, this |
| * worker will stop rescheduling, leaving the regulators disabled |
| * as already done by the Portable Batch System (PBS). |
| * |
| * Returns: IRQ_HANDLED for success or IRQ_NONE for failure. |
| */ |
| static void qcom_labibb_sc_recovery_worker(struct work_struct *work) |
| { |
| struct labibb_regulator *vreg; |
| const struct regulator_ops *ops; |
| u32 lab_reg, ibb_reg, lab_val, ibb_val, val; |
| bool pbs_cut = false; |
| int i, sc, ret; |
| |
| vreg = container_of(work, struct labibb_regulator, |
| sc_recovery_work.work); |
| ops = vreg->rdev->desc->ops; |
| |
| /* |
| * If we tried to check the regulator status multiple times but we |
| * kept failing, then just bail out, as the Portable Batch System |
| * (PBS) will disable the vregs for us, preventing hardware damage. |
| */ |
| if (vreg->fatal_count > LABIBB_MAX_FATAL_COUNT) |
| return; |
| |
| /* Too many short-circuit events. Throw in the towel. */ |
| if (vreg->sc_count > LABIBB_MAX_SC_COUNT) |
| return; |
| |
| /* |
| * The Portable Batch System (PBS) automatically disables LAB |
| * and IBB when a short-circuit event is detected, so we have to |
| * check and work on both of them at the same time. |
| */ |
| lab_reg = ibb_reg = vreg->base + REG_LABIBB_ENABLE_CTL; |
| if (vreg->type == QCOM_LAB_TYPE) |
| ibb_reg -= PMI8998_IBB_LAB_REG_OFFSET; |
| else |
| lab_reg += PMI8998_IBB_LAB_REG_OFFSET; |
| |
| sc = qcom_labibb_check_sc_status(vreg); |
| if (sc) |
| goto reschedule; |
| |
| for (i = 0; i < LABIBB_MAX_SC_COUNT; i++) { |
| ret = regmap_read(vreg->regmap, lab_reg, &lab_val); |
| if (ret) { |
| vreg->fatal_count++; |
| goto reschedule; |
| } |
| |
| ret = regmap_read(vreg->regmap, ibb_reg, &ibb_val); |
| if (ret) { |
| vreg->fatal_count++; |
| goto reschedule; |
| } |
| val = lab_val & ibb_val; |
| |
| if (!(val & LABIBB_CONTROL_ENABLE)) { |
| pbs_cut = true; |
| break; |
| } |
| usleep_range(5000, 6000); |
| } |
| if (pbs_cut) |
| goto reschedule; |
| |
| |
| /* |
| * If we have reached this point, we either have successfully |
| * recovered from the SC condition or we had a spurious SC IRQ, |
| * which means that we can re-enable the regulators, if they |
| * have ever been disabled by the PBS. |
| */ |
| ret = ops->enable(vreg->rdev); |
| if (ret) |
| goto reschedule; |
| |
| /* Everything went fine: reset the OCP count! */ |
| vreg->sc_count = 0; |
| enable_irq(vreg->sc_irq); |
| return; |
| |
| reschedule: |
| /* |
| * Now that we have done basic handling of the short-circuit, |
| * reschedule this worker in the regular system workqueue, as |
| * taking action is not truly urgent anymore. |
| */ |
| vreg->sc_count++; |
| mod_delayed_work(system_wq, &vreg->sc_recovery_work, |
| msecs_to_jiffies(SC_RECOVERY_INTERVAL_MS)); |
| } |
| |
| /** |
| * qcom_labibb_sc_isr - Interrupt routine for Short Circuit Protection |
| * @irq: Interrupt number |
| * @chip: Main driver structure |
| * |
| * Short Circuit Protection (SCP) will signal to the client driver |
| * that a regulation-out event has happened and then will schedule |
| * a recovery worker. |
| * |
| * The LAB and IBB regulators will be automatically disabled by the |
| * Portable Batch System (PBS) and they will be enabled again by |
| * the worker function if the hardware stops signaling the short |
| * circuit event. |
| * |
| * Returns: IRQ_HANDLED for success or IRQ_NONE for failure. |
| */ |
| static irqreturn_t qcom_labibb_sc_isr(int irq, void *chip) |
| { |
| struct labibb_regulator *vreg = chip; |
| |
| if (vreg->sc_count > LABIBB_MAX_SC_COUNT) |
| return IRQ_NONE; |
| |
| /* Warn the user for short circuit */ |
| dev_warn(vreg->dev, "Short-Circuit interrupt fired!\n"); |
| |
| /* |
| * Disable the interrupt temporarily, or it will fire continuously; |
| * we will re-enable it in the recovery worker function. |
| */ |
| disable_irq_nosync(irq); |
| |
| /* Signal out of regulation event to drivers */ |
| regulator_notifier_call_chain(vreg->rdev, |
| REGULATOR_EVENT_REGULATION_OUT, NULL); |
| |
| /* Schedule the short-circuit handling as high-priority work */ |
| mod_delayed_work(system_highpri_wq, &vreg->sc_recovery_work, |
| msecs_to_jiffies(SC_RECOVERY_INTERVAL_MS)); |
| return IRQ_HANDLED; |
| } |
| |
| |
| static int qcom_labibb_set_current_limit(struct regulator_dev *rdev, |
| int min_uA, int max_uA) |
| { |
| struct labibb_regulator *vreg = rdev_get_drvdata(rdev); |
| struct regulator_desc *desc = &vreg->desc; |
| struct labibb_current_limits *lim = &vreg->uA_limits; |
| u32 mask, val; |
| int i, ret, sel = -1; |
| |
| if (min_uA < lim->uA_min || max_uA < lim->uA_min) |
| return -EINVAL; |
| |
| for (i = 0; i < desc->n_current_limits; i++) { |
| int uA_limit = (lim->uA_step * i) + lim->uA_min; |
| |
| if (max_uA >= uA_limit && min_uA <= uA_limit) |
| sel = i; |
| } |
| if (sel < 0) |
| return -EINVAL; |
| |
| /* Current limit setting needs secure access */ |
| ret = regmap_write(vreg->regmap, vreg->base + REG_LABIBB_SEC_ACCESS, |
| LABIBB_SEC_UNLOCK_CODE); |
| if (ret) |
| return ret; |
| |
| mask = desc->csel_mask | lim->ovr_val; |
| mask |= LABIBB_CURRENT_LIMIT_EN; |
| val = (u32)sel | lim->ovr_val; |
| val |= LABIBB_CURRENT_LIMIT_EN; |
| |
| return regmap_update_bits(vreg->regmap, desc->csel_reg, mask, val); |
| } |
| |
| static int qcom_labibb_get_current_limit(struct regulator_dev *rdev) |
| { |
| struct labibb_regulator *vreg = rdev_get_drvdata(rdev); |
| struct regulator_desc *desc = &vreg->desc; |
| struct labibb_current_limits *lim = &vreg->uA_limits; |
| unsigned int cur_step; |
| int ret; |
| |
| ret = regmap_read(vreg->regmap, desc->csel_reg, &cur_step); |
| if (ret) |
| return ret; |
| cur_step &= desc->csel_mask; |
| |
| return (cur_step * lim->uA_step) + lim->uA_min; |
| } |
| |
| static int qcom_labibb_set_soft_start(struct regulator_dev *rdev) |
| { |
| struct labibb_regulator *vreg = rdev_get_drvdata(rdev); |
| u32 val = 0; |
| |
| if (vreg->type == QCOM_IBB_TYPE) |
| val = vreg->dischg_sel; |
| else |
| val = vreg->soft_start_sel; |
| |
| return regmap_write(rdev->regmap, rdev->desc->soft_start_reg, val); |
| } |
| |
| static int qcom_labibb_get_table_sel(const int *table, int sz, u32 value) |
| { |
| int i; |
| |
| for (i = 0; i < sz; i++) |
| if (table[i] == value) |
| return i; |
| return -EINVAL; |
| } |
| |
| /* IBB discharge resistor values in KOhms */ |
| static const int dischg_resistor_values[] = { 300, 64, 32, 16 }; |
| |
| /* Soft start time in microseconds */ |
| static const int soft_start_values[] = { 200, 400, 600, 800 }; |
| |
| static int qcom_labibb_of_parse_cb(struct device_node *np, |
| const struct regulator_desc *desc, |
| struct regulator_config *config) |
| { |
| struct labibb_regulator *vreg = config->driver_data; |
| u32 dischg_kohms, soft_start_time; |
| int ret; |
| |
| ret = of_property_read_u32(np, "qcom,discharge-resistor-kohms", |
| &dischg_kohms); |
| if (ret) |
| dischg_kohms = 300; |
| |
| ret = qcom_labibb_get_table_sel(dischg_resistor_values, |
| ARRAY_SIZE(dischg_resistor_values), |
| dischg_kohms); |
| if (ret < 0) |
| return ret; |
| vreg->dischg_sel = (u8)ret; |
| |
| ret = of_property_read_u32(np, "qcom,soft-start-us", |
| &soft_start_time); |
| if (ret) |
| soft_start_time = 200; |
| |
| ret = qcom_labibb_get_table_sel(soft_start_values, |
| ARRAY_SIZE(soft_start_values), |
| soft_start_time); |
| if (ret < 0) |
| return ret; |
| vreg->soft_start_sel = (u8)ret; |
| |
| return 0; |
| } |
| |
| static const struct regulator_ops qcom_labibb_ops = { |
| .enable = regulator_enable_regmap, |
| .disable = regulator_disable_regmap, |
| .is_enabled = regulator_is_enabled_regmap, |
| .set_voltage_sel = regulator_set_voltage_sel_regmap, |
| .get_voltage_sel = regulator_get_voltage_sel_regmap, |
| .list_voltage = regulator_list_voltage_linear, |
| .map_voltage = regulator_map_voltage_linear, |
| .set_active_discharge = regulator_set_active_discharge_regmap, |
| .set_pull_down = regulator_set_pull_down_regmap, |
| .set_current_limit = qcom_labibb_set_current_limit, |
| .get_current_limit = qcom_labibb_get_current_limit, |
| .set_soft_start = qcom_labibb_set_soft_start, |
| .set_over_current_protection = qcom_labibb_set_ocp, |
| }; |
| |
| static const struct regulator_desc pmi8998_lab_desc = { |
| .enable_mask = LAB_ENABLE_CTL_MASK, |
| .enable_reg = (PMI8998_LAB_REG_BASE + REG_LABIBB_ENABLE_CTL), |
| .enable_val = LABIBB_CONTROL_ENABLE, |
| .enable_time = LAB_ENABLE_TIME, |
| .poll_enabled_time = LABIBB_POLL_ENABLED_TIME, |
| .soft_start_reg = (PMI8998_LAB_REG_BASE + REG_LABIBB_SOFT_START_CTL), |
| .pull_down_reg = (PMI8998_LAB_REG_BASE + REG_LABIBB_PD_CTL), |
| .pull_down_mask = LAB_PD_CTL_MASK, |
| .pull_down_val_on = LAB_PD_CTL_STRONG_PULL, |
| .vsel_reg = (PMI8998_LAB_REG_BASE + REG_LABIBB_VOLTAGE), |
| .vsel_mask = LAB_VOLTAGE_SET_MASK, |
| .apply_reg = (PMI8998_LAB_REG_BASE + REG_LABIBB_VOLTAGE), |
| .apply_bit = LABIBB_VOLTAGE_OVERRIDE_EN, |
| .csel_reg = (PMI8998_LAB_REG_BASE + REG_LABIBB_CURRENT_LIMIT), |
| .csel_mask = LAB_CURRENT_LIMIT_MASK, |
| .n_current_limits = 8, |
| .off_on_delay = LABIBB_OFF_ON_DELAY, |
| .owner = THIS_MODULE, |
| .type = REGULATOR_VOLTAGE, |
| .min_uV = 4600000, |
| .uV_step = 100000, |
| .n_voltages = 16, |
| .ops = &qcom_labibb_ops, |
| .of_parse_cb = qcom_labibb_of_parse_cb, |
| }; |
| |
| static const struct regulator_desc pmi8998_ibb_desc = { |
| .enable_mask = IBB_ENABLE_CTL_MASK, |
| .enable_reg = (PMI8998_IBB_REG_BASE + REG_LABIBB_ENABLE_CTL), |
| .enable_val = LABIBB_CONTROL_ENABLE, |
| .enable_time = IBB_ENABLE_TIME, |
| .poll_enabled_time = LABIBB_POLL_ENABLED_TIME, |
| .soft_start_reg = (PMI8998_IBB_REG_BASE + REG_LABIBB_SOFT_START_CTL), |
| .active_discharge_off = 0, |
| .active_discharge_on = IBB_CTL_1_DISCHARGE_EN, |
| .active_discharge_mask = IBB_CTL_1_DISCHARGE_EN, |
| .active_discharge_reg = (PMI8998_IBB_REG_BASE + REG_IBB_PWRUP_PWRDN_CTL_1), |
| .pull_down_reg = (PMI8998_IBB_REG_BASE + REG_LABIBB_PD_CTL), |
| .pull_down_mask = IBB_PD_CTL_MASK, |
| .pull_down_val_on = IBB_PD_CTL_HALF_STRENGTH | IBB_PD_CTL_EN, |
| .vsel_reg = (PMI8998_IBB_REG_BASE + REG_LABIBB_VOLTAGE), |
| .vsel_mask = IBB_VOLTAGE_SET_MASK, |
| .apply_reg = (PMI8998_IBB_REG_BASE + REG_LABIBB_VOLTAGE), |
| .apply_bit = LABIBB_VOLTAGE_OVERRIDE_EN, |
| .csel_reg = (PMI8998_IBB_REG_BASE + REG_LABIBB_CURRENT_LIMIT), |
| .csel_mask = IBB_CURRENT_LIMIT_MASK, |
| .n_current_limits = 32, |
| .off_on_delay = LABIBB_OFF_ON_DELAY, |
| .owner = THIS_MODULE, |
| .type = REGULATOR_VOLTAGE, |
| .min_uV = 1400000, |
| .uV_step = 100000, |
| .n_voltages = 64, |
| .ops = &qcom_labibb_ops, |
| .of_parse_cb = qcom_labibb_of_parse_cb, |
| }; |
| |
| static const struct labibb_regulator_data pmi8998_labibb_data[] = { |
| {"lab", QCOM_LAB_TYPE, PMI8998_LAB_REG_BASE, &pmi8998_lab_desc}, |
| {"ibb", QCOM_IBB_TYPE, PMI8998_IBB_REG_BASE, &pmi8998_ibb_desc}, |
| { }, |
| }; |
| |
| static const struct of_device_id qcom_labibb_match[] = { |
| { .compatible = "qcom,pmi8998-lab-ibb", .data = &pmi8998_labibb_data}, |
| { }, |
| }; |
| MODULE_DEVICE_TABLE(of, qcom_labibb_match); |
| |
| static int qcom_labibb_regulator_probe(struct platform_device *pdev) |
| { |
| struct labibb_regulator *vreg; |
| struct device *dev = &pdev->dev; |
| struct regulator_config cfg = {}; |
| struct device_node *reg_node; |
| const struct of_device_id *match; |
| const struct labibb_regulator_data *reg_data; |
| struct regmap *reg_regmap; |
| unsigned int type; |
| int ret; |
| |
| reg_regmap = dev_get_regmap(pdev->dev.parent, NULL); |
| if (!reg_regmap) { |
| dev_err(&pdev->dev, "Couldn't get parent's regmap\n"); |
| return -ENODEV; |
| } |
| |
| match = of_match_device(qcom_labibb_match, &pdev->dev); |
| if (!match) |
| return -ENODEV; |
| |
| for (reg_data = match->data; reg_data->name; reg_data++) { |
| char *sc_irq_name; |
| int irq = 0; |
| |
| /* Validate if the type of regulator is indeed |
| * what's mentioned in DT. |
| */ |
| ret = regmap_read(reg_regmap, reg_data->base + REG_PERPH_TYPE, |
| &type); |
| if (ret < 0) { |
| dev_err(dev, |
| "Peripheral type read failed ret=%d\n", |
| ret); |
| return -EINVAL; |
| } |
| |
| if (WARN_ON((type != QCOM_LAB_TYPE) && (type != QCOM_IBB_TYPE)) || |
| WARN_ON(type != reg_data->type)) |
| return -EINVAL; |
| |
| vreg = devm_kzalloc(&pdev->dev, sizeof(*vreg), |
| GFP_KERNEL); |
| if (!vreg) |
| return -ENOMEM; |
| |
| sc_irq_name = devm_kasprintf(dev, GFP_KERNEL, |
| "%s-short-circuit", |
| reg_data->name); |
| if (!sc_irq_name) |
| return -ENOMEM; |
| |
| reg_node = of_get_child_by_name(pdev->dev.of_node, |
| reg_data->name); |
| if (!reg_node) |
| return -EINVAL; |
| |
| /* The Short Circuit interrupt is critical */ |
| irq = of_irq_get_byname(reg_node, "sc-err"); |
| if (irq <= 0) { |
| if (irq == 0) |
| irq = -EINVAL; |
| |
| return dev_err_probe(vreg->dev, irq, |
| "Short-circuit irq not found.\n"); |
| } |
| vreg->sc_irq = irq; |
| |
| /* OverCurrent Protection IRQ is optional */ |
| irq = of_irq_get_byname(reg_node, "ocp"); |
| vreg->ocp_irq = irq; |
| vreg->ocp_irq_count = 0; |
| of_node_put(reg_node); |
| |
| vreg->regmap = reg_regmap; |
| vreg->dev = dev; |
| vreg->base = reg_data->base; |
| vreg->type = reg_data->type; |
| INIT_DELAYED_WORK(&vreg->sc_recovery_work, |
| qcom_labibb_sc_recovery_worker); |
| |
| if (vreg->ocp_irq > 0) |
| INIT_DELAYED_WORK(&vreg->ocp_recovery_work, |
| qcom_labibb_ocp_recovery_worker); |
| |
| switch (vreg->type) { |
| case QCOM_LAB_TYPE: |
| /* LAB Limits: 200-1600mA */ |
| vreg->uA_limits.uA_min = 200000; |
| vreg->uA_limits.uA_step = 200000; |
| vreg->uA_limits.ovr_val = LAB_CURRENT_LIMIT_OVERRIDE_EN; |
| break; |
| case QCOM_IBB_TYPE: |
| /* IBB Limits: 0-1550mA */ |
| vreg->uA_limits.uA_min = 0; |
| vreg->uA_limits.uA_step = 50000; |
| vreg->uA_limits.ovr_val = 0; /* No override bit */ |
| break; |
| default: |
| return -EINVAL; |
| } |
| |
| memcpy(&vreg->desc, reg_data->desc, sizeof(vreg->desc)); |
| vreg->desc.of_match = reg_data->name; |
| vreg->desc.name = reg_data->name; |
| |
| cfg.dev = vreg->dev; |
| cfg.driver_data = vreg; |
| cfg.regmap = vreg->regmap; |
| |
| vreg->rdev = devm_regulator_register(vreg->dev, &vreg->desc, |
| &cfg); |
| |
| if (IS_ERR(vreg->rdev)) { |
| dev_err(dev, "qcom_labibb: error registering %s : %d\n", |
| reg_data->name, ret); |
| return PTR_ERR(vreg->rdev); |
| } |
| |
| ret = devm_request_threaded_irq(vreg->dev, vreg->sc_irq, NULL, |
| qcom_labibb_sc_isr, |
| IRQF_ONESHOT | |
| IRQF_TRIGGER_RISING, |
| sc_irq_name, vreg); |
| if (ret) |
| return ret; |
| } |
| |
| return 0; |
| } |
| |
| static struct platform_driver qcom_labibb_regulator_driver = { |
| .driver = { |
| .name = "qcom-lab-ibb-regulator", |
| .of_match_table = qcom_labibb_match, |
| }, |
| .probe = qcom_labibb_regulator_probe, |
| }; |
| module_platform_driver(qcom_labibb_regulator_driver); |
| |
| MODULE_DESCRIPTION("Qualcomm labibb driver"); |
| MODULE_AUTHOR("Nisha Kumari <nishakumari@codeaurora.org>"); |
| MODULE_AUTHOR("Sumit Semwal <sumit.semwal@linaro.org>"); |
| MODULE_LICENSE("GPL v2"); |