xref: /OK3568_Linux_fs/kernel/drivers/thermal/ti-soc-thermal/ti-bandgap.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * TI Bandgap temperature sensor driver
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (C) 2011-2012 Texas Instruments Incorporated - http://www.ti.com/
6*4882a593Smuzhiyun  * Author: J Keerthy <j-keerthy@ti.com>
7*4882a593Smuzhiyun  * Author: Moiz Sonasath <m-sonasath@ti.com>
8*4882a593Smuzhiyun  * Couple of fixes, DT and MFD adaptation:
9*4882a593Smuzhiyun  *   Eduardo Valentin <eduardo.valentin@ti.com>
10*4882a593Smuzhiyun  */
11*4882a593Smuzhiyun 
12*4882a593Smuzhiyun #include <linux/module.h>
13*4882a593Smuzhiyun #include <linux/export.h>
14*4882a593Smuzhiyun #include <linux/init.h>
15*4882a593Smuzhiyun #include <linux/kernel.h>
16*4882a593Smuzhiyun #include <linux/interrupt.h>
17*4882a593Smuzhiyun #include <linux/clk.h>
18*4882a593Smuzhiyun #include <linux/gpio/consumer.h>
19*4882a593Smuzhiyun #include <linux/platform_device.h>
20*4882a593Smuzhiyun #include <linux/err.h>
21*4882a593Smuzhiyun #include <linux/types.h>
22*4882a593Smuzhiyun #include <linux/spinlock.h>
23*4882a593Smuzhiyun #include <linux/sys_soc.h>
24*4882a593Smuzhiyun #include <linux/reboot.h>
25*4882a593Smuzhiyun #include <linux/of_device.h>
26*4882a593Smuzhiyun #include <linux/of_platform.h>
27*4882a593Smuzhiyun #include <linux/of_irq.h>
28*4882a593Smuzhiyun #include <linux/io.h>
29*4882a593Smuzhiyun #include <linux/cpu_pm.h>
30*4882a593Smuzhiyun #include <linux/device.h>
31*4882a593Smuzhiyun #include <linux/pm_runtime.h>
32*4882a593Smuzhiyun #include <linux/pm.h>
33*4882a593Smuzhiyun #include <linux/of.h>
34*4882a593Smuzhiyun #include <linux/of_device.h>
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun #include "ti-bandgap.h"
37*4882a593Smuzhiyun 
38*4882a593Smuzhiyun static int ti_bandgap_force_single_read(struct ti_bandgap *bgp, int id);
39*4882a593Smuzhiyun #ifdef CONFIG_PM_SLEEP
40*4882a593Smuzhiyun static int bandgap_omap_cpu_notifier(struct notifier_block *nb,
41*4882a593Smuzhiyun 				  unsigned long cmd, void *v);
42*4882a593Smuzhiyun #endif
43*4882a593Smuzhiyun 
44*4882a593Smuzhiyun /***   Helper functions to access registers and their bitfields   ***/
45*4882a593Smuzhiyun 
46*4882a593Smuzhiyun /**
47*4882a593Smuzhiyun  * ti_bandgap_readl() - simple read helper function
48*4882a593Smuzhiyun  * @bgp: pointer to ti_bandgap structure
49*4882a593Smuzhiyun  * @reg: desired register (offset) to be read
50*4882a593Smuzhiyun  *
51*4882a593Smuzhiyun  * Helper function to read bandgap registers. It uses the io remapped area.
52*4882a593Smuzhiyun  * Return: the register value.
53*4882a593Smuzhiyun  */
ti_bandgap_readl(struct ti_bandgap * bgp,u32 reg)54*4882a593Smuzhiyun static u32 ti_bandgap_readl(struct ti_bandgap *bgp, u32 reg)
55*4882a593Smuzhiyun {
56*4882a593Smuzhiyun 	return readl(bgp->base + reg);
57*4882a593Smuzhiyun }
58*4882a593Smuzhiyun 
59*4882a593Smuzhiyun /**
60*4882a593Smuzhiyun  * ti_bandgap_writel() - simple write helper function
61*4882a593Smuzhiyun  * @bgp: pointer to ti_bandgap structure
62*4882a593Smuzhiyun  * @val: desired register value to be written
63*4882a593Smuzhiyun  * @reg: desired register (offset) to be written
64*4882a593Smuzhiyun  *
65*4882a593Smuzhiyun  * Helper function to write bandgap registers. It uses the io remapped area.
66*4882a593Smuzhiyun  */
ti_bandgap_writel(struct ti_bandgap * bgp,u32 val,u32 reg)67*4882a593Smuzhiyun static void ti_bandgap_writel(struct ti_bandgap *bgp, u32 val, u32 reg)
68*4882a593Smuzhiyun {
69*4882a593Smuzhiyun 	writel(val, bgp->base + reg);
70*4882a593Smuzhiyun }
71*4882a593Smuzhiyun 
72*4882a593Smuzhiyun /**
73*4882a593Smuzhiyun  * DOC: macro to update bits.
74*4882a593Smuzhiyun  *
75*4882a593Smuzhiyun  * RMW_BITS() - used to read, modify and update bandgap bitfields.
76*4882a593Smuzhiyun  *            The value passed will be shifted.
77*4882a593Smuzhiyun  */
78*4882a593Smuzhiyun #define RMW_BITS(bgp, id, reg, mask, val)			\
79*4882a593Smuzhiyun do {								\
80*4882a593Smuzhiyun 	struct temp_sensor_registers *t;			\
81*4882a593Smuzhiyun 	u32 r;							\
82*4882a593Smuzhiyun 								\
83*4882a593Smuzhiyun 	t = bgp->conf->sensors[(id)].registers;		\
84*4882a593Smuzhiyun 	r = ti_bandgap_readl(bgp, t->reg);			\
85*4882a593Smuzhiyun 	r &= ~t->mask;						\
86*4882a593Smuzhiyun 	r |= (val) << __ffs(t->mask);				\
87*4882a593Smuzhiyun 	ti_bandgap_writel(bgp, r, t->reg);			\
88*4882a593Smuzhiyun } while (0)
89*4882a593Smuzhiyun 
90*4882a593Smuzhiyun /***   Basic helper functions   ***/
91*4882a593Smuzhiyun 
92*4882a593Smuzhiyun /**
93*4882a593Smuzhiyun  * ti_bandgap_power() - controls the power state of a bandgap device
94*4882a593Smuzhiyun  * @bgp: pointer to ti_bandgap structure
95*4882a593Smuzhiyun  * @on: desired power state (1 - on, 0 - off)
96*4882a593Smuzhiyun  *
97*4882a593Smuzhiyun  * Used to power on/off a bandgap device instance. Only used on those
98*4882a593Smuzhiyun  * that features tempsoff bit.
99*4882a593Smuzhiyun  *
100*4882a593Smuzhiyun  * Return: 0 on success, -ENOTSUPP if tempsoff is not supported.
101*4882a593Smuzhiyun  */
ti_bandgap_power(struct ti_bandgap * bgp,bool on)102*4882a593Smuzhiyun static int ti_bandgap_power(struct ti_bandgap *bgp, bool on)
103*4882a593Smuzhiyun {
104*4882a593Smuzhiyun 	int i;
105*4882a593Smuzhiyun 
106*4882a593Smuzhiyun 	if (!TI_BANDGAP_HAS(bgp, POWER_SWITCH))
107*4882a593Smuzhiyun 		return -ENOTSUPP;
108*4882a593Smuzhiyun 
109*4882a593Smuzhiyun 	for (i = 0; i < bgp->conf->sensor_count; i++)
110*4882a593Smuzhiyun 		/* active on 0 */
111*4882a593Smuzhiyun 		RMW_BITS(bgp, i, temp_sensor_ctrl, bgap_tempsoff_mask, !on);
112*4882a593Smuzhiyun 	return 0;
113*4882a593Smuzhiyun }
114*4882a593Smuzhiyun 
115*4882a593Smuzhiyun /**
116*4882a593Smuzhiyun  * ti_errata814_bandgap_read_temp() - helper function to read dra7 sensor temperature
117*4882a593Smuzhiyun  * @bgp: pointer to ti_bandgap structure
118*4882a593Smuzhiyun  * @reg: desired register (offset) to be read
119*4882a593Smuzhiyun  *
120*4882a593Smuzhiyun  * Function to read dra7 bandgap sensor temperature. This is done separately
121*4882a593Smuzhiyun  * so as to workaround the errata "Bandgap Temperature read Dtemp can be
122*4882a593Smuzhiyun  * corrupted" - Errata ID: i814".
123*4882a593Smuzhiyun  * Read accesses to registers listed below can be corrupted due to incorrect
124*4882a593Smuzhiyun  * resynchronization between clock domains.
125*4882a593Smuzhiyun  * Read access to registers below can be corrupted :
126*4882a593Smuzhiyun  * CTRL_CORE_DTEMP_MPU/GPU/CORE/DSPEVE/IVA_n (n = 0 to 4)
127*4882a593Smuzhiyun  * CTRL_CORE_TEMP_SENSOR_MPU/GPU/CORE/DSPEVE/IVA_n
128*4882a593Smuzhiyun  *
129*4882a593Smuzhiyun  * Return: the register value.
130*4882a593Smuzhiyun  */
ti_errata814_bandgap_read_temp(struct ti_bandgap * bgp,u32 reg)131*4882a593Smuzhiyun static u32 ti_errata814_bandgap_read_temp(struct ti_bandgap *bgp,  u32 reg)
132*4882a593Smuzhiyun {
133*4882a593Smuzhiyun 	u32 val1, val2;
134*4882a593Smuzhiyun 
135*4882a593Smuzhiyun 	val1 = ti_bandgap_readl(bgp, reg);
136*4882a593Smuzhiyun 	val2 = ti_bandgap_readl(bgp, reg);
137*4882a593Smuzhiyun 
138*4882a593Smuzhiyun 	/* If both times we read the same value then that is right */
139*4882a593Smuzhiyun 	if (val1 == val2)
140*4882a593Smuzhiyun 		return val1;
141*4882a593Smuzhiyun 
142*4882a593Smuzhiyun 	/* if val1 and val2 are different read it third time */
143*4882a593Smuzhiyun 	return ti_bandgap_readl(bgp, reg);
144*4882a593Smuzhiyun }
145*4882a593Smuzhiyun 
146*4882a593Smuzhiyun /**
147*4882a593Smuzhiyun  * ti_bandgap_read_temp() - helper function to read sensor temperature
148*4882a593Smuzhiyun  * @bgp: pointer to ti_bandgap structure
149*4882a593Smuzhiyun  * @id: bandgap sensor id
150*4882a593Smuzhiyun  *
151*4882a593Smuzhiyun  * Function to concentrate the steps to read sensor temperature register.
152*4882a593Smuzhiyun  * This function is desired because, depending on bandgap device version,
153*4882a593Smuzhiyun  * it might be needed to freeze the bandgap state machine, before fetching
154*4882a593Smuzhiyun  * the register value.
155*4882a593Smuzhiyun  *
156*4882a593Smuzhiyun  * Return: temperature in ADC values.
157*4882a593Smuzhiyun  */
ti_bandgap_read_temp(struct ti_bandgap * bgp,int id)158*4882a593Smuzhiyun static u32 ti_bandgap_read_temp(struct ti_bandgap *bgp, int id)
159*4882a593Smuzhiyun {
160*4882a593Smuzhiyun 	struct temp_sensor_registers *tsr;
161*4882a593Smuzhiyun 	u32 temp, reg;
162*4882a593Smuzhiyun 
163*4882a593Smuzhiyun 	tsr = bgp->conf->sensors[id].registers;
164*4882a593Smuzhiyun 	reg = tsr->temp_sensor_ctrl;
165*4882a593Smuzhiyun 
166*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, FREEZE_BIT)) {
167*4882a593Smuzhiyun 		RMW_BITS(bgp, id, bgap_mask_ctrl, mask_freeze_mask, 1);
168*4882a593Smuzhiyun 		/*
169*4882a593Smuzhiyun 		 * In case we cannot read from cur_dtemp / dtemp_0,
170*4882a593Smuzhiyun 		 * then we read from the last valid temp read
171*4882a593Smuzhiyun 		 */
172*4882a593Smuzhiyun 		reg = tsr->ctrl_dtemp_1;
173*4882a593Smuzhiyun 	}
174*4882a593Smuzhiyun 
175*4882a593Smuzhiyun 	/* read temperature */
176*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, ERRATA_814))
177*4882a593Smuzhiyun 		temp = ti_errata814_bandgap_read_temp(bgp, reg);
178*4882a593Smuzhiyun 	else
179*4882a593Smuzhiyun 		temp = ti_bandgap_readl(bgp, reg);
180*4882a593Smuzhiyun 
181*4882a593Smuzhiyun 	temp &= tsr->bgap_dtemp_mask;
182*4882a593Smuzhiyun 
183*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, FREEZE_BIT))
184*4882a593Smuzhiyun 		RMW_BITS(bgp, id, bgap_mask_ctrl, mask_freeze_mask, 0);
185*4882a593Smuzhiyun 
186*4882a593Smuzhiyun 	return temp;
187*4882a593Smuzhiyun }
188*4882a593Smuzhiyun 
189*4882a593Smuzhiyun /***   IRQ handlers   ***/
190*4882a593Smuzhiyun 
191*4882a593Smuzhiyun /**
192*4882a593Smuzhiyun  * ti_bandgap_talert_irq_handler() - handles Temperature alert IRQs
193*4882a593Smuzhiyun  * @irq: IRQ number
194*4882a593Smuzhiyun  * @data: private data (struct ti_bandgap *)
195*4882a593Smuzhiyun  *
196*4882a593Smuzhiyun  * This is the Talert handler. Use it only if bandgap device features
197*4882a593Smuzhiyun  * HAS(TALERT). This handler goes over all sensors and checks their
198*4882a593Smuzhiyun  * conditions and acts accordingly. In case there are events pending,
199*4882a593Smuzhiyun  * it will reset the event mask to wait for the opposite event (next event).
200*4882a593Smuzhiyun  * Every time there is a new event, it will be reported to thermal layer.
201*4882a593Smuzhiyun  *
202*4882a593Smuzhiyun  * Return: IRQ_HANDLED
203*4882a593Smuzhiyun  */
ti_bandgap_talert_irq_handler(int irq,void * data)204*4882a593Smuzhiyun static irqreturn_t ti_bandgap_talert_irq_handler(int irq, void *data)
205*4882a593Smuzhiyun {
206*4882a593Smuzhiyun 	struct ti_bandgap *bgp = data;
207*4882a593Smuzhiyun 	struct temp_sensor_registers *tsr;
208*4882a593Smuzhiyun 	u32 t_hot = 0, t_cold = 0, ctrl;
209*4882a593Smuzhiyun 	int i;
210*4882a593Smuzhiyun 
211*4882a593Smuzhiyun 	spin_lock(&bgp->lock);
212*4882a593Smuzhiyun 	for (i = 0; i < bgp->conf->sensor_count; i++) {
213*4882a593Smuzhiyun 		tsr = bgp->conf->sensors[i].registers;
214*4882a593Smuzhiyun 		ctrl = ti_bandgap_readl(bgp, tsr->bgap_status);
215*4882a593Smuzhiyun 
216*4882a593Smuzhiyun 		/* Read the status of t_hot */
217*4882a593Smuzhiyun 		t_hot = ctrl & tsr->status_hot_mask;
218*4882a593Smuzhiyun 
219*4882a593Smuzhiyun 		/* Read the status of t_cold */
220*4882a593Smuzhiyun 		t_cold = ctrl & tsr->status_cold_mask;
221*4882a593Smuzhiyun 
222*4882a593Smuzhiyun 		if (!t_cold && !t_hot)
223*4882a593Smuzhiyun 			continue;
224*4882a593Smuzhiyun 
225*4882a593Smuzhiyun 		ctrl = ti_bandgap_readl(bgp, tsr->bgap_mask_ctrl);
226*4882a593Smuzhiyun 		/*
227*4882a593Smuzhiyun 		 * One TALERT interrupt: Two sources
228*4882a593Smuzhiyun 		 * If the interrupt is due to t_hot then mask t_hot and
229*4882a593Smuzhiyun 		 * and unmask t_cold else mask t_cold and unmask t_hot
230*4882a593Smuzhiyun 		 */
231*4882a593Smuzhiyun 		if (t_hot) {
232*4882a593Smuzhiyun 			ctrl &= ~tsr->mask_hot_mask;
233*4882a593Smuzhiyun 			ctrl |= tsr->mask_cold_mask;
234*4882a593Smuzhiyun 		} else if (t_cold) {
235*4882a593Smuzhiyun 			ctrl &= ~tsr->mask_cold_mask;
236*4882a593Smuzhiyun 			ctrl |= tsr->mask_hot_mask;
237*4882a593Smuzhiyun 		}
238*4882a593Smuzhiyun 
239*4882a593Smuzhiyun 		ti_bandgap_writel(bgp, ctrl, tsr->bgap_mask_ctrl);
240*4882a593Smuzhiyun 
241*4882a593Smuzhiyun 		dev_dbg(bgp->dev,
242*4882a593Smuzhiyun 			"%s: IRQ from %s sensor: hotevent %d coldevent %d\n",
243*4882a593Smuzhiyun 			__func__, bgp->conf->sensors[i].domain,
244*4882a593Smuzhiyun 			t_hot, t_cold);
245*4882a593Smuzhiyun 
246*4882a593Smuzhiyun 		/* report temperature to whom may concern */
247*4882a593Smuzhiyun 		if (bgp->conf->report_temperature)
248*4882a593Smuzhiyun 			bgp->conf->report_temperature(bgp, i);
249*4882a593Smuzhiyun 	}
250*4882a593Smuzhiyun 	spin_unlock(&bgp->lock);
251*4882a593Smuzhiyun 
252*4882a593Smuzhiyun 	return IRQ_HANDLED;
253*4882a593Smuzhiyun }
254*4882a593Smuzhiyun 
255*4882a593Smuzhiyun /**
256*4882a593Smuzhiyun  * ti_bandgap_tshut_irq_handler() - handles Temperature shutdown signal
257*4882a593Smuzhiyun  * @irq: IRQ number
258*4882a593Smuzhiyun  * @data: private data (unused)
259*4882a593Smuzhiyun  *
260*4882a593Smuzhiyun  * This is the Tshut handler. Use it only if bandgap device features
261*4882a593Smuzhiyun  * HAS(TSHUT). If any sensor fires the Tshut signal, we simply shutdown
262*4882a593Smuzhiyun  * the system.
263*4882a593Smuzhiyun  *
264*4882a593Smuzhiyun  * Return: IRQ_HANDLED
265*4882a593Smuzhiyun  */
ti_bandgap_tshut_irq_handler(int irq,void * data)266*4882a593Smuzhiyun static irqreturn_t ti_bandgap_tshut_irq_handler(int irq, void *data)
267*4882a593Smuzhiyun {
268*4882a593Smuzhiyun 	pr_emerg("%s: TSHUT temperature reached. Needs shut down...\n",
269*4882a593Smuzhiyun 		 __func__);
270*4882a593Smuzhiyun 
271*4882a593Smuzhiyun 	orderly_poweroff(true);
272*4882a593Smuzhiyun 
273*4882a593Smuzhiyun 	return IRQ_HANDLED;
274*4882a593Smuzhiyun }
275*4882a593Smuzhiyun 
276*4882a593Smuzhiyun /***   Helper functions which manipulate conversion ADC <-> mi Celsius   ***/
277*4882a593Smuzhiyun 
278*4882a593Smuzhiyun /**
279*4882a593Smuzhiyun  * ti_bandgap_adc_to_mcelsius() - converts an ADC value to mCelsius scale
280*4882a593Smuzhiyun  * @bgp: struct ti_bandgap pointer
281*4882a593Smuzhiyun  * @adc_val: value in ADC representation
282*4882a593Smuzhiyun  * @t: address where to write the resulting temperature in mCelsius
283*4882a593Smuzhiyun  *
284*4882a593Smuzhiyun  * Simple conversion from ADC representation to mCelsius. In case the ADC value
285*4882a593Smuzhiyun  * is out of the ADC conv table range, it returns -ERANGE, 0 on success.
286*4882a593Smuzhiyun  * The conversion table is indexed by the ADC values.
287*4882a593Smuzhiyun  *
288*4882a593Smuzhiyun  * Return: 0 if conversion was successful, else -ERANGE in case the @adc_val
289*4882a593Smuzhiyun  * argument is out of the ADC conv table range.
290*4882a593Smuzhiyun  */
291*4882a593Smuzhiyun static
ti_bandgap_adc_to_mcelsius(struct ti_bandgap * bgp,int adc_val,int * t)292*4882a593Smuzhiyun int ti_bandgap_adc_to_mcelsius(struct ti_bandgap *bgp, int adc_val, int *t)
293*4882a593Smuzhiyun {
294*4882a593Smuzhiyun 	const struct ti_bandgap_data *conf = bgp->conf;
295*4882a593Smuzhiyun 
296*4882a593Smuzhiyun 	/* look up for temperature in the table and return the temperature */
297*4882a593Smuzhiyun 	if (adc_val < conf->adc_start_val || adc_val > conf->adc_end_val)
298*4882a593Smuzhiyun 		return -ERANGE;
299*4882a593Smuzhiyun 
300*4882a593Smuzhiyun 	*t = bgp->conf->conv_table[adc_val - conf->adc_start_val];
301*4882a593Smuzhiyun 	return 0;
302*4882a593Smuzhiyun }
303*4882a593Smuzhiyun 
304*4882a593Smuzhiyun /**
305*4882a593Smuzhiyun  * ti_bandgap_validate() - helper to check the sanity of a struct ti_bandgap
306*4882a593Smuzhiyun  * @bgp: struct ti_bandgap pointer
307*4882a593Smuzhiyun  * @id: bandgap sensor id
308*4882a593Smuzhiyun  *
309*4882a593Smuzhiyun  * Checks if the bandgap pointer is valid and if the sensor id is also
310*4882a593Smuzhiyun  * applicable.
311*4882a593Smuzhiyun  *
312*4882a593Smuzhiyun  * Return: 0 if no errors, -EINVAL for invalid @bgp pointer or -ERANGE if
313*4882a593Smuzhiyun  * @id cannot index @bgp sensors.
314*4882a593Smuzhiyun  */
ti_bandgap_validate(struct ti_bandgap * bgp,int id)315*4882a593Smuzhiyun static inline int ti_bandgap_validate(struct ti_bandgap *bgp, int id)
316*4882a593Smuzhiyun {
317*4882a593Smuzhiyun 	if (!bgp || IS_ERR(bgp)) {
318*4882a593Smuzhiyun 		pr_err("%s: invalid bandgap pointer\n", __func__);
319*4882a593Smuzhiyun 		return -EINVAL;
320*4882a593Smuzhiyun 	}
321*4882a593Smuzhiyun 
322*4882a593Smuzhiyun 	if ((id < 0) || (id >= bgp->conf->sensor_count)) {
323*4882a593Smuzhiyun 		dev_err(bgp->dev, "%s: sensor id out of range (%d)\n",
324*4882a593Smuzhiyun 			__func__, id);
325*4882a593Smuzhiyun 		return -ERANGE;
326*4882a593Smuzhiyun 	}
327*4882a593Smuzhiyun 
328*4882a593Smuzhiyun 	return 0;
329*4882a593Smuzhiyun }
330*4882a593Smuzhiyun 
331*4882a593Smuzhiyun /**
332*4882a593Smuzhiyun  * ti_bandgap_read_counter() - read the sensor counter
333*4882a593Smuzhiyun  * @bgp: pointer to bandgap instance
334*4882a593Smuzhiyun  * @id: sensor id
335*4882a593Smuzhiyun  * @interval: resulting update interval in miliseconds
336*4882a593Smuzhiyun  */
ti_bandgap_read_counter(struct ti_bandgap * bgp,int id,int * interval)337*4882a593Smuzhiyun static void ti_bandgap_read_counter(struct ti_bandgap *bgp, int id,
338*4882a593Smuzhiyun 				    int *interval)
339*4882a593Smuzhiyun {
340*4882a593Smuzhiyun 	struct temp_sensor_registers *tsr;
341*4882a593Smuzhiyun 	int time;
342*4882a593Smuzhiyun 
343*4882a593Smuzhiyun 	tsr = bgp->conf->sensors[id].registers;
344*4882a593Smuzhiyun 	time = ti_bandgap_readl(bgp, tsr->bgap_counter);
345*4882a593Smuzhiyun 	time = (time & tsr->counter_mask) >>
346*4882a593Smuzhiyun 					__ffs(tsr->counter_mask);
347*4882a593Smuzhiyun 	time = time * 1000 / bgp->clk_rate;
348*4882a593Smuzhiyun 	*interval = time;
349*4882a593Smuzhiyun }
350*4882a593Smuzhiyun 
351*4882a593Smuzhiyun /**
352*4882a593Smuzhiyun  * ti_bandgap_read_counter_delay() - read the sensor counter delay
353*4882a593Smuzhiyun  * @bgp: pointer to bandgap instance
354*4882a593Smuzhiyun  * @id: sensor id
355*4882a593Smuzhiyun  * @interval: resulting update interval in miliseconds
356*4882a593Smuzhiyun  */
ti_bandgap_read_counter_delay(struct ti_bandgap * bgp,int id,int * interval)357*4882a593Smuzhiyun static void ti_bandgap_read_counter_delay(struct ti_bandgap *bgp, int id,
358*4882a593Smuzhiyun 					  int *interval)
359*4882a593Smuzhiyun {
360*4882a593Smuzhiyun 	struct temp_sensor_registers *tsr;
361*4882a593Smuzhiyun 	int reg_val;
362*4882a593Smuzhiyun 
363*4882a593Smuzhiyun 	tsr = bgp->conf->sensors[id].registers;
364*4882a593Smuzhiyun 
365*4882a593Smuzhiyun 	reg_val = ti_bandgap_readl(bgp, tsr->bgap_mask_ctrl);
366*4882a593Smuzhiyun 	reg_val = (reg_val & tsr->mask_counter_delay_mask) >>
367*4882a593Smuzhiyun 				__ffs(tsr->mask_counter_delay_mask);
368*4882a593Smuzhiyun 	switch (reg_val) {
369*4882a593Smuzhiyun 	case 0:
370*4882a593Smuzhiyun 		*interval = 0;
371*4882a593Smuzhiyun 		break;
372*4882a593Smuzhiyun 	case 1:
373*4882a593Smuzhiyun 		*interval = 1;
374*4882a593Smuzhiyun 		break;
375*4882a593Smuzhiyun 	case 2:
376*4882a593Smuzhiyun 		*interval = 10;
377*4882a593Smuzhiyun 		break;
378*4882a593Smuzhiyun 	case 3:
379*4882a593Smuzhiyun 		*interval = 100;
380*4882a593Smuzhiyun 		break;
381*4882a593Smuzhiyun 	case 4:
382*4882a593Smuzhiyun 		*interval = 250;
383*4882a593Smuzhiyun 		break;
384*4882a593Smuzhiyun 	case 5:
385*4882a593Smuzhiyun 		*interval = 500;
386*4882a593Smuzhiyun 		break;
387*4882a593Smuzhiyun 	default:
388*4882a593Smuzhiyun 		dev_warn(bgp->dev, "Wrong counter delay value read from register %X",
389*4882a593Smuzhiyun 			 reg_val);
390*4882a593Smuzhiyun 	}
391*4882a593Smuzhiyun }
392*4882a593Smuzhiyun 
393*4882a593Smuzhiyun /**
394*4882a593Smuzhiyun  * ti_bandgap_read_update_interval() - read the sensor update interval
395*4882a593Smuzhiyun  * @bgp: pointer to bandgap instance
396*4882a593Smuzhiyun  * @id: sensor id
397*4882a593Smuzhiyun  * @interval: resulting update interval in miliseconds
398*4882a593Smuzhiyun  *
399*4882a593Smuzhiyun  * Return: 0 on success or the proper error code
400*4882a593Smuzhiyun  */
ti_bandgap_read_update_interval(struct ti_bandgap * bgp,int id,int * interval)401*4882a593Smuzhiyun int ti_bandgap_read_update_interval(struct ti_bandgap *bgp, int id,
402*4882a593Smuzhiyun 				    int *interval)
403*4882a593Smuzhiyun {
404*4882a593Smuzhiyun 	int ret = 0;
405*4882a593Smuzhiyun 
406*4882a593Smuzhiyun 	ret = ti_bandgap_validate(bgp, id);
407*4882a593Smuzhiyun 	if (ret)
408*4882a593Smuzhiyun 		goto exit;
409*4882a593Smuzhiyun 
410*4882a593Smuzhiyun 	if (!TI_BANDGAP_HAS(bgp, COUNTER) &&
411*4882a593Smuzhiyun 	    !TI_BANDGAP_HAS(bgp, COUNTER_DELAY)) {
412*4882a593Smuzhiyun 		ret = -ENOTSUPP;
413*4882a593Smuzhiyun 		goto exit;
414*4882a593Smuzhiyun 	}
415*4882a593Smuzhiyun 
416*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, COUNTER)) {
417*4882a593Smuzhiyun 		ti_bandgap_read_counter(bgp, id, interval);
418*4882a593Smuzhiyun 		goto exit;
419*4882a593Smuzhiyun 	}
420*4882a593Smuzhiyun 
421*4882a593Smuzhiyun 	ti_bandgap_read_counter_delay(bgp, id, interval);
422*4882a593Smuzhiyun exit:
423*4882a593Smuzhiyun 	return ret;
424*4882a593Smuzhiyun }
425*4882a593Smuzhiyun 
426*4882a593Smuzhiyun /**
427*4882a593Smuzhiyun  * ti_bandgap_write_counter_delay() - set the counter_delay
428*4882a593Smuzhiyun  * @bgp: pointer to bandgap instance
429*4882a593Smuzhiyun  * @id: sensor id
430*4882a593Smuzhiyun  * @interval: desired update interval in miliseconds
431*4882a593Smuzhiyun  *
432*4882a593Smuzhiyun  * Return: 0 on success or the proper error code
433*4882a593Smuzhiyun  */
ti_bandgap_write_counter_delay(struct ti_bandgap * bgp,int id,u32 interval)434*4882a593Smuzhiyun static int ti_bandgap_write_counter_delay(struct ti_bandgap *bgp, int id,
435*4882a593Smuzhiyun 					  u32 interval)
436*4882a593Smuzhiyun {
437*4882a593Smuzhiyun 	int rval;
438*4882a593Smuzhiyun 
439*4882a593Smuzhiyun 	switch (interval) {
440*4882a593Smuzhiyun 	case 0: /* Immediate conversion */
441*4882a593Smuzhiyun 		rval = 0x0;
442*4882a593Smuzhiyun 		break;
443*4882a593Smuzhiyun 	case 1: /* Conversion after ever 1ms */
444*4882a593Smuzhiyun 		rval = 0x1;
445*4882a593Smuzhiyun 		break;
446*4882a593Smuzhiyun 	case 10: /* Conversion after ever 10ms */
447*4882a593Smuzhiyun 		rval = 0x2;
448*4882a593Smuzhiyun 		break;
449*4882a593Smuzhiyun 	case 100: /* Conversion after ever 100ms */
450*4882a593Smuzhiyun 		rval = 0x3;
451*4882a593Smuzhiyun 		break;
452*4882a593Smuzhiyun 	case 250: /* Conversion after ever 250ms */
453*4882a593Smuzhiyun 		rval = 0x4;
454*4882a593Smuzhiyun 		break;
455*4882a593Smuzhiyun 	case 500: /* Conversion after ever 500ms */
456*4882a593Smuzhiyun 		rval = 0x5;
457*4882a593Smuzhiyun 		break;
458*4882a593Smuzhiyun 	default:
459*4882a593Smuzhiyun 		dev_warn(bgp->dev, "Delay %d ms is not supported\n", interval);
460*4882a593Smuzhiyun 		return -EINVAL;
461*4882a593Smuzhiyun 	}
462*4882a593Smuzhiyun 
463*4882a593Smuzhiyun 	spin_lock(&bgp->lock);
464*4882a593Smuzhiyun 	RMW_BITS(bgp, id, bgap_mask_ctrl, mask_counter_delay_mask, rval);
465*4882a593Smuzhiyun 	spin_unlock(&bgp->lock);
466*4882a593Smuzhiyun 
467*4882a593Smuzhiyun 	return 0;
468*4882a593Smuzhiyun }
469*4882a593Smuzhiyun 
470*4882a593Smuzhiyun /**
471*4882a593Smuzhiyun  * ti_bandgap_write_counter() - set the bandgap sensor counter
472*4882a593Smuzhiyun  * @bgp: pointer to bandgap instance
473*4882a593Smuzhiyun  * @id: sensor id
474*4882a593Smuzhiyun  * @interval: desired update interval in miliseconds
475*4882a593Smuzhiyun  */
ti_bandgap_write_counter(struct ti_bandgap * bgp,int id,u32 interval)476*4882a593Smuzhiyun static void ti_bandgap_write_counter(struct ti_bandgap *bgp, int id,
477*4882a593Smuzhiyun 				     u32 interval)
478*4882a593Smuzhiyun {
479*4882a593Smuzhiyun 	interval = interval * bgp->clk_rate / 1000;
480*4882a593Smuzhiyun 	spin_lock(&bgp->lock);
481*4882a593Smuzhiyun 	RMW_BITS(bgp, id, bgap_counter, counter_mask, interval);
482*4882a593Smuzhiyun 	spin_unlock(&bgp->lock);
483*4882a593Smuzhiyun }
484*4882a593Smuzhiyun 
485*4882a593Smuzhiyun /**
486*4882a593Smuzhiyun  * ti_bandgap_write_update_interval() - set the update interval
487*4882a593Smuzhiyun  * @bgp: pointer to bandgap instance
488*4882a593Smuzhiyun  * @id: sensor id
489*4882a593Smuzhiyun  * @interval: desired update interval in miliseconds
490*4882a593Smuzhiyun  *
491*4882a593Smuzhiyun  * Return: 0 on success or the proper error code
492*4882a593Smuzhiyun  */
ti_bandgap_write_update_interval(struct ti_bandgap * bgp,int id,u32 interval)493*4882a593Smuzhiyun int ti_bandgap_write_update_interval(struct ti_bandgap *bgp,
494*4882a593Smuzhiyun 				     int id, u32 interval)
495*4882a593Smuzhiyun {
496*4882a593Smuzhiyun 	int ret = ti_bandgap_validate(bgp, id);
497*4882a593Smuzhiyun 	if (ret)
498*4882a593Smuzhiyun 		goto exit;
499*4882a593Smuzhiyun 
500*4882a593Smuzhiyun 	if (!TI_BANDGAP_HAS(bgp, COUNTER) &&
501*4882a593Smuzhiyun 	    !TI_BANDGAP_HAS(bgp, COUNTER_DELAY)) {
502*4882a593Smuzhiyun 		ret = -ENOTSUPP;
503*4882a593Smuzhiyun 		goto exit;
504*4882a593Smuzhiyun 	}
505*4882a593Smuzhiyun 
506*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, COUNTER)) {
507*4882a593Smuzhiyun 		ti_bandgap_write_counter(bgp, id, interval);
508*4882a593Smuzhiyun 		goto exit;
509*4882a593Smuzhiyun 	}
510*4882a593Smuzhiyun 
511*4882a593Smuzhiyun 	ret = ti_bandgap_write_counter_delay(bgp, id, interval);
512*4882a593Smuzhiyun exit:
513*4882a593Smuzhiyun 	return ret;
514*4882a593Smuzhiyun }
515*4882a593Smuzhiyun 
516*4882a593Smuzhiyun /**
517*4882a593Smuzhiyun  * ti_bandgap_read_temperature() - report current temperature
518*4882a593Smuzhiyun  * @bgp: pointer to bandgap instance
519*4882a593Smuzhiyun  * @id: sensor id
520*4882a593Smuzhiyun  * @temperature: resulting temperature
521*4882a593Smuzhiyun  *
522*4882a593Smuzhiyun  * Return: 0 on success or the proper error code
523*4882a593Smuzhiyun  */
ti_bandgap_read_temperature(struct ti_bandgap * bgp,int id,int * temperature)524*4882a593Smuzhiyun int ti_bandgap_read_temperature(struct ti_bandgap *bgp, int id,
525*4882a593Smuzhiyun 				int *temperature)
526*4882a593Smuzhiyun {
527*4882a593Smuzhiyun 	u32 temp;
528*4882a593Smuzhiyun 	int ret;
529*4882a593Smuzhiyun 
530*4882a593Smuzhiyun 	ret = ti_bandgap_validate(bgp, id);
531*4882a593Smuzhiyun 	if (ret)
532*4882a593Smuzhiyun 		return ret;
533*4882a593Smuzhiyun 
534*4882a593Smuzhiyun 	if (!TI_BANDGAP_HAS(bgp, MODE_CONFIG)) {
535*4882a593Smuzhiyun 		ret = ti_bandgap_force_single_read(bgp, id);
536*4882a593Smuzhiyun 		if (ret)
537*4882a593Smuzhiyun 			return ret;
538*4882a593Smuzhiyun 	}
539*4882a593Smuzhiyun 
540*4882a593Smuzhiyun 	spin_lock(&bgp->lock);
541*4882a593Smuzhiyun 	temp = ti_bandgap_read_temp(bgp, id);
542*4882a593Smuzhiyun 	spin_unlock(&bgp->lock);
543*4882a593Smuzhiyun 
544*4882a593Smuzhiyun 	ret = ti_bandgap_adc_to_mcelsius(bgp, temp, &temp);
545*4882a593Smuzhiyun 	if (ret)
546*4882a593Smuzhiyun 		return -EIO;
547*4882a593Smuzhiyun 
548*4882a593Smuzhiyun 	*temperature = temp;
549*4882a593Smuzhiyun 
550*4882a593Smuzhiyun 	return 0;
551*4882a593Smuzhiyun }
552*4882a593Smuzhiyun 
553*4882a593Smuzhiyun /**
554*4882a593Smuzhiyun  * ti_bandgap_set_sensor_data() - helper function to store thermal
555*4882a593Smuzhiyun  * framework related data.
556*4882a593Smuzhiyun  * @bgp: pointer to bandgap instance
557*4882a593Smuzhiyun  * @id: sensor id
558*4882a593Smuzhiyun  * @data: thermal framework related data to be stored
559*4882a593Smuzhiyun  *
560*4882a593Smuzhiyun  * Return: 0 on success or the proper error code
561*4882a593Smuzhiyun  */
ti_bandgap_set_sensor_data(struct ti_bandgap * bgp,int id,void * data)562*4882a593Smuzhiyun int ti_bandgap_set_sensor_data(struct ti_bandgap *bgp, int id, void *data)
563*4882a593Smuzhiyun {
564*4882a593Smuzhiyun 	int ret = ti_bandgap_validate(bgp, id);
565*4882a593Smuzhiyun 	if (ret)
566*4882a593Smuzhiyun 		return ret;
567*4882a593Smuzhiyun 
568*4882a593Smuzhiyun 	bgp->regval[id].data = data;
569*4882a593Smuzhiyun 
570*4882a593Smuzhiyun 	return 0;
571*4882a593Smuzhiyun }
572*4882a593Smuzhiyun 
573*4882a593Smuzhiyun /**
574*4882a593Smuzhiyun  * ti_bandgap_get_sensor_data() - helper function to get thermal
575*4882a593Smuzhiyun  * framework related data.
576*4882a593Smuzhiyun  * @bgp: pointer to bandgap instance
577*4882a593Smuzhiyun  * @id: sensor id
578*4882a593Smuzhiyun  *
579*4882a593Smuzhiyun  * Return: data stored by set function with sensor id on success or NULL
580*4882a593Smuzhiyun  */
ti_bandgap_get_sensor_data(struct ti_bandgap * bgp,int id)581*4882a593Smuzhiyun void *ti_bandgap_get_sensor_data(struct ti_bandgap *bgp, int id)
582*4882a593Smuzhiyun {
583*4882a593Smuzhiyun 	int ret = ti_bandgap_validate(bgp, id);
584*4882a593Smuzhiyun 	if (ret)
585*4882a593Smuzhiyun 		return ERR_PTR(ret);
586*4882a593Smuzhiyun 
587*4882a593Smuzhiyun 	return bgp->regval[id].data;
588*4882a593Smuzhiyun }
589*4882a593Smuzhiyun 
590*4882a593Smuzhiyun /***   Helper functions used during device initialization   ***/
591*4882a593Smuzhiyun 
592*4882a593Smuzhiyun /**
593*4882a593Smuzhiyun  * ti_bandgap_force_single_read() - executes 1 single ADC conversion
594*4882a593Smuzhiyun  * @bgp: pointer to struct ti_bandgap
595*4882a593Smuzhiyun  * @id: sensor id which it is desired to read 1 temperature
596*4882a593Smuzhiyun  *
597*4882a593Smuzhiyun  * Used to initialize the conversion state machine and set it to a valid
598*4882a593Smuzhiyun  * state. Called during device initialization and context restore events.
599*4882a593Smuzhiyun  *
600*4882a593Smuzhiyun  * Return: 0
601*4882a593Smuzhiyun  */
602*4882a593Smuzhiyun static int
ti_bandgap_force_single_read(struct ti_bandgap * bgp,int id)603*4882a593Smuzhiyun ti_bandgap_force_single_read(struct ti_bandgap *bgp, int id)
604*4882a593Smuzhiyun {
605*4882a593Smuzhiyun 	u32 counter = 1000;
606*4882a593Smuzhiyun 	struct temp_sensor_registers *tsr;
607*4882a593Smuzhiyun 
608*4882a593Smuzhiyun 	/* Select single conversion mode */
609*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, MODE_CONFIG))
610*4882a593Smuzhiyun 		RMW_BITS(bgp, id, bgap_mode_ctrl, mode_ctrl_mask, 0);
611*4882a593Smuzhiyun 
612*4882a593Smuzhiyun 	/* Start of Conversion = 1 */
613*4882a593Smuzhiyun 	RMW_BITS(bgp, id, temp_sensor_ctrl, bgap_soc_mask, 1);
614*4882a593Smuzhiyun 
615*4882a593Smuzhiyun 	/* Wait for EOCZ going up */
616*4882a593Smuzhiyun 	tsr = bgp->conf->sensors[id].registers;
617*4882a593Smuzhiyun 
618*4882a593Smuzhiyun 	while (--counter) {
619*4882a593Smuzhiyun 		if (ti_bandgap_readl(bgp, tsr->temp_sensor_ctrl) &
620*4882a593Smuzhiyun 		    tsr->bgap_eocz_mask)
621*4882a593Smuzhiyun 			break;
622*4882a593Smuzhiyun 	}
623*4882a593Smuzhiyun 
624*4882a593Smuzhiyun 	/* Start of Conversion = 0 */
625*4882a593Smuzhiyun 	RMW_BITS(bgp, id, temp_sensor_ctrl, bgap_soc_mask, 0);
626*4882a593Smuzhiyun 
627*4882a593Smuzhiyun 	/* Wait for EOCZ going down */
628*4882a593Smuzhiyun 	counter = 1000;
629*4882a593Smuzhiyun 	while (--counter) {
630*4882a593Smuzhiyun 		if (!(ti_bandgap_readl(bgp, tsr->temp_sensor_ctrl) &
631*4882a593Smuzhiyun 		      tsr->bgap_eocz_mask))
632*4882a593Smuzhiyun 			break;
633*4882a593Smuzhiyun 	}
634*4882a593Smuzhiyun 
635*4882a593Smuzhiyun 	return 0;
636*4882a593Smuzhiyun }
637*4882a593Smuzhiyun 
638*4882a593Smuzhiyun /**
639*4882a593Smuzhiyun  * ti_bandgap_set_continuous_mode() - One time enabling of continuous mode
640*4882a593Smuzhiyun  * @bgp: pointer to struct ti_bandgap
641*4882a593Smuzhiyun  *
642*4882a593Smuzhiyun  * Call this function only if HAS(MODE_CONFIG) is set. As this driver may
643*4882a593Smuzhiyun  * be used for junction temperature monitoring, it is desirable that the
644*4882a593Smuzhiyun  * sensors are operational all the time, so that alerts are generated
645*4882a593Smuzhiyun  * properly.
646*4882a593Smuzhiyun  *
647*4882a593Smuzhiyun  * Return: 0
648*4882a593Smuzhiyun  */
ti_bandgap_set_continuous_mode(struct ti_bandgap * bgp)649*4882a593Smuzhiyun static int ti_bandgap_set_continuous_mode(struct ti_bandgap *bgp)
650*4882a593Smuzhiyun {
651*4882a593Smuzhiyun 	int i;
652*4882a593Smuzhiyun 
653*4882a593Smuzhiyun 	for (i = 0; i < bgp->conf->sensor_count; i++) {
654*4882a593Smuzhiyun 		/* Perform a single read just before enabling continuous */
655*4882a593Smuzhiyun 		ti_bandgap_force_single_read(bgp, i);
656*4882a593Smuzhiyun 		RMW_BITS(bgp, i, bgap_mode_ctrl, mode_ctrl_mask, 1);
657*4882a593Smuzhiyun 	}
658*4882a593Smuzhiyun 
659*4882a593Smuzhiyun 	return 0;
660*4882a593Smuzhiyun }
661*4882a593Smuzhiyun 
662*4882a593Smuzhiyun /**
663*4882a593Smuzhiyun  * ti_bandgap_get_trend() - To fetch the temperature trend of a sensor
664*4882a593Smuzhiyun  * @bgp: pointer to struct ti_bandgap
665*4882a593Smuzhiyun  * @id: id of the individual sensor
666*4882a593Smuzhiyun  * @trend: Pointer to trend.
667*4882a593Smuzhiyun  *
668*4882a593Smuzhiyun  * This function needs to be called to fetch the temperature trend of a
669*4882a593Smuzhiyun  * Particular sensor. The function computes the difference in temperature
670*4882a593Smuzhiyun  * w.r.t time. For the bandgaps with built in history buffer the temperatures
671*4882a593Smuzhiyun  * are read from the buffer and for those without the Buffer -ENOTSUPP is
672*4882a593Smuzhiyun  * returned.
673*4882a593Smuzhiyun  *
674*4882a593Smuzhiyun  * Return: 0 if no error, else return corresponding error. If no
675*4882a593Smuzhiyun  *		error then the trend value is passed on to trend parameter
676*4882a593Smuzhiyun  */
ti_bandgap_get_trend(struct ti_bandgap * bgp,int id,int * trend)677*4882a593Smuzhiyun int ti_bandgap_get_trend(struct ti_bandgap *bgp, int id, int *trend)
678*4882a593Smuzhiyun {
679*4882a593Smuzhiyun 	struct temp_sensor_registers *tsr;
680*4882a593Smuzhiyun 	u32 temp1, temp2, reg1, reg2;
681*4882a593Smuzhiyun 	int t1, t2, interval, ret = 0;
682*4882a593Smuzhiyun 
683*4882a593Smuzhiyun 	ret = ti_bandgap_validate(bgp, id);
684*4882a593Smuzhiyun 	if (ret)
685*4882a593Smuzhiyun 		goto exit;
686*4882a593Smuzhiyun 
687*4882a593Smuzhiyun 	if (!TI_BANDGAP_HAS(bgp, HISTORY_BUFFER) ||
688*4882a593Smuzhiyun 	    !TI_BANDGAP_HAS(bgp, FREEZE_BIT)) {
689*4882a593Smuzhiyun 		ret = -ENOTSUPP;
690*4882a593Smuzhiyun 		goto exit;
691*4882a593Smuzhiyun 	}
692*4882a593Smuzhiyun 
693*4882a593Smuzhiyun 	spin_lock(&bgp->lock);
694*4882a593Smuzhiyun 
695*4882a593Smuzhiyun 	tsr = bgp->conf->sensors[id].registers;
696*4882a593Smuzhiyun 
697*4882a593Smuzhiyun 	/* Freeze and read the last 2 valid readings */
698*4882a593Smuzhiyun 	RMW_BITS(bgp, id, bgap_mask_ctrl, mask_freeze_mask, 1);
699*4882a593Smuzhiyun 	reg1 = tsr->ctrl_dtemp_1;
700*4882a593Smuzhiyun 	reg2 = tsr->ctrl_dtemp_2;
701*4882a593Smuzhiyun 
702*4882a593Smuzhiyun 	/* read temperature from history buffer */
703*4882a593Smuzhiyun 	temp1 = ti_bandgap_readl(bgp, reg1);
704*4882a593Smuzhiyun 	temp1 &= tsr->bgap_dtemp_mask;
705*4882a593Smuzhiyun 
706*4882a593Smuzhiyun 	temp2 = ti_bandgap_readl(bgp, reg2);
707*4882a593Smuzhiyun 	temp2 &= tsr->bgap_dtemp_mask;
708*4882a593Smuzhiyun 
709*4882a593Smuzhiyun 	/* Convert from adc values to mCelsius temperature */
710*4882a593Smuzhiyun 	ret = ti_bandgap_adc_to_mcelsius(bgp, temp1, &t1);
711*4882a593Smuzhiyun 	if (ret)
712*4882a593Smuzhiyun 		goto unfreeze;
713*4882a593Smuzhiyun 
714*4882a593Smuzhiyun 	ret = ti_bandgap_adc_to_mcelsius(bgp, temp2, &t2);
715*4882a593Smuzhiyun 	if (ret)
716*4882a593Smuzhiyun 		goto unfreeze;
717*4882a593Smuzhiyun 
718*4882a593Smuzhiyun 	/* Fetch the update interval */
719*4882a593Smuzhiyun 	ret = ti_bandgap_read_update_interval(bgp, id, &interval);
720*4882a593Smuzhiyun 	if (ret)
721*4882a593Smuzhiyun 		goto unfreeze;
722*4882a593Smuzhiyun 
723*4882a593Smuzhiyun 	/* Set the interval to 1 ms if bandgap counter delay is not set */
724*4882a593Smuzhiyun 	if (interval == 0)
725*4882a593Smuzhiyun 		interval = 1;
726*4882a593Smuzhiyun 
727*4882a593Smuzhiyun 	*trend = (t1 - t2) / interval;
728*4882a593Smuzhiyun 
729*4882a593Smuzhiyun 	dev_dbg(bgp->dev, "The temperatures are t1 = %d and t2 = %d and trend =%d\n",
730*4882a593Smuzhiyun 		t1, t2, *trend);
731*4882a593Smuzhiyun 
732*4882a593Smuzhiyun unfreeze:
733*4882a593Smuzhiyun 	RMW_BITS(bgp, id, bgap_mask_ctrl, mask_freeze_mask, 0);
734*4882a593Smuzhiyun 	spin_unlock(&bgp->lock);
735*4882a593Smuzhiyun exit:
736*4882a593Smuzhiyun 	return ret;
737*4882a593Smuzhiyun }
738*4882a593Smuzhiyun 
739*4882a593Smuzhiyun /**
740*4882a593Smuzhiyun  * ti_bandgap_tshut_init() - setup and initialize tshut handling
741*4882a593Smuzhiyun  * @bgp: pointer to struct ti_bandgap
742*4882a593Smuzhiyun  * @pdev: pointer to device struct platform_device
743*4882a593Smuzhiyun  *
744*4882a593Smuzhiyun  * Call this function only in case the bandgap features HAS(TSHUT).
745*4882a593Smuzhiyun  * In this case, the driver needs to handle the TSHUT signal as an IRQ.
746*4882a593Smuzhiyun  * The IRQ is wired as a GPIO, and for this purpose, it is required
747*4882a593Smuzhiyun  * to specify which GPIO line is used. TSHUT IRQ is fired anytime
748*4882a593Smuzhiyun  * one of the bandgap sensors violates the TSHUT high/hot threshold.
749*4882a593Smuzhiyun  * And in that case, the system must go off.
750*4882a593Smuzhiyun  *
751*4882a593Smuzhiyun  * Return: 0 if no error, else error status
752*4882a593Smuzhiyun  */
ti_bandgap_tshut_init(struct ti_bandgap * bgp,struct platform_device * pdev)753*4882a593Smuzhiyun static int ti_bandgap_tshut_init(struct ti_bandgap *bgp,
754*4882a593Smuzhiyun 				 struct platform_device *pdev)
755*4882a593Smuzhiyun {
756*4882a593Smuzhiyun 	int status;
757*4882a593Smuzhiyun 
758*4882a593Smuzhiyun 	status = request_irq(gpiod_to_irq(bgp->tshut_gpiod),
759*4882a593Smuzhiyun 			     ti_bandgap_tshut_irq_handler,
760*4882a593Smuzhiyun 			     IRQF_TRIGGER_RISING, "tshut", NULL);
761*4882a593Smuzhiyun 	if (status)
762*4882a593Smuzhiyun 		dev_err(bgp->dev, "request irq failed for TSHUT");
763*4882a593Smuzhiyun 
764*4882a593Smuzhiyun 	return 0;
765*4882a593Smuzhiyun }
766*4882a593Smuzhiyun 
767*4882a593Smuzhiyun /**
768*4882a593Smuzhiyun  * ti_bandgap_alert_init() - setup and initialize talert handling
769*4882a593Smuzhiyun  * @bgp: pointer to struct ti_bandgap
770*4882a593Smuzhiyun  * @pdev: pointer to device struct platform_device
771*4882a593Smuzhiyun  *
772*4882a593Smuzhiyun  * Call this function only in case the bandgap features HAS(TALERT).
773*4882a593Smuzhiyun  * In this case, the driver needs to handle the TALERT signals as an IRQs.
774*4882a593Smuzhiyun  * TALERT is a normal IRQ and it is fired any time thresholds (hot or cold)
775*4882a593Smuzhiyun  * are violated. In these situation, the driver must reprogram the thresholds,
776*4882a593Smuzhiyun  * accordingly to specified policy.
777*4882a593Smuzhiyun  *
778*4882a593Smuzhiyun  * Return: 0 if no error, else return corresponding error.
779*4882a593Smuzhiyun  */
ti_bandgap_talert_init(struct ti_bandgap * bgp,struct platform_device * pdev)780*4882a593Smuzhiyun static int ti_bandgap_talert_init(struct ti_bandgap *bgp,
781*4882a593Smuzhiyun 				  struct platform_device *pdev)
782*4882a593Smuzhiyun {
783*4882a593Smuzhiyun 	int ret;
784*4882a593Smuzhiyun 
785*4882a593Smuzhiyun 	bgp->irq = platform_get_irq(pdev, 0);
786*4882a593Smuzhiyun 	if (bgp->irq < 0)
787*4882a593Smuzhiyun 		return bgp->irq;
788*4882a593Smuzhiyun 
789*4882a593Smuzhiyun 	ret = request_threaded_irq(bgp->irq, NULL,
790*4882a593Smuzhiyun 				   ti_bandgap_talert_irq_handler,
791*4882a593Smuzhiyun 				   IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
792*4882a593Smuzhiyun 				   "talert", bgp);
793*4882a593Smuzhiyun 	if (ret) {
794*4882a593Smuzhiyun 		dev_err(&pdev->dev, "Request threaded irq failed.\n");
795*4882a593Smuzhiyun 		return ret;
796*4882a593Smuzhiyun 	}
797*4882a593Smuzhiyun 
798*4882a593Smuzhiyun 	return 0;
799*4882a593Smuzhiyun }
800*4882a593Smuzhiyun 
801*4882a593Smuzhiyun static const struct of_device_id of_ti_bandgap_match[];
802*4882a593Smuzhiyun /**
803*4882a593Smuzhiyun  * ti_bandgap_build() - parse DT and setup a struct ti_bandgap
804*4882a593Smuzhiyun  * @pdev: pointer to device struct platform_device
805*4882a593Smuzhiyun  *
806*4882a593Smuzhiyun  * Used to read the device tree properties accordingly to the bandgap
807*4882a593Smuzhiyun  * matching version. Based on bandgap version and its capabilities it
808*4882a593Smuzhiyun  * will build a struct ti_bandgap out of the required DT entries.
809*4882a593Smuzhiyun  *
810*4882a593Smuzhiyun  * Return: valid bandgap structure if successful, else returns ERR_PTR
811*4882a593Smuzhiyun  * return value must be verified with IS_ERR.
812*4882a593Smuzhiyun  */
ti_bandgap_build(struct platform_device * pdev)813*4882a593Smuzhiyun static struct ti_bandgap *ti_bandgap_build(struct platform_device *pdev)
814*4882a593Smuzhiyun {
815*4882a593Smuzhiyun 	struct device_node *node = pdev->dev.of_node;
816*4882a593Smuzhiyun 	const struct of_device_id *of_id;
817*4882a593Smuzhiyun 	struct ti_bandgap *bgp;
818*4882a593Smuzhiyun 	struct resource *res;
819*4882a593Smuzhiyun 	int i;
820*4882a593Smuzhiyun 
821*4882a593Smuzhiyun 	/* just for the sake */
822*4882a593Smuzhiyun 	if (!node) {
823*4882a593Smuzhiyun 		dev_err(&pdev->dev, "no platform information available\n");
824*4882a593Smuzhiyun 		return ERR_PTR(-EINVAL);
825*4882a593Smuzhiyun 	}
826*4882a593Smuzhiyun 
827*4882a593Smuzhiyun 	bgp = devm_kzalloc(&pdev->dev, sizeof(*bgp), GFP_KERNEL);
828*4882a593Smuzhiyun 	if (!bgp)
829*4882a593Smuzhiyun 		return ERR_PTR(-ENOMEM);
830*4882a593Smuzhiyun 
831*4882a593Smuzhiyun 	of_id = of_match_device(of_ti_bandgap_match, &pdev->dev);
832*4882a593Smuzhiyun 	if (of_id)
833*4882a593Smuzhiyun 		bgp->conf = of_id->data;
834*4882a593Smuzhiyun 
835*4882a593Smuzhiyun 	/* register shadow for context save and restore */
836*4882a593Smuzhiyun 	bgp->regval = devm_kcalloc(&pdev->dev, bgp->conf->sensor_count,
837*4882a593Smuzhiyun 				   sizeof(*bgp->regval), GFP_KERNEL);
838*4882a593Smuzhiyun 	if (!bgp->regval)
839*4882a593Smuzhiyun 		return ERR_PTR(-ENOMEM);
840*4882a593Smuzhiyun 
841*4882a593Smuzhiyun 	i = 0;
842*4882a593Smuzhiyun 	do {
843*4882a593Smuzhiyun 		void __iomem *chunk;
844*4882a593Smuzhiyun 
845*4882a593Smuzhiyun 		res = platform_get_resource(pdev, IORESOURCE_MEM, i);
846*4882a593Smuzhiyun 		if (!res)
847*4882a593Smuzhiyun 			break;
848*4882a593Smuzhiyun 		chunk = devm_ioremap_resource(&pdev->dev, res);
849*4882a593Smuzhiyun 		if (i == 0)
850*4882a593Smuzhiyun 			bgp->base = chunk;
851*4882a593Smuzhiyun 		if (IS_ERR(chunk))
852*4882a593Smuzhiyun 			return ERR_CAST(chunk);
853*4882a593Smuzhiyun 
854*4882a593Smuzhiyun 		i++;
855*4882a593Smuzhiyun 	} while (res);
856*4882a593Smuzhiyun 
857*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, TSHUT)) {
858*4882a593Smuzhiyun 		bgp->tshut_gpiod = devm_gpiod_get(&pdev->dev, NULL, GPIOD_IN);
859*4882a593Smuzhiyun 		if (IS_ERR(bgp->tshut_gpiod)) {
860*4882a593Smuzhiyun 			dev_err(&pdev->dev, "invalid gpio for tshut\n");
861*4882a593Smuzhiyun 			return ERR_CAST(bgp->tshut_gpiod);
862*4882a593Smuzhiyun 		}
863*4882a593Smuzhiyun 	}
864*4882a593Smuzhiyun 
865*4882a593Smuzhiyun 	return bgp;
866*4882a593Smuzhiyun }
867*4882a593Smuzhiyun 
868*4882a593Smuzhiyun /*
869*4882a593Smuzhiyun  * List of SoCs on which the CPU PM notifier can cause erros on the DTEMP
870*4882a593Smuzhiyun  * readout.
871*4882a593Smuzhiyun  * Enabled notifier on these machines results in erroneous, random values which
872*4882a593Smuzhiyun  * could trigger unexpected thermal shutdown.
873*4882a593Smuzhiyun  */
874*4882a593Smuzhiyun static const struct soc_device_attribute soc_no_cpu_notifier[] = {
875*4882a593Smuzhiyun 	{ .machine = "OMAP4430" },
876*4882a593Smuzhiyun 	{ /* sentinel */ },
877*4882a593Smuzhiyun };
878*4882a593Smuzhiyun 
879*4882a593Smuzhiyun /***   Device driver call backs   ***/
880*4882a593Smuzhiyun 
881*4882a593Smuzhiyun static
ti_bandgap_probe(struct platform_device * pdev)882*4882a593Smuzhiyun int ti_bandgap_probe(struct platform_device *pdev)
883*4882a593Smuzhiyun {
884*4882a593Smuzhiyun 	struct ti_bandgap *bgp;
885*4882a593Smuzhiyun 	int clk_rate, ret, i;
886*4882a593Smuzhiyun 
887*4882a593Smuzhiyun 	bgp = ti_bandgap_build(pdev);
888*4882a593Smuzhiyun 	if (IS_ERR(bgp)) {
889*4882a593Smuzhiyun 		dev_err(&pdev->dev, "failed to fetch platform data\n");
890*4882a593Smuzhiyun 		return PTR_ERR(bgp);
891*4882a593Smuzhiyun 	}
892*4882a593Smuzhiyun 	bgp->dev = &pdev->dev;
893*4882a593Smuzhiyun 
894*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, UNRELIABLE))
895*4882a593Smuzhiyun 		dev_warn(&pdev->dev,
896*4882a593Smuzhiyun 			 "This OMAP thermal sensor is unreliable. You've been warned\n");
897*4882a593Smuzhiyun 
898*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, TSHUT)) {
899*4882a593Smuzhiyun 		ret = ti_bandgap_tshut_init(bgp, pdev);
900*4882a593Smuzhiyun 		if (ret) {
901*4882a593Smuzhiyun 			dev_err(&pdev->dev,
902*4882a593Smuzhiyun 				"failed to initialize system tshut IRQ\n");
903*4882a593Smuzhiyun 			return ret;
904*4882a593Smuzhiyun 		}
905*4882a593Smuzhiyun 	}
906*4882a593Smuzhiyun 
907*4882a593Smuzhiyun 	bgp->fclock = clk_get(NULL, bgp->conf->fclock_name);
908*4882a593Smuzhiyun 	if (IS_ERR(bgp->fclock)) {
909*4882a593Smuzhiyun 		dev_err(&pdev->dev, "failed to request fclock reference\n");
910*4882a593Smuzhiyun 		ret = PTR_ERR(bgp->fclock);
911*4882a593Smuzhiyun 		goto free_irqs;
912*4882a593Smuzhiyun 	}
913*4882a593Smuzhiyun 
914*4882a593Smuzhiyun 	bgp->div_clk = clk_get(NULL, bgp->conf->div_ck_name);
915*4882a593Smuzhiyun 	if (IS_ERR(bgp->div_clk)) {
916*4882a593Smuzhiyun 		dev_err(&pdev->dev, "failed to request div_ts_ck clock ref\n");
917*4882a593Smuzhiyun 		ret = PTR_ERR(bgp->div_clk);
918*4882a593Smuzhiyun 		goto put_fclock;
919*4882a593Smuzhiyun 	}
920*4882a593Smuzhiyun 
921*4882a593Smuzhiyun 	for (i = 0; i < bgp->conf->sensor_count; i++) {
922*4882a593Smuzhiyun 		struct temp_sensor_registers *tsr;
923*4882a593Smuzhiyun 		u32 val;
924*4882a593Smuzhiyun 
925*4882a593Smuzhiyun 		tsr = bgp->conf->sensors[i].registers;
926*4882a593Smuzhiyun 		/*
927*4882a593Smuzhiyun 		 * check if the efuse has a non-zero value if not
928*4882a593Smuzhiyun 		 * it is an untrimmed sample and the temperatures
929*4882a593Smuzhiyun 		 * may not be accurate
930*4882a593Smuzhiyun 		 */
931*4882a593Smuzhiyun 		val = ti_bandgap_readl(bgp, tsr->bgap_efuse);
932*4882a593Smuzhiyun 		if (!val)
933*4882a593Smuzhiyun 			dev_info(&pdev->dev,
934*4882a593Smuzhiyun 				 "Non-trimmed BGAP, Temp not accurate\n");
935*4882a593Smuzhiyun 	}
936*4882a593Smuzhiyun 
937*4882a593Smuzhiyun 	clk_rate = clk_round_rate(bgp->div_clk,
938*4882a593Smuzhiyun 				  bgp->conf->sensors[0].ts_data->max_freq);
939*4882a593Smuzhiyun 	if (clk_rate < bgp->conf->sensors[0].ts_data->min_freq ||
940*4882a593Smuzhiyun 	    clk_rate <= 0) {
941*4882a593Smuzhiyun 		ret = -ENODEV;
942*4882a593Smuzhiyun 		dev_err(&pdev->dev, "wrong clock rate (%d)\n", clk_rate);
943*4882a593Smuzhiyun 		goto put_clks;
944*4882a593Smuzhiyun 	}
945*4882a593Smuzhiyun 
946*4882a593Smuzhiyun 	ret = clk_set_rate(bgp->div_clk, clk_rate);
947*4882a593Smuzhiyun 	if (ret)
948*4882a593Smuzhiyun 		dev_err(&pdev->dev, "Cannot re-set clock rate. Continuing\n");
949*4882a593Smuzhiyun 
950*4882a593Smuzhiyun 	bgp->clk_rate = clk_rate;
951*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, CLK_CTRL))
952*4882a593Smuzhiyun 		clk_prepare_enable(bgp->fclock);
953*4882a593Smuzhiyun 
954*4882a593Smuzhiyun 
955*4882a593Smuzhiyun 	spin_lock_init(&bgp->lock);
956*4882a593Smuzhiyun 	bgp->dev = &pdev->dev;
957*4882a593Smuzhiyun 	platform_set_drvdata(pdev, bgp);
958*4882a593Smuzhiyun 
959*4882a593Smuzhiyun 	ti_bandgap_power(bgp, true);
960*4882a593Smuzhiyun 
961*4882a593Smuzhiyun 	/* Set default counter to 1 for now */
962*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, COUNTER))
963*4882a593Smuzhiyun 		for (i = 0; i < bgp->conf->sensor_count; i++)
964*4882a593Smuzhiyun 			RMW_BITS(bgp, i, bgap_counter, counter_mask, 1);
965*4882a593Smuzhiyun 
966*4882a593Smuzhiyun 	/* Set default thresholds for alert and shutdown */
967*4882a593Smuzhiyun 	for (i = 0; i < bgp->conf->sensor_count; i++) {
968*4882a593Smuzhiyun 		struct temp_sensor_data *ts_data;
969*4882a593Smuzhiyun 
970*4882a593Smuzhiyun 		ts_data = bgp->conf->sensors[i].ts_data;
971*4882a593Smuzhiyun 
972*4882a593Smuzhiyun 		if (TI_BANDGAP_HAS(bgp, TALERT)) {
973*4882a593Smuzhiyun 			/* Set initial Talert thresholds */
974*4882a593Smuzhiyun 			RMW_BITS(bgp, i, bgap_threshold,
975*4882a593Smuzhiyun 				 threshold_tcold_mask, ts_data->t_cold);
976*4882a593Smuzhiyun 			RMW_BITS(bgp, i, bgap_threshold,
977*4882a593Smuzhiyun 				 threshold_thot_mask, ts_data->t_hot);
978*4882a593Smuzhiyun 			/* Enable the alert events */
979*4882a593Smuzhiyun 			RMW_BITS(bgp, i, bgap_mask_ctrl, mask_hot_mask, 1);
980*4882a593Smuzhiyun 			RMW_BITS(bgp, i, bgap_mask_ctrl, mask_cold_mask, 1);
981*4882a593Smuzhiyun 		}
982*4882a593Smuzhiyun 
983*4882a593Smuzhiyun 		if (TI_BANDGAP_HAS(bgp, TSHUT_CONFIG)) {
984*4882a593Smuzhiyun 			/* Set initial Tshut thresholds */
985*4882a593Smuzhiyun 			RMW_BITS(bgp, i, tshut_threshold,
986*4882a593Smuzhiyun 				 tshut_hot_mask, ts_data->tshut_hot);
987*4882a593Smuzhiyun 			RMW_BITS(bgp, i, tshut_threshold,
988*4882a593Smuzhiyun 				 tshut_cold_mask, ts_data->tshut_cold);
989*4882a593Smuzhiyun 		}
990*4882a593Smuzhiyun 	}
991*4882a593Smuzhiyun 
992*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, MODE_CONFIG))
993*4882a593Smuzhiyun 		ti_bandgap_set_continuous_mode(bgp);
994*4882a593Smuzhiyun 
995*4882a593Smuzhiyun 	/* Set .250 seconds time as default counter */
996*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, COUNTER))
997*4882a593Smuzhiyun 		for (i = 0; i < bgp->conf->sensor_count; i++)
998*4882a593Smuzhiyun 			RMW_BITS(bgp, i, bgap_counter, counter_mask,
999*4882a593Smuzhiyun 				 bgp->clk_rate / 4);
1000*4882a593Smuzhiyun 
1001*4882a593Smuzhiyun 	/* Every thing is good? Then expose the sensors */
1002*4882a593Smuzhiyun 	for (i = 0; i < bgp->conf->sensor_count; i++) {
1003*4882a593Smuzhiyun 		char *domain;
1004*4882a593Smuzhiyun 
1005*4882a593Smuzhiyun 		if (bgp->conf->sensors[i].register_cooling) {
1006*4882a593Smuzhiyun 			ret = bgp->conf->sensors[i].register_cooling(bgp, i);
1007*4882a593Smuzhiyun 			if (ret)
1008*4882a593Smuzhiyun 				goto remove_sensors;
1009*4882a593Smuzhiyun 		}
1010*4882a593Smuzhiyun 
1011*4882a593Smuzhiyun 		if (bgp->conf->expose_sensor) {
1012*4882a593Smuzhiyun 			domain = bgp->conf->sensors[i].domain;
1013*4882a593Smuzhiyun 			ret = bgp->conf->expose_sensor(bgp, i, domain);
1014*4882a593Smuzhiyun 			if (ret)
1015*4882a593Smuzhiyun 				goto remove_last_cooling;
1016*4882a593Smuzhiyun 		}
1017*4882a593Smuzhiyun 	}
1018*4882a593Smuzhiyun 
1019*4882a593Smuzhiyun 	/*
1020*4882a593Smuzhiyun 	 * Enable the Interrupts once everything is set. Otherwise irq handler
1021*4882a593Smuzhiyun 	 * might be called as soon as it is enabled where as rest of framework
1022*4882a593Smuzhiyun 	 * is still getting initialised.
1023*4882a593Smuzhiyun 	 */
1024*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, TALERT)) {
1025*4882a593Smuzhiyun 		ret = ti_bandgap_talert_init(bgp, pdev);
1026*4882a593Smuzhiyun 		if (ret) {
1027*4882a593Smuzhiyun 			dev_err(&pdev->dev, "failed to initialize Talert IRQ\n");
1028*4882a593Smuzhiyun 			i = bgp->conf->sensor_count;
1029*4882a593Smuzhiyun 			goto disable_clk;
1030*4882a593Smuzhiyun 		}
1031*4882a593Smuzhiyun 	}
1032*4882a593Smuzhiyun 
1033*4882a593Smuzhiyun #ifdef CONFIG_PM_SLEEP
1034*4882a593Smuzhiyun 	bgp->nb.notifier_call = bandgap_omap_cpu_notifier;
1035*4882a593Smuzhiyun 	if (!soc_device_match(soc_no_cpu_notifier))
1036*4882a593Smuzhiyun 		cpu_pm_register_notifier(&bgp->nb);
1037*4882a593Smuzhiyun #endif
1038*4882a593Smuzhiyun 
1039*4882a593Smuzhiyun 	return 0;
1040*4882a593Smuzhiyun 
1041*4882a593Smuzhiyun remove_last_cooling:
1042*4882a593Smuzhiyun 	if (bgp->conf->sensors[i].unregister_cooling)
1043*4882a593Smuzhiyun 		bgp->conf->sensors[i].unregister_cooling(bgp, i);
1044*4882a593Smuzhiyun remove_sensors:
1045*4882a593Smuzhiyun 	for (i--; i >= 0; i--) {
1046*4882a593Smuzhiyun 		if (bgp->conf->sensors[i].unregister_cooling)
1047*4882a593Smuzhiyun 			bgp->conf->sensors[i].unregister_cooling(bgp, i);
1048*4882a593Smuzhiyun 		if (bgp->conf->remove_sensor)
1049*4882a593Smuzhiyun 			bgp->conf->remove_sensor(bgp, i);
1050*4882a593Smuzhiyun 	}
1051*4882a593Smuzhiyun 	ti_bandgap_power(bgp, false);
1052*4882a593Smuzhiyun disable_clk:
1053*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, CLK_CTRL))
1054*4882a593Smuzhiyun 		clk_disable_unprepare(bgp->fclock);
1055*4882a593Smuzhiyun put_clks:
1056*4882a593Smuzhiyun 	clk_put(bgp->div_clk);
1057*4882a593Smuzhiyun put_fclock:
1058*4882a593Smuzhiyun 	clk_put(bgp->fclock);
1059*4882a593Smuzhiyun free_irqs:
1060*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, TSHUT))
1061*4882a593Smuzhiyun 		free_irq(gpiod_to_irq(bgp->tshut_gpiod), NULL);
1062*4882a593Smuzhiyun 
1063*4882a593Smuzhiyun 	return ret;
1064*4882a593Smuzhiyun }
1065*4882a593Smuzhiyun 
1066*4882a593Smuzhiyun static
ti_bandgap_remove(struct platform_device * pdev)1067*4882a593Smuzhiyun int ti_bandgap_remove(struct platform_device *pdev)
1068*4882a593Smuzhiyun {
1069*4882a593Smuzhiyun 	struct ti_bandgap *bgp = platform_get_drvdata(pdev);
1070*4882a593Smuzhiyun 	int i;
1071*4882a593Smuzhiyun 
1072*4882a593Smuzhiyun 	if (!soc_device_match(soc_no_cpu_notifier))
1073*4882a593Smuzhiyun 		cpu_pm_unregister_notifier(&bgp->nb);
1074*4882a593Smuzhiyun 
1075*4882a593Smuzhiyun 	/* Remove sensor interfaces */
1076*4882a593Smuzhiyun 	for (i = 0; i < bgp->conf->sensor_count; i++) {
1077*4882a593Smuzhiyun 		if (bgp->conf->sensors[i].unregister_cooling)
1078*4882a593Smuzhiyun 			bgp->conf->sensors[i].unregister_cooling(bgp, i);
1079*4882a593Smuzhiyun 
1080*4882a593Smuzhiyun 		if (bgp->conf->remove_sensor)
1081*4882a593Smuzhiyun 			bgp->conf->remove_sensor(bgp, i);
1082*4882a593Smuzhiyun 	}
1083*4882a593Smuzhiyun 
1084*4882a593Smuzhiyun 	ti_bandgap_power(bgp, false);
1085*4882a593Smuzhiyun 
1086*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, CLK_CTRL))
1087*4882a593Smuzhiyun 		clk_disable_unprepare(bgp->fclock);
1088*4882a593Smuzhiyun 	clk_put(bgp->fclock);
1089*4882a593Smuzhiyun 	clk_put(bgp->div_clk);
1090*4882a593Smuzhiyun 
1091*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, TALERT))
1092*4882a593Smuzhiyun 		free_irq(bgp->irq, bgp);
1093*4882a593Smuzhiyun 
1094*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, TSHUT))
1095*4882a593Smuzhiyun 		free_irq(gpiod_to_irq(bgp->tshut_gpiod), NULL);
1096*4882a593Smuzhiyun 
1097*4882a593Smuzhiyun 	return 0;
1098*4882a593Smuzhiyun }
1099*4882a593Smuzhiyun 
1100*4882a593Smuzhiyun #ifdef CONFIG_PM_SLEEP
ti_bandgap_save_ctxt(struct ti_bandgap * bgp)1101*4882a593Smuzhiyun static int ti_bandgap_save_ctxt(struct ti_bandgap *bgp)
1102*4882a593Smuzhiyun {
1103*4882a593Smuzhiyun 	int i;
1104*4882a593Smuzhiyun 
1105*4882a593Smuzhiyun 	for (i = 0; i < bgp->conf->sensor_count; i++) {
1106*4882a593Smuzhiyun 		struct temp_sensor_registers *tsr;
1107*4882a593Smuzhiyun 		struct temp_sensor_regval *rval;
1108*4882a593Smuzhiyun 
1109*4882a593Smuzhiyun 		rval = &bgp->regval[i];
1110*4882a593Smuzhiyun 		tsr = bgp->conf->sensors[i].registers;
1111*4882a593Smuzhiyun 
1112*4882a593Smuzhiyun 		if (TI_BANDGAP_HAS(bgp, MODE_CONFIG))
1113*4882a593Smuzhiyun 			rval->bg_mode_ctrl = ti_bandgap_readl(bgp,
1114*4882a593Smuzhiyun 							tsr->bgap_mode_ctrl);
1115*4882a593Smuzhiyun 		if (TI_BANDGAP_HAS(bgp, COUNTER))
1116*4882a593Smuzhiyun 			rval->bg_counter = ti_bandgap_readl(bgp,
1117*4882a593Smuzhiyun 							tsr->bgap_counter);
1118*4882a593Smuzhiyun 		if (TI_BANDGAP_HAS(bgp, TALERT)) {
1119*4882a593Smuzhiyun 			rval->bg_threshold = ti_bandgap_readl(bgp,
1120*4882a593Smuzhiyun 							tsr->bgap_threshold);
1121*4882a593Smuzhiyun 			rval->bg_ctrl = ti_bandgap_readl(bgp,
1122*4882a593Smuzhiyun 						   tsr->bgap_mask_ctrl);
1123*4882a593Smuzhiyun 		}
1124*4882a593Smuzhiyun 
1125*4882a593Smuzhiyun 		if (TI_BANDGAP_HAS(bgp, TSHUT_CONFIG))
1126*4882a593Smuzhiyun 			rval->tshut_threshold = ti_bandgap_readl(bgp,
1127*4882a593Smuzhiyun 						   tsr->tshut_threshold);
1128*4882a593Smuzhiyun 	}
1129*4882a593Smuzhiyun 
1130*4882a593Smuzhiyun 	return 0;
1131*4882a593Smuzhiyun }
1132*4882a593Smuzhiyun 
ti_bandgap_restore_ctxt(struct ti_bandgap * bgp)1133*4882a593Smuzhiyun static int ti_bandgap_restore_ctxt(struct ti_bandgap *bgp)
1134*4882a593Smuzhiyun {
1135*4882a593Smuzhiyun 	int i;
1136*4882a593Smuzhiyun 
1137*4882a593Smuzhiyun 	for (i = 0; i < bgp->conf->sensor_count; i++) {
1138*4882a593Smuzhiyun 		struct temp_sensor_registers *tsr;
1139*4882a593Smuzhiyun 		struct temp_sensor_regval *rval;
1140*4882a593Smuzhiyun 		u32 val = 0;
1141*4882a593Smuzhiyun 
1142*4882a593Smuzhiyun 		rval = &bgp->regval[i];
1143*4882a593Smuzhiyun 		tsr = bgp->conf->sensors[i].registers;
1144*4882a593Smuzhiyun 
1145*4882a593Smuzhiyun 		if (TI_BANDGAP_HAS(bgp, COUNTER))
1146*4882a593Smuzhiyun 			val = ti_bandgap_readl(bgp, tsr->bgap_counter);
1147*4882a593Smuzhiyun 
1148*4882a593Smuzhiyun 		if (TI_BANDGAP_HAS(bgp, TSHUT_CONFIG))
1149*4882a593Smuzhiyun 			ti_bandgap_writel(bgp, rval->tshut_threshold,
1150*4882a593Smuzhiyun 					  tsr->tshut_threshold);
1151*4882a593Smuzhiyun 		/* Force immediate temperature measurement and update
1152*4882a593Smuzhiyun 		 * of the DTEMP field
1153*4882a593Smuzhiyun 		 */
1154*4882a593Smuzhiyun 		ti_bandgap_force_single_read(bgp, i);
1155*4882a593Smuzhiyun 
1156*4882a593Smuzhiyun 		if (TI_BANDGAP_HAS(bgp, COUNTER))
1157*4882a593Smuzhiyun 			ti_bandgap_writel(bgp, rval->bg_counter,
1158*4882a593Smuzhiyun 					  tsr->bgap_counter);
1159*4882a593Smuzhiyun 		if (TI_BANDGAP_HAS(bgp, MODE_CONFIG))
1160*4882a593Smuzhiyun 			ti_bandgap_writel(bgp, rval->bg_mode_ctrl,
1161*4882a593Smuzhiyun 					  tsr->bgap_mode_ctrl);
1162*4882a593Smuzhiyun 		if (TI_BANDGAP_HAS(bgp, TALERT)) {
1163*4882a593Smuzhiyun 			ti_bandgap_writel(bgp, rval->bg_threshold,
1164*4882a593Smuzhiyun 					  tsr->bgap_threshold);
1165*4882a593Smuzhiyun 			ti_bandgap_writel(bgp, rval->bg_ctrl,
1166*4882a593Smuzhiyun 					  tsr->bgap_mask_ctrl);
1167*4882a593Smuzhiyun 		}
1168*4882a593Smuzhiyun 	}
1169*4882a593Smuzhiyun 
1170*4882a593Smuzhiyun 	return 0;
1171*4882a593Smuzhiyun }
1172*4882a593Smuzhiyun 
ti_bandgap_suspend(struct device * dev)1173*4882a593Smuzhiyun static int ti_bandgap_suspend(struct device *dev)
1174*4882a593Smuzhiyun {
1175*4882a593Smuzhiyun 	struct ti_bandgap *bgp = dev_get_drvdata(dev);
1176*4882a593Smuzhiyun 	int err;
1177*4882a593Smuzhiyun 
1178*4882a593Smuzhiyun 	err = ti_bandgap_save_ctxt(bgp);
1179*4882a593Smuzhiyun 	ti_bandgap_power(bgp, false);
1180*4882a593Smuzhiyun 
1181*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, CLK_CTRL))
1182*4882a593Smuzhiyun 		clk_disable_unprepare(bgp->fclock);
1183*4882a593Smuzhiyun 
1184*4882a593Smuzhiyun 	bgp->is_suspended = true;
1185*4882a593Smuzhiyun 
1186*4882a593Smuzhiyun 	return err;
1187*4882a593Smuzhiyun }
1188*4882a593Smuzhiyun 
bandgap_omap_cpu_notifier(struct notifier_block * nb,unsigned long cmd,void * v)1189*4882a593Smuzhiyun static int bandgap_omap_cpu_notifier(struct notifier_block *nb,
1190*4882a593Smuzhiyun 				  unsigned long cmd, void *v)
1191*4882a593Smuzhiyun {
1192*4882a593Smuzhiyun 	struct ti_bandgap *bgp;
1193*4882a593Smuzhiyun 
1194*4882a593Smuzhiyun 	bgp = container_of(nb, struct ti_bandgap, nb);
1195*4882a593Smuzhiyun 
1196*4882a593Smuzhiyun 	spin_lock(&bgp->lock);
1197*4882a593Smuzhiyun 	switch (cmd) {
1198*4882a593Smuzhiyun 	case CPU_CLUSTER_PM_ENTER:
1199*4882a593Smuzhiyun 		if (bgp->is_suspended)
1200*4882a593Smuzhiyun 			break;
1201*4882a593Smuzhiyun 		ti_bandgap_save_ctxt(bgp);
1202*4882a593Smuzhiyun 		ti_bandgap_power(bgp, false);
1203*4882a593Smuzhiyun 		if (TI_BANDGAP_HAS(bgp, CLK_CTRL))
1204*4882a593Smuzhiyun 			clk_disable(bgp->fclock);
1205*4882a593Smuzhiyun 		break;
1206*4882a593Smuzhiyun 	case CPU_CLUSTER_PM_ENTER_FAILED:
1207*4882a593Smuzhiyun 	case CPU_CLUSTER_PM_EXIT:
1208*4882a593Smuzhiyun 		if (bgp->is_suspended)
1209*4882a593Smuzhiyun 			break;
1210*4882a593Smuzhiyun 		if (TI_BANDGAP_HAS(bgp, CLK_CTRL))
1211*4882a593Smuzhiyun 			clk_enable(bgp->fclock);
1212*4882a593Smuzhiyun 		ti_bandgap_power(bgp, true);
1213*4882a593Smuzhiyun 		ti_bandgap_restore_ctxt(bgp);
1214*4882a593Smuzhiyun 		break;
1215*4882a593Smuzhiyun 	}
1216*4882a593Smuzhiyun 	spin_unlock(&bgp->lock);
1217*4882a593Smuzhiyun 
1218*4882a593Smuzhiyun 	return NOTIFY_OK;
1219*4882a593Smuzhiyun }
1220*4882a593Smuzhiyun 
ti_bandgap_resume(struct device * dev)1221*4882a593Smuzhiyun static int ti_bandgap_resume(struct device *dev)
1222*4882a593Smuzhiyun {
1223*4882a593Smuzhiyun 	struct ti_bandgap *bgp = dev_get_drvdata(dev);
1224*4882a593Smuzhiyun 
1225*4882a593Smuzhiyun 	if (TI_BANDGAP_HAS(bgp, CLK_CTRL))
1226*4882a593Smuzhiyun 		clk_prepare_enable(bgp->fclock);
1227*4882a593Smuzhiyun 
1228*4882a593Smuzhiyun 	ti_bandgap_power(bgp, true);
1229*4882a593Smuzhiyun 	bgp->is_suspended = false;
1230*4882a593Smuzhiyun 
1231*4882a593Smuzhiyun 	return ti_bandgap_restore_ctxt(bgp);
1232*4882a593Smuzhiyun }
1233*4882a593Smuzhiyun static SIMPLE_DEV_PM_OPS(ti_bandgap_dev_pm_ops, ti_bandgap_suspend,
1234*4882a593Smuzhiyun 			 ti_bandgap_resume);
1235*4882a593Smuzhiyun 
1236*4882a593Smuzhiyun #define DEV_PM_OPS	(&ti_bandgap_dev_pm_ops)
1237*4882a593Smuzhiyun #else
1238*4882a593Smuzhiyun #define DEV_PM_OPS	NULL
1239*4882a593Smuzhiyun #endif
1240*4882a593Smuzhiyun 
1241*4882a593Smuzhiyun static const struct of_device_id of_ti_bandgap_match[] = {
1242*4882a593Smuzhiyun #ifdef CONFIG_OMAP3_THERMAL
1243*4882a593Smuzhiyun 	{
1244*4882a593Smuzhiyun 		.compatible = "ti,omap34xx-bandgap",
1245*4882a593Smuzhiyun 		.data = (void *)&omap34xx_data,
1246*4882a593Smuzhiyun 	},
1247*4882a593Smuzhiyun 	{
1248*4882a593Smuzhiyun 		.compatible = "ti,omap36xx-bandgap",
1249*4882a593Smuzhiyun 		.data = (void *)&omap36xx_data,
1250*4882a593Smuzhiyun 	},
1251*4882a593Smuzhiyun #endif
1252*4882a593Smuzhiyun #ifdef CONFIG_OMAP4_THERMAL
1253*4882a593Smuzhiyun 	{
1254*4882a593Smuzhiyun 		.compatible = "ti,omap4430-bandgap",
1255*4882a593Smuzhiyun 		.data = (void *)&omap4430_data,
1256*4882a593Smuzhiyun 	},
1257*4882a593Smuzhiyun 	{
1258*4882a593Smuzhiyun 		.compatible = "ti,omap4460-bandgap",
1259*4882a593Smuzhiyun 		.data = (void *)&omap4460_data,
1260*4882a593Smuzhiyun 	},
1261*4882a593Smuzhiyun 	{
1262*4882a593Smuzhiyun 		.compatible = "ti,omap4470-bandgap",
1263*4882a593Smuzhiyun 		.data = (void *)&omap4470_data,
1264*4882a593Smuzhiyun 	},
1265*4882a593Smuzhiyun #endif
1266*4882a593Smuzhiyun #ifdef CONFIG_OMAP5_THERMAL
1267*4882a593Smuzhiyun 	{
1268*4882a593Smuzhiyun 		.compatible = "ti,omap5430-bandgap",
1269*4882a593Smuzhiyun 		.data = (void *)&omap5430_data,
1270*4882a593Smuzhiyun 	},
1271*4882a593Smuzhiyun #endif
1272*4882a593Smuzhiyun #ifdef CONFIG_DRA752_THERMAL
1273*4882a593Smuzhiyun 	{
1274*4882a593Smuzhiyun 		.compatible = "ti,dra752-bandgap",
1275*4882a593Smuzhiyun 		.data = (void *)&dra752_data,
1276*4882a593Smuzhiyun 	},
1277*4882a593Smuzhiyun #endif
1278*4882a593Smuzhiyun 	/* Sentinel */
1279*4882a593Smuzhiyun 	{ },
1280*4882a593Smuzhiyun };
1281*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, of_ti_bandgap_match);
1282*4882a593Smuzhiyun 
1283*4882a593Smuzhiyun static struct platform_driver ti_bandgap_sensor_driver = {
1284*4882a593Smuzhiyun 	.probe = ti_bandgap_probe,
1285*4882a593Smuzhiyun 	.remove = ti_bandgap_remove,
1286*4882a593Smuzhiyun 	.driver = {
1287*4882a593Smuzhiyun 			.name = "ti-soc-thermal",
1288*4882a593Smuzhiyun 			.pm = DEV_PM_OPS,
1289*4882a593Smuzhiyun 			.of_match_table	= of_ti_bandgap_match,
1290*4882a593Smuzhiyun 	},
1291*4882a593Smuzhiyun };
1292*4882a593Smuzhiyun 
1293*4882a593Smuzhiyun module_platform_driver(ti_bandgap_sensor_driver);
1294*4882a593Smuzhiyun 
1295*4882a593Smuzhiyun MODULE_DESCRIPTION("OMAP4+ bandgap temperature sensor driver");
1296*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
1297*4882a593Smuzhiyun MODULE_ALIAS("platform:ti-soc-thermal");
1298*4882a593Smuzhiyun MODULE_AUTHOR("Texas Instrument Inc.");
1299