Commit 8dd5cada authored by Dmitry Osipenko's avatar Dmitry Osipenko Committed by Viresh Kumar
Browse files

opp: Add dev_pm_opp_find_level_ceil() 



Add a ceil version of the dev_pm_opp_find_level(). It's handy to have if
levels don't start from 0 in OPP table and zero usually means a minimal
level.

Tested-by: default avatarPeter Geis <pgwipeout@gmail.com>
Tested-by: default avatarNicolas Chauvet <kwizart@gmail.com>
Tested-by: default avatarMatt Merhar <mattmerhar@protonmail.com>
Signed-off-by: default avatarDmitry Osipenko <digetx@gmail.com>
Signed-off-by: default avatarViresh Kumar <viresh.kumar@linaro.org>
parent d758eaf5

drivers/opp/core.c

+49 −0
Original line number Diff line number Diff line
@@ -449,6 +449,55 @@ struct dev_pm_opp *dev_pm_opp_find_level_exact(struct device *dev, 
}

EXPORT_SYMBOL_GPL(dev_pm_opp_find_level_exact);



/**

 * dev_pm_opp_find_level_ceil() - search for an rounded up level

 * @dev:		device for which we do this operation

 * @level:		level to search for

 *

 * Return: Searches for rounded up match in the opp table and returns pointer

 * to the  matching opp if found, else returns ERR_PTR in case of error and

 * should be handled using IS_ERR. Error return values can be:

 * EINVAL:	for bad pointer

 * ERANGE:	no match found for search

 * ENODEV:	if device not found in list of registered devices

 *

 * The callers are required to call dev_pm_opp_put() for the returned OPP after

 * use.

 */

struct dev_pm_opp *dev_pm_opp_find_level_ceil(struct device *dev,

					      unsigned int *level)

{

	struct opp_table *opp_table;

	struct dev_pm_opp *temp_opp, *opp = ERR_PTR(-ERANGE);



	opp_table = _find_opp_table(dev);

	if (IS_ERR(opp_table)) {

		int r = PTR_ERR(opp_table);



		dev_err(dev, "%s: OPP table not found (%d)\n", __func__, r);

		return ERR_PTR(r);

	}



	mutex_lock(&opp_table->lock);



	list_for_each_entry(temp_opp, &opp_table->opp_list, node) {

		if (temp_opp->available && temp_opp->level >= *level) {

			opp = temp_opp;

			*level = opp->level;



			/* Increment the reference count of OPP */

			dev_pm_opp_get(opp);

			break;

		}

	}



	mutex_unlock(&opp_table->lock);

	dev_pm_opp_put_opp_table(opp_table);



	return opp;

}

EXPORT_SYMBOL_GPL(dev_pm_opp_find_level_ceil);



static noinline struct dev_pm_opp *_find_freq_ceil(struct opp_table *opp_table,

						   unsigned long *freq)

{

include/linux/pm_opp.h

+8 −0
Original line number Diff line number Diff line
@@ -111,6 +111,8 @@ struct dev_pm_opp *dev_pm_opp_find_freq_exact(struct device *dev, 
					      bool available);

struct dev_pm_opp *dev_pm_opp_find_level_exact(struct device *dev,

					       unsigned int level);

struct dev_pm_opp *dev_pm_opp_find_level_ceil(struct device *dev,

					      unsigned int *level);



struct dev_pm_opp *dev_pm_opp_find_freq_floor(struct device *dev,

					      unsigned long *freq);
@@ -226,6 +228,12 @@ static inline struct dev_pm_opp *dev_pm_opp_find_level_exact(struct device *dev, 
	return ERR_PTR(-ENOTSUPP);

}



static inline struct dev_pm_opp *dev_pm_opp_find_level_ceil(struct device *dev,

					unsigned int *level)

{

	return ERR_PTR(-ENOTSUPP);

}



static inline struct dev_pm_opp *dev_pm_opp_find_freq_floor(struct device *dev,

					unsigned long *freq)

{