[PATCHv5 05/10] Thermal: Add APIs to bind cdev to new zone structure
This patch creates new APIs to add/remove a
cdev to/from a zone. This patch does not change
the existing cooling device implementation.
Signed-off-by: Durgadoss R
---
drivers/thermal/thermal_core_new.c | 135
include/linux/thermal.h|8 +++
2 files changed, 143 insertions(+)
diff --git a/drivers/thermal/thermal_core_new.c
b/drivers/thermal/thermal_core_new.c
index 4f84cb5..3134b1a 100644
--- a/drivers/thermal/thermal_core_new.c
+++ b/drivers/thermal/thermal_core_new.c
@@ -66,6 +66,9 @@ static DEFINE_MUTEX(zone_list_lock);
#define for_each_thermal_zone(pos) \
list_for_each_entry(pos, _zone_list, node)
+#define for_each_cdev(pos) \
+ list_for_each_entry(pos, _cdev_list, node)
+
#define GET_INDEX(tz, ptr, type) \
({ \
int i, ret = -EINVAL; \
@@ -301,6 +304,27 @@ static void remove_sensor_from_zone(struct thermal_zone
*tz,
mutex_unlock(>lock);
}
+static void remove_cdev_from_zone(struct thermal_zone *tz,
+ struct thermal_cooling_device *cdev)
+{
+ int j, indx;
+
+ indx = GET_INDEX(tz, cdev, cdev);
+ if (indx < 0)
+ return;
+
+ sysfs_remove_link(>device.kobj, kobject_name(>device.kobj));
+
+ mutex_lock(>lock);
+
+ /* Shift the entries in the tz->cdevs array */
+ for (j = indx; j < MAX_CDEVS_PER_ZONE - 1; j++)
+ tz->cdevs[j] = tz->cdevs[j + 1];
+
+ tz->cdev_indx--;
+ mutex_unlock(>lock);
+}
+
/**
* thermal_create_sensor_sysfs - create sysfs nodes for sensorX
* @ts:the thermal sensor
@@ -593,6 +617,7 @@ EXPORT_SYMBOL_GPL(thermal_cdev_register);
void thermal_cdev_unregister(struct thermal_cooling_device *cdev)
{
struct thermal_cooling_device *pos, *next;
+ struct thermal_zone *tz;
bool found = false;
if (!cdev)
@@ -610,6 +635,13 @@ void thermal_cdev_unregister(struct thermal_cooling_device
*cdev)
if (!found)
return;
+ mutex_lock(_list_lock);
+
+ for_each_thermal_zone(tz)
+ remove_cdev_from_zone(tz, cdev);
+
+ mutex_unlock(_list_lock);
+
device_remove_file(>device, _attr_type);
device_remove_file(>device, _attr_max_state);
device_remove_file(>device, _attr_cur_state);
@@ -688,6 +720,7 @@ void thermal_remove_thermal_zone(struct thermal_zone *tz)
{
struct thermal_zone *pos, *next;
struct thermal_sensor *ts;
+ struct thermal_cooling_device *cdev;
bool found = false;
if (!tz)
@@ -709,6 +742,9 @@ void thermal_remove_thermal_zone(struct thermal_zone *tz)
for_each_thermal_sensor(ts)
remove_sensor_from_zone(tz, ts);
+ for_each_cdev(cdev)
+ remove_cdev_from_zone(tz, cdev);
+
device_remove_file(>device, _attr_zone_name);
mutex_destroy(>lock);
@@ -817,3 +853,102 @@ exit_zone:
return ret;
}
EXPORT_SYMBOL_GPL(thermal_add_sensor_to_zone);
+
+/**
+ * thermal_get_cdev_by_name() - search for a cdev and returns its reference
+ * @name: cooling device name to fetch the reference
+ *
+ * On success returns a reference to an unique cdev with
+ * the name matching that of @name, an ERR_PTR otherwise:
+ * -EINVAL for invalid paramenters
+ * -ENODEV for cdev not found
+ * -EEXIST for multiple matches
+ */
+struct thermal_cooling_device *thermal_get_cdev_by_name(const char *name)
+{
+ int found = 0;
+ struct thermal_cooling_device *pos;
+ struct thermal_cooling_device *cdev = ERR_PTR(-EINVAL);
+
+ if (!name)
+ return cdev;
+
+ mutex_lock(_list_lock);
+ for_each_cdev(pos) {
+ if (!strnicmp(pos->type, name, THERMAL_NAME_LENGTH)) {
+ found++;
+ cdev = pos;
+ }
+ }
+ mutex_unlock(_list_lock);
+
+ /*
+* Nothing has been found; return an error code for it.
+* Return success only when an unique cdev is found.
+*/
+ if (found == 0)
+ cdev = ERR_PTR(-ENODEV);
+ else if (found > 1)
+ cdev = ERR_PTR(-EEXIST);
+
+ return cdev;
+}
+EXPORT_SYMBOL_GPL(thermal_get_cdev_by_name);
+
+/**
+ * thermal_add_cdev_to_zone - Add @cdev to thermal zone @tz
+ * @tz:Thermal zone reference
+ * @cdev: Cooling device reference
+ *
+ * Returns 0 on success, otherwise
+ * -EINVAL for invalid paramenters
+ * -EINVAL when trying to add more cdevs than MAX_CDEVS_PER_ZONE
+ * -EEXIST when trying add existing cdev again
+ */
+int thermal_add_cdev_to_zone(struct thermal_zone *tz,
+ struct thermal_cooling_device *cdev)
+{
+ int ret;
+
+ if (!tz || !cdev)
+ return -EINVAL;
+
+ mutex_lock(_list_lock);
+
+ /* Ensure we are not adding the same
[PATCHv5 05/10] Thermal: Add APIs to bind cdev to new zone structure
This patch creates new APIs to add/remove a
cdev to/from a zone. This patch does not change
the existing cooling device implementation.
Signed-off-by: Durgadoss R durgados...@intel.com
---
drivers/thermal/thermal_core_new.c | 135
include/linux/thermal.h|8 +++
2 files changed, 143 insertions(+)
diff --git a/drivers/thermal/thermal_core_new.c
b/drivers/thermal/thermal_core_new.c
index 4f84cb5..3134b1a 100644
--- a/drivers/thermal/thermal_core_new.c
+++ b/drivers/thermal/thermal_core_new.c
@@ -66,6 +66,9 @@ static DEFINE_MUTEX(zone_list_lock);
#define for_each_thermal_zone(pos) \
list_for_each_entry(pos, thermal_zone_list, node)
+#define for_each_cdev(pos) \
+ list_for_each_entry(pos, thermal_cdev_list, node)
+
#define GET_INDEX(tz, ptr, type) \
({ \
int i, ret = -EINVAL; \
@@ -301,6 +304,27 @@ static void remove_sensor_from_zone(struct thermal_zone
*tz,
mutex_unlock(tz-lock);
}
+static void remove_cdev_from_zone(struct thermal_zone *tz,
+ struct thermal_cooling_device *cdev)
+{
+ int j, indx;
+
+ indx = GET_INDEX(tz, cdev, cdev);
+ if (indx 0)
+ return;
+
+ sysfs_remove_link(tz-device.kobj, kobject_name(cdev-device.kobj));
+
+ mutex_lock(tz-lock);
+
+ /* Shift the entries in the tz-cdevs array */
+ for (j = indx; j MAX_CDEVS_PER_ZONE - 1; j++)
+ tz-cdevs[j] = tz-cdevs[j + 1];
+
+ tz-cdev_indx--;
+ mutex_unlock(tz-lock);
+}
+
/**
* thermal_create_sensor_sysfs - create sysfs nodes for sensorX
* @ts:the thermal sensor
@@ -593,6 +617,7 @@ EXPORT_SYMBOL_GPL(thermal_cdev_register);
void thermal_cdev_unregister(struct thermal_cooling_device *cdev)
{
struct thermal_cooling_device *pos, *next;
+ struct thermal_zone *tz;
bool found = false;
if (!cdev)
@@ -610,6 +635,13 @@ void thermal_cdev_unregister(struct thermal_cooling_device
*cdev)
if (!found)
return;
+ mutex_lock(zone_list_lock);
+
+ for_each_thermal_zone(tz)
+ remove_cdev_from_zone(tz, cdev);
+
+ mutex_unlock(zone_list_lock);
+
device_remove_file(cdev-device, dev_attr_type);
device_remove_file(cdev-device, dev_attr_max_state);
device_remove_file(cdev-device, dev_attr_cur_state);
@@ -688,6 +720,7 @@ void thermal_remove_thermal_zone(struct thermal_zone *tz)
{
struct thermal_zone *pos, *next;
struct thermal_sensor *ts;
+ struct thermal_cooling_device *cdev;
bool found = false;
if (!tz)
@@ -709,6 +742,9 @@ void thermal_remove_thermal_zone(struct thermal_zone *tz)
for_each_thermal_sensor(ts)
remove_sensor_from_zone(tz, ts);
+ for_each_cdev(cdev)
+ remove_cdev_from_zone(tz, cdev);
+
device_remove_file(tz-device, dev_attr_zone_name);
mutex_destroy(tz-lock);
@@ -817,3 +853,102 @@ exit_zone:
return ret;
}
EXPORT_SYMBOL_GPL(thermal_add_sensor_to_zone);
+
+/**
+ * thermal_get_cdev_by_name() - search for a cdev and returns its reference
+ * @name: cooling device name to fetch the reference
+ *
+ * On success returns a reference to an unique cdev with
+ * the name matching that of @name, an ERR_PTR otherwise:
+ * -EINVAL for invalid paramenters
+ * -ENODEV for cdev not found
+ * -EEXIST for multiple matches
+ */
+struct thermal_cooling_device *thermal_get_cdev_by_name(const char *name)
+{
+ int found = 0;
+ struct thermal_cooling_device *pos;
+ struct thermal_cooling_device *cdev = ERR_PTR(-EINVAL);
+
+ if (!name)
+ return cdev;
+
+ mutex_lock(cdev_list_lock);
+ for_each_cdev(pos) {
+ if (!strnicmp(pos-type, name, THERMAL_NAME_LENGTH)) {
+ found++;
+ cdev = pos;
+ }
+ }
+ mutex_unlock(cdev_list_lock);
+
+ /*
+* Nothing has been found; return an error code for it.
+* Return success only when an unique cdev is found.
+*/
+ if (found == 0)
+ cdev = ERR_PTR(-ENODEV);
+ else if (found 1)
+ cdev = ERR_PTR(-EEXIST);
+
+ return cdev;
+}
+EXPORT_SYMBOL_GPL(thermal_get_cdev_by_name);
+
+/**
+ * thermal_add_cdev_to_zone - Add @cdev to thermal zone @tz
+ * @tz:Thermal zone reference
+ * @cdev: Cooling device reference
+ *
+ * Returns 0 on success, otherwise
+ * -EINVAL for invalid paramenters
+ * -EINVAL when trying to add more cdevs than MAX_CDEVS_PER_ZONE
+ * -EEXIST when trying add existing cdev again
+ */
+int thermal_add_cdev_to_zone(struct thermal_zone *tz,
+ struct thermal_cooling_device *cdev)
+{
+ int ret;
+
+ if (!tz || !cdev)
+ return -EINVAL;
