// SPDX-License-Identifier: GPL-2.0-or-later // // helpers.c -- Voltage/Current Regulator framework helper functions. // // Copyright 2007, 2008 Wolfson Microelectronics PLC. // Copyright 2008 SlimLogic Ltd. #include #include #include #include #include #include #include #include #include "internal.h" /** * regulator_is_enabled_regmap - standard is_enabled() for regmap users * * @rdev: regulator to operate on * * Regulators that use regmap for their register I/O can set the * enable_reg and enable_mask fields in their descriptor and then use * this as their is_enabled operation, saving some code. */ int regulator_is_enabled_regmap(struct regulator_dev *rdev) { unsigned int val; int ret; ret = regmap_read(rdev->regmap, rdev->desc->enable_reg, &val); if (ret != 0) return ret; val &= rdev->desc->enable_mask; if (rdev->desc->enable_is_inverted) { if (rdev->desc->enable_val) return val != rdev->desc->enable_val; return val == 0; } else { if (rdev->desc->enable_val) return val == rdev->desc->enable_val; return val != 0; } } EXPORT_SYMBOL_GPL(regulator_is_enabled_regmap); /** * regulator_enable_regmap - standard enable() for regmap users * * @rdev: regulator to operate on * * Regulators that use regmap for their register I/O can set the * enable_reg and enable_mask fields in their descriptor and then use * this as their enable() operation, saving some code. */ int regulator_enable_regmap(struct regulator_dev *rdev) { unsigned int val; if (rdev->desc->enable_is_inverted) { val = rdev->desc->disable_val; } else { val = rdev->desc->enable_val; if (!val) val = rdev->desc->enable_mask; } return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg, rdev->desc->enable_mask, val); } EXPORT_SYMBOL_GPL(regulator_enable_regmap); /** * regulator_disable_regmap - standard disable() for regmap users * * @rdev: regulator to operate on * * Regulators that use regmap for their register I/O can set the * enable_reg and enable_mask fields in their descriptor and then use * this as their disable() operation, saving some code. */ int regulator_disable_regmap(struct regulator_dev *rdev) { unsigned int val; if (rdev->desc->enable_is_inverted) { val = rdev->desc->enable_val; if (!val) val = rdev->desc->enable_mask; } else { val = rdev->desc->disable_val; } return regmap_update_bits(rdev->regmap, rdev->desc->enable_reg, rdev->desc->enable_mask, val); } EXPORT_SYMBOL_GPL(regulator_disable_regmap); static int regulator_range_selector_to_index(struct regulator_dev *rdev, unsigned int rval) { int i; if (!rdev->desc->linear_range_selectors_bitfield) return -EINVAL; rval &= rdev->desc->vsel_range_mask; rval >>= ffs(rdev->desc->vsel_range_mask) - 1; for (i = 0; i < rdev->desc->n_linear_ranges; i++) { if (rdev->desc->linear_range_selectors_bitfield[i] == rval) return i; } return -EINVAL; } /** * regulator_get_voltage_sel_pickable_regmap - pickable range get_voltage_sel * * @rdev: regulator to operate on * * Regulators that use regmap for their register I/O and use pickable * ranges can set the vsel_reg, vsel_mask, vsel_range_reg and vsel_range_mask * fields in their descriptor and then use this as their get_voltage_vsel * operation, saving some code. */ int regulator_get_voltage_sel_pickable_regmap(struct regulator_dev *rdev) { unsigned int r_val; int range; unsigned int val; int ret; unsigned int voltages = 0; const struct linear_range *r = rdev->desc->linear_ranges; if (!r) return -EINVAL; ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val); if (ret != 0) return ret; ret = regmap_read(rdev->regmap, rdev->desc->vsel_range_reg, &r_val); if (ret != 0) return ret; val &= rdev->desc->vsel_mask; val >>= ffs(rdev->desc->vsel_mask) - 1; range = regulator_range_selector_to_index(rdev, r_val); if (range < 0) return -EINVAL; voltages = linear_range_values_in_range_array(r, range); return val + voltages; } EXPORT_SYMBOL_GPL(regulator_get_voltage_sel_pickable_regmap); /** * regulator_set_voltage_sel_pickable_regmap - pickable range set_voltage_sel * * @rdev: regulator to operate on * @sel: Selector to set * * Regulators that use regmap for their register I/O and use pickable * ranges can set the vsel_reg, vsel_mask, vsel_range_reg and vsel_range_mask * fields in their descriptor and then use this as their set_voltage_vsel * operation, saving some code. */ int regulator_set_voltage_sel_pickable_regmap(struct regulator_dev *rdev, unsigned int sel) { unsigned int range; int ret, i; unsigned int voltages_in_range = 0; for (i = 0; i < rdev->desc->n_linear_ranges; i++) { const struct linear_range *r; r = &rdev->desc->linear_ranges[i]; voltages_in_range = linear_range_values_in_range(r); if (sel < voltages_in_range) break; sel -= voltages_in_range; } if (i == rdev->desc->n_linear_ranges) return -EINVAL; sel <<= ffs(rdev->desc->vsel_mask) - 1; sel += rdev->desc->linear_ranges[i].min_sel; range = rdev->desc->linear_range_selectors_bitfield[i]; range <<= ffs(rdev->desc->vsel_range_mask) - 1; if (rdev->desc->vsel_reg == rdev->desc->vsel_range_reg) { ret = regmap_update_bits(rdev->regmap, rdev->desc->vsel_reg, rdev->desc->vsel_range_mask | rdev->desc->vsel_mask, sel | range); } else { ret = regmap_update_bits(rdev->regmap, rdev->desc->vsel_range_reg, rdev->desc->vsel_range_mask, range); if (ret) return ret; ret = regmap_update_bits(rdev->regmap, rdev->desc->vsel_reg, rdev->desc->vsel_mask, sel); } if (ret) return ret; if (rdev->desc->apply_bit) ret = regmap_update_bits(rdev->regmap, rdev->desc->apply_reg, rdev->desc->apply_bit, rdev->desc->apply_bit); return ret; } EXPORT_SYMBOL_GPL(regulator_set_voltage_sel_pickable_regmap); /** * regulator_get_voltage_sel_regmap - standard get_voltage_sel for regmap users * * @rdev: regulator to operate on * * Regulators that use regmap for their register I/O can set the * vsel_reg and vsel_mask fields in their descriptor and then use this * as their get_voltage_vsel operation, saving some code. */ int regulator_get_voltage_sel_regmap(struct regulator_dev *rdev) { unsigned int val; int ret; ret = regmap_read(rdev->regmap, rdev->desc->vsel_reg, &val); if (ret != 0) return ret; val &= rdev->desc->vsel_mask; val >>= ffs(rdev->desc->vsel_mask) - 1; return val; } EXPORT_SYMBOL_GPL(regulator_get_voltage_sel_regmap); /** * regulator_set_voltage_sel_regmap - standard set_voltage_sel for regmap users * * @rdev: regulator to operate on * @sel: Selector to set * * Regulators that use regmap for their register I/O can set the * vsel_reg and vsel_mask fields in their descriptor and then use this * as their set_voltage_vsel operation, saving some code. */ int regulator_set_voltage_sel_regmap(struct regulator_dev *rdev, unsigned sel) { int ret; sel <<= ffs(rdev->desc->vsel_mask) - 1; ret = regmap_update_bits(rdev->regmap, rdev->desc->vsel_reg, rdev->desc->vsel_mask, sel); if (ret) return ret; if (rdev->desc->apply_bit) ret = regmap_update_bits(rdev->regmap, rdev->desc->apply_reg, rdev->desc->apply_bit, rdev->desc->apply_bit); return ret; } EXPORT_SYMBOL_GPL(regulator_set_voltage_sel_regmap); /** * regulator_map_voltage_iterate - map_voltage() based on list_voltage() * * @rdev: Regulator to operate on * @min_uV: Lower bound for voltage * @max_uV: Upper bound for voltage * * Drivers implementing set_voltage_sel() and list_voltage() can use * this as their map_voltage() operation. It will find a suitable * voltage by calling list_voltage() until it gets something in bounds * for the requested voltages. */ int regulator_map_voltage_iterate(struct regulator_dev *rdev, int min_uV, int max_uV) { int best_val = INT_MAX; int selector = 0; int i, ret; /* Find the smallest voltage that falls within the specified * range. */ for (i = 0; i < rdev->desc->n_voltages; i++) { ret = rdev->desc->ops->list_voltage(rdev, i); if (ret < 0) continue; if (ret < best_val && ret >= min_uV && ret <= max_uV) { best_val = ret; selector = i; } } if (best_val != INT_MAX) return selector; else return -EINVAL; } EXPORT_SYMBOL_GPL(regulator_map_voltage_iterate); /** * regulator_map_voltage_ascend - map_voltage() for ascendant voltage list * * @rdev: Regulator to operate on * @min_uV: Lower bound for voltage * @max_uV: Upper bound for voltage * * Drivers that have ascendant voltage list can use this as their * map_voltage() operation. */ int regulator_map_voltage_ascend(struct regulator_dev *rdev, int min_uV, int max_uV) { int i, ret; for (i = 0; i < rdev->desc->n_voltages; i++) { ret = rdev->desc->ops->list_voltage(rdev, i); if (ret < 0) continue; if (ret > max_uV) break; if (ret >= min_uV && ret <= max_uV) return i; } return -EINVAL; } EXPORT_SYMBOL_GPL(regulator_map_voltage_ascend); /** * regulator_map_voltage_linear - map_voltage() for simple linear mappings * * @rdev: Regulator to operate on * @min_uV: Lower bound for voltage * @max_uV: Upper bound for voltage * * Drivers providing min_uV and uV_step in their regulator_desc can * use this as their map_voltage() operation. */ int regulator_map_voltage_linear(struct regulator_dev *rdev, int min_uV, int max_uV) { int ret, voltage; /* Allow uV_step to be 0 for fixed voltage */ if (rdev->desc->n_voltages == 1 && rdev->desc->uV_step == 0) { if (min_uV <= rdev->desc->min_uV && rdev->desc->min_uV <= max_uV) return 0; else return -EINVAL; } if (!rdev->desc->uV_step) { BUG_ON(!rdev->desc->uV_step); return -EINVAL; } if (min_uV < rdev->desc->min_uV) min_uV = rdev->desc->min_uV; ret = DIV_ROUND_UP(min_uV - rdev->desc->min_uV, rdev->desc->uV_step); if (ret < 0) return ret; ret += rdev->desc->linear_min_sel; /* Map back into a voltage to verify we're still in bounds */ voltage = rdev->desc->ops->list_voltage(rdev, ret); if (voltage < min_uV || voltage > max_uV) return -EINVAL; return ret; } EXPORT_SYMBOL_GPL(regulator_map_voltage_linear); /** * regulator_map_voltage_linear_range - map_voltage() for multiple linear ranges * * @rdev: Regulator to operate on * @min_uV: Lower bound for voltage * @max_uV: Upper bound for voltage * * Drivers providing linear_ranges in their descriptor can use this as * their map_voltage() callback. */ int regulator_map_voltage_linear_range(struct regulator_dev *rdev, int min_uV, int max_uV) { const struct linear_range *range; int ret = -EINVAL; unsigned int sel; bool found; int voltage, i; if (!rdev->desc->n_linear_ranges) { BUG_ON(!rdev->desc->n_linear_ranges); return -EINVAL; } for (i = 0; i < rdev->desc->n_linear_ranges; i++) { range = &rdev->desc->linear_ranges[i]; ret = linear_range_get_selector_high(range, min_uV, &sel, &found); if (ret) continue; ret = sel; /* * Map back into a voltage to verify we're still in bounds. * If we are not, then continue checking rest of the ranges. */ voltage = rdev->desc->ops->list_voltage(rdev, sel); if (voltage >= min_uV && voltage <= max_uV) break; } if (i == rdev->desc->n_linear_ranges) return -EINVAL; return ret; } EXPORT_SYMBOL_GPL(regulator_map_voltage_linear_range); /** * regulator_map_voltage_pickable_linear_range - map_voltage, pickable ranges * * @rdev: Regulator to operate on * @min_uV: Lower bound for voltage * @max_uV: Upper bound for voltage * * Drivers providing pickable linear_ranges in their descriptor can use * this as their map_voltage() callback. */ int regulator_map_voltage_pickable_linear_range(struct regulator_dev *rdev, int min_uV, int max_uV) { const struct linear_range *range; int ret = -EINVAL; int voltage, i; unsigned int selector = 0; if (!rdev->desc->n_linear_ranges) { BUG_ON(!rdev->desc->n_linear_ranges); return -EINVAL; } for (i = 0; i < rdev->desc->n_linear_ranges; i++) { int linear_max_uV; bool found; unsigned int sel; range = &rdev->desc->linear_ranges[i]; linear_max_uV = linear_range_get_max_value(range); if (!(min_uV <= linear_max_uV && max_uV >= range->min)) { selector += linear_range_values_in_range(range); continue; } ret = linear_range_get_selector_high(range, min_uV, &sel, &found); if (ret) { selector += linear_range_values_in_range(range); continue; } ret = selector + sel - range->min_sel; voltage = rdev->desc->ops->list_voltage(rdev, ret); /* * Map back into a voltage to verify we're still in bounds. * We may have overlapping voltage ranges. Hence we don't * exit but retry until we have checked all ranges. */ if (voltage < min_uV || voltage > max_uV) selector += linear_range_values_in_range(range); else break; } if (i == rdev->desc->n_linear_ranges) return -EINVAL; return ret; } EXPORT_SYMBOL_GPL(regulator_map_voltage_pickable_linear_range); /** * regulator_desc_list_voltage_linear - List voltages with simple calculation * * @desc: Regulator desc for regulator which volatges are to be listed * @selector: Selector to convert into a voltage * * Regulators with a simple linear mapping between voltages and * selectors can set min_uV and uV_step in the regulator descriptor * and then use this function prior regulator registration to list * the voltages. This is useful when voltages need to be listed during * device-tree parsing. */ int regulator_desc_list_voltage_linear(const struct regulator_desc *desc, unsigned int selector) { if (selector >= desc->n_voltages) return -EINVAL; if (selector < desc->linear_min_sel) return 0; selector -= desc->linear_min_sel; return desc->min_uV + (desc->uV_step * selector); } EXPORT_SYMBOL_GPL(regulator_desc_list_voltage_linear); /** * regulator_list_voltage_linear - List voltages with simple calculation * * @rdev: Regulator device * @selector: Selector to convert into a voltage * * Regulators with a simple linear mapping between voltages and * selectors can set min_uV and uV_step in the regulator descriptor * and then use this function as their list_voltage() operation, */ int regulator_list_voltage_linear(struct regulator_dev *rdev, unsigned int selector) { return regulator_desc_list_voltage_linear(rdev->desc, selector); } EXPORT_SYMBOL_GPL(regulator_list_voltage_linear); /** * regulator_list_voltage_pickable_linear_range - pickable range list voltages * * @rdev: Regulator device * @selector: Selector to convert into a voltage * * list_voltage() operation, intended to be used by drivers utilizing pickable * ranges helpers. */ int regulator_list_voltage_pickable_linear_range(struct regulator_dev *rdev, unsigned int selector) { const struct linear_range *range; int i; unsigned int all_sels = 0; if (!rdev->desc->n_linear_ranges) { BUG_ON(!rdev->desc->n_linear_ranges); return -EINVAL; } for (i = 0; i < rdev->desc->n_linear_ranges; i++) { unsigned int sel_indexes; range = &rdev->desc->linear_ranges[i]; sel_indexes = linear_range_values_in_range(range) - 1; if (all_sels + sel_indexes >= selector) { selector -= all_sels; /* * As we see here, pickable ranges work only as * long as the first selector for each pickable * range is 0, and the each subsequent range for * this 'pick' follow immediately at next unused * selector (Eg. there is no gaps between ranges). * I think this is fine but it probably should be * documented. OTOH, whole pickable range stuff * might benefit from some documentation */ return range->min + (range->step * selector); } all_sels += (sel_indexes + 1); } return -EINVAL; } EXPORT_SYMBOL_GPL(regulator_list_voltage_pickable_linear_range); /** * regulator_desc_list_voltage_linear_range - List voltages for linear ranges * * @desc: Regulator desc for regulator which volatges are to be listed * @selector: Selector to convert into a voltage * * Regulators with a series of simple linear mappings between voltages * and selectors who have set linear_ranges in the regulator descriptor * can use this function prior regulator registration to list voltages. * This is useful when voltages need to be listed during device-tree * parsing. */ int regulator_desc_list_voltage_linear_range(const struct regulator_desc *desc, unsigned int selector) { unsigned int val; int ret; BUG_ON(!desc->n_linear_ranges); ret = linear_range_get_value_array(desc->linear_ranges, desc->n_linear_ranges, selector, &val); if (ret) return ret; return val; } EXPORT_SYMBOL_GPL(regulator_desc_list_voltage_linear_range); /** * regulator_list_voltage_linear_range - List voltages for linear ranges * * @rdev: Regulator device * @selector: Selector to convert into a voltage * * Regulators with a series of simple linear mappings between voltages * and selectors can set linear_ranges in the regulator descriptor and * then use this function as their list_voltage() operation, */ int regulator_list_voltage_linear_range(struct regulator_dev *rdev, unsigned int selector) { return regulator_desc_list_voltage_linear_range(rdev->desc, selector); } EXPORT_SYMBOL_GPL(regulator_list_voltage_linear_range); /** * regulator_list_voltage_table - List voltages with table based mapping * * @rdev: Regulator device * @selector: Selector to convert into a voltage * * Regulators with table based mapping between voltages and * selectors can set volt_table in the regulator descriptor * and then use this function as their list_voltage() operation. */ int regulator_list_voltage_table(struct regulator_dev *rdev, unsigned int selector) { if (!rdev->desc->volt_table) { BUG_ON(!rdev->desc->volt_table); return -EINVAL; } if (selector >= rdev->desc->n_voltages) return -EINVAL; if (selector < rdev->desc->linear_min_sel) return 0; return rdev->desc->volt_table[selector]; } EXPORT_SYMBOL_GPL(regulator_list_voltage_table); /** * regulator_set_bypass_regmap - Default set_bypass() using regmap * * @rdev: device to operate on. * @enable: state to set. */ int regulator_set_bypass_regmap(struct regulator_dev *rdev, bool enable) { unsigned int val; if (enable) { val = rdev->desc->bypass_val_on; if (!val) val = rdev->desc->bypass_mask; } else { val = rdev->desc->bypass_val_off; } return regmap_update_bits(rdev->regmap, rdev->desc->bypass_reg, rdev->desc->bypass_mask, val); } EXPORT_SYMBOL_GPL(regulator_set_bypass_regmap); /** * regulator_set_soft_start_regmap - Default set_soft_start() using regmap * * @rdev: device to operate on. */ int regulator_set_soft_start_regmap(struct regulator_dev *rdev) { unsigned int val; val = rdev->desc->soft_start_val_on; if (!val) val = rdev->desc->soft_start_mask; return regmap_update_bits(rdev->regmap, rdev->desc->soft_start_reg, rdev->desc->soft_start_mask, val); } EXPORT_SYMBOL_GPL(regulator_set_soft_start_regmap); /** * regulator_set_pull_down_regmap - Default set_pull_down() using regmap * * @rdev: device to operate on. */ int regulator_set_pull_down_regmap(struct regulator_dev *rdev) { unsigned int val; val = rdev->desc->pull_down_val_on; if (!val) val = rdev->desc->pull_down_mask; return regmap_update_bits(rdev->regmap, rdev->desc->pull_down_reg, rdev->desc->pull_down_mask, val); } EXPORT_SYMBOL_GPL(regulator_set_pull_down_regmap); /** * regulator_get_bypass_regmap - Default get_bypass() using regmap * * @rdev: device to operate on. * @enable: current state. */ int regulator_get_bypass_regmap(struct regulator_dev *rdev, bool *enable) { unsigned int val; unsigned int val_on = rdev->desc->bypass_val_on; int ret; ret = regmap_read(rdev->regmap, rdev->desc->bypass_reg, &val); if (ret != 0) return ret; if (!val_on) val_on = rdev->desc->bypass_mask; *enable = (val & rdev->desc->bypass_mask) == val_on; return 0; } EXPORT_SYMBOL_GPL(regulator_get_bypass_regmap); /** * regulator_set_active_discharge_regmap - Default set_active_discharge() * using regmap * * @rdev: device to operate on. * @enable: state to set, 0 to disable and 1 to enable. */ int regulator_set_active_discharge_regmap(struct regulator_dev *rdev, bool enable) { unsigned int val; if (enable) val = rdev->desc->active_discharge_on; else val = rdev->desc->active_discharge_off; return regmap_update_bits(rdev->regmap, rdev->desc->active_discharge_reg, rdev->desc->active_discharge_mask, val); } EXPORT_SYMBOL_GPL(regulator_set_active_discharge_regmap); /** * regulator_set_current_limit_regmap - set_current_limit for regmap users * * @rdev: regulator to operate on * @min_uA: Lower bound for current limit * @max_uA: Upper bound for current limit * * Regulators that use regmap for their register I/O can set curr_table, * csel_reg and csel_mask fields in their descriptor and then use this * as their set_current_limit operation, saving some code. */ int regulator_set_current_limit_regmap(struct regulator_dev *rdev, int min_uA, int max_uA) { unsigned int n_currents = rdev->desc->n_current_limits; int i, sel = -1; if (n_currents == 0) return -EINVAL; if (rdev->desc->curr_table) { const unsigned int *curr_table = rdev->desc->curr_table; bool ascend = curr_table[n_currents - 1] > curr_table[0]; /* search for closest to maximum */ if (ascend) { for (i = n_currents - 1; i >= 0; i--) { if (min_uA <= curr_table[i] && curr_table[i] <= max_uA) { sel = i; break; } } } else { for (i = 0; i < n_currents; i++) { if (min_uA <= curr_table[i] && curr_table[i] <= max_uA) { sel = i; break; } } } } if (sel < 0) return -EINVAL; sel <<= ffs(rdev->desc->csel_mask) - 1; return regmap_update_bits(rdev->regmap, rdev->desc->csel_reg, rdev->desc->csel_mask, sel); } EXPORT_SYMBOL_GPL(regulator_set_current_limit_regmap); /** * regulator_get_current_limit_regmap - get_current_limit for regmap users * * @rdev: regulator to operate on * * Regulators that use regmap for their register I/O can set the * csel_reg and csel_mask fields in their descriptor and then use this * as their get_current_limit operation, saving some code. */ int regulator_get_current_limit_regmap(struct regulator_dev *rdev) { unsigned int val; int ret; ret = regmap_read(rdev->regmap, rdev->desc->csel_reg, &val); if (ret != 0) return ret; val &= rdev->desc->csel_mask; val >>= ffs(rdev->desc->csel_mask) - 1; if (rdev->desc->curr_table) { if (val >= rdev->desc->n_current_limits) return -EINVAL; return rdev->desc->curr_table[val]; } return -EINVAL; } EXPORT_SYMBOL_GPL(regulator_get_current_limit_regmap); /** * regulator_bulk_set_supply_names - initialize the 'supply' fields in an array * of regulator_bulk_data structs * * @consumers: array of regulator_bulk_data entries to initialize * @supply_names: array of supply name strings * @num_supplies: number of supply names to initialize * * Note: the 'consumers' array must be the size of 'num_supplies'. */ void regulator_bulk_set_supply_names(struct regulator_bulk_data *consumers, const char *const *supply_names, unsigned int num_supplies) { unsigned int i; for (i = 0; i < num_supplies; i++) consumers[i].supply = supply_names[i]; } EXPORT_SYMBOL_GPL(regulator_bulk_set_supply_names); /** * regulator_is_equal - test whether two regulators are the same * * @reg1: first regulator to operate on * @reg2: second regulator to operate on */ bool regulator_is_equal(struct regulator *reg1, struct regulator *reg2) { return reg1->rdev == reg2->rdev; } EXPORT_SYMBOL_GPL(regulator_is_equal); /** * regulator_find_closest_bigger - helper to find offset in ramp delay table * * @target: targeted ramp_delay * @table: table with supported ramp delays * @num_sel: number of entries in the table * @sel: Pointer to store table offset * * This is the internal helper used by regulator_set_ramp_delay_regmap to * map ramp delay to register value. It should only be used directly if * regulator_set_ramp_delay_regmap cannot handle a specific device setup * (e.g. because the value is split over multiple registers). */ int regulator_find_closest_bigger(unsigned int target, const unsigned int *table, unsigned int num_sel, unsigned int *sel) { unsigned int s, tmp, max, maxsel = 0; bool found = false; max = table[0]; for (s = 0; s < num_sel; s++) { if (table[s] > max) { max = table[s]; maxsel = s; } if (table[s] >= target) { if (!found || table[s] - target < tmp - target) { tmp = table[s]; *sel = s; found = true; if (tmp == target) break; } } } if (!found) { *sel = maxsel; return -EINVAL; } return 0; } EXPORT_SYMBOL_GPL(regulator_find_closest_bigger); /** * regulator_set_ramp_delay_regmap - set_ramp_delay() helper * * @rdev: regulator to operate on * @ramp_delay: ramp-rate value given in units V/S (uV/uS) * * Regulators that use regmap for their register I/O can set the ramp_reg * and ramp_mask fields in their descriptor and then use this as their * set_ramp_delay operation, saving some code. */ int regulator_set_ramp_delay_regmap(struct regulator_dev *rdev, int ramp_delay) { int ret; unsigned int sel; if (WARN_ON(!rdev->desc->n_ramp_values || !rdev->desc->ramp_delay_table)) return -EINVAL; ret = regulator_find_closest_bigger(ramp_delay, rdev->desc->ramp_delay_table, rdev->desc->n_ramp_values, &sel); if (ret) { dev_warn(rdev_get_dev(rdev), "Can't set ramp-delay %u, setting %u\n", ramp_delay, rdev->desc->ramp_delay_table[sel]); } sel <<= ffs(rdev->desc->ramp_mask) - 1; return regmap_update_bits(rdev->regmap, rdev->desc->ramp_reg, rdev->desc->ramp_mask, sel); } EXPORT_SYMBOL_GPL(regulator_set_ramp_delay_regmap);