2  * Hisilicon thermal sensor driver
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
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()
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()
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()
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()
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()
350 	/* select sensor id */  in hi6220_thermal_enable_sensor()
351 	hi6220_thermal_sensor_select(data->regs, sensor->id);  in hi6220_thermal_enable_sensor()
360 	hi6220_thermal_alarm_set(data->regs, sensor->thres_temp);  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()
410 	data->sensor = devm_kzalloc(dev, sizeof(*data->sensor), GFP_KERNEL);  in hi6220_thermal_probe()
411 	if (!data->sensor)  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()
429 	data->sensor = devm_kzalloc(dev, sizeof(*data->sensor) *  in hi3660_thermal_probe()
431 	if (!data->sensor)  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()
443 	struct hisi_thermal_sensor *sensor = __data;  in hisi_thermal_get_temp()  local
444 	struct hisi_thermal_data *data = sensor->data;  in hisi_thermal_get_temp()
446 	*temp = data->ops->get_temp(sensor);  in hisi_thermal_get_temp()
449 		sensor->tzd, sensor->id, *temp, sensor->thres_temp);  in hisi_thermal_get_temp()
460 	struct hisi_thermal_sensor *sensor = dev;  in hisi_thermal_alarm_irq_thread()  local
461 	struct hisi_thermal_data *data = sensor->data;  in hisi_thermal_alarm_irq_thread()
464 	data->ops->irq_handler(sensor);  in hisi_thermal_alarm_irq_thread()
466 	hisi_thermal_get_temp(sensor, &temp);  in hisi_thermal_alarm_irq_thread()
468 	if (temp >= sensor->thres_temp) {  in hisi_thermal_alarm_irq_thread()
470 			 "sensor <%d> THERMAL ALARM: %d > %d\n",  in hisi_thermal_alarm_irq_thread()
471 			 sensor->id, temp, sensor->thres_temp);  in hisi_thermal_alarm_irq_thread()
473 		thermal_zone_device_update(sensor->tzd,  in hisi_thermal_alarm_irq_thread()
478 			 "sensor <%d> THERMAL ALARM stopped: %d < %d\n",  in hisi_thermal_alarm_irq_thread()
479 			 sensor->id, temp, sensor->thres_temp);  in hisi_thermal_alarm_irq_thread()
486 					struct hisi_thermal_sensor *sensor)  in hisi_thermal_register_sensor()  argument
491 	sensor->tzd = devm_thermal_zone_of_sensor_register(&pdev->dev,  in hisi_thermal_register_sensor()
492 							   sensor->id, sensor,  in hisi_thermal_register_sensor()
494 	if (IS_ERR(sensor->tzd)) {  in hisi_thermal_register_sensor()
495 		ret = PTR_ERR(sensor->tzd);  in hisi_thermal_register_sensor()
496 		sensor->tzd = NULL;  in hisi_thermal_register_sensor()
497 		dev_err(&pdev->dev, "failed to register sensor id %d: %d\n",  in hisi_thermal_register_sensor()
498 			sensor->id, ret);  in hisi_thermal_register_sensor()
502 	trip = of_thermal_get_trip_points(sensor->tzd);  in hisi_thermal_register_sensor()
504 	for (i = 0; i < of_thermal_get_ntrips(sensor->tzd); i++) {  in hisi_thermal_register_sensor()
506 			sensor->thres_temp = trip[i].temperature;  in hisi_thermal_register_sensor()
543 static void hisi_thermal_toggle_sensor(struct hisi_thermal_sensor *sensor,  in hisi_thermal_toggle_sensor()  argument
546 	struct thermal_zone_device *tzd = sensor->tzd;  in hisi_thermal_toggle_sensor()
581 		struct hisi_thermal_sensor *sensor = &data->sensor[i];  in hisi_thermal_probe()  local
583 		ret = hisi_thermal_register_sensor(pdev, sensor);  in hisi_thermal_probe()
585 			dev_err(dev, "failed to register thermal sensor: %d\n",  in hisi_thermal_probe()
596 						IRQF_ONESHOT, sensor->irq_name,  in hisi_thermal_probe()
597 						sensor);  in hisi_thermal_probe()
603 		ret = data->ops->enable_sensor(sensor);  in hisi_thermal_probe()
605 			dev_err(dev, "Failed to setup the sensor: %d\n", ret);  in hisi_thermal_probe()
609 		hisi_thermal_toggle_sensor(sensor, true);  in hisi_thermal_probe()
621 		struct hisi_thermal_sensor *sensor = &data->sensor[i];  in hisi_thermal_remove()  local
623 		hisi_thermal_toggle_sensor(sensor, false);  in hisi_thermal_remove()
624 		data->ops->disable_sensor(sensor);  in hisi_thermal_remove()
637 		data->ops->disable_sensor(&data->sensor[i]);  in hisi_thermal_suspend()
648 		ret |= data->ops->enable_sensor(&data->sensor[i]);  in hisi_thermal_resume()