Author: hrs
Date: Sat Aug 18 12:37:07 2012
New Revision: 239371
URL: http://svn.freebsd.org/changeset/base/239371
Log:
Add mvts(4) driver for internal thermal sensor found on 88F6282 and 88F6283.
The temperature value will be exported via sysctl like this:
dev.mvts.0.temperature: 52.1C
Added:
head/sys/arm/mv/mv_ts.c (contents, props changed)
Modified:
head/sys/arm/mv/files.mv
Modified: head/sys/arm/mv/files.mv
==============================================================================
--- head/sys/arm/mv/files.mv Sat Aug 18 12:20:51 2012 (r239370)
+++ head/sys/arm/mv/files.mv Sat Aug 18 12:37:07 2012 (r239371)
@@ -29,6 +29,7 @@ arm/mv/mv_localbus.c standard
arm/mv/mv_machdep.c standard
arm/mv/mv_pci.c optional pci
arm/mv/mv_sata.c optional ata | atamvsata
+arm/mv/mv_ts.c standard
arm/mv/timer.c standard
arm/mv/twsi.c optional iicbus
Added: head/sys/arm/mv/mv_ts.c
==============================================================================
--- /dev/null 00:00:00 1970 (empty, because file is newly added)
+++ head/sys/arm/mv/mv_ts.c Sat Aug 18 12:37:07 2012 (r239371)
@@ -0,0 +1,178 @@
+/*-
+ * Copyright (c) 2012 Hiroki Sato <h...@freebsd.org>
+ * 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 AUTHOR 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 AUTHOR 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.
+ *
+ * Driver for on-die thermal sensor in 88F6282 and 88F6283.
+ */
+
+#include <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include <sys/param.h>
+#include <sys/systm.h>
+#include <sys/kernel.h>
+#include <sys/module.h>
+#include <sys/bus.h>
+#include <sys/sysctl.h>
+#include <machine/fdt.h>
+
+#include <dev/fdt/fdt_common.h>
+#include <dev/ofw/ofw_bus.h>
+#include <dev/ofw/ofw_bus_subr.h>
+
+#include <arm/mv/mvreg.h>
+#include <arm/mv/mvvar.h>
+
+static struct resource_spec mvts_res[] = {
+ { SYS_RES_MEMORY, 0, RF_ACTIVE },
+ { -1, 0 }
+};
+
+struct mvts_softc {
+ device_t sc_dev;
+ struct resource *sc_res[sizeof(mvts_res)];
+};
+
+static int
+ts_probe(device_t dev)
+{
+ uint32_t d, r;
+
+ if (!ofw_bus_is_compatible(dev, "mrvl,ts"))
+ return (ENXIO);
+ soc_id(&d, &r);
+ switch (d) {
+ case MV_DEV_88F6282:
+ break;
+ default:
+ device_printf(dev, "unsupported SoC (ID: 0x%08X)!\n", d);
+ return (ENXIO);
+ }
+ device_set_desc(dev, "Marvell Thermal Sensor");
+
+ return (0);
+}
+
+#define MV_TEMP_VALID_BIT (1 << 9)
+#define MV_TEMP_SENS_OFFS 10
+#define MV_TEMP_SENS_MASK 0x1ff
+#define MV_TEMP_SENS_READ_MAX 16
+#define TZ_ZEROC 2732
+#define MV_TEMP_CONVERT(x) ((((322 - x) * 100000) / 13625) +
TZ_ZEROC)
+
+/*
+ * MSB LSB
+ * 0000 0000 0000 0000 0000 0000 0000 0000
+ * ^- valid bit
+ * |---------|
+ * ^--- temperature (9 bits)
+ */
+
+static int
+ts_sysctl_handler(SYSCTL_HANDLER_ARGS)
+{
+ struct mvts_softc *sc;
+ device_t dev;
+ uint32_t ret, ret0;
+ u_int val;
+ int i;
+
+ dev = (device_t)arg1;
+ sc = device_get_softc(dev);
+ val = TZ_ZEROC;
+
+ ret = bus_read_4(sc->sc_res[0], 0);
+ if ((ret & MV_TEMP_VALID_BIT) == 0) {
+ device_printf(dev, "temperature sensor is broken.\n");
+ goto ts_sysctl_handle_int;
+ }
+ ret0 = 0;
+ for (i = 0; i < MV_TEMP_SENS_READ_MAX; i++) {
+ ret = bus_read_4(sc->sc_res[0], 0);
+ ret = (ret >> MV_TEMP_SENS_OFFS) & MV_TEMP_SENS_MASK;
+
+ /*
+ * Successive reads should returns the same value except
+ * for the LSB when the sensor is normal.
+ */
+ if (((ret0 ^ ret) & 0x1fe) == 0)
+ break;
+ else
+ ret0 = ret;
+ }
+ if (i == MV_TEMP_SENS_READ_MAX) {
+ device_printf(dev, "temperature sensor is unstable.\n");
+ goto ts_sysctl_handle_int;
+ }
+ val = (u_int)MV_TEMP_CONVERT(ret);
+
+ts_sysctl_handle_int:
+ return (sysctl_handle_int(oidp, &val, 0, req));
+}
+
+static int
+ts_attach(device_t dev)
+{
+ struct mvts_softc *sc;
+ struct sysctl_ctx_list *ctx;
+ int error;
+
+ sc = device_get_softc(dev);
+ sc->sc_dev = dev;
+ error = bus_alloc_resources(dev, mvts_res, sc->sc_res);
+ if (error) {
+ device_printf(dev, "could not allocate resources\n");
+ return (ENXIO);
+ }
+ ctx = device_get_sysctl_ctx(dev);
+ SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(device_get_sysctl_tree(dev)),
+ OID_AUTO, "temperature", CTLTYPE_INT | CTLFLAG_RD, dev,
+ 0, ts_sysctl_handler, "IK", "Current Temperature");
+
+ return (0);
+}
+
+static int
+ts_detach(device_t dev)
+{
+
+ return (0);
+}
+
+static device_method_t ts_methods[] = {
+ DEVMETHOD(device_probe, ts_probe),
+ DEVMETHOD(device_attach, ts_attach),
+ DEVMETHOD(device_detach, ts_detach),
+ {0, 0},
+};
+
+static driver_t ts_driver = {
+ "mvts",
+ ts_methods,
+ sizeof(struct mvts_softc),
+};
+
+static devclass_t ts_devclass;
+DRIVER_MODULE(mvts, simplebus, ts_driver, ts_devclass, 0, 0);
+MODULE_VERSION(mvts, 1);
_______________________________________________
svn-src-head@freebsd.org mailing list
http://lists.freebsd.org/mailman/listinfo/svn-src-head
To unsubscribe, send any mail to "svn-src-head-unsubscr...@freebsd.org"
