d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 1) // SPDX-License-Identifier: GPL-2.0
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 2) /*
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 3) * helpers to map values in a linear range to range index
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 4) *
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 5) * Original idea borrowed from regulator framework
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 6) *
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 7) * It might be useful if we could support also inversely proportional ranges?
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 8) * Copyright 2020 ROHM Semiconductors
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 9) */
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 10)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 11) #include <linux/errno.h>
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 12) #include <linux/export.h>
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 13) #include <linux/kernel.h>
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 14) #include <linux/linear_range.h>
35e65600808e2 (Matti Vaittinen 2020-05-09 18:15:19 +0300 15) #include <linux/module.h>
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 16)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 17) /**
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 18) * linear_range_values_in_range - return the amount of values in a range
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 19) * @r: pointer to linear range where values are counted
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 20) *
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 21) * Compute the amount of values in range pointed by @r. Note, values can
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 22) * be all equal - range with selectors 0,...,2 with step 0 still contains
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 23) * 3 values even though they are all equal.
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 24) *
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 25) * Return: the amount of values in range pointed by @r
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 26) */
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 27) unsigned int linear_range_values_in_range(const struct linear_range *r)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 28) {
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 29) if (!r)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 30) return 0;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 31) return r->max_sel - r->min_sel + 1;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 32) }
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 33) EXPORT_SYMBOL_GPL(linear_range_values_in_range);
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 34)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 35) /**
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 36) * linear_range_values_in_range_array - return the amount of values in ranges
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 37) * @r: pointer to array of linear ranges where values are counted
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 38) * @ranges: amount of ranges we include in computation.
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 39) *
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 40) * Compute the amount of values in ranges pointed by @r. Note, values can
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 41) * be all equal - range with selectors 0,...,2 with step 0 still contains
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 42) * 3 values even though they are all equal.
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 43) *
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 44) * Return: the amount of values in first @ranges ranges pointed by @r
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 45) */
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 46) unsigned int linear_range_values_in_range_array(const struct linear_range *r,
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 47) int ranges)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 48) {
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 49) int i, values_in_range = 0;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 50)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 51) for (i = 0; i < ranges; i++) {
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 52) int values;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 53)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 54) values = linear_range_values_in_range(&r[i]);
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 55) if (!values)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 56) return values;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 57)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 58) values_in_range += values;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 59) }
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 60) return values_in_range;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 61) }
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 62) EXPORT_SYMBOL_GPL(linear_range_values_in_range_array);
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 63)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 64) /**
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 65) * linear_range_get_max_value - return the largest value in a range
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 66) * @r: pointer to linear range where value is looked from
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 67) *
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 68) * Return: the largest value in the given range
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 69) */
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 70) unsigned int linear_range_get_max_value(const struct linear_range *r)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 71) {
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 72) return r->min + (r->max_sel - r->min_sel) * r->step;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 73) }
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 74) EXPORT_SYMBOL_GPL(linear_range_get_max_value);
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 75)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 76) /**
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 77) * linear_range_get_value - fetch a value from given range
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 78) * @r: pointer to linear range where value is looked from
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 79) * @selector: selector for which the value is searched
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 80) * @val: address where found value is updated
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 81) *
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 82) * Search given ranges for value which matches given selector.
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 83) *
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 84) * Return: 0 on success, -EINVAL given selector is not found from any of the
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 85) * ranges.
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 86) */
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 87) int linear_range_get_value(const struct linear_range *r, unsigned int selector,
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 88) unsigned int *val)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 89) {
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 90) if (r->min_sel > selector || r->max_sel < selector)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 91) return -EINVAL;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 92)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 93) *val = r->min + (selector - r->min_sel) * r->step;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 94)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 95) return 0;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 96) }
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 97) EXPORT_SYMBOL_GPL(linear_range_get_value);
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 98)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 99) /**
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 100) * linear_range_get_value_array - fetch a value from array of ranges
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 101) * @r: pointer to array of linear ranges where value is looked from
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 102) * @ranges: amount of ranges in an array
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 103) * @selector: selector for which the value is searched
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 104) * @val: address where found value is updated
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 105) *
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 106) * Search through an array of ranges for value which matches given selector.
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 107) *
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 108) * Return: 0 on success, -EINVAL given selector is not found from any of the
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 109) * ranges.
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 110) */
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 111) int linear_range_get_value_array(const struct linear_range *r, int ranges,
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 112) unsigned int selector, unsigned int *val)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 113) {
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 114) int i;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 115)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 116) for (i = 0; i < ranges; i++)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 117) if (r[i].min_sel <= selector && r[i].max_sel >= selector)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 118) return linear_range_get_value(&r[i], selector, val);
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 119)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 120) return -EINVAL;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 121) }
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 122) EXPORT_SYMBOL_GPL(linear_range_get_value_array);
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 123)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 124) /**
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 125) * linear_range_get_selector_low - return linear range selector for value
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 126) * @r: pointer to linear range where selector is looked from
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 127) * @val: value for which the selector is searched
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 128) * @selector: address where found selector value is updated
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 129) * @found: flag to indicate that given value was in the range
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 130) *
4d5270e70981c (Randy Dunlap 2020-12-20 20:06:10 -0800 131) * Return selector for which range value is closest match for given
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 132) * input value. Value is matching if it is equal or smaller than given
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 133) * value. If given value is in the range, then @found is set true.
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 134) *
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 135) * Return: 0 on success, -EINVAL if range is invalid or does not contain
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 136) * value smaller or equal to given value
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 137) */
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 138) int linear_range_get_selector_low(const struct linear_range *r,
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 139) unsigned int val, unsigned int *selector,
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 140) bool *found)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 141) {
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 142) *found = false;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 143)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 144) if (r->min > val)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 145) return -EINVAL;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 146)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 147) if (linear_range_get_max_value(r) < val) {
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 148) *selector = r->max_sel;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 149) return 0;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 150) }
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 151)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 152) *found = true;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 153)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 154) if (r->step == 0)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 155) *selector = r->min_sel;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 156) else
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 157) *selector = (val - r->min) / r->step + r->min_sel;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 158)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 159) return 0;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 160) }
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 161) EXPORT_SYMBOL_GPL(linear_range_get_selector_low);
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 162)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 163) /**
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 164) * linear_range_get_selector_low_array - return linear range selector for value
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 165) * @r: pointer to array of linear ranges where selector is looked from
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 166) * @ranges: amount of ranges to scan from array
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 167) * @val: value for which the selector is searched
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 168) * @selector: address where found selector value is updated
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 169) * @found: flag to indicate that given value was in the range
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 170) *
4d5270e70981c (Randy Dunlap 2020-12-20 20:06:10 -0800 171) * Scan array of ranges for selector for which range value matches given
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 172) * input value. Value is matching if it is equal or smaller than given
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 173) * value. If given value is found to be in a range scanning is stopped and
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 174) * @found is set true. If a range with values smaller than given value is found
4d5270e70981c (Randy Dunlap 2020-12-20 20:06:10 -0800 175) * but the range max is being smaller than given value, then the range's
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 176) * biggest selector is updated to @selector but scanning ranges is continued
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 177) * and @found is set to false.
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 178) *
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 179) * Return: 0 on success, -EINVAL if range array is invalid or does not contain
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 180) * range with a value smaller or equal to given value
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 181) */
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 182) int linear_range_get_selector_low_array(const struct linear_range *r,
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 183) int ranges, unsigned int val,
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 184) unsigned int *selector, bool *found)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 185) {
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 186) int i;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 187) int ret = -EINVAL;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 188)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 189) for (i = 0; i < ranges; i++) {
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 190) int tmpret;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 191)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 192) tmpret = linear_range_get_selector_low(&r[i], val, selector,
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 193) found);
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 194) if (!tmpret)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 195) ret = 0;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 196)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 197) if (*found)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 198) break;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 199) }
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 200)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 201) return ret;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 202) }
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 203) EXPORT_SYMBOL_GPL(linear_range_get_selector_low_array);
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 204)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 205) /**
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 206) * linear_range_get_selector_high - return linear range selector for value
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 207) * @r: pointer to linear range where selector is looked from
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 208) * @val: value for which the selector is searched
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 209) * @selector: address where found selector value is updated
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 210) * @found: flag to indicate that given value was in the range
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 211) *
4d5270e70981c (Randy Dunlap 2020-12-20 20:06:10 -0800 212) * Return selector for which range value is closest match for given
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 213) * input value. Value is matching if it is equal or higher than given
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 214) * value. If given value is in the range, then @found is set true.
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 215) *
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 216) * Return: 0 on success, -EINVAL if range is invalid or does not contain
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 217) * value greater or equal to given value
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 218) */
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 219) int linear_range_get_selector_high(const struct linear_range *r,
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 220) unsigned int val, unsigned int *selector,
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 221) bool *found)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 222) {
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 223) *found = false;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 224)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 225) if (linear_range_get_max_value(r) < val)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 226) return -EINVAL;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 227)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 228) if (r->min > val) {
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 229) *selector = r->min_sel;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 230) return 0;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 231) }
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 232)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 233) *found = true;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 234)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 235) if (r->step == 0)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 236) *selector = r->max_sel;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 237) else
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 238) *selector = DIV_ROUND_UP(val - r->min, r->step) + r->min_sel;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 239)
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 240) return 0;
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 241) }
d2218d4e4a65f (Matti Vaittinen 2020-05-08 18:39:35 +0300 242) EXPORT_SYMBOL_GPL(linear_range_get_selector_high);
35e65600808e2 (Matti Vaittinen 2020-05-09 18:15:19 +0300 243)
35e65600808e2 (Matti Vaittinen 2020-05-09 18:15:19 +0300 244) MODULE_DESCRIPTION("linear-ranges helper");
35e65600808e2 (Matti Vaittinen 2020-05-09 18:15:19 +0300 245) MODULE_LICENSE("GPL");