Merge branch 'release' of git://git.kernel.org/pub/scm/linux/kernel/git/rzhang/linux
Pull thermal management update from Zhang Rui:
 "Highlights:
   - Introduction of thermal policy support, together with three new
     thermal governors, including step_wise, user_space, fire_share.
   - Introduction of ST-Ericsson db8500_thermal driver and ST-Ericsson
     db8500_cpufreq_cooling driver.
   - Thermal Kconfig file and Makefile refactor.
   - Fixes for generic thermal layer, generic cpucooling, rcar thermal
     driver and Exynos thermal driver."
* 'release' of git://git.kernel.org/pub/scm/linux/kernel/git/rzhang/linux: (36 commits)
  Thermal: Fix DEFAULT_THERMAL_GOVERNOR
  Thermal: fix a NULL pointer dereference when generic thermal layer is built as a module
  thermal: rcar: add rcar_zone_to_priv() macro
  thermal: rcar: fixup the unit of temperature
  thermal: cpu cooling: allow module builds
  thermal: cpu cooling: use const parameter while registering
  Thermal: Add ST-Ericsson DB8500 thermal properties and platform data.
  Thermal: Add ST-Ericsson DB8500 thermal driver.
  drivers/thermal/Makefile refactor
  Exynos: Add missing dependency
  Refactor drivers/thermal/Kconfig
  thermal: cpu_cooling: Make 'notify_device' static
  Thermal: Remove the cooling_cpufreq_list.
  Thermal: fix bug of counting cpu frequencies.
  Thermal: add indent for code alignment.
  thermal: rcar_thermal: remove explicitly used devm_kfree/iounap()
  thermal: user_space: Add missing static storage class specifiers
  thermal: fair_share: Add missing static storage class specifiers
  thermal: step_wise: Add missing static storage class specifiers
  Thermal: Fix oops and unlocking in thermal_sys.c
  ...
	
	
This commit is contained in:
		
				commit
				
					
						50851c6248
					
				
			
		
					 27 changed files with 2039 additions and 399 deletions
				
			
		
							
								
								
									
										44
									
								
								Documentation/devicetree/bindings/thermal/db8500-thermal.txt
									
										
									
									
									
										Normal file
									
								
							
							
						
						
									
										44
									
								
								Documentation/devicetree/bindings/thermal/db8500-thermal.txt
									
										
									
									
									
										Normal file
									
								
							| 
						 | 
				
			
			@ -0,0 +1,44 @@
 | 
			
		|||
* ST-Ericsson DB8500 Thermal
 | 
			
		||||
 | 
			
		||||
** Thermal node properties:
 | 
			
		||||
 | 
			
		||||
- compatible : "stericsson,db8500-thermal";
 | 
			
		||||
- reg : address range of the thermal sensor registers;
 | 
			
		||||
- interrupts : interrupts generated from PRCMU;
 | 
			
		||||
- interrupt-names : "IRQ_HOTMON_LOW" and "IRQ_HOTMON_HIGH";
 | 
			
		||||
- num-trips : number of total trip points, this is required, set it 0 if none,
 | 
			
		||||
  if greater than 0, the following properties must be defined;
 | 
			
		||||
- tripN-temp : temperature of trip point N, should be in ascending order;
 | 
			
		||||
- tripN-type : type of trip point N, should be one of "active" "passive" "hot"
 | 
			
		||||
  "critical";
 | 
			
		||||
- tripN-cdev-num : number of the cooling devices which can be bound to trip
 | 
			
		||||
  point N, this is required if trip point N is defined, set it 0 if none,
 | 
			
		||||
  otherwise the following cooling device names must be defined;
 | 
			
		||||
- tripN-cdev-nameM : name of the No. M cooling device of trip point N;
 | 
			
		||||
 | 
			
		||||
Usually the num-trips and tripN-*** are separated in board related dts files.
 | 
			
		||||
 | 
			
		||||
Example:
 | 
			
		||||
thermal@801573c0 {
 | 
			
		||||
	compatible = "stericsson,db8500-thermal";
 | 
			
		||||
	reg = <0x801573c0 0x40>;
 | 
			
		||||
	interrupts = <21 0x4>, <22 0x4>;
 | 
			
		||||
	interrupt-names = "IRQ_HOTMON_LOW", "IRQ_HOTMON_HIGH";
 | 
			
		||||
 | 
			
		||||
	num-trips = <3>;
 | 
			
		||||
 | 
			
		||||
	trip0-temp = <75000>;
 | 
			
		||||
	trip0-type = "active";
 | 
			
		||||
	trip0-cdev-num = <1>;
 | 
			
		||||
	trip0-cdev-name0 = "thermal-cpufreq-0";
 | 
			
		||||
 | 
			
		||||
	trip1-temp = <80000>;
 | 
			
		||||
	trip1-type = "active";
 | 
			
		||||
	trip1-cdev-num = <2>;
 | 
			
		||||
	trip1-cdev-name0 = "thermal-cpufreq-0";
 | 
			
		||||
	trip1-cdev-name1 = "thermal-fan";
 | 
			
		||||
 | 
			
		||||
	trip2-temp = <85000>;
 | 
			
		||||
	trip2-type = "critical";
 | 
			
		||||
	trip2-cdev-num = <0>;
 | 
			
		||||
}
 | 
			
		||||
| 
						 | 
				
			
			@ -112,6 +112,29 @@ temperature) and throttle appropriate devices.
 | 
			
		|||
    trip: indicates which trip point the cooling devices is associated with
 | 
			
		||||
	  in this thermal zone.
 | 
			
		||||
 | 
			
		||||
1.4 Thermal Zone Parameters
 | 
			
		||||
1.4.1 struct thermal_bind_params
 | 
			
		||||
    This structure defines the following parameters that are used to bind
 | 
			
		||||
    a zone with a cooling device for a particular trip point.
 | 
			
		||||
    .cdev: The cooling device pointer
 | 
			
		||||
    .weight: The 'influence' of a particular cooling device on this zone.
 | 
			
		||||
             This is on a percentage scale. The sum of all these weights
 | 
			
		||||
             (for a particular zone) cannot exceed 100.
 | 
			
		||||
    .trip_mask:This is a bit mask that gives the binding relation between
 | 
			
		||||
               this thermal zone and cdev, for a particular trip point.
 | 
			
		||||
               If nth bit is set, then the cdev and thermal zone are bound
 | 
			
		||||
               for trip point n.
 | 
			
		||||
    .match: This call back returns success(0) if the 'tz and cdev' need to
 | 
			
		||||
	    be bound, as per platform data.
 | 
			
		||||
1.4.2 struct thermal_zone_params
 | 
			
		||||
    This structure defines the platform level parameters for a thermal zone.
 | 
			
		||||
    This data, for each thermal zone should come from the platform layer.
 | 
			
		||||
    This is an optional feature where some platforms can choose not to
 | 
			
		||||
    provide this data.
 | 
			
		||||
    .governor_name: Name of the thermal governor used for this zone
 | 
			
		||||
    .num_tbps: Number of thermal_bind_params entries for this zone
 | 
			
		||||
    .tbp: thermal_bind_params entries
 | 
			
		||||
 | 
			
		||||
2. sysfs attributes structure
 | 
			
		||||
 | 
			
		||||
RO	read only value
 | 
			
		||||
| 
						 | 
				
			
			@ -126,6 +149,7 @@ Thermal zone device sys I/F, created once it's registered:
 | 
			
		|||
    |---type:			Type of the thermal zone
 | 
			
		||||
    |---temp:			Current temperature
 | 
			
		||||
    |---mode:			Working mode of the thermal zone
 | 
			
		||||
    |---policy:			Thermal governor used for this zone
 | 
			
		||||
    |---trip_point_[0-*]_temp:	Trip point temperature
 | 
			
		||||
    |---trip_point_[0-*]_type:	Trip point type
 | 
			
		||||
    |---trip_point_[0-*]_hyst:	Hysteresis value for this trip point
 | 
			
		||||
| 
						 | 
				
			
			@ -187,6 +211,10 @@ mode
 | 
			
		|||
			  charge of the thermal management.
 | 
			
		||||
	RW, Optional
 | 
			
		||||
 | 
			
		||||
policy
 | 
			
		||||
	One of the various thermal governors used for a particular zone.
 | 
			
		||||
	RW, Required
 | 
			
		||||
 | 
			
		||||
trip_point_[0-*]_temp
 | 
			
		||||
	The temperature above which trip point will be fired.
 | 
			
		||||
	Unit: millidegree Celsius
 | 
			
		||||
| 
						 | 
				
			
			@ -264,6 +292,7 @@ method, the sys I/F structure will be built like this:
 | 
			
		|||
    |---type:			acpitz
 | 
			
		||||
    |---temp:			37000
 | 
			
		||||
    |---mode:			enabled
 | 
			
		||||
    |---policy:			step_wise
 | 
			
		||||
    |---trip_point_0_temp:	100000
 | 
			
		||||
    |---trip_point_0_type:	critical
 | 
			
		||||
    |---trip_point_1_temp:	80000
 | 
			
		||||
| 
						 | 
				
			
			@ -305,3 +334,38 @@ to a thermal_zone_device when it registers itself with the framework. The
 | 
			
		|||
event will be one of:{THERMAL_AUX0, THERMAL_AUX1, THERMAL_CRITICAL,
 | 
			
		||||
THERMAL_DEV_FAULT}. Notification can be sent when the current temperature
 | 
			
		||||
crosses any of the configured thresholds.
 | 
			
		||||
 | 
			
		||||
5. Export Symbol APIs:
 | 
			
		||||
 | 
			
		||||
5.1: get_tz_trend:
 | 
			
		||||
This function returns the trend of a thermal zone, i.e the rate of change
 | 
			
		||||
of temperature of the thermal zone. Ideally, the thermal sensor drivers
 | 
			
		||||
are supposed to implement the callback. If they don't, the thermal
 | 
			
		||||
framework calculated the trend by comparing the previous and the current
 | 
			
		||||
temperature values.
 | 
			
		||||
 | 
			
		||||
5.2:get_thermal_instance:
 | 
			
		||||
This function returns the thermal_instance corresponding to a given
 | 
			
		||||
{thermal_zone, cooling_device, trip_point} combination. Returns NULL
 | 
			
		||||
if such an instance does not exist.
 | 
			
		||||
 | 
			
		||||
5.3:notify_thermal_framework:
 | 
			
		||||
This function handles the trip events from sensor drivers. It starts
 | 
			
		||||
throttling the cooling devices according to the policy configured.
 | 
			
		||||
For CRITICAL and HOT trip points, this notifies the respective drivers,
 | 
			
		||||
and does actual throttling for other trip points i.e ACTIVE and PASSIVE.
 | 
			
		||||
The throttling policy is based on the configured platform data; if no
 | 
			
		||||
platform data is provided, this uses the step_wise throttling policy.
 | 
			
		||||
 | 
			
		||||
5.4:thermal_cdev_update:
 | 
			
		||||
This function serves as an arbitrator to set the state of a cooling
 | 
			
		||||
device. It sets the cooling device to the deepest cooling state if
 | 
			
		||||
possible.
 | 
			
		||||
 | 
			
		||||
5.5:thermal_register_governor:
 | 
			
		||||
This function lets the various thermal governors to register themselves
 | 
			
		||||
with the Thermal framework. At run time, depending on a zone's platform
 | 
			
		||||
data, a particular governor is used for throttling.
 | 
			
		||||
 | 
			
		||||
5.6:thermal_unregister_governor:
 | 
			
		||||
This function unregisters a governor from the thermal framework.
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -203,6 +203,14 @@
 | 
			
		|||
				reg = <0x80157450 0xC>;
 | 
			
		||||
			};
 | 
			
		||||
 | 
			
		||||
			thermal@801573c0 {
 | 
			
		||||
				compatible = "stericsson,db8500-thermal";
 | 
			
		||||
				reg = <0x801573c0 0x40>;
 | 
			
		||||
				interrupts = <21 0x4>, <22 0x4>;
 | 
			
		||||
				interrupt-names = "IRQ_HOTMON_LOW", "IRQ_HOTMON_HIGH";
 | 
			
		||||
				status = "disabled";
 | 
			
		||||
			 };
 | 
			
		||||
 | 
			
		||||
			db8500-prcmu-regulators {
 | 
			
		||||
				compatible = "stericsson,db8500-prcmu-regulator";
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -660,5 +668,11 @@
 | 
			
		|||
			ranges = <0 0x50000000 0x4000000>;
 | 
			
		||||
			status = "disabled";
 | 
			
		||||
		};
 | 
			
		||||
 | 
			
		||||
		cpufreq-cooling {
 | 
			
		||||
			compatible = "stericsson,db8500-cpufreq-cooling";
 | 
			
		||||
			status = "disabled";
 | 
			
		||||
		 };
 | 
			
		||||
 | 
			
		||||
	};
 | 
			
		||||
};
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -99,6 +99,33 @@
 | 
			
		|||
			status = "okay";
 | 
			
		||||
		};
 | 
			
		||||
 | 
			
		||||
		prcmu@80157000 {
 | 
			
		||||
			thermal@801573c0 {
 | 
			
		||||
				num-trips = <4>;
 | 
			
		||||
 | 
			
		||||
				trip0-temp = <70000>;
 | 
			
		||||
				trip0-type = "active";
 | 
			
		||||
				trip0-cdev-num = <1>;
 | 
			
		||||
				trip0-cdev-name0 = "thermal-cpufreq-0";
 | 
			
		||||
 | 
			
		||||
				trip1-temp = <75000>;
 | 
			
		||||
				trip1-type = "active";
 | 
			
		||||
				trip1-cdev-num = <1>;
 | 
			
		||||
				trip1-cdev-name0 = "thermal-cpufreq-0";
 | 
			
		||||
 | 
			
		||||
				trip2-temp = <80000>;
 | 
			
		||||
				trip2-type = "active";
 | 
			
		||||
				trip2-cdev-num = <1>;
 | 
			
		||||
				trip2-cdev-name0 = "thermal-cpufreq-0";
 | 
			
		||||
 | 
			
		||||
				trip3-temp = <85000>;
 | 
			
		||||
				trip3-type = "critical";
 | 
			
		||||
				trip3-cdev-num = <0>;
 | 
			
		||||
 | 
			
		||||
				status = "okay";
 | 
			
		||||
			 };
 | 
			
		||||
		};
 | 
			
		||||
 | 
			
		||||
		external-bus@50000000 {
 | 
			
		||||
			status = "okay";
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -183,5 +210,9 @@
 | 
			
		|||
				reg = <0x33>;
 | 
			
		||||
			};
 | 
			
		||||
		};
 | 
			
		||||
 | 
			
		||||
		cpufreq-cooling {
 | 
			
		||||
			status = "okay";
 | 
			
		||||
		};
 | 
			
		||||
	};
 | 
			
		||||
};
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -69,6 +69,8 @@ CONFIG_GPIO_TC3589X=y
 | 
			
		|||
CONFIG_POWER_SUPPLY=y
 | 
			
		||||
CONFIG_AB8500_BM=y
 | 
			
		||||
CONFIG_AB8500_BATTERY_THERM_ON_BATCTRL=y
 | 
			
		||||
CONFIG_THERMAL=y
 | 
			
		||||
CONFIG_CPU_THERMAL=y
 | 
			
		||||
CONFIG_MFD_STMPE=y
 | 
			
		||||
CONFIG_MFD_TC3589X=y
 | 
			
		||||
CONFIG_AB5500_CORE=y
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -16,6 +16,7 @@
 | 
			
		|||
#include <linux/io.h>
 | 
			
		||||
#include <linux/i2c.h>
 | 
			
		||||
#include <linux/platform_data/i2c-nomadik.h>
 | 
			
		||||
#include <linux/platform_data/db8500_thermal.h>
 | 
			
		||||
#include <linux/gpio.h>
 | 
			
		||||
#include <linux/amba/bus.h>
 | 
			
		||||
#include <linux/amba/pl022.h>
 | 
			
		||||
| 
						 | 
				
			
			@ -228,6 +229,67 @@ static struct ab8500_platform_data ab8500_platdata = {
 | 
			
		|||
	.codec		= &ab8500_codec_pdata,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/*
 | 
			
		||||
 * Thermal Sensor
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
static struct resource db8500_thsens_resources[] = {
 | 
			
		||||
	{
 | 
			
		||||
		.name = "IRQ_HOTMON_LOW",
 | 
			
		||||
		.start  = IRQ_PRCMU_HOTMON_LOW,
 | 
			
		||||
		.end    = IRQ_PRCMU_HOTMON_LOW,
 | 
			
		||||
		.flags  = IORESOURCE_IRQ,
 | 
			
		||||
	},
 | 
			
		||||
	{
 | 
			
		||||
		.name = "IRQ_HOTMON_HIGH",
 | 
			
		||||
		.start  = IRQ_PRCMU_HOTMON_HIGH,
 | 
			
		||||
		.end    = IRQ_PRCMU_HOTMON_HIGH,
 | 
			
		||||
		.flags  = IORESOURCE_IRQ,
 | 
			
		||||
	},
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static struct db8500_thsens_platform_data db8500_thsens_data = {
 | 
			
		||||
	.trip_points[0] = {
 | 
			
		||||
		.temp = 70000,
 | 
			
		||||
		.type = THERMAL_TRIP_ACTIVE,
 | 
			
		||||
		.cdev_name = {
 | 
			
		||||
			[0] = "thermal-cpufreq-0",
 | 
			
		||||
		},
 | 
			
		||||
	},
 | 
			
		||||
	.trip_points[1] = {
 | 
			
		||||
		.temp = 75000,
 | 
			
		||||
		.type = THERMAL_TRIP_ACTIVE,
 | 
			
		||||
		.cdev_name = {
 | 
			
		||||
			[0] = "thermal-cpufreq-0",
 | 
			
		||||
		},
 | 
			
		||||
	},
 | 
			
		||||
	.trip_points[2] = {
 | 
			
		||||
		.temp = 80000,
 | 
			
		||||
		.type = THERMAL_TRIP_ACTIVE,
 | 
			
		||||
		.cdev_name = {
 | 
			
		||||
			[0] = "thermal-cpufreq-0",
 | 
			
		||||
		},
 | 
			
		||||
	},
 | 
			
		||||
	.trip_points[3] = {
 | 
			
		||||
		.temp = 85000,
 | 
			
		||||
		.type = THERMAL_TRIP_CRITICAL,
 | 
			
		||||
	},
 | 
			
		||||
	.num_trips = 4,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static struct platform_device u8500_thsens_device = {
 | 
			
		||||
	.name           = "db8500-thermal",
 | 
			
		||||
	.resource       = db8500_thsens_resources,
 | 
			
		||||
	.num_resources  = ARRAY_SIZE(db8500_thsens_resources),
 | 
			
		||||
	.dev	= {
 | 
			
		||||
		.platform_data	= &db8500_thsens_data,
 | 
			
		||||
	},
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static struct platform_device u8500_cpufreq_cooling_device = {
 | 
			
		||||
	.name           = "db8500-cpufreq-cooling",
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/*
 | 
			
		||||
 * TPS61052
 | 
			
		||||
 */
 | 
			
		||||
| 
						 | 
				
			
			@ -583,6 +645,8 @@ static struct platform_device *snowball_platform_devs[] __initdata = {
 | 
			
		|||
	&snowball_key_dev,
 | 
			
		||||
	&snowball_sbnet_dev,
 | 
			
		||||
	&snowball_gpio_en_3v3_regulator_dev,
 | 
			
		||||
	&u8500_thsens_device,
 | 
			
		||||
	&u8500_cpufreq_cooling_device,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static void __init mop500_init_machine(void)
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -900,14 +900,14 @@ static int acpi_thermal_register_thermal_zone(struct acpi_thermal *tz)
 | 
			
		|||
	if (tz->trips.passive.flags.valid)
 | 
			
		||||
		tz->thermal_zone =
 | 
			
		||||
			thermal_zone_device_register("acpitz", trips, 0, tz,
 | 
			
		||||
						     &acpi_thermal_zone_ops,
 | 
			
		||||
						&acpi_thermal_zone_ops, NULL,
 | 
			
		||||
						     tz->trips.passive.tsp*100,
 | 
			
		||||
						     tz->polling_frequency*100);
 | 
			
		||||
	else
 | 
			
		||||
		tz->thermal_zone =
 | 
			
		||||
			thermal_zone_device_register("acpitz", trips, 0, tz,
 | 
			
		||||
						     &acpi_thermal_zone_ops, 0,
 | 
			
		||||
						     tz->polling_frequency*100);
 | 
			
		||||
						&acpi_thermal_zone_ops, NULL,
 | 
			
		||||
						0, tz->polling_frequency*100);
 | 
			
		||||
	if (IS_ERR(tz->thermal_zone))
 | 
			
		||||
		return -ENODEV;
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -662,7 +662,7 @@ static int acerhdf_register_thermal(void)
 | 
			
		|||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	thz_dev = thermal_zone_device_register("acerhdf", 1, 0, NULL,
 | 
			
		||||
					      &acerhdf_dev_ops, 0,
 | 
			
		||||
					      &acerhdf_dev_ops, NULL, 0,
 | 
			
		||||
					      (kernelmode) ? interval*1000 : 0);
 | 
			
		||||
	if (IS_ERR(thz_dev))
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -502,7 +502,7 @@ static int mid_thermal_probe(struct platform_device *pdev)
 | 
			
		|||
			goto err;
 | 
			
		||||
		}
 | 
			
		||||
		pinfo->tzd[i] = thermal_zone_device_register(name[i],
 | 
			
		||||
				0, 0, td_info, &tzd_ops, 0, 0);
 | 
			
		||||
				0, 0, td_info, &tzd_ops, NULL, 0, 0);
 | 
			
		||||
		if (IS_ERR(pinfo->tzd[i])) {
 | 
			
		||||
			kfree(td_info);
 | 
			
		||||
			ret = PTR_ERR(pinfo->tzd[i]);
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -201,7 +201,7 @@ static int psy_register_thermal(struct power_supply *psy)
 | 
			
		|||
	for (i = 0; i < psy->num_properties; i++) {
 | 
			
		||||
		if (psy->properties[i] == POWER_SUPPLY_PROP_TEMP) {
 | 
			
		||||
			psy->tzd = thermal_zone_device_register(psy->name, 0, 0,
 | 
			
		||||
					psy, &psy_tzd_ops, 0, 0);
 | 
			
		||||
					psy, &psy_tzd_ops, NULL, 0, 0);
 | 
			
		||||
			if (IS_ERR(psy->tzd))
 | 
			
		||||
				return PTR_ERR(psy->tzd);
 | 
			
		||||
			break;
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -270,7 +270,7 @@ int omap_thermal_expose_sensor(struct omap_bandgap *bg_ptr, int id,
 | 
			
		|||
	/* Create thermal zone */
 | 
			
		||||
	data->omap_thermal = thermal_zone_device_register(domain,
 | 
			
		||||
				OMAP_TRIP_NUMBER, 0, data, &omap_thermal_ops,
 | 
			
		||||
				FAST_TEMP_MONITORING_RATE,
 | 
			
		||||
				NULL, FAST_TEMP_MONITORING_RATE,
 | 
			
		||||
				FAST_TEMP_MONITORING_RATE);
 | 
			
		||||
	if (IS_ERR_OR_NULL(data->omap_thermal)) {
 | 
			
		||||
		dev_err(bg_ptr->dev, "thermal zone device is NULL\n");
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -13,15 +13,62 @@ menuconfig THERMAL
 | 
			
		|||
	  All platforms with ACPI thermal support can use this driver.
 | 
			
		||||
	  If you want this support, you should say Y or M here.
 | 
			
		||||
 | 
			
		||||
if THERMAL
 | 
			
		||||
 | 
			
		||||
config THERMAL_HWMON
 | 
			
		||||
	bool
 | 
			
		||||
	depends on THERMAL
 | 
			
		||||
	depends on HWMON=y || HWMON=THERMAL
 | 
			
		||||
	default y
 | 
			
		||||
 | 
			
		||||
choice
 | 
			
		||||
	prompt "Default Thermal governor"
 | 
			
		||||
	default THERMAL_DEFAULT_GOV_STEP_WISE
 | 
			
		||||
	help
 | 
			
		||||
	  This option sets which thermal governor shall be loaded at
 | 
			
		||||
	  startup. If in doubt, select 'step_wise'.
 | 
			
		||||
 | 
			
		||||
config THERMAL_DEFAULT_GOV_STEP_WISE
 | 
			
		||||
	bool "step_wise"
 | 
			
		||||
	select STEP_WISE
 | 
			
		||||
	help
 | 
			
		||||
	  Use the step_wise governor as default. This throttles the
 | 
			
		||||
	  devices one step at a time.
 | 
			
		||||
 | 
			
		||||
config THERMAL_DEFAULT_GOV_FAIR_SHARE
 | 
			
		||||
	bool "fair_share"
 | 
			
		||||
	select FAIR_SHARE
 | 
			
		||||
	help
 | 
			
		||||
	  Use the fair_share governor as default. This throttles the
 | 
			
		||||
	  devices based on their 'contribution' to a zone. The
 | 
			
		||||
	  contribution should be provided through platform data.
 | 
			
		||||
 | 
			
		||||
config THERMAL_DEFAULT_GOV_USER_SPACE
 | 
			
		||||
	bool "user_space"
 | 
			
		||||
	select USER_SPACE
 | 
			
		||||
	help
 | 
			
		||||
	  Select this if you want to let the user space manage the
 | 
			
		||||
	  lpatform thermals.
 | 
			
		||||
 | 
			
		||||
endchoice
 | 
			
		||||
 | 
			
		||||
config FAIR_SHARE
 | 
			
		||||
	bool "Fair-share thermal governor"
 | 
			
		||||
	help
 | 
			
		||||
	  Enable this to manage platform thermals using fair-share governor.
 | 
			
		||||
 | 
			
		||||
config STEP_WISE
 | 
			
		||||
	bool "Step_wise thermal governor"
 | 
			
		||||
	help
 | 
			
		||||
	  Enable this to manage platform thermals using a simple linear
 | 
			
		||||
 | 
			
		||||
config USER_SPACE
 | 
			
		||||
	bool "User_space thermal governor"
 | 
			
		||||
	help
 | 
			
		||||
	  Enable this to let the user space manage the platform thermals.
 | 
			
		||||
 | 
			
		||||
config CPU_THERMAL
 | 
			
		||||
	bool "generic cpu cooling support"
 | 
			
		||||
	depends on THERMAL && CPU_FREQ
 | 
			
		||||
	tristate "generic cpu cooling support"
 | 
			
		||||
	depends on CPU_FREQ
 | 
			
		||||
	select CPU_FREQ_TABLE
 | 
			
		||||
	help
 | 
			
		||||
	  This implements the generic cpu cooling mechanism through frequency
 | 
			
		||||
| 
						 | 
				
			
			@ -33,7 +80,6 @@ config CPU_THERMAL
 | 
			
		|||
 | 
			
		||||
config SPEAR_THERMAL
 | 
			
		||||
	bool "SPEAr thermal sensor driver"
 | 
			
		||||
	depends on THERMAL
 | 
			
		||||
	depends on PLAT_SPEAR
 | 
			
		||||
	depends on OF
 | 
			
		||||
	help
 | 
			
		||||
| 
						 | 
				
			
			@ -42,7 +88,6 @@ config SPEAR_THERMAL
 | 
			
		|||
 | 
			
		||||
config RCAR_THERMAL
 | 
			
		||||
	tristate "Renesas R-Car thermal driver"
 | 
			
		||||
	depends on THERMAL
 | 
			
		||||
	depends on ARCH_SHMOBILE
 | 
			
		||||
	help
 | 
			
		||||
	  Enable this to plug the R-Car thermal sensor driver into the Linux
 | 
			
		||||
| 
						 | 
				
			
			@ -50,8 +95,31 @@ config RCAR_THERMAL
 | 
			
		|||
 | 
			
		||||
config EXYNOS_THERMAL
 | 
			
		||||
	tristate "Temperature sensor on Samsung EXYNOS"
 | 
			
		||||
	depends on (ARCH_EXYNOS4 || ARCH_EXYNOS5) && THERMAL
 | 
			
		||||
	select CPU_FREQ_TABLE
 | 
			
		||||
	depends on (ARCH_EXYNOS4 || ARCH_EXYNOS5)
 | 
			
		||||
	depends on CPU_THERMAL
 | 
			
		||||
	help
 | 
			
		||||
	  If you say yes here you get support for TMU (Thermal Managment
 | 
			
		||||
	  Unit) on SAMSUNG EXYNOS series of SoC.
 | 
			
		||||
 | 
			
		||||
config DB8500_THERMAL
 | 
			
		||||
	bool "DB8500 thermal management"
 | 
			
		||||
	depends on ARCH_U8500
 | 
			
		||||
	default y
 | 
			
		||||
	help
 | 
			
		||||
	  Adds DB8500 thermal management implementation according to the thermal
 | 
			
		||||
	  management framework. A thermal zone with several trip points will be
 | 
			
		||||
	  created. Cooling devices can be bound to the trip points to cool this
 | 
			
		||||
	  thermal zone if trip points reached.
 | 
			
		||||
 | 
			
		||||
config DB8500_CPUFREQ_COOLING
 | 
			
		||||
	tristate "DB8500 cpufreq cooling"
 | 
			
		||||
	depends on ARCH_U8500
 | 
			
		||||
	depends on CPU_THERMAL
 | 
			
		||||
	default y
 | 
			
		||||
	help
 | 
			
		||||
	  Adds DB8500 cpufreq cooling devices, and these cooling devices can be
 | 
			
		||||
	  bound to thermal zone trip points. When a trip point reached, the
 | 
			
		||||
	  bound cpufreq cooling device turns active to set CPU frequency low to
 | 
			
		||||
	  cool down the CPU.
 | 
			
		||||
 | 
			
		||||
endif
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -3,7 +3,18 @@
 | 
			
		|||
#
 | 
			
		||||
 | 
			
		||||
obj-$(CONFIG_THERMAL)		+= thermal_sys.o
 | 
			
		||||
 | 
			
		||||
# governors
 | 
			
		||||
obj-$(CONFIG_FAIR_SHARE)	+= fair_share.o
 | 
			
		||||
obj-$(CONFIG_STEP_WISE)		+= step_wise.o
 | 
			
		||||
obj-$(CONFIG_USER_SPACE)	+= user_space.o
 | 
			
		||||
 | 
			
		||||
# cpufreq cooling
 | 
			
		||||
obj-$(CONFIG_CPU_THERMAL)	+= cpu_cooling.o
 | 
			
		||||
 | 
			
		||||
# platform thermal drivers
 | 
			
		||||
obj-$(CONFIG_SPEAR_THERMAL)	+= spear_thermal.o
 | 
			
		||||
obj-$(CONFIG_RCAR_THERMAL)	+= rcar_thermal.o
 | 
			
		||||
obj-$(CONFIG_EXYNOS_THERMAL)	+= exynos_thermal.o
 | 
			
		||||
obj-$(CONFIG_DB8500_THERMAL)	+= db8500_thermal.o
 | 
			
		||||
obj-$(CONFIG_DB8500_CPUFREQ_COOLING)	+= db8500_cpufreq_cooling.o
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -58,12 +58,13 @@ struct cpufreq_cooling_device {
 | 
			
		|||
};
 | 
			
		||||
static LIST_HEAD(cooling_cpufreq_list);
 | 
			
		||||
static DEFINE_IDR(cpufreq_idr);
 | 
			
		||||
static DEFINE_MUTEX(cooling_cpufreq_lock);
 | 
			
		||||
 | 
			
		||||
static struct mutex cooling_cpufreq_lock;
 | 
			
		||||
static unsigned int cpufreq_dev_count;
 | 
			
		||||
 | 
			
		||||
/* notify_table passes value to the CPUFREQ_ADJUST callback function. */
 | 
			
		||||
#define NOTIFY_INVALID NULL
 | 
			
		||||
struct cpufreq_cooling_device *notify_device;
 | 
			
		||||
static struct cpufreq_cooling_device *notify_device;
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * get_idr - function to get a unique id.
 | 
			
		||||
| 
						 | 
				
			
			@ -240,42 +241,32 @@ static int cpufreq_thermal_notifier(struct notifier_block *nb,
 | 
			
		|||
static int cpufreq_get_max_state(struct thermal_cooling_device *cdev,
 | 
			
		||||
				 unsigned long *state)
 | 
			
		||||
{
 | 
			
		||||
	int ret = -EINVAL, i = 0;
 | 
			
		||||
	struct cpufreq_cooling_device *cpufreq_device;
 | 
			
		||||
	struct cpumask *maskPtr;
 | 
			
		||||
	struct cpufreq_cooling_device *cpufreq_device = cdev->devdata;
 | 
			
		||||
	struct cpumask *maskPtr = &cpufreq_device->allowed_cpus;
 | 
			
		||||
	unsigned int cpu;
 | 
			
		||||
	struct cpufreq_frequency_table *table;
 | 
			
		||||
	unsigned long count = 0;
 | 
			
		||||
	int i = 0;
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&cooling_cpufreq_lock);
 | 
			
		||||
	list_for_each_entry(cpufreq_device, &cooling_cpufreq_list, node) {
 | 
			
		||||
		if (cpufreq_device && cpufreq_device->cool_dev == cdev)
 | 
			
		||||
			break;
 | 
			
		||||
	}
 | 
			
		||||
	if (cpufreq_device == NULL)
 | 
			
		||||
		goto return_get_max_state;
 | 
			
		||||
 | 
			
		||||
	maskPtr = &cpufreq_device->allowed_cpus;
 | 
			
		||||
	cpu = cpumask_any(maskPtr);
 | 
			
		||||
	table = cpufreq_frequency_get_table(cpu);
 | 
			
		||||
	if (!table) {
 | 
			
		||||
		*state = 0;
 | 
			
		||||
		ret = 0;
 | 
			
		||||
		goto return_get_max_state;
 | 
			
		||||
		return 0;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	while (table[i].frequency != CPUFREQ_TABLE_END) {
 | 
			
		||||
	for (i = 0; (table[i].frequency != CPUFREQ_TABLE_END); i++) {
 | 
			
		||||
		if (table[i].frequency == CPUFREQ_ENTRY_INVALID)
 | 
			
		||||
			continue;
 | 
			
		||||
		i++;
 | 
			
		||||
	}
 | 
			
		||||
	if (i > 0) {
 | 
			
		||||
		*state = --i;
 | 
			
		||||
		ret = 0;
 | 
			
		||||
		count++;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
return_get_max_state:
 | 
			
		||||
	mutex_unlock(&cooling_cpufreq_lock);
 | 
			
		||||
	return ret;
 | 
			
		||||
	if (count > 0) {
 | 
			
		||||
		*state = --count;
 | 
			
		||||
		return 0;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return -EINVAL;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
| 
						 | 
				
			
			@ -286,20 +277,10 @@ return_get_max_state:
 | 
			
		|||
static int cpufreq_get_cur_state(struct thermal_cooling_device *cdev,
 | 
			
		||||
				 unsigned long *state)
 | 
			
		||||
{
 | 
			
		||||
	int ret = -EINVAL;
 | 
			
		||||
	struct cpufreq_cooling_device *cpufreq_device;
 | 
			
		||||
	struct cpufreq_cooling_device *cpufreq_device = cdev->devdata;
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&cooling_cpufreq_lock);
 | 
			
		||||
	list_for_each_entry(cpufreq_device, &cooling_cpufreq_list, node) {
 | 
			
		||||
		if (cpufreq_device && cpufreq_device->cool_dev == cdev) {
 | 
			
		||||
	*state = cpufreq_device->cpufreq_state;
 | 
			
		||||
			ret = 0;
 | 
			
		||||
			break;
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
	mutex_unlock(&cooling_cpufreq_lock);
 | 
			
		||||
 | 
			
		||||
	return ret;
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
| 
						 | 
				
			
			@ -310,22 +291,9 @@ static int cpufreq_get_cur_state(struct thermal_cooling_device *cdev,
 | 
			
		|||
static int cpufreq_set_cur_state(struct thermal_cooling_device *cdev,
 | 
			
		||||
				 unsigned long state)
 | 
			
		||||
{
 | 
			
		||||
	int ret = -EINVAL;
 | 
			
		||||
	struct cpufreq_cooling_device *cpufreq_device;
 | 
			
		||||
	struct cpufreq_cooling_device *cpufreq_device = cdev->devdata;
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&cooling_cpufreq_lock);
 | 
			
		||||
	list_for_each_entry(cpufreq_device, &cooling_cpufreq_list, node) {
 | 
			
		||||
		if (cpufreq_device && cpufreq_device->cool_dev == cdev) {
 | 
			
		||||
			ret = 0;
 | 
			
		||||
			break;
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
	if (!ret)
 | 
			
		||||
		ret = cpufreq_apply_cooling(cpufreq_device, state);
 | 
			
		||||
 | 
			
		||||
	mutex_unlock(&cooling_cpufreq_lock);
 | 
			
		||||
 | 
			
		||||
	return ret;
 | 
			
		||||
	return cpufreq_apply_cooling(cpufreq_device, state);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* Bind cpufreq callbacks to thermal cooling device ops */
 | 
			
		||||
| 
						 | 
				
			
			@ -345,18 +313,15 @@ static struct notifier_block thermal_cpufreq_notifier_block = {
 | 
			
		|||
 * @clip_cpus: cpumask of cpus where the frequency constraints will happen.
 | 
			
		||||
 */
 | 
			
		||||
struct thermal_cooling_device *cpufreq_cooling_register(
 | 
			
		||||
	struct cpumask *clip_cpus)
 | 
			
		||||
	const struct cpumask *clip_cpus)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_cooling_device *cool_dev;
 | 
			
		||||
	struct cpufreq_cooling_device *cpufreq_dev = NULL;
 | 
			
		||||
	unsigned int cpufreq_dev_count = 0, min = 0, max = 0;
 | 
			
		||||
	unsigned int min = 0, max = 0;
 | 
			
		||||
	char dev_name[THERMAL_NAME_LENGTH];
 | 
			
		||||
	int ret = 0, i;
 | 
			
		||||
	struct cpufreq_policy policy;
 | 
			
		||||
 | 
			
		||||
	list_for_each_entry(cpufreq_dev, &cooling_cpufreq_list, node)
 | 
			
		||||
		cpufreq_dev_count++;
 | 
			
		||||
 | 
			
		||||
	/*Verify that all the clip cpus have same freq_min, freq_max limit*/
 | 
			
		||||
	for_each_cpu(i, clip_cpus) {
 | 
			
		||||
		/*continue if cpufreq policy not found and not return error*/
 | 
			
		||||
| 
						 | 
				
			
			@ -369,7 +334,7 @@ struct thermal_cooling_device *cpufreq_cooling_register(
 | 
			
		|||
			if (min != policy.cpuinfo.min_freq ||
 | 
			
		||||
				max != policy.cpuinfo.max_freq)
 | 
			
		||||
				return ERR_PTR(-EINVAL);
 | 
			
		||||
}
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
	cpufreq_dev = kzalloc(sizeof(struct cpufreq_cooling_device),
 | 
			
		||||
			GFP_KERNEL);
 | 
			
		||||
| 
						 | 
				
			
			@ -378,9 +343,6 @@ struct thermal_cooling_device *cpufreq_cooling_register(
 | 
			
		|||
 | 
			
		||||
	cpumask_copy(&cpufreq_dev->allowed_cpus, clip_cpus);
 | 
			
		||||
 | 
			
		||||
	if (cpufreq_dev_count == 0)
 | 
			
		||||
		mutex_init(&cooling_cpufreq_lock);
 | 
			
		||||
 | 
			
		||||
	ret = get_idr(&cpufreq_idr, &cpufreq_dev->id);
 | 
			
		||||
	if (ret) {
 | 
			
		||||
		kfree(cpufreq_dev);
 | 
			
		||||
| 
						 | 
				
			
			@ -399,12 +361,12 @@ struct thermal_cooling_device *cpufreq_cooling_register(
 | 
			
		|||
	cpufreq_dev->cool_dev = cool_dev;
 | 
			
		||||
	cpufreq_dev->cpufreq_state = 0;
 | 
			
		||||
	mutex_lock(&cooling_cpufreq_lock);
 | 
			
		||||
	list_add_tail(&cpufreq_dev->node, &cooling_cpufreq_list);
 | 
			
		||||
 | 
			
		||||
	/* Register the notifier for first cpufreq cooling device */
 | 
			
		||||
	if (cpufreq_dev_count == 0)
 | 
			
		||||
		cpufreq_register_notifier(&thermal_cpufreq_notifier_block,
 | 
			
		||||
						CPUFREQ_POLICY_NOTIFIER);
 | 
			
		||||
	cpufreq_dev_count++;
 | 
			
		||||
 | 
			
		||||
	mutex_unlock(&cooling_cpufreq_lock);
 | 
			
		||||
	return cool_dev;
 | 
			
		||||
| 
						 | 
				
			
			@ -417,33 +379,20 @@ EXPORT_SYMBOL(cpufreq_cooling_register);
 | 
			
		|||
 */
 | 
			
		||||
void cpufreq_cooling_unregister(struct thermal_cooling_device *cdev)
 | 
			
		||||
{
 | 
			
		||||
	struct cpufreq_cooling_device *cpufreq_dev = NULL;
 | 
			
		||||
	unsigned int cpufreq_dev_count = 0;
 | 
			
		||||
	struct cpufreq_cooling_device *cpufreq_dev = cdev->devdata;
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&cooling_cpufreq_lock);
 | 
			
		||||
	list_for_each_entry(cpufreq_dev, &cooling_cpufreq_list, node) {
 | 
			
		||||
		if (cpufreq_dev && cpufreq_dev->cool_dev == cdev)
 | 
			
		||||
			break;
 | 
			
		||||
		cpufreq_dev_count++;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (!cpufreq_dev || cpufreq_dev->cool_dev != cdev) {
 | 
			
		||||
		mutex_unlock(&cooling_cpufreq_lock);
 | 
			
		||||
		return;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	list_del(&cpufreq_dev->node);
 | 
			
		||||
	cpufreq_dev_count--;
 | 
			
		||||
 | 
			
		||||
	/* Unregister the notifier for the last cpufreq cooling device */
 | 
			
		||||
	if (cpufreq_dev_count == 1) {
 | 
			
		||||
	if (cpufreq_dev_count == 0) {
 | 
			
		||||
		cpufreq_unregister_notifier(&thermal_cpufreq_notifier_block,
 | 
			
		||||
					CPUFREQ_POLICY_NOTIFIER);
 | 
			
		||||
	}
 | 
			
		||||
	mutex_unlock(&cooling_cpufreq_lock);
 | 
			
		||||
 | 
			
		||||
	thermal_cooling_device_unregister(cpufreq_dev->cool_dev);
 | 
			
		||||
	release_idr(&cpufreq_idr, cpufreq_dev->id);
 | 
			
		||||
	if (cpufreq_dev_count == 1)
 | 
			
		||||
		mutex_destroy(&cooling_cpufreq_lock);
 | 
			
		||||
	kfree(cpufreq_dev);
 | 
			
		||||
}
 | 
			
		||||
EXPORT_SYMBOL(cpufreq_cooling_unregister);
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
							
								
								
									
										108
									
								
								drivers/thermal/db8500_cpufreq_cooling.c
									
										
									
									
									
										Normal file
									
								
							
							
						
						
									
										108
									
								
								drivers/thermal/db8500_cpufreq_cooling.c
									
										
									
									
									
										Normal file
									
								
							| 
						 | 
				
			
			@ -0,0 +1,108 @@
 | 
			
		|||
/*
 | 
			
		||||
 * db8500_cpufreq_cooling.c - DB8500 cpufreq works as cooling device.
 | 
			
		||||
 *
 | 
			
		||||
 * Copyright (C) 2012 ST-Ericsson
 | 
			
		||||
 * Copyright (C) 2012 Linaro Ltd.
 | 
			
		||||
 *
 | 
			
		||||
 * Author: Hongbo Zhang <hongbo.zhang@linaro.com>
 | 
			
		||||
 *
 | 
			
		||||
 * This program is free software; you can redistribute it and/or modify
 | 
			
		||||
 * it under the terms of the GNU General Public License as published by
 | 
			
		||||
 * the Free Software Foundation; either version 2 of the License, or
 | 
			
		||||
 * (at your option) any later version.
 | 
			
		||||
 *
 | 
			
		||||
 * This program is distributed in the hope that it will be useful,
 | 
			
		||||
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
			
		||||
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | 
			
		||||
 * GNU General Public License for more details.
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
#include <linux/cpu_cooling.h>
 | 
			
		||||
#include <linux/cpufreq.h>
 | 
			
		||||
#include <linux/err.h>
 | 
			
		||||
#include <linux/module.h>
 | 
			
		||||
#include <linux/platform_device.h>
 | 
			
		||||
#include <linux/slab.h>
 | 
			
		||||
 | 
			
		||||
static int db8500_cpufreq_cooling_probe(struct platform_device *pdev)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_cooling_device *cdev;
 | 
			
		||||
	struct cpumask mask_val;
 | 
			
		||||
 | 
			
		||||
	/* make sure cpufreq driver has been initialized */
 | 
			
		||||
	if (!cpufreq_frequency_get_table(0))
 | 
			
		||||
		return -EPROBE_DEFER;
 | 
			
		||||
 | 
			
		||||
	cpumask_set_cpu(0, &mask_val);
 | 
			
		||||
	cdev = cpufreq_cooling_register(&mask_val);
 | 
			
		||||
 | 
			
		||||
	if (IS_ERR_OR_NULL(cdev)) {
 | 
			
		||||
		dev_err(&pdev->dev, "Failed to register cooling device\n");
 | 
			
		||||
		return PTR_ERR(cdev);
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	platform_set_drvdata(pdev, cdev);
 | 
			
		||||
 | 
			
		||||
	dev_info(&pdev->dev, "Cooling device registered: %s\n",	cdev->type);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int db8500_cpufreq_cooling_remove(struct platform_device *pdev)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_cooling_device *cdev = platform_get_drvdata(pdev);
 | 
			
		||||
 | 
			
		||||
	cpufreq_cooling_unregister(cdev);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int db8500_cpufreq_cooling_suspend(struct platform_device *pdev,
 | 
			
		||||
		pm_message_t state)
 | 
			
		||||
{
 | 
			
		||||
	return -ENOSYS;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int db8500_cpufreq_cooling_resume(struct platform_device *pdev)
 | 
			
		||||
{
 | 
			
		||||
	return -ENOSYS;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
#ifdef CONFIG_OF
 | 
			
		||||
static const struct of_device_id db8500_cpufreq_cooling_match[] = {
 | 
			
		||||
	{ .compatible = "stericsson,db8500-cpufreq-cooling" },
 | 
			
		||||
	{},
 | 
			
		||||
};
 | 
			
		||||
#else
 | 
			
		||||
#define db8500_cpufreq_cooling_match NULL
 | 
			
		||||
#endif
 | 
			
		||||
 | 
			
		||||
static struct platform_driver db8500_cpufreq_cooling_driver = {
 | 
			
		||||
	.driver = {
 | 
			
		||||
		.owner = THIS_MODULE,
 | 
			
		||||
		.name = "db8500-cpufreq-cooling",
 | 
			
		||||
		.of_match_table = db8500_cpufreq_cooling_match,
 | 
			
		||||
	},
 | 
			
		||||
	.probe = db8500_cpufreq_cooling_probe,
 | 
			
		||||
	.suspend = db8500_cpufreq_cooling_suspend,
 | 
			
		||||
	.resume = db8500_cpufreq_cooling_resume,
 | 
			
		||||
	.remove = db8500_cpufreq_cooling_remove,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static int __init db8500_cpufreq_cooling_init(void)
 | 
			
		||||
{
 | 
			
		||||
	return platform_driver_register(&db8500_cpufreq_cooling_driver);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void __exit db8500_cpufreq_cooling_exit(void)
 | 
			
		||||
{
 | 
			
		||||
	platform_driver_unregister(&db8500_cpufreq_cooling_driver);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* Should be later than db8500_cpufreq_register */
 | 
			
		||||
late_initcall(db8500_cpufreq_cooling_init);
 | 
			
		||||
module_exit(db8500_cpufreq_cooling_exit);
 | 
			
		||||
 | 
			
		||||
MODULE_AUTHOR("Hongbo Zhang <hongbo.zhang@stericsson.com>");
 | 
			
		||||
MODULE_DESCRIPTION("DB8500 cpufreq cooling driver");
 | 
			
		||||
MODULE_LICENSE("GPL");
 | 
			
		||||
							
								
								
									
										531
									
								
								drivers/thermal/db8500_thermal.c
									
										
									
									
									
										Normal file
									
								
							
							
						
						
									
										531
									
								
								drivers/thermal/db8500_thermal.c
									
										
									
									
									
										Normal file
									
								
							| 
						 | 
				
			
			@ -0,0 +1,531 @@
 | 
			
		|||
/*
 | 
			
		||||
 * db8500_thermal.c - DB8500 Thermal Management Implementation
 | 
			
		||||
 *
 | 
			
		||||
 * Copyright (C) 2012 ST-Ericsson
 | 
			
		||||
 * Copyright (C) 2012 Linaro Ltd.
 | 
			
		||||
 *
 | 
			
		||||
 * Author: Hongbo Zhang <hongbo.zhang@linaro.com>
 | 
			
		||||
 *
 | 
			
		||||
 * This program is free software; you can redistribute it and/or modify
 | 
			
		||||
 * it under the terms of the GNU General Public License as published by
 | 
			
		||||
 * the Free Software Foundation; either version 2 of the License, or
 | 
			
		||||
 * (at your option) any later version.
 | 
			
		||||
 *
 | 
			
		||||
 * This program is distributed in the hope that it will be useful,
 | 
			
		||||
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
			
		||||
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | 
			
		||||
 * GNU General Public License for more details.
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
#include <linux/cpu_cooling.h>
 | 
			
		||||
#include <linux/interrupt.h>
 | 
			
		||||
#include <linux/mfd/dbx500-prcmu.h>
 | 
			
		||||
#include <linux/module.h>
 | 
			
		||||
#include <linux/of.h>
 | 
			
		||||
#include <linux/platform_data/db8500_thermal.h>
 | 
			
		||||
#include <linux/platform_device.h>
 | 
			
		||||
#include <linux/slab.h>
 | 
			
		||||
#include <linux/thermal.h>
 | 
			
		||||
 | 
			
		||||
#define PRCMU_DEFAULT_MEASURE_TIME	0xFFF
 | 
			
		||||
#define PRCMU_DEFAULT_LOW_TEMP		0
 | 
			
		||||
 | 
			
		||||
struct db8500_thermal_zone {
 | 
			
		||||
	struct thermal_zone_device *therm_dev;
 | 
			
		||||
	struct mutex th_lock;
 | 
			
		||||
	struct work_struct therm_work;
 | 
			
		||||
	struct db8500_thsens_platform_data *trip_tab;
 | 
			
		||||
	enum thermal_device_mode mode;
 | 
			
		||||
	enum thermal_trend trend;
 | 
			
		||||
	unsigned long cur_temp_pseudo;
 | 
			
		||||
	unsigned int cur_index;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/* Local function to check if thermal zone matches cooling devices */
 | 
			
		||||
static int db8500_thermal_match_cdev(struct thermal_cooling_device *cdev,
 | 
			
		||||
		struct db8500_trip_point *trip_point)
 | 
			
		||||
{
 | 
			
		||||
	int i;
 | 
			
		||||
 | 
			
		||||
	if (!strlen(cdev->type))
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	for (i = 0; i < COOLING_DEV_MAX; i++) {
 | 
			
		||||
		if (!strcmp(trip_point->cdev_name[i], cdev->type))
 | 
			
		||||
			return 0;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return -ENODEV;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* Callback to bind cooling device to thermal zone */
 | 
			
		||||
static int db8500_cdev_bind(struct thermal_zone_device *thermal,
 | 
			
		||||
		struct thermal_cooling_device *cdev)
 | 
			
		||||
{
 | 
			
		||||
	struct db8500_thermal_zone *pzone = thermal->devdata;
 | 
			
		||||
	struct db8500_thsens_platform_data *ptrips = pzone->trip_tab;
 | 
			
		||||
	unsigned long max_state, upper, lower;
 | 
			
		||||
	int i, ret = -EINVAL;
 | 
			
		||||
 | 
			
		||||
	cdev->ops->get_max_state(cdev, &max_state);
 | 
			
		||||
 | 
			
		||||
	for (i = 0; i < ptrips->num_trips; i++) {
 | 
			
		||||
		if (db8500_thermal_match_cdev(cdev, &ptrips->trip_points[i]))
 | 
			
		||||
			continue;
 | 
			
		||||
 | 
			
		||||
		upper = lower = i > max_state ? max_state : i;
 | 
			
		||||
 | 
			
		||||
		ret = thermal_zone_bind_cooling_device(thermal, i, cdev,
 | 
			
		||||
			upper, lower);
 | 
			
		||||
 | 
			
		||||
		dev_info(&cdev->device, "%s bind to %d: %d-%s\n", cdev->type,
 | 
			
		||||
			i, ret, ret ? "fail" : "succeed");
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return ret;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* Callback to unbind cooling device from thermal zone */
 | 
			
		||||
static int db8500_cdev_unbind(struct thermal_zone_device *thermal,
 | 
			
		||||
		struct thermal_cooling_device *cdev)
 | 
			
		||||
{
 | 
			
		||||
	struct db8500_thermal_zone *pzone = thermal->devdata;
 | 
			
		||||
	struct db8500_thsens_platform_data *ptrips = pzone->trip_tab;
 | 
			
		||||
	int i, ret = -EINVAL;
 | 
			
		||||
 | 
			
		||||
	for (i = 0; i < ptrips->num_trips; i++) {
 | 
			
		||||
		if (db8500_thermal_match_cdev(cdev, &ptrips->trip_points[i]))
 | 
			
		||||
			continue;
 | 
			
		||||
 | 
			
		||||
		ret = thermal_zone_unbind_cooling_device(thermal, i, cdev);
 | 
			
		||||
 | 
			
		||||
		dev_info(&cdev->device, "%s unbind from %d: %s\n", cdev->type,
 | 
			
		||||
			i, ret ? "fail" : "succeed");
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return ret;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* Callback to get current temperature */
 | 
			
		||||
static int db8500_sys_get_temp(struct thermal_zone_device *thermal,
 | 
			
		||||
		unsigned long *temp)
 | 
			
		||||
{
 | 
			
		||||
	struct db8500_thermal_zone *pzone = thermal->devdata;
 | 
			
		||||
 | 
			
		||||
	/*
 | 
			
		||||
	 * TODO: There is no PRCMU interface to get temperature data currently,
 | 
			
		||||
	 * so a pseudo temperature is returned , it works for thermal framework
 | 
			
		||||
	 * and this will be fixed when the PRCMU interface is available.
 | 
			
		||||
	 */
 | 
			
		||||
	*temp = pzone->cur_temp_pseudo;
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* Callback to get temperature changing trend */
 | 
			
		||||
static int db8500_sys_get_trend(struct thermal_zone_device *thermal,
 | 
			
		||||
		int trip, enum thermal_trend *trend)
 | 
			
		||||
{
 | 
			
		||||
	struct db8500_thermal_zone *pzone = thermal->devdata;
 | 
			
		||||
 | 
			
		||||
	*trend = pzone->trend;
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* Callback to get thermal zone mode */
 | 
			
		||||
static int db8500_sys_get_mode(struct thermal_zone_device *thermal,
 | 
			
		||||
		enum thermal_device_mode *mode)
 | 
			
		||||
{
 | 
			
		||||
	struct db8500_thermal_zone *pzone = thermal->devdata;
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&pzone->th_lock);
 | 
			
		||||
	*mode = pzone->mode;
 | 
			
		||||
	mutex_unlock(&pzone->th_lock);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* Callback to set thermal zone mode */
 | 
			
		||||
static int db8500_sys_set_mode(struct thermal_zone_device *thermal,
 | 
			
		||||
		enum thermal_device_mode mode)
 | 
			
		||||
{
 | 
			
		||||
	struct db8500_thermal_zone *pzone = thermal->devdata;
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&pzone->th_lock);
 | 
			
		||||
 | 
			
		||||
	pzone->mode = mode;
 | 
			
		||||
	if (mode == THERMAL_DEVICE_ENABLED)
 | 
			
		||||
		schedule_work(&pzone->therm_work);
 | 
			
		||||
 | 
			
		||||
	mutex_unlock(&pzone->th_lock);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* Callback to get trip point type */
 | 
			
		||||
static int db8500_sys_get_trip_type(struct thermal_zone_device *thermal,
 | 
			
		||||
		int trip, enum thermal_trip_type *type)
 | 
			
		||||
{
 | 
			
		||||
	struct db8500_thermal_zone *pzone = thermal->devdata;
 | 
			
		||||
	struct db8500_thsens_platform_data *ptrips = pzone->trip_tab;
 | 
			
		||||
 | 
			
		||||
	if (trip >= ptrips->num_trips)
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	*type = ptrips->trip_points[trip].type;
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* Callback to get trip point temperature */
 | 
			
		||||
static int db8500_sys_get_trip_temp(struct thermal_zone_device *thermal,
 | 
			
		||||
		int trip, unsigned long *temp)
 | 
			
		||||
{
 | 
			
		||||
	struct db8500_thermal_zone *pzone = thermal->devdata;
 | 
			
		||||
	struct db8500_thsens_platform_data *ptrips = pzone->trip_tab;
 | 
			
		||||
 | 
			
		||||
	if (trip >= ptrips->num_trips)
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	*temp = ptrips->trip_points[trip].temp;
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* Callback to get critical trip point temperature */
 | 
			
		||||
static int db8500_sys_get_crit_temp(struct thermal_zone_device *thermal,
 | 
			
		||||
		unsigned long *temp)
 | 
			
		||||
{
 | 
			
		||||
	struct db8500_thermal_zone *pzone = thermal->devdata;
 | 
			
		||||
	struct db8500_thsens_platform_data *ptrips = pzone->trip_tab;
 | 
			
		||||
	int i;
 | 
			
		||||
 | 
			
		||||
	for (i = ptrips->num_trips - 1; i > 0; i--) {
 | 
			
		||||
		if (ptrips->trip_points[i].type == THERMAL_TRIP_CRITICAL) {
 | 
			
		||||
			*temp = ptrips->trip_points[i].temp;
 | 
			
		||||
			return 0;
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return -EINVAL;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static struct thermal_zone_device_ops thdev_ops = {
 | 
			
		||||
	.bind = db8500_cdev_bind,
 | 
			
		||||
	.unbind = db8500_cdev_unbind,
 | 
			
		||||
	.get_temp = db8500_sys_get_temp,
 | 
			
		||||
	.get_trend = db8500_sys_get_trend,
 | 
			
		||||
	.get_mode = db8500_sys_get_mode,
 | 
			
		||||
	.set_mode = db8500_sys_set_mode,
 | 
			
		||||
	.get_trip_type = db8500_sys_get_trip_type,
 | 
			
		||||
	.get_trip_temp = db8500_sys_get_trip_temp,
 | 
			
		||||
	.get_crit_temp = db8500_sys_get_crit_temp,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static void db8500_thermal_update_config(struct db8500_thermal_zone *pzone,
 | 
			
		||||
		unsigned int idx, enum thermal_trend trend,
 | 
			
		||||
		unsigned long next_low, unsigned long next_high)
 | 
			
		||||
{
 | 
			
		||||
	prcmu_stop_temp_sense();
 | 
			
		||||
 | 
			
		||||
	pzone->cur_index = idx;
 | 
			
		||||
	pzone->cur_temp_pseudo = (next_low + next_high)/2;
 | 
			
		||||
	pzone->trend = trend;
 | 
			
		||||
 | 
			
		||||
	prcmu_config_hotmon((u8)(next_low/1000), (u8)(next_high/1000));
 | 
			
		||||
	prcmu_start_temp_sense(PRCMU_DEFAULT_MEASURE_TIME);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static irqreturn_t prcmu_low_irq_handler(int irq, void *irq_data)
 | 
			
		||||
{
 | 
			
		||||
	struct db8500_thermal_zone *pzone = irq_data;
 | 
			
		||||
	struct db8500_thsens_platform_data *ptrips = pzone->trip_tab;
 | 
			
		||||
	unsigned int idx = pzone->cur_index;
 | 
			
		||||
	unsigned long next_low, next_high;
 | 
			
		||||
 | 
			
		||||
	if (unlikely(idx == 0))
 | 
			
		||||
		/* Meaningless for thermal management, ignoring it */
 | 
			
		||||
		return IRQ_HANDLED;
 | 
			
		||||
 | 
			
		||||
	if (idx == 1) {
 | 
			
		||||
		next_high = ptrips->trip_points[0].temp;
 | 
			
		||||
		next_low = PRCMU_DEFAULT_LOW_TEMP;
 | 
			
		||||
	} else {
 | 
			
		||||
		next_high = ptrips->trip_points[idx-1].temp;
 | 
			
		||||
		next_low = ptrips->trip_points[idx-2].temp;
 | 
			
		||||
	}
 | 
			
		||||
	idx -= 1;
 | 
			
		||||
 | 
			
		||||
	db8500_thermal_update_config(pzone, idx, THERMAL_TREND_DROPPING,
 | 
			
		||||
		next_low, next_high);
 | 
			
		||||
 | 
			
		||||
	dev_dbg(&pzone->therm_dev->device,
 | 
			
		||||
		"PRCMU set max %ld, min %ld\n", next_high, next_low);
 | 
			
		||||
 | 
			
		||||
	schedule_work(&pzone->therm_work);
 | 
			
		||||
 | 
			
		||||
	return IRQ_HANDLED;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static irqreturn_t prcmu_high_irq_handler(int irq, void *irq_data)
 | 
			
		||||
{
 | 
			
		||||
	struct db8500_thermal_zone *pzone = irq_data;
 | 
			
		||||
	struct db8500_thsens_platform_data *ptrips = pzone->trip_tab;
 | 
			
		||||
	unsigned int idx = pzone->cur_index;
 | 
			
		||||
	unsigned long next_low, next_high;
 | 
			
		||||
 | 
			
		||||
	if (idx < ptrips->num_trips - 1) {
 | 
			
		||||
		next_high = ptrips->trip_points[idx+1].temp;
 | 
			
		||||
		next_low = ptrips->trip_points[idx].temp;
 | 
			
		||||
		idx += 1;
 | 
			
		||||
 | 
			
		||||
		db8500_thermal_update_config(pzone, idx, THERMAL_TREND_RAISING,
 | 
			
		||||
			next_low, next_high);
 | 
			
		||||
 | 
			
		||||
		dev_dbg(&pzone->therm_dev->device,
 | 
			
		||||
		"PRCMU set max %ld, min %ld\n", next_high, next_low);
 | 
			
		||||
	} else if (idx == ptrips->num_trips - 1)
 | 
			
		||||
		pzone->cur_temp_pseudo = ptrips->trip_points[idx].temp + 1;
 | 
			
		||||
 | 
			
		||||
	schedule_work(&pzone->therm_work);
 | 
			
		||||
 | 
			
		||||
	return IRQ_HANDLED;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void db8500_thermal_work(struct work_struct *work)
 | 
			
		||||
{
 | 
			
		||||
	enum thermal_device_mode cur_mode;
 | 
			
		||||
	struct db8500_thermal_zone *pzone;
 | 
			
		||||
 | 
			
		||||
	pzone = container_of(work, struct db8500_thermal_zone, therm_work);
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&pzone->th_lock);
 | 
			
		||||
	cur_mode = pzone->mode;
 | 
			
		||||
	mutex_unlock(&pzone->th_lock);
 | 
			
		||||
 | 
			
		||||
	if (cur_mode == THERMAL_DEVICE_DISABLED)
 | 
			
		||||
		return;
 | 
			
		||||
 | 
			
		||||
	thermal_zone_device_update(pzone->therm_dev);
 | 
			
		||||
	dev_dbg(&pzone->therm_dev->device, "thermal work finished.\n");
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
#ifdef CONFIG_OF
 | 
			
		||||
static struct db8500_thsens_platform_data*
 | 
			
		||||
		db8500_thermal_parse_dt(struct platform_device *pdev)
 | 
			
		||||
{
 | 
			
		||||
	struct db8500_thsens_platform_data *ptrips;
 | 
			
		||||
	struct device_node *np = pdev->dev.of_node;
 | 
			
		||||
	char prop_name[32];
 | 
			
		||||
	const char *tmp_str;
 | 
			
		||||
	u32 tmp_data;
 | 
			
		||||
	int i, j;
 | 
			
		||||
 | 
			
		||||
	ptrips = devm_kzalloc(&pdev->dev, sizeof(*ptrips), GFP_KERNEL);
 | 
			
		||||
	if (!ptrips)
 | 
			
		||||
		return NULL;
 | 
			
		||||
 | 
			
		||||
	if (of_property_read_u32(np, "num-trips", &tmp_data))
 | 
			
		||||
		goto err_parse_dt;
 | 
			
		||||
 | 
			
		||||
	if (tmp_data > THERMAL_MAX_TRIPS)
 | 
			
		||||
		goto err_parse_dt;
 | 
			
		||||
 | 
			
		||||
	ptrips->num_trips = tmp_data;
 | 
			
		||||
 | 
			
		||||
	for (i = 0; i < ptrips->num_trips; i++) {
 | 
			
		||||
		sprintf(prop_name, "trip%d-temp", i);
 | 
			
		||||
		if (of_property_read_u32(np, prop_name, &tmp_data))
 | 
			
		||||
			goto err_parse_dt;
 | 
			
		||||
 | 
			
		||||
		ptrips->trip_points[i].temp = tmp_data;
 | 
			
		||||
 | 
			
		||||
		sprintf(prop_name, "trip%d-type", i);
 | 
			
		||||
		if (of_property_read_string(np, prop_name, &tmp_str))
 | 
			
		||||
			goto err_parse_dt;
 | 
			
		||||
 | 
			
		||||
		if (!strcmp(tmp_str, "active"))
 | 
			
		||||
			ptrips->trip_points[i].type = THERMAL_TRIP_ACTIVE;
 | 
			
		||||
		else if (!strcmp(tmp_str, "passive"))
 | 
			
		||||
			ptrips->trip_points[i].type = THERMAL_TRIP_PASSIVE;
 | 
			
		||||
		else if (!strcmp(tmp_str, "hot"))
 | 
			
		||||
			ptrips->trip_points[i].type = THERMAL_TRIP_HOT;
 | 
			
		||||
		else if (!strcmp(tmp_str, "critical"))
 | 
			
		||||
			ptrips->trip_points[i].type = THERMAL_TRIP_CRITICAL;
 | 
			
		||||
		else
 | 
			
		||||
			goto err_parse_dt;
 | 
			
		||||
 | 
			
		||||
		sprintf(prop_name, "trip%d-cdev-num", i);
 | 
			
		||||
		if (of_property_read_u32(np, prop_name, &tmp_data))
 | 
			
		||||
			goto err_parse_dt;
 | 
			
		||||
 | 
			
		||||
		if (tmp_data > COOLING_DEV_MAX)
 | 
			
		||||
			goto err_parse_dt;
 | 
			
		||||
 | 
			
		||||
		for (j = 0; j < tmp_data; j++) {
 | 
			
		||||
			sprintf(prop_name, "trip%d-cdev-name%d", i, j);
 | 
			
		||||
			if (of_property_read_string(np, prop_name, &tmp_str))
 | 
			
		||||
				goto err_parse_dt;
 | 
			
		||||
 | 
			
		||||
			if (strlen(tmp_str) >= THERMAL_NAME_LENGTH)
 | 
			
		||||
				goto err_parse_dt;
 | 
			
		||||
 | 
			
		||||
			strcpy(ptrips->trip_points[i].cdev_name[j], tmp_str);
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
	return ptrips;
 | 
			
		||||
 | 
			
		||||
err_parse_dt:
 | 
			
		||||
	dev_err(&pdev->dev, "Parsing device tree data error.\n");
 | 
			
		||||
	return NULL;
 | 
			
		||||
}
 | 
			
		||||
#else
 | 
			
		||||
static inline struct db8500_thsens_platform_data*
 | 
			
		||||
		db8500_thermal_parse_dt(struct platform_device *pdev)
 | 
			
		||||
{
 | 
			
		||||
	return NULL;
 | 
			
		||||
}
 | 
			
		||||
#endif
 | 
			
		||||
 | 
			
		||||
static int db8500_thermal_probe(struct platform_device *pdev)
 | 
			
		||||
{
 | 
			
		||||
	struct db8500_thermal_zone *pzone = NULL;
 | 
			
		||||
	struct db8500_thsens_platform_data *ptrips = NULL;
 | 
			
		||||
	struct device_node *np = pdev->dev.of_node;
 | 
			
		||||
	int low_irq, high_irq, ret = 0;
 | 
			
		||||
	unsigned long dft_low, dft_high;
 | 
			
		||||
 | 
			
		||||
	if (np)
 | 
			
		||||
		ptrips = db8500_thermal_parse_dt(pdev);
 | 
			
		||||
	else
 | 
			
		||||
		ptrips = dev_get_platdata(&pdev->dev);
 | 
			
		||||
 | 
			
		||||
	if (!ptrips)
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	pzone = devm_kzalloc(&pdev->dev, sizeof(*pzone), GFP_KERNEL);
 | 
			
		||||
	if (!pzone)
 | 
			
		||||
		return -ENOMEM;
 | 
			
		||||
 | 
			
		||||
	mutex_init(&pzone->th_lock);
 | 
			
		||||
	mutex_lock(&pzone->th_lock);
 | 
			
		||||
 | 
			
		||||
	pzone->mode = THERMAL_DEVICE_DISABLED;
 | 
			
		||||
	pzone->trip_tab = ptrips;
 | 
			
		||||
 | 
			
		||||
	INIT_WORK(&pzone->therm_work, db8500_thermal_work);
 | 
			
		||||
 | 
			
		||||
	low_irq = platform_get_irq_byname(pdev, "IRQ_HOTMON_LOW");
 | 
			
		||||
	if (low_irq < 0) {
 | 
			
		||||
		dev_err(&pdev->dev, "Get IRQ_HOTMON_LOW failed.\n");
 | 
			
		||||
		return low_irq;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	ret = devm_request_threaded_irq(&pdev->dev, low_irq, NULL,
 | 
			
		||||
		prcmu_low_irq_handler, IRQF_NO_SUSPEND | IRQF_ONESHOT,
 | 
			
		||||
		"dbx500_temp_low", pzone);
 | 
			
		||||
	if (ret < 0) {
 | 
			
		||||
		dev_err(&pdev->dev, "Failed to allocate temp low irq.\n");
 | 
			
		||||
		return ret;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	high_irq = platform_get_irq_byname(pdev, "IRQ_HOTMON_HIGH");
 | 
			
		||||
	if (high_irq < 0) {
 | 
			
		||||
		dev_err(&pdev->dev, "Get IRQ_HOTMON_HIGH failed.\n");
 | 
			
		||||
		return high_irq;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	ret = devm_request_threaded_irq(&pdev->dev, high_irq, NULL,
 | 
			
		||||
		prcmu_high_irq_handler, IRQF_NO_SUSPEND | IRQF_ONESHOT,
 | 
			
		||||
		"dbx500_temp_high", pzone);
 | 
			
		||||
	if (ret < 0) {
 | 
			
		||||
		dev_err(&pdev->dev, "Failed to allocate temp high irq.\n");
 | 
			
		||||
		return ret;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	pzone->therm_dev = thermal_zone_device_register("db8500_thermal_zone",
 | 
			
		||||
		ptrips->num_trips, 0, pzone, &thdev_ops, NULL, 0, 0);
 | 
			
		||||
 | 
			
		||||
	if (IS_ERR_OR_NULL(pzone->therm_dev)) {
 | 
			
		||||
		dev_err(&pdev->dev, "Register thermal zone device failed.\n");
 | 
			
		||||
		return PTR_ERR(pzone->therm_dev);
 | 
			
		||||
	}
 | 
			
		||||
	dev_info(&pdev->dev, "Thermal zone device registered.\n");
 | 
			
		||||
 | 
			
		||||
	dft_low = PRCMU_DEFAULT_LOW_TEMP;
 | 
			
		||||
	dft_high = ptrips->trip_points[0].temp;
 | 
			
		||||
 | 
			
		||||
	db8500_thermal_update_config(pzone, 0, THERMAL_TREND_STABLE,
 | 
			
		||||
		dft_low, dft_high);
 | 
			
		||||
 | 
			
		||||
	platform_set_drvdata(pdev, pzone);
 | 
			
		||||
	pzone->mode = THERMAL_DEVICE_ENABLED;
 | 
			
		||||
	mutex_unlock(&pzone->th_lock);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int db8500_thermal_remove(struct platform_device *pdev)
 | 
			
		||||
{
 | 
			
		||||
	struct db8500_thermal_zone *pzone = platform_get_drvdata(pdev);
 | 
			
		||||
 | 
			
		||||
	thermal_zone_device_unregister(pzone->therm_dev);
 | 
			
		||||
	cancel_work_sync(&pzone->therm_work);
 | 
			
		||||
	mutex_destroy(&pzone->th_lock);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int db8500_thermal_suspend(struct platform_device *pdev,
 | 
			
		||||
		pm_message_t state)
 | 
			
		||||
{
 | 
			
		||||
	struct db8500_thermal_zone *pzone = platform_get_drvdata(pdev);
 | 
			
		||||
 | 
			
		||||
	flush_work(&pzone->therm_work);
 | 
			
		||||
	prcmu_stop_temp_sense();
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int db8500_thermal_resume(struct platform_device *pdev)
 | 
			
		||||
{
 | 
			
		||||
	struct db8500_thermal_zone *pzone = platform_get_drvdata(pdev);
 | 
			
		||||
	struct db8500_thsens_platform_data *ptrips = pzone->trip_tab;
 | 
			
		||||
	unsigned long dft_low, dft_high;
 | 
			
		||||
 | 
			
		||||
	dft_low = PRCMU_DEFAULT_LOW_TEMP;
 | 
			
		||||
	dft_high = ptrips->trip_points[0].temp;
 | 
			
		||||
 | 
			
		||||
	db8500_thermal_update_config(pzone, 0, THERMAL_TREND_STABLE,
 | 
			
		||||
		dft_low, dft_high);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
#ifdef CONFIG_OF
 | 
			
		||||
static const struct of_device_id db8500_thermal_match[] = {
 | 
			
		||||
	{ .compatible = "stericsson,db8500-thermal" },
 | 
			
		||||
	{},
 | 
			
		||||
};
 | 
			
		||||
#else
 | 
			
		||||
#define db8500_thermal_match NULL
 | 
			
		||||
#endif
 | 
			
		||||
 | 
			
		||||
static struct platform_driver db8500_thermal_driver = {
 | 
			
		||||
	.driver = {
 | 
			
		||||
		.owner = THIS_MODULE,
 | 
			
		||||
		.name = "db8500-thermal",
 | 
			
		||||
		.of_match_table = db8500_thermal_match,
 | 
			
		||||
	},
 | 
			
		||||
	.probe = db8500_thermal_probe,
 | 
			
		||||
	.suspend = db8500_thermal_suspend,
 | 
			
		||||
	.resume = db8500_thermal_resume,
 | 
			
		||||
	.remove = db8500_thermal_remove,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
module_platform_driver(db8500_thermal_driver);
 | 
			
		||||
 | 
			
		||||
MODULE_AUTHOR("Hongbo Zhang <hongbo.zhang@stericsson.com>");
 | 
			
		||||
MODULE_DESCRIPTION("DB8500 thermal driver");
 | 
			
		||||
MODULE_LICENSE("GPL");
 | 
			
		||||
| 
						 | 
				
			
			@ -451,7 +451,7 @@ static int exynos_register_thermal(struct thermal_sensor_conf *sensor_conf)
 | 
			
		|||
	th_zone->cool_dev_size++;
 | 
			
		||||
 | 
			
		||||
	th_zone->therm_dev = thermal_zone_device_register(sensor_conf->name,
 | 
			
		||||
			EXYNOS_ZONE_COUNT, 0, NULL, &exynos_dev_ops, 0,
 | 
			
		||||
			EXYNOS_ZONE_COUNT, 0, NULL, &exynos_dev_ops, NULL, 0,
 | 
			
		||||
			IDLE_INTERVAL);
 | 
			
		||||
 | 
			
		||||
	if (IS_ERR(th_zone->therm_dev)) {
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
							
								
								
									
										133
									
								
								drivers/thermal/fair_share.c
									
										
									
									
									
										Normal file
									
								
							
							
						
						
									
										133
									
								
								drivers/thermal/fair_share.c
									
										
									
									
									
										Normal file
									
								
							| 
						 | 
				
			
			@ -0,0 +1,133 @@
 | 
			
		|||
/*
 | 
			
		||||
 *  fair_share.c - A simple weight based Thermal governor
 | 
			
		||||
 *
 | 
			
		||||
 *  Copyright (C) 2012 Intel Corp
 | 
			
		||||
 *  Copyright (C) 2012 Durgadoss R <durgadoss.r@intel.com>
 | 
			
		||||
 *
 | 
			
		||||
 *  ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 | 
			
		||||
 *
 | 
			
		||||
 *  This program is free software; you can redistribute it and/or modify
 | 
			
		||||
 *  it under the terms of the GNU General Public License as published by
 | 
			
		||||
 *  the Free Software Foundation; version 2 of the License.
 | 
			
		||||
 *
 | 
			
		||||
 *  This program is distributed in the hope that it will be useful, but
 | 
			
		||||
 *  WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
			
		||||
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 | 
			
		||||
 *  General Public License for more details.
 | 
			
		||||
 *
 | 
			
		||||
 *  You should have received a copy of the GNU General Public License along
 | 
			
		||||
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 | 
			
		||||
 *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
 | 
			
		||||
 *
 | 
			
		||||
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
 | 
			
		||||
 | 
			
		||||
#include <linux/module.h>
 | 
			
		||||
#include <linux/thermal.h>
 | 
			
		||||
 | 
			
		||||
#include "thermal_core.h"
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * get_trip_level: - obtains the current trip level for a zone
 | 
			
		||||
 * @tz:		thermal zone device
 | 
			
		||||
 */
 | 
			
		||||
static int get_trip_level(struct thermal_zone_device *tz)
 | 
			
		||||
{
 | 
			
		||||
	int count = 0;
 | 
			
		||||
	unsigned long trip_temp;
 | 
			
		||||
 | 
			
		||||
	if (tz->trips == 0 || !tz->ops->get_trip_temp)
 | 
			
		||||
		return 0;
 | 
			
		||||
 | 
			
		||||
	for (count = 0; count < tz->trips; count++) {
 | 
			
		||||
		tz->ops->get_trip_temp(tz, count, &trip_temp);
 | 
			
		||||
		if (tz->temperature < trip_temp)
 | 
			
		||||
			break;
 | 
			
		||||
	}
 | 
			
		||||
	return count;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static long get_target_state(struct thermal_zone_device *tz,
 | 
			
		||||
		struct thermal_cooling_device *cdev, int weight, int level)
 | 
			
		||||
{
 | 
			
		||||
	unsigned long max_state;
 | 
			
		||||
 | 
			
		||||
	cdev->ops->get_max_state(cdev, &max_state);
 | 
			
		||||
 | 
			
		||||
	return (long)(weight * level * max_state) / (100 * tz->trips);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * fair_share_throttle - throttles devices asscciated with the given zone
 | 
			
		||||
 * @tz - thermal_zone_device
 | 
			
		||||
 *
 | 
			
		||||
 * Throttling Logic: This uses three parameters to calculate the new
 | 
			
		||||
 * throttle state of the cooling devices associated with the given zone.
 | 
			
		||||
 *
 | 
			
		||||
 * Parameters used for Throttling:
 | 
			
		||||
 * P1. max_state: Maximum throttle state exposed by the cooling device.
 | 
			
		||||
 * P2. weight[i]/100:
 | 
			
		||||
 *	How 'effective' the 'i'th device is, in cooling the given zone.
 | 
			
		||||
 * P3. cur_trip_level/max_no_of_trips:
 | 
			
		||||
 *	This describes the extent to which the devices should be throttled.
 | 
			
		||||
 *	We do not want to throttle too much when we trip a lower temperature,
 | 
			
		||||
 *	whereas the throttling is at full swing if we trip critical levels.
 | 
			
		||||
 *	(Heavily assumes the trip points are in ascending order)
 | 
			
		||||
 * new_state of cooling device = P3 * P2 * P1
 | 
			
		||||
 */
 | 
			
		||||
static int fair_share_throttle(struct thermal_zone_device *tz, int trip)
 | 
			
		||||
{
 | 
			
		||||
	const struct thermal_zone_params *tzp;
 | 
			
		||||
	struct thermal_cooling_device *cdev;
 | 
			
		||||
	struct thermal_instance *instance;
 | 
			
		||||
	int i;
 | 
			
		||||
	int cur_trip_level = get_trip_level(tz);
 | 
			
		||||
 | 
			
		||||
	if (!tz->tzp || !tz->tzp->tbp)
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	tzp = tz->tzp;
 | 
			
		||||
 | 
			
		||||
	for (i = 0; i < tzp->num_tbps; i++) {
 | 
			
		||||
		if (!tzp->tbp[i].cdev)
 | 
			
		||||
			continue;
 | 
			
		||||
 | 
			
		||||
		cdev = tzp->tbp[i].cdev;
 | 
			
		||||
		instance = get_thermal_instance(tz, cdev, trip);
 | 
			
		||||
		if (!instance)
 | 
			
		||||
			continue;
 | 
			
		||||
 | 
			
		||||
		instance->target = get_target_state(tz, cdev,
 | 
			
		||||
					tzp->tbp[i].weight, cur_trip_level);
 | 
			
		||||
 | 
			
		||||
		instance->cdev->updated = false;
 | 
			
		||||
		thermal_cdev_update(cdev);
 | 
			
		||||
	}
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static struct thermal_governor thermal_gov_fair_share = {
 | 
			
		||||
	.name		= "fair_share",
 | 
			
		||||
	.throttle	= fair_share_throttle,
 | 
			
		||||
	.owner		= THIS_MODULE,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static int __init thermal_gov_fair_share_init(void)
 | 
			
		||||
{
 | 
			
		||||
	return thermal_register_governor(&thermal_gov_fair_share);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void __exit thermal_gov_fair_share_exit(void)
 | 
			
		||||
{
 | 
			
		||||
	thermal_unregister_governor(&thermal_gov_fair_share);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* This should load after thermal framework */
 | 
			
		||||
fs_initcall(thermal_gov_fair_share_init);
 | 
			
		||||
module_exit(thermal_gov_fair_share_exit);
 | 
			
		||||
 | 
			
		||||
MODULE_AUTHOR("Durgadoss R");
 | 
			
		||||
MODULE_DESCRIPTION("A simple weight based thermal throttling governor");
 | 
			
		||||
MODULE_LICENSE("GPL");
 | 
			
		||||
| 
						 | 
				
			
			@ -43,6 +43,9 @@ struct rcar_thermal_priv {
 | 
			
		|||
	u32 comp;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
#define MCELSIUS(temp)			((temp) * 1000)
 | 
			
		||||
#define rcar_zone_to_priv(zone)		(zone->devdata)
 | 
			
		||||
 | 
			
		||||
/*
 | 
			
		||||
 *		basic functions
 | 
			
		||||
 */
 | 
			
		||||
| 
						 | 
				
			
			@ -96,7 +99,7 @@ static void rcar_thermal_bset(struct rcar_thermal_priv *priv, u32 reg,
 | 
			
		|||
static int rcar_thermal_get_temp(struct thermal_zone_device *zone,
 | 
			
		||||
			   unsigned long *temp)
 | 
			
		||||
{
 | 
			
		||||
	struct rcar_thermal_priv *priv = zone->devdata;
 | 
			
		||||
	struct rcar_thermal_priv *priv = rcar_zone_to_priv(zone);
 | 
			
		||||
	int val, min, max, tmp;
 | 
			
		||||
 | 
			
		||||
	tmp = -200; /* default */
 | 
			
		||||
| 
						 | 
				
			
			@ -169,7 +172,7 @@ static int rcar_thermal_get_temp(struct thermal_zone_device *zone,
 | 
			
		|||
		}
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	*temp = tmp;
 | 
			
		||||
	*temp = MCELSIUS(tmp);
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -185,7 +188,6 @@ static int rcar_thermal_probe(struct platform_device *pdev)
 | 
			
		|||
	struct thermal_zone_device *zone;
 | 
			
		||||
	struct rcar_thermal_priv *priv;
 | 
			
		||||
	struct resource *res;
 | 
			
		||||
	int ret;
 | 
			
		||||
 | 
			
		||||
	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 | 
			
		||||
	if (!res) {
 | 
			
		||||
| 
						 | 
				
			
			@ -206,16 +208,14 @@ static int rcar_thermal_probe(struct platform_device *pdev)
 | 
			
		|||
					  res->start, resource_size(res));
 | 
			
		||||
	if (!priv->base) {
 | 
			
		||||
		dev_err(&pdev->dev, "Unable to ioremap thermal register\n");
 | 
			
		||||
		ret = -ENOMEM;
 | 
			
		||||
		goto error_free_priv;
 | 
			
		||||
		return -ENOMEM;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	zone = thermal_zone_device_register("rcar_thermal", 0, 0, priv,
 | 
			
		||||
					    &rcar_thermal_zone_ops, 0, 0);
 | 
			
		||||
				    &rcar_thermal_zone_ops, NULL, 0, 0);
 | 
			
		||||
	if (IS_ERR(zone)) {
 | 
			
		||||
		dev_err(&pdev->dev, "thermal zone device is NULL\n");
 | 
			
		||||
		ret = PTR_ERR(zone);
 | 
			
		||||
		goto error_iounmap;
 | 
			
		||||
		return PTR_ERR(zone);
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	platform_set_drvdata(pdev, zone);
 | 
			
		||||
| 
						 | 
				
			
			@ -223,26 +223,15 @@ static int rcar_thermal_probe(struct platform_device *pdev)
 | 
			
		|||
	dev_info(&pdev->dev, "proved\n");
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
 | 
			
		||||
error_iounmap:
 | 
			
		||||
	devm_iounmap(&pdev->dev, priv->base);
 | 
			
		||||
error_free_priv:
 | 
			
		||||
	devm_kfree(&pdev->dev, priv);
 | 
			
		||||
 | 
			
		||||
	return ret;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static int rcar_thermal_remove(struct platform_device *pdev)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_zone_device *zone = platform_get_drvdata(pdev);
 | 
			
		||||
	struct rcar_thermal_priv *priv = zone->devdata;
 | 
			
		||||
 | 
			
		||||
	thermal_zone_device_unregister(zone);
 | 
			
		||||
	platform_set_drvdata(pdev, NULL);
 | 
			
		||||
 | 
			
		||||
	devm_iounmap(&pdev->dev, priv->base);
 | 
			
		||||
	devm_kfree(&pdev->dev, priv);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
| 
						 | 
				
			
			@ -147,7 +147,7 @@ static int spear_thermal_probe(struct platform_device *pdev)
 | 
			
		|||
	writel_relaxed(stdev->flags, stdev->thermal_base);
 | 
			
		||||
 | 
			
		||||
	spear_thermal = thermal_zone_device_register("spear_thermal", 0, 0,
 | 
			
		||||
				stdev, &ops, 0, 0);
 | 
			
		||||
				stdev, &ops, NULL, 0, 0);
 | 
			
		||||
	if (IS_ERR(spear_thermal)) {
 | 
			
		||||
		dev_err(&pdev->dev, "thermal zone device is NULL\n");
 | 
			
		||||
		ret = PTR_ERR(spear_thermal);
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
							
								
								
									
										194
									
								
								drivers/thermal/step_wise.c
									
										
									
									
									
										Normal file
									
								
							
							
						
						
									
										194
									
								
								drivers/thermal/step_wise.c
									
										
									
									
									
										Normal file
									
								
							| 
						 | 
				
			
			@ -0,0 +1,194 @@
 | 
			
		|||
/*
 | 
			
		||||
 *  step_wise.c - A step-by-step Thermal throttling governor
 | 
			
		||||
 *
 | 
			
		||||
 *  Copyright (C) 2012 Intel Corp
 | 
			
		||||
 *  Copyright (C) 2012 Durgadoss R <durgadoss.r@intel.com>
 | 
			
		||||
 *
 | 
			
		||||
 *  ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 | 
			
		||||
 *
 | 
			
		||||
 *  This program is free software; you can redistribute it and/or modify
 | 
			
		||||
 *  it under the terms of the GNU General Public License as published by
 | 
			
		||||
 *  the Free Software Foundation; version 2 of the License.
 | 
			
		||||
 *
 | 
			
		||||
 *  This program is distributed in the hope that it will be useful, but
 | 
			
		||||
 *  WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
			
		||||
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 | 
			
		||||
 *  General Public License for more details.
 | 
			
		||||
 *
 | 
			
		||||
 *  You should have received a copy of the GNU General Public License along
 | 
			
		||||
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 | 
			
		||||
 *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
 | 
			
		||||
 *
 | 
			
		||||
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
 | 
			
		||||
 | 
			
		||||
#include <linux/module.h>
 | 
			
		||||
#include <linux/thermal.h>
 | 
			
		||||
 | 
			
		||||
#include "thermal_core.h"
 | 
			
		||||
 | 
			
		||||
/*
 | 
			
		||||
 * If the temperature is higher than a trip point,
 | 
			
		||||
 *    a. if the trend is THERMAL_TREND_RAISING, use higher cooling
 | 
			
		||||
 *       state for this trip point
 | 
			
		||||
 *    b. if the trend is THERMAL_TREND_DROPPING, use lower cooling
 | 
			
		||||
 *       state for this trip point
 | 
			
		||||
 */
 | 
			
		||||
static unsigned long get_target_state(struct thermal_instance *instance,
 | 
			
		||||
					enum thermal_trend trend)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_cooling_device *cdev = instance->cdev;
 | 
			
		||||
	unsigned long cur_state;
 | 
			
		||||
 | 
			
		||||
	cdev->ops->get_cur_state(cdev, &cur_state);
 | 
			
		||||
 | 
			
		||||
	if (trend == THERMAL_TREND_RAISING) {
 | 
			
		||||
		cur_state = cur_state < instance->upper ?
 | 
			
		||||
			    (cur_state + 1) : instance->upper;
 | 
			
		||||
	} else if (trend == THERMAL_TREND_DROPPING) {
 | 
			
		||||
		cur_state = cur_state > instance->lower ?
 | 
			
		||||
			    (cur_state - 1) : instance->lower;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return cur_state;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void update_passive_instance(struct thermal_zone_device *tz,
 | 
			
		||||
				enum thermal_trip_type type, int value)
 | 
			
		||||
{
 | 
			
		||||
	/*
 | 
			
		||||
	 * If value is +1, activate a passive instance.
 | 
			
		||||
	 * If value is -1, deactivate a passive instance.
 | 
			
		||||
	 */
 | 
			
		||||
	if (type == THERMAL_TRIP_PASSIVE || type == THERMAL_TRIPS_NONE)
 | 
			
		||||
		tz->passive += value;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void update_instance_for_throttle(struct thermal_zone_device *tz,
 | 
			
		||||
				int trip, enum thermal_trip_type trip_type,
 | 
			
		||||
				enum thermal_trend trend)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_instance *instance;
 | 
			
		||||
 | 
			
		||||
	list_for_each_entry(instance, &tz->thermal_instances, tz_node) {
 | 
			
		||||
		if (instance->trip != trip)
 | 
			
		||||
			continue;
 | 
			
		||||
 | 
			
		||||
		instance->target = get_target_state(instance, trend);
 | 
			
		||||
 | 
			
		||||
		/* Activate a passive thermal instance */
 | 
			
		||||
		if (instance->target == THERMAL_NO_TARGET)
 | 
			
		||||
			update_passive_instance(tz, trip_type, 1);
 | 
			
		||||
 | 
			
		||||
		instance->cdev->updated = false; /* cdev needs update */
 | 
			
		||||
	}
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void update_instance_for_dethrottle(struct thermal_zone_device *tz,
 | 
			
		||||
				int trip, enum thermal_trip_type trip_type)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_instance *instance;
 | 
			
		||||
	struct thermal_cooling_device *cdev;
 | 
			
		||||
	unsigned long cur_state;
 | 
			
		||||
 | 
			
		||||
	list_for_each_entry(instance, &tz->thermal_instances, tz_node) {
 | 
			
		||||
		if (instance->trip != trip ||
 | 
			
		||||
			instance->target == THERMAL_NO_TARGET)
 | 
			
		||||
			continue;
 | 
			
		||||
 | 
			
		||||
		cdev = instance->cdev;
 | 
			
		||||
		cdev->ops->get_cur_state(cdev, &cur_state);
 | 
			
		||||
 | 
			
		||||
		instance->target = cur_state > instance->lower ?
 | 
			
		||||
			    (cur_state - 1) : THERMAL_NO_TARGET;
 | 
			
		||||
 | 
			
		||||
		/* Deactivate a passive thermal instance */
 | 
			
		||||
		if (instance->target == THERMAL_NO_TARGET)
 | 
			
		||||
			update_passive_instance(tz, trip_type, -1);
 | 
			
		||||
 | 
			
		||||
		cdev->updated = false; /* cdev needs update */
 | 
			
		||||
	}
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void thermal_zone_trip_update(struct thermal_zone_device *tz, int trip)
 | 
			
		||||
{
 | 
			
		||||
	long trip_temp;
 | 
			
		||||
	enum thermal_trip_type trip_type;
 | 
			
		||||
	enum thermal_trend trend;
 | 
			
		||||
 | 
			
		||||
	if (trip == THERMAL_TRIPS_NONE) {
 | 
			
		||||
		trip_temp = tz->forced_passive;
 | 
			
		||||
		trip_type = THERMAL_TRIPS_NONE;
 | 
			
		||||
	} else {
 | 
			
		||||
		tz->ops->get_trip_temp(tz, trip, &trip_temp);
 | 
			
		||||
		tz->ops->get_trip_type(tz, trip, &trip_type);
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	trend = get_tz_trend(tz, trip);
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&tz->lock);
 | 
			
		||||
 | 
			
		||||
	if (tz->temperature >= trip_temp)
 | 
			
		||||
		update_instance_for_throttle(tz, trip, trip_type, trend);
 | 
			
		||||
	else
 | 
			
		||||
		update_instance_for_dethrottle(tz, trip, trip_type);
 | 
			
		||||
 | 
			
		||||
	mutex_unlock(&tz->lock);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * step_wise_throttle - throttles devices asscciated with the given zone
 | 
			
		||||
 * @tz - thermal_zone_device
 | 
			
		||||
 * @trip - the trip point
 | 
			
		||||
 * @trip_type - type of the trip point
 | 
			
		||||
 *
 | 
			
		||||
 * Throttling Logic: This uses the trend of the thermal zone to throttle.
 | 
			
		||||
 * If the thermal zone is 'heating up' this throttles all the cooling
 | 
			
		||||
 * devices associated with the zone and its particular trip point, by one
 | 
			
		||||
 * step. If the zone is 'cooling down' it brings back the performance of
 | 
			
		||||
 * the devices by one step.
 | 
			
		||||
 */
 | 
			
		||||
static int step_wise_throttle(struct thermal_zone_device *tz, int trip)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_instance *instance;
 | 
			
		||||
 | 
			
		||||
	thermal_zone_trip_update(tz, trip);
 | 
			
		||||
 | 
			
		||||
	if (tz->forced_passive)
 | 
			
		||||
		thermal_zone_trip_update(tz, THERMAL_TRIPS_NONE);
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&tz->lock);
 | 
			
		||||
 | 
			
		||||
	list_for_each_entry(instance, &tz->thermal_instances, tz_node)
 | 
			
		||||
		thermal_cdev_update(instance->cdev);
 | 
			
		||||
 | 
			
		||||
	mutex_unlock(&tz->lock);
 | 
			
		||||
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static struct thermal_governor thermal_gov_step_wise = {
 | 
			
		||||
	.name		= "step_wise",
 | 
			
		||||
	.throttle	= step_wise_throttle,
 | 
			
		||||
	.owner		= THIS_MODULE,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static int __init thermal_gov_step_wise_init(void)
 | 
			
		||||
{
 | 
			
		||||
	return thermal_register_governor(&thermal_gov_step_wise);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void __exit thermal_gov_step_wise_exit(void)
 | 
			
		||||
{
 | 
			
		||||
	thermal_unregister_governor(&thermal_gov_step_wise);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* This should load after thermal framework */
 | 
			
		||||
fs_initcall(thermal_gov_step_wise_init);
 | 
			
		||||
module_exit(thermal_gov_step_wise_exit);
 | 
			
		||||
 | 
			
		||||
MODULE_AUTHOR("Durgadoss R");
 | 
			
		||||
MODULE_DESCRIPTION("A step-by-step thermal throttling governor");
 | 
			
		||||
MODULE_LICENSE("GPL");
 | 
			
		||||
							
								
								
									
										53
									
								
								drivers/thermal/thermal_core.h
									
										
									
									
									
										Normal file
									
								
							
							
						
						
									
										53
									
								
								drivers/thermal/thermal_core.h
									
										
									
									
									
										Normal file
									
								
							| 
						 | 
				
			
			@ -0,0 +1,53 @@
 | 
			
		|||
/*
 | 
			
		||||
 *  thermal_core.h
 | 
			
		||||
 *
 | 
			
		||||
 *  Copyright (C) 2012  Intel Corp
 | 
			
		||||
 *  Author: Durgadoss R <durgadoss.r@intel.com>
 | 
			
		||||
 *
 | 
			
		||||
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 | 
			
		||||
 *  This program is free software; you can redistribute it and/or modify
 | 
			
		||||
 *  it under the terms of the GNU General Public License as published by
 | 
			
		||||
 *  the Free Software Foundation; version 2 of the License.
 | 
			
		||||
 *
 | 
			
		||||
 *  This program is distributed in the hope that it will be useful, but
 | 
			
		||||
 *  WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
			
		||||
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 | 
			
		||||
 *  General Public License for more details.
 | 
			
		||||
 *
 | 
			
		||||
 *  You should have received a copy of the GNU General Public License along
 | 
			
		||||
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 | 
			
		||||
 *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
 | 
			
		||||
 *
 | 
			
		||||
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
#ifndef __THERMAL_CORE_H__
 | 
			
		||||
#define __THERMAL_CORE_H__
 | 
			
		||||
 | 
			
		||||
#include <linux/device.h>
 | 
			
		||||
#include <linux/thermal.h>
 | 
			
		||||
 | 
			
		||||
/* Initial state of a cooling device during binding */
 | 
			
		||||
#define THERMAL_NO_TARGET -1UL
 | 
			
		||||
 | 
			
		||||
/*
 | 
			
		||||
 * This structure is used to describe the behavior of
 | 
			
		||||
 * a certain cooling device on a certain trip point
 | 
			
		||||
 * in a certain thermal zone
 | 
			
		||||
 */
 | 
			
		||||
struct thermal_instance {
 | 
			
		||||
	int id;
 | 
			
		||||
	char name[THERMAL_NAME_LENGTH];
 | 
			
		||||
	struct thermal_zone_device *tz;
 | 
			
		||||
	struct thermal_cooling_device *cdev;
 | 
			
		||||
	int trip;
 | 
			
		||||
	unsigned long upper;	/* Highest cooling state for this trip point */
 | 
			
		||||
	unsigned long lower;	/* Lowest cooling state for this trip point */
 | 
			
		||||
	unsigned long target;	/* expected cooling state */
 | 
			
		||||
	char attr_name[THERMAL_NAME_LENGTH];
 | 
			
		||||
	struct device_attribute attr;
 | 
			
		||||
	struct list_head tz_node; /* node in tz->thermal_instances */
 | 
			
		||||
	struct list_head cdev_node; /* node in cdev->thermal_instances */
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
#endif /* __THERMAL_CORE_H__ */
 | 
			
		||||
| 
						 | 
				
			
			@ -37,38 +37,98 @@
 | 
			
		|||
#include <net/netlink.h>
 | 
			
		||||
#include <net/genetlink.h>
 | 
			
		||||
 | 
			
		||||
#include "thermal_core.h"
 | 
			
		||||
 | 
			
		||||
MODULE_AUTHOR("Zhang Rui");
 | 
			
		||||
MODULE_DESCRIPTION("Generic thermal management sysfs support");
 | 
			
		||||
MODULE_LICENSE("GPL");
 | 
			
		||||
 | 
			
		||||
#define THERMAL_NO_TARGET -1UL
 | 
			
		||||
/*
 | 
			
		||||
 * This structure is used to describe the behavior of
 | 
			
		||||
 * a certain cooling device on a certain trip point
 | 
			
		||||
 * in a certain thermal zone
 | 
			
		||||
 */
 | 
			
		||||
struct thermal_instance {
 | 
			
		||||
	int id;
 | 
			
		||||
	char name[THERMAL_NAME_LENGTH];
 | 
			
		||||
	struct thermal_zone_device *tz;
 | 
			
		||||
	struct thermal_cooling_device *cdev;
 | 
			
		||||
	int trip;
 | 
			
		||||
	unsigned long upper;	/* Highest cooling state for this trip point */
 | 
			
		||||
	unsigned long lower;	/* Lowest cooling state for this trip point */
 | 
			
		||||
	unsigned long target;	/* expected cooling state */
 | 
			
		||||
	char attr_name[THERMAL_NAME_LENGTH];
 | 
			
		||||
	struct device_attribute attr;
 | 
			
		||||
	struct list_head tz_node; /* node in tz->thermal_instances */
 | 
			
		||||
	struct list_head cdev_node; /* node in cdev->thermal_instances */
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static DEFINE_IDR(thermal_tz_idr);
 | 
			
		||||
static DEFINE_IDR(thermal_cdev_idr);
 | 
			
		||||
static DEFINE_MUTEX(thermal_idr_lock);
 | 
			
		||||
 | 
			
		||||
static LIST_HEAD(thermal_tz_list);
 | 
			
		||||
static LIST_HEAD(thermal_cdev_list);
 | 
			
		||||
static LIST_HEAD(thermal_governor_list);
 | 
			
		||||
 | 
			
		||||
static DEFINE_MUTEX(thermal_list_lock);
 | 
			
		||||
static DEFINE_MUTEX(thermal_governor_lock);
 | 
			
		||||
 | 
			
		||||
static struct thermal_governor *__find_governor(const char *name)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_governor *pos;
 | 
			
		||||
 | 
			
		||||
	list_for_each_entry(pos, &thermal_governor_list, governor_list)
 | 
			
		||||
		if (!strnicmp(name, pos->name, THERMAL_NAME_LENGTH))
 | 
			
		||||
			return pos;
 | 
			
		||||
 | 
			
		||||
	return NULL;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
int thermal_register_governor(struct thermal_governor *governor)
 | 
			
		||||
{
 | 
			
		||||
	int err;
 | 
			
		||||
	const char *name;
 | 
			
		||||
	struct thermal_zone_device *pos;
 | 
			
		||||
 | 
			
		||||
	if (!governor)
 | 
			
		||||
		return -EINVAL;
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&thermal_governor_lock);
 | 
			
		||||
 | 
			
		||||
	err = -EBUSY;
 | 
			
		||||
	if (__find_governor(governor->name) == NULL) {
 | 
			
		||||
		err = 0;
 | 
			
		||||
		list_add(&governor->governor_list, &thermal_governor_list);
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&thermal_list_lock);
 | 
			
		||||
 | 
			
		||||
	list_for_each_entry(pos, &thermal_tz_list, node) {
 | 
			
		||||
		if (pos->governor)
 | 
			
		||||
			continue;
 | 
			
		||||
		if (pos->tzp)
 | 
			
		||||
			name = pos->tzp->governor_name;
 | 
			
		||||
		else
 | 
			
		||||
			name = DEFAULT_THERMAL_GOVERNOR;
 | 
			
		||||
		if (!strnicmp(name, governor->name, THERMAL_NAME_LENGTH))
 | 
			
		||||
			pos->governor = governor;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	mutex_unlock(&thermal_list_lock);
 | 
			
		||||
	mutex_unlock(&thermal_governor_lock);
 | 
			
		||||
 | 
			
		||||
	return err;
 | 
			
		||||
}
 | 
			
		||||
EXPORT_SYMBOL_GPL(thermal_register_governor);
 | 
			
		||||
 | 
			
		||||
void thermal_unregister_governor(struct thermal_governor *governor)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_zone_device *pos;
 | 
			
		||||
 | 
			
		||||
	if (!governor)
 | 
			
		||||
		return;
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&thermal_governor_lock);
 | 
			
		||||
 | 
			
		||||
	if (__find_governor(governor->name) == NULL)
 | 
			
		||||
		goto exit;
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&thermal_list_lock);
 | 
			
		||||
 | 
			
		||||
	list_for_each_entry(pos, &thermal_tz_list, node) {
 | 
			
		||||
		if (!strnicmp(pos->governor->name, governor->name,
 | 
			
		||||
						THERMAL_NAME_LENGTH))
 | 
			
		||||
			pos->governor = NULL;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	mutex_unlock(&thermal_list_lock);
 | 
			
		||||
	list_del(&governor->governor_list);
 | 
			
		||||
exit:
 | 
			
		||||
	mutex_unlock(&thermal_governor_lock);
 | 
			
		||||
	return;
 | 
			
		||||
}
 | 
			
		||||
EXPORT_SYMBOL_GPL(thermal_unregister_governor);
 | 
			
		||||
 | 
			
		||||
static int get_idr(struct idr *idr, struct mutex *lock, int *id)
 | 
			
		||||
{
 | 
			
		||||
| 
						 | 
				
			
			@ -101,6 +161,262 @@ static void release_idr(struct idr *idr, struct mutex *lock, int id)
 | 
			
		|||
		mutex_unlock(lock);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
int get_tz_trend(struct thermal_zone_device *tz, int trip)
 | 
			
		||||
{
 | 
			
		||||
	enum thermal_trend trend;
 | 
			
		||||
 | 
			
		||||
	if (!tz->ops->get_trend || tz->ops->get_trend(tz, trip, &trend)) {
 | 
			
		||||
		if (tz->temperature > tz->last_temperature)
 | 
			
		||||
			trend = THERMAL_TREND_RAISING;
 | 
			
		||||
		else if (tz->temperature < tz->last_temperature)
 | 
			
		||||
			trend = THERMAL_TREND_DROPPING;
 | 
			
		||||
		else
 | 
			
		||||
			trend = THERMAL_TREND_STABLE;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return trend;
 | 
			
		||||
}
 | 
			
		||||
EXPORT_SYMBOL(get_tz_trend);
 | 
			
		||||
 | 
			
		||||
struct thermal_instance *get_thermal_instance(struct thermal_zone_device *tz,
 | 
			
		||||
			struct thermal_cooling_device *cdev, int trip)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_instance *pos = NULL;
 | 
			
		||||
	struct thermal_instance *target_instance = NULL;
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&tz->lock);
 | 
			
		||||
	mutex_lock(&cdev->lock);
 | 
			
		||||
 | 
			
		||||
	list_for_each_entry(pos, &tz->thermal_instances, tz_node) {
 | 
			
		||||
		if (pos->tz == tz && pos->trip == trip && pos->cdev == cdev) {
 | 
			
		||||
			target_instance = pos;
 | 
			
		||||
			break;
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	mutex_unlock(&cdev->lock);
 | 
			
		||||
	mutex_unlock(&tz->lock);
 | 
			
		||||
 | 
			
		||||
	return target_instance;
 | 
			
		||||
}
 | 
			
		||||
EXPORT_SYMBOL(get_thermal_instance);
 | 
			
		||||
 | 
			
		||||
static void print_bind_err_msg(struct thermal_zone_device *tz,
 | 
			
		||||
			struct thermal_cooling_device *cdev, int ret)
 | 
			
		||||
{
 | 
			
		||||
	dev_err(&tz->device, "binding zone %s with cdev %s failed:%d\n",
 | 
			
		||||
				tz->type, cdev->type, ret);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void __bind(struct thermal_zone_device *tz, int mask,
 | 
			
		||||
			struct thermal_cooling_device *cdev)
 | 
			
		||||
{
 | 
			
		||||
	int i, ret;
 | 
			
		||||
 | 
			
		||||
	for (i = 0; i < tz->trips; i++) {
 | 
			
		||||
		if (mask & (1 << i)) {
 | 
			
		||||
			ret = thermal_zone_bind_cooling_device(tz, i, cdev,
 | 
			
		||||
					THERMAL_NO_LIMIT, THERMAL_NO_LIMIT);
 | 
			
		||||
			if (ret)
 | 
			
		||||
				print_bind_err_msg(tz, cdev, ret);
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void __unbind(struct thermal_zone_device *tz, int mask,
 | 
			
		||||
			struct thermal_cooling_device *cdev)
 | 
			
		||||
{
 | 
			
		||||
	int i;
 | 
			
		||||
 | 
			
		||||
	for (i = 0; i < tz->trips; i++)
 | 
			
		||||
		if (mask & (1 << i))
 | 
			
		||||
			thermal_zone_unbind_cooling_device(tz, i, cdev);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void bind_cdev(struct thermal_cooling_device *cdev)
 | 
			
		||||
{
 | 
			
		||||
	int i, ret;
 | 
			
		||||
	const struct thermal_zone_params *tzp;
 | 
			
		||||
	struct thermal_zone_device *pos = NULL;
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&thermal_list_lock);
 | 
			
		||||
 | 
			
		||||
	list_for_each_entry(pos, &thermal_tz_list, node) {
 | 
			
		||||
		if (!pos->tzp && !pos->ops->bind)
 | 
			
		||||
			continue;
 | 
			
		||||
 | 
			
		||||
		if (!pos->tzp && pos->ops->bind) {
 | 
			
		||||
			ret = pos->ops->bind(pos, cdev);
 | 
			
		||||
			if (ret)
 | 
			
		||||
				print_bind_err_msg(pos, cdev, ret);
 | 
			
		||||
		}
 | 
			
		||||
 | 
			
		||||
		tzp = pos->tzp;
 | 
			
		||||
		if (!tzp || !tzp->tbp)
 | 
			
		||||
			continue;
 | 
			
		||||
 | 
			
		||||
		for (i = 0; i < tzp->num_tbps; i++) {
 | 
			
		||||
			if (tzp->tbp[i].cdev || !tzp->tbp[i].match)
 | 
			
		||||
				continue;
 | 
			
		||||
			if (tzp->tbp[i].match(pos, cdev))
 | 
			
		||||
				continue;
 | 
			
		||||
			tzp->tbp[i].cdev = cdev;
 | 
			
		||||
			__bind(pos, tzp->tbp[i].trip_mask, cdev);
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	mutex_unlock(&thermal_list_lock);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void bind_tz(struct thermal_zone_device *tz)
 | 
			
		||||
{
 | 
			
		||||
	int i, ret;
 | 
			
		||||
	struct thermal_cooling_device *pos = NULL;
 | 
			
		||||
	const struct thermal_zone_params *tzp = tz->tzp;
 | 
			
		||||
 | 
			
		||||
	if (!tzp && !tz->ops->bind)
 | 
			
		||||
		return;
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&thermal_list_lock);
 | 
			
		||||
 | 
			
		||||
	/* If there is no platform data, try to use ops->bind */
 | 
			
		||||
	if (!tzp && tz->ops->bind) {
 | 
			
		||||
		list_for_each_entry(pos, &thermal_cdev_list, node) {
 | 
			
		||||
			ret = tz->ops->bind(tz, pos);
 | 
			
		||||
			if (ret)
 | 
			
		||||
				print_bind_err_msg(tz, pos, ret);
 | 
			
		||||
		}
 | 
			
		||||
		goto exit;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (!tzp || !tzp->tbp)
 | 
			
		||||
		goto exit;
 | 
			
		||||
 | 
			
		||||
	list_for_each_entry(pos, &thermal_cdev_list, node) {
 | 
			
		||||
		for (i = 0; i < tzp->num_tbps; i++) {
 | 
			
		||||
			if (tzp->tbp[i].cdev || !tzp->tbp[i].match)
 | 
			
		||||
				continue;
 | 
			
		||||
			if (tzp->tbp[i].match(tz, pos))
 | 
			
		||||
				continue;
 | 
			
		||||
			tzp->tbp[i].cdev = pos;
 | 
			
		||||
			__bind(tz, tzp->tbp[i].trip_mask, pos);
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
exit:
 | 
			
		||||
	mutex_unlock(&thermal_list_lock);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void thermal_zone_device_set_polling(struct thermal_zone_device *tz,
 | 
			
		||||
					    int delay)
 | 
			
		||||
{
 | 
			
		||||
	if (delay > 1000)
 | 
			
		||||
		mod_delayed_work(system_freezable_wq, &tz->poll_queue,
 | 
			
		||||
				 round_jiffies(msecs_to_jiffies(delay)));
 | 
			
		||||
	else if (delay)
 | 
			
		||||
		mod_delayed_work(system_freezable_wq, &tz->poll_queue,
 | 
			
		||||
				 msecs_to_jiffies(delay));
 | 
			
		||||
	else
 | 
			
		||||
		cancel_delayed_work(&tz->poll_queue);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void monitor_thermal_zone(struct thermal_zone_device *tz)
 | 
			
		||||
{
 | 
			
		||||
	mutex_lock(&tz->lock);
 | 
			
		||||
 | 
			
		||||
	if (tz->passive)
 | 
			
		||||
		thermal_zone_device_set_polling(tz, tz->passive_delay);
 | 
			
		||||
	else if (tz->polling_delay)
 | 
			
		||||
		thermal_zone_device_set_polling(tz, tz->polling_delay);
 | 
			
		||||
	else
 | 
			
		||||
		thermal_zone_device_set_polling(tz, 0);
 | 
			
		||||
 | 
			
		||||
	mutex_unlock(&tz->lock);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void handle_non_critical_trips(struct thermal_zone_device *tz,
 | 
			
		||||
			int trip, enum thermal_trip_type trip_type)
 | 
			
		||||
{
 | 
			
		||||
	if (tz->governor)
 | 
			
		||||
		tz->governor->throttle(tz, trip);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void handle_critical_trips(struct thermal_zone_device *tz,
 | 
			
		||||
				int trip, enum thermal_trip_type trip_type)
 | 
			
		||||
{
 | 
			
		||||
	long trip_temp;
 | 
			
		||||
 | 
			
		||||
	tz->ops->get_trip_temp(tz, trip, &trip_temp);
 | 
			
		||||
 | 
			
		||||
	/* If we have not crossed the trip_temp, we do not care. */
 | 
			
		||||
	if (tz->temperature < trip_temp)
 | 
			
		||||
		return;
 | 
			
		||||
 | 
			
		||||
	if (tz->ops->notify)
 | 
			
		||||
		tz->ops->notify(tz, trip, trip_type);
 | 
			
		||||
 | 
			
		||||
	if (trip_type == THERMAL_TRIP_CRITICAL) {
 | 
			
		||||
		pr_emerg("Critical temperature reached(%d C),shutting down\n",
 | 
			
		||||
			 tz->temperature / 1000);
 | 
			
		||||
		orderly_poweroff(true);
 | 
			
		||||
	}
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void handle_thermal_trip(struct thermal_zone_device *tz, int trip)
 | 
			
		||||
{
 | 
			
		||||
	enum thermal_trip_type type;
 | 
			
		||||
 | 
			
		||||
	tz->ops->get_trip_type(tz, trip, &type);
 | 
			
		||||
 | 
			
		||||
	if (type == THERMAL_TRIP_CRITICAL || type == THERMAL_TRIP_HOT)
 | 
			
		||||
		handle_critical_trips(tz, trip, type);
 | 
			
		||||
	else
 | 
			
		||||
		handle_non_critical_trips(tz, trip, type);
 | 
			
		||||
	/*
 | 
			
		||||
	 * Alright, we handled this trip successfully.
 | 
			
		||||
	 * So, start monitoring again.
 | 
			
		||||
	 */
 | 
			
		||||
	monitor_thermal_zone(tz);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void update_temperature(struct thermal_zone_device *tz)
 | 
			
		||||
{
 | 
			
		||||
	long temp;
 | 
			
		||||
	int ret;
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&tz->lock);
 | 
			
		||||
 | 
			
		||||
	ret = tz->ops->get_temp(tz, &temp);
 | 
			
		||||
	if (ret) {
 | 
			
		||||
		pr_warn("failed to read out thermal zone %d\n", tz->id);
 | 
			
		||||
		goto exit;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	tz->last_temperature = tz->temperature;
 | 
			
		||||
	tz->temperature = temp;
 | 
			
		||||
 | 
			
		||||
exit:
 | 
			
		||||
	mutex_unlock(&tz->lock);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
void thermal_zone_device_update(struct thermal_zone_device *tz)
 | 
			
		||||
{
 | 
			
		||||
	int count;
 | 
			
		||||
 | 
			
		||||
	update_temperature(tz);
 | 
			
		||||
 | 
			
		||||
	for (count = 0; count < tz->trips; count++)
 | 
			
		||||
		handle_thermal_trip(tz, count);
 | 
			
		||||
}
 | 
			
		||||
EXPORT_SYMBOL(thermal_zone_device_update);
 | 
			
		||||
 | 
			
		||||
static void thermal_zone_device_check(struct work_struct *work)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_zone_device *tz = container_of(work, struct
 | 
			
		||||
						      thermal_zone_device,
 | 
			
		||||
						      poll_queue.work);
 | 
			
		||||
	thermal_zone_device_update(tz);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* sys I/F for thermal zone */
 | 
			
		||||
 | 
			
		||||
#define to_thermal_zone(_dev) \
 | 
			
		||||
| 
						 | 
				
			
			@ -354,10 +670,41 @@ passive_show(struct device *dev, struct device_attribute *attr,
 | 
			
		|||
	return sprintf(buf, "%d\n", tz->forced_passive);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static ssize_t
 | 
			
		||||
policy_store(struct device *dev, struct device_attribute *attr,
 | 
			
		||||
		    const char *buf, size_t count)
 | 
			
		||||
{
 | 
			
		||||
	int ret = -EINVAL;
 | 
			
		||||
	struct thermal_zone_device *tz = to_thermal_zone(dev);
 | 
			
		||||
	struct thermal_governor *gov;
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&thermal_governor_lock);
 | 
			
		||||
 | 
			
		||||
	gov = __find_governor(buf);
 | 
			
		||||
	if (!gov)
 | 
			
		||||
		goto exit;
 | 
			
		||||
 | 
			
		||||
	tz->governor = gov;
 | 
			
		||||
	ret = count;
 | 
			
		||||
 | 
			
		||||
exit:
 | 
			
		||||
	mutex_unlock(&thermal_governor_lock);
 | 
			
		||||
	return ret;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static ssize_t
 | 
			
		||||
policy_show(struct device *dev, struct device_attribute *devattr, char *buf)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_zone_device *tz = to_thermal_zone(dev);
 | 
			
		||||
 | 
			
		||||
	return sprintf(buf, "%s\n", tz->governor->name);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static DEVICE_ATTR(type, 0444, type_show, NULL);
 | 
			
		||||
static DEVICE_ATTR(temp, 0444, temp_show, NULL);
 | 
			
		||||
static DEVICE_ATTR(mode, 0644, mode_show, mode_store);
 | 
			
		||||
static DEVICE_ATTR(passive, S_IRUGO | S_IWUSR, passive_show, passive_store);
 | 
			
		||||
static DEVICE_ATTR(policy, S_IRUGO | S_IWUSR, policy_show, policy_store);
 | 
			
		||||
 | 
			
		||||
/* sys I/F for cooling device */
 | 
			
		||||
#define to_cooling_device(_dev)	\
 | 
			
		||||
| 
						 | 
				
			
			@ -700,27 +1047,6 @@ thermal_remove_hwmon_sysfs(struct thermal_zone_device *tz)
 | 
			
		|||
}
 | 
			
		||||
#endif
 | 
			
		||||
 | 
			
		||||
static void thermal_zone_device_set_polling(struct thermal_zone_device *tz,
 | 
			
		||||
					    int delay)
 | 
			
		||||
{
 | 
			
		||||
	if (delay > 1000)
 | 
			
		||||
		mod_delayed_work(system_freezable_wq, &tz->poll_queue,
 | 
			
		||||
				 round_jiffies(msecs_to_jiffies(delay)));
 | 
			
		||||
	else if (delay)
 | 
			
		||||
		mod_delayed_work(system_freezable_wq, &tz->poll_queue,
 | 
			
		||||
				 msecs_to_jiffies(delay));
 | 
			
		||||
	else
 | 
			
		||||
		cancel_delayed_work(&tz->poll_queue);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void thermal_zone_device_check(struct work_struct *work)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_zone_device *tz = container_of(work, struct
 | 
			
		||||
						      thermal_zone_device,
 | 
			
		||||
						      poll_queue.work);
 | 
			
		||||
	thermal_zone_device_update(tz);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * thermal_zone_bind_cooling_device - bind a cooling device to a thermal zone
 | 
			
		||||
 * @tz:		thermal zone device
 | 
			
		||||
| 
						 | 
				
			
			@ -895,7 +1221,6 @@ thermal_cooling_device_register(char *type, void *devdata,
 | 
			
		|||
				const struct thermal_cooling_device_ops *ops)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_cooling_device *cdev;
 | 
			
		||||
	struct thermal_zone_device *pos;
 | 
			
		||||
	int result;
 | 
			
		||||
 | 
			
		||||
	if (type && strlen(type) >= THERMAL_NAME_LENGTH)
 | 
			
		||||
| 
						 | 
				
			
			@ -945,19 +1270,14 @@ thermal_cooling_device_register(char *type, void *devdata,
 | 
			
		|||
	if (result)
 | 
			
		||||
		goto unregister;
 | 
			
		||||
 | 
			
		||||
	/* Add 'this' new cdev to the global cdev list */
 | 
			
		||||
	mutex_lock(&thermal_list_lock);
 | 
			
		||||
	list_add(&cdev->node, &thermal_cdev_list);
 | 
			
		||||
	list_for_each_entry(pos, &thermal_tz_list, node) {
 | 
			
		||||
		if (!pos->ops->bind)
 | 
			
		||||
			continue;
 | 
			
		||||
		result = pos->ops->bind(pos, cdev);
 | 
			
		||||
		if (result)
 | 
			
		||||
			break;
 | 
			
		||||
 | 
			
		||||
	}
 | 
			
		||||
	mutex_unlock(&thermal_list_lock);
 | 
			
		||||
 | 
			
		||||
	if (!result)
 | 
			
		||||
	/* Update binding information for 'this' new cdev */
 | 
			
		||||
	bind_cdev(cdev);
 | 
			
		||||
 | 
			
		||||
	return cdev;
 | 
			
		||||
 | 
			
		||||
unregister:
 | 
			
		||||
| 
						 | 
				
			
			@ -974,10 +1294,10 @@ EXPORT_SYMBOL(thermal_cooling_device_register);
 | 
			
		|||
 * thermal_cooling_device_unregister() must be called when the device is no
 | 
			
		||||
 * longer needed.
 | 
			
		||||
 */
 | 
			
		||||
void thermal_cooling_device_unregister(struct
 | 
			
		||||
				       thermal_cooling_device
 | 
			
		||||
				       *cdev)
 | 
			
		||||
void thermal_cooling_device_unregister(struct thermal_cooling_device *cdev)
 | 
			
		||||
{
 | 
			
		||||
	int i;
 | 
			
		||||
	const struct thermal_zone_params *tzp;
 | 
			
		||||
	struct thermal_zone_device *tz;
 | 
			
		||||
	struct thermal_cooling_device *pos = NULL;
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -994,12 +1314,28 @@ void thermal_cooling_device_unregister(struct
 | 
			
		|||
		return;
 | 
			
		||||
	}
 | 
			
		||||
	list_del(&cdev->node);
 | 
			
		||||
 | 
			
		||||
	/* Unbind all thermal zones associated with 'this' cdev */
 | 
			
		||||
	list_for_each_entry(tz, &thermal_tz_list, node) {
 | 
			
		||||
		if (!tz->ops->unbind)
 | 
			
		||||
			continue;
 | 
			
		||||
		if (tz->ops->unbind) {
 | 
			
		||||
			tz->ops->unbind(tz, cdev);
 | 
			
		||||
			continue;
 | 
			
		||||
		}
 | 
			
		||||
 | 
			
		||||
		if (!tz->tzp || !tz->tzp->tbp)
 | 
			
		||||
			continue;
 | 
			
		||||
 | 
			
		||||
		tzp = tz->tzp;
 | 
			
		||||
		for (i = 0; i < tzp->num_tbps; i++) {
 | 
			
		||||
			if (tzp->tbp[i].cdev == cdev) {
 | 
			
		||||
				__unbind(tz, tzp->tbp[i].trip_mask, cdev);
 | 
			
		||||
				tzp->tbp[i].cdev = NULL;
 | 
			
		||||
			}
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	mutex_unlock(&thermal_list_lock);
 | 
			
		||||
 | 
			
		||||
	if (cdev->type[0])
 | 
			
		||||
		device_remove_file(&cdev->device, &dev_attr_cdev_type);
 | 
			
		||||
	device_remove_file(&cdev->device, &dev_attr_max_state);
 | 
			
		||||
| 
						 | 
				
			
			@ -1011,7 +1347,7 @@ void thermal_cooling_device_unregister(struct
 | 
			
		|||
}
 | 
			
		||||
EXPORT_SYMBOL(thermal_cooling_device_unregister);
 | 
			
		||||
 | 
			
		||||
static void thermal_cdev_do_update(struct thermal_cooling_device *cdev)
 | 
			
		||||
void thermal_cdev_update(struct thermal_cooling_device *cdev)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_instance *instance;
 | 
			
		||||
	unsigned long target = 0;
 | 
			
		||||
| 
						 | 
				
			
			@ -1032,183 +1368,25 @@ static void thermal_cdev_do_update(struct thermal_cooling_device *cdev)
 | 
			
		|||
	cdev->ops->set_cur_state(cdev, target);
 | 
			
		||||
	cdev->updated = true;
 | 
			
		||||
}
 | 
			
		||||
EXPORT_SYMBOL(thermal_cdev_update);
 | 
			
		||||
 | 
			
		||||
static void thermal_zone_do_update(struct thermal_zone_device *tz)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_instance *instance;
 | 
			
		||||
 | 
			
		||||
	list_for_each_entry(instance, &tz->thermal_instances, tz_node)
 | 
			
		||||
		thermal_cdev_do_update(instance->cdev);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/*
 | 
			
		||||
 * Cooling algorithm for both active and passive cooling
 | 
			
		||||
 *
 | 
			
		||||
 * 1. if the temperature is higher than a trip point,
 | 
			
		||||
 *    a. if the trend is THERMAL_TREND_RAISING, use higher cooling
 | 
			
		||||
 *       state for this trip point
 | 
			
		||||
 *    b. if the trend is THERMAL_TREND_DROPPING, use lower cooling
 | 
			
		||||
 *       state for this trip point
 | 
			
		||||
 *
 | 
			
		||||
 * 2. if the temperature is lower than a trip point, use lower
 | 
			
		||||
 *    cooling state for this trip point
 | 
			
		||||
 *
 | 
			
		||||
 * Note that this behaves the same as the previous passive cooling
 | 
			
		||||
 * algorithm.
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
static void thermal_zone_trip_update(struct thermal_zone_device *tz,
 | 
			
		||||
				     int trip, long temp)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_instance *instance;
 | 
			
		||||
	struct thermal_cooling_device *cdev = NULL;
 | 
			
		||||
	unsigned long cur_state, max_state;
 | 
			
		||||
	long trip_temp;
 | 
			
		||||
	enum thermal_trip_type trip_type;
 | 
			
		||||
	enum thermal_trend trend;
 | 
			
		||||
 | 
			
		||||
	if (trip == THERMAL_TRIPS_NONE) {
 | 
			
		||||
		trip_temp = tz->forced_passive;
 | 
			
		||||
		trip_type = THERMAL_TRIPS_NONE;
 | 
			
		||||
	} else {
 | 
			
		||||
		tz->ops->get_trip_temp(tz, trip, &trip_temp);
 | 
			
		||||
		tz->ops->get_trip_type(tz, trip, &trip_type);
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (!tz->ops->get_trend || tz->ops->get_trend(tz, trip, &trend)) {
 | 
			
		||||
		/*
 | 
			
		||||
		 * compare the current temperature and previous temperature
 | 
			
		||||
		 * to get the thermal trend, if no special requirement
 | 
			
		||||
		 */
 | 
			
		||||
		if (tz->temperature > tz->last_temperature)
 | 
			
		||||
			trend = THERMAL_TREND_RAISING;
 | 
			
		||||
		else if (tz->temperature < tz->last_temperature)
 | 
			
		||||
			trend = THERMAL_TREND_DROPPING;
 | 
			
		||||
		else
 | 
			
		||||
			trend = THERMAL_TREND_STABLE;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (temp >= trip_temp) {
 | 
			
		||||
		list_for_each_entry(instance, &tz->thermal_instances, tz_node) {
 | 
			
		||||
			if (instance->trip != trip)
 | 
			
		||||
				continue;
 | 
			
		||||
 | 
			
		||||
			cdev = instance->cdev;
 | 
			
		||||
 | 
			
		||||
			cdev->ops->get_cur_state(cdev, &cur_state);
 | 
			
		||||
			cdev->ops->get_max_state(cdev, &max_state);
 | 
			
		||||
 | 
			
		||||
			if (trend == THERMAL_TREND_RAISING) {
 | 
			
		||||
				cur_state = cur_state < instance->upper ?
 | 
			
		||||
					    (cur_state + 1) : instance->upper;
 | 
			
		||||
			} else if (trend == THERMAL_TREND_DROPPING) {
 | 
			
		||||
				cur_state = cur_state > instance->lower ?
 | 
			
		||||
				    (cur_state - 1) : instance->lower;
 | 
			
		||||
			}
 | 
			
		||||
 | 
			
		||||
			/* activate a passive thermal instance */
 | 
			
		||||
			if ((trip_type == THERMAL_TRIP_PASSIVE ||
 | 
			
		||||
			     trip_type == THERMAL_TRIPS_NONE) &&
 | 
			
		||||
			     instance->target == THERMAL_NO_TARGET)
 | 
			
		||||
				tz->passive++;
 | 
			
		||||
 | 
			
		||||
			instance->target = cur_state;
 | 
			
		||||
			cdev->updated = false; /* cooling device needs update */
 | 
			
		||||
		}
 | 
			
		||||
	} else {	/* below trip */
 | 
			
		||||
		list_for_each_entry(instance, &tz->thermal_instances, tz_node) {
 | 
			
		||||
			if (instance->trip != trip)
 | 
			
		||||
				continue;
 | 
			
		||||
 | 
			
		||||
			/* Do not use the inactive thermal instance */
 | 
			
		||||
			if (instance->target == THERMAL_NO_TARGET)
 | 
			
		||||
				continue;
 | 
			
		||||
			cdev = instance->cdev;
 | 
			
		||||
			cdev->ops->get_cur_state(cdev, &cur_state);
 | 
			
		||||
 | 
			
		||||
			cur_state = cur_state > instance->lower ?
 | 
			
		||||
				    (cur_state - 1) : THERMAL_NO_TARGET;
 | 
			
		||||
 | 
			
		||||
			/* deactivate a passive thermal instance */
 | 
			
		||||
			if ((trip_type == THERMAL_TRIP_PASSIVE ||
 | 
			
		||||
			     trip_type == THERMAL_TRIPS_NONE) &&
 | 
			
		||||
			     cur_state == THERMAL_NO_TARGET)
 | 
			
		||||
				tz->passive--;
 | 
			
		||||
			instance->target = cur_state;
 | 
			
		||||
			cdev->updated = false; /* cooling device needs update */
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	return;
 | 
			
		||||
}
 | 
			
		||||
/**
 | 
			
		||||
 * thermal_zone_device_update - force an update of a thermal zone's state
 | 
			
		||||
 * @ttz:	the thermal zone to update
 | 
			
		||||
 * notify_thermal_framework - Sensor drivers use this API to notify framework
 | 
			
		||||
 * @tz:		thermal zone device
 | 
			
		||||
 * @trip:	indicates which trip point has been crossed
 | 
			
		||||
 *
 | 
			
		||||
 * This function handles the trip events from sensor drivers. It starts
 | 
			
		||||
 * throttling the cooling devices according to the policy configured.
 | 
			
		||||
 * For CRITICAL and HOT trip points, this notifies the respective drivers,
 | 
			
		||||
 * and does actual throttling for other trip points i.e ACTIVE and PASSIVE.
 | 
			
		||||
 * The throttling policy is based on the configured platform data; if no
 | 
			
		||||
 * platform data is provided, this uses the step_wise throttling policy.
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
void thermal_zone_device_update(struct thermal_zone_device *tz)
 | 
			
		||||
void notify_thermal_framework(struct thermal_zone_device *tz, int trip)
 | 
			
		||||
{
 | 
			
		||||
	int count, ret = 0;
 | 
			
		||||
	long temp, trip_temp;
 | 
			
		||||
	enum thermal_trip_type trip_type;
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&tz->lock);
 | 
			
		||||
 | 
			
		||||
	if (tz->ops->get_temp(tz, &temp)) {
 | 
			
		||||
		/* get_temp failed - retry it later */
 | 
			
		||||
		pr_warn("failed to read out thermal zone %d\n", tz->id);
 | 
			
		||||
		goto leave;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	tz->last_temperature = tz->temperature;
 | 
			
		||||
	tz->temperature = temp;
 | 
			
		||||
 | 
			
		||||
	for (count = 0; count < tz->trips; count++) {
 | 
			
		||||
		tz->ops->get_trip_type(tz, count, &trip_type);
 | 
			
		||||
		tz->ops->get_trip_temp(tz, count, &trip_temp);
 | 
			
		||||
 | 
			
		||||
		switch (trip_type) {
 | 
			
		||||
		case THERMAL_TRIP_CRITICAL:
 | 
			
		||||
			if (temp >= trip_temp) {
 | 
			
		||||
				if (tz->ops->notify)
 | 
			
		||||
					ret = tz->ops->notify(tz, count,
 | 
			
		||||
							      trip_type);
 | 
			
		||||
				if (!ret) {
 | 
			
		||||
					pr_emerg("Critical temperature reached (%ld C), shutting down\n",
 | 
			
		||||
						 temp/1000);
 | 
			
		||||
					orderly_poweroff(true);
 | 
			
		||||
				}
 | 
			
		||||
			}
 | 
			
		||||
			break;
 | 
			
		||||
		case THERMAL_TRIP_HOT:
 | 
			
		||||
			if (temp >= trip_temp)
 | 
			
		||||
				if (tz->ops->notify)
 | 
			
		||||
					tz->ops->notify(tz, count, trip_type);
 | 
			
		||||
			break;
 | 
			
		||||
		case THERMAL_TRIP_ACTIVE:
 | 
			
		||||
			thermal_zone_trip_update(tz, count, temp);
 | 
			
		||||
			break;
 | 
			
		||||
		case THERMAL_TRIP_PASSIVE:
 | 
			
		||||
			if (temp >= trip_temp || tz->passive)
 | 
			
		||||
				thermal_zone_trip_update(tz, count, temp);
 | 
			
		||||
			break;
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (tz->forced_passive)
 | 
			
		||||
		thermal_zone_trip_update(tz, THERMAL_TRIPS_NONE, temp);
 | 
			
		||||
	thermal_zone_do_update(tz);
 | 
			
		||||
 | 
			
		||||
leave:
 | 
			
		||||
	if (tz->passive)
 | 
			
		||||
		thermal_zone_device_set_polling(tz, tz->passive_delay);
 | 
			
		||||
	else if (tz->polling_delay)
 | 
			
		||||
		thermal_zone_device_set_polling(tz, tz->polling_delay);
 | 
			
		||||
	else
 | 
			
		||||
		thermal_zone_device_set_polling(tz, 0);
 | 
			
		||||
	mutex_unlock(&tz->lock);
 | 
			
		||||
	handle_thermal_trip(tz, trip);
 | 
			
		||||
}
 | 
			
		||||
EXPORT_SYMBOL(thermal_zone_device_update);
 | 
			
		||||
EXPORT_SYMBOL(notify_thermal_framework);
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * create_trip_attrs - create attributes for trip points
 | 
			
		||||
| 
						 | 
				
			
			@ -1320,6 +1498,7 @@ static void remove_trip_attrs(struct thermal_zone_device *tz)
 | 
			
		|||
 * @mask:	a bit string indicating the writeablility of trip points
 | 
			
		||||
 * @devdata:	private device data
 | 
			
		||||
 * @ops:	standard thermal zone device callbacks
 | 
			
		||||
 * @tzp:	thermal zone platform parameters
 | 
			
		||||
 * @passive_delay: number of milliseconds to wait between polls when
 | 
			
		||||
 *		   performing passive cooling
 | 
			
		||||
 * @polling_delay: number of milliseconds to wait between polls when checking
 | 
			
		||||
| 
						 | 
				
			
			@ -1332,10 +1511,10 @@ static void remove_trip_attrs(struct thermal_zone_device *tz)
 | 
			
		|||
struct thermal_zone_device *thermal_zone_device_register(const char *type,
 | 
			
		||||
	int trips, int mask, void *devdata,
 | 
			
		||||
	const struct thermal_zone_device_ops *ops,
 | 
			
		||||
	const struct thermal_zone_params *tzp,
 | 
			
		||||
	int passive_delay, int polling_delay)
 | 
			
		||||
{
 | 
			
		||||
	struct thermal_zone_device *tz;
 | 
			
		||||
	struct thermal_cooling_device *pos;
 | 
			
		||||
	enum thermal_trip_type trip_type;
 | 
			
		||||
	int result;
 | 
			
		||||
	int count;
 | 
			
		||||
| 
						 | 
				
			
			@ -1365,6 +1544,7 @@ struct thermal_zone_device *thermal_zone_device_register(const char *type,
 | 
			
		|||
 | 
			
		||||
	strcpy(tz->type, type ? : "");
 | 
			
		||||
	tz->ops = ops;
 | 
			
		||||
	tz->tzp = tzp;
 | 
			
		||||
	tz->device.class = &thermal_class;
 | 
			
		||||
	tz->devdata = devdata;
 | 
			
		||||
	tz->trips = trips;
 | 
			
		||||
| 
						 | 
				
			
			@ -1406,12 +1586,26 @@ struct thermal_zone_device *thermal_zone_device_register(const char *type,
 | 
			
		|||
			passive = 1;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	if (!passive)
 | 
			
		||||
		result = device_create_file(&tz->device,
 | 
			
		||||
					    &dev_attr_passive);
 | 
			
		||||
 | 
			
		||||
	if (!passive) {
 | 
			
		||||
		result = device_create_file(&tz->device, &dev_attr_passive);
 | 
			
		||||
		if (result)
 | 
			
		||||
			goto unregister;
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	/* Create policy attribute */
 | 
			
		||||
	result = device_create_file(&tz->device, &dev_attr_policy);
 | 
			
		||||
	if (result)
 | 
			
		||||
		goto unregister;
 | 
			
		||||
 | 
			
		||||
	/* Update 'this' zone's governor information */
 | 
			
		||||
	mutex_lock(&thermal_governor_lock);
 | 
			
		||||
 | 
			
		||||
	if (tz->tzp)
 | 
			
		||||
		tz->governor = __find_governor(tz->tzp->governor_name);
 | 
			
		||||
	else
 | 
			
		||||
		tz->governor = __find_governor(DEFAULT_THERMAL_GOVERNOR);
 | 
			
		||||
 | 
			
		||||
	mutex_unlock(&thermal_governor_lock);
 | 
			
		||||
 | 
			
		||||
	result = thermal_add_hwmon_sysfs(tz);
 | 
			
		||||
	if (result)
 | 
			
		||||
| 
						 | 
				
			
			@ -1419,14 +1613,11 @@ struct thermal_zone_device *thermal_zone_device_register(const char *type,
 | 
			
		|||
 | 
			
		||||
	mutex_lock(&thermal_list_lock);
 | 
			
		||||
	list_add_tail(&tz->node, &thermal_tz_list);
 | 
			
		||||
	if (ops->bind)
 | 
			
		||||
		list_for_each_entry(pos, &thermal_cdev_list, node) {
 | 
			
		||||
		result = ops->bind(tz, pos);
 | 
			
		||||
		if (result)
 | 
			
		||||
			break;
 | 
			
		||||
		}
 | 
			
		||||
	mutex_unlock(&thermal_list_lock);
 | 
			
		||||
 | 
			
		||||
	/* Bind cooling devices for this zone */
 | 
			
		||||
	bind_tz(tz);
 | 
			
		||||
 | 
			
		||||
	INIT_DELAYED_WORK(&(tz->poll_queue), thermal_zone_device_check);
 | 
			
		||||
 | 
			
		||||
	thermal_zone_device_update(tz);
 | 
			
		||||
| 
						 | 
				
			
			@ -1447,12 +1638,16 @@ EXPORT_SYMBOL(thermal_zone_device_register);
 | 
			
		|||
 */
 | 
			
		||||
void thermal_zone_device_unregister(struct thermal_zone_device *tz)
 | 
			
		||||
{
 | 
			
		||||
	int i;
 | 
			
		||||
	const struct thermal_zone_params *tzp;
 | 
			
		||||
	struct thermal_cooling_device *cdev;
 | 
			
		||||
	struct thermal_zone_device *pos = NULL;
 | 
			
		||||
 | 
			
		||||
	if (!tz)
 | 
			
		||||
		return;
 | 
			
		||||
 | 
			
		||||
	tzp = tz->tzp;
 | 
			
		||||
 | 
			
		||||
	mutex_lock(&thermal_list_lock);
 | 
			
		||||
	list_for_each_entry(pos, &thermal_tz_list, node)
 | 
			
		||||
	    if (pos == tz)
 | 
			
		||||
| 
						 | 
				
			
			@ -1463,9 +1658,25 @@ void thermal_zone_device_unregister(struct thermal_zone_device *tz)
 | 
			
		|||
		return;
 | 
			
		||||
	}
 | 
			
		||||
	list_del(&tz->node);
 | 
			
		||||
	if (tz->ops->unbind)
 | 
			
		||||
		list_for_each_entry(cdev, &thermal_cdev_list, node)
 | 
			
		||||
 | 
			
		||||
	/* Unbind all cdevs associated with 'this' thermal zone */
 | 
			
		||||
	list_for_each_entry(cdev, &thermal_cdev_list, node) {
 | 
			
		||||
		if (tz->ops->unbind) {
 | 
			
		||||
			tz->ops->unbind(tz, cdev);
 | 
			
		||||
			continue;
 | 
			
		||||
		}
 | 
			
		||||
 | 
			
		||||
		if (!tzp || !tzp->tbp)
 | 
			
		||||
			break;
 | 
			
		||||
 | 
			
		||||
		for (i = 0; i < tzp->num_tbps; i++) {
 | 
			
		||||
			if (tzp->tbp[i].cdev == cdev) {
 | 
			
		||||
				__unbind(tz, tzp->tbp[i].trip_mask, cdev);
 | 
			
		||||
				tzp->tbp[i].cdev = NULL;
 | 
			
		||||
			}
 | 
			
		||||
		}
 | 
			
		||||
	}
 | 
			
		||||
 | 
			
		||||
	mutex_unlock(&thermal_list_lock);
 | 
			
		||||
 | 
			
		||||
	thermal_zone_device_set_polling(tz, 0);
 | 
			
		||||
| 
						 | 
				
			
			@ -1475,7 +1686,9 @@ void thermal_zone_device_unregister(struct thermal_zone_device *tz)
 | 
			
		|||
	device_remove_file(&tz->device, &dev_attr_temp);
 | 
			
		||||
	if (tz->ops->get_mode)
 | 
			
		||||
		device_remove_file(&tz->device, &dev_attr_mode);
 | 
			
		||||
	device_remove_file(&tz->device, &dev_attr_policy);
 | 
			
		||||
	remove_trip_attrs(tz);
 | 
			
		||||
	tz->governor = NULL;
 | 
			
		||||
 | 
			
		||||
	thermal_remove_hwmon_sysfs(tz);
 | 
			
		||||
	release_idr(&thermal_tz_idr, &thermal_idr_lock, tz->id);
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
							
								
								
									
										68
									
								
								drivers/thermal/user_space.c
									
										
									
									
									
										Normal file
									
								
							
							
						
						
									
										68
									
								
								drivers/thermal/user_space.c
									
										
									
									
									
										Normal file
									
								
							| 
						 | 
				
			
			@ -0,0 +1,68 @@
 | 
			
		|||
/*
 | 
			
		||||
 *  user_space.c - A simple user space Thermal events notifier
 | 
			
		||||
 *
 | 
			
		||||
 *  Copyright (C) 2012 Intel Corp
 | 
			
		||||
 *  Copyright (C) 2012 Durgadoss R <durgadoss.r@intel.com>
 | 
			
		||||
 *
 | 
			
		||||
 *  ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 | 
			
		||||
 *
 | 
			
		||||
 *  This program is free software; you can redistribute it and/or modify
 | 
			
		||||
 *  it under the terms of the GNU General Public License as published by
 | 
			
		||||
 *  the Free Software Foundation; version 2 of the License.
 | 
			
		||||
 *
 | 
			
		||||
 *  This program is distributed in the hope that it will be useful, but
 | 
			
		||||
 *  WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
			
		||||
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 | 
			
		||||
 *  General Public License for more details.
 | 
			
		||||
 *
 | 
			
		||||
 *  You should have received a copy of the GNU General Public License along
 | 
			
		||||
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 | 
			
		||||
 *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
 | 
			
		||||
 *
 | 
			
		||||
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
 | 
			
		||||
 | 
			
		||||
#include <linux/module.h>
 | 
			
		||||
#include <linux/thermal.h>
 | 
			
		||||
 | 
			
		||||
#include "thermal_core.h"
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * notify_user_space - Notifies user space about thermal events
 | 
			
		||||
 * @tz - thermal_zone_device
 | 
			
		||||
 *
 | 
			
		||||
 * This function notifies the user space through UEvents.
 | 
			
		||||
 */
 | 
			
		||||
static int notify_user_space(struct thermal_zone_device *tz, int trip)
 | 
			
		||||
{
 | 
			
		||||
	mutex_lock(&tz->lock);
 | 
			
		||||
	kobject_uevent(&tz->device.kobj, KOBJ_CHANGE);
 | 
			
		||||
	mutex_unlock(&tz->lock);
 | 
			
		||||
	return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static struct thermal_governor thermal_gov_user_space = {
 | 
			
		||||
	.name		= "user_space",
 | 
			
		||||
	.throttle	= notify_user_space,
 | 
			
		||||
	.owner		= THIS_MODULE,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static int __init thermal_gov_user_space_init(void)
 | 
			
		||||
{
 | 
			
		||||
	return thermal_register_governor(&thermal_gov_user_space);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void __exit thermal_gov_user_space_exit(void)
 | 
			
		||||
{
 | 
			
		||||
	thermal_unregister_governor(&thermal_gov_user_space);
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
/* This should load after thermal framework */
 | 
			
		||||
fs_initcall(thermal_gov_user_space_init);
 | 
			
		||||
module_exit(thermal_gov_user_space_exit);
 | 
			
		||||
 | 
			
		||||
MODULE_AUTHOR("Durgadoss R");
 | 
			
		||||
MODULE_DESCRIPTION("A user space Thermal notifier");
 | 
			
		||||
MODULE_LICENSE("GPL");
 | 
			
		||||
| 
						 | 
				
			
			@ -29,13 +29,13 @@
 | 
			
		|||
#define CPUFREQ_COOLING_START		0
 | 
			
		||||
#define CPUFREQ_COOLING_STOP		1
 | 
			
		||||
 | 
			
		||||
#ifdef CONFIG_CPU_THERMAL
 | 
			
		||||
#if defined(CONFIG_CPU_THERMAL) || defined(CONFIG_CPU_THERMAL_MODULE)
 | 
			
		||||
/**
 | 
			
		||||
 * cpufreq_cooling_register - function to create cpufreq cooling device.
 | 
			
		||||
 * @clip_cpus: cpumask of cpus where the frequency constraints will happen
 | 
			
		||||
 */
 | 
			
		||||
struct thermal_cooling_device *cpufreq_cooling_register(
 | 
			
		||||
		struct cpumask *clip_cpus);
 | 
			
		||||
		const struct cpumask *clip_cpus);
 | 
			
		||||
 | 
			
		||||
/**
 | 
			
		||||
 * cpufreq_cooling_unregister - function to remove cpufreq cooling device.
 | 
			
		||||
| 
						 | 
				
			
			@ -44,7 +44,7 @@ struct thermal_cooling_device *cpufreq_cooling_register(
 | 
			
		|||
void cpufreq_cooling_unregister(struct thermal_cooling_device *cdev);
 | 
			
		||||
#else /* !CONFIG_CPU_THERMAL */
 | 
			
		||||
static inline struct thermal_cooling_device *cpufreq_cooling_register(
 | 
			
		||||
	struct cpumask *clip_cpus)
 | 
			
		||||
	const struct cpumask *clip_cpus)
 | 
			
		||||
{
 | 
			
		||||
	return NULL;
 | 
			
		||||
}
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
							
								
								
									
										38
									
								
								include/linux/platform_data/db8500_thermal.h
									
										
									
									
									
										Normal file
									
								
							
							
						
						
									
										38
									
								
								include/linux/platform_data/db8500_thermal.h
									
										
									
									
									
										Normal file
									
								
							| 
						 | 
				
			
			@ -0,0 +1,38 @@
 | 
			
		|||
/*
 | 
			
		||||
 * db8500_thermal.h - DB8500 Thermal Management Implementation
 | 
			
		||||
 *
 | 
			
		||||
 * Copyright (C) 2012 ST-Ericsson
 | 
			
		||||
 * Copyright (C) 2012 Linaro Ltd.
 | 
			
		||||
 *
 | 
			
		||||
 * Author: Hongbo Zhang <hongbo.zhang@linaro.com>
 | 
			
		||||
 *
 | 
			
		||||
 * This program is free software; you can redistribute it and/or modify
 | 
			
		||||
 * it under the terms of the GNU General Public License as published by
 | 
			
		||||
 * the Free Software Foundation; either version 2 of the License, or
 | 
			
		||||
 * (at your option) any later version.
 | 
			
		||||
 *
 | 
			
		||||
 * This program is distributed in the hope that it will be useful,
 | 
			
		||||
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
			
		||||
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | 
			
		||||
 * GNU General Public License for more details.
 | 
			
		||||
 */
 | 
			
		||||
 | 
			
		||||
#ifndef _DB8500_THERMAL_H_
 | 
			
		||||
#define _DB8500_THERMAL_H_
 | 
			
		||||
 | 
			
		||||
#include <linux/thermal.h>
 | 
			
		||||
 | 
			
		||||
#define COOLING_DEV_MAX 8
 | 
			
		||||
 | 
			
		||||
struct db8500_trip_point {
 | 
			
		||||
	unsigned long temp;
 | 
			
		||||
	enum thermal_trip_type type;
 | 
			
		||||
	char cdev_name[COOLING_DEV_MAX][THERMAL_NAME_LENGTH];
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
struct db8500_thsens_platform_data {
 | 
			
		||||
	struct db8500_trip_point trip_points[THERMAL_MAX_TRIPS];
 | 
			
		||||
	int num_trips;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
#endif /* _DB8500_THERMAL_H_ */
 | 
			
		||||
| 
						 | 
				
			
			@ -29,6 +29,32 @@
 | 
			
		|||
#include <linux/device.h>
 | 
			
		||||
#include <linux/workqueue.h>
 | 
			
		||||
 | 
			
		||||
#define THERMAL_TRIPS_NONE	-1
 | 
			
		||||
#define THERMAL_MAX_TRIPS	12
 | 
			
		||||
#define THERMAL_NAME_LENGTH	20
 | 
			
		||||
 | 
			
		||||
/* No upper/lower limit requirement */
 | 
			
		||||
#define THERMAL_NO_LIMIT	-1UL
 | 
			
		||||
 | 
			
		||||
/* Unit conversion macros */
 | 
			
		||||
#define KELVIN_TO_CELSIUS(t)	(long)(((long)t-2732 >= 0) ?	\
 | 
			
		||||
				((long)t-2732+5)/10 : ((long)t-2732-5)/10)
 | 
			
		||||
#define CELSIUS_TO_KELVIN(t)	((t)*10+2732)
 | 
			
		||||
 | 
			
		||||
/* Adding event notification support elements */
 | 
			
		||||
#define THERMAL_GENL_FAMILY_NAME                "thermal_event"
 | 
			
		||||
#define THERMAL_GENL_VERSION                    0x01
 | 
			
		||||
#define THERMAL_GENL_MCAST_GROUP_NAME           "thermal_mc_group"
 | 
			
		||||
 | 
			
		||||
/* Default Thermal Governor */
 | 
			
		||||
#if defined(CONFIG_THERMAL_DEFAULT_GOV_STEP_WISE)
 | 
			
		||||
#define DEFAULT_THERMAL_GOVERNOR       "step_wise"
 | 
			
		||||
#elif defined(CONFIG_THERMAL_DEFAULT_GOV_FAIR_SHARE)
 | 
			
		||||
#define DEFAULT_THERMAL_GOVERNOR       "fair_share"
 | 
			
		||||
#elif defined(CONFIG_THERMAL_DEFAULT_GOV_USER_SPACE)
 | 
			
		||||
#define DEFAULT_THERMAL_GOVERNOR       "user_space"
 | 
			
		||||
#endif
 | 
			
		||||
 | 
			
		||||
struct thermal_zone_device;
 | 
			
		||||
struct thermal_cooling_device;
 | 
			
		||||
 | 
			
		||||
| 
						 | 
				
			
			@ -50,6 +76,30 @@ enum thermal_trend {
 | 
			
		|||
	THERMAL_TREND_DROPPING, /* temperature is dropping */
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/* Events supported by Thermal Netlink */
 | 
			
		||||
enum events {
 | 
			
		||||
	THERMAL_AUX0,
 | 
			
		||||
	THERMAL_AUX1,
 | 
			
		||||
	THERMAL_CRITICAL,
 | 
			
		||||
	THERMAL_DEV_FAULT,
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/* attributes of thermal_genl_family */
 | 
			
		||||
enum {
 | 
			
		||||
	THERMAL_GENL_ATTR_UNSPEC,
 | 
			
		||||
	THERMAL_GENL_ATTR_EVENT,
 | 
			
		||||
	__THERMAL_GENL_ATTR_MAX,
 | 
			
		||||
};
 | 
			
		||||
#define THERMAL_GENL_ATTR_MAX (__THERMAL_GENL_ATTR_MAX - 1)
 | 
			
		||||
 | 
			
		||||
/* commands supported by the thermal_genl_family */
 | 
			
		||||
enum {
 | 
			
		||||
	THERMAL_GENL_CMD_UNSPEC,
 | 
			
		||||
	THERMAL_GENL_CMD_EVENT,
 | 
			
		||||
	__THERMAL_GENL_CMD_MAX,
 | 
			
		||||
};
 | 
			
		||||
#define THERMAL_GENL_CMD_MAX (__THERMAL_GENL_CMD_MAX - 1)
 | 
			
		||||
 | 
			
		||||
struct thermal_zone_device_ops {
 | 
			
		||||
	int (*bind) (struct thermal_zone_device *,
 | 
			
		||||
		     struct thermal_cooling_device *);
 | 
			
		||||
| 
						 | 
				
			
			@ -83,11 +133,6 @@ struct thermal_cooling_device_ops {
 | 
			
		|||
	int (*set_cur_state) (struct thermal_cooling_device *, unsigned long);
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
#define THERMAL_NO_LIMIT -1UL /* no upper/lower limit requirement */
 | 
			
		||||
 | 
			
		||||
#define THERMAL_TRIPS_NONE -1
 | 
			
		||||
#define THERMAL_MAX_TRIPS 12
 | 
			
		||||
#define THERMAL_NAME_LENGTH 20
 | 
			
		||||
struct thermal_cooling_device {
 | 
			
		||||
	int id;
 | 
			
		||||
	char type[THERMAL_NAME_LENGTH];
 | 
			
		||||
| 
						 | 
				
			
			@ -100,10 +145,6 @@ struct thermal_cooling_device {
 | 
			
		|||
	struct list_head node;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
#define KELVIN_TO_CELSIUS(t)	(long)(((long)t-2732 >= 0) ?	\
 | 
			
		||||
				((long)t-2732+5)/10 : ((long)t-2732-5)/10)
 | 
			
		||||
#define CELSIUS_TO_KELVIN(t)	((t)*10+2732)
 | 
			
		||||
 | 
			
		||||
struct thermal_attr {
 | 
			
		||||
	struct device_attribute attr;
 | 
			
		||||
	char name[THERMAL_NAME_LENGTH];
 | 
			
		||||
| 
						 | 
				
			
			@ -125,46 +166,61 @@ struct thermal_zone_device {
 | 
			
		|||
	int passive;
 | 
			
		||||
	unsigned int forced_passive;
 | 
			
		||||
	const struct thermal_zone_device_ops *ops;
 | 
			
		||||
	const struct thermal_zone_params *tzp;
 | 
			
		||||
	struct thermal_governor *governor;
 | 
			
		||||
	struct list_head thermal_instances;
 | 
			
		||||
	struct idr idr;
 | 
			
		||||
	struct mutex lock; /* protect thermal_instances list */
 | 
			
		||||
	struct list_head node;
 | 
			
		||||
	struct delayed_work poll_queue;
 | 
			
		||||
};
 | 
			
		||||
/* Adding event notification support elements */
 | 
			
		||||
#define THERMAL_GENL_FAMILY_NAME                "thermal_event"
 | 
			
		||||
#define THERMAL_GENL_VERSION                    0x01
 | 
			
		||||
#define THERMAL_GENL_MCAST_GROUP_NAME           "thermal_mc_group"
 | 
			
		||||
 | 
			
		||||
enum events {
 | 
			
		||||
	THERMAL_AUX0,
 | 
			
		||||
	THERMAL_AUX1,
 | 
			
		||||
	THERMAL_CRITICAL,
 | 
			
		||||
	THERMAL_DEV_FAULT,
 | 
			
		||||
/* Structure that holds thermal governor information */
 | 
			
		||||
struct thermal_governor {
 | 
			
		||||
	char name[THERMAL_NAME_LENGTH];
 | 
			
		||||
	int (*throttle)(struct thermal_zone_device *tz, int trip);
 | 
			
		||||
	struct list_head	governor_list;
 | 
			
		||||
	struct module		*owner;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/* Structure that holds binding parameters for a zone */
 | 
			
		||||
struct thermal_bind_params {
 | 
			
		||||
	struct thermal_cooling_device *cdev;
 | 
			
		||||
 | 
			
		||||
	/*
 | 
			
		||||
	 * This is a measure of 'how effectively these devices can
 | 
			
		||||
	 * cool 'this' thermal zone. The shall be determined by platform
 | 
			
		||||
	 * characterization. This is on a 'percentage' scale.
 | 
			
		||||
	 * See Documentation/thermal/sysfs-api.txt for more information.
 | 
			
		||||
	 */
 | 
			
		||||
	int weight;
 | 
			
		||||
 | 
			
		||||
	/*
 | 
			
		||||
	 * This is a bit mask that gives the binding relation between this
 | 
			
		||||
	 * thermal zone and cdev, for a particular trip point.
 | 
			
		||||
	 * See Documentation/thermal/sysfs-api.txt for more information.
 | 
			
		||||
	 */
 | 
			
		||||
	int trip_mask;
 | 
			
		||||
	int (*match) (struct thermal_zone_device *tz,
 | 
			
		||||
			struct thermal_cooling_device *cdev);
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
/* Structure to define Thermal Zone parameters */
 | 
			
		||||
struct thermal_zone_params {
 | 
			
		||||
	char governor_name[THERMAL_NAME_LENGTH];
 | 
			
		||||
	int num_tbps;	/* Number of tbp entries */
 | 
			
		||||
	struct thermal_bind_params *tbp;
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
struct thermal_genl_event {
 | 
			
		||||
	u32 orig;
 | 
			
		||||
	enum events event;
 | 
			
		||||
};
 | 
			
		||||
/* attributes of thermal_genl_family */
 | 
			
		||||
enum {
 | 
			
		||||
	THERMAL_GENL_ATTR_UNSPEC,
 | 
			
		||||
	THERMAL_GENL_ATTR_EVENT,
 | 
			
		||||
	__THERMAL_GENL_ATTR_MAX,
 | 
			
		||||
};
 | 
			
		||||
#define THERMAL_GENL_ATTR_MAX (__THERMAL_GENL_ATTR_MAX - 1)
 | 
			
		||||
 | 
			
		||||
/* commands supported by the thermal_genl_family */
 | 
			
		||||
enum {
 | 
			
		||||
	THERMAL_GENL_CMD_UNSPEC,
 | 
			
		||||
	THERMAL_GENL_CMD_EVENT,
 | 
			
		||||
	__THERMAL_GENL_CMD_MAX,
 | 
			
		||||
};
 | 
			
		||||
#define THERMAL_GENL_CMD_MAX (__THERMAL_GENL_CMD_MAX - 1)
 | 
			
		||||
 | 
			
		||||
/* Function declarations */
 | 
			
		||||
struct thermal_zone_device *thermal_zone_device_register(const char *, int, int,
 | 
			
		||||
		void *, const struct thermal_zone_device_ops *, int, int);
 | 
			
		||||
		void *, const struct thermal_zone_device_ops *,
 | 
			
		||||
		const struct thermal_zone_params *, int, int);
 | 
			
		||||
void thermal_zone_device_unregister(struct thermal_zone_device *);
 | 
			
		||||
 | 
			
		||||
int thermal_zone_bind_cooling_device(struct thermal_zone_device *, int,
 | 
			
		||||
| 
						 | 
				
			
			@ -173,10 +229,20 @@ int thermal_zone_bind_cooling_device(struct thermal_zone_device *, int,
 | 
			
		|||
int thermal_zone_unbind_cooling_device(struct thermal_zone_device *, int,
 | 
			
		||||
				       struct thermal_cooling_device *);
 | 
			
		||||
void thermal_zone_device_update(struct thermal_zone_device *);
 | 
			
		||||
 | 
			
		||||
struct thermal_cooling_device *thermal_cooling_device_register(char *, void *,
 | 
			
		||||
		const struct thermal_cooling_device_ops *);
 | 
			
		||||
void thermal_cooling_device_unregister(struct thermal_cooling_device *);
 | 
			
		||||
 | 
			
		||||
int get_tz_trend(struct thermal_zone_device *, int);
 | 
			
		||||
struct thermal_instance *get_thermal_instance(struct thermal_zone_device *,
 | 
			
		||||
		struct thermal_cooling_device *, int);
 | 
			
		||||
void thermal_cdev_update(struct thermal_cooling_device *);
 | 
			
		||||
void notify_thermal_framework(struct thermal_zone_device *, int);
 | 
			
		||||
 | 
			
		||||
int thermal_register_governor(struct thermal_governor *);
 | 
			
		||||
void thermal_unregister_governor(struct thermal_governor *);
 | 
			
		||||
 | 
			
		||||
#ifdef CONFIG_NET
 | 
			
		||||
extern int thermal_generate_netlink_event(u32 orig, enum events event);
 | 
			
		||||
#else
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
		Loading…
	
	Add table
		Add a link
		
	
		Reference in a new issue