1 /*-
2 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
3 *
4 * Copyright 2020 Michal Meloun <mmel@FreeBSD.org>
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 * 1. Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 *
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
18 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
19 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
21 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
25 * SUCH DAMAGE.
26 */
27
28 #include <sys/cdefs.h>
29 __FBSDID("$FreeBSD$");
30
31 #include <sys/param.h>
32 #include <sys/systm.h>
33 #include <sys/bus.h>
34 #include <sys/cpu.h>
35 #include <sys/kernel.h>
36 #include <sys/lock.h>
37 #include <sys/malloc.h>
38 #include <sys/module.h>
39 #include <sys/sysctl.h>
40
41 #include <machine/bus.h>
42 #include <machine/cpu.h>
43
44 #include <dev/extres/clk/clk.h>
45 #include <dev/ofw/ofw_bus_subr.h>
46
47 #include "tegra_soctherm_if.h"
48
49
50 enum therm_info {
51 CORETEMP_TEMP,
52 CORETEMP_DELTA,
53 CORETEMP_RESOLUTION,
54 CORETEMP_TJMAX,
55 };
56
57 struct tegra210_coretemp_softc {
58 device_t dev;
59 int overheat_log;
60 int core_max_temp;
61 int cpu_id;
62 device_t tsens_dev;
63 intptr_t tsens_id;
64 };
65
66 static int
67 coretemp_get_val_sysctl(SYSCTL_HANDLER_ARGS)
68 {
69 device_t dev;
70 int val, temp, rv;
71 struct tegra210_coretemp_softc *sc;
72 enum therm_info type;
73 char stemp[16];
74
75
76 dev = (device_t) arg1;
77 sc = device_get_softc(dev);
78 type = arg2;
79
80
81 rv = TEGRA_SOCTHERM_GET_TEMPERATURE(sc->tsens_dev, sc->dev,
82 sc->tsens_id, &temp);
83 if (rv != 0) {
84 device_printf(sc->dev,
85 "Cannot read temperature sensor %u: %d\n",
86 (unsigned int)sc->tsens_id, rv);
87 return (rv);
88 }
89
90 switch (type) {
91 case CORETEMP_TEMP:
92 val = temp / 100;
93 val += 2731;
94 break;
95 case CORETEMP_DELTA:
96 val = (sc->core_max_temp - temp) / 1000;
97 break;
98 case CORETEMP_RESOLUTION:
99 val = 1;
100 break;
101 case CORETEMP_TJMAX:
102 val = sc->core_max_temp / 100;
103 val += 2731;
104 break;
105 }
106
107
108 if ((temp > sc->core_max_temp) && !sc->overheat_log) {
109 sc->overheat_log = 1;
110
111 /*
112 * Check for Critical Temperature Status and Critical
113 * Temperature Log. It doesn't really matter if the
114 * current temperature is invalid because the "Critical
115 * Temperature Log" bit will tell us if the Critical
116 * Temperature has * been reached in past. It's not
117 * directly related to the current temperature.
118 *
119 * If we reach a critical level, allow devctl(4)
120 * to catch this and shutdown the system.
121 */
122 device_printf(dev, "critical temperature detected, "
123 "suggest system shutdown\n");
124 snprintf(stemp, sizeof(stemp), "%d", val);
125 devctl_notify("coretemp", "Thermal", stemp,
126 "notify=0xcc");
127 } else {
128 sc->overheat_log = 0;
129 }
130
131 return (sysctl_handle_int(oidp, 0, val, req));
132 }
133
134 static int
135 tegra210_coretemp_ofw_parse(struct tegra210_coretemp_softc *sc)
136 {
137 int rv, ncells;
138 phandle_t node, xnode;
139 pcell_t *cells;
140
141 node = OF_peer(0);
142 node = ofw_bus_find_child(node, "thermal-zones");
143 if (node <= 0) {
144 device_printf(sc->dev, "Cannot find 'thermal-zones'.\n");
145 return (ENXIO);
146 }
147
148 node = ofw_bus_find_child(node, "cpu");
149 if (node <= 0) {
150 device_printf(sc->dev, "Cannot find 'cpu'\n");
151 return (ENXIO);
152 }
153 rv = ofw_bus_parse_xref_list_alloc(node, "thermal-sensors",
154 "#thermal-sensor-cells", 0, &xnode, &ncells, &cells);
155 if (rv != 0) {
156 device_printf(sc->dev,
157 "Cannot parse 'thermal-sensors' property.\n");
158 return (ENXIO);
159 }
160 if (ncells != 1) {
161 device_printf(sc->dev,
162 "Invalid format of 'thermal-sensors' property(%d).\n",
163 ncells);
164 return (ENXIO);
165 }
166
167 sc->tsens_id = 0x100 + sc->cpu_id;
168 OF_prop_free(cells);
169
170 sc->tsens_dev = OF_device_from_xref(xnode);
171 if (sc->tsens_dev == NULL) {
172 device_printf(sc->dev,
173 "Cannot find thermal sensors device.");
174 return (ENXIO);
175 }
176 return (0);
177 }
178
179 static void
180 tegra210_coretemp_identify(driver_t *driver, device_t parent)
181 {
182 phandle_t root;
183
184 root = OF_finddevice("/");
185 if (!ofw_bus_node_is_compatible(root, "nvidia,tegra210"))
186 return;
187 if (device_find_child(parent, "tegra210_coretemp", -1) != NULL)
188 return;
189 if (BUS_ADD_CHILD(parent, 0, "tegra210_coretemp", -1) == NULL)
190 device_printf(parent, "add child failed\n");
191 }
192
193 static int
194 tegra210_coretemp_probe(device_t dev)
195 {
196
197 device_set_desc(dev, "CPU Thermal Sensor");
198 return (0);
199 }
200
201 static int
202 tegra210_coretemp_attach(device_t dev)
203 {
204 struct tegra210_coretemp_softc *sc;
205 device_t pdev;
206 struct sysctl_oid *oid;
207 struct sysctl_ctx_list *ctx;
208 int rv;
209
210 sc = device_get_softc(dev);
211 sc->dev = dev;
212 sc->cpu_id = device_get_unit(dev);
213 sc->core_max_temp = 102000;
214 pdev = device_get_parent(dev);
215
216 rv = tegra210_coretemp_ofw_parse(sc);
217 if (rv != 0)
218 return (rv);
219
220 ctx = device_get_sysctl_ctx(dev);
221
222 oid = SYSCTL_ADD_NODE(ctx,
223 SYSCTL_CHILDREN(device_get_sysctl_tree(pdev)), OID_AUTO,
224 "coretemp", CTLFLAG_RD, NULL, "Per-CPU thermal information");
225
226 /*
227 * Add the MIBs to dev.cpu.N and dev.cpu.N.coretemp.
228 */
229 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(device_get_sysctl_tree(pdev)),
230 OID_AUTO, "temperature", CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_MPSAFE,
231 dev, CORETEMP_TEMP, coretemp_get_val_sysctl, "IK",
232 "Current temperature");
233 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, "delta",
234 CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_MPSAFE, dev, CORETEMP_DELTA,
235 coretemp_get_val_sysctl, "I",
236 "Delta between TCC activation and current temperature");
237 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, "resolution",
238 CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_MPSAFE, dev, CORETEMP_RESOLUTION,
239 coretemp_get_val_sysctl, "I",
240 "Resolution of CPU thermal sensor");
241 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, "tjmax",
242 CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_MPSAFE, dev, CORETEMP_TJMAX,
243 coretemp_get_val_sysctl, "IK",
244 "TCC activation temperature");
245
246 return (0);
247 }
248
249 static int
250 tegra210_coretemp_detach(device_t dev)
251 {
252 return (0);
253 }
254
255 static device_method_t tegra210_coretemp_methods[] = {
256 /* Device interface */
257 DEVMETHOD(device_identify, tegra210_coretemp_identify),
258 DEVMETHOD(device_probe, tegra210_coretemp_probe),
259 DEVMETHOD(device_attach, tegra210_coretemp_attach),
260 DEVMETHOD(device_detach, tegra210_coretemp_detach),
261
262 DEVMETHOD_END
263 };
264
265 static DEFINE_CLASS_0(tegra210_coretemp, tegra210_coretemp_driver,
266 tegra210_coretemp_methods, sizeof(struct tegra210_coretemp_softc));
267 DRIVER_MODULE(tegra210_coretemp, cpu, tegra210_coretemp_driver, NULL, NULL);
Cache object: 26300e89bdf4e44a041f3d218ed5e667
|