2 * Copyright (c) 2014, Fuzhou Rockchip Electronics Co., Ltd
4 * Copyright (c) 2015, Fuzhou Rockchip Electronics Co., Ltd
5 * Caesar Wang <wxt@rock-chips.com>
7 * This program is free software; you can redistribute it and/or modify it
8 * under the terms and conditions of the GNU General Public License,
9 * version 2, as published by the Free Software Foundation.
11 * This program is distributed in the hope it will be useful, but WITHOUT
12 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
13 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
17 #include <linux/clk.h>
18 #include <linux/delay.h>
19 #include <linux/interrupt.h>
21 #include <linux/module.h>
23 #include <linux/of_address.h>
24 #include <linux/of_irq.h>
25 #include <linux/platform_device.h>
26 #include <linux/reset.h>
27 #include <linux/thermal.h>
28 #include <linux/pinctrl/consumer.h>
31 * If the temperature over a period of time High,
32 * the resulting TSHUT gave CRU module,let it reset the entire chip,
33 * or via GPIO give PMIC.
41 * The system Temperature Sensors tshut(tshut) polarity
42 * the bit 8 is tshut polarity.
43 * 0: low active, 1: high active
51 * The system has two Temperature Sensors.
52 * sensor0 is for CPU, and sensor1 is for GPU.
60 * The conversion table has the adc value and temperature.
61 * ADC_DECREMENT: the adc value is of diminishing.(e.g. v2_code_table)
62 * ADC_INCREMENT: the adc value is incremental.(e.g. v3_code_table)
70 * The max sensors is two in rockchip SoCs.
71 * Two sensors: CPU and GPU sensor.
73 #define SOC_MAX_SENSORS 2
76 * struct chip_tsadc_table: hold information about chip-specific differences
77 * @id: conversion table
78 * @length: size of conversion table
79 * @data_mask: mask to apply on data inputs
80 * @mode: sort mode of this adc variant (incrementing or decrementing)
82 struct chip_tsadc_table
{
83 const struct tsadc_table
*id
;
86 enum adc_sort_mode mode
;
89 struct rockchip_tsadc_chip
{
90 /* The sensor id of chip correspond to the ADC channel */
91 int chn_id
[SOC_MAX_SENSORS
];
94 /* The hardware-controlled tshut property */
96 enum tshut_mode tshut_mode
;
97 enum tshut_polarity tshut_polarity
;
99 /* Chip-wide methods */
100 void (*initialize
)(void __iomem
*reg
, enum tshut_polarity p
);
101 void (*irq_ack
)(void __iomem
*reg
);
102 void (*control
)(void __iomem
*reg
, bool on
);
104 /* Per-sensor methods */
105 int (*get_temp
)(struct chip_tsadc_table table
,
106 int chn
, void __iomem
*reg
, int *temp
);
107 void (*set_tshut_temp
)(struct chip_tsadc_table table
,
108 int chn
, void __iomem
*reg
, int temp
);
109 void (*set_tshut_mode
)(int chn
, void __iomem
*reg
, enum tshut_mode m
);
111 /* Per-table methods */
112 struct chip_tsadc_table table
;
115 struct rockchip_thermal_sensor
{
116 struct rockchip_thermal_data
*thermal
;
117 struct thermal_zone_device
*tzd
;
121 struct rockchip_thermal_data
{
122 const struct rockchip_tsadc_chip
*chip
;
123 struct platform_device
*pdev
;
124 struct reset_control
*reset
;
126 struct rockchip_thermal_sensor sensors
[SOC_MAX_SENSORS
];
134 enum tshut_mode tshut_mode
;
135 enum tshut_polarity tshut_polarity
;
138 /* TSADC Sensor info define: */
139 #define TSADCV2_AUTO_CON 0x04
140 #define TSADCV2_INT_EN 0x08
141 #define TSADCV2_INT_PD 0x0c
142 #define TSADCV2_DATA(chn) (0x20 + (chn) * 0x04)
143 #define TSADCV2_COMP_SHUT(chn) (0x40 + (chn) * 0x04)
144 #define TSADCV2_HIGHT_INT_DEBOUNCE 0x60
145 #define TSADCV2_HIGHT_TSHUT_DEBOUNCE 0x64
146 #define TSADCV2_AUTO_PERIOD 0x68
147 #define TSADCV2_AUTO_PERIOD_HT 0x6c
149 #define TSADCV2_AUTO_EN BIT(0)
150 #define TSADCV2_AUTO_SRC_EN(chn) BIT(4 + (chn))
151 #define TSADCV2_AUTO_TSHUT_POLARITY_HIGH BIT(8)
153 #define TSADCV2_INT_SRC_EN(chn) BIT(chn)
154 #define TSADCV2_SHUT_2GPIO_SRC_EN(chn) BIT(4 + (chn))
155 #define TSADCV2_SHUT_2CRU_SRC_EN(chn) BIT(8 + (chn))
157 #define TSADCV1_INT_PD_CLEAR_MASK ~BIT(16)
158 #define TSADCV2_INT_PD_CLEAR_MASK ~BIT(8)
160 #define TSADCV2_DATA_MASK 0xfff
161 #define TSADCV3_DATA_MASK 0x3ff
163 #define TSADCV2_HIGHT_INT_DEBOUNCE_COUNT 4
164 #define TSADCV2_HIGHT_TSHUT_DEBOUNCE_COUNT 4
165 #define TSADCV2_AUTO_PERIOD_TIME 250 /* msec */
166 #define TSADCV2_AUTO_PERIOD_HT_TIME 50 /* msec */
175 * Code to Temperature mapping of the Temperature sensor is a piece wise linear
176 * curve.Any temperature, code faling between to 2 give temperatures can be
177 * linearly interpolated.
178 * Code to Temperature mapping should be updated based on sillcon results.
180 static const struct tsadc_table v1_code_table
[] = {
181 {TSADCV3_DATA_MASK
, -40000},
218 static const struct tsadc_table v2_code_table
[] = {
219 {TSADCV2_DATA_MASK
, -40000},
256 static const struct tsadc_table v3_code_table
[] = {
292 {TSADCV3_DATA_MASK
, 125000},
295 static const struct tsadc_table v4_code_table
[] = {
296 {TSADCV3_DATA_MASK
, -40000},
333 static u32
rk_tsadcv2_temp_to_code(struct chip_tsadc_table table
,
339 high
= table
.length
- 1;
340 mid
= (high
+ low
) / 2;
342 if (temp
< table
.id
[low
].temp
|| temp
> table
.id
[high
].temp
)
345 while (low
<= high
) {
346 if (temp
== table
.id
[mid
].temp
)
347 return table
.id
[mid
].code
;
348 else if (temp
< table
.id
[mid
].temp
)
352 mid
= (low
+ high
) / 2;
358 static int rk_tsadcv2_code_to_temp(struct chip_tsadc_table table
, u32 code
,
361 unsigned int low
= 1;
362 unsigned int high
= table
.length
- 1;
363 unsigned int mid
= (low
+ high
) / 2;
367 WARN_ON(table
.length
< 2);
369 switch (table
.mode
) {
371 code
&= table
.data_mask
;
372 if (code
< table
.id
[high
].code
)
373 return -EAGAIN
; /* Incorrect reading */
375 while (low
<= high
) {
376 if (code
>= table
.id
[mid
].code
&&
377 code
< table
.id
[mid
- 1].code
)
379 else if (code
< table
.id
[mid
].code
)
384 mid
= (low
+ high
) / 2;
388 code
&= table
.data_mask
;
389 if (code
< table
.id
[low
].code
)
390 return -EAGAIN
; /* Incorrect reading */
392 while (low
<= high
) {
393 if (code
>= table
.id
[mid
- 1].code
&&
394 code
< table
.id
[mid
].code
)
396 else if (code
> table
.id
[mid
].code
)
401 mid
= (low
+ high
) / 2;
405 pr_err("Invalid the conversion table\n");
409 * The 5C granularity provided by the table is too much. Let's
410 * assume that the relationship between sensor readings and
411 * temperature between 2 table entries is linear and interpolate
412 * to produce less granular result.
414 num
= table
.id
[mid
].temp
- v2_code_table
[mid
- 1].temp
;
415 num
*= abs(table
.id
[mid
- 1].code
- code
);
416 denom
= abs(table
.id
[mid
- 1].code
- table
.id
[mid
].code
);
417 *temp
= table
.id
[mid
- 1].temp
+ (num
/ denom
);
423 * rk_tsadcv2_initialize - initialize TASDC Controller.
425 * (1) Set TSADC_V2_AUTO_PERIOD:
426 * Configure the interleave between every two accessing of
427 * TSADC in normal operation.
429 * (2) Set TSADCV2_AUTO_PERIOD_HT:
430 * Configure the interleave between every two accessing of
431 * TSADC after the temperature is higher than COM_SHUT or COM_INT.
433 * (3) Set TSADCV2_HIGH_INT_DEBOUNCE and TSADC_HIGHT_TSHUT_DEBOUNCE:
434 * If the temperature is higher than COMP_INT or COMP_SHUT for
435 * "debounce" times, TSADC controller will generate interrupt or TSHUT.
437 static void rk_tsadcv2_initialize(void __iomem
*regs
,
438 enum tshut_polarity tshut_polarity
)
440 if (tshut_polarity
== TSHUT_HIGH_ACTIVE
)
441 writel_relaxed(0U | TSADCV2_AUTO_TSHUT_POLARITY_HIGH
,
442 regs
+ TSADCV2_AUTO_CON
);
444 writel_relaxed(0U & ~TSADCV2_AUTO_TSHUT_POLARITY_HIGH
,
445 regs
+ TSADCV2_AUTO_CON
);
447 writel_relaxed(TSADCV2_AUTO_PERIOD_TIME
, regs
+ TSADCV2_AUTO_PERIOD
);
448 writel_relaxed(TSADCV2_HIGHT_INT_DEBOUNCE_COUNT
,
449 regs
+ TSADCV2_HIGHT_INT_DEBOUNCE
);
450 writel_relaxed(TSADCV2_AUTO_PERIOD_HT_TIME
,
451 regs
+ TSADCV2_AUTO_PERIOD_HT
);
452 writel_relaxed(TSADCV2_HIGHT_TSHUT_DEBOUNCE_COUNT
,
453 regs
+ TSADCV2_HIGHT_TSHUT_DEBOUNCE
);
456 static void rk_tsadcv1_irq_ack(void __iomem
*regs
)
460 val
= readl_relaxed(regs
+ TSADCV2_INT_PD
);
461 writel_relaxed(val
& TSADCV1_INT_PD_CLEAR_MASK
, regs
+ TSADCV2_INT_PD
);
464 static void rk_tsadcv2_irq_ack(void __iomem
*regs
)
468 val
= readl_relaxed(regs
+ TSADCV2_INT_PD
);
469 writel_relaxed(val
& TSADCV2_INT_PD_CLEAR_MASK
, regs
+ TSADCV2_INT_PD
);
472 static void rk_tsadcv2_control(void __iomem
*regs
, bool enable
)
476 val
= readl_relaxed(regs
+ TSADCV2_AUTO_CON
);
478 val
|= TSADCV2_AUTO_EN
;
480 val
&= ~TSADCV2_AUTO_EN
;
482 writel_relaxed(val
, regs
+ TSADCV2_AUTO_CON
);
485 static int rk_tsadcv2_get_temp(struct chip_tsadc_table table
,
486 int chn
, void __iomem
*regs
, int *temp
)
490 val
= readl_relaxed(regs
+ TSADCV2_DATA(chn
));
492 return rk_tsadcv2_code_to_temp(table
, val
, temp
);
495 static void rk_tsadcv2_tshut_temp(struct chip_tsadc_table table
,
496 int chn
, void __iomem
*regs
, int temp
)
498 u32 tshut_value
, val
;
500 tshut_value
= rk_tsadcv2_temp_to_code(table
, temp
);
501 writel_relaxed(tshut_value
, regs
+ TSADCV2_COMP_SHUT(chn
));
503 /* TSHUT will be valid */
504 val
= readl_relaxed(regs
+ TSADCV2_AUTO_CON
);
505 writel_relaxed(val
| TSADCV2_AUTO_SRC_EN(chn
), regs
+ TSADCV2_AUTO_CON
);
508 static void rk_tsadcv2_tshut_mode(int chn
, void __iomem
*regs
,
509 enum tshut_mode mode
)
513 val
= readl_relaxed(regs
+ TSADCV2_INT_EN
);
514 if (mode
== TSHUT_MODE_GPIO
) {
515 val
&= ~TSADCV2_SHUT_2CRU_SRC_EN(chn
);
516 val
|= TSADCV2_SHUT_2GPIO_SRC_EN(chn
);
518 val
&= ~TSADCV2_SHUT_2GPIO_SRC_EN(chn
);
519 val
|= TSADCV2_SHUT_2CRU_SRC_EN(chn
);
522 writel_relaxed(val
, regs
+ TSADCV2_INT_EN
);
525 static const struct rockchip_tsadc_chip rk3228_tsadc_data
= {
526 .chn_id
[SENSOR_CPU
] = 0, /* cpu sensor is channel 0 */
527 .chn_num
= 1, /* one channel for tsadc */
529 .tshut_mode
= TSHUT_MODE_GPIO
, /* default TSHUT via GPIO give PMIC */
530 .tshut_polarity
= TSHUT_LOW_ACTIVE
, /* default TSHUT LOW ACTIVE */
533 .initialize
= rk_tsadcv2_initialize
,
534 .irq_ack
= rk_tsadcv1_irq_ack
,
535 .control
= rk_tsadcv2_control
,
536 .get_temp
= rk_tsadcv2_get_temp
,
537 .set_tshut_temp
= rk_tsadcv2_tshut_temp
,
538 .set_tshut_mode
= rk_tsadcv2_tshut_mode
,
542 .length
= ARRAY_SIZE(v1_code_table
),
543 .data_mask
= TSADCV3_DATA_MASK
,
544 .mode
= ADC_DECREMENT
,
548 static const struct rockchip_tsadc_chip rk3288_tsadc_data
= {
549 .chn_id
[SENSOR_CPU
] = 1, /* cpu sensor is channel 1 */
550 .chn_id
[SENSOR_GPU
] = 2, /* gpu sensor is channel 2 */
551 .chn_num
= 2, /* two channels for tsadc */
553 .tshut_mode
= TSHUT_MODE_GPIO
, /* default TSHUT via GPIO give PMIC */
554 .tshut_polarity
= TSHUT_LOW_ACTIVE
, /* default TSHUT LOW ACTIVE */
557 .initialize
= rk_tsadcv2_initialize
,
558 .irq_ack
= rk_tsadcv2_irq_ack
,
559 .control
= rk_tsadcv2_control
,
560 .get_temp
= rk_tsadcv2_get_temp
,
561 .set_tshut_temp
= rk_tsadcv2_tshut_temp
,
562 .set_tshut_mode
= rk_tsadcv2_tshut_mode
,
566 .length
= ARRAY_SIZE(v2_code_table
),
567 .data_mask
= TSADCV2_DATA_MASK
,
568 .mode
= ADC_DECREMENT
,
572 static const struct rockchip_tsadc_chip rk3368_tsadc_data
= {
573 .chn_id
[SENSOR_CPU
] = 0, /* cpu sensor is channel 0 */
574 .chn_id
[SENSOR_GPU
] = 1, /* gpu sensor is channel 1 */
575 .chn_num
= 2, /* two channels for tsadc */
577 .tshut_mode
= TSHUT_MODE_GPIO
, /* default TSHUT via GPIO give PMIC */
578 .tshut_polarity
= TSHUT_LOW_ACTIVE
, /* default TSHUT LOW ACTIVE */
581 .initialize
= rk_tsadcv2_initialize
,
582 .irq_ack
= rk_tsadcv2_irq_ack
,
583 .control
= rk_tsadcv2_control
,
584 .get_temp
= rk_tsadcv2_get_temp
,
585 .set_tshut_temp
= rk_tsadcv2_tshut_temp
,
586 .set_tshut_mode
= rk_tsadcv2_tshut_mode
,
590 .length
= ARRAY_SIZE(v3_code_table
),
591 .data_mask
= TSADCV3_DATA_MASK
,
592 .mode
= ADC_INCREMENT
,
596 static const struct rockchip_tsadc_chip rk3399_tsadc_data
= {
597 .chn_id
[SENSOR_CPU
] = 0, /* cpu sensor is channel 0 */
598 .chn_id
[SENSOR_GPU
] = 1, /* gpu sensor is channel 1 */
599 .chn_num
= 2, /* two channels for tsadc */
601 .tshut_mode
= TSHUT_MODE_GPIO
, /* default TSHUT via GPIO give PMIC */
602 .tshut_polarity
= TSHUT_LOW_ACTIVE
, /* default TSHUT LOW ACTIVE */
605 .initialize
= rk_tsadcv2_initialize
,
606 .irq_ack
= rk_tsadcv1_irq_ack
,
607 .control
= rk_tsadcv2_control
,
608 .get_temp
= rk_tsadcv2_get_temp
,
609 .set_tshut_temp
= rk_tsadcv2_tshut_temp
,
610 .set_tshut_mode
= rk_tsadcv2_tshut_mode
,
614 .length
= ARRAY_SIZE(v4_code_table
),
615 .data_mask
= TSADCV3_DATA_MASK
,
616 .mode
= ADC_DECREMENT
,
620 static const struct of_device_id of_rockchip_thermal_match
[] = {
622 .compatible
= "rockchip,rk3228-tsadc",
623 .data
= (void *)&rk3228_tsadc_data
,
626 .compatible
= "rockchip,rk3288-tsadc",
627 .data
= (void *)&rk3288_tsadc_data
,
630 .compatible
= "rockchip,rk3368-tsadc",
631 .data
= (void *)&rk3368_tsadc_data
,
634 .compatible
= "rockchip,rk3399-tsadc",
635 .data
= (void *)&rk3399_tsadc_data
,
639 MODULE_DEVICE_TABLE(of
, of_rockchip_thermal_match
);
642 rockchip_thermal_toggle_sensor(struct rockchip_thermal_sensor
*sensor
, bool on
)
644 struct thermal_zone_device
*tzd
= sensor
->tzd
;
646 tzd
->ops
->set_mode(tzd
,
647 on
? THERMAL_DEVICE_ENABLED
: THERMAL_DEVICE_DISABLED
);
650 static irqreturn_t
rockchip_thermal_alarm_irq_thread(int irq
, void *dev
)
652 struct rockchip_thermal_data
*thermal
= dev
;
655 dev_dbg(&thermal
->pdev
->dev
, "thermal alarm\n");
657 thermal
->chip
->irq_ack(thermal
->regs
);
659 for (i
= 0; i
< thermal
->chip
->chn_num
; i
++)
660 thermal_zone_device_update(thermal
->sensors
[i
].tzd
);
665 static int rockchip_thermal_get_temp(void *_sensor
, int *out_temp
)
667 struct rockchip_thermal_sensor
*sensor
= _sensor
;
668 struct rockchip_thermal_data
*thermal
= sensor
->thermal
;
669 const struct rockchip_tsadc_chip
*tsadc
= sensor
->thermal
->chip
;
672 retval
= tsadc
->get_temp(tsadc
->table
,
673 sensor
->id
, thermal
->regs
, out_temp
);
674 dev_dbg(&thermal
->pdev
->dev
, "sensor %d - temp: %d, retval: %d\n",
675 sensor
->id
, *out_temp
, retval
);
680 static const struct thermal_zone_of_device_ops rockchip_of_thermal_ops
= {
681 .get_temp
= rockchip_thermal_get_temp
,
684 static int rockchip_configure_from_dt(struct device
*dev
,
685 struct device_node
*np
,
686 struct rockchip_thermal_data
*thermal
)
688 u32 shut_temp
, tshut_mode
, tshut_polarity
;
690 if (of_property_read_u32(np
, "rockchip,hw-tshut-temp", &shut_temp
)) {
692 "Missing tshut temp property, using default %d\n",
693 thermal
->chip
->tshut_temp
);
694 thermal
->tshut_temp
= thermal
->chip
->tshut_temp
;
696 thermal
->tshut_temp
= shut_temp
;
699 if (thermal
->tshut_temp
> INT_MAX
) {
700 dev_err(dev
, "Invalid tshut temperature specified: %d\n",
701 thermal
->tshut_temp
);
705 if (of_property_read_u32(np
, "rockchip,hw-tshut-mode", &tshut_mode
)) {
707 "Missing tshut mode property, using default (%s)\n",
708 thermal
->chip
->tshut_mode
== TSHUT_MODE_GPIO
?
710 thermal
->tshut_mode
= thermal
->chip
->tshut_mode
;
712 thermal
->tshut_mode
= tshut_mode
;
715 if (thermal
->tshut_mode
> 1) {
716 dev_err(dev
, "Invalid tshut mode specified: %d\n",
717 thermal
->tshut_mode
);
721 if (of_property_read_u32(np
, "rockchip,hw-tshut-polarity",
724 "Missing tshut-polarity property, using default (%s)\n",
725 thermal
->chip
->tshut_polarity
== TSHUT_LOW_ACTIVE
?
727 thermal
->tshut_polarity
= thermal
->chip
->tshut_polarity
;
729 thermal
->tshut_polarity
= tshut_polarity
;
732 if (thermal
->tshut_polarity
> 1) {
733 dev_err(dev
, "Invalid tshut-polarity specified: %d\n",
734 thermal
->tshut_polarity
);
742 rockchip_thermal_register_sensor(struct platform_device
*pdev
,
743 struct rockchip_thermal_data
*thermal
,
744 struct rockchip_thermal_sensor
*sensor
,
747 const struct rockchip_tsadc_chip
*tsadc
= thermal
->chip
;
750 tsadc
->set_tshut_mode(id
, thermal
->regs
, thermal
->tshut_mode
);
751 tsadc
->set_tshut_temp(tsadc
->table
, id
, thermal
->regs
,
752 thermal
->tshut_temp
);
754 sensor
->thermal
= thermal
;
756 sensor
->tzd
= thermal_zone_of_sensor_register(&pdev
->dev
, id
, sensor
,
757 &rockchip_of_thermal_ops
);
758 if (IS_ERR(sensor
->tzd
)) {
759 error
= PTR_ERR(sensor
->tzd
);
760 dev_err(&pdev
->dev
, "failed to register sensor %d: %d\n",
769 * Reset TSADC Controller, reset all tsadc registers.
771 static void rockchip_thermal_reset_controller(struct reset_control
*reset
)
773 reset_control_assert(reset
);
774 usleep_range(10, 20);
775 reset_control_deassert(reset
);
778 static int rockchip_thermal_probe(struct platform_device
*pdev
)
780 struct device_node
*np
= pdev
->dev
.of_node
;
781 struct rockchip_thermal_data
*thermal
;
782 const struct of_device_id
*match
;
783 struct resource
*res
;
788 match
= of_match_node(of_rockchip_thermal_match
, np
);
792 irq
= platform_get_irq(pdev
, 0);
794 dev_err(&pdev
->dev
, "no irq resource?\n");
798 thermal
= devm_kzalloc(&pdev
->dev
, sizeof(struct rockchip_thermal_data
),
803 thermal
->pdev
= pdev
;
805 thermal
->chip
= (const struct rockchip_tsadc_chip
*)match
->data
;
809 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
810 thermal
->regs
= devm_ioremap_resource(&pdev
->dev
, res
);
811 if (IS_ERR(thermal
->regs
))
812 return PTR_ERR(thermal
->regs
);
814 thermal
->reset
= devm_reset_control_get(&pdev
->dev
, "tsadc-apb");
815 if (IS_ERR(thermal
->reset
)) {
816 error
= PTR_ERR(thermal
->reset
);
817 dev_err(&pdev
->dev
, "failed to get tsadc reset: %d\n", error
);
821 thermal
->clk
= devm_clk_get(&pdev
->dev
, "tsadc");
822 if (IS_ERR(thermal
->clk
)) {
823 error
= PTR_ERR(thermal
->clk
);
824 dev_err(&pdev
->dev
, "failed to get tsadc clock: %d\n", error
);
828 thermal
->pclk
= devm_clk_get(&pdev
->dev
, "apb_pclk");
829 if (IS_ERR(thermal
->pclk
)) {
830 error
= PTR_ERR(thermal
->pclk
);
831 dev_err(&pdev
->dev
, "failed to get apb_pclk clock: %d\n",
836 error
= clk_prepare_enable(thermal
->clk
);
838 dev_err(&pdev
->dev
, "failed to enable converter clock: %d\n",
843 error
= clk_prepare_enable(thermal
->pclk
);
845 dev_err(&pdev
->dev
, "failed to enable pclk: %d\n", error
);
846 goto err_disable_clk
;
849 rockchip_thermal_reset_controller(thermal
->reset
);
851 error
= rockchip_configure_from_dt(&pdev
->dev
, np
, thermal
);
853 dev_err(&pdev
->dev
, "failed to parse device tree data: %d\n",
855 goto err_disable_pclk
;
858 thermal
->chip
->initialize(thermal
->regs
, thermal
->tshut_polarity
);
860 for (i
= 0; i
< thermal
->chip
->chn_num
; i
++) {
861 error
= rockchip_thermal_register_sensor(pdev
, thermal
,
862 &thermal
->sensors
[i
],
863 thermal
->chip
->chn_id
[i
]);
866 "failed to register sensor[%d] : error = %d\n",
868 for (j
= 0; j
< i
; j
++)
869 thermal_zone_of_sensor_unregister(&pdev
->dev
,
870 thermal
->sensors
[j
].tzd
);
871 goto err_disable_pclk
;
875 error
= devm_request_threaded_irq(&pdev
->dev
, irq
, NULL
,
876 &rockchip_thermal_alarm_irq_thread
,
878 "rockchip_thermal", thermal
);
881 "failed to request tsadc irq: %d\n", error
);
882 goto err_unregister_sensor
;
885 thermal
->chip
->control(thermal
->regs
, true);
887 for (i
= 0; i
< thermal
->chip
->chn_num
; i
++)
888 rockchip_thermal_toggle_sensor(&thermal
->sensors
[i
], true);
890 platform_set_drvdata(pdev
, thermal
);
894 err_unregister_sensor
:
896 thermal_zone_of_sensor_unregister(&pdev
->dev
,
897 thermal
->sensors
[i
].tzd
);
900 clk_disable_unprepare(thermal
->pclk
);
902 clk_disable_unprepare(thermal
->clk
);
907 static int rockchip_thermal_remove(struct platform_device
*pdev
)
909 struct rockchip_thermal_data
*thermal
= platform_get_drvdata(pdev
);
912 for (i
= 0; i
< thermal
->chip
->chn_num
; i
++) {
913 struct rockchip_thermal_sensor
*sensor
= &thermal
->sensors
[i
];
915 rockchip_thermal_toggle_sensor(sensor
, false);
916 thermal_zone_of_sensor_unregister(&pdev
->dev
, sensor
->tzd
);
919 thermal
->chip
->control(thermal
->regs
, false);
921 clk_disable_unprepare(thermal
->pclk
);
922 clk_disable_unprepare(thermal
->clk
);
927 static int __maybe_unused
rockchip_thermal_suspend(struct device
*dev
)
929 struct platform_device
*pdev
= to_platform_device(dev
);
930 struct rockchip_thermal_data
*thermal
= platform_get_drvdata(pdev
);
933 for (i
= 0; i
< thermal
->chip
->chn_num
; i
++)
934 rockchip_thermal_toggle_sensor(&thermal
->sensors
[i
], false);
936 thermal
->chip
->control(thermal
->regs
, false);
938 clk_disable(thermal
->pclk
);
939 clk_disable(thermal
->clk
);
941 pinctrl_pm_select_sleep_state(dev
);
946 static int __maybe_unused
rockchip_thermal_resume(struct device
*dev
)
948 struct platform_device
*pdev
= to_platform_device(dev
);
949 struct rockchip_thermal_data
*thermal
= platform_get_drvdata(pdev
);
953 error
= clk_enable(thermal
->clk
);
957 error
= clk_enable(thermal
->pclk
);
961 rockchip_thermal_reset_controller(thermal
->reset
);
963 thermal
->chip
->initialize(thermal
->regs
, thermal
->tshut_polarity
);
965 for (i
= 0; i
< thermal
->chip
->chn_num
; i
++) {
966 int id
= thermal
->sensors
[i
].id
;
968 thermal
->chip
->set_tshut_mode(id
, thermal
->regs
,
969 thermal
->tshut_mode
);
970 thermal
->chip
->set_tshut_temp(thermal
->chip
->table
,
972 thermal
->tshut_temp
);
975 thermal
->chip
->control(thermal
->regs
, true);
977 for (i
= 0; i
< thermal
->chip
->chn_num
; i
++)
978 rockchip_thermal_toggle_sensor(&thermal
->sensors
[i
], true);
980 pinctrl_pm_select_default_state(dev
);
985 static SIMPLE_DEV_PM_OPS(rockchip_thermal_pm_ops
,
986 rockchip_thermal_suspend
, rockchip_thermal_resume
);
988 static struct platform_driver rockchip_thermal_driver
= {
990 .name
= "rockchip-thermal",
991 .pm
= &rockchip_thermal_pm_ops
,
992 .of_match_table
= of_rockchip_thermal_match
,
994 .probe
= rockchip_thermal_probe
,
995 .remove
= rockchip_thermal_remove
,
998 module_platform_driver(rockchip_thermal_driver
);
1000 MODULE_DESCRIPTION("ROCKCHIP THERMAL Driver");
1001 MODULE_AUTHOR("Rockchip, Inc.");
1002 MODULE_LICENSE("GPL v2");
1003 MODULE_ALIAS("platform:rockchip-thermal");