1 /* $OpenBSD: opalsens.c,v 1.3 2022/04/06 18:59:27 naddy Exp $ */
2 /*
3 * Copyright (c) 2020 Mark Kettenis <kettenis@openbsd.org>
4 *
5 * Permission to use, copy, modify, and distribute this software for any
6 * purpose with or without fee is hereby granted, provided that the above
7 * copyright notice and this permission notice appear in all copies.
8 *
9 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
10 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
11 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
12 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
13 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
14 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
15 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
16 */
17
18 #include <sys/param.h>
19 #include <sys/device.h>
20 #include <sys/sensors.h>
21 #include <sys/systm.h>
22
23 #include <machine/fdt.h>
24 #include <machine/opal.h>
25
26 #include <dev/ofw/openfirm.h>
27 #include <dev/ofw/fdt.h>
28
29 struct opalsens_softc {
30 struct device sc_dev;
31 uint32_t sc_data;
32
33 struct ksensor sc_sensor;
34 struct ksensordev sc_sensordev;
35 };
36
37 int opalsens_match(struct device *, void *, void *);
38 void opalsens_attach(struct device *, struct device *, void *);
39
40 const struct cfattach opalsens_ca = {
41 sizeof (struct opalsens_softc), opalsens_match, opalsens_attach
42 };
43
44 struct cfdriver opalsens_cd = {
45 NULL, "opalsens", DV_DULL
46 };
47
48 void opalsens_refresh(void *);
49
50 int
opalsens_match(struct device * parent,void * match,void * aux)51 opalsens_match(struct device *parent, void *match, void *aux)
52 {
53 struct fdt_attach_args *faa = aux;
54
55 return OF_is_compatible(faa->fa_node, "ibm,opal-sensor");
56 }
57
58 void
opalsens_attach(struct device * parent,struct device * self,void * aux)59 opalsens_attach(struct device *parent, struct device *self, void *aux)
60 {
61 struct opalsens_softc *sc = (struct opalsens_softc *)self;
62 struct fdt_attach_args *faa = aux;
63 char name[32], type[32], label[32];
64
65 sc->sc_data = OF_getpropint(faa->fa_node, "sensor-data", 0);
66
67 name[0] = 0;
68 OF_getprop(faa->fa_node, "name", name, sizeof(name));
69 name[sizeof(name) - 1] = 0;
70
71 printf(": \"%s\"", name);
72
73 type[0] = 0;
74 OF_getprop(faa->fa_node, "sensor-type", type, sizeof(type));
75 type[sizeof(type) - 1] = 0;
76
77 if (strcmp(type, "curr") == 0)
78 sc->sc_sensor.type = SENSOR_AMPS;
79 else if (strcmp(type, "energy") == 0)
80 sc->sc_sensor.type = SENSOR_ENERGY;
81 else if (strcmp(type, "in") == 0)
82 sc->sc_sensor.type = SENSOR_VOLTS_DC;
83 else if (strcmp(type, "power") == 0)
84 sc->sc_sensor.type = SENSOR_WATTS;
85 else if (strcmp(type, "temp") == 0)
86 sc->sc_sensor.type = SENSOR_TEMP;
87 else {
88 printf(", unsupported sensor type \"%s\"\n", type);
89 return;
90 }
91
92 label[0] = 0;
93 OF_getprop(faa->fa_node, "label", label, sizeof(label));
94 label[sizeof(label) - 1] = 0;
95
96 strlcpy(sc->sc_sensor.desc, label, sizeof(sc->sc_sensor.desc));
97
98 printf("\n");
99
100 /* Register sensor. */
101 strlcpy(sc->sc_sensordev.xname, sc->sc_dev.dv_xname,
102 sizeof(sc->sc_sensordev.xname));
103 sc->sc_sensor.flags = SENSOR_FINVALID;
104 sensor_attach(&sc->sc_sensordev, &sc->sc_sensor);
105 sensordev_install(&sc->sc_sensordev);
106 sensor_task_register(sc, opalsens_refresh, 5);
107 }
108
109 void
opalsens_refresh(void * arg)110 opalsens_refresh(void *arg)
111 {
112 struct opalsens_softc *sc = arg;
113 uint64_t value;
114 int64_t error;
115
116 error = opal_sensor_read_u64(sc->sc_data, 0, opal_phys(&value));
117 if (error == OPAL_SUCCESS)
118 sc->sc_sensor.flags &= ~SENSOR_FINVALID;
119 else
120 sc->sc_sensor.flags |= SENSOR_FINVALID;
121
122 switch (sc->sc_sensor.type) {
123 case SENSOR_AMPS:
124 case SENSOR_VOLTS_DC:
125 sc->sc_sensor.value = value * 1000;
126 break;
127 case SENSOR_WATTS:
128 sc->sc_sensor.value = value * 1000000;
129 break;
130 case SENSOR_TEMP:
131 /* Firmware reports 0 for unpopulated DIMM slots. */
132 if (value == 0)
133 sc->sc_sensor.flags |= SENSOR_FINVALID;
134 else
135 sc->sc_sensor.value = 273150000 + value * 1000000;
136 break;
137 default:
138 sc->sc_sensor.value = value;
139 break;
140 }
141 }
142