2019-06-04 11:11:33 +03:00
|
|
|
// SPDX-License-Identifier: GPL-2.0-only
|
2016-03-22 07:44:03 +03:00
|
|
|
/*
|
|
|
|
* linux/drivers/devfreq/governor_passive.c
|
|
|
|
*
|
|
|
|
* Copyright (C) 2016 Samsung Electronics
|
|
|
|
* Author: Chanwoo Choi <cw00.choi@samsung.com>
|
|
|
|
* Author: MyungJoo Ham <myungjoo.ham@samsung.com>
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/device.h>
|
|
|
|
#include <linux/devfreq.h>
|
|
|
|
#include "governor.h"
|
|
|
|
|
|
|
|
static int devfreq_passive_get_target_freq(struct devfreq *devfreq,
|
|
|
|
unsigned long *freq)
|
|
|
|
{
|
|
|
|
struct devfreq_passive_data *p_data
|
|
|
|
= (struct devfreq_passive_data *)devfreq->data;
|
|
|
|
struct devfreq *parent_devfreq = (struct devfreq *)p_data->parent;
|
|
|
|
unsigned long child_freq = ULONG_MAX;
|
2021-02-04 11:14:24 +03:00
|
|
|
struct dev_pm_opp *opp, *p_opp;
|
|
|
|
int i, count;
|
2016-03-22 07:44:03 +03:00
|
|
|
|
|
|
|
/*
|
|
|
|
* If the devfreq device with passive governor has the specific method
|
|
|
|
* to determine the next frequency, should use the get_target_freq()
|
|
|
|
* of struct devfreq_passive_data.
|
|
|
|
*/
|
2021-02-04 11:14:24 +03:00
|
|
|
if (p_data->get_target_freq)
|
|
|
|
return p_data->get_target_freq(devfreq, freq);
|
2016-03-22 07:44:03 +03:00
|
|
|
|
|
|
|
/*
|
|
|
|
* If the parent and passive devfreq device uses the OPP table,
|
|
|
|
* get the next frequency by using the OPP table.
|
|
|
|
*/
|
|
|
|
|
|
|
|
/*
|
|
|
|
* - parent devfreq device uses the governors except for passive.
|
|
|
|
* - passive devfreq device uses the passive governor.
|
|
|
|
*
|
|
|
|
* Each devfreq has the OPP table. After deciding the new frequency
|
|
|
|
* from the governor of parent devfreq device, the passive governor
|
|
|
|
* need to get the index of new frequency on OPP table of parent
|
|
|
|
* device. And then the index is used for getting the suitable
|
|
|
|
* new frequency for passive devfreq device.
|
|
|
|
*/
|
|
|
|
if (!devfreq->profile || !devfreq->profile->freq_table
|
|
|
|
|| devfreq->profile->max_state <= 0)
|
|
|
|
return -EINVAL;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* The passive governor have to get the correct frequency from OPP
|
|
|
|
* list of parent device. Because in this case, *freq is temporary
|
|
|
|
* value which is decided by ondemand governor.
|
|
|
|
*/
|
2021-02-04 11:14:24 +03:00
|
|
|
if (devfreq->opp_table && parent_devfreq->opp_table) {
|
|
|
|
p_opp = devfreq_recommended_opp(parent_devfreq->dev.parent,
|
|
|
|
freq, 0);
|
|
|
|
if (IS_ERR(p_opp))
|
|
|
|
return PTR_ERR(p_opp);
|
|
|
|
|
|
|
|
opp = dev_pm_opp_xlate_required_opp(parent_devfreq->opp_table,
|
|
|
|
devfreq->opp_table, p_opp);
|
|
|
|
dev_pm_opp_put(p_opp);
|
|
|
|
|
|
|
|
if (IS_ERR(opp))
|
|
|
|
return PTR_ERR(opp);
|
2016-03-22 07:44:03 +03:00
|
|
|
|
2021-02-04 11:14:24 +03:00
|
|
|
*freq = dev_pm_opp_get_freq(opp);
|
|
|
|
dev_pm_opp_put(opp);
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
2017-01-23 07:41:47 +03:00
|
|
|
|
2016-03-22 07:44:03 +03:00
|
|
|
/*
|
2021-02-04 11:14:24 +03:00
|
|
|
* Get the OPP table's index of decided frequency by governor
|
2016-03-22 07:44:03 +03:00
|
|
|
* of parent device.
|
|
|
|
*/
|
|
|
|
for (i = 0; i < parent_devfreq->profile->max_state; i++)
|
|
|
|
if (parent_devfreq->profile->freq_table[i] == *freq)
|
|
|
|
break;
|
|
|
|
|
2021-02-04 11:14:24 +03:00
|
|
|
if (i == parent_devfreq->profile->max_state)
|
|
|
|
return -EINVAL;
|
2016-03-22 07:44:03 +03:00
|
|
|
|
|
|
|
/* Get the suitable frequency by using index of parent device. */
|
|
|
|
if (i < devfreq->profile->max_state) {
|
|
|
|
child_freq = devfreq->profile->freq_table[i];
|
|
|
|
} else {
|
|
|
|
count = devfreq->profile->max_state;
|
|
|
|
child_freq = devfreq->profile->freq_table[count - 1];
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Return the suitable frequency for passive device. */
|
|
|
|
*freq = child_freq;
|
|
|
|
|
2021-02-04 11:14:24 +03:00
|
|
|
return 0;
|
2016-03-22 07:44:03 +03:00
|
|
|
}
|
|
|
|
|
|
|
|
static int devfreq_passive_notifier_call(struct notifier_block *nb,
|
|
|
|
unsigned long event, void *ptr)
|
|
|
|
{
|
|
|
|
struct devfreq_passive_data *data
|
|
|
|
= container_of(nb, struct devfreq_passive_data, nb);
|
|
|
|
struct devfreq *devfreq = (struct devfreq *)data->this;
|
|
|
|
struct devfreq *parent = (struct devfreq *)data->parent;
|
|
|
|
struct devfreq_freqs *freqs = (struct devfreq_freqs *)ptr;
|
|
|
|
unsigned long freq = freqs->new;
|
2020-10-07 16:02:39 +03:00
|
|
|
int ret = 0;
|
2016-03-22 07:44:03 +03:00
|
|
|
|
2020-10-07 16:02:39 +03:00
|
|
|
mutex_lock_nested(&devfreq->lock, SINGLE_DEPTH_NESTING);
|
2016-03-22 07:44:03 +03:00
|
|
|
switch (event) {
|
|
|
|
case DEVFREQ_PRECHANGE:
|
|
|
|
if (parent->previous_freq > freq)
|
2020-10-07 16:02:39 +03:00
|
|
|
ret = devfreq_update_target(devfreq, freq);
|
|
|
|
|
2016-03-22 07:44:03 +03:00
|
|
|
break;
|
|
|
|
case DEVFREQ_POSTCHANGE:
|
|
|
|
if (parent->previous_freq < freq)
|
2020-10-07 16:02:39 +03:00
|
|
|
ret = devfreq_update_target(devfreq, freq);
|
2016-03-22 07:44:03 +03:00
|
|
|
break;
|
|
|
|
}
|
2020-10-07 16:02:39 +03:00
|
|
|
mutex_unlock(&devfreq->lock);
|
|
|
|
|
|
|
|
if (ret < 0)
|
|
|
|
dev_warn(&devfreq->dev,
|
|
|
|
"failed to update devfreq using passive governor\n");
|
2016-03-22 07:44:03 +03:00
|
|
|
|
|
|
|
return NOTIFY_DONE;
|
|
|
|
}
|
|
|
|
|
|
|
|
static int devfreq_passive_event_handler(struct devfreq *devfreq,
|
|
|
|
unsigned int event, void *data)
|
|
|
|
{
|
|
|
|
struct devfreq_passive_data *p_data
|
|
|
|
= (struct devfreq_passive_data *)devfreq->data;
|
|
|
|
struct devfreq *parent = (struct devfreq *)p_data->parent;
|
|
|
|
struct notifier_block *nb = &p_data->nb;
|
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
if (!parent)
|
|
|
|
return -EPROBE_DEFER;
|
|
|
|
|
|
|
|
switch (event) {
|
|
|
|
case DEVFREQ_GOV_START:
|
|
|
|
if (!p_data->this)
|
|
|
|
p_data->this = devfreq;
|
|
|
|
|
|
|
|
nb->notifier_call = devfreq_passive_notifier_call;
|
2019-08-08 19:54:08 +03:00
|
|
|
ret = devfreq_register_notifier(parent, nb,
|
2016-03-22 07:44:03 +03:00
|
|
|
DEVFREQ_TRANSITION_NOTIFIER);
|
|
|
|
break;
|
|
|
|
case DEVFREQ_GOV_STOP:
|
2019-08-08 19:54:08 +03:00
|
|
|
WARN_ON(devfreq_unregister_notifier(parent, nb,
|
|
|
|
DEVFREQ_TRANSITION_NOTIFIER));
|
2016-03-22 07:44:03 +03:00
|
|
|
break;
|
|
|
|
default:
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
}
|
|
|
|
|
|
|
|
static struct devfreq_governor devfreq_passive = {
|
2017-10-23 04:32:12 +03:00
|
|
|
.name = DEVFREQ_GOV_PASSIVE,
|
2020-10-05 08:48:01 +03:00
|
|
|
.flags = DEVFREQ_GOV_FLAG_IMMUTABLE,
|
2016-03-22 07:44:03 +03:00
|
|
|
.get_target_freq = devfreq_passive_get_target_freq,
|
|
|
|
.event_handler = devfreq_passive_event_handler,
|
|
|
|
};
|
|
|
|
|
|
|
|
static int __init devfreq_passive_init(void)
|
|
|
|
{
|
|
|
|
return devfreq_add_governor(&devfreq_passive);
|
|
|
|
}
|
|
|
|
subsys_initcall(devfreq_passive_init);
|
|
|
|
|
|
|
|
static void __exit devfreq_passive_exit(void)
|
|
|
|
{
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
ret = devfreq_remove_governor(&devfreq_passive);
|
|
|
|
if (ret)
|
|
|
|
pr_err("%s: failed remove governor %d\n", __func__, ret);
|
|
|
|
}
|
|
|
|
module_exit(devfreq_passive_exit);
|
|
|
|
|
|
|
|
MODULE_AUTHOR("Chanwoo Choi <cw00.choi@samsung.com>");
|
|
|
|
MODULE_AUTHOR("MyungJoo Ham <myungjoo.ham@samsung.com>");
|
|
|
|
MODULE_DESCRIPTION("DEVFREQ Passive governor");
|
|
|
|
MODULE_LICENSE("GPL v2");
|