Skip site navigation (1)Skip section navigation (2)
Date:      Sat, 10 May 2014 12:19:03 +0000 (UTC)
From:      Luiz Otavio O Souza <loos@FreeBSD.org>
To:        src-committers@freebsd.org, svn-src-all@freebsd.org, svn-src-head@freebsd.org
Subject:   svn commit: r265813 - in head: share/man/man4 sys/conf sys/dev/iicbus
Message-ID:  <201405101219.s4ACJ3ug091717@svn.freebsd.org>

next in thread | raw e-mail | index | archive | help
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 <loos@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 ``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 loos@FreeBSD.org

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 <loos@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 ``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, &reg },
+	    { 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);
+}



Want to link to this message? Use this URL: <https://mail-archive.FreeBSD.org/cgi/mid.cgi?201405101219.s4ACJ3ug091717>