Author: loos
Date: Sat May 10 12:19:02 2014
New Revision: 265813
URL: http://svnweb.freebsd.org/changeset/base/265813
Log:
Add the lm75 i2c digital temperature sensor driver.
This driver supports the low and high precision models (9 and 11 bits) and
it will auto-detect the both variants.
The driver expose the temperature registers (actual temperature, shutdown
and hysteresys temperature) and also the configuration register.
It was tested on FDT systems: RPi, BBB and on non-FDT systems: AR71xx, with
both, hardware i2c controllers (when available) and gpioiic(4).
This provides a simple and cheap way for verifying the i2c bus on embedded
systems.
Added:
head/share/man/man4/lm75.4 (contents, props changed)
head/sys/dev/iicbus/lm75.c (contents, props changed)
Modified:
head/share/man/man4/Makefile
head/sys/conf/files
Modified: head/share/man/man4/Makefile
==============================================================================
--- head/share/man/man4/Makefile Sat May 10 09:17:45 2014
(r265812)
+++ head/share/man/man4/Makefile Sat May 10 12:19:02 2014
(r265813)
@@ -228,6 +228,7 @@ MAN= aac.4 \
led.4 \
lge.4 \
${_linux.4} \
+ lm75.4 \
lmc.4 \
lo.4 \
lp.4 \
Added: head/share/man/man4/lm75.4
==============================================================================
--- /dev/null 00:00:00 1970 (empty, because file is newly added)
+++ head/share/man/man4/lm75.4 Sat May 10 12:19:02 2014 (r265813)
@@ -0,0 +1,191 @@
+.\"
+.\" Copyright (c) 2014 Luiz Otavio O Souza <[email protected]>
+.\" 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 ``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 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.
+.\"
+.\" $FreeBSD$
+.\"
+.Dd March 7, 2014
+.Dt LM75 4
+.Os
+.Sh NAME
+.Nm lm75
+.Nd lm75 i2c digital temperature sensor driver
+.Sh SYNOPSIS
+.Cd "device iic"
+.Cd "device iicbus"
+.Cd "device lm75"
+.Sh DESCRIPTION
+The
+.Nm
+driver provides access to sensor data and configuration over the
+.Xr iicbus 4 .
+.Pp
+It provides an easy and simple way to check the functionality of an i2c bus
+as it provides read and write access to the
+.Nm
+configuration register.
+.Pp
+The access to
+.Nm
+data is made via the
+.Xr sysctl 8
+interface:
+.Bd -literal
+dev.lm75.0.%desc: LM75 temperature sensor
+dev.lm75.0.%driver: lm75
+dev.lm75.0.%location: addr=0x49
+dev.lm75.0.%pnpinfo: name=lm750 compat=national,lm75
+dev.lm75.0.%parent: iicbus3
+dev.lm75.0.temperature: 27.1C
+dev.lm75.0.thyst: 75.0C
+dev.lm75.0.tos: 80.0C
+dev.lm75.0.faults: 1
+dev.lm75.0.mode: comparator
+dev.lm75.0.polarity: active-low
+dev.lm75.0.shutdown: 0
+.Ed
+.Bl -tag -width ".Va dev.lm75.%d.temperature"
+.It Va dev.lm75.%d.temperature
+Is the read-only value of the current temperature read by the sensor.
+.It Va dev.lm75.%d.thyst
+Sets the hysteresis temperature.
+Once the temperature get over the overtemperature shutdown value (tos)
+it need to drop bellow the hysteresis temperature to disable the output
+(interrupt) pin again.
+.It Va dev.lm75.%d.tos
+Sets the overtemperature shutdown value.
+Once the temperature get over this value the output pin will be enabled.
+The way the output (interrupt) pin works, depends on the mode configuration.
+.It Va dev.lm75.%d.faults
+Is the number of faults that must occur consecutively to activate the
+interrupt (output) pin.
+It can be set to 1, 2, 4, and 6.
+.It Va dev.lm75.%d.mode
+Set the operation mode for the sensor interrupt pin.
+It can be set to 'comparator' (default) or 'interrupt'.
+.It Va dev.lm75.%d.polarity
+Set the polarity of the sensor interrupt pin.
+It can be set to 'active-low' (default) or 'active-high'.
+Please note that the output pin is an open-drain output and it needs a
+proper pull-up resistor to work.
+.It Va dev.lm75.%d.shutdown
+When set to '1' it shutdown the sensor.
+The temperature convertion stops but the sensor remains with its i2c bus
+active, i.e., it can be woken up by setting this option to '0' again.
+.El
+.Pp
+Please check the
+.Nm
+datasheet for more details.
+.Pp
+When used together with
+.Xr snmp_lm75 3
+it allows the monitoring of
+.Nm
+temperature data over SNMP.
+.Pp
+The
+.Nm
+driver supports both the low and the high resolution models.
+.Pp
+The low resolution model (lm75) provides a 9 bit output with the LSB
+representing 0.5C.
+.Pp
+The high resolution model (lm75a) provides an 11 bit output with the LSB
+representing 0.125C.
+.Pp
+The driver tries to auto-detect the
+.Nm
+model, but the detection of some
+.Nm
+clones may not work reliably.
+.Pp
+On a
+.Xr device.hints 5
+based system, like
+.Li MIPS ,
+these values are configurable for the
+.Nm :
+.Bl -tag -width ".Va hint.lm75.%d.addr"
+.It Va hint.lm75.%d.at
+Is the
+.Xr iicbus 4
+you are attaching to.
+.It Va hint.lm75.%d.addr
+Is the
+.Nm
+i2c address on the
+.Xr iicbus 4 .
+.El
+.Pp
+On a
+.Xr FDT 4
+based system, like
+.Li ARM ,
+the DTS part for a
+.Nm
+device usually looks like:
+.Bd -literal
+i2c {
+
+ ...
+
+ lm750 {
+ compatible = "national,lm75";
+ i2c-address = <0x49>;
+ };
+};
+.Ed
+.Pp
+Where:
+.Bl -tag -width ".Va i2c-address"
+.It Va compatible
+Should always be set to "national,lm75".
+.It Va i2c-address
+The
+.Va i2c-address
+property indicates which i2c address the
+.Nm
+is wired at.
+.Nm
+temperature sensors can be wired to 8 different address, allowing up to 8
+sensors on the same
+.Xr iicbus 4 .
+.El
+.Sh SEE ALSO
+.Xr snmp_lm75 3 ,
+.Xr fdt 4 ,
+.Xr iic 4 ,
+.Xr iicbus 4 ,
+.Xr sysctl 8
+.Sh HISTORY
+The
+.Nm
+driver first appeared in
+.Fx 11.0 .
+.Sh AUTHORS
+.An -nosplit
+The
+.Nm
+driver and this manual page was written by
+.An Luiz Otavio O Souza Aq [email protected]
Modified: head/sys/conf/files
==============================================================================
--- head/sys/conf/files Sat May 10 09:17:45 2014 (r265812)
+++ head/sys/conf/files Sat May 10 12:19:02 2014 (r265813)
@@ -1444,6 +1444,7 @@ dev/iicbus/iiconf.c optional iicbus
dev/iicbus/iicsmb.c optional iicsmb \
dependency "iicbus_if.h"
dev/iicbus/iicoc.c optional iicoc
+dev/iicbus/lm75.c optional lm75
dev/iicbus/pcf8563.c optional pcf8563
dev/iicbus/s35390a.c optional s35390a
dev/iir/iir.c optional iir
Added: head/sys/dev/iicbus/lm75.c
==============================================================================
--- /dev/null 00:00:00 1970 (empty, because file is newly added)
+++ head/sys/dev/iicbus/lm75.c Sat May 10 12:19:02 2014 (r265813)
@@ -0,0 +1,574 @@
+/*-
+ * Copyright (c) 2010 Andreas Tobler.
+ * Copyright (c) 2013-2014 Luiz Otavio O Souza <[email protected]>
+ * 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 ``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 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/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include "opt_platform.h"
+
+#include <sys/param.h>
+#include <sys/bus.h>
+#include <sys/endian.h>
+#include <sys/kernel.h>
+#include <sys/module.h>
+#include <sys/sysctl.h>
+#include <sys/systm.h>
+
+#include <machine/bus.h>
+
+#include <dev/iicbus/iicbus.h>
+#include <dev/iicbus/iiconf.h>
+
+#ifdef FDT
+#include <dev/ofw/openfirm.h>
+#include <dev/ofw/ofw_bus.h>
+#include <dev/ofw/ofw_bus_subr.h>
+#endif
+
+/* LM75 registers. */
+#define LM75_TEMP 0x0
+#define LM75_CONF 0x1
+#define LM75_CONF_FSHIFT 3
+#define LM75_CONF_FAULT 0x18
+#define LM75_CONF_POL 0x04
+#define LM75_CONF_MODE 0x02
+#define LM75_CONF_SHUTD 0x01
+#define LM75_CONF_MASK 0x1f
+#define LM75_THYST 0x2
+#define LM75_TOS 0x3
+
+/* LM75 constants. */
+#define LM75_TEST_PATTERN 0xa
+#define LM75_MIN_TEMP -55
+#define LM75_MAX_TEMP 125
+#define LM75_0500C 0x80
+#define LM75_0250C 0x40
+#define LM75_0125C 0x20
+#define LM75_MSB 0x8000
+#define LM75_NEG_BIT LM75_MSB
+#define TZ_ZEROC 2732
+
+/* LM75 supported models. */
+#define HWTYPE_LM75 1
+#define HWTYPE_LM75A 2
+
+/* Regular bus attachment functions */
+static int lm75_probe(device_t);
+static int lm75_attach(device_t);
+
+struct lm75_softc {
+ device_t sc_dev;
+ struct intr_config_hook enum_hook;
+ int32_t sc_hwtype;
+ uint32_t sc_addr;
+ uint32_t sc_conf;
+};
+
+static int lm75_faults[4] = { 1, 2, 4, 6 };
+
+/* Utility functions */
+static int lm75_conf_read(struct lm75_softc *);
+static int lm75_conf_write(struct lm75_softc *);
+static int lm75_temp_read(struct lm75_softc *, uint8_t, int *);
+static int lm75_temp_write(struct lm75_softc *, uint8_t, int);
+static void lm75_start(void *);
+static int lm75_read(device_t, uint32_t, uint8_t, uint8_t *, size_t);
+static int lm75_write(device_t, uint32_t, uint8_t *, size_t);
+static int lm75_str_mode(char *);
+static int lm75_str_pol(char *);
+static int lm75_temp_sysctl(SYSCTL_HANDLER_ARGS);
+static int lm75_faults_sysctl(SYSCTL_HANDLER_ARGS);
+static int lm75_mode_sysctl(SYSCTL_HANDLER_ARGS);
+static int lm75_pol_sysctl(SYSCTL_HANDLER_ARGS);
+static int lm75_shutdown_sysctl(SYSCTL_HANDLER_ARGS);
+
+static device_method_t lm75_methods[] = {
+ /* Device interface */
+ DEVMETHOD(device_probe, lm75_probe),
+ DEVMETHOD(device_attach, lm75_attach),
+
+ DEVMETHOD_END
+};
+
+static driver_t lm75_driver = {
+ "lm75",
+ lm75_methods,
+ sizeof(struct lm75_softc)
+};
+
+static devclass_t lm75_devclass;
+
+DRIVER_MODULE(lm75, iicbus, lm75_driver, lm75_devclass, 0, 0);
+
+static int
+lm75_read(device_t dev, uint32_t addr, uint8_t reg, uint8_t *data, size_t len)
+{
+ struct iic_msg msg[2] = {
+ { addr, IIC_M_WR | IIC_M_NOSTOP, 1, ® },
+ { addr, IIC_M_RD, len, data },
+ };
+
+ if (iicbus_transfer(dev, msg, 2) != 0)
+ return (-1);
+
+ return (0);
+}
+
+static int
+lm75_write(device_t dev, uint32_t addr, uint8_t *data, size_t len)
+{
+ struct iic_msg msg[1] = {
+ { addr, IIC_M_WR, len, data },
+ };
+
+ if (iicbus_transfer(dev, msg, 1) != 0)
+ return (-1);
+
+ return (0);
+}
+
+static int
+lm75_probe(device_t dev)
+{
+ struct lm75_softc *sc;
+
+ sc = device_get_softc(dev);
+ sc->sc_hwtype = HWTYPE_LM75;
+#ifdef FDT
+ if (!ofw_bus_is_compatible(dev, "national,lm75"))
+ return (ENXIO);
+#endif
+ device_set_desc(dev, "LM75 temperature sensor");
+
+ return (BUS_PROBE_GENERIC);
+}
+
+static int
+lm75_attach(device_t dev)
+{
+ struct lm75_softc *sc;
+
+ sc = device_get_softc(dev);
+ sc->sc_dev = dev;
+ sc->sc_addr = iicbus_get_addr(dev);
+
+ sc->enum_hook.ich_func = lm75_start;
+ sc->enum_hook.ich_arg = dev;
+
+ /*
+ * We have to wait until interrupts are enabled. Usually I2C read
+ * and write only works when the interrupts are available.
+ */
+ if (config_intrhook_establish(&sc->enum_hook) != 0)
+ return (ENOMEM);
+
+ return (0);
+}
+
+static int
+lm75_type_detect(struct lm75_softc *sc)
+{
+ int i, lm75a;
+ uint8_t buf8;
+ uint32_t conf;
+
+ /* Save the contents of the configuration register. */
+ if (lm75_conf_read(sc) != 0)
+ return (-1);
+ conf = sc->sc_conf;
+
+ /*
+ * Just write some pattern at configuration register so we can later
+ * verify. The test pattern should be pretty harmless.
+ */
+ sc->sc_conf = LM75_TEST_PATTERN;
+ if (lm75_conf_write(sc) != 0)
+ return (-1);
+
+ /*
+ * Read the configuration register again and check for our test
+ * pattern.
+ */
+ if (lm75_conf_read(sc) != 0)
+ return (-1);
+ if (sc->sc_conf != LM75_TEST_PATTERN)
+ return (-1);
+
+ /*
+ * Read from nonexistent registers (0x4 ~ 0x6).
+ * LM75A always return 0xff for nonexistent registers.
+ * LM75 will return the last read value - our test pattern written to
+ * configuration register.
+ */
+ lm75a = 0;
+ for (i = 4; i <= 6; i++) {
+ if (lm75_read(sc->sc_dev, sc->sc_addr, i, &buf8, 1) < 0)
+ return (-1);
+ if (buf8 != LM75_TEST_PATTERN && buf8 != 0xff)
+ return (-1);
+ if (buf8 == 0xff)
+ lm75a++;
+ }
+ if (lm75a == 3)
+ sc->sc_hwtype = HWTYPE_LM75A;
+
+ /* Restore the configuration register. */
+ sc->sc_conf = conf;
+ if (lm75_conf_write(sc) != 0)
+ return (-1);
+
+ return (0);
+}
+
+static void
+lm75_start(void *xdev)
+{
+ device_t dev;
+ struct lm75_softc *sc;
+ struct sysctl_ctx_list *ctx;
+ struct sysctl_oid *tree_node;
+ struct sysctl_oid_list *tree;
+
+ dev = (device_t)xdev;
+ sc = device_get_softc(dev);
+ ctx = device_get_sysctl_ctx(dev);
+ tree_node = device_get_sysctl_tree(dev);
+ tree = SYSCTL_CHILDREN(tree_node);
+
+ config_intrhook_disestablish(&sc->enum_hook);
+
+ /*
+ * Detect the kind of chip we are attaching to.
+ * This may not work for LM75 clones.
+ */
+ if (lm75_type_detect(sc) != 0) {
+ device_printf(dev, "cannot read from sensor.\n");
+ return;
+ }
+ if (sc->sc_hwtype == HWTYPE_LM75A)
+ device_printf(dev,
+ "LM75A type sensor detected (11bits resolution).\n");
+
+ /* Temperature. */
+ SYSCTL_ADD_PROC(ctx, tree, OID_AUTO, "temperature",
+ CTLTYPE_INT | CTLFLAG_RD | CTLFLAG_MPSAFE, dev, LM75_TEMP,
+ lm75_temp_sysctl, "IK", "Current temperature");
+ SYSCTL_ADD_PROC(ctx, tree, OID_AUTO, "thyst",
+ CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE, dev, LM75_THYST,
+ lm75_temp_sysctl, "IK", "Hysteresis temperature");
+ SYSCTL_ADD_PROC(ctx, tree, OID_AUTO, "tos",
+ CTLTYPE_INT | CTLFLAG_RW | CTLFLAG_MPSAFE, dev, LM75_TOS,
+ lm75_temp_sysctl, "IK", "Overtemperature");
+
+ /* Configuration parameters. */
+ SYSCTL_ADD_PROC(ctx, tree, OID_AUTO, "faults",
+ CTLFLAG_RW | CTLTYPE_UINT, dev, 0,
+ lm75_faults_sysctl, "IU", "LM75 fault queue");
+ SYSCTL_ADD_PROC(ctx, tree, OID_AUTO, "mode",
+ CTLFLAG_RW | CTLTYPE_STRING, dev, 0,
+ lm75_mode_sysctl, "A", "LM75 mode");
+ SYSCTL_ADD_PROC(ctx, tree, OID_AUTO, "polarity",
+ CTLFLAG_RW | CTLTYPE_STRING, dev, 0,
+ lm75_pol_sysctl, "A", "LM75 OS polarity");
+ SYSCTL_ADD_PROC(ctx, tree, OID_AUTO, "shutdown",
+ CTLFLAG_RW | CTLTYPE_UINT, dev, 0,
+ lm75_shutdown_sysctl, "IU", "LM75 shutdown");
+}
+
+static int
+lm75_conf_read(struct lm75_softc *sc)
+{
+ uint8_t buf8;
+
+ if (lm75_read(sc->sc_dev, sc->sc_addr, LM75_CONF, &buf8, 1) < 0)
+ return (-1);
+
+ sc->sc_conf = (uint32_t)buf8;
+
+ return (0);
+}
+
+static int
+lm75_conf_write(struct lm75_softc *sc)
+{
+ uint8_t buf8[2];
+
+ buf8[0] = LM75_CONF;
+ buf8[1] = (uint8_t)sc->sc_conf & LM75_CONF_MASK;
+
+ if (lm75_write(sc->sc_dev, sc->sc_addr, buf8, 2) < 0)
+ return (-1);
+
+ return (0);
+}
+
+static int
+lm75_temp_read(struct lm75_softc *sc, uint8_t reg, int *temp)
+{
+ uint8_t buf8[2];
+ uint16_t buf;
+ int t;
+
+ if (lm75_read(sc->sc_dev, sc->sc_addr, reg, buf8, 2) < 0)
+ return (-1);
+
+ buf = (buf8[0] << 8) | (buf8[1] & 0xff);
+
+ /*
+ * LM75 has a 9 bit ADC with resolution of 0.5 C per bit.
+ * LM75A has an 11 bit ADC with resolution of 0.125 C per bit.
+ * Temperature is stored with two's complement.
+ */
+ if (buf & LM75_NEG_BIT)
+ buf = ~buf + 1;
+ *temp = ((int16_t)buf >> 8) * 10;
+ t = 0;
+ if (sc->sc_hwtype == HWTYPE_LM75A) {
+ if (buf & LM75_0125C)
+ t += 125;
+ if (buf & LM75_0250C)
+ t += 250;
+ }
+ if (buf & LM75_0500C)
+ t += 500;
+ t /= 100;
+ *temp += t;
+ if (buf & LM75_NEG_BIT)
+ *temp = -(*temp);
+ *temp += TZ_ZEROC;
+
+ return (0);
+}
+
+static int
+lm75_temp_write(struct lm75_softc *sc, uint8_t reg, int temp)
+{
+ uint8_t buf8[3];
+ uint16_t buf;
+
+ if (temp > LM75_MAX_TEMP)
+ temp = LM75_MAX_TEMP;
+ if (temp < LM75_MIN_TEMP)
+ temp = LM75_MIN_TEMP;
+
+ buf = (uint16_t)temp;
+ buf <<= 8;
+
+ buf8[0] = reg;
+ buf8[1] = buf >> 8;
+ buf8[2] = buf & 0xff;
+
+ if (lm75_write(sc->sc_dev, sc->sc_addr, buf8, 3) < 0)
+ return (-1);
+
+ return (0);
+}
+
+static int
+lm75_str_mode(char *buf)
+{
+ int len, rtrn;
+
+ rtrn = -1;
+ len = strlen(buf);
+ if (len > 2 && strncasecmp("interrupt", buf, len) == 0)
+ rtrn = 1;
+ else if (len > 2 && strncasecmp("comparator", buf, len) == 0)
+ rtrn = 0;
+
+ return (rtrn);
+}
+
+static int
+lm75_str_pol(char *buf)
+{
+ int len, rtrn;
+
+ rtrn = -1;
+ len = strlen(buf);
+ if (len > 1 && strncasecmp("high", buf, len) == 0)
+ rtrn = 1;
+ else if (len > 1 && strncasecmp("low", buf, len) == 0)
+ rtrn = 0;
+ else if (len > 8 && strncasecmp("active-high", buf, len) == 0)
+ rtrn = 1;
+ else if (len > 8 && strncasecmp("active-low", buf, len) == 0)
+ rtrn = 0;
+
+ return (rtrn);
+}
+
+static int
+lm75_temp_sysctl(SYSCTL_HANDLER_ARGS)
+{
+ device_t dev;
+ int error, temp;
+ struct lm75_softc *sc;
+ uint8_t reg;
+
+ dev = (device_t)arg1;
+ reg = (uint8_t)arg2;
+ sc = device_get_softc(dev);
+
+ if (lm75_temp_read(sc, reg, &temp) != 0)
+ return (EIO);
+
+ error = sysctl_handle_int(oidp, &temp, 0, req);
+ if (error != 0 || req->newptr == NULL)
+ return (error);
+
+ if (lm75_temp_write(sc, reg, temp) != 0)
+ return (EIO);
+
+ return (error);
+}
+
+static int
+lm75_faults_sysctl(SYSCTL_HANDLER_ARGS)
+{
+ device_t dev;
+ int error, faults, i, newf, tmp;
+ struct lm75_softc *sc;
+
+ dev = (device_t)arg1;
+ sc = device_get_softc(dev);
+ tmp = (sc->sc_conf & LM75_CONF_FAULT) >> LM75_CONF_FSHIFT;
+ if (tmp > nitems(lm75_faults))
+ tmp = nitems(lm75_faults);
+ faults = lm75_faults[tmp];
+
+ error = sysctl_handle_int(oidp, &faults, 0, req);
+ if (error != 0 || req->newptr == NULL)
+ return (error);
+
+ if (faults != lm75_faults[tmp]) {
+ newf = 0;
+ for (i = 0; i < nitems(lm75_faults); i++)
+ if (faults >= lm75_faults[i])
+ newf = i;
+ sc->sc_conf &= ~LM75_CONF_FAULT;
+ sc->sc_conf |= newf << LM75_CONF_FSHIFT;
+ if (lm75_conf_write(sc) != 0)
+ return (EIO);
+ }
+
+ return (error);
+}
+
+static int
+lm75_mode_sysctl(SYSCTL_HANDLER_ARGS)
+{
+ char buf[16];
+ device_t dev;
+ int error, mode, newm;
+ struct lm75_softc *sc;
+
+ dev = (device_t)arg1;
+ sc = device_get_softc(dev);
+ if (sc->sc_conf & LM75_CONF_MODE) {
+ mode = 1;
+ strlcpy(buf, "interrupt", sizeof(buf));
+ } else {
+ mode = 0;
+ strlcpy(buf, "comparator", sizeof(buf));
+ }
+
+ error = sysctl_handle_string(oidp, buf, sizeof(buf), req);
+ if (error != 0 || req->newptr == NULL)
+ return (error);
+
+ newm = lm75_str_mode(buf);
+ if (newm != -1 && mode != newm) {
+ sc->sc_conf &= ~LM75_CONF_MODE;
+ if (newm == 1)
+ sc->sc_conf |= LM75_CONF_MODE;
+ if (lm75_conf_write(sc) != 0)
+ return (EIO);
+ }
+
+ return (error);
+}
+
+static int
+lm75_pol_sysctl(SYSCTL_HANDLER_ARGS)
+{
+ char buf[16];
+ device_t dev;
+ int error, newp, pol;
+ struct lm75_softc *sc;
+
+ dev = (device_t)arg1;
+ sc = device_get_softc(dev);
+ if (sc->sc_conf & LM75_CONF_POL) {
+ pol = 1;
+ strlcpy(buf, "active-high", sizeof(buf));
+ } else {
+ pol = 0;
+ strlcpy(buf, "active-low", sizeof(buf));
+ }
+
+ error = sysctl_handle_string(oidp, buf, sizeof(buf), req);
+ if (error != 0 || req->newptr == NULL)
+ return (error);
+
+ newp = lm75_str_pol(buf);
+ if (newp != -1 && pol != newp) {
+ sc->sc_conf &= ~LM75_CONF_POL;
+ if (newp == 1)
+ sc->sc_conf |= LM75_CONF_POL;
+ if (lm75_conf_write(sc) != 0)
+ return (EIO);
+ }
+
+ return (error);
+}
+
+static int
+lm75_shutdown_sysctl(SYSCTL_HANDLER_ARGS)
+{
+ device_t dev;
+ int error, shutdown, tmp;
+ struct lm75_softc *sc;
+
+ dev = (device_t)arg1;
+ sc = device_get_softc(dev);
+ tmp = shutdown = (sc->sc_conf & LM75_CONF_SHUTD) ? 1 : 0;
+
+ error = sysctl_handle_int(oidp, &shutdown, 0, req);
+ if (error != 0 || req->newptr == NULL)
+ return (error);
+
+ if (shutdown != tmp) {
+ sc->sc_conf &= ~LM75_CONF_SHUTD;
+ if (shutdown)
+ sc->sc_conf |= LM75_CONF_SHUTD;
+ if (lm75_conf_write(sc) != 0)
+ return (EIO);
+ }
+
+ return (error);
+}
_______________________________________________
[email protected] mailing list
http://lists.freebsd.org/mailman/listinfo/svn-src-head
To unsubscribe, send any mail to "[email protected]"
