2  * HiSilicon thermal sensor driver
4  * Copyright (c) 2014-2015 HiSilicon Limited.
5  * Copyright (c) 2014-2015 Linaro Limited.
49 #define HI6220_TEMP_BASE			(-60000)
54 #define HI3660_TEMP_BASE		(-63780)
77 	int (*get_temp)(struct hisi_thermal_sensor *sensor);
78 	int (*enable_sensor)(struct hisi_thermal_sensor *sensor);
79 	int (*disable_sensor)(struct hisi_thermal_sensor *sensor);
80 	int (*irq_handler)(struct hisi_thermal_sensor *sensor);
86 	struct hisi_thermal_sensor *sensor;  member
94  * The temperature computation on the tsensor is as follow:
97  *	Temperature base: -60°C
99  * The register is programmed in temperature steps, every step is 785
100  * millidegree and begins at -60 000 m°C
102  * The temperature from the steps:
106  * and the steps from the temperature:
108  *	steps = (Temp - TempBase) / 785
118 	return DIV_ROUND_UP(temp - HI6220_TEMP_BASE, HI6220_TEMP_STEP);  in hi6220_thermal_temp_to_step()
124  *	Temperature base: -63.780°C
126  * The register is programmed in temperature steps, every step is 205
127  * millidegree and begins at -63 780 m°C
136 	return DIV_ROUND_UP(temp - HI3660_TEMP_BASE, HI3660_TEMP_STEP);  in hi3660_thermal_temp_to_step()
140  * The lag register contains 5 bits encoding the temperature in steps.
142  * Each time the temperature crosses the threshold boundary, an
143  * interrupt is raised. It could be when the temperature is going
144  * above the threshold or below. However, if the temperature is
148  * We can setup a temperature representing the delta between the
149  * threshold and the current temperature when the temperature is
153  * the temperature reaches 65°C an interrupt is raised and when the
154  * temperature decrease to 65°C - 5°C another interrupt is raised.
157  * increase the latency to react to the temperature changes.  In our
159  * temperature.
163  * The temperature is coded in steps, cf. HI6220_TEMP_STEP.
215  * The temperature is coded in steps, cf. HI3660_TEMP_STEP.
252  * Temperature configuration register - Sensor selection
256  * 0x0: local sensor (default)
257  * 0x1: remote sensor 1 (ACPU cluster 1)
258  * 0x2: remote sensor 2 (ACPU cluster 0)
259  * 0x3: remote sensor 3 (G3D)
261 static inline void hi6220_thermal_sensor_select(void __iomem *addr, int sensor)  in hi6220_thermal_sensor_select()  argument
264 	       (sensor << 12), addr + HI6220_TEMP0_CFG);  in hi6220_thermal_sensor_select()
268  * Temperature configuration register - Hdak conversion polling interval
283 static int hi6220_thermal_irq_handler(struct hisi_thermal_sensor *sensor)  in hi6220_thermal_irq_handler()  argument
285 	struct hisi_thermal_data *data = sensor->data;  in hi6220_thermal_irq_handler()
287 	hi6220_thermal_alarm_clear(data->regs, 1);  in hi6220_thermal_irq_handler()
291 static int hi3660_thermal_irq_handler(struct hisi_thermal_sensor *sensor)  in hi3660_thermal_irq_handler()  argument
293 	struct hisi_thermal_data *data = sensor->data;  in hi3660_thermal_irq_handler()
295 	hi3660_thermal_alarm_clear(data->regs, sensor->id, 1);  in hi3660_thermal_irq_handler()
299 static int hi6220_thermal_get_temp(struct hisi_thermal_sensor *sensor)  in hi6220_thermal_get_temp()  argument
301 	struct hisi_thermal_data *data = sensor->data;  in hi6220_thermal_get_temp()
303 	return hi6220_thermal_get_temperature(data->regs);  in hi6220_thermal_get_temp()
306 static int hi3660_thermal_get_temp(struct hisi_thermal_sensor *sensor)  in hi3660_thermal_get_temp()  argument
308 	struct hisi_thermal_data *data = sensor->data;  in hi3660_thermal_get_temp()
310 	return hi3660_thermal_get_temperature(data->regs, sensor->id);  in hi3660_thermal_get_temp()
313 static int hi6220_thermal_disable_sensor(struct hisi_thermal_sensor *sensor)  in hi6220_thermal_disable_sensor()  argument
315 	struct hisi_thermal_data *data = sensor->data;  in hi6220_thermal_disable_sensor()
317 	/* disable sensor module */  in hi6220_thermal_disable_sensor()
318 	hi6220_thermal_enable(data->regs, 0);  in hi6220_thermal_disable_sensor()
319 	hi6220_thermal_alarm_enable(data->regs, 0);  in hi6220_thermal_disable_sensor()
320 	hi6220_thermal_reset_enable(data->regs, 0);  in hi6220_thermal_disable_sensor()
322 	clk_disable_unprepare(data->clk);  in hi6220_thermal_disable_sensor()
327 static int hi3660_thermal_disable_sensor(struct hisi_thermal_sensor *sensor)  in hi3660_thermal_disable_sensor()  argument
329 	struct hisi_thermal_data *data = sensor->data;  in hi3660_thermal_disable_sensor()
331 	/* disable sensor module */  in hi3660_thermal_disable_sensor()
332 	hi3660_thermal_alarm_enable(data->regs, sensor->id, 0);  in hi3660_thermal_disable_sensor()
336 static int hi6220_thermal_enable_sensor(struct hisi_thermal_sensor *sensor)  in hi6220_thermal_enable_sensor()  argument
338 	struct hisi_thermal_data *data = sensor->data;  in hi6220_thermal_enable_sensor()
342 	ret = clk_prepare_enable(data->clk);  in hi6220_thermal_enable_sensor()
347 	hi6220_thermal_reset_enable(data->regs, 0);  in hi6220_thermal_enable_sensor()
348 	hi6220_thermal_enable(data->regs, 0);  in hi6220_thermal_enable_sensor()
350 	/* select sensor id */  in hi6220_thermal_enable_sensor()
351 	hi6220_thermal_sensor_select(data->regs, sensor->id);  in hi6220_thermal_enable_sensor()
354 	hi6220_thermal_hdak_set(data->regs, 0);  in hi6220_thermal_enable_sensor()
357 	hi6220_thermal_set_lag(data->regs, HI6220_TEMP_LAG);  in hi6220_thermal_enable_sensor()
360 	hi6220_thermal_alarm_set(data->regs, sensor->thres_temp);  in hi6220_thermal_enable_sensor()
362 	hi6220_thermal_reset_set(data->regs, HI6220_TEMP_RESET);  in hi6220_thermal_enable_sensor()
365 	hi6220_thermal_reset_enable(data->regs, 1);  in hi6220_thermal_enable_sensor()
366 	hi6220_thermal_enable(data->regs, 1);  in hi6220_thermal_enable_sensor()
368 	hi6220_thermal_alarm_clear(data->regs, 0);  in hi6220_thermal_enable_sensor()
369 	hi6220_thermal_alarm_enable(data->regs, 1);  in hi6220_thermal_enable_sensor()
374 static int hi3660_thermal_enable_sensor(struct hisi_thermal_sensor *sensor)  in hi3660_thermal_enable_sensor()  argument
377 	struct hisi_thermal_data *data = sensor->data;  in hi3660_thermal_enable_sensor()
380 	hi3660_thermal_alarm_enable(data->regs, sensor->id, 0);  in hi3660_thermal_enable_sensor()
383 	hi3660_thermal_set_lag(data->regs, sensor->id, HI3660_TEMP_LAG);  in hi3660_thermal_enable_sensor()
386 	value = hi3660_thermal_temp_to_step(sensor->thres_temp);  in hi3660_thermal_enable_sensor()
387 	hi3660_thermal_alarm_set(data->regs, sensor->id, value);  in hi3660_thermal_enable_sensor()
390 	hi3660_thermal_alarm_clear(data->regs, sensor->id, 1);  in hi3660_thermal_enable_sensor()
391 	hi3660_thermal_alarm_enable(data->regs, sensor->id, 1);  in hi3660_thermal_enable_sensor()
398 	struct platform_device *pdev = data->pdev;  in hi6220_thermal_probe()
399 	struct device *dev = &pdev->dev;  in hi6220_thermal_probe()
402 	data->clk = devm_clk_get(dev, "thermal_clk");  in hi6220_thermal_probe()
403 	if (IS_ERR(data->clk)) {  in hi6220_thermal_probe()
404 		ret = PTR_ERR(data->clk);  in hi6220_thermal_probe()
405 		if (ret != -EPROBE_DEFER)  in hi6220_thermal_probe()
410 	data->sensor = devm_kzalloc(dev, sizeof(*data->sensor), GFP_KERNEL);  in hi6220_thermal_probe()
411 	if (!data->sensor)  in hi6220_thermal_probe()
412 		return -ENOMEM;  in hi6220_thermal_probe()
414 	data->sensor[0].id = HI6220_CLUSTER0_SENSOR;  in hi6220_thermal_probe()
415 	data->sensor[0].irq_name = "tsensor_intr";  in hi6220_thermal_probe()
416 	data->sensor[0].data = data;  in hi6220_thermal_probe()
417 	data->nr_sensors = 1;  in hi6220_thermal_probe()
424 	struct platform_device *pdev = data->pdev;  in hi3660_thermal_probe()
425 	struct device *dev = &pdev->dev;  in hi3660_thermal_probe()
427 	data->nr_sensors = 1;  in hi3660_thermal_probe()
429 	data->sensor = devm_kzalloc(dev, sizeof(*data->sensor) *  in hi3660_thermal_probe()
430 				    data->nr_sensors, GFP_KERNEL);  in hi3660_thermal_probe()
431 	if (!data->sensor)  in hi3660_thermal_probe()
432 		return -ENOMEM;  in hi3660_thermal_probe()
434 	data->sensor[0].id = HI3660_BIG_SENSOR;  in hi3660_thermal_probe()
435 	data->sensor[0].irq_name = "tsensor_a73";  in hi3660_thermal_probe()
436 	data->sensor[0].data = data;  in hi3660_thermal_probe()
438 	data->sensor[1].id = HI3660_LITTLE_SENSOR;  in hi3660_thermal_probe()
439 	data->sensor[1].irq_name = "tsensor_a53";  in hi3660_thermal_probe()
440 	data->sensor[1].data = data;  in hi3660_thermal_probe()
447 	struct hisi_thermal_sensor *sensor = __data;  in hisi_thermal_get_temp()  local
448 	struct hisi_thermal_data *data = sensor->data;  in hisi_thermal_get_temp()
450 	*temp = data->ops->get_temp(sensor);  in hisi_thermal_get_temp()
452 	dev_dbg(&data->pdev->dev, "tzd=%p, id=%d, temp=%d, thres=%d\n",  in hisi_thermal_get_temp()
453 		sensor->tzd, sensor->id, *temp, sensor->thres_temp);  in hisi_thermal_get_temp()
464 	struct hisi_thermal_sensor *sensor = dev;  in hisi_thermal_alarm_irq_thread()  local
465 	struct hisi_thermal_data *data = sensor->data;  in hisi_thermal_alarm_irq_thread()
468 	data->ops->irq_handler(sensor);  in hisi_thermal_alarm_irq_thread()
470 	hisi_thermal_get_temp(sensor, &temp);  in hisi_thermal_alarm_irq_thread()
472 	if (temp >= sensor->thres_temp) {  in hisi_thermal_alarm_irq_thread()
473 		dev_crit(&data->pdev->dev,  in hisi_thermal_alarm_irq_thread()
474 			 "sensor <%d> THERMAL ALARM: %d > %d\n",  in hisi_thermal_alarm_irq_thread()
475 			 sensor->id, temp, sensor->thres_temp);  in hisi_thermal_alarm_irq_thread()
477 		thermal_zone_device_update(sensor->tzd,  in hisi_thermal_alarm_irq_thread()
481 		dev_crit(&data->pdev->dev,  in hisi_thermal_alarm_irq_thread()
482 			 "sensor <%d> THERMAL ALARM stopped: %d < %d\n",  in hisi_thermal_alarm_irq_thread()
483 			 sensor->id, temp, sensor->thres_temp);  in hisi_thermal_alarm_irq_thread()
490 					struct hisi_thermal_sensor *sensor)  in hisi_thermal_register_sensor()  argument
495 	sensor->tzd = devm_thermal_zone_of_sensor_register(&pdev->dev,  in hisi_thermal_register_sensor()
496 							   sensor->id, sensor,  in hisi_thermal_register_sensor()
498 	if (IS_ERR(sensor->tzd)) {  in hisi_thermal_register_sensor()
499 		ret = PTR_ERR(sensor->tzd);  in hisi_thermal_register_sensor()
500 		sensor->tzd = NULL;  in hisi_thermal_register_sensor()
501 		dev_err(&pdev->dev, "failed to register sensor id %d: %d\n",  in hisi_thermal_register_sensor()
502 			sensor->id, ret);  in hisi_thermal_register_sensor()
506 	trip = of_thermal_get_trip_points(sensor->tzd);  in hisi_thermal_register_sensor()
508 	for (i = 0; i < of_thermal_get_ntrips(sensor->tzd); i++) {  in hisi_thermal_register_sensor()
510 			sensor->thres_temp = trip[i].temperature;  in hisi_thermal_register_sensor()
540 		.compatible = "hisilicon,hi3660-tsensor",
547 static void hisi_thermal_toggle_sensor(struct hisi_thermal_sensor *sensor,  in hisi_thermal_toggle_sensor()  argument
550 	struct thermal_zone_device *tzd = sensor->tzd;  in hisi_thermal_toggle_sensor()
561 	struct device *dev = &pdev->dev;  in hisi_thermal_probe()
567 		return -ENOMEM;  in hisi_thermal_probe()
569 	data->pdev = pdev;  in hisi_thermal_probe()
571 	data->ops = of_device_get_match_data(dev);  in hisi_thermal_probe()
574 	data->regs = devm_ioremap_resource(dev, res);  in hisi_thermal_probe()
575 	if (IS_ERR(data->regs))  in hisi_thermal_probe()
576 		return PTR_ERR(data->regs);  in hisi_thermal_probe()
578 	ret = data->ops->probe(data);  in hisi_thermal_probe()
582 	for (i = 0; i < data->nr_sensors; i++) {  in hisi_thermal_probe()
583 		struct hisi_thermal_sensor *sensor = &data->sensor[i];  in hisi_thermal_probe()  local
585 		ret = hisi_thermal_register_sensor(pdev, sensor);  in hisi_thermal_probe()
587 			dev_err(dev, "failed to register thermal sensor: %d\n",  in hisi_thermal_probe()
598 						IRQF_ONESHOT, sensor->irq_name,  in hisi_thermal_probe()
599 						sensor);  in hisi_thermal_probe()
605 		ret = data->ops->enable_sensor(sensor);  in hisi_thermal_probe()
607 			dev_err(dev, "Failed to setup the sensor: %d\n", ret);  in hisi_thermal_probe()
611 		hisi_thermal_toggle_sensor(sensor, true);  in hisi_thermal_probe()
622 	for (i = 0; i < data->nr_sensors; i++) {  in hisi_thermal_remove()
623 		struct hisi_thermal_sensor *sensor = &data->sensor[i];  in hisi_thermal_remove()  local
625 		hisi_thermal_toggle_sensor(sensor, false);  in hisi_thermal_remove()
626 		data->ops->disable_sensor(sensor);  in hisi_thermal_remove()
638 	for (i = 0; i < data->nr_sensors; i++)  in hisi_thermal_suspend()
639 		data->ops->disable_sensor(&data->sensor[i]);  in hisi_thermal_suspend()
649 	for (i = 0; i < data->nr_sensors; i++)  in hisi_thermal_resume()
650 		ret |= data->ops->enable_sensor(&data->sensor[i]);  in hisi_thermal_resume()