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