xref: /openbmc/linux/drivers/thermal/thermal_of.c (revision 901181b7)
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  *  of-thermal.c - Generic Thermal Management device tree support.
4  *
5  *  Copyright (C) 2013 Texas Instruments
6  *  Copyright (C) 2013 Eduardo Valentin <eduardo.valentin@ti.com>
7  */
8 
9 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
10 
11 #include <linux/err.h>
12 #include <linux/export.h>
13 #include <linux/of_device.h>
14 #include <linux/of_platform.h>
15 #include <linux/slab.h>
16 #include <linux/thermal.h>
17 #include <linux/types.h>
18 #include <linux/string.h>
19 
20 #include "thermal_core.h"
21 
22 /***   Private data structures to represent thermal device tree data ***/
23 
24 /**
25  * struct __thermal_cooling_bind_param - a cooling device for a trip point
26  * @cooling_device: a pointer to identify the referred cooling device
27  * @min: minimum cooling state used at this trip point
28  * @max: maximum cooling state used at this trip point
29  */
30 
31 struct __thermal_cooling_bind_param {
32 	struct device_node *cooling_device;
33 	unsigned long min;
34 	unsigned long max;
35 };
36 
37 /**
38  * struct __thermal_bind_param - a match between trip and cooling device
39  * @tcbp: a pointer to an array of cooling devices
40  * @count: number of elements in array
41  * @trip_id: the trip point index
42  * @usage: the percentage (from 0 to 100) of cooling contribution
43  */
44 
45 struct __thermal_bind_params {
46 	struct __thermal_cooling_bind_param *tcbp;
47 	unsigned int count;
48 	unsigned int trip_id;
49 	unsigned int usage;
50 };
51 
52 /**
53  * struct __thermal_zone - internal representation of a thermal zone
54  * @passive_delay: polling interval while passive cooling is activated
55  * @polling_delay: zone polling interval
56  * @slope: slope of the temperature adjustment curve
57  * @offset: offset of the temperature adjustment curve
58  * @ntrips: number of trip points
59  * @trips: an array of trip points (0..ntrips - 1)
60  * @num_tbps: number of thermal bind params
61  * @tbps: an array of thermal bind params (0..num_tbps - 1)
62  * @sensor_data: sensor private data used while reading temperature and trend
63  * @ops: set of callbacks to handle the thermal zone based on DT
64  */
65 
66 struct __thermal_zone {
67 	int passive_delay;
68 	int polling_delay;
69 	int slope;
70 	int offset;
71 
72 	/* trip data */
73 	int ntrips;
74 	struct thermal_trip *trips;
75 
76 	/* cooling binding data */
77 	int num_tbps;
78 	struct __thermal_bind_params *tbps;
79 
80 	/* sensor interface */
81 	void *sensor_data;
82 	const struct thermal_zone_of_device_ops *ops;
83 };
84 
85 /***   DT thermal zone device callbacks   ***/
86 
87 static int of_thermal_get_temp(struct thermal_zone_device *tz,
88 			       int *temp)
89 {
90 	struct __thermal_zone *data = tz->devdata;
91 
92 	if (!data->ops || !data->ops->get_temp)
93 		return -EINVAL;
94 
95 	return data->ops->get_temp(data->sensor_data, temp);
96 }
97 
98 static int of_thermal_set_trips(struct thermal_zone_device *tz,
99 				int low, int high)
100 {
101 	struct __thermal_zone *data = tz->devdata;
102 
103 	if (!data->ops || !data->ops->set_trips)
104 		return -EINVAL;
105 
106 	return data->ops->set_trips(data->sensor_data, low, high);
107 }
108 
109 /**
110  * of_thermal_get_ntrips - function to export number of available trip
111  *			   points.
112  * @tz: pointer to a thermal zone
113  *
114  * This function is a globally visible wrapper to get number of trip points
115  * stored in the local struct __thermal_zone
116  *
117  * Return: number of available trip points, -ENODEV when data not available
118  */
119 int of_thermal_get_ntrips(struct thermal_zone_device *tz)
120 {
121 	struct __thermal_zone *data = tz->devdata;
122 
123 	if (!data || IS_ERR(data))
124 		return -ENODEV;
125 
126 	return data->ntrips;
127 }
128 EXPORT_SYMBOL_GPL(of_thermal_get_ntrips);
129 
130 /**
131  * of_thermal_is_trip_valid - function to check if trip point is valid
132  *
133  * @tz:	pointer to a thermal zone
134  * @trip:	trip point to evaluate
135  *
136  * This function is responsible for checking if passed trip point is valid
137  *
138  * Return: true if trip point is valid, false otherwise
139  */
140 bool of_thermal_is_trip_valid(struct thermal_zone_device *tz, int trip)
141 {
142 	struct __thermal_zone *data = tz->devdata;
143 
144 	if (!data || trip >= data->ntrips || trip < 0)
145 		return false;
146 
147 	return true;
148 }
149 EXPORT_SYMBOL_GPL(of_thermal_is_trip_valid);
150 
151 /**
152  * of_thermal_get_trip_points - function to get access to a globally exported
153  *				trip points
154  *
155  * @tz:	pointer to a thermal zone
156  *
157  * This function provides a pointer to trip points table
158  *
159  * Return: pointer to trip points table, NULL otherwise
160  */
161 const struct thermal_trip *
162 of_thermal_get_trip_points(struct thermal_zone_device *tz)
163 {
164 	struct __thermal_zone *data = tz->devdata;
165 
166 	if (!data)
167 		return NULL;
168 
169 	return data->trips;
170 }
171 EXPORT_SYMBOL_GPL(of_thermal_get_trip_points);
172 
173 /**
174  * of_thermal_set_emul_temp - function to set emulated temperature
175  *
176  * @tz:	pointer to a thermal zone
177  * @temp:	temperature to set
178  *
179  * This function gives the ability to set emulated value of temperature,
180  * which is handy for debugging
181  *
182  * Return: zero on success, error code otherwise
183  */
184 static int of_thermal_set_emul_temp(struct thermal_zone_device *tz,
185 				    int temp)
186 {
187 	struct __thermal_zone *data = tz->devdata;
188 
189 	if (!data->ops || !data->ops->set_emul_temp)
190 		return -EINVAL;
191 
192 	return data->ops->set_emul_temp(data->sensor_data, temp);
193 }
194 
195 static int of_thermal_get_trend(struct thermal_zone_device *tz, int trip,
196 				enum thermal_trend *trend)
197 {
198 	struct __thermal_zone *data = tz->devdata;
199 
200 	if (!data->ops || !data->ops->get_trend)
201 		return -EINVAL;
202 
203 	return data->ops->get_trend(data->sensor_data, trip, trend);
204 }
205 
206 static int of_thermal_bind(struct thermal_zone_device *thermal,
207 			   struct thermal_cooling_device *cdev)
208 {
209 	struct __thermal_zone *data = thermal->devdata;
210 	struct __thermal_bind_params *tbp;
211 	struct __thermal_cooling_bind_param *tcbp;
212 	int i, j;
213 
214 	if (!data || IS_ERR(data))
215 		return -ENODEV;
216 
217 	/* find where to bind */
218 	for (i = 0; i < data->num_tbps; i++) {
219 		tbp = data->tbps + i;
220 
221 		for (j = 0; j < tbp->count; j++) {
222 			tcbp = tbp->tcbp + j;
223 
224 			if (tcbp->cooling_device == cdev->np) {
225 				int ret;
226 
227 				ret = thermal_zone_bind_cooling_device(thermal,
228 						tbp->trip_id, cdev,
229 						tcbp->max,
230 						tcbp->min,
231 						tbp->usage);
232 				if (ret)
233 					return ret;
234 			}
235 		}
236 	}
237 
238 	return 0;
239 }
240 
241 static int of_thermal_unbind(struct thermal_zone_device *thermal,
242 			     struct thermal_cooling_device *cdev)
243 {
244 	struct __thermal_zone *data = thermal->devdata;
245 	struct __thermal_bind_params *tbp;
246 	struct __thermal_cooling_bind_param *tcbp;
247 	int i, j;
248 
249 	if (!data || IS_ERR(data))
250 		return -ENODEV;
251 
252 	/* find where to unbind */
253 	for (i = 0; i < data->num_tbps; i++) {
254 		tbp = data->tbps + i;
255 
256 		for (j = 0; j < tbp->count; j++) {
257 			tcbp = tbp->tcbp + j;
258 
259 			if (tcbp->cooling_device == cdev->np) {
260 				int ret;
261 
262 				ret = thermal_zone_unbind_cooling_device(thermal,
263 							tbp->trip_id, cdev);
264 				if (ret)
265 					return ret;
266 			}
267 		}
268 	}
269 
270 	return 0;
271 }
272 
273 static int of_thermal_get_trip_type(struct thermal_zone_device *tz, int trip,
274 				    enum thermal_trip_type *type)
275 {
276 	struct __thermal_zone *data = tz->devdata;
277 
278 	if (trip >= data->ntrips || trip < 0)
279 		return -EDOM;
280 
281 	*type = data->trips[trip].type;
282 
283 	return 0;
284 }
285 
286 static int of_thermal_get_trip_temp(struct thermal_zone_device *tz, int trip,
287 				    int *temp)
288 {
289 	struct __thermal_zone *data = tz->devdata;
290 
291 	if (trip >= data->ntrips || trip < 0)
292 		return -EDOM;
293 
294 	*temp = data->trips[trip].temperature;
295 
296 	return 0;
297 }
298 
299 static int of_thermal_set_trip_temp(struct thermal_zone_device *tz, int trip,
300 				    int temp)
301 {
302 	struct __thermal_zone *data = tz->devdata;
303 
304 	if (trip >= data->ntrips || trip < 0)
305 		return -EDOM;
306 
307 	if (data->ops && data->ops->set_trip_temp) {
308 		int ret;
309 
310 		ret = data->ops->set_trip_temp(data->sensor_data, trip, temp);
311 		if (ret)
312 			return ret;
313 	}
314 
315 	/* thermal framework should take care of data->mask & (1 << trip) */
316 	data->trips[trip].temperature = temp;
317 
318 	return 0;
319 }
320 
321 static int of_thermal_get_trip_hyst(struct thermal_zone_device *tz, int trip,
322 				    int *hyst)
323 {
324 	struct __thermal_zone *data = tz->devdata;
325 
326 	if (trip >= data->ntrips || trip < 0)
327 		return -EDOM;
328 
329 	*hyst = data->trips[trip].hysteresis;
330 
331 	return 0;
332 }
333 
334 static int of_thermal_set_trip_hyst(struct thermal_zone_device *tz, int trip,
335 				    int hyst)
336 {
337 	struct __thermal_zone *data = tz->devdata;
338 
339 	if (trip >= data->ntrips || trip < 0)
340 		return -EDOM;
341 
342 	/* thermal framework should take care of data->mask & (1 << trip) */
343 	data->trips[trip].hysteresis = hyst;
344 
345 	return 0;
346 }
347 
348 static int of_thermal_get_crit_temp(struct thermal_zone_device *tz,
349 				    int *temp)
350 {
351 	struct __thermal_zone *data = tz->devdata;
352 	int i;
353 
354 	for (i = 0; i < data->ntrips; i++)
355 		if (data->trips[i].type == THERMAL_TRIP_CRITICAL) {
356 			*temp = data->trips[i].temperature;
357 			return 0;
358 		}
359 
360 	return -EINVAL;
361 }
362 
363 static struct thermal_zone_device_ops of_thermal_ops = {
364 	.get_trip_type = of_thermal_get_trip_type,
365 	.get_trip_temp = of_thermal_get_trip_temp,
366 	.set_trip_temp = of_thermal_set_trip_temp,
367 	.get_trip_hyst = of_thermal_get_trip_hyst,
368 	.set_trip_hyst = of_thermal_set_trip_hyst,
369 	.get_crit_temp = of_thermal_get_crit_temp,
370 
371 	.bind = of_thermal_bind,
372 	.unbind = of_thermal_unbind,
373 };
374 
375 /***   sensor API   ***/
376 
377 static struct thermal_zone_device *
378 thermal_zone_of_add_sensor(struct device_node *zone,
379 			   struct device_node *sensor, void *data,
380 			   const struct thermal_zone_of_device_ops *ops)
381 {
382 	struct thermal_zone_device *tzd;
383 	struct __thermal_zone *tz;
384 
385 	tzd = thermal_zone_get_zone_by_name(zone->name);
386 	if (IS_ERR(tzd))
387 		return ERR_PTR(-EPROBE_DEFER);
388 
389 	tz = tzd->devdata;
390 
391 	if (!ops)
392 		return ERR_PTR(-EINVAL);
393 
394 	mutex_lock(&tzd->lock);
395 	tz->ops = ops;
396 	tz->sensor_data = data;
397 
398 	tzd->ops->get_temp = of_thermal_get_temp;
399 	tzd->ops->get_trend = of_thermal_get_trend;
400 
401 	/*
402 	 * The thermal zone core will calculate the window if they have set the
403 	 * optional set_trips pointer.
404 	 */
405 	if (ops->set_trips)
406 		tzd->ops->set_trips = of_thermal_set_trips;
407 
408 	if (ops->set_emul_temp)
409 		tzd->ops->set_emul_temp = of_thermal_set_emul_temp;
410 
411 	mutex_unlock(&tzd->lock);
412 
413 	return tzd;
414 }
415 
416 /**
417  * thermal_zone_of_get_sensor_id - get sensor ID from a DT thermal zone
418  * @tz_np: a valid thermal zone device node.
419  * @sensor_np: a sensor node of a valid sensor device.
420  * @id: the sensor ID returned if success.
421  *
422  * This function will get sensor ID from a given thermal zone node and
423  * the sensor node must match the temperature provider @sensor_np.
424  *
425  * Return: 0 on success, proper error code otherwise.
426  */
427 
428 int thermal_zone_of_get_sensor_id(struct device_node *tz_np,
429 				  struct device_node *sensor_np,
430 				  u32 *id)
431 {
432 	struct of_phandle_args sensor_specs;
433 	int ret;
434 
435 	ret = of_parse_phandle_with_args(tz_np,
436 					 "thermal-sensors",
437 					 "#thermal-sensor-cells",
438 					 0,
439 					 &sensor_specs);
440 	if (ret)
441 		return ret;
442 
443 	if (sensor_specs.np != sensor_np) {
444 		of_node_put(sensor_specs.np);
445 		return -ENODEV;
446 	}
447 
448 	if (sensor_specs.args_count > 1)
449 		pr_warn("%pOFn: too many cells in sensor specifier %d\n",
450 		     sensor_specs.np, sensor_specs.args_count);
451 
452 	*id = sensor_specs.args_count ? sensor_specs.args[0] : 0;
453 
454 	of_node_put(sensor_specs.np);
455 
456 	return 0;
457 }
458 EXPORT_SYMBOL_GPL(thermal_zone_of_get_sensor_id);
459 
460 /**
461  * thermal_zone_of_sensor_register - registers a sensor to a DT thermal zone
462  * @dev: a valid struct device pointer of a sensor device. Must contain
463  *       a valid .of_node, for the sensor node.
464  * @sensor_id: a sensor identifier, in case the sensor IP has more
465  *             than one sensors
466  * @data: a private pointer (owned by the caller) that will be passed
467  *        back, when a temperature reading is needed.
468  * @ops: struct thermal_zone_of_device_ops *. Must contain at least .get_temp.
469  *
470  * This function will search the list of thermal zones described in device
471  * tree and look for the zone that refer to the sensor device pointed by
472  * @dev->of_node as temperature providers. For the zone pointing to the
473  * sensor node, the sensor will be added to the DT thermal zone device.
474  *
475  * The thermal zone temperature is provided by the @get_temp function
476  * pointer. When called, it will have the private pointer @data back.
477  *
478  * The thermal zone temperature trend is provided by the @get_trend function
479  * pointer. When called, it will have the private pointer @data back.
480  *
481  * TODO:
482  * 01 - This function must enqueue the new sensor instead of using
483  * it as the only source of temperature values.
484  *
485  * 02 - There must be a way to match the sensor with all thermal zones
486  * that refer to it.
487  *
488  * Return: On success returns a valid struct thermal_zone_device,
489  * otherwise, it returns a corresponding ERR_PTR(). Caller must
490  * check the return value with help of IS_ERR() helper.
491  */
492 struct thermal_zone_device *
493 thermal_zone_of_sensor_register(struct device *dev, int sensor_id, void *data,
494 				const struct thermal_zone_of_device_ops *ops)
495 {
496 	struct device_node *np, *child, *sensor_np;
497 	struct thermal_zone_device *tzd = ERR_PTR(-ENODEV);
498 
499 	np = of_find_node_by_name(NULL, "thermal-zones");
500 	if (!np)
501 		return ERR_PTR(-ENODEV);
502 
503 	if (!dev || !dev->of_node) {
504 		of_node_put(np);
505 		return ERR_PTR(-ENODEV);
506 	}
507 
508 	sensor_np = of_node_get(dev->of_node);
509 
510 	for_each_available_child_of_node(np, child) {
511 		int ret, id;
512 
513 		/* For now, thermal framework supports only 1 sensor per zone */
514 		ret = thermal_zone_of_get_sensor_id(child, sensor_np, &id);
515 		if (ret)
516 			continue;
517 
518 		if (id == sensor_id) {
519 			tzd = thermal_zone_of_add_sensor(child, sensor_np,
520 							 data, ops);
521 			if (!IS_ERR(tzd))
522 				thermal_zone_device_enable(tzd);
523 
524 			of_node_put(child);
525 			goto exit;
526 		}
527 	}
528 exit:
529 	of_node_put(sensor_np);
530 	of_node_put(np);
531 
532 	return tzd;
533 }
534 EXPORT_SYMBOL_GPL(thermal_zone_of_sensor_register);
535 
536 /**
537  * thermal_zone_of_sensor_unregister - unregisters a sensor from a DT thermal zone
538  * @dev: a valid struct device pointer of a sensor device. Must contain
539  *       a valid .of_node, for the sensor node.
540  * @tzd: a pointer to struct thermal_zone_device where the sensor is registered.
541  *
542  * This function removes the sensor callbacks and private data from the
543  * thermal zone device registered with thermal_zone_of_sensor_register()
544  * API. It will also silent the zone by remove the .get_temp() and .get_trend()
545  * thermal zone device callbacks.
546  *
547  * TODO: When the support to several sensors per zone is added, this
548  * function must search the sensor list based on @dev parameter.
549  *
550  */
551 void thermal_zone_of_sensor_unregister(struct device *dev,
552 				       struct thermal_zone_device *tzd)
553 {
554 	struct __thermal_zone *tz;
555 
556 	if (!dev || !tzd || !tzd->devdata)
557 		return;
558 
559 	tz = tzd->devdata;
560 
561 	/* no __thermal_zone, nothing to be done */
562 	if (!tz)
563 		return;
564 
565 	/* stop temperature polling */
566 	thermal_zone_device_disable(tzd);
567 
568 	mutex_lock(&tzd->lock);
569 	tzd->ops->get_temp = NULL;
570 	tzd->ops->get_trend = NULL;
571 	tzd->ops->set_emul_temp = NULL;
572 
573 	tz->ops = NULL;
574 	tz->sensor_data = NULL;
575 	mutex_unlock(&tzd->lock);
576 }
577 EXPORT_SYMBOL_GPL(thermal_zone_of_sensor_unregister);
578 
579 static void devm_thermal_zone_of_sensor_release(struct device *dev, void *res)
580 {
581 	thermal_zone_of_sensor_unregister(dev,
582 					  *(struct thermal_zone_device **)res);
583 }
584 
585 static int devm_thermal_zone_of_sensor_match(struct device *dev, void *res,
586 					     void *data)
587 {
588 	struct thermal_zone_device **r = res;
589 
590 	if (WARN_ON(!r || !*r))
591 		return 0;
592 
593 	return *r == data;
594 }
595 
596 /**
597  * devm_thermal_zone_of_sensor_register - Resource managed version of
598  *				thermal_zone_of_sensor_register()
599  * @dev: a valid struct device pointer of a sensor device. Must contain
600  *       a valid .of_node, for the sensor node.
601  * @sensor_id: a sensor identifier, in case the sensor IP has more
602  *	       than one sensors
603  * @data: a private pointer (owned by the caller) that will be passed
604  *	  back, when a temperature reading is needed.
605  * @ops: struct thermal_zone_of_device_ops *. Must contain at least .get_temp.
606  *
607  * Refer thermal_zone_of_sensor_register() for more details.
608  *
609  * Return: On success returns a valid struct thermal_zone_device,
610  * otherwise, it returns a corresponding ERR_PTR(). Caller must
611  * check the return value with help of IS_ERR() helper.
612  * Registered thermal_zone_device device will automatically be
613  * released when device is unbounded.
614  */
615 struct thermal_zone_device *devm_thermal_zone_of_sensor_register(
616 	struct device *dev, int sensor_id,
617 	void *data, const struct thermal_zone_of_device_ops *ops)
618 {
619 	struct thermal_zone_device **ptr, *tzd;
620 
621 	ptr = devres_alloc(devm_thermal_zone_of_sensor_release, sizeof(*ptr),
622 			   GFP_KERNEL);
623 	if (!ptr)
624 		return ERR_PTR(-ENOMEM);
625 
626 	tzd = thermal_zone_of_sensor_register(dev, sensor_id, data, ops);
627 	if (IS_ERR(tzd)) {
628 		devres_free(ptr);
629 		return tzd;
630 	}
631 
632 	*ptr = tzd;
633 	devres_add(dev, ptr);
634 
635 	return tzd;
636 }
637 EXPORT_SYMBOL_GPL(devm_thermal_zone_of_sensor_register);
638 
639 /**
640  * devm_thermal_zone_of_sensor_unregister - Resource managed version of
641  *				thermal_zone_of_sensor_unregister().
642  * @dev: Device for which which resource was allocated.
643  * @tzd: a pointer to struct thermal_zone_device where the sensor is registered.
644  *
645  * This function removes the sensor callbacks and private data from the
646  * thermal zone device registered with devm_thermal_zone_of_sensor_register()
647  * API. It will also silent the zone by remove the .get_temp() and .get_trend()
648  * thermal zone device callbacks.
649  * Normally this function will not need to be called and the resource
650  * management code will ensure that the resource is freed.
651  */
652 void devm_thermal_zone_of_sensor_unregister(struct device *dev,
653 					    struct thermal_zone_device *tzd)
654 {
655 	WARN_ON(devres_release(dev, devm_thermal_zone_of_sensor_release,
656 			       devm_thermal_zone_of_sensor_match, tzd));
657 }
658 EXPORT_SYMBOL_GPL(devm_thermal_zone_of_sensor_unregister);
659 
660 /***   functions parsing device tree nodes   ***/
661 
662 /**
663  * thermal_of_populate_bind_params - parse and fill cooling map data
664  * @np: DT node containing a cooling-map node
665  * @__tbp: data structure to be filled with cooling map info
666  * @trips: array of thermal zone trip points
667  * @ntrips: number of trip points inside trips.
668  *
669  * This function parses a cooling-map type of node represented by
670  * @np parameter and fills the read data into @__tbp data structure.
671  * It needs the already parsed array of trip points of the thermal zone
672  * in consideration.
673  *
674  * Return: 0 on success, proper error code otherwise
675  */
676 static int thermal_of_populate_bind_params(struct device_node *np,
677 					   struct __thermal_bind_params *__tbp,
678 					   struct thermal_trip *trips,
679 					   int ntrips)
680 {
681 	struct of_phandle_args cooling_spec;
682 	struct __thermal_cooling_bind_param *__tcbp;
683 	struct device_node *trip;
684 	int ret, i, count;
685 	u32 prop;
686 
687 	/* Default weight. Usage is optional */
688 	__tbp->usage = THERMAL_WEIGHT_DEFAULT;
689 	ret = of_property_read_u32(np, "contribution", &prop);
690 	if (ret == 0)
691 		__tbp->usage = prop;
692 
693 	trip = of_parse_phandle(np, "trip", 0);
694 	if (!trip) {
695 		pr_err("missing trip property\n");
696 		return -ENODEV;
697 	}
698 
699 	/* match using device_node */
700 	for (i = 0; i < ntrips; i++)
701 		if (trip == trips[i].np) {
702 			__tbp->trip_id = i;
703 			break;
704 		}
705 
706 	if (i == ntrips) {
707 		ret = -ENODEV;
708 		goto end;
709 	}
710 
711 	count = of_count_phandle_with_args(np, "cooling-device",
712 					   "#cooling-cells");
713 	if (count <= 0) {
714 		pr_err("Add a cooling_device property with at least one device\n");
715 		ret = -ENOENT;
716 		goto end;
717 	}
718 
719 	__tcbp = kcalloc(count, sizeof(*__tcbp), GFP_KERNEL);
720 	if (!__tcbp) {
721 		ret = -ENOMEM;
722 		goto end;
723 	}
724 
725 	for (i = 0; i < count; i++) {
726 		ret = of_parse_phandle_with_args(np, "cooling-device",
727 				"#cooling-cells", i, &cooling_spec);
728 		if (ret < 0) {
729 			pr_err("Invalid cooling-device entry\n");
730 			goto free_tcbp;
731 		}
732 
733 		__tcbp[i].cooling_device = cooling_spec.np;
734 
735 		if (cooling_spec.args_count >= 2) { /* at least min and max */
736 			__tcbp[i].min = cooling_spec.args[0];
737 			__tcbp[i].max = cooling_spec.args[1];
738 		} else {
739 			pr_err("wrong reference to cooling device, missing limits\n");
740 		}
741 	}
742 
743 	__tbp->tcbp = __tcbp;
744 	__tbp->count = count;
745 
746 	goto end;
747 
748 free_tcbp:
749 	for (i = i - 1; i >= 0; i--)
750 		of_node_put(__tcbp[i].cooling_device);
751 	kfree(__tcbp);
752 end:
753 	of_node_put(trip);
754 
755 	return ret;
756 }
757 
758 /*
759  * It maps 'enum thermal_trip_type' found in include/linux/thermal.h
760  * into the device tree binding of 'trip', property type.
761  */
762 static const char * const trip_types[] = {
763 	[THERMAL_TRIP_ACTIVE]	= "active",
764 	[THERMAL_TRIP_PASSIVE]	= "passive",
765 	[THERMAL_TRIP_HOT]	= "hot",
766 	[THERMAL_TRIP_CRITICAL]	= "critical",
767 };
768 
769 /**
770  * thermal_of_get_trip_type - Get phy mode for given device_node
771  * @np:	Pointer to the given device_node
772  * @type: Pointer to resulting trip type
773  *
774  * The function gets trip type string from property 'type',
775  * and store its index in trip_types table in @type,
776  *
777  * Return: 0 on success, or errno in error case.
778  */
779 static int thermal_of_get_trip_type(struct device_node *np,
780 				    enum thermal_trip_type *type)
781 {
782 	const char *t;
783 	int err, i;
784 
785 	err = of_property_read_string(np, "type", &t);
786 	if (err < 0)
787 		return err;
788 
789 	for (i = 0; i < ARRAY_SIZE(trip_types); i++)
790 		if (!strcasecmp(t, trip_types[i])) {
791 			*type = i;
792 			return 0;
793 		}
794 
795 	return -ENODEV;
796 }
797 
798 /**
799  * thermal_of_populate_trip - parse and fill one trip point data
800  * @np: DT node containing a trip point node
801  * @trip: trip point data structure to be filled up
802  *
803  * This function parses a trip point type of node represented by
804  * @np parameter and fills the read data into @trip data structure.
805  *
806  * Return: 0 on success, proper error code otherwise
807  */
808 static int thermal_of_populate_trip(struct device_node *np,
809 				    struct thermal_trip *trip)
810 {
811 	int prop;
812 	int ret;
813 
814 	ret = of_property_read_u32(np, "temperature", &prop);
815 	if (ret < 0) {
816 		pr_err("missing temperature property\n");
817 		return ret;
818 	}
819 	trip->temperature = prop;
820 
821 	ret = of_property_read_u32(np, "hysteresis", &prop);
822 	if (ret < 0) {
823 		pr_err("missing hysteresis property\n");
824 		return ret;
825 	}
826 	trip->hysteresis = prop;
827 
828 	ret = thermal_of_get_trip_type(np, &trip->type);
829 	if (ret < 0) {
830 		pr_err("wrong trip type property\n");
831 		return ret;
832 	}
833 
834 	/* Required for cooling map matching */
835 	trip->np = np;
836 	of_node_get(np);
837 
838 	return 0;
839 }
840 
841 /**
842  * thermal_of_build_thermal_zone - parse and fill one thermal zone data
843  * @np: DT node containing a thermal zone node
844  *
845  * This function parses a thermal zone type of node represented by
846  * @np parameter and fills the read data into a __thermal_zone data structure
847  * and return this pointer.
848  *
849  * TODO: Missing properties to parse: thermal-sensor-names
850  *
851  * Return: On success returns a valid struct __thermal_zone,
852  * otherwise, it returns a corresponding ERR_PTR(). Caller must
853  * check the return value with help of IS_ERR() helper.
854  */
855 static struct __thermal_zone
856 __init *thermal_of_build_thermal_zone(struct device_node *np)
857 {
858 	struct device_node *child = NULL, *gchild;
859 	struct __thermal_zone *tz;
860 	int ret, i;
861 	u32 prop, coef[2];
862 
863 	if (!np) {
864 		pr_err("no thermal zone np\n");
865 		return ERR_PTR(-EINVAL);
866 	}
867 
868 	tz = kzalloc(sizeof(*tz), GFP_KERNEL);
869 	if (!tz)
870 		return ERR_PTR(-ENOMEM);
871 
872 	ret = of_property_read_u32(np, "polling-delay-passive", &prop);
873 	if (ret < 0) {
874 		pr_err("%pOFn: missing polling-delay-passive property\n", np);
875 		goto free_tz;
876 	}
877 	tz->passive_delay = prop;
878 
879 	ret = of_property_read_u32(np, "polling-delay", &prop);
880 	if (ret < 0) {
881 		pr_err("%pOFn: missing polling-delay property\n", np);
882 		goto free_tz;
883 	}
884 	tz->polling_delay = prop;
885 
886 	/*
887 	 * REVIST: for now, the thermal framework supports only
888 	 * one sensor per thermal zone. Thus, we are considering
889 	 * only the first two values as slope and offset.
890 	 */
891 	ret = of_property_read_u32_array(np, "coefficients", coef, 2);
892 	if (ret == 0) {
893 		tz->slope = coef[0];
894 		tz->offset = coef[1];
895 	} else {
896 		tz->slope = 1;
897 		tz->offset = 0;
898 	}
899 
900 	/* trips */
901 	child = of_get_child_by_name(np, "trips");
902 
903 	/* No trips provided */
904 	if (!child)
905 		goto finish;
906 
907 	tz->ntrips = of_get_child_count(child);
908 	if (tz->ntrips == 0) /* must have at least one child */
909 		goto finish;
910 
911 	tz->trips = kcalloc(tz->ntrips, sizeof(*tz->trips), GFP_KERNEL);
912 	if (!tz->trips) {
913 		ret = -ENOMEM;
914 		goto free_tz;
915 	}
916 
917 	i = 0;
918 	for_each_child_of_node(child, gchild) {
919 		ret = thermal_of_populate_trip(gchild, &tz->trips[i++]);
920 		if (ret)
921 			goto free_trips;
922 	}
923 
924 	of_node_put(child);
925 
926 	/* cooling-maps */
927 	child = of_get_child_by_name(np, "cooling-maps");
928 
929 	/* cooling-maps not provided */
930 	if (!child)
931 		goto finish;
932 
933 	tz->num_tbps = of_get_child_count(child);
934 	if (tz->num_tbps == 0)
935 		goto finish;
936 
937 	tz->tbps = kcalloc(tz->num_tbps, sizeof(*tz->tbps), GFP_KERNEL);
938 	if (!tz->tbps) {
939 		ret = -ENOMEM;
940 		goto free_trips;
941 	}
942 
943 	i = 0;
944 	for_each_child_of_node(child, gchild) {
945 		ret = thermal_of_populate_bind_params(gchild, &tz->tbps[i++],
946 						      tz->trips, tz->ntrips);
947 		if (ret)
948 			goto free_tbps;
949 	}
950 
951 finish:
952 	of_node_put(child);
953 
954 	return tz;
955 
956 free_tbps:
957 	for (i = i - 1; i >= 0; i--) {
958 		struct __thermal_bind_params *tbp = tz->tbps + i;
959 		int j;
960 
961 		for (j = 0; j < tbp->count; j++)
962 			of_node_put(tbp->tcbp[j].cooling_device);
963 
964 		kfree(tbp->tcbp);
965 	}
966 
967 	kfree(tz->tbps);
968 free_trips:
969 	for (i = 0; i < tz->ntrips; i++)
970 		of_node_put(tz->trips[i].np);
971 	kfree(tz->trips);
972 	of_node_put(gchild);
973 free_tz:
974 	kfree(tz);
975 	of_node_put(child);
976 
977 	return ERR_PTR(ret);
978 }
979 
980 static __init void of_thermal_free_zone(struct __thermal_zone *tz)
981 {
982 	struct __thermal_bind_params *tbp;
983 	int i, j;
984 
985 	for (i = 0; i < tz->num_tbps; i++) {
986 		tbp = tz->tbps + i;
987 
988 		for (j = 0; j < tbp->count; j++)
989 			of_node_put(tbp->tcbp[j].cooling_device);
990 
991 		kfree(tbp->tcbp);
992 	}
993 
994 	kfree(tz->tbps);
995 	for (i = 0; i < tz->ntrips; i++)
996 		of_node_put(tz->trips[i].np);
997 	kfree(tz->trips);
998 	kfree(tz);
999 }
1000 
1001 /**
1002  * of_thermal_destroy_zones - remove all zones parsed and allocated resources
1003  *
1004  * Finds all zones parsed and added to the thermal framework and remove them
1005  * from the system, together with their resources.
1006  *
1007  */
1008 static __init void of_thermal_destroy_zones(void)
1009 {
1010 	struct device_node *np, *child;
1011 
1012 	np = of_find_node_by_name(NULL, "thermal-zones");
1013 	if (!np) {
1014 		pr_debug("unable to find thermal zones\n");
1015 		return;
1016 	}
1017 
1018 	for_each_available_child_of_node(np, child) {
1019 		struct thermal_zone_device *zone;
1020 
1021 		zone = thermal_zone_get_zone_by_name(child->name);
1022 		if (IS_ERR(zone))
1023 			continue;
1024 
1025 		thermal_zone_device_unregister(zone);
1026 		kfree(zone->tzp);
1027 		kfree(zone->ops);
1028 		of_thermal_free_zone(zone->devdata);
1029 	}
1030 	of_node_put(np);
1031 }
1032 
1033 /**
1034  * of_parse_thermal_zones - parse device tree thermal data
1035  *
1036  * Initialization function that can be called by machine initialization
1037  * code to parse thermal data and populate the thermal framework
1038  * with hardware thermal zones info. This function only parses thermal zones.
1039  * Cooling devices and sensor devices nodes are supposed to be parsed
1040  * by their respective drivers.
1041  *
1042  * Return: 0 on success, proper error code otherwise
1043  *
1044  */
1045 int __init of_parse_thermal_zones(void)
1046 {
1047 	struct device_node *np, *child;
1048 	struct __thermal_zone *tz;
1049 	struct thermal_zone_device_ops *ops;
1050 
1051 	np = of_find_node_by_name(NULL, "thermal-zones");
1052 	if (!np) {
1053 		pr_debug("unable to find thermal zones\n");
1054 		return 0; /* Run successfully on systems without thermal DT */
1055 	}
1056 
1057 	for_each_available_child_of_node(np, child) {
1058 		struct thermal_zone_device *zone;
1059 		struct thermal_zone_params *tzp;
1060 		int i, mask = 0;
1061 		u32 prop;
1062 
1063 		tz = thermal_of_build_thermal_zone(child);
1064 		if (IS_ERR(tz)) {
1065 			pr_err("failed to build thermal zone %pOFn: %ld\n",
1066 			       child,
1067 			       PTR_ERR(tz));
1068 			continue;
1069 		}
1070 
1071 		ops = kmemdup(&of_thermal_ops, sizeof(*ops), GFP_KERNEL);
1072 		if (!ops)
1073 			goto exit_free;
1074 
1075 		tzp = kzalloc(sizeof(*tzp), GFP_KERNEL);
1076 		if (!tzp) {
1077 			kfree(ops);
1078 			goto exit_free;
1079 		}
1080 
1081 		/* No hwmon because there might be hwmon drivers registering */
1082 		tzp->no_hwmon = true;
1083 
1084 		if (!of_property_read_u32(child, "sustainable-power", &prop))
1085 			tzp->sustainable_power = prop;
1086 
1087 		for (i = 0; i < tz->ntrips; i++)
1088 			mask |= 1 << i;
1089 
1090 		/* these two are left for temperature drivers to use */
1091 		tzp->slope = tz->slope;
1092 		tzp->offset = tz->offset;
1093 
1094 		zone = thermal_zone_device_register(child->name, tz->ntrips,
1095 						    mask, tz,
1096 						    ops, tzp,
1097 						    tz->passive_delay,
1098 						    tz->polling_delay);
1099 		if (IS_ERR(zone)) {
1100 			pr_err("Failed to build %pOFn zone %ld\n", child,
1101 			       PTR_ERR(zone));
1102 			kfree(tzp);
1103 			kfree(ops);
1104 			of_thermal_free_zone(tz);
1105 			/* attempting to build remaining zones still */
1106 		}
1107 	}
1108 	of_node_put(np);
1109 
1110 	return 0;
1111 
1112 exit_free:
1113 	of_node_put(child);
1114 	of_node_put(np);
1115 	of_thermal_free_zone(tz);
1116 
1117 	/* no memory available, so free what we have built */
1118 	of_thermal_destroy_zones();
1119 
1120 	return -ENOMEM;
1121 }
1122