Home | History | Annotate | Line # | Download | only in i2c
sdtemp.c revision 1.23.4.1.4.1
      1  1.23.4.1.4.1     skrll /*      $NetBSD: sdtemp.c,v 1.23.4.1.4.1 2017/01/18 08:46:27 skrll Exp $        */
      2           1.1  pgoyette 
      3           1.1  pgoyette /*
      4           1.1  pgoyette  * Copyright (c) 2009 The NetBSD Foundation, Inc.
      5           1.1  pgoyette  * All rights reserved.
      6           1.1  pgoyette  *
      7           1.1  pgoyette  * This code is derived from software contributed to The NetBSD Foundation
      8           1.1  pgoyette  * by Paul Goyette.
      9           1.1  pgoyette  *
     10           1.1  pgoyette  * Redistribution and use in source and binary forms, with or without
     11           1.1  pgoyette  * modification, are permitted provided that the following conditions
     12           1.1  pgoyette  * are met:
     13           1.1  pgoyette  * 1. Redistributions of source code must retain the above copyright
     14           1.1  pgoyette  *    notice, this list of conditions and the following disclaimer.
     15           1.1  pgoyette  * 2. Redistributions in binary form must reproduce the above copyright
     16           1.1  pgoyette  *    notice, this list of conditions and the following disclaimer in the
     17           1.1  pgoyette  *    documentation and/or other materials provided with the distribution.
     18           1.1  pgoyette  *
     19           1.1  pgoyette  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20           1.1  pgoyette  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21           1.1  pgoyette  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22           1.1  pgoyette  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23           1.1  pgoyette  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24           1.1  pgoyette  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25           1.1  pgoyette  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26           1.1  pgoyette  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27           1.1  pgoyette  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28           1.1  pgoyette  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29           1.1  pgoyette  * POSSIBILITY OF SUCH DAMAGE.
     30           1.1  pgoyette  */
     31           1.1  pgoyette 
     32           1.1  pgoyette #include <sys/cdefs.h>
     33  1.23.4.1.4.1     skrll __KERNEL_RCSID(0, "$NetBSD: sdtemp.c,v 1.23.4.1.4.1 2017/01/18 08:46:27 skrll Exp $");
     34           1.1  pgoyette 
     35           1.1  pgoyette #include <sys/param.h>
     36           1.1  pgoyette #include <sys/systm.h>
     37           1.1  pgoyette #include <sys/kmem.h>
     38           1.1  pgoyette #include <sys/device.h>
     39           1.1  pgoyette #include <sys/kernel.h>
     40           1.1  pgoyette #include <sys/endian.h>
     41          1.19  jmcneill #include <sys/module.h>
     42           1.1  pgoyette 
     43           1.1  pgoyette #include <dev/sysmon/sysmonvar.h>
     44           1.1  pgoyette 
     45           1.1  pgoyette #include <dev/i2c/i2cvar.h>
     46           1.1  pgoyette #include <dev/i2c/sdtemp_reg.h>
     47           1.1  pgoyette 
     48           1.1  pgoyette struct sdtemp_softc {
     49           1.1  pgoyette 	device_t sc_dev;
     50           1.1  pgoyette 	i2c_tag_t sc_tag;
     51           1.1  pgoyette 	int sc_address;
     52           1.1  pgoyette 
     53           1.1  pgoyette 	struct sysmon_envsys *sc_sme;
     54           1.1  pgoyette 	envsys_data_t *sc_sensor;
     55          1.13  pgoyette 	sysmon_envsys_lim_t sc_deflims;
     56          1.13  pgoyette 	uint32_t sc_defprops;
     57           1.1  pgoyette 	int sc_resolution;
     58  1.23.4.1.4.1     skrll 	uint16_t sc_mfgid;
     59  1.23.4.1.4.1     skrll 	uint16_t sc_devid;
     60  1.23.4.1.4.1     skrll 	uint16_t sc_devid_masked;
     61           1.1  pgoyette 	uint16_t sc_capability;
     62           1.1  pgoyette };
     63           1.1  pgoyette 
     64           1.1  pgoyette static int  sdtemp_match(device_t, cfdata_t, void *);
     65           1.1  pgoyette static void sdtemp_attach(device_t, device_t, void *);
     66          1.19  jmcneill static int  sdtemp_detach(device_t, int);
     67           1.1  pgoyette 
     68           1.1  pgoyette CFATTACH_DECL_NEW(sdtemp, sizeof(struct sdtemp_softc),
     69          1.19  jmcneill 	sdtemp_match, sdtemp_attach, sdtemp_detach, NULL);
     70           1.1  pgoyette 
     71           1.1  pgoyette static void	sdtemp_refresh(struct sysmon_envsys *, envsys_data_t *);
     72           1.6  pgoyette static void	sdtemp_get_limits(struct sysmon_envsys *, envsys_data_t *,
     73          1.10  pgoyette 				  sysmon_envsys_lim_t *, uint32_t *);
     74           1.6  pgoyette static void	sdtemp_set_limits(struct sysmon_envsys *, envsys_data_t *,
     75          1.10  pgoyette 				  sysmon_envsys_lim_t *, uint32_t *);
     76           1.1  pgoyette #ifdef NOT_YET
     77           1.1  pgoyette static int	sdtemp_read_8(struct sdtemp_softc *, uint8_t, uint8_t *);
     78           1.1  pgoyette static int	sdtemp_write_8(struct sdtemp_softc *, uint8_t, uint8_t);
     79           1.1  pgoyette #endif /* NOT YET */
     80           1.1  pgoyette static int	sdtemp_read_16(struct sdtemp_softc *, uint8_t, uint16_t *);
     81           1.1  pgoyette static int	sdtemp_write_16(struct sdtemp_softc *, uint8_t, uint16_t);
     82           1.1  pgoyette static uint32_t	sdtemp_decode_temp(struct sdtemp_softc *, uint16_t);
     83          1.11    dyoung static bool	sdtemp_pmf_suspend(device_t, const pmf_qual_t *);
     84          1.11    dyoung static bool	sdtemp_pmf_resume(device_t, const pmf_qual_t *);
     85  1.23.4.1.4.1     skrll /* Device dependent config functions */
     86  1.23.4.1.4.1     skrll static void	sdtemp_config_mcp(struct sdtemp_softc *);
     87  1.23.4.1.4.1     skrll static void	sdtemp_config_idt(struct sdtemp_softc *);
     88           1.1  pgoyette 
     89           1.1  pgoyette struct sdtemp_dev_entry {
     90           1.1  pgoyette 	const uint16_t sdtemp_mfg_id;
     91  1.23.4.1.4.1     skrll 	const uint16_t sdtemp_devrev;
     92  1.23.4.1.4.1     skrll 	const uint16_t sdtemp_mask;
     93  1.23.4.1.4.1     skrll 	void         (*sdtemp_config)(struct sdtemp_softc *);
     94           1.1  pgoyette 	const char    *sdtemp_desc;
     95           1.1  pgoyette };
     96           1.1  pgoyette 
     97           1.4  pgoyette /* Convert sysmon_envsys uKelvin value to simple degC */
     98           1.4  pgoyette 
     99           1.4  pgoyette #define	__UK2C(uk) (((uk) - 273150000) / 1000000)
    100           1.1  pgoyette 
    101  1.23.4.1.4.1     skrll /* List of devices known to conform to JEDEC JC42.4 */
    102  1.23.4.1.4.1     skrll 
    103  1.23.4.1.4.1     skrll #define	CMCP sdtemp_config_mcp
    104  1.23.4.1.4.1     skrll #define	CIDT sdtemp_config_idt
    105  1.23.4.1.4.1     skrll 
    106           1.1  pgoyette static const struct sdtemp_dev_entry
    107           1.1  pgoyette sdtemp_dev_table[] = {
    108  1.23.4.1.4.1     skrll     { AT_MANUFACTURER_ID,   AT_30TS00_DEVICE_ID,     AT_30TS00_MASK,	  NULL,
    109  1.23.4.1.4.1     skrll 	"Atmel AT30TS00" },
    110  1.23.4.1.4.1     skrll     { AT2_MANUFACTURER_ID,  AT2_30TSE004_DEVICE_ID,  AT2_30TSE004_MASK,	  NULL,
    111  1.23.4.1.4.1     skrll 	"Atmel AT30TSE004" },
    112  1.23.4.1.4.1     skrll     { GT_MANUFACTURER_ID,   GT_30TS00_DEVICE_ID,     GT_30TS00_MASK,	  NULL,
    113  1.23.4.1.4.1     skrll 	"Giantec GT30TS00" },
    114  1.23.4.1.4.1     skrll     { GT2_MANUFACTURER_ID,  GT2_34TS02_DEVICE_ID,    GT2_34TS02_MASK,	  NULL,
    115  1.23.4.1.4.1     skrll 	"Giantec GT34TS02" },
    116  1.23.4.1.4.1     skrll     { MAXIM_MANUFACTURER_ID, MAX_6604_DEVICE_ID,     MAX_6604_MASK,	  NULL,
    117          1.16  pgoyette 	"Maxim MAX6604" },
    118  1.23.4.1.4.1     skrll     { MCP_MANUFACTURER_ID,  MCP_9804_DEVICE_ID,	     MCP_9804_MASK,	  CMCP,
    119  1.23.4.1.4.1     skrll 	"Microchip Tech MCP9804" },
    120  1.23.4.1.4.1     skrll     { MCP_MANUFACTURER_ID,  MCP_9805_DEVICE_ID,	     MCP_9805_MASK,	  NULL,
    121          1.14  pgoyette 	"Microchip Tech MCP9805/MCP9843" },
    122  1.23.4.1.4.1     skrll     { MCP_MANUFACTURER_ID,  MCP_98242_DEVICE_ID,     MCP_98242_MASK,	  CMCP,
    123           1.1  pgoyette 	"Microchip Tech MCP98242" },
    124  1.23.4.1.4.1     skrll     { MCP_MANUFACTURER_ID,  MCP_98243_DEVICE_ID,     MCP_98243_MASK,	  CMCP,
    125  1.23.4.1.4.1     skrll 	"Microchip Tech MCP98243" },
    126  1.23.4.1.4.1     skrll     { MCP_MANUFACTURER_ID,  MCP_98244_DEVICE_ID,     MCP_98244_MASK,	  CMCP,
    127  1.23.4.1.4.1     skrll 	"Microchip Tech MCP98244" },
    128  1.23.4.1.4.1     skrll     { ADT_MANUFACTURER_ID,  ADT_7408_DEVICE_ID,	     ADT_7408_MASK,	  NULL,
    129           1.1  pgoyette 	"Analog Devices ADT7408" },
    130  1.23.4.1.4.1     skrll     { NXP_MANUFACTURER_ID,  NXP_SE98_DEVICE_ID,	     NXP_SE98_MASK,	  NULL,
    131          1.14  pgoyette 	"NXP Semiconductors SE97B/SE98" },
    132  1.23.4.1.4.1     skrll     { NXP_MANUFACTURER_ID,  NXP_SE97_DEVICE_ID,	     NXP_SE97_MASK,	  NULL,
    133          1.14  pgoyette 	"NXP Semiconductors SE97" },
    134  1.23.4.1.4.1     skrll     { STTS_MANUFACTURER_ID, STTS_424E_DEVICE_ID,     STTS_424E_MASK,	  NULL,
    135  1.23.4.1.4.1     skrll 	"STmicroelectronics STTS424E" },
    136  1.23.4.1.4.1     skrll     { STTS_MANUFACTURER_ID, STTS_424_DEVICE_ID,	     STTS_424_MASK,	  NULL,
    137  1.23.4.1.4.1     skrll 	"STmicroelectronics STTS424" },
    138  1.23.4.1.4.1     skrll     { STTS_MANUFACTURER_ID, STTS_2002_DEVICE_ID,     STTS_2002_MASK,	  NULL,
    139  1.23.4.1.4.1     skrll 	"STmicroelectronics STTS2002" },
    140  1.23.4.1.4.1     skrll     { STTS_MANUFACTURER_ID, STTS_2004_DEVICE_ID,     STTS_2004_MASK,	  NULL,
    141  1.23.4.1.4.1     skrll 	"STmicroelectronics STTS2004" },
    142  1.23.4.1.4.1     skrll     { STTS_MANUFACTURER_ID, STTS_3000_DEVICE_ID,     STTS_3000_MASK,	  NULL,
    143  1.23.4.1.4.1     skrll 	"STmicroelectronics STTS3000" },
    144  1.23.4.1.4.1     skrll     { CAT_MANUFACTURER_ID,  CAT_34TS02_DEVICE_ID,    CAT_34TS02_MASK,	  NULL,
    145           1.1  pgoyette 	"Catalyst CAT34TS02/CAT6095" },
    146  1.23.4.1.4.1     skrll     { CAT_MANUFACTURER_ID,  CAT_34TS02C_DEVICE_ID,   CAT_34TS02C_MASK,	  NULL,
    147  1.23.4.1.4.1     skrll 	"Catalyst CAT34TS02C" },
    148  1.23.4.1.4.1     skrll     { CAT_MANUFACTURER_ID,  CAT_34TS04_DEVICE_ID,    CAT_34TS04_MASK,	  NULL,
    149  1.23.4.1.4.1     skrll 	"Catalyst CAT34TS04" },
    150  1.23.4.1.4.1     skrll     { IDT_MANUFACTURER_ID,  IDT_TSE2004GB2_DEVICE_ID,IDT_TSE2004GB2_MASK, NULL,
    151  1.23.4.1.4.1     skrll 	"Integrated Device Technology TSE2004GB2" },
    152  1.23.4.1.4.1     skrll     { IDT_MANUFACTURER_ID,  IDT_TS3000B3_DEVICE_ID,  IDT_TS3000B3_MASK,	  CIDT,
    153          1.15  pgoyette 	"Integrated Device Technology TS3000B3/TSE2002B3" },
    154  1.23.4.1.4.1     skrll     { IDT_MANUFACTURER_ID,  IDT_TS3000GB0_DEVICE_ID, IDT_TS3000GB0_MASK,  CIDT,
    155  1.23.4.1.4.1     skrll 	"Integrated Device Technology TS3000GB0" },
    156  1.23.4.1.4.1     skrll     { IDT_MANUFACTURER_ID,  IDT_TS3000GB2_DEVICE_ID, IDT_TS3000GB2_MASK,  CIDT,
    157  1.23.4.1.4.1     skrll 	"Integrated Device Technology TS3000GB2" },
    158  1.23.4.1.4.1     skrll     { IDT_MANUFACTURER_ID,  IDT_TS3001GB2_DEVICE_ID, IDT_TS3001GB2_MASK,  CIDT,
    159  1.23.4.1.4.1     skrll 	"Integrated Device Technology TS3001GB2" },
    160  1.23.4.1.4.1     skrll     /*
    161  1.23.4.1.4.1     skrll      * Don't change the location of the following two entries. Device specific
    162  1.23.4.1.4.1     skrll      * entry must be located at above.
    163  1.23.4.1.4.1     skrll      */
    164  1.23.4.1.4.1     skrll     { 0,		    TSE2004AV_ID,	     TSE2004AV_MASK,	  NULL,
    165  1.23.4.1.4.1     skrll 	"TSE2004av compliant device (generic driver)" },
    166  1.23.4.1.4.1     skrll     { 0, 0, 0, NULL, "Unknown" }
    167  1.23.4.1.4.1     skrll };
    168  1.23.4.1.4.1     skrll 
    169  1.23.4.1.4.1     skrll #undef CMCP
    170  1.23.4.1.4.1     skrll #undef CIDT
    171  1.23.4.1.4.1     skrll 
    172  1.23.4.1.4.1     skrll static const char *temp_resl[] = {
    173  1.23.4.1.4.1     skrll 	"0.5C",
    174  1.23.4.1.4.1     skrll 	"0.25C",
    175  1.23.4.1.4.1     skrll 	"0.125C",
    176  1.23.4.1.4.1     skrll 	"0.0625C"
    177           1.1  pgoyette };
    178           1.1  pgoyette 
    179           1.1  pgoyette static int
    180          1.14  pgoyette sdtemp_lookup(uint16_t mfg, uint16_t devrev)
    181           1.1  pgoyette {
    182           1.1  pgoyette 	int i;
    183           1.1  pgoyette 
    184          1.14  pgoyette 	for (i = 0; sdtemp_dev_table[i].sdtemp_mfg_id; i++) {
    185          1.14  pgoyette 		if (mfg != sdtemp_dev_table[i].sdtemp_mfg_id)
    186          1.14  pgoyette 			continue;
    187          1.14  pgoyette 		if ((devrev & sdtemp_dev_table[i].sdtemp_mask) ==
    188          1.14  pgoyette 		    sdtemp_dev_table[i].sdtemp_devrev)
    189           1.1  pgoyette 			break;
    190          1.14  pgoyette 	}
    191  1.23.4.1.4.1     skrll 	/* Check TSE2004av */
    192  1.23.4.1.4.1     skrll 	if ((sdtemp_dev_table[i].sdtemp_mfg_id == 0)
    193  1.23.4.1.4.1     skrll 	    && (SDTEMP_IS_TSE2004AV(devrev) == 0))
    194  1.23.4.1.4.1     skrll 			i++; /* Unknown */
    195           1.1  pgoyette 
    196           1.1  pgoyette 	return i;
    197           1.1  pgoyette }
    198           1.1  pgoyette 
    199           1.1  pgoyette static int
    200           1.1  pgoyette sdtemp_match(device_t parent, cfdata_t cf, void *aux)
    201           1.1  pgoyette {
    202           1.1  pgoyette 	struct i2c_attach_args *ia = aux;
    203  1.23.4.1.4.1     skrll 	uint16_t mfgid, devid, cap;
    204           1.1  pgoyette 	struct sdtemp_softc sc;
    205           1.1  pgoyette 	int i, error;
    206           1.1  pgoyette 
    207           1.1  pgoyette 	sc.sc_tag = ia->ia_tag;
    208           1.1  pgoyette 	sc.sc_address = ia->ia_addr;
    209           1.1  pgoyette 
    210           1.1  pgoyette 	if ((ia->ia_addr & SDTEMP_ADDRMASK) != SDTEMP_ADDR)
    211           1.1  pgoyette 		return 0;
    212           1.1  pgoyette 
    213  1.23.4.1.4.1     skrll 	/* Verify that we can read the manufacturer ID, Device ID and the capability */
    214           1.1  pgoyette 	iic_acquire_bus(sc.sc_tag, 0);
    215           1.1  pgoyette 	error = sdtemp_read_16(&sc, SDTEMP_REG_MFG_ID,  &mfgid) |
    216  1.23.4.1.4.1     skrll 		sdtemp_read_16(&sc, SDTEMP_REG_DEV_REV, &devid) |
    217  1.23.4.1.4.1     skrll 		sdtemp_read_16(&sc, SDTEMP_REG_CAPABILITY, &cap);
    218           1.1  pgoyette 	iic_release_bus(sc.sc_tag, 0);
    219           1.1  pgoyette 
    220           1.1  pgoyette 	if (error)
    221           1.1  pgoyette 		return 0;
    222           1.1  pgoyette 
    223          1.14  pgoyette 	i = sdtemp_lookup(mfgid, devid);
    224  1.23.4.1.4.1     skrll 	if ((sdtemp_dev_table[i].sdtemp_mfg_id == 0) &&
    225  1.23.4.1.4.1     skrll 	    (sdtemp_dev_table[i].sdtemp_devrev == 0)) {
    226           1.1  pgoyette 		aprint_debug("sdtemp: No match for mfg 0x%04x dev 0x%02x "
    227           1.1  pgoyette 		    "rev 0x%02x at address 0x%02x\n", mfgid, devid >> 8,
    228           1.1  pgoyette 		    devid & 0xff, sc.sc_address);
    229           1.1  pgoyette 		return 0;
    230           1.1  pgoyette 	}
    231           1.1  pgoyette 
    232  1.23.4.1.4.1     skrll 	/*
    233  1.23.4.1.4.1     skrll 	 * Check by SDTEMP_IS_TSE2004AV() might not be enough, so check the alarm
    234  1.23.4.1.4.1     skrll 	 * capability, too.
    235  1.23.4.1.4.1     skrll 	 */
    236  1.23.4.1.4.1     skrll 	if ((cap & SDTEMP_CAP_HAS_ALARM) == 0)
    237  1.23.4.1.4.1     skrll 		return 0;
    238  1.23.4.1.4.1     skrll 
    239           1.1  pgoyette 	return 1;
    240           1.1  pgoyette }
    241           1.1  pgoyette 
    242           1.1  pgoyette static void
    243           1.1  pgoyette sdtemp_attach(device_t parent, device_t self, void *aux)
    244           1.1  pgoyette {
    245           1.1  pgoyette 	struct sdtemp_softc *sc = device_private(self);
    246           1.1  pgoyette 	struct i2c_attach_args *ia = aux;
    247           1.1  pgoyette 	uint16_t mfgid, devid;
    248           1.1  pgoyette 	int i, error;
    249           1.1  pgoyette 
    250           1.1  pgoyette 	sc->sc_tag = ia->ia_tag;
    251           1.1  pgoyette 	sc->sc_address = ia->ia_addr;
    252           1.1  pgoyette 	sc->sc_dev = self;
    253           1.1  pgoyette 
    254           1.1  pgoyette 	iic_acquire_bus(sc->sc_tag, 0);
    255           1.1  pgoyette 	if ((error = sdtemp_read_16(sc, SDTEMP_REG_MFG_ID,  &mfgid)) != 0 ||
    256           1.1  pgoyette 	    (error = sdtemp_read_16(sc, SDTEMP_REG_DEV_REV, &devid)) != 0) {
    257           1.5  pgoyette 		iic_release_bus(sc->sc_tag, 0);
    258           1.1  pgoyette 		aprint_error(": attach error %d\n", error);
    259           1.1  pgoyette 		return;
    260           1.1  pgoyette 	}
    261  1.23.4.1.4.1     skrll 	sc->sc_mfgid = mfgid;
    262  1.23.4.1.4.1     skrll 	sc->sc_devid = devid;
    263          1.14  pgoyette 	i = sdtemp_lookup(mfgid, devid);
    264  1.23.4.1.4.1     skrll 	sc->sc_devid_masked = devid & sdtemp_dev_table[i].sdtemp_mask;
    265           1.1  pgoyette 
    266           1.1  pgoyette 	aprint_naive(": Temp Sensor\n");
    267           1.1  pgoyette 	aprint_normal(": %s Temp Sensor\n", sdtemp_dev_table[i].sdtemp_desc);
    268           1.1  pgoyette 
    269  1.23.4.1.4.1     skrll 	if (sdtemp_dev_table[i].sdtemp_mfg_id == 0) {
    270  1.23.4.1.4.1     skrll 		if (SDTEMP_IS_TSE2004AV(devid))
    271  1.23.4.1.4.1     skrll 			aprint_normal_dev(self, "TSE2004av compliant. "
    272  1.23.4.1.4.1     skrll 			    "Manufacturer ID 0x%04hx, Device revision 0x%02x\n",
    273  1.23.4.1.4.1     skrll 			    mfgid, devid & TSE2004AV_REV);
    274  1.23.4.1.4.1     skrll 		else {
    275  1.23.4.1.4.1     skrll 			aprint_error_dev(self,
    276  1.23.4.1.4.1     skrll 			    "mfg 0x%04x dev 0x%02x rev 0x%02x at addr 0x%02x\n",
    277  1.23.4.1.4.1     skrll 			    mfgid, devid >> 8, devid & 0xff, ia->ia_addr);
    278  1.23.4.1.4.1     skrll 			iic_release_bus(sc->sc_tag, 0);
    279  1.23.4.1.4.1     skrll 			aprint_error_dev(self, "It should no happen. "
    280  1.23.4.1.4.1     skrll 			    "Why attach() found me?\n");
    281  1.23.4.1.4.1     skrll 			return;
    282  1.23.4.1.4.1     skrll 		}
    283  1.23.4.1.4.1     skrll 	}
    284  1.23.4.1.4.1     skrll 
    285  1.23.4.1.4.1     skrll 	error = sdtemp_read_16(sc, SDTEMP_REG_CAPABILITY, &sc->sc_capability);
    286  1.23.4.1.4.1     skrll 	aprint_debug_dev(self, "capability reg = %04x\n", sc->sc_capability);
    287  1.23.4.1.4.1     skrll 	sc->sc_resolution
    288  1.23.4.1.4.1     skrll 	    = __SHIFTOUT(sc->sc_capability, SDTEMP_CAP_RESOLUTION);
    289  1.23.4.1.4.1     skrll 	/*
    290  1.23.4.1.4.1     skrll 	 * Call device dependent function here. Currently, it's used for
    291  1.23.4.1.4.1     skrll 	 * the resolution.
    292  1.23.4.1.4.1     skrll 	 *
    293  1.23.4.1.4.1     skrll 	 * IDT's devices and some Microchip's devices have the resolution
    294  1.23.4.1.4.1     skrll 	 * register in the vendor specific registers area. The devices'
    295  1.23.4.1.4.1     skrll 	 * resolution bits in the capability register are not the maximum
    296  1.23.4.1.4.1     skrll 	 * resolution but the current vaule of the setting.
    297  1.23.4.1.4.1     skrll 	 */
    298  1.23.4.1.4.1     skrll 	if (sdtemp_dev_table[i].sdtemp_config != NULL)
    299  1.23.4.1.4.1     skrll 		sdtemp_dev_table[i].sdtemp_config(sc);
    300           1.1  pgoyette 
    301  1.23.4.1.4.1     skrll 	aprint_normal_dev(self, "%s accuracy",
    302  1.23.4.1.4.1     skrll 	    (sc->sc_capability & SDTEMP_CAP_ACCURACY_1C) ? "high" : "default");
    303  1.23.4.1.4.1     skrll 	if ((sc->sc_capability & SDTEMP_CAP_WIDER_RANGE) != 0)
    304  1.23.4.1.4.1     skrll 		aprint_normal(", wider range");
    305  1.23.4.1.4.1     skrll 	aprint_normal(", %s resolution", temp_resl[sc->sc_resolution]);
    306  1.23.4.1.4.1     skrll 	if ((sc->sc_capability & SDTEMP_CAP_VHV) != 0)
    307  1.23.4.1.4.1     skrll 		aprint_debug(", high voltage standoff");
    308  1.23.4.1.4.1     skrll 	aprint_debug(", %s timeout",
    309  1.23.4.1.4.1     skrll 	    (sc->sc_capability & SDTEMP_CAP_TMOUT) ? "25-35ms" : "10-60ms");
    310  1.23.4.1.4.1     skrll 	if ((sc->sc_capability & SDTEMP_CAP_EVSD) != 0)
    311  1.23.4.1.4.1     skrll 		aprint_normal(", event with shutdown");
    312  1.23.4.1.4.1     skrll 	aprint_normal("\n");
    313           1.1  pgoyette 	/*
    314           1.1  pgoyette 	 * Alarm capability is required;  if not present, this is likely
    315           1.1  pgoyette 	 * not a real sdtemp device.
    316           1.1  pgoyette 	 */
    317           1.1  pgoyette 	if (error != 0 || (sc->sc_capability & SDTEMP_CAP_HAS_ALARM) == 0) {
    318           1.1  pgoyette 		iic_release_bus(sc->sc_tag, 0);
    319           1.1  pgoyette 		aprint_error_dev(self,
    320           1.1  pgoyette 		    "required alarm capability not present!\n");
    321           1.1  pgoyette 		return;
    322           1.1  pgoyette 	}
    323           1.1  pgoyette 	/* Set the configuration to defaults. */
    324           1.1  pgoyette 	error = sdtemp_write_16(sc, SDTEMP_REG_CONFIG, 0);
    325           1.1  pgoyette 	if (error != 0) {
    326           1.1  pgoyette 		iic_release_bus(sc->sc_tag, 0);
    327           1.1  pgoyette 		aprint_error_dev(self, "error %d writing config register\n",
    328           1.1  pgoyette 		    error);
    329           1.1  pgoyette 		return;
    330           1.1  pgoyette 	}
    331           1.1  pgoyette 	iic_release_bus(sc->sc_tag, 0);
    332           1.1  pgoyette 
    333           1.1  pgoyette 	/* Hook us into the sysmon_envsys subsystem */
    334           1.1  pgoyette 	sc->sc_sme = sysmon_envsys_create();
    335           1.4  pgoyette 	sc->sc_sme->sme_name = device_xname(self);
    336           1.4  pgoyette 	sc->sc_sme->sme_cookie = sc;
    337           1.4  pgoyette 	sc->sc_sme->sme_refresh = sdtemp_refresh;
    338           1.4  pgoyette 	sc->sc_sme->sme_get_limits = sdtemp_get_limits;
    339           1.4  pgoyette 	sc->sc_sme->sme_set_limits = sdtemp_set_limits;
    340           1.4  pgoyette 
    341           1.1  pgoyette 	sc->sc_sensor = kmem_zalloc(sizeof(envsys_data_t), KM_NOSLEEP);
    342           1.1  pgoyette 	if (!sc->sc_sensor) {
    343           1.1  pgoyette 		aprint_error_dev(self, "unable to allocate sc_sensor\n");
    344           1.1  pgoyette 		goto bad2;
    345           1.1  pgoyette 	}
    346           1.1  pgoyette 
    347           1.1  pgoyette 	/* Initialize sensor data. */
    348           1.1  pgoyette 	sc->sc_sensor->units =  ENVSYS_STEMP;
    349           1.1  pgoyette 	sc->sc_sensor->state = ENVSYS_SINVALID;
    350           1.1  pgoyette 	sc->sc_sensor->flags |= ENVSYS_FMONLIMITS;
    351           1.1  pgoyette 	(void)strlcpy(sc->sc_sensor->desc, device_xname(self),
    352           1.1  pgoyette 	    sizeof(sc->sc_sensor->desc));
    353          1.22     soren 	snprintf(sc->sc_sensor->desc, sizeof(sc->sc_sensor->desc),
    354          1.22     soren 	    "DIMM %d temperature", sc->sc_address - SDTEMP_ADDR);
    355           1.1  pgoyette 
    356           1.1  pgoyette 	/* Now attach the sensor */
    357           1.1  pgoyette 	if (sysmon_envsys_sensor_attach(sc->sc_sme, sc->sc_sensor)) {
    358           1.1  pgoyette 		aprint_error_dev(self, "unable to attach sensor\n");
    359           1.1  pgoyette 		goto bad;
    360           1.1  pgoyette 	}
    361           1.1  pgoyette 
    362           1.1  pgoyette 	/* Register the device */
    363           1.1  pgoyette 	error = sysmon_envsys_register(sc->sc_sme);
    364           1.1  pgoyette 	if (error) {
    365           1.1  pgoyette 		aprint_error_dev(self, "error %d registering with sysmon\n",
    366           1.1  pgoyette 		    error);
    367           1.1  pgoyette 		goto bad;
    368           1.1  pgoyette 	}
    369           1.1  pgoyette 
    370           1.1  pgoyette 	if (!pmf_device_register(self, sdtemp_pmf_suspend, sdtemp_pmf_resume))
    371           1.1  pgoyette 		aprint_error_dev(self, "couldn't establish power handler\n");
    372           1.1  pgoyette 
    373           1.1  pgoyette 	/* Retrieve and display hardware monitor limits */
    374          1.17     njoly 	sdtemp_get_limits(sc->sc_sme, sc->sc_sensor, &sc->sc_deflims,
    375          1.17     njoly 	    &sc->sc_defprops);
    376          1.21  pgoyette 	aprint_normal_dev(self, "Hardware limits: ");
    377           1.1  pgoyette 	i = 0;
    378          1.17     njoly 	if (sc->sc_defprops & PROP_WARNMIN) {
    379          1.21  pgoyette 		aprint_normal("low %dC",
    380          1.17     njoly 		              __UK2C(sc->sc_deflims.sel_warnmin));
    381           1.1  pgoyette 		i++;
    382           1.1  pgoyette 	}
    383          1.17     njoly 	if (sc->sc_defprops & PROP_WARNMAX) {
    384          1.21  pgoyette 		aprint_normal("%shigh %dC ", (i)?", ":"",
    385          1.17     njoly 			      __UK2C(sc->sc_deflims.sel_warnmax));
    386           1.1  pgoyette 		i++;
    387           1.1  pgoyette 	}
    388          1.17     njoly 	if (sc->sc_defprops & PROP_CRITMAX) {
    389          1.21  pgoyette 		aprint_normal("%scritical %dC ", (i)?", ":"",
    390          1.17     njoly 			      __UK2C(sc->sc_deflims.sel_critmax));
    391           1.1  pgoyette 		i++;
    392           1.1  pgoyette 	}
    393          1.21  pgoyette 	aprint_normal("%s\n", (i)?"":"none set");
    394           1.1  pgoyette 
    395           1.1  pgoyette 	return;
    396           1.1  pgoyette 
    397           1.1  pgoyette bad:
    398           1.1  pgoyette 	kmem_free(sc->sc_sensor, sizeof(envsys_data_t));
    399           1.1  pgoyette bad2:
    400           1.1  pgoyette 	sysmon_envsys_destroy(sc->sc_sme);
    401           1.1  pgoyette }
    402           1.1  pgoyette 
    403          1.19  jmcneill static int
    404          1.19  jmcneill sdtemp_detach(device_t self, int flags)
    405          1.19  jmcneill {
    406          1.19  jmcneill 	struct sdtemp_softc *sc = device_private(self);
    407          1.19  jmcneill 
    408          1.19  jmcneill 	pmf_device_deregister(self);
    409          1.19  jmcneill 
    410          1.19  jmcneill 	if (sc->sc_sme)
    411          1.19  jmcneill 		sysmon_envsys_unregister(sc->sc_sme);
    412          1.19  jmcneill 	if (sc->sc_sensor)
    413          1.19  jmcneill 		kmem_free(sc->sc_sensor, sizeof(envsys_data_t));
    414          1.19  jmcneill 
    415          1.19  jmcneill 	return 0;
    416          1.19  jmcneill }
    417          1.19  jmcneill 
    418           1.4  pgoyette /* Retrieve current limits from device, and encode in uKelvins */
    419           1.1  pgoyette static void
    420           1.6  pgoyette sdtemp_get_limits(struct sysmon_envsys *sme, envsys_data_t *edata,
    421          1.10  pgoyette 		  sysmon_envsys_lim_t *limits, uint32_t *props)
    422           1.1  pgoyette {
    423           1.4  pgoyette 	struct sdtemp_softc *sc = sme->sme_cookie;
    424           1.4  pgoyette 	uint16_t lim;
    425           1.1  pgoyette 
    426          1.10  pgoyette 	*props = 0;
    427           1.4  pgoyette 	iic_acquire_bus(sc->sc_tag, 0);
    428           1.4  pgoyette 	if (sdtemp_read_16(sc, SDTEMP_REG_LOWER_LIM, &lim) == 0 && lim != 0) {
    429           1.4  pgoyette 		limits->sel_warnmin = sdtemp_decode_temp(sc, lim);
    430          1.10  pgoyette 		*props |= PROP_WARNMIN;
    431           1.4  pgoyette 	}
    432           1.4  pgoyette 	if (sdtemp_read_16(sc, SDTEMP_REG_UPPER_LIM, &lim) == 0 && lim != 0) {
    433           1.4  pgoyette 		limits->sel_warnmax = sdtemp_decode_temp(sc, lim);
    434          1.10  pgoyette 		*props |= PROP_WARNMAX;
    435           1.4  pgoyette 	}
    436           1.4  pgoyette 	if (sdtemp_read_16(sc, SDTEMP_REG_CRIT_LIM, &lim) == 0 && lim != 0) {
    437           1.4  pgoyette 		limits->sel_critmax = sdtemp_decode_temp(sc, lim);
    438          1.10  pgoyette 		*props |= PROP_CRITMAX;
    439           1.1  pgoyette 	}
    440           1.4  pgoyette 	iic_release_bus(sc->sc_tag, 0);
    441          1.10  pgoyette 	if (*props != 0)
    442          1.10  pgoyette 		*props |= PROP_DRIVER_LIMITS;
    443           1.4  pgoyette }
    444           1.4  pgoyette 
    445           1.4  pgoyette /* Send current limit values to the device */
    446           1.4  pgoyette static void
    447           1.6  pgoyette sdtemp_set_limits(struct sysmon_envsys *sme, envsys_data_t *edata,
    448          1.10  pgoyette 		  sysmon_envsys_lim_t *limits, uint32_t *props)
    449           1.4  pgoyette {
    450           1.4  pgoyette 	uint16_t val;
    451           1.4  pgoyette 	struct sdtemp_softc *sc = sme->sme_cookie;
    452           1.1  pgoyette 
    453          1.13  pgoyette 	if (limits == NULL) {
    454          1.13  pgoyette 		limits = &sc->sc_deflims;
    455          1.13  pgoyette 		props  = &sc->sc_defprops;
    456          1.13  pgoyette 	}
    457           1.1  pgoyette 	iic_acquire_bus(sc->sc_tag, 0);
    458          1.10  pgoyette 	if (*props & PROP_WARNMIN) {
    459           1.4  pgoyette 		val = __UK2C(limits->sel_warnmin);
    460           1.4  pgoyette 		(void)sdtemp_write_16(sc, SDTEMP_REG_LOWER_LIM,
    461           1.4  pgoyette 					(val << 4) & SDTEMP_TEMP_MASK);
    462           1.4  pgoyette 	}
    463          1.10  pgoyette 	if (*props & PROP_WARNMAX) {
    464           1.4  pgoyette 		val = __UK2C(limits->sel_warnmax);
    465           1.4  pgoyette 		(void)sdtemp_write_16(sc, SDTEMP_REG_UPPER_LIM,
    466           1.4  pgoyette 					(val << 4) & SDTEMP_TEMP_MASK);
    467           1.4  pgoyette 	}
    468          1.10  pgoyette 	if (*props & PROP_CRITMAX) {
    469           1.4  pgoyette 		val = __UK2C(limits->sel_critmax);
    470           1.4  pgoyette 		(void)sdtemp_write_16(sc, SDTEMP_REG_CRIT_LIM,
    471           1.4  pgoyette 					(val << 4) & SDTEMP_TEMP_MASK);
    472           1.4  pgoyette 	}
    473           1.1  pgoyette 	iic_release_bus(sc->sc_tag, 0);
    474           1.1  pgoyette 
    475           1.4  pgoyette 	/*
    476           1.4  pgoyette 	 * If at least one limit is set that we can handle, and no
    477           1.4  pgoyette 	 * limits are set that we cannot handle, tell sysmon that
    478           1.4  pgoyette 	 * the driver will take care of monitoring the limits!
    479           1.4  pgoyette 	 */
    480          1.10  pgoyette 	if (*props & (PROP_CRITMIN | PROP_BATTCAP | PROP_BATTWARN))
    481          1.10  pgoyette 		*props &= ~PROP_DRIVER_LIMITS;
    482          1.10  pgoyette 	else if (*props & PROP_LIMITS)
    483          1.10  pgoyette 		*props |= PROP_DRIVER_LIMITS;
    484           1.4  pgoyette 	else
    485          1.10  pgoyette 		*props &= ~PROP_DRIVER_LIMITS;
    486           1.1  pgoyette }
    487           1.1  pgoyette 
    488           1.1  pgoyette #ifdef NOT_YET	/* All registers on these sensors are 16-bits */
    489           1.1  pgoyette 
    490           1.1  pgoyette /* Read a 8-bit value from a register */
    491           1.1  pgoyette static int
    492           1.1  pgoyette sdtemp_read_8(struct sdtemp_softc *sc, uint8_t reg, uint8_t *valp)
    493           1.1  pgoyette {
    494           1.1  pgoyette 	int error;
    495           1.1  pgoyette 
    496           1.1  pgoyette 	error = iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP,
    497           1.1  pgoyette 	    sc->sc_address, &reg, 1, valp, sizeof(*valp), 0);
    498           1.1  pgoyette 
    499           1.1  pgoyette 	return error;
    500           1.1  pgoyette }
    501           1.1  pgoyette 
    502           1.1  pgoyette static int
    503           1.1  pgoyette sdtemp_write_8(struct sdtemp_softc *sc, uint8_t reg, uint8_t val)
    504           1.1  pgoyette {
    505           1.1  pgoyette 	return iic_exec(sc->sc_tag, I2C_OP_WRITE_WITH_STOP,
    506           1.1  pgoyette 	    sc->sc_address, &reg, 1, &val, sizeof(val), 0);
    507           1.1  pgoyette }
    508           1.1  pgoyette #endif /* NOT_YET */
    509           1.1  pgoyette 
    510           1.1  pgoyette /* Read a 16-bit value from a register */
    511           1.1  pgoyette static int
    512           1.1  pgoyette sdtemp_read_16(struct sdtemp_softc *sc, uint8_t reg, uint16_t *valp)
    513           1.1  pgoyette {
    514           1.1  pgoyette 	int error;
    515           1.1  pgoyette 
    516           1.1  pgoyette 	error = iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP,
    517           1.1  pgoyette 	    sc->sc_address, &reg, 1, valp, sizeof(*valp), 0);
    518           1.1  pgoyette 	if (error)
    519           1.1  pgoyette 		return error;
    520           1.1  pgoyette 
    521           1.1  pgoyette 	*valp = be16toh(*valp);
    522           1.1  pgoyette 
    523           1.1  pgoyette 	return 0;
    524           1.1  pgoyette }
    525           1.1  pgoyette 
    526           1.1  pgoyette static int
    527           1.1  pgoyette sdtemp_write_16(struct sdtemp_softc *sc, uint8_t reg, uint16_t val)
    528           1.1  pgoyette {
    529           1.1  pgoyette 	uint16_t temp;
    530           1.1  pgoyette 
    531           1.1  pgoyette 	temp = htobe16(val);
    532           1.1  pgoyette 	return iic_exec(sc->sc_tag, I2C_OP_WRITE_WITH_STOP,
    533           1.1  pgoyette 	    sc->sc_address, &reg, 1, &temp, sizeof(temp), 0);
    534           1.1  pgoyette }
    535           1.1  pgoyette 
    536           1.1  pgoyette static uint32_t
    537           1.1  pgoyette sdtemp_decode_temp(struct sdtemp_softc *sc, uint16_t temp)
    538           1.1  pgoyette {
    539           1.1  pgoyette 	uint32_t val;
    540           1.1  pgoyette 	int32_t stemp;
    541           1.1  pgoyette 
    542           1.1  pgoyette 	/* Get only the temperature bits */
    543           1.1  pgoyette 	temp &= SDTEMP_TEMP_MASK;
    544           1.1  pgoyette 
    545           1.1  pgoyette 	/* If necessary, extend the sign bit */
    546           1.1  pgoyette 	if ((sc->sc_capability & SDTEMP_CAP_WIDER_RANGE) &&
    547           1.1  pgoyette 	    (temp & SDTEMP_TEMP_NEGATIVE))
    548           1.1  pgoyette 		temp |= SDTEMP_TEMP_SIGN_EXT;
    549           1.1  pgoyette 
    550           1.1  pgoyette 	/* Mask off only bits valid within current resolution */
    551  1.23.4.1.4.1     skrll 	temp &= ~(0x7 >> sc->sc_resolution);
    552           1.1  pgoyette 
    553           1.1  pgoyette 	/* Treat as signed and extend to 32-bits */
    554           1.1  pgoyette 	stemp = (int16_t)temp;
    555           1.1  pgoyette 
    556           1.1  pgoyette 	/* Now convert from 0.0625 (1/16) deg C increments to microKelvins */
    557           1.1  pgoyette 	val = (stemp * 62500) + 273150000;
    558           1.1  pgoyette 
    559           1.1  pgoyette 	return val;
    560           1.1  pgoyette }
    561           1.1  pgoyette 
    562           1.1  pgoyette static void
    563           1.1  pgoyette sdtemp_refresh(struct sysmon_envsys *sme, envsys_data_t *edata)
    564           1.1  pgoyette {
    565           1.1  pgoyette 	struct sdtemp_softc *sc = sme->sme_cookie;
    566           1.1  pgoyette 	uint16_t val;
    567           1.1  pgoyette 	int error;
    568           1.1  pgoyette 
    569           1.1  pgoyette 	iic_acquire_bus(sc->sc_tag, 0);
    570           1.1  pgoyette 	error = sdtemp_read_16(sc, SDTEMP_REG_AMBIENT_TEMP, &val);
    571           1.1  pgoyette 	iic_release_bus(sc->sc_tag, 0);
    572           1.1  pgoyette 
    573           1.1  pgoyette 	if (error) {
    574           1.1  pgoyette 		edata->state = ENVSYS_SINVALID;
    575           1.1  pgoyette 		return;
    576           1.1  pgoyette 	}
    577           1.1  pgoyette 
    578           1.1  pgoyette 	edata->value_cur = sdtemp_decode_temp(sc, val);
    579           1.1  pgoyette 
    580           1.1  pgoyette 	/* Now check for limits */
    581           1.4  pgoyette 	if ((edata->upropset & PROP_DRIVER_LIMITS) == 0)
    582           1.4  pgoyette 		edata->state = ENVSYS_SVALID;
    583          1.18  pgoyette 	else if ((val & SDTEMP_ABOVE_CRIT) &&
    584          1.18  pgoyette 		    (edata->upropset & PROP_CRITMAX))
    585           1.1  pgoyette 		edata->state = ENVSYS_SCRITOVER;
    586          1.18  pgoyette 	else if ((val & SDTEMP_ABOVE_UPPER) &&
    587          1.18  pgoyette 		    (edata->upropset & PROP_WARNMAX))
    588           1.1  pgoyette 		edata->state = ENVSYS_SWARNOVER;
    589          1.18  pgoyette 	else if ((val & SDTEMP_BELOW_LOWER) &&
    590          1.18  pgoyette 		    (edata->upropset & PROP_WARNMIN))
    591           1.1  pgoyette 		edata->state = ENVSYS_SWARNUNDER;
    592           1.1  pgoyette 	else
    593           1.1  pgoyette 		edata->state = ENVSYS_SVALID;
    594           1.1  pgoyette }
    595           1.1  pgoyette 
    596           1.1  pgoyette /*
    597           1.1  pgoyette  * power management functions
    598           1.1  pgoyette  *
    599           1.1  pgoyette  * We go into "shutdown" mode at suspend time, and return to normal
    600           1.1  pgoyette  * mode upon resume.  This reduces power consumption by disabling
    601           1.1  pgoyette  * the A/D converter.
    602           1.1  pgoyette  */
    603           1.1  pgoyette 
    604           1.1  pgoyette static bool
    605          1.11    dyoung sdtemp_pmf_suspend(device_t dev, const pmf_qual_t *qual)
    606           1.1  pgoyette {
    607           1.1  pgoyette 	struct sdtemp_softc *sc = device_private(dev);
    608           1.1  pgoyette 	int error;
    609           1.1  pgoyette 	uint16_t config;
    610           1.1  pgoyette 
    611           1.1  pgoyette 	iic_acquire_bus(sc->sc_tag, 0);
    612           1.1  pgoyette 	error = sdtemp_read_16(sc, SDTEMP_REG_CONFIG, &config);
    613           1.1  pgoyette 	if (error == 0) {
    614           1.1  pgoyette 		config |= SDTEMP_CONFIG_SHUTDOWN_MODE;
    615           1.1  pgoyette 		error = sdtemp_write_16(sc, SDTEMP_REG_CONFIG, config);
    616           1.1  pgoyette 	}
    617           1.1  pgoyette 	iic_release_bus(sc->sc_tag, 0);
    618           1.1  pgoyette 	return (error == 0);
    619           1.1  pgoyette }
    620           1.1  pgoyette 
    621           1.1  pgoyette static bool
    622          1.11    dyoung sdtemp_pmf_resume(device_t dev, const pmf_qual_t *qual)
    623           1.1  pgoyette {
    624           1.1  pgoyette 	struct sdtemp_softc *sc = device_private(dev);
    625           1.1  pgoyette 	int error;
    626           1.1  pgoyette 	uint16_t config;
    627           1.1  pgoyette 
    628           1.1  pgoyette 	iic_acquire_bus(sc->sc_tag, 0);
    629           1.1  pgoyette 	error = sdtemp_read_16(sc, SDTEMP_REG_CONFIG, &config);
    630           1.1  pgoyette 	if (error == 0) {
    631           1.1  pgoyette 		config &= ~SDTEMP_CONFIG_SHUTDOWN_MODE;
    632           1.1  pgoyette 		error = sdtemp_write_16(sc, SDTEMP_REG_CONFIG, config);
    633           1.1  pgoyette 	}
    634           1.1  pgoyette 	iic_release_bus(sc->sc_tag, 0);
    635           1.1  pgoyette 	return (error == 0);
    636           1.1  pgoyette }
    637          1.19  jmcneill 
    638  1.23.4.1.4.1     skrll /* Device dependent config functions */
    639  1.23.4.1.4.1     skrll 
    640  1.23.4.1.4.1     skrll static void
    641  1.23.4.1.4.1     skrll sdtemp_config_mcp(struct sdtemp_softc *sc)
    642  1.23.4.1.4.1     skrll {
    643  1.23.4.1.4.1     skrll 	int rv;
    644  1.23.4.1.4.1     skrll 	uint8_t resolreg;
    645  1.23.4.1.4.1     skrll 
    646  1.23.4.1.4.1     skrll 	/* Note that MCP9805 has no resolution register */
    647  1.23.4.1.4.1     skrll 	switch (sc->sc_devid_masked) {
    648  1.23.4.1.4.1     skrll 	case MCP_9804_DEVICE_ID:
    649  1.23.4.1.4.1     skrll 	case MCP_98242_DEVICE_ID:
    650  1.23.4.1.4.1     skrll 	case MCP_98243_DEVICE_ID:
    651  1.23.4.1.4.1     skrll 		resolreg = SDTEMP_REG_MCP_RESOLUTION_9804;
    652  1.23.4.1.4.1     skrll 		break;
    653  1.23.4.1.4.1     skrll 	case MCP_98244_DEVICE_ID:
    654  1.23.4.1.4.1     skrll 		resolreg = SDTEMP_REG_MCP_RESOLUTION_98244;
    655  1.23.4.1.4.1     skrll 		break;
    656  1.23.4.1.4.1     skrll 	default:
    657  1.23.4.1.4.1     skrll 		aprint_error("%s: %s: unknown device ID (%04hx)\n",
    658  1.23.4.1.4.1     skrll 		    device_xname(sc->sc_dev), __func__, sc->sc_devid_masked);
    659  1.23.4.1.4.1     skrll 		return;
    660  1.23.4.1.4.1     skrll 	}
    661  1.23.4.1.4.1     skrll 
    662  1.23.4.1.4.1     skrll 	/*
    663  1.23.4.1.4.1     skrll 	 * Set resolution to the max.
    664  1.23.4.1.4.1     skrll 	 *
    665  1.23.4.1.4.1     skrll 	 * Even if it fails, the resolution will be the default. It's not a
    666  1.23.4.1.4.1     skrll 	 * fatal error.
    667  1.23.4.1.4.1     skrll 	 */
    668  1.23.4.1.4.1     skrll 	rv = sdtemp_write_16(sc, resolreg, SDTEMP_CAP_RESOLUTION_MAX);
    669  1.23.4.1.4.1     skrll 	if (rv == 0)
    670  1.23.4.1.4.1     skrll 		sc->sc_resolution = SDTEMP_CAP_RESOLUTION_MAX;
    671  1.23.4.1.4.1     skrll 	else
    672  1.23.4.1.4.1     skrll 		aprint_error("%s: error %d writing resolution register\n",
    673  1.23.4.1.4.1     skrll 		    device_xname(sc->sc_dev), rv);
    674  1.23.4.1.4.1     skrll }
    675  1.23.4.1.4.1     skrll 
    676  1.23.4.1.4.1     skrll static void
    677  1.23.4.1.4.1     skrll sdtemp_config_idt(struct sdtemp_softc *sc)
    678  1.23.4.1.4.1     skrll {
    679  1.23.4.1.4.1     skrll 	int rv;
    680  1.23.4.1.4.1     skrll 
    681  1.23.4.1.4.1     skrll 	/*
    682  1.23.4.1.4.1     skrll 	 * Set resolution to the max.
    683  1.23.4.1.4.1     skrll 	 *
    684  1.23.4.1.4.1     skrll 	 * Even if it fails, the resolution will be the default. It's not a
    685  1.23.4.1.4.1     skrll 	 * fatal error.
    686  1.23.4.1.4.1     skrll 	 */
    687  1.23.4.1.4.1     skrll 	rv = sdtemp_write_16(sc, SDTEMP_REG_IDT_RESOLUTION,
    688  1.23.4.1.4.1     skrll 	    __SHIFTIN(SDTEMP_CAP_RESOLUTION_MAX, SDTEMP_CAP_RESOLUTION));
    689  1.23.4.1.4.1     skrll 	if (rv == 0)
    690  1.23.4.1.4.1     skrll 		sc->sc_resolution = SDTEMP_CAP_RESOLUTION_MAX;
    691  1.23.4.1.4.1     skrll 	else
    692  1.23.4.1.4.1     skrll 		aprint_error("%s: error %d writing resolution register\n",
    693  1.23.4.1.4.1     skrll 		    device_xname(sc->sc_dev), rv);
    694  1.23.4.1.4.1     skrll }
    695  1.23.4.1.4.1     skrll 
    696      1.23.4.1       snj MODULE(MODULE_CLASS_DRIVER, sdtemp, "i2cexec");
    697          1.19  jmcneill 
    698          1.19  jmcneill #ifdef _MODULE
    699          1.19  jmcneill #include "ioconf.c"
    700          1.19  jmcneill #endif
    701          1.19  jmcneill 
    702          1.19  jmcneill static int
    703          1.19  jmcneill sdtemp_modcmd(modcmd_t cmd, void *opaque)
    704          1.19  jmcneill {
    705          1.19  jmcneill 	int error = 0;
    706          1.19  jmcneill 
    707          1.19  jmcneill 	switch (cmd) {
    708          1.19  jmcneill 	case MODULE_CMD_INIT:
    709          1.19  jmcneill #ifdef _MODULE
    710          1.19  jmcneill 		error = config_init_component(cfdriver_ioconf_sdtemp,
    711          1.19  jmcneill 		    cfattach_ioconf_sdtemp, cfdata_ioconf_sdtemp);
    712          1.19  jmcneill #endif
    713          1.19  jmcneill 		return error;
    714          1.19  jmcneill 	case MODULE_CMD_FINI:
    715          1.19  jmcneill #ifdef _MODULE
    716          1.19  jmcneill 		error = config_fini_component(cfdriver_ioconf_sdtemp,
    717          1.19  jmcneill 		    cfattach_ioconf_sdtemp, cfdata_ioconf_sdtemp);
    718          1.19  jmcneill #endif
    719          1.19  jmcneill 		return error;
    720          1.19  jmcneill 	default:
    721          1.19  jmcneill 		return ENOTTY;
    722          1.19  jmcneill 	}
    723          1.19  jmcneill }
    724