cpu_cooling.c revision a0f846c23cf8e52da054abb52294d54e4b1986f9
1023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/* 2023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * linux/drivers/thermal/cpu_cooling.c 3023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * 4023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * Copyright (C) 2012 Samsung Electronics Co., Ltd(http://www.samsung.com) 5023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * Copyright (C) 2012 Amit Daniel <amit.kachhap@linaro.org> 6023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * 7023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ 8023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * This program is free software; you can redistribute it and/or modify 9023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * it under the terms of the GNU General Public License as published by 10023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * the Free Software Foundation; version 2 of the License. 11023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * 12023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * This program is distributed in the hope that it will be useful, but 13023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * WITHOUT ANY WARRANTY; without even the implied warranty of 14023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 15023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * General Public License for more details. 16023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * 17023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * You should have received a copy of the GNU General Public License along 18023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * with this program; if not, write to the Free Software Foundation, Inc., 19023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA. 20023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * 21023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~ 22023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap */ 23023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap#include <linux/kernel.h> 24023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap#include <linux/module.h> 25023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap#include <linux/thermal.h> 26023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap#include <linux/platform_device.h> 27023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap#include <linux/cpufreq.h> 28023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap#include <linux/err.h> 29023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap#include <linux/slab.h> 30023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap#include <linux/cpu.h> 31023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap#include <linux/cpu_cooling.h> 32023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 33023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/** 34023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * struct cpufreq_cooling_device 35023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @id: unique integer value corresponding to each cpufreq_cooling_device 36023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * registered. 37023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @cool_dev: thermal_cooling_device pointer to keep track of the the 38023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * egistered cooling device. 39023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @cpufreq_state: integer value representing the current state of cpufreq 40023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * cooling devices. 41023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @cpufreq_val: integer value representing the absolute value of the clipped 42023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * frequency. 43023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @allowed_cpus: all the cpus involved for this cpufreq_cooling_device. 44023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @node: list_head to link all cpufreq_cooling_device together. 45023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * 46023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * This structure is required for keeping information of each 47023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * cpufreq_cooling_device registered as a list whose head is represented by 48023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * cooling_cpufreq_list. In order to prevent corruption of this list a 49023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * mutex lock cooling_cpufreq_lock is used. 50023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap */ 51023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapstruct cpufreq_cooling_device { 52023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap int id; 53023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap struct thermal_cooling_device *cool_dev; 54023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap unsigned int cpufreq_state; 55023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap unsigned int cpufreq_val; 56023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap struct cpumask allowed_cpus; 57023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap struct list_head node; 58023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap}; 59023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapstatic LIST_HEAD(cooling_cpufreq_list); 60023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapstatic DEFINE_IDR(cpufreq_idr); 61160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhangstatic DEFINE_MUTEX(cooling_cpufreq_lock); 62023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 63160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhangstatic unsigned int cpufreq_dev_count; 64023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 65023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/* notify_table passes value to the CPUFREQ_ADJUST callback function. */ 66023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap#define NOTIFY_INVALID NULL 67a0f846c23cf8e52da054abb52294d54e4b1986f9Sachin Kamatstatic struct cpufreq_cooling_device *notify_device; 68023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 69023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/** 70023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * get_idr - function to get a unique id. 71023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @idr: struct idr * handle used to create a id. 72023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @id: int * value generated by this function. 73023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap */ 74023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapstatic int get_idr(struct idr *idr, int *id) 75023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap{ 76023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap int err; 77023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapagain: 78023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (unlikely(idr_pre_get(idr, GFP_KERNEL) == 0)) 79023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return -ENOMEM; 80023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 81023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap mutex_lock(&cooling_cpufreq_lock); 82023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap err = idr_get_new(idr, NULL, id); 83023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap mutex_unlock(&cooling_cpufreq_lock); 84023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 85023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (unlikely(err == -EAGAIN)) 86023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap goto again; 87023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap else if (unlikely(err)) 88023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return err; 89023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 9029b19e250434c6193c8b8e4c34c9c6284dd4f101Len Brown *id = *id & MAX_IDR_MASK; 91023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return 0; 92023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap} 93023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 94023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/** 95023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * release_idr - function to free the unique id. 96023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @idr: struct idr * handle used for creating the id. 97023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @id: int value representing the unique id. 98023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap */ 99023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapstatic void release_idr(struct idr *idr, int id) 100023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap{ 101023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap mutex_lock(&cooling_cpufreq_lock); 102023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap idr_remove(idr, id); 103023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap mutex_unlock(&cooling_cpufreq_lock); 104023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap} 105023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 106023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/* Below code defines functions to be used for cpufreq as cooling device */ 107023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 108023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/** 109023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * is_cpufreq_valid - function to check if a cpu has frequency transition policy. 110023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @cpu: cpu for which check is needed. 111023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap */ 112023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapstatic int is_cpufreq_valid(int cpu) 113023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap{ 114023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap struct cpufreq_policy policy; 115023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return !cpufreq_get_policy(&policy, cpu); 116023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap} 117023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 118023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/** 119023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * get_cpu_frequency - get the absolute value of frequency from level. 120023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @cpu: cpu for which frequency is fetched. 121023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @level: level of frequency of the CPU 122023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * e.g level=1 --> 1st MAX FREQ, LEVEL=2 ---> 2nd MAX FREQ, .... etc 123023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap */ 124023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapstatic unsigned int get_cpu_frequency(unsigned int cpu, unsigned long level) 125023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap{ 126023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap int ret = 0, i = 0; 127023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap unsigned long level_index; 128023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap bool descend = false; 129023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap struct cpufreq_frequency_table *table = 130023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap cpufreq_frequency_get_table(cpu); 131023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (!table) 132023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return ret; 133023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 134023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap while (table[i].frequency != CPUFREQ_TABLE_END) { 135023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (table[i].frequency == CPUFREQ_ENTRY_INVALID) 136023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap continue; 137023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 138023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap /*check if table in ascending or descending order*/ 139023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if ((table[i + 1].frequency != CPUFREQ_TABLE_END) && 140023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap (table[i + 1].frequency < table[i].frequency) 141023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap && !descend) { 142023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap descend = true; 143023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap } 144023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 145023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap /*return if level matched and table in descending order*/ 146023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (descend && i == level) 147023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return table[i].frequency; 148023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap i++; 149023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap } 150023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap i--; 151023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 152023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (level > i || descend) 153023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return ret; 154023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap level_index = i - level; 155023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 156023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap /*Scan the table in reverse order and match the level*/ 157023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap while (i >= 0) { 158023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (table[i].frequency == CPUFREQ_ENTRY_INVALID) 159023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap continue; 160023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap /*return if level matched*/ 161023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (i == level_index) 162023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return table[i].frequency; 163023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap i--; 164023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap } 165023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return ret; 166023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap} 167023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 168023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/** 169023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * cpufreq_apply_cooling - function to apply frequency clipping. 170023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @cpufreq_device: cpufreq_cooling_device pointer containing frequency 171023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * clipping data. 172023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @cooling_state: value of the cooling state. 173023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap */ 174023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapstatic int cpufreq_apply_cooling(struct cpufreq_cooling_device *cpufreq_device, 175023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap unsigned long cooling_state) 176023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap{ 177023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap unsigned int cpuid, clip_freq; 178023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap struct cpumask *maskPtr = &cpufreq_device->allowed_cpus; 179023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap unsigned int cpu = cpumask_any(maskPtr); 180023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 181023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 182023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap /* Check if the old cooling action is same as new cooling action */ 183023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (cpufreq_device->cpufreq_state == cooling_state) 184023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return 0; 185023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 186023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap clip_freq = get_cpu_frequency(cpu, cooling_state); 187023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (!clip_freq) 188023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return -EINVAL; 189023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 190023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap cpufreq_device->cpufreq_state = cooling_state; 191023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap cpufreq_device->cpufreq_val = clip_freq; 192023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap notify_device = cpufreq_device; 193023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 194023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap for_each_cpu(cpuid, maskPtr) { 195023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (is_cpufreq_valid(cpuid)) 196023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap cpufreq_update_policy(cpuid); 197023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap } 198023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 199023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap notify_device = NOTIFY_INVALID; 200023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 201023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return 0; 202023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap} 203023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 204023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/** 205023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * cpufreq_thermal_notifier - notifier callback for cpufreq policy change. 206023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @nb: struct notifier_block * with callback info. 207023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @event: value showing cpufreq event for which this function invoked. 208023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @data: callback-specific data 209023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap */ 210023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapstatic int cpufreq_thermal_notifier(struct notifier_block *nb, 211023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap unsigned long event, void *data) 212023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap{ 213023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap struct cpufreq_policy *policy = data; 214023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap unsigned long max_freq = 0; 215023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 216023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (event != CPUFREQ_ADJUST || notify_device == NOTIFY_INVALID) 217023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return 0; 218023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 219023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (cpumask_test_cpu(policy->cpu, ¬ify_device->allowed_cpus)) 220023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap max_freq = notify_device->cpufreq_val; 221023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 222023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap /* Never exceed user_policy.max*/ 223023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (max_freq > policy->user_policy.max) 224023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap max_freq = policy->user_policy.max; 225023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 226023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (policy->max != max_freq) 227023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap cpufreq_verify_within_limits(policy, 0, max_freq); 228023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 229023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return 0; 230023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap} 231023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 232023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/* 233023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * cpufreq cooling device callback functions are defined below 234023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap */ 235023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 236023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/** 237023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * cpufreq_get_max_state - callback function to get the max cooling state. 238023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @cdev: thermal cooling device pointer. 239023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @state: fill this variable with the max cooling state. 240023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap */ 241023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapstatic int cpufreq_get_max_state(struct thermal_cooling_device *cdev, 242023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap unsigned long *state) 243023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap{ 244160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang struct cpufreq_cooling_device *cpufreq_device = cdev->devdata; 245160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang struct cpumask *maskPtr = &cpufreq_device->allowed_cpus; 246023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap unsigned int cpu; 247023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap struct cpufreq_frequency_table *table; 2489c51b05a7852183ba9654ca850bee97d38e948d5hongbo.zhang unsigned long count = 0; 249160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang int i = 0; 250023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 251023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap cpu = cpumask_any(maskPtr); 252023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap table = cpufreq_frequency_get_table(cpu); 253023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (!table) { 254023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap *state = 0; 255160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang return 0; 256023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap } 257023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 2589c51b05a7852183ba9654ca850bee97d38e948d5hongbo.zhang for (i = 0; (table[i].frequency != CPUFREQ_TABLE_END); i++) { 259023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (table[i].frequency == CPUFREQ_ENTRY_INVALID) 260023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap continue; 2619c51b05a7852183ba9654ca850bee97d38e948d5hongbo.zhang count++; 262023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap } 2639c51b05a7852183ba9654ca850bee97d38e948d5hongbo.zhang 2649c51b05a7852183ba9654ca850bee97d38e948d5hongbo.zhang if (count > 0) { 2659c51b05a7852183ba9654ca850bee97d38e948d5hongbo.zhang *state = --count; 266160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang return 0; 267023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap } 268023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 269160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang return -EINVAL; 270023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap} 271023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 272023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/** 273023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * cpufreq_get_cur_state - callback function to get the current cooling state. 274023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @cdev: thermal cooling device pointer. 275023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @state: fill this variable with the current cooling state. 276023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap */ 277023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapstatic int cpufreq_get_cur_state(struct thermal_cooling_device *cdev, 278023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap unsigned long *state) 279023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap{ 280160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang struct cpufreq_cooling_device *cpufreq_device = cdev->devdata; 281023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 282160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang *state = cpufreq_device->cpufreq_state; 283160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang return 0; 284023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap} 285023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 286023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/** 287023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * cpufreq_set_cur_state - callback function to set the current cooling state. 288023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @cdev: thermal cooling device pointer. 289023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @state: set this variable to the current cooling state. 290023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap */ 291023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapstatic int cpufreq_set_cur_state(struct thermal_cooling_device *cdev, 292023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap unsigned long state) 293023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap{ 294160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang struct cpufreq_cooling_device *cpufreq_device = cdev->devdata; 295023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 296160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang return cpufreq_apply_cooling(cpufreq_device, state); 297023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap} 298023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 299023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/* Bind cpufreq callbacks to thermal cooling device ops */ 300023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapstatic struct thermal_cooling_device_ops const cpufreq_cooling_ops = { 301023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap .get_max_state = cpufreq_get_max_state, 302023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap .get_cur_state = cpufreq_get_cur_state, 303023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap .set_cur_state = cpufreq_set_cur_state, 304023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap}; 305023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 306023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/* Notifier for cpufreq policy change */ 307023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapstatic struct notifier_block thermal_cpufreq_notifier_block = { 308023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap .notifier_call = cpufreq_thermal_notifier, 309023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap}; 310023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 311023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/** 312023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * cpufreq_cooling_register - function to create cpufreq cooling device. 313023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @clip_cpus: cpumask of cpus where the frequency constraints will happen. 314023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap */ 315023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapstruct thermal_cooling_device *cpufreq_cooling_register( 316023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap struct cpumask *clip_cpus) 317023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap{ 318023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap struct thermal_cooling_device *cool_dev; 319023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap struct cpufreq_cooling_device *cpufreq_dev = NULL; 320160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang unsigned int min = 0, max = 0; 321023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap char dev_name[THERMAL_NAME_LENGTH]; 322a4b6fec977020a508ff04b05f0fa01221a4ecf29Jonghwa Lee int ret = 0, i; 323023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap struct cpufreq_policy policy; 324023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 325023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap /*Verify that all the clip cpus have same freq_min, freq_max limit*/ 326023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap for_each_cpu(i, clip_cpus) { 327023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap /*continue if cpufreq policy not found and not return error*/ 328023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (!cpufreq_get_policy(&policy, i)) 329023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap continue; 330023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (min == 0 && max == 0) { 331023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap min = policy.cpuinfo.min_freq; 332023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap max = policy.cpuinfo.max_freq; 333023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap } else { 334023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (min != policy.cpuinfo.min_freq || 335023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap max != policy.cpuinfo.max_freq) 336023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return ERR_PTR(-EINVAL); 3376b6519df84afcda294c487bccb83a8caecb48acdhongbo.zhang } 338023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap } 339023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap cpufreq_dev = kzalloc(sizeof(struct cpufreq_cooling_device), 340023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap GFP_KERNEL); 341023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (!cpufreq_dev) 342023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return ERR_PTR(-ENOMEM); 343023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 344023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap cpumask_copy(&cpufreq_dev->allowed_cpus, clip_cpus); 345023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 346023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap ret = get_idr(&cpufreq_idr, &cpufreq_dev->id); 347023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (ret) { 348023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap kfree(cpufreq_dev); 349023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return ERR_PTR(-EINVAL); 350023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap } 351023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 352023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap sprintf(dev_name, "thermal-cpufreq-%d", cpufreq_dev->id); 353023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 354023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap cool_dev = thermal_cooling_device_register(dev_name, cpufreq_dev, 355023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap &cpufreq_cooling_ops); 356023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (!cool_dev) { 357023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap release_idr(&cpufreq_idr, cpufreq_dev->id); 358023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap kfree(cpufreq_dev); 359023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return ERR_PTR(-EINVAL); 360023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap } 361023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap cpufreq_dev->cool_dev = cool_dev; 362023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap cpufreq_dev->cpufreq_state = 0; 363023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap mutex_lock(&cooling_cpufreq_lock); 364023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 365023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap /* Register the notifier for first cpufreq cooling device */ 366023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap if (cpufreq_dev_count == 0) 367023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap cpufreq_register_notifier(&thermal_cpufreq_notifier_block, 368023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap CPUFREQ_POLICY_NOTIFIER); 369160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang cpufreq_dev_count++; 370023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 371023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap mutex_unlock(&cooling_cpufreq_lock); 372023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap return cool_dev; 373023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap} 374023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel KachhapEXPORT_SYMBOL(cpufreq_cooling_register); 375023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 376023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap/** 377023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * cpufreq_cooling_unregister - function to remove cpufreq cooling device. 378023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap * @cdev: thermal cooling device pointer. 379023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap */ 380023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhapvoid cpufreq_cooling_unregister(struct thermal_cooling_device *cdev) 381023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap{ 382160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang struct cpufreq_cooling_device *cpufreq_dev = cdev->devdata; 383023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 384023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap mutex_lock(&cooling_cpufreq_lock); 385160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang cpufreq_dev_count--; 386023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap 387023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap /* Unregister the notifier for the last cpufreq cooling device */ 388160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang if (cpufreq_dev_count == 0) { 389023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap cpufreq_unregister_notifier(&thermal_cpufreq_notifier_block, 390023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap CPUFREQ_POLICY_NOTIFIER); 391023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap } 392023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap mutex_unlock(&cooling_cpufreq_lock); 393160b7d8048b87cb594e1a22b5345b468b6c2c40ehongbo.zhang 394023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap thermal_cooling_device_unregister(cpufreq_dev->cool_dev); 395023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap release_idr(&cpufreq_idr, cpufreq_dev->id); 396023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap kfree(cpufreq_dev); 397023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel Kachhap} 398023614183768a7ac62898bded5ec6c0c9fecbdd9Amit Daniel KachhapEXPORT_SYMBOL(cpufreq_cooling_unregister); 399