77  * @tz: thermal zone we are operating in
86 static u32 estimate_sustainable_power(struct thermal_zone_device *tz)  in estimate_sustainable_power()  argument
90 	struct power_allocator_params *params = tz->governor_data;  in estimate_sustainable_power()
92 	list_for_each_entry(instance, &tz->thermal_instances, tz_node) {  in estimate_sustainable_power()
110  * @tz:		thermal zone for which to estimate the constants
127 static void estimate_pid_constants(struct thermal_zone_device *tz,  in estimate_pid_constants()  argument
135 	ret = tz->ops->get_trip_temp(tz, trip_switch_on, &switch_on_temp);  in estimate_pid_constants()
151 	if (!tz->tzp->k_po || force)  in estimate_pid_constants()
152 		tz->tzp->k_po = int_to_frac(sustainable_power) /  in estimate_pid_constants()
155 	if (!tz->tzp->k_pu || force)  in estimate_pid_constants()
156 		tz->tzp->k_pu = int_to_frac(2 * sustainable_power) /  in estimate_pid_constants()
159 	if (!tz->tzp->k_i || force)  in estimate_pid_constants()
160 		tz->tzp->k_i = int_to_frac(10) / 1000;  in estimate_pid_constants()
169  * @tz:	thermal zone we are operating in
185 static u32 pid_controller(struct thermal_zone_device *tz,  in pid_controller()  argument
192 	struct power_allocator_params *params = tz->governor_data;  in pid_controller()
196 	if (tz->tzp->sustainable_power) {  in pid_controller()
197 		sustainable_power = tz->tzp->sustainable_power;  in pid_controller()
199 		sustainable_power = estimate_sustainable_power(tz);  in pid_controller()
200 		estimate_pid_constants(tz, sustainable_power,  in pid_controller()
205 	err = control_temp - tz->temperature;  in pid_controller()
209 	p = mul_frac(err < 0 ? tz->tzp->k_po : tz->tzp->k_pu, err);  in pid_controller()
217 	i = mul_frac(tz->tzp->k_i, params->err_integral);  in pid_controller()
219 	if (err < int_to_frac(tz->tzp->integral_cutoff)) {  in pid_controller()
220 		s64 i_next = i + mul_frac(tz->tzp->k_i, err);  in pid_controller()
235 	d = mul_frac(tz->tzp->k_d, err - params->prev_err);  in pid_controller()
236 	d = div_frac(d, tz->passive_delay);  in pid_controller()
246 	trace_thermal_power_allocator_pid(tz, frac_to_int(err),  in pid_controller()
325 static int allocate_power(struct thermal_zone_device *tz,  in allocate_power()  argument
329 	struct power_allocator_params *params = tz->governor_data;  in allocate_power()
337 	mutex_lock(&tz->lock);  in allocate_power()
341 	list_for_each_entry(instance, &tz->thermal_instances, tz_node) {  in allocate_power()
381 	list_for_each_entry(instance, &tz->thermal_instances, tz_node) {  in allocate_power()
411 	power_range = pid_controller(tz, control_temp, max_allocatable_power);  in allocate_power()
419 	list_for_each_entry(instance, &tz->thermal_instances, tz_node) {  in allocate_power()
433 	trace_thermal_power_allocator(tz, req_power, total_req_power,  in allocate_power()
436 				      max_allocatable_power, tz->temperature,  in allocate_power()
437 				      control_temp - tz->temperature);  in allocate_power()
441 	mutex_unlock(&tz->lock);  in allocate_power()
448  * @tz:	thermal zone to operate on
461 static void get_governor_trips(struct thermal_zone_device *tz,  in get_governor_trips()  argument
471 	for (i = 0; i < tz->trips; i++) {  in get_governor_trips()
475 		ret = tz->ops->get_trip_type(tz, i, &type);  in get_governor_trips()
477 			dev_warn(&tz->device,  in get_governor_trips()
514 static void allow_maximum_power(struct thermal_zone_device *tz)  in allow_maximum_power()  argument
517 	struct power_allocator_params *params = tz->governor_data;  in allow_maximum_power()
519 	mutex_lock(&tz->lock);  in allow_maximum_power()
520 	list_for_each_entry(instance, &tz->thermal_instances, tz_node) {  in allow_maximum_power()
531 	mutex_unlock(&tz->lock);  in allow_maximum_power()
536  * @tz:	thermal zone to bind it to
543 static int power_allocator_bind(struct thermal_zone_device *tz)  in power_allocator_bind()  argument
553 	if (!tz->tzp) {  in power_allocator_bind()
554 		tz->tzp = kzalloc(sizeof(*tz->tzp), GFP_KERNEL);  in power_allocator_bind()
555 		if (!tz->tzp) {  in power_allocator_bind()
563 	if (!tz->tzp->sustainable_power)  in power_allocator_bind()
564 		dev_warn(&tz->device, "power_allocator: sustainable_power will be estimated\n");  in power_allocator_bind()
566 	get_governor_trips(tz, params);  in power_allocator_bind()
568 	if (tz->trips > 0) {  in power_allocator_bind()
569 		ret = tz->ops->get_trip_temp(tz,  in power_allocator_bind()
573 			estimate_pid_constants(tz, tz->tzp->sustainable_power,  in power_allocator_bind()
580 	tz->governor_data = params;  in power_allocator_bind()
590 static void power_allocator_unbind(struct thermal_zone_device *tz)  in power_allocator_unbind()  argument
592 	struct power_allocator_params *params = tz->governor_data;  in power_allocator_unbind()
594 	dev_dbg(&tz->device, "Unbinding from thermal zone %d\n", tz->id);  in power_allocator_unbind()
597 		kfree(tz->tzp);  in power_allocator_unbind()
598 		tz->tzp = NULL;  in power_allocator_unbind()
601 	kfree(tz->governor_data);  in power_allocator_unbind()
602 	tz->governor_data = NULL;  in power_allocator_unbind()
605 static int power_allocator_throttle(struct thermal_zone_device *tz, int trip)  in power_allocator_throttle()  argument
609 	struct power_allocator_params *params = tz->governor_data;  in power_allocator_throttle()
618 	ret = tz->ops->get_trip_temp(tz, params->trip_switch_on,  in power_allocator_throttle()
620 	if (!ret && (tz->temperature < switch_on_temp)) {  in power_allocator_throttle()
621 		tz->passive = 0;  in power_allocator_throttle()
623 		allow_maximum_power(tz);  in power_allocator_throttle()
627 	tz->passive = 1;  in power_allocator_throttle()
629 	ret = tz->ops->get_trip_temp(tz, params->trip_max_desired_temperature,  in power_allocator_throttle()
632 		dev_warn(&tz->device,  in power_allocator_throttle()
638 	return allocate_power(tz, control_temp);  in power_allocator_throttle()