107 static unsigned long get_level(struct cpufreq_cooling_device *cpufreq_cdev,  in get_level()  argument
110 	struct freq_table *freq_table = cpufreq_cdev->freq_table;  in get_level()
113 	for (level = 1; level <= cpufreq_cdev->max_level; level++)  in get_level()
133 static int update_freq_table(struct cpufreq_cooling_device *cpufreq_cdev,  in update_freq_table()  argument
136 	struct freq_table *freq_table = cpufreq_cdev->freq_table;  in update_freq_table()
139 	int num_opps = 0, cpu = cpufreq_cdev->policy->cpu, i;  in update_freq_table()
155 	if (num_opps != cpufreq_cdev->max_level + 1) {  in update_freq_table()
160 	for (i = 0; i <= cpufreq_cdev->max_level; i++) {  in update_freq_table()
194 static u32 cpu_freq_to_power(struct cpufreq_cooling_device *cpufreq_cdev,  in cpu_freq_to_power()  argument
198 	struct freq_table *freq_table = cpufreq_cdev->freq_table;  in cpu_freq_to_power()
200 	for (i = 1; i <= cpufreq_cdev->max_level; i++)  in cpu_freq_to_power()
207 static u32 cpu_power_to_freq(struct cpufreq_cooling_device *cpufreq_cdev,  in cpu_power_to_freq()  argument
211 	struct freq_table *freq_table = cpufreq_cdev->freq_table;  in cpu_power_to_freq()
213 	for (i = 1; i <= cpufreq_cdev->max_level; i++)  in cpu_power_to_freq()
229 static u32 get_load(struct cpufreq_cooling_device *cpufreq_cdev, int cpu,  in get_load()  argument
234 	struct time_in_idle *idle_time = &cpufreq_cdev->idle_time[cpu_idx];  in get_load()
259 static u32 get_dynamic_power(struct cpufreq_cooling_device *cpufreq_cdev,  in get_dynamic_power()  argument
264 	raw_cpu_power = cpu_freq_to_power(cpufreq_cdev, freq);  in get_dynamic_power()
265 	return (raw_cpu_power * cpufreq_cdev->last_load) / 100;  in get_dynamic_power()
283 	struct cpufreq_cooling_device *cpufreq_cdev = cdev->devdata;  in cpufreq_get_max_state()  local
285 	*state = cpufreq_cdev->max_level;  in cpufreq_get_max_state()
302 	struct cpufreq_cooling_device *cpufreq_cdev = cdev->devdata;  in cpufreq_get_cur_state()  local
304 	*state = cpufreq_cdev->cpufreq_state;  in cpufreq_get_cur_state()
322 	struct cpufreq_cooling_device *cpufreq_cdev = cdev->devdata;  in cpufreq_set_cur_state()  local
325 	if (WARN_ON(state > cpufreq_cdev->max_level))  in cpufreq_set_cur_state()
329 	if (cpufreq_cdev->cpufreq_state == state)  in cpufreq_set_cur_state()
332 	cpufreq_cdev->cpufreq_state = state;  in cpufreq_set_cur_state()
334 	return freq_qos_update_request(&cpufreq_cdev->qos_req,  in cpufreq_set_cur_state()
335 				cpufreq_cdev->freq_table[state].frequency);  in cpufreq_set_cur_state()
368 	struct cpufreq_cooling_device *cpufreq_cdev = cdev->devdata;  in cpufreq_get_requested_power()  local
369 	struct cpufreq_policy *policy = cpufreq_cdev->policy;  in cpufreq_get_requested_power()
384 			load = get_load(cpufreq_cdev, cpu, i);  in cpufreq_get_requested_power()
395 	cpufreq_cdev->last_load = total_load;  in cpufreq_get_requested_power()
397 	*power = get_dynamic_power(cpufreq_cdev, freq);  in cpufreq_get_requested_power()
429 	struct cpufreq_cooling_device *cpufreq_cdev = cdev->devdata;  in cpufreq_state2power()  local
432 	if (WARN_ON(state > cpufreq_cdev->max_level))  in cpufreq_state2power()
435 	num_cpus = cpumask_weight(cpufreq_cdev->policy->cpus);  in cpufreq_state2power()
437 	freq = cpufreq_cdev->freq_table[state].frequency;  in cpufreq_state2power()
438 	*power = cpu_freq_to_power(cpufreq_cdev, freq) * num_cpus;  in cpufreq_state2power()
469 	struct cpufreq_cooling_device *cpufreq_cdev = cdev->devdata;  in cpufreq_power2state()  local
470 	struct cpufreq_policy *policy = cpufreq_cdev->policy;  in cpufreq_power2state()
472 	last_load = cpufreq_cdev->last_load ?: 1;  in cpufreq_power2state()
474 	target_freq = cpu_power_to_freq(cpufreq_cdev, normalised_power);  in cpufreq_power2state()
476 	*state = get_level(cpufreq_cdev, target_freq);  in cpufreq_power2state()
533 	struct cpufreq_cooling_device *cpufreq_cdev;  in __cpufreq_cooling_register()  local
559 	cpufreq_cdev = kzalloc(sizeof(*cpufreq_cdev), GFP_KERNEL);  in __cpufreq_cooling_register()
560 	if (!cpufreq_cdev)  in __cpufreq_cooling_register()
563 	cpufreq_cdev->policy = policy;  in __cpufreq_cooling_register()
565 	cpufreq_cdev->idle_time = kcalloc(num_cpus,  in __cpufreq_cooling_register()
566 					 sizeof(*cpufreq_cdev->idle_time),  in __cpufreq_cooling_register()
568 	if (!cpufreq_cdev->idle_time) {  in __cpufreq_cooling_register()
574 	cpufreq_cdev->max_level = i - 1;  in __cpufreq_cooling_register()
576 	cpufreq_cdev->freq_table = kmalloc_array(i,  in __cpufreq_cooling_register()
577 					sizeof(*cpufreq_cdev->freq_table),  in __cpufreq_cooling_register()
579 	if (!cpufreq_cdev->freq_table) {  in __cpufreq_cooling_register()
589 	cpufreq_cdev->id = ret;  in __cpufreq_cooling_register()
592 		 cpufreq_cdev->id);  in __cpufreq_cooling_register()
595 	for (i = 0, freq = -1; i <= cpufreq_cdev->max_level; i++) {  in __cpufreq_cooling_register()
597 		cpufreq_cdev->freq_table[i].frequency = freq;  in __cpufreq_cooling_register()
607 		ret = update_freq_table(cpufreq_cdev, capacitance);  in __cpufreq_cooling_register()
619 				   &cpufreq_cdev->qos_req, FREQ_QOS_MAX,  in __cpufreq_cooling_register()
620 				   cpufreq_cdev->freq_table[0].frequency);  in __cpufreq_cooling_register()
628 	cdev = thermal_of_cooling_device_register(np, dev_name, cpufreq_cdev,  in __cpufreq_cooling_register()
634 	list_add(&cpufreq_cdev->node, &cpufreq_cdev_list);  in __cpufreq_cooling_register()
640 	freq_qos_remove_request(&cpufreq_cdev->qos_req);  in __cpufreq_cooling_register()
642 	ida_simple_remove(&cpufreq_ida, cpufreq_cdev->id);  in __cpufreq_cooling_register()
644 	kfree(cpufreq_cdev->freq_table);  in __cpufreq_cooling_register()
646 	kfree(cpufreq_cdev->idle_time);  in __cpufreq_cooling_register()
648 	kfree(cpufreq_cdev);  in __cpufreq_cooling_register()
727 	struct cpufreq_cooling_device *cpufreq_cdev;  in cpufreq_cooling_unregister()  local
732 	cpufreq_cdev = cdev->devdata;  in cpufreq_cooling_unregister()
735 	list_del(&cpufreq_cdev->node);  in cpufreq_cooling_unregister()
739 	freq_qos_remove_request(&cpufreq_cdev->qos_req);  in cpufreq_cooling_unregister()
740 	ida_simple_remove(&cpufreq_ida, cpufreq_cdev->id);  in cpufreq_cooling_unregister()
741 	kfree(cpufreq_cdev->idle_time);  in cpufreq_cooling_unregister()
742 	kfree(cpufreq_cdev->freq_table);  in cpufreq_cooling_unregister()
743 	kfree(cpufreq_cdev);  in cpufreq_cooling_unregister()