Lines Matching +full:temp +full:- +full:sensor
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
97 * Temperature base: -60°C
100 * millidegree and begins at -60 000 m°C
104 * Temp = TempBase + (steps x 785)
108 * steps = (Temp - TempBase) / 785
116 static inline int hi6220_thermal_temp_to_step(int temp) in hi6220_thermal_temp_to_step() argument
118 return DIV_ROUND_UP(temp - HI6220_TEMP_BASE, HI6220_TEMP_STEP); in hi6220_thermal_temp_to_step()
124 * Temperature base: -63.780°C
127 * millidegree and begins at -63 780 m°C
134 static inline int hi3660_thermal_temp_to_step(int temp) in hi3660_thermal_temp_to_step() argument
136 return DIV_ROUND_UP(temp - HI3660_TEMP_BASE, HI3660_TEMP_STEP); in hi3660_thermal_temp_to_step()
154 * temperature decrease to 65°C - 5°C another interrupt is raised.
186 static inline void hi6220_thermal_alarm_set(void __iomem *addr, int temp) in hi6220_thermal_alarm_set() argument
188 writel(hi6220_thermal_temp_to_step(temp) | 0x0FFFFFF00, in hi6220_thermal_alarm_set()
192 static inline void hi6220_thermal_reset_set(void __iomem *addr, int temp) in hi6220_thermal_reset_set() argument
194 writel(hi6220_thermal_temp_to_step(temp), addr + HI6220_TEMP0_RST_TH); in hi6220_thermal_reset_set()
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()
356 /* setting lag value between current temp and the threshold */ 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()
382 /* setting lag value between current temp and the threshold */ 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()
441 static int hisi_thermal_get_temp(void *__data, int *temp) in hisi_thermal_get_temp() argument
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()
448 dev_dbg(&data->pdev->dev, "tzd=%p, id=%d, temp=%d, thres=%d\n", 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()
462 int temp = 0; in hisi_thermal_alarm_irq_thread() local
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()
469 dev_crit(&data->pdev->dev, 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()
477 dev_crit(&data->pdev->dev, 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()
536 .compatible = "hisilicon,hi3660-tsensor",
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()
557 struct device *dev = &pdev->dev; in hisi_thermal_probe()
563 return -ENOMEM; in hisi_thermal_probe()
565 data->pdev = pdev; in hisi_thermal_probe()
567 data->ops = of_device_get_match_data(dev); in hisi_thermal_probe()
570 data->regs = devm_ioremap_resource(dev, res); in hisi_thermal_probe()
571 if (IS_ERR(data->regs)) { in hisi_thermal_probe()
573 return PTR_ERR(data->regs); in hisi_thermal_probe()
576 ret = data->ops->probe(data); in hisi_thermal_probe()
580 for (i = 0; i < data->nr_sensors; i++) { in hisi_thermal_probe()
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()
620 for (i = 0; i < data->nr_sensors; i++) { in hisi_thermal_remove()
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()
636 for (i = 0; i < data->nr_sensors; i++) in hisi_thermal_suspend()
637 data->ops->disable_sensor(&data->sensor[i]); in hisi_thermal_suspend()
647 for (i = 0; i < data->nr_sensors; i++) in hisi_thermal_resume()
648 ret |= data->ops->enable_sensor(&data->sensor[i]); in hisi_thermal_resume()