xref: /openbmc/linux/drivers/gpu/drm/nouveau/nvkm/subdev/therm/base.c (revision d0034a7a4ac7fae708146ac0059b9c47a1543f0d)
1c39f472eSBen Skeggs /*
2c39f472eSBen Skeggs  * Copyright 2012 The Nouveau community
3c39f472eSBen Skeggs  *
4c39f472eSBen Skeggs  * Permission is hereby granted, free of charge, to any person obtaining a
5c39f472eSBen Skeggs  * copy of this software and associated documentation files (the "Software"),
6c39f472eSBen Skeggs  * to deal in the Software without restriction, including without limitation
7c39f472eSBen Skeggs  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8c39f472eSBen Skeggs  * and/or sell copies of the Software, and to permit persons to whom the
9c39f472eSBen Skeggs  * Software is furnished to do so, subject to the following conditions:
10c39f472eSBen Skeggs  *
11c39f472eSBen Skeggs  * The above copyright notice and this permission notice shall be included in
12c39f472eSBen Skeggs  * all copies or substantial portions of the Software.
13c39f472eSBen Skeggs  *
14c39f472eSBen Skeggs  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15c39f472eSBen Skeggs  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16c39f472eSBen Skeggs  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
17c39f472eSBen Skeggs  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18c39f472eSBen Skeggs  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19c39f472eSBen Skeggs  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20c39f472eSBen Skeggs  * OTHER DEALINGS IN THE SOFTWARE.
21c39f472eSBen Skeggs  *
22c39f472eSBen Skeggs  * Authors: Martin Peres
23c39f472eSBen Skeggs  */
24c39f472eSBen Skeggs #include "priv.h"
25c39f472eSBen Skeggs 
2669cbbb7bSBen Skeggs #include <core/option.h>
2769cbbb7bSBen Skeggs #include <subdev/pmu.h>
2869cbbb7bSBen Skeggs 
2957113c01SBen Skeggs int
nvkm_therm_temp_get(struct nvkm_therm * therm)3057113c01SBen Skeggs nvkm_therm_temp_get(struct nvkm_therm *therm)
31c39f472eSBen Skeggs {
3257113c01SBen Skeggs 	if (therm->func->temp_get)
3357113c01SBen Skeggs 		return therm->func->temp_get(therm);
3457113c01SBen Skeggs 	return -ENODEV;
3557113c01SBen Skeggs }
3657113c01SBen Skeggs 
3757113c01SBen Skeggs static int
nvkm_therm_update_trip(struct nvkm_therm * therm)3857113c01SBen Skeggs nvkm_therm_update_trip(struct nvkm_therm *therm)
3957113c01SBen Skeggs {
40da06b46bSBen Skeggs 	struct nvbios_therm_trip_point *trip = therm->fan->bios.trip,
41c39f472eSBen Skeggs 				       *cur_trip = NULL,
42da06b46bSBen Skeggs 				       *last_trip = therm->last_trip;
4357113c01SBen Skeggs 	u8  temp = therm->func->temp_get(therm);
44c39f472eSBen Skeggs 	u16 duty, i;
45c39f472eSBen Skeggs 
46c39f472eSBen Skeggs 	/* look for the trip point corresponding to the current temperature */
47c39f472eSBen Skeggs 	cur_trip = NULL;
48da06b46bSBen Skeggs 	for (i = 0; i < therm->fan->bios.nr_fan_trip; i++) {
49c39f472eSBen Skeggs 		if (temp >= trip[i].temp)
50c39f472eSBen Skeggs 			cur_trip = &trip[i];
51c39f472eSBen Skeggs 	}
52c39f472eSBen Skeggs 
53c39f472eSBen Skeggs 	/* account for the hysteresis cycle */
54c39f472eSBen Skeggs 	if (last_trip && temp <= (last_trip->temp) &&
55c39f472eSBen Skeggs 	    temp > (last_trip->temp - last_trip->hysteresis))
56c39f472eSBen Skeggs 		cur_trip = last_trip;
57c39f472eSBen Skeggs 
58c39f472eSBen Skeggs 	if (cur_trip) {
59c39f472eSBen Skeggs 		duty = cur_trip->fan_duty;
60da06b46bSBen Skeggs 		therm->last_trip = cur_trip;
61c39f472eSBen Skeggs 	} else {
62c39f472eSBen Skeggs 		duty = 0;
63da06b46bSBen Skeggs 		therm->last_trip = NULL;
64c39f472eSBen Skeggs 	}
65c39f472eSBen Skeggs 
66c39f472eSBen Skeggs 	return duty;
67c39f472eSBen Skeggs }
68c39f472eSBen Skeggs 
69c39f472eSBen Skeggs static int
nvkm_therm_compute_linear_duty(struct nvkm_therm * therm,u8 linear_min_temp,u8 linear_max_temp)70800efb4cSMartin Peres nvkm_therm_compute_linear_duty(struct nvkm_therm *therm, u8 linear_min_temp,
71800efb4cSMartin Peres                                u8 linear_max_temp)
72c39f472eSBen Skeggs {
7357113c01SBen Skeggs 	u8  temp = therm->func->temp_get(therm);
74c39f472eSBen Skeggs 	u16 duty;
75c39f472eSBen Skeggs 
76c39f472eSBen Skeggs 	/* handle the non-linear part first */
77c39f472eSBen Skeggs 	if (temp < linear_min_temp)
78da06b46bSBen Skeggs 		return therm->fan->bios.min_duty;
79c39f472eSBen Skeggs 	else if (temp > linear_max_temp)
80da06b46bSBen Skeggs 		return therm->fan->bios.max_duty;
81c39f472eSBen Skeggs 
82c39f472eSBen Skeggs 	/* we are in the linear zone */
83c39f472eSBen Skeggs 	duty  = (temp - linear_min_temp);
84da06b46bSBen Skeggs 	duty *= (therm->fan->bios.max_duty - therm->fan->bios.min_duty);
85c39f472eSBen Skeggs 	duty /= (linear_max_temp - linear_min_temp);
86da06b46bSBen Skeggs 	duty += therm->fan->bios.min_duty;
87c39f472eSBen Skeggs 	return duty;
88c39f472eSBen Skeggs }
89c39f472eSBen Skeggs 
90800efb4cSMartin Peres static int
nvkm_therm_update_linear(struct nvkm_therm * therm)91800efb4cSMartin Peres nvkm_therm_update_linear(struct nvkm_therm *therm)
92800efb4cSMartin Peres {
93800efb4cSMartin Peres 	u8  min = therm->fan->bios.linear_min_temp;
94800efb4cSMartin Peres 	u8  max = therm->fan->bios.linear_max_temp;
95800efb4cSMartin Peres 	return nvkm_therm_compute_linear_duty(therm, min, max);
96800efb4cSMartin Peres }
97800efb4cSMartin Peres 
98800efb4cSMartin Peres static int
nvkm_therm_update_linear_fallback(struct nvkm_therm * therm)99800efb4cSMartin Peres nvkm_therm_update_linear_fallback(struct nvkm_therm *therm)
100800efb4cSMartin Peres {
101800efb4cSMartin Peres 	u8 max = therm->bios_sensor.thrs_fan_boost.temp;
102800efb4cSMartin Peres 	return nvkm_therm_compute_linear_duty(therm, 30, max);
103800efb4cSMartin Peres }
104800efb4cSMartin Peres 
105c39f472eSBen Skeggs static void
nvkm_therm_update(struct nvkm_therm * therm,int mode)10657113c01SBen Skeggs nvkm_therm_update(struct nvkm_therm *therm, int mode)
107c39f472eSBen Skeggs {
10857113c01SBen Skeggs 	struct nvkm_subdev *subdev = &therm->subdev;
109b3c418bbSBen Skeggs 	struct nvkm_timer *tmr = subdev->device->timer;
110c39f472eSBen Skeggs 	unsigned long flags;
111c39f472eSBen Skeggs 	bool immd = true;
112c39f472eSBen Skeggs 	bool poll = true;
113c39f472eSBen Skeggs 	int duty = -1;
114c39f472eSBen Skeggs 
115da06b46bSBen Skeggs 	spin_lock_irqsave(&therm->lock, flags);
116c39f472eSBen Skeggs 	if (mode < 0)
117da06b46bSBen Skeggs 		mode = therm->mode;
118da06b46bSBen Skeggs 	therm->mode = mode;
119c39f472eSBen Skeggs 
120c39f472eSBen Skeggs 	switch (mode) {
121e1404611SBen Skeggs 	case NVKM_THERM_CTRL_MANUAL:
1227eaf1198SBen Skeggs 		nvkm_timer_alarm(tmr, 0, &therm->alarm);
12357113c01SBen Skeggs 		duty = nvkm_therm_fan_get(therm);
124c39f472eSBen Skeggs 		if (duty < 0)
125c39f472eSBen Skeggs 			duty = 100;
126c39f472eSBen Skeggs 		poll = false;
127c39f472eSBen Skeggs 		break;
128e1404611SBen Skeggs 	case NVKM_THERM_CTRL_AUTO:
129da06b46bSBen Skeggs 		switch(therm->fan->bios.fan_mode) {
130c39f472eSBen Skeggs 		case NVBIOS_THERM_FAN_TRIP:
13157113c01SBen Skeggs 			duty = nvkm_therm_update_trip(therm);
132c39f472eSBen Skeggs 			break;
133c39f472eSBen Skeggs 		case NVBIOS_THERM_FAN_LINEAR:
13457113c01SBen Skeggs 			duty = nvkm_therm_update_linear(therm);
135c39f472eSBen Skeggs 			break;
136c39f472eSBen Skeggs 		case NVBIOS_THERM_FAN_OTHER:
13711878006STakashi Iwai 			if (therm->cstate) {
138da06b46bSBen Skeggs 				duty = therm->cstate;
139c39f472eSBen Skeggs 				poll = false;
14011878006STakashi Iwai 			} else {
14111878006STakashi Iwai 				duty = nvkm_therm_update_linear_fallback(therm);
14211878006STakashi Iwai 			}
143c39f472eSBen Skeggs 			break;
144c39f472eSBen Skeggs 		}
145c39f472eSBen Skeggs 		immd = false;
146c39f472eSBen Skeggs 		break;
147e1404611SBen Skeggs 	case NVKM_THERM_CTRL_NONE:
148c39f472eSBen Skeggs 	default:
1497eaf1198SBen Skeggs 		nvkm_timer_alarm(tmr, 0, &therm->alarm);
150c39f472eSBen Skeggs 		poll = false;
151c39f472eSBen Skeggs 	}
152c39f472eSBen Skeggs 
153e4311ee5SBen Skeggs 	if (poll)
15431649ecfSBen Skeggs 		nvkm_timer_alarm(tmr, 1000000000ULL, &therm->alarm);
155da06b46bSBen Skeggs 	spin_unlock_irqrestore(&therm->lock, flags);
156c39f472eSBen Skeggs 
157c39f472eSBen Skeggs 	if (duty >= 0) {
158b3c418bbSBen Skeggs 		nvkm_debug(subdev, "FAN target request: %d%%\n", duty);
15957113c01SBen Skeggs 		nvkm_therm_fan_set(therm, immd, duty);
160c39f472eSBen Skeggs 	}
161c39f472eSBen Skeggs }
162c39f472eSBen Skeggs 
163c39f472eSBen Skeggs int
nvkm_therm_cstate(struct nvkm_therm * therm,int fan,int dir)16457113c01SBen Skeggs nvkm_therm_cstate(struct nvkm_therm *therm, int fan, int dir)
165c39f472eSBen Skeggs {
16657113c01SBen Skeggs 	struct nvkm_subdev *subdev = &therm->subdev;
167da06b46bSBen Skeggs 	if (!dir || (dir < 0 && fan < therm->cstate) ||
168da06b46bSBen Skeggs 		    (dir > 0 && fan > therm->cstate)) {
169b3c418bbSBen Skeggs 		nvkm_debug(subdev, "default fan speed -> %d%%\n", fan);
170da06b46bSBen Skeggs 		therm->cstate = fan;
17157113c01SBen Skeggs 		nvkm_therm_update(therm, -1);
172c39f472eSBen Skeggs 	}
173c39f472eSBen Skeggs 	return 0;
174c39f472eSBen Skeggs }
175c39f472eSBen Skeggs 
176c39f472eSBen Skeggs static void
nvkm_therm_alarm(struct nvkm_alarm * alarm)177e1404611SBen Skeggs nvkm_therm_alarm(struct nvkm_alarm *alarm)
178c39f472eSBen Skeggs {
17957113c01SBen Skeggs 	struct nvkm_therm *therm =
18057113c01SBen Skeggs 	       container_of(alarm, struct nvkm_therm, alarm);
18157113c01SBen Skeggs 	nvkm_therm_update(therm, -1);
182c39f472eSBen Skeggs }
183c39f472eSBen Skeggs 
184c39f472eSBen Skeggs int
nvkm_therm_fan_mode(struct nvkm_therm * therm,int mode)18557113c01SBen Skeggs nvkm_therm_fan_mode(struct nvkm_therm *therm, int mode)
186c39f472eSBen Skeggs {
18757113c01SBen Skeggs 	struct nvkm_subdev *subdev = &therm->subdev;
188b3c418bbSBen Skeggs 	struct nvkm_device *device = subdev->device;
189c39f472eSBen Skeggs 	static const char *name[] = {
190c39f472eSBen Skeggs 		"disabled",
191c39f472eSBen Skeggs 		"manual",
192c39f472eSBen Skeggs 		"automatic"
193c39f472eSBen Skeggs 	};
194c39f472eSBen Skeggs 
195c39f472eSBen Skeggs 	/* The default PPWR ucode on fermi interferes with fan management */
196c39f472eSBen Skeggs 	if ((mode >= ARRAY_SIZE(name)) ||
19769cbbb7bSBen Skeggs 	    (mode != NVKM_THERM_CTRL_NONE && nvkm_pmu_fan_controlled(device)))
198c39f472eSBen Skeggs 		return -EINVAL;
199c39f472eSBen Skeggs 
200c39f472eSBen Skeggs 	/* do not allow automatic fan management if the thermal sensor is
201c39f472eSBen Skeggs 	 * not available */
202da06b46bSBen Skeggs 	if (mode == NVKM_THERM_CTRL_AUTO &&
20357113c01SBen Skeggs 	    therm->func->temp_get(therm) < 0)
204c39f472eSBen Skeggs 		return -EINVAL;
205c39f472eSBen Skeggs 
206da06b46bSBen Skeggs 	if (therm->mode == mode)
207c39f472eSBen Skeggs 		return 0;
208c39f472eSBen Skeggs 
209b3c418bbSBen Skeggs 	nvkm_debug(subdev, "fan management: %s\n", name[mode]);
21057113c01SBen Skeggs 	nvkm_therm_update(therm, mode);
211c39f472eSBen Skeggs 	return 0;
212c39f472eSBen Skeggs }
213c39f472eSBen Skeggs 
214c39f472eSBen Skeggs int
nvkm_therm_attr_get(struct nvkm_therm * therm,enum nvkm_therm_attr_type type)21557113c01SBen Skeggs nvkm_therm_attr_get(struct nvkm_therm *therm, enum nvkm_therm_attr_type type)
216c39f472eSBen Skeggs {
217c39f472eSBen Skeggs 	switch (type) {
218e1404611SBen Skeggs 	case NVKM_THERM_ATTR_FAN_MIN_DUTY:
219da06b46bSBen Skeggs 		return therm->fan->bios.min_duty;
220e1404611SBen Skeggs 	case NVKM_THERM_ATTR_FAN_MAX_DUTY:
221da06b46bSBen Skeggs 		return therm->fan->bios.max_duty;
222e1404611SBen Skeggs 	case NVKM_THERM_ATTR_FAN_MODE:
223da06b46bSBen Skeggs 		return therm->mode;
224e1404611SBen Skeggs 	case NVKM_THERM_ATTR_THRS_FAN_BOOST:
225da06b46bSBen Skeggs 		return therm->bios_sensor.thrs_fan_boost.temp;
226e1404611SBen Skeggs 	case NVKM_THERM_ATTR_THRS_FAN_BOOST_HYST:
227da06b46bSBen Skeggs 		return therm->bios_sensor.thrs_fan_boost.hysteresis;
228e1404611SBen Skeggs 	case NVKM_THERM_ATTR_THRS_DOWN_CLK:
229da06b46bSBen Skeggs 		return therm->bios_sensor.thrs_down_clock.temp;
230e1404611SBen Skeggs 	case NVKM_THERM_ATTR_THRS_DOWN_CLK_HYST:
231da06b46bSBen Skeggs 		return therm->bios_sensor.thrs_down_clock.hysteresis;
232e1404611SBen Skeggs 	case NVKM_THERM_ATTR_THRS_CRITICAL:
233da06b46bSBen Skeggs 		return therm->bios_sensor.thrs_critical.temp;
234e1404611SBen Skeggs 	case NVKM_THERM_ATTR_THRS_CRITICAL_HYST:
235da06b46bSBen Skeggs 		return therm->bios_sensor.thrs_critical.hysteresis;
236e1404611SBen Skeggs 	case NVKM_THERM_ATTR_THRS_SHUTDOWN:
237da06b46bSBen Skeggs 		return therm->bios_sensor.thrs_shutdown.temp;
238e1404611SBen Skeggs 	case NVKM_THERM_ATTR_THRS_SHUTDOWN_HYST:
239da06b46bSBen Skeggs 		return therm->bios_sensor.thrs_shutdown.hysteresis;
240c39f472eSBen Skeggs 	}
241c39f472eSBen Skeggs 
242c39f472eSBen Skeggs 	return -EINVAL;
243c39f472eSBen Skeggs }
244c39f472eSBen Skeggs 
245c39f472eSBen Skeggs int
nvkm_therm_attr_set(struct nvkm_therm * therm,enum nvkm_therm_attr_type type,int value)24657113c01SBen Skeggs nvkm_therm_attr_set(struct nvkm_therm *therm,
247e1404611SBen Skeggs 		    enum nvkm_therm_attr_type type, int value)
248c39f472eSBen Skeggs {
249c39f472eSBen Skeggs 	switch (type) {
250e1404611SBen Skeggs 	case NVKM_THERM_ATTR_FAN_MIN_DUTY:
251c39f472eSBen Skeggs 		if (value < 0)
252c39f472eSBen Skeggs 			value = 0;
253da06b46bSBen Skeggs 		if (value > therm->fan->bios.max_duty)
254da06b46bSBen Skeggs 			value = therm->fan->bios.max_duty;
255da06b46bSBen Skeggs 		therm->fan->bios.min_duty = value;
256c39f472eSBen Skeggs 		return 0;
257e1404611SBen Skeggs 	case NVKM_THERM_ATTR_FAN_MAX_DUTY:
258c39f472eSBen Skeggs 		if (value < 0)
259c39f472eSBen Skeggs 			value = 0;
260da06b46bSBen Skeggs 		if (value < therm->fan->bios.min_duty)
261da06b46bSBen Skeggs 			value = therm->fan->bios.min_duty;
262da06b46bSBen Skeggs 		therm->fan->bios.max_duty = value;
263c39f472eSBen Skeggs 		return 0;
264e1404611SBen Skeggs 	case NVKM_THERM_ATTR_FAN_MODE:
26557113c01SBen Skeggs 		return nvkm_therm_fan_mode(therm, value);
266e1404611SBen Skeggs 	case NVKM_THERM_ATTR_THRS_FAN_BOOST:
267da06b46bSBen Skeggs 		therm->bios_sensor.thrs_fan_boost.temp = value;
26857113c01SBen Skeggs 		therm->func->program_alarms(therm);
269c39f472eSBen Skeggs 		return 0;
270e1404611SBen Skeggs 	case NVKM_THERM_ATTR_THRS_FAN_BOOST_HYST:
271da06b46bSBen Skeggs 		therm->bios_sensor.thrs_fan_boost.hysteresis = value;
27257113c01SBen Skeggs 		therm->func->program_alarms(therm);
273c39f472eSBen Skeggs 		return 0;
274e1404611SBen Skeggs 	case NVKM_THERM_ATTR_THRS_DOWN_CLK:
275da06b46bSBen Skeggs 		therm->bios_sensor.thrs_down_clock.temp = value;
27657113c01SBen Skeggs 		therm->func->program_alarms(therm);
277c39f472eSBen Skeggs 		return 0;
278e1404611SBen Skeggs 	case NVKM_THERM_ATTR_THRS_DOWN_CLK_HYST:
279da06b46bSBen Skeggs 		therm->bios_sensor.thrs_down_clock.hysteresis = value;
28057113c01SBen Skeggs 		therm->func->program_alarms(therm);
281c39f472eSBen Skeggs 		return 0;
282e1404611SBen Skeggs 	case NVKM_THERM_ATTR_THRS_CRITICAL:
283da06b46bSBen Skeggs 		therm->bios_sensor.thrs_critical.temp = value;
28457113c01SBen Skeggs 		therm->func->program_alarms(therm);
285c39f472eSBen Skeggs 		return 0;
286e1404611SBen Skeggs 	case NVKM_THERM_ATTR_THRS_CRITICAL_HYST:
287da06b46bSBen Skeggs 		therm->bios_sensor.thrs_critical.hysteresis = value;
28857113c01SBen Skeggs 		therm->func->program_alarms(therm);
289c39f472eSBen Skeggs 		return 0;
290e1404611SBen Skeggs 	case NVKM_THERM_ATTR_THRS_SHUTDOWN:
291da06b46bSBen Skeggs 		therm->bios_sensor.thrs_shutdown.temp = value;
29257113c01SBen Skeggs 		therm->func->program_alarms(therm);
293c39f472eSBen Skeggs 		return 0;
294e1404611SBen Skeggs 	case NVKM_THERM_ATTR_THRS_SHUTDOWN_HYST:
295da06b46bSBen Skeggs 		therm->bios_sensor.thrs_shutdown.hysteresis = value;
29657113c01SBen Skeggs 		therm->func->program_alarms(therm);
297c39f472eSBen Skeggs 		return 0;
298c39f472eSBen Skeggs 	}
299c39f472eSBen Skeggs 
300c39f472eSBen Skeggs 	return -EINVAL;
301c39f472eSBen Skeggs }
302c39f472eSBen Skeggs 
303b138eca6SLyude Paul void
nvkm_therm_clkgate_enable(struct nvkm_therm * therm)304b138eca6SLyude Paul nvkm_therm_clkgate_enable(struct nvkm_therm *therm)
305b138eca6SLyude Paul {
30692256269SThierry Reding 	if (!therm || !therm->func->clkgate_enable || !therm->clkgating_enabled)
307b138eca6SLyude Paul 		return;
308b138eca6SLyude Paul 
309b138eca6SLyude Paul 	nvkm_debug(&therm->subdev,
310b138eca6SLyude Paul 		   "Enabling clockgating\n");
311b138eca6SLyude Paul 	therm->func->clkgate_enable(therm);
312b138eca6SLyude Paul }
313b138eca6SLyude Paul 
314b138eca6SLyude Paul void
nvkm_therm_clkgate_fini(struct nvkm_therm * therm,bool suspend)315b138eca6SLyude Paul nvkm_therm_clkgate_fini(struct nvkm_therm *therm, bool suspend)
316b138eca6SLyude Paul {
31792256269SThierry Reding 	if (!therm || !therm->func->clkgate_fini || !therm->clkgating_enabled)
318b138eca6SLyude Paul 		return;
319b138eca6SLyude Paul 
320b138eca6SLyude Paul 	nvkm_debug(&therm->subdev,
321b138eca6SLyude Paul 		   "Preparing clockgating for %s\n",
322b138eca6SLyude Paul 		   suspend ? "suspend" : "fini");
323b138eca6SLyude Paul 	therm->func->clkgate_fini(therm, suspend);
324b138eca6SLyude Paul }
325b138eca6SLyude Paul 
326b138eca6SLyude Paul static void
nvkm_therm_clkgate_oneinit(struct nvkm_therm * therm)327b138eca6SLyude Paul nvkm_therm_clkgate_oneinit(struct nvkm_therm *therm)
328b138eca6SLyude Paul {
329b138eca6SLyude Paul 	if (!therm->func->clkgate_enable || !therm->clkgating_enabled)
330b138eca6SLyude Paul 		return;
331b138eca6SLyude Paul 
332b138eca6SLyude Paul 	nvkm_info(&therm->subdev, "Clockgating enabled\n");
333b138eca6SLyude Paul }
334b138eca6SLyude Paul 
33557113c01SBen Skeggs static void
nvkm_therm_intr(struct nvkm_subdev * subdev)33657113c01SBen Skeggs nvkm_therm_intr(struct nvkm_subdev *subdev)
337c39f472eSBen Skeggs {
33857113c01SBen Skeggs 	struct nvkm_therm *therm = nvkm_therm(subdev);
33957113c01SBen Skeggs 	if (therm->func->intr)
34057113c01SBen Skeggs 		therm->func->intr(therm);
341c39f472eSBen Skeggs }
342c39f472eSBen Skeggs 
34357113c01SBen Skeggs static int
nvkm_therm_fini(struct nvkm_subdev * subdev,bool suspend)34457113c01SBen Skeggs nvkm_therm_fini(struct nvkm_subdev *subdev, bool suspend)
345c39f472eSBen Skeggs {
34657113c01SBen Skeggs 	struct nvkm_therm *therm = nvkm_therm(subdev);
347c39f472eSBen Skeggs 
34857113c01SBen Skeggs 	if (therm->func->fini)
34957113c01SBen Skeggs 		therm->func->fini(therm);
35057113c01SBen Skeggs 
35157113c01SBen Skeggs 	nvkm_therm_fan_fini(therm, suspend);
35257113c01SBen Skeggs 	nvkm_therm_sensor_fini(therm, suspend);
35357113c01SBen Skeggs 
354c39f472eSBen Skeggs 	if (suspend) {
355da06b46bSBen Skeggs 		therm->suspend = therm->mode;
356da06b46bSBen Skeggs 		therm->mode = NVKM_THERM_CTRL_NONE;
357c39f472eSBen Skeggs 	}
358c39f472eSBen Skeggs 
359c39f472eSBen Skeggs 	return 0;
360c39f472eSBen Skeggs }
361c39f472eSBen Skeggs 
36257113c01SBen Skeggs static int
nvkm_therm_oneinit(struct nvkm_subdev * subdev)36357113c01SBen Skeggs nvkm_therm_oneinit(struct nvkm_subdev *subdev)
364c39f472eSBen Skeggs {
36557113c01SBen Skeggs 	struct nvkm_therm *therm = nvkm_therm(subdev);
366e1404611SBen Skeggs 	nvkm_therm_sensor_ctor(therm);
367e1404611SBen Skeggs 	nvkm_therm_ic_ctor(therm);
368e1404611SBen Skeggs 	nvkm_therm_fan_ctor(therm);
369e1404611SBen Skeggs 	nvkm_therm_fan_mode(therm, NVKM_THERM_CTRL_AUTO);
370e1404611SBen Skeggs 	nvkm_therm_sensor_preinit(therm);
371b138eca6SLyude Paul 	nvkm_therm_clkgate_oneinit(therm);
372c39f472eSBen Skeggs 	return 0;
373c39f472eSBen Skeggs }
374c39f472eSBen Skeggs 
37557113c01SBen Skeggs static int
nvkm_therm_init(struct nvkm_subdev * subdev)37657113c01SBen Skeggs nvkm_therm_init(struct nvkm_subdev *subdev)
377c39f472eSBen Skeggs {
37857113c01SBen Skeggs 	struct nvkm_therm *therm = nvkm_therm(subdev);
37957113c01SBen Skeggs 
380d3265637SRhys Kidd 	if (therm->func->init)
38157113c01SBen Skeggs 		therm->func->init(therm);
38257113c01SBen Skeggs 
38357113c01SBen Skeggs 	if (therm->suspend >= 0) {
38457113c01SBen Skeggs 		/* restore the pwm value only when on manual or auto mode */
38557113c01SBen Skeggs 		if (therm->suspend > 0)
38657113c01SBen Skeggs 			nvkm_therm_fan_set(therm, true, therm->fan->percent);
38757113c01SBen Skeggs 
38857113c01SBen Skeggs 		nvkm_therm_fan_mode(therm, therm->suspend);
38957113c01SBen Skeggs 	}
39057113c01SBen Skeggs 
39157113c01SBen Skeggs 	nvkm_therm_sensor_init(therm);
39257113c01SBen Skeggs 	nvkm_therm_fan_init(therm);
39357113c01SBen Skeggs 	return 0;
39457113c01SBen Skeggs }
39557113c01SBen Skeggs 
3961bab09acSLyude Paul void
nvkm_therm_clkgate_init(struct nvkm_therm * therm,const struct nvkm_therm_clkgate_pack * p)3971bab09acSLyude Paul nvkm_therm_clkgate_init(struct nvkm_therm *therm,
3981bab09acSLyude Paul 			const struct nvkm_therm_clkgate_pack *p)
3991bab09acSLyude Paul {
40092256269SThierry Reding 	if (!therm || !therm->func->clkgate_init || !therm->clkgating_enabled)
4011bab09acSLyude Paul 		return;
4021bab09acSLyude Paul 
4031bab09acSLyude Paul 	therm->func->clkgate_init(therm, p);
4041bab09acSLyude Paul }
4051bab09acSLyude Paul 
40657113c01SBen Skeggs static void *
nvkm_therm_dtor(struct nvkm_subdev * subdev)40757113c01SBen Skeggs nvkm_therm_dtor(struct nvkm_subdev *subdev)
40857113c01SBen Skeggs {
40957113c01SBen Skeggs 	struct nvkm_therm *therm = nvkm_therm(subdev);
410da06b46bSBen Skeggs 	kfree(therm->fan);
41157113c01SBen Skeggs 	return therm;
41257113c01SBen Skeggs }
41357113c01SBen Skeggs 
41457113c01SBen Skeggs static const struct nvkm_subdev_func
41557113c01SBen Skeggs nvkm_therm = {
41657113c01SBen Skeggs 	.dtor = nvkm_therm_dtor,
41757113c01SBen Skeggs 	.oneinit = nvkm_therm_oneinit,
41857113c01SBen Skeggs 	.init = nvkm_therm_init,
41957113c01SBen Skeggs 	.fini = nvkm_therm_fini,
42057113c01SBen Skeggs 	.intr = nvkm_therm_intr,
42157113c01SBen Skeggs };
42257113c01SBen Skeggs 
423b138eca6SLyude Paul void
nvkm_therm_ctor(struct nvkm_therm * therm,struct nvkm_device * device,enum nvkm_subdev_type type,int inst,const struct nvkm_therm_func * func)424*0aec69c7SBen Skeggs nvkm_therm_ctor(struct nvkm_therm *therm, struct nvkm_device *device, enum nvkm_subdev_type type,
425*0aec69c7SBen Skeggs 		int inst, const struct nvkm_therm_func *func)
42657113c01SBen Skeggs {
427*0aec69c7SBen Skeggs 	nvkm_subdev_ctor(&nvkm_therm, device, type, inst, &therm->subdev);
42857113c01SBen Skeggs 	therm->func = func;
42957113c01SBen Skeggs 
43057113c01SBen Skeggs 	nvkm_alarm_init(&therm->alarm, nvkm_therm_alarm);
43157113c01SBen Skeggs 	spin_lock_init(&therm->lock);
43257113c01SBen Skeggs 	spin_lock_init(&therm->sensor.alarm_program_lock);
43357113c01SBen Skeggs 
43457113c01SBen Skeggs 	therm->fan_get = nvkm_therm_fan_user_get;
43557113c01SBen Skeggs 	therm->fan_set = nvkm_therm_fan_user_set;
43657113c01SBen Skeggs 	therm->attr_get = nvkm_therm_attr_get;
43757113c01SBen Skeggs 	therm->attr_set = nvkm_therm_attr_set;
43857113c01SBen Skeggs 	therm->mode = therm->suspend = -1; /* undefined */
4393ea74559SLyude Paul 
4403ea74559SLyude Paul 	therm->clkgating_enabled = nvkm_boolopt(device->cfgopt,
4413ea74559SLyude Paul 						"NvPmEnableGating", false);
442b138eca6SLyude Paul }
443b138eca6SLyude Paul 
444b138eca6SLyude Paul int
nvkm_therm_new_(const struct nvkm_therm_func * func,struct nvkm_device * device,enum nvkm_subdev_type type,int inst,struct nvkm_therm ** ptherm)445b138eca6SLyude Paul nvkm_therm_new_(const struct nvkm_therm_func *func, struct nvkm_device *device,
446*0aec69c7SBen Skeggs 		enum nvkm_subdev_type type, int inst, struct nvkm_therm **ptherm)
447b138eca6SLyude Paul {
448b138eca6SLyude Paul 	struct nvkm_therm *therm;
449b138eca6SLyude Paul 
450b138eca6SLyude Paul 	if (!(therm = *ptherm = kzalloc(sizeof(*therm), GFP_KERNEL)))
451b138eca6SLyude Paul 		return -ENOMEM;
452b138eca6SLyude Paul 
453*0aec69c7SBen Skeggs 	nvkm_therm_ctor(therm, device, type, inst, func);
45457113c01SBen Skeggs 	return 0;
455c39f472eSBen Skeggs }
456