[src/trunk]: src/sys/arch/macppc this driver allows to read the speeds of fan...

[macallan <macallan%NetBSD.org@localhost>]

details:   https://anonhg.NetBSD.org/src/rev/5ef2f26f8812
branches:  trunk
changeset: 1023490:5ef2f26f8812
user:      macallan <macallan%NetBSD.org@localhost>
date:      Fri Sep 10 23:32:17 2021 +0000

description:
this driver allows to read the speeds of fans controlled via mac-io/fans/*
found in some G5, for example my 7,3
based on guesswork and observation

diffstat:

 sys/arch/macppc/conf/files.macppc |    9 +-
 sys/arch/macppc/dev/obiofan.c     |  176 ++++++++++++++++++++++++++++++++++++++
 2 files changed, 184 insertions(+), 1 deletions(-)

diffs (200 lines):

diff -r b938fef7f0f2 -r 5ef2f26f8812 sys/arch/macppc/conf/files.macppc
--- a/sys/arch/macppc/conf/files.macppc Fri Sep 10 22:48:19 2021 +0000
+++ b/sys/arch/macppc/conf/files.macppc Fri Sep 10 23:32:17 2021 +0000
@@ -1,4 +1,4 @@
-#      $NetBSD: files.macppc,v 1.122 2021/09/03 17:18:39 macallan Exp $
+#      $NetBSD: files.macppc,v 1.123 2021/09/10 23:32:17 macallan Exp $
 #
 # macppc-specific configuration info
 
@@ -335,3 +335,10 @@
 device fcu: sysmon_envsys, fancontrol
 attach fcu at iic
 file   arch/macppc/dev/fcu.c                           fcu     needs-flag
+
+# fan control bits found in obio's space on some G5
+device         obiofan: sysmon_envsys
+attach         obiofan at obio
+file   arch/macppc/dev/obiofan.c                       obiofan
+defflag opt_obiofan.h OBIOFAN_DEBUG
+
diff -r b938fef7f0f2 -r 5ef2f26f8812 sys/arch/macppc/dev/obiofan.c
--- /dev/null   Thu Jan 01 00:00:00 1970 +0000
+++ b/sys/arch/macppc/dev/obiofan.c     Fri Sep 10 23:32:17 2021 +0000
@@ -0,0 +1,176 @@
+/*     $NetBSD: obiofan.c,v 1.1 2021/09/10 23:32:17 macallan Exp $     */
+/*     Id: ki2c.c,v 1.7 2002/10/05 09:56:05 tsubai Exp */
+
+/*-
+ * Copyright (c) 2006 Michael Lorenz
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
+ * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
+ * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
+ * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
+ * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+ * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+ * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <sys/param.h>
+#include <sys/device.h>
+#include <sys/systm.h>
+#include <sys/mutex.h>
+#include <sys/callout.h>
+#include <sys/time.h>
+
+#include <dev/ofw/openfirm.h>
+#include <dev/sysmon/sysmonvar.h>
+#include <machine/autoconf.h>
+#include <macppc/dev/obiovar.h>
+
+#include "opt_obiofan.h"
+
+#ifdef OBIOFAN_DEBUG
+#define DPRINTF printf
+#else
+#define DPRINTF if (0) printf
+#endif
+
+struct obiofan_softc {
+       device_t sc_dev;
+       struct sysmon_envsys    *sc_sme;
+       envsys_data_t           sc_sensors[4];
+       callout_t               sc_callout;
+       time_t                  sc_stamp;
+       int                     sc_node;
+       int                     sc_reg, sc_shift;
+       int                     sc_count, sc_rpm;
+};
+
+int obiofan_match(device_t, cfdata_t, void *);
+void obiofan_attach(device_t, device_t, void *);
+static void obiofan_refresh(struct sysmon_envsys *, envsys_data_t *);
+static void obiofan_update(void *);
+
+CFATTACH_DECL_NEW(obiofan, sizeof(struct obiofan_softc), obiofan_match,
+       obiofan_attach, NULL, NULL);
+
+int
+obiofan_match(device_t parent, cfdata_t match, void *aux)
+{
+       struct confargs *ca = aux;
+
+       if (strcmp(ca->ca_name, "fans") == 0)
+               return 1;
+
+       return 0;
+}
+
+void
+obiofan_attach(device_t parent, device_t self, void *aux)
+{
+       struct obiofan_softc *sc = device_private(self);
+       struct confargs *ca = aux;
+       char descr[32] = "fan";
+       int node = ca->ca_node, tc_node;
+       int regs[8], tc_regs[32];
+
+       printf("\n");
+
+       if (OF_getprop(node, "reg", regs, sizeof(regs)) <= 0)
+               return;
+
+       sc->sc_node = node;
+
+#ifdef OBIOFAN_DEBUG
+       int i;
+       for (i = 0; i < 7; i += 2)
+               printf("%02x: %08x\n", regs[i], obio_read_4(regs[i]));
+#endif
+
+       tc_node = OF_parent(node);
+
+       if (OF_getprop(tc_node, "platform-do-getTACHCount", tc_regs, 32) <= 0) {
+               aprint_error("no platform-do-getTACHCount\n");
+               return;
+       }
+
+       /*
+        * XXX this is guesswork based on poking around & observation
+        *
+        * the parameter format seems to be:
+        * reg[0] - node number for the fan, or pointer into OF space
+        * reg[1] - 0x08000000
+        * reg[2] - 0x0000001a - varies with different platform-do-*
+        * reg[3] - register number in obio space
+        * reg[4] - bitmask in the register
+        * reg[5] - unknown
+        * reg[6] - unknown
+        *
+        * for now only get the parameters for the 1st fan since that's all we
+        * have on my 7,3
+        */
+
+       sc->sc_reg = tc_regs[3];
+       sc->sc_shift = ffs(tc_regs[4]) - 1;
+
+       OF_getprop(tc_regs[0], "location", descr, 32);
+       DPRINTF("%s: %02x %d\n", descr, sc->sc_reg, sc->sc_shift);
+
+       sc->sc_stamp = time_second;
+       sc->sc_count = obio_read_4(sc->sc_reg) >> sc->sc_shift;
+       sc->sc_rpm = -1;
+       
+       sc->sc_sme = sysmon_envsys_create();
+       sc->sc_sme->sme_name = device_xname(self);
+       sc->sc_sme->sme_cookie = sc;
+       sc->sc_sme->sme_refresh = obiofan_refresh;
+
+       sc->sc_sensors[0].units = ENVSYS_SFANRPM;
+       sc->sc_sensors[0].state = ENVSYS_SINVALID;
+       strcpy(sc->sc_sensors[0].desc, descr);
+       sysmon_envsys_sensor_attach(sc->sc_sme, &sc->sc_sensors[0]);
+       sysmon_envsys_register(sc->sc_sme);
+
+       callout_init(&sc->sc_callout, 0);
+       callout_setfunc(&sc->sc_callout, obiofan_update, sc);
+       callout_schedule(&sc->sc_callout, mstohz(5000));
+}
+
+static void
+obiofan_update(void *cookie)
+{
+       struct obiofan_softc *sc = cookie;
+       time_t now = time_second, diff;
+       int spin, spins;
+       diff = now - sc->sc_stamp;
+       if (diff < 5) return;
+       spin = obio_read_4(sc->sc_reg) >> sc->sc_shift;
+       spins = (spin - sc->sc_count) & 0xffff;
+       sc->sc_rpm = spins * 60 / diff;
+       sc->sc_count = spin;
+       sc->sc_stamp = now;
+       DPRINTF("%s %lld %d\n", __func__, diff, spins);
+       callout_schedule(&sc->sc_callout, mstohz(5000));
+}
+
+static void
+obiofan_refresh(struct sysmon_envsys *sme, envsys_data_t *edata)
+{
+       struct obiofan_softc *sc = sme->sme_cookie;
+       if (sc->sc_rpm >= 0) {
+               edata->state = ENVSYS_SVALID;
+               edata->value_cur = sc->sc_rpm;
+       }
+}