89 static u32 estimate_sustainable_power(struct thermal_zone_device *tz)  in estimate_sustainable_power()  argument
93 	struct power_allocator_params *params = tz->governor_data;  in estimate_sustainable_power()
95 	list_for_each_entry(instance, &tz->thermal_instances, tz_node) {  in estimate_sustainable_power()
124 static void estimate_pid_constants(struct thermal_zone_device *tz,  in estimate_pid_constants()  argument
133 	ret = tz->ops->get_trip_temp(tz, trip_switch_on, &switch_on_temp);  in estimate_pid_constants()
149 	tz->tzp->k_po = int_to_frac(sustainable_power) /  in estimate_pid_constants()
152 	tz->tzp->k_pu = int_to_frac(2 * sustainable_power) /  in estimate_pid_constants()
155 	k_i = tz->tzp->k_pu / 10;  in estimate_pid_constants()
156 	tz->tzp->k_i = k_i > 0 ? k_i : 1;  in estimate_pid_constants()
175 static u32 get_sustainable_power(struct thermal_zone_device *tz,  in get_sustainable_power()  argument
181 	if (!tz->tzp->sustainable_power)  in get_sustainable_power()
182 		sustainable_power = estimate_sustainable_power(tz);  in get_sustainable_power()
184 		sustainable_power = tz->tzp->sustainable_power;  in get_sustainable_power()
188 		estimate_pid_constants(tz, sustainable_power,  in get_sustainable_power()
192 		tz->tzp->sustainable_power = sustainable_power;  in get_sustainable_power()
217 static u32 pid_controller(struct thermal_zone_device *tz,  in pid_controller()  argument
224 	struct power_allocator_params *params = tz->governor_data;  in pid_controller()
228 	sustainable_power = get_sustainable_power(tz, params, control_temp);  in pid_controller()
230 	err = control_temp - tz->temperature;  in pid_controller()
234 	p = mul_frac(err < 0 ? tz->tzp->k_po : tz->tzp->k_pu, err);  in pid_controller()
242 	i = mul_frac(tz->tzp->k_i, params->err_integral);  in pid_controller()
244 	if (err < int_to_frac(tz->tzp->integral_cutoff)) {  in pid_controller()
245 		s64 i_next = i + mul_frac(tz->tzp->k_i, err);  in pid_controller()
260 	d = mul_frac(tz->tzp->k_d, err - params->prev_err);  in pid_controller()
261 	d = div_frac(d, jiffies_to_msecs(tz->passive_delay_jiffies));  in pid_controller()
271 	trace_thermal_power_allocator_pid(tz, frac_to_int(err),  in pid_controller()
383 static int allocate_power(struct thermal_zone_device *tz,  in allocate_power()  argument
387 	struct power_allocator_params *params = tz->governor_data;  in allocate_power()
397 	list_for_each_entry(instance, &tz->thermal_instances, tz_node) {  in allocate_power()
433 	list_for_each_entry(instance, &tz->thermal_instances, tz_node) {  in allocate_power()
464 	power_range = pid_controller(tz, control_temp, max_allocatable_power);  in allocate_power()
472 	list_for_each_entry(instance, &tz->thermal_instances, tz_node) {  in allocate_power()
486 	trace_thermal_power_allocator(tz, req_power, total_req_power,  in allocate_power()
489 				      max_allocatable_power, tz->temperature,  in allocate_power()
490 				      control_temp - tz->temperature);  in allocate_power()
512 static void get_governor_trips(struct thermal_zone_device *tz,  in get_governor_trips()  argument
522 	for (i = 0; i < tz->num_trips; i++) {  in get_governor_trips()
526 		ret = tz->ops->get_trip_type(tz, i, &type);  in get_governor_trips()
528 			dev_warn(&tz->device,  in get_governor_trips()
565 static void allow_maximum_power(struct thermal_zone_device *tz, bool update)  in allow_maximum_power()  argument
568 	struct power_allocator_params *params = tz->governor_data;  in allow_maximum_power()
571 	list_for_each_entry(instance, &tz->thermal_instances, tz_node) {  in allow_maximum_power()
606 static int check_power_actors(struct thermal_zone_device *tz)  in check_power_actors()  argument
611 	list_for_each_entry(instance, &tz->thermal_instances, tz_node) {  in check_power_actors()
613 			dev_warn(&tz->device, "power_allocator: %s is not a power actor\n",  in check_power_actors()
632 static int power_allocator_bind(struct thermal_zone_device *tz)  in power_allocator_bind()  argument
638 	ret = check_power_actors(tz);  in power_allocator_bind()
646 	if (!tz->tzp) {  in power_allocator_bind()
647 		tz->tzp = kzalloc(sizeof(*tz->tzp), GFP_KERNEL);  in power_allocator_bind()
648 		if (!tz->tzp) {  in power_allocator_bind()
656 	if (!tz->tzp->sustainable_power)  in power_allocator_bind()
657 		dev_warn(&tz->device, "power_allocator: sustainable_power will be estimated\n");  in power_allocator_bind()
659 	get_governor_trips(tz, params);  in power_allocator_bind()
661 	if (tz->num_trips > 0) {  in power_allocator_bind()
662 		ret = tz->ops->get_trip_temp(tz,  in power_allocator_bind()
666 			estimate_pid_constants(tz, tz->tzp->sustainable_power,  in power_allocator_bind()
673 	tz->governor_data = params;  in power_allocator_bind()
683 static void power_allocator_unbind(struct thermal_zone_device *tz)  in power_allocator_unbind()  argument
685 	struct power_allocator_params *params = tz->governor_data;  in power_allocator_unbind()
687 	dev_dbg(&tz->device, "Unbinding from thermal zone %d\n", tz->id);  in power_allocator_unbind()
690 		kfree(tz->tzp);  in power_allocator_unbind()
691 		tz->tzp = NULL;  in power_allocator_unbind()
694 	kfree(tz->governor_data);  in power_allocator_unbind()
695 	tz->governor_data = NULL;  in power_allocator_unbind()
698 static int power_allocator_throttle(struct thermal_zone_device *tz, int trip)  in power_allocator_throttle()  argument
702 	struct power_allocator_params *params = tz->governor_data;  in power_allocator_throttle()
705 	lockdep_assert_held(&tz->lock);  in power_allocator_throttle()
714 	ret = tz->ops->get_trip_temp(tz, params->trip_switch_on,  in power_allocator_throttle()
716 	if (!ret && (tz->temperature < switch_on_temp)) {  in power_allocator_throttle()
717 		update = (tz->last_temperature >= switch_on_temp);  in power_allocator_throttle()
718 		tz->passive = 0;  in power_allocator_throttle()
720 		allow_maximum_power(tz, update);  in power_allocator_throttle()
724 	tz->passive = 1;  in power_allocator_throttle()
726 	ret = tz->ops->get_trip_temp(tz, params->trip_max_desired_temperature,  in power_allocator_throttle()
729 		dev_warn(&tz->device,  in power_allocator_throttle()
735 	return allocate_power(tz, control_temp);  in power_allocator_throttle()