Home | History | Annotate | Line # | Download | only in pci
viapcib.c revision 1.8
      1  1.8     joerg /* $NetBSD: viapcib.c,v 1.8 2008/03/09 17:14:51 joerg Exp $ */
      2  1.1  jmcneill /* $FreeBSD: src/sys/pci/viapm.c,v 1.10 2005/05/29 04:42:29 nyan Exp $ */
      3  1.1  jmcneill 
      4  1.1  jmcneill /*-
      5  1.1  jmcneill  * Copyright (c) 2005, 2006 Jared D. McNeill <jmcneill (at) invisible.ca>
      6  1.1  jmcneill  * All rights reserved.
      7  1.1  jmcneill  *
      8  1.1  jmcneill  * Redistribution and use in source and binary forms, with or without
      9  1.1  jmcneill  * modification, are permitted provided that the following conditions
     10  1.1  jmcneill  * are met:
     11  1.1  jmcneill  * 1. Redistributions of source code must retain the above copyright
     12  1.1  jmcneill  *    notice, this list of conditions and the following disclaimer.
     13  1.1  jmcneill  * 2. Redistributions in binary form must reproduce the above copyright
     14  1.1  jmcneill  *    notice, this list of conditions, and the following disclaimer in the
     15  1.1  jmcneill  *    documentation and/or other materials provided with the distribution.
     16  1.1  jmcneill  * 3. The name of the author may not be used to endorse or promote products
     17  1.1  jmcneill  *    derived from this software without specific prior written permission.
     18  1.1  jmcneill  *
     19  1.1  jmcneill  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     20  1.1  jmcneill  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     21  1.1  jmcneill  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     22  1.1  jmcneill  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     23  1.1  jmcneill  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
     24  1.1  jmcneill  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     25  1.1  jmcneill  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
     26  1.1  jmcneill  * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
     27  1.1  jmcneill  * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     28  1.1  jmcneill  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     29  1.1  jmcneill  * SUCH DAMAGE.
     30  1.1  jmcneill  */
     31  1.1  jmcneill /*-
     32  1.1  jmcneill  * Copyright (c) 2001 Alcove - Nicolas Souchu
     33  1.1  jmcneill  * All rights reserved.
     34  1.1  jmcneill  *
     35  1.1  jmcneill  * Redistribution and use in source and binary forms, with or without
     36  1.1  jmcneill  * modification, are permitted provided that the following conditions
     37  1.1  jmcneill  * are met:
     38  1.1  jmcneill  * 1. Redistributions of source code must retain the above copyright
     39  1.1  jmcneill  *    notice, this list of conditions and the following disclaimer.
     40  1.1  jmcneill  * 2. Redistributions in binary form must reproduce the above copyright
     41  1.1  jmcneill  *    notice, this list of conditions and the following disclaimer in the
     42  1.1  jmcneill  *    documentation and/or other materials provided with the distribution.
     43  1.1  jmcneill  *
     44  1.1  jmcneill  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
     45  1.1  jmcneill  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     46  1.1  jmcneill  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     47  1.1  jmcneill  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
     48  1.1  jmcneill  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     49  1.1  jmcneill  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     50  1.1  jmcneill  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     51  1.1  jmcneill  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     52  1.1  jmcneill  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     53  1.1  jmcneill  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     54  1.1  jmcneill  * SUCH DAMAGE.
     55  1.1  jmcneill  */
     56  1.1  jmcneill 
     57  1.1  jmcneill #include <sys/cdefs.h>
     58  1.8     joerg __KERNEL_RCSID(0, "$NetBSD: viapcib.c,v 1.8 2008/03/09 17:14:51 joerg Exp $");
     59  1.1  jmcneill 
     60  1.1  jmcneill #include <sys/types.h>
     61  1.1  jmcneill #include <sys/param.h>
     62  1.1  jmcneill #include <sys/systm.h>
     63  1.1  jmcneill #include <sys/device.h>
     64  1.1  jmcneill #include <sys/proc.h>
     65  1.7        ad #include <sys/simplelock.h>
     66  1.7        ad #include <sys/bus.h>
     67  1.1  jmcneill 
     68  1.1  jmcneill #include <dev/pci/pcireg.h>
     69  1.1  jmcneill #include <dev/pci/pcivar.h>
     70  1.1  jmcneill #include <dev/pci/pcidevs.h>
     71  1.1  jmcneill 
     72  1.1  jmcneill #include <dev/i2c/i2cvar.h>
     73  1.1  jmcneill 
     74  1.1  jmcneill #include <i386/pci/viapcibreg.h>
     75  1.1  jmcneill 
     76  1.1  jmcneill /*#define VIAPCIB_DEBUG*/
     77  1.1  jmcneill 
     78  1.1  jmcneill #ifdef	VIAPCIB_DEBUG
     79  1.1  jmcneill #define	DPRINTF(x)	printf x
     80  1.1  jmcneill #else
     81  1.1  jmcneill #define	DPRINTF(x)
     82  1.1  jmcneill #endif
     83  1.1  jmcneill 
     84  1.1  jmcneill struct viapcib_softc {
     85  1.1  jmcneill 	struct device	sc_dev;
     86  1.1  jmcneill 	bus_space_tag_t	sc_iot;
     87  1.1  jmcneill 	bus_space_handle_t sc_ioh;
     88  1.1  jmcneill 	struct i2c_controller sc_i2c;
     89  1.1  jmcneill 
     90  1.1  jmcneill 	int sc_revision;
     91  1.1  jmcneill 
     92  1.1  jmcneill 	struct simplelock sc_lock;
     93  1.1  jmcneill };
     94  1.1  jmcneill 
     95  1.1  jmcneill static int	viapcib_match(struct device *, struct cfdata *, void *);
     96  1.1  jmcneill static void	viapcib_attach(struct device *, struct device *, void *);
     97  1.1  jmcneill 
     98  1.1  jmcneill static int	viapcib_clear(struct viapcib_softc *);
     99  1.1  jmcneill static int	viapcib_busy(struct viapcib_softc *);
    100  1.1  jmcneill 
    101  1.1  jmcneill #define		viapcib_smbus_read(sc, o) \
    102  1.1  jmcneill 	bus_space_read_1((sc)->sc_iot, (sc)->sc_ioh, (o))
    103  1.1  jmcneill #define		viapcib_smbus_write(sc, o, v) \
    104  1.1  jmcneill 	bus_space_write_1((sc)->sc_iot, (sc)->sc_ioh, (o), (v))
    105  1.1  jmcneill 
    106  1.1  jmcneill #define	VIAPCIB_SMBUS_TIMEOUT	10000
    107  1.1  jmcneill 
    108  1.1  jmcneill static int	viapcib_acquire_bus(void *, int);
    109  1.1  jmcneill static void	viapcib_release_bus(void *, int);
    110  1.1  jmcneill static int	viapcib_exec(void *, i2c_op_t, i2c_addr_t, const void *,
    111  1.1  jmcneill 			     size_t, void *, size_t, int);
    112  1.1  jmcneill 
    113  1.1  jmcneill /* SMBus operations */
    114  1.1  jmcneill static int      viapcib_smbus_quick_write(void *, i2c_addr_t);
    115  1.1  jmcneill static int      viapcib_smbus_quick_read(void *, i2c_addr_t);
    116  1.1  jmcneill static int      viapcib_smbus_send_byte(void *, i2c_addr_t, uint8_t);
    117  1.1  jmcneill static int      viapcib_smbus_receive_byte(void *, i2c_addr_t,
    118  1.1  jmcneill                                            uint8_t *);
    119  1.1  jmcneill static int      viapcib_smbus_read_byte(void *, i2c_addr_t, uint8_t,
    120  1.1  jmcneill 					int8_t *);
    121  1.1  jmcneill static int      viapcib_smbus_write_byte(void *, i2c_addr_t, uint8_t,
    122  1.1  jmcneill 					 int8_t);
    123  1.1  jmcneill static int      viapcib_smbus_read_word(void *, i2c_addr_t, uint8_t,
    124  1.1  jmcneill 					int16_t *);
    125  1.1  jmcneill static int      viapcib_smbus_write_word(void *, i2c_addr_t, uint8_t,
    126  1.1  jmcneill 					 int16_t);
    127  1.1  jmcneill static int      viapcib_smbus_block_write(void *, i2c_addr_t, uint8_t,
    128  1.1  jmcneill 					  int, void *);
    129  1.1  jmcneill static int      viapcib_smbus_block_read(void *, i2c_addr_t, uint8_t,
    130  1.1  jmcneill 					 int, void *);
    131  1.1  jmcneill /* XXX Should be moved to smbus layer */
    132  1.1  jmcneill #define	SMB_MAXBLOCKSIZE	32
    133  1.1  jmcneill 
    134  1.1  jmcneill /* from arch/i386/pci/pcib.c */
    135  1.1  jmcneill extern void	pcibattach(struct device *, struct device *, void *);
    136  1.1  jmcneill 
    137  1.1  jmcneill CFATTACH_DECL(viapcib, sizeof(struct viapcib_softc), viapcib_match,
    138  1.1  jmcneill     viapcib_attach, NULL, NULL);
    139  1.1  jmcneill 
    140  1.1  jmcneill static int
    141  1.6  christos viapcib_match(struct device *parent, struct cfdata *match,
    142  1.4  christos     void *opaque)
    143  1.1  jmcneill {
    144  1.1  jmcneill 	struct pci_attach_args *pa;
    145  1.1  jmcneill 
    146  1.1  jmcneill 	pa = (struct pci_attach_args *)opaque;
    147  1.1  jmcneill 
    148  1.1  jmcneill 	if (PCI_VENDOR(pa->pa_id) != PCI_VENDOR_VIATECH)
    149  1.1  jmcneill 		return 0;
    150  1.1  jmcneill 
    151  1.1  jmcneill 	switch (PCI_PRODUCT(pa->pa_id)) {
    152  1.1  jmcneill 	case PCI_PRODUCT_VIATECH_VT8235:
    153  1.2   xtraeme 	case PCI_PRODUCT_VIATECH_VT8237:
    154  1.1  jmcneill 		return 2; /* match above generic pcib(4) */
    155  1.1  jmcneill 	}
    156  1.1  jmcneill 
    157  1.1  jmcneill 	return 0;
    158  1.1  jmcneill }
    159  1.1  jmcneill 
    160  1.1  jmcneill static void
    161  1.1  jmcneill viapcib_attach(struct device *parent, struct device *self, void *opaque)
    162  1.1  jmcneill {
    163  1.1  jmcneill 	struct viapcib_softc *sc;
    164  1.1  jmcneill 	struct pci_attach_args *pa;
    165  1.1  jmcneill 	pcireg_t addr, val;
    166  1.1  jmcneill 
    167  1.1  jmcneill 	sc = (struct viapcib_softc *)self;
    168  1.1  jmcneill 	pa = (struct pci_attach_args *)opaque;
    169  1.1  jmcneill 
    170  1.1  jmcneill 	/* XXX Only the 8235 is supported for now */
    171  1.1  jmcneill 	sc->sc_iot = pa->pa_iot;
    172  1.1  jmcneill 	addr = pci_conf_read(pa->pa_pc, pa->pa_tag, SMB_BASE3);
    173  1.1  jmcneill 	addr &= 0xfff0;
    174  1.1  jmcneill 	if (bus_space_map(sc->sc_iot, addr, 8, 0, &sc->sc_ioh)) {
    175  1.1  jmcneill 		printf(": failed to map SMBus I/O space\n");
    176  1.1  jmcneill 		addr = 0;
    177  1.1  jmcneill 		goto core_pcib;
    178  1.1  jmcneill 	}
    179  1.1  jmcneill 
    180  1.1  jmcneill 	simple_lock_init(&sc->sc_lock);
    181  1.1  jmcneill 
    182  1.1  jmcneill 	val = pci_conf_read(pa->pa_pc, pa->pa_tag, SMB_HOST_CONFIG);
    183  1.8     joerg 	if ((val & 0x10000) == 0) {
    184  1.1  jmcneill 		printf(": SMBus is disabled\n");
    185  1.1  jmcneill 		addr = 0;
    186  1.1  jmcneill 		/* XXX We can enable the SMBus here by writing 1 to
    187  1.1  jmcneill 		 * SMB_HOST_CONFIG, but do we want to?
    188  1.1  jmcneill 		 */
    189  1.1  jmcneill 		goto core_pcib;
    190  1.1  jmcneill 	}
    191  1.1  jmcneill 
    192  1.1  jmcneill #ifdef VIAPCIB_DEBUG
    193  1.1  jmcneill 	switch (val & 0x0e) {
    194  1.1  jmcneill 	case 8:
    195  1.1  jmcneill 		printf(": interrupting at irq 9\n");
    196  1.1  jmcneill 		break;
    197  1.1  jmcneill 	case 0:
    198  1.1  jmcneill 		printf(": interrupting at SMI#\n");
    199  1.1  jmcneill 		break;
    200  1.1  jmcneill 	default:
    201  1.1  jmcneill 		printf(": interrupt misconfigured\n");
    202  1.1  jmcneill 		break;
    203  1.1  jmcneill 	}
    204  1.1  jmcneill #endif /* !VIAPCIB_DEBUG */
    205  1.1  jmcneill 
    206  1.1  jmcneill 	val = pci_conf_read(pa->pa_pc, pa->pa_tag, SMB_REVISION);
    207  1.8     joerg 	sc->sc_revision = val >> 16;
    208  1.1  jmcneill 
    209  1.1  jmcneill core_pcib:
    210  1.1  jmcneill 	pcibattach(parent, self, opaque);
    211  1.1  jmcneill 
    212  1.1  jmcneill 	if (addr != 0) {
    213  1.1  jmcneill 		struct i2cbus_attach_args iba;
    214  1.1  jmcneill 		uint8_t b;
    215  1.1  jmcneill 
    216  1.1  jmcneill 		printf("%s: SMBus found at 0x%x (revision 0x%x)\n",
    217  1.1  jmcneill 		    sc->sc_dev.dv_xname, addr, sc->sc_revision);
    218  1.1  jmcneill 
    219  1.1  jmcneill 		/* Disable slave function */
    220  1.1  jmcneill 		b = viapcib_smbus_read(sc, SMBSLVCNT);
    221  1.1  jmcneill 		viapcib_smbus_write(sc, SMBSLVCNT, b & ~1);
    222  1.1  jmcneill 
    223  1.1  jmcneill 		memset(&sc->sc_i2c, 0, sizeof(sc->sc_i2c));
    224  1.1  jmcneill #ifdef I2C_TYPE_SMBUS
    225  1.1  jmcneill 		iba.iba_type = I2C_TYPE_SMBUS;
    226  1.1  jmcneill #endif
    227  1.1  jmcneill 		iba.iba_tag = &sc->sc_i2c;
    228  1.1  jmcneill 		iba.iba_tag->ic_cookie = (void *)sc;
    229  1.1  jmcneill 		iba.iba_tag->ic_acquire_bus = viapcib_acquire_bus;
    230  1.1  jmcneill 		iba.iba_tag->ic_release_bus = viapcib_release_bus;
    231  1.1  jmcneill 		iba.iba_tag->ic_exec = viapcib_exec;
    232  1.1  jmcneill 
    233  1.3  drochner 		config_found_ia(&sc->sc_dev, "i2cbus", &iba, iicbus_print);
    234  1.1  jmcneill 	}
    235  1.1  jmcneill 
    236  1.1  jmcneill 	return;
    237  1.1  jmcneill }
    238  1.1  jmcneill 
    239  1.1  jmcneill static int
    240  1.1  jmcneill viapcib_wait(struct viapcib_softc *sc)
    241  1.1  jmcneill {
    242  1.1  jmcneill 	int rv, timeout;
    243  1.1  jmcneill 	uint8_t val;
    244  1.1  jmcneill 
    245  1.1  jmcneill 	timeout = VIAPCIB_SMBUS_TIMEOUT;
    246  1.1  jmcneill 	rv = 0;
    247  1.1  jmcneill 
    248  1.1  jmcneill 	while (timeout--) {
    249  1.1  jmcneill 		val = viapcib_smbus_read(sc, SMBHSTSTS);
    250  1.1  jmcneill 		if (!(val & SMBHSTSTS_BUSY) && (val & SMBHSTSTS_INTR))
    251  1.1  jmcneill 			break;
    252  1.1  jmcneill 		DELAY(10);
    253  1.1  jmcneill 	}
    254  1.1  jmcneill 
    255  1.1  jmcneill 	if (timeout == 0)
    256  1.1  jmcneill 		rv = EBUSY;
    257  1.1  jmcneill 
    258  1.1  jmcneill 	if ((val & SMBHSTSTS_FAILED) || (val & SMBHSTSTS_COLLISION) ||
    259  1.1  jmcneill 	    (val & SMBHSTSTS_ERROR))
    260  1.1  jmcneill 		rv = EIO;
    261  1.1  jmcneill 
    262  1.1  jmcneill 	viapcib_clear(sc);
    263  1.1  jmcneill 
    264  1.1  jmcneill 	return rv;
    265  1.1  jmcneill }
    266  1.1  jmcneill 
    267  1.1  jmcneill static int
    268  1.1  jmcneill viapcib_clear(struct viapcib_softc *sc)
    269  1.1  jmcneill {
    270  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTSTS,
    271  1.1  jmcneill 	    (SMBHSTSTS_FAILED | SMBHSTSTS_COLLISION | SMBHSTSTS_ERROR |
    272  1.1  jmcneill 	     SMBHSTSTS_INTR));
    273  1.1  jmcneill 	DELAY(10);
    274  1.1  jmcneill 
    275  1.1  jmcneill 	return 0;
    276  1.1  jmcneill }
    277  1.1  jmcneill 
    278  1.1  jmcneill static int
    279  1.1  jmcneill viapcib_busy(struct viapcib_softc *sc)
    280  1.1  jmcneill {
    281  1.1  jmcneill 	uint8_t val;
    282  1.1  jmcneill 
    283  1.1  jmcneill 	val = viapcib_smbus_read(sc, SMBHSTSTS);
    284  1.1  jmcneill 
    285  1.1  jmcneill 	return (val & SMBHSTSTS_BUSY);
    286  1.1  jmcneill }
    287  1.1  jmcneill 
    288  1.1  jmcneill static int
    289  1.6  christos viapcib_acquire_bus(void *opaque, int flags)
    290  1.1  jmcneill {
    291  1.1  jmcneill 	struct viapcib_softc *sc;
    292  1.1  jmcneill 
    293  1.1  jmcneill 	DPRINTF(("viapcib_i2c_acquire_bus(%p, 0x%x)\n", opaque, flags));
    294  1.1  jmcneill 
    295  1.1  jmcneill 	sc = (struct viapcib_softc *)opaque;
    296  1.1  jmcneill 
    297  1.1  jmcneill 	simple_lock(&sc->sc_lock);
    298  1.1  jmcneill 
    299  1.1  jmcneill 	return 0;
    300  1.1  jmcneill }
    301  1.1  jmcneill 
    302  1.1  jmcneill static void
    303  1.6  christos viapcib_release_bus(void *opaque, int flags)
    304  1.1  jmcneill {
    305  1.1  jmcneill 	struct viapcib_softc *sc;
    306  1.1  jmcneill 
    307  1.1  jmcneill 	DPRINTF(("viapcib_i2c_release_bus(%p, 0x%x)\n", opaque, flags));
    308  1.1  jmcneill 
    309  1.1  jmcneill 	sc = (struct viapcib_softc *)opaque;
    310  1.1  jmcneill 
    311  1.1  jmcneill 	simple_unlock(&sc->sc_lock);
    312  1.1  jmcneill 
    313  1.1  jmcneill 	return;
    314  1.1  jmcneill }
    315  1.1  jmcneill 
    316  1.1  jmcneill static int
    317  1.1  jmcneill viapcib_exec(void *opaque, i2c_op_t op, i2c_addr_t addr, const void *vcmd,
    318  1.6  christos     size_t cmdlen, void *vbuf, size_t buflen, int flags)
    319  1.1  jmcneill {
    320  1.1  jmcneill 	struct viapcib_softc *sc;
    321  1.1  jmcneill 	uint8_t cmd;
    322  1.1  jmcneill 	int rv = -1;
    323  1.1  jmcneill 
    324  1.1  jmcneill 	DPRINTF(("viapcib_exec(%p, 0x%x, 0x%x, %p, %d, %p, %d, 0x%x)\n",
    325  1.1  jmcneill 	    opaque, op, addr, vcmd, cmdlen, vbuf, buflen, flags));
    326  1.1  jmcneill 
    327  1.1  jmcneill 	sc = (struct viapcib_softc *)opaque;
    328  1.1  jmcneill 
    329  1.1  jmcneill 	if (op != I2C_OP_READ_WITH_STOP &&
    330  1.1  jmcneill 	    op != I2C_OP_WRITE_WITH_STOP)
    331  1.1  jmcneill 		return -1;
    332  1.1  jmcneill 
    333  1.1  jmcneill 	if (cmdlen > 0)
    334  1.1  jmcneill 		cmd = *(uint8_t *)(__UNCONST(vcmd)); /* XXX */
    335  1.1  jmcneill 
    336  1.1  jmcneill 	switch (cmdlen) {
    337  1.1  jmcneill 	case 0:
    338  1.1  jmcneill 		switch (buflen) {
    339  1.1  jmcneill 		case 0:
    340  1.1  jmcneill 			/* SMBus quick read/write */
    341  1.1  jmcneill 			if (I2C_OP_READ_P(op))
    342  1.1  jmcneill 				rv = viapcib_smbus_quick_read(sc, addr);
    343  1.1  jmcneill 			else
    344  1.1  jmcneill 				rv = viapcib_smbus_quick_write(sc, addr);
    345  1.1  jmcneill 
    346  1.1  jmcneill 			return rv;
    347  1.1  jmcneill 		case 1:
    348  1.1  jmcneill 			/* SMBus send/receive byte */
    349  1.1  jmcneill 			if (I2C_OP_READ_P(op))
    350  1.1  jmcneill 				rv = viapcib_smbus_send_byte(sc, addr,
    351  1.1  jmcneill 				    *(uint8_t *)vbuf);
    352  1.1  jmcneill 			else
    353  1.1  jmcneill 				rv = viapcib_smbus_receive_byte(sc, addr,
    354  1.1  jmcneill 				    (uint8_t *)vbuf);
    355  1.1  jmcneill 			return rv;
    356  1.1  jmcneill 		default:
    357  1.1  jmcneill 			return -1;
    358  1.1  jmcneill 		}
    359  1.1  jmcneill 	case 1:
    360  1.1  jmcneill 		switch (buflen) {
    361  1.1  jmcneill 		case 0:
    362  1.1  jmcneill 			return -1;
    363  1.1  jmcneill 		case 1:
    364  1.1  jmcneill 			/* SMBus read/write byte */
    365  1.1  jmcneill 			if (I2C_OP_READ_P(op))
    366  1.1  jmcneill 				rv = viapcib_smbus_read_byte(sc, addr,
    367  1.1  jmcneill 				    cmd, (uint8_t *)vbuf);
    368  1.1  jmcneill 			else
    369  1.1  jmcneill 				rv = viapcib_smbus_write_byte(sc, addr,
    370  1.1  jmcneill 				    cmd, *(uint8_t *)vbuf);
    371  1.1  jmcneill 			return rv;
    372  1.1  jmcneill 		case 2:
    373  1.1  jmcneill 			/* SMBus read/write word */
    374  1.1  jmcneill 			if (I2C_OP_READ_P(op))
    375  1.1  jmcneill 				rv = viapcib_smbus_read_word(sc, addr,
    376  1.1  jmcneill 				    cmd, (uint16_t *)vbuf);
    377  1.1  jmcneill 			else
    378  1.1  jmcneill 				rv = viapcib_smbus_write_word(sc, addr,
    379  1.1  jmcneill 				    cmd, *(uint16_t *)vbuf);
    380  1.1  jmcneill 			return rv;
    381  1.1  jmcneill 		default:
    382  1.1  jmcneill 			/* SMBus read/write block */
    383  1.1  jmcneill 			if (I2C_OP_READ_P(op))
    384  1.1  jmcneill 				rv = viapcib_smbus_block_read(sc, addr,
    385  1.1  jmcneill 				    cmd, buflen, vbuf);
    386  1.1  jmcneill 			else
    387  1.1  jmcneill 				rv = viapcib_smbus_block_write(sc, addr,
    388  1.1  jmcneill 				    cmd, buflen, vbuf);
    389  1.1  jmcneill 			return rv;
    390  1.1  jmcneill 		}
    391  1.1  jmcneill 	}
    392  1.1  jmcneill 
    393  1.1  jmcneill 	return -1; /* XXX ??? */
    394  1.1  jmcneill }
    395  1.1  jmcneill 
    396  1.1  jmcneill static int
    397  1.1  jmcneill viapcib_smbus_quick_write(void *opaque, i2c_addr_t slave)
    398  1.1  jmcneill {
    399  1.1  jmcneill 	struct viapcib_softc *sc;
    400  1.1  jmcneill 
    401  1.1  jmcneill 	sc = (struct viapcib_softc *)opaque;
    402  1.1  jmcneill 
    403  1.1  jmcneill 	DPRINTF(("viapcib_smbus_quick_write(%p, 0x%x)\n", opaque, slave));
    404  1.1  jmcneill 
    405  1.1  jmcneill 	viapcib_clear(sc);
    406  1.1  jmcneill 	if (viapcib_busy(sc))
    407  1.1  jmcneill 		return EBUSY;
    408  1.1  jmcneill 
    409  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTADD, (slave & 0x7f) << 1);
    410  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCNT, SMBHSTCNT_QUICK);
    411  1.1  jmcneill 	if (viapcib_wait(sc))
    412  1.1  jmcneill 		return EBUSY;
    413  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCNT, SMBHSTCNT_QUICK | SMBHSTCNT_START);
    414  1.1  jmcneill 
    415  1.1  jmcneill 	return viapcib_wait(sc);
    416  1.1  jmcneill }
    417  1.1  jmcneill 
    418  1.1  jmcneill static int
    419  1.1  jmcneill viapcib_smbus_quick_read(void *opaque, i2c_addr_t slave)
    420  1.1  jmcneill {
    421  1.1  jmcneill 	struct viapcib_softc *sc;
    422  1.1  jmcneill 
    423  1.1  jmcneill 	sc = (struct viapcib_softc *)opaque;
    424  1.1  jmcneill 
    425  1.1  jmcneill 	DPRINTF(("viapcib_smbus_quick_read(%p, 0x%x)\n", opaque, slave));
    426  1.1  jmcneill 
    427  1.1  jmcneill 	viapcib_clear(sc);
    428  1.1  jmcneill 	if (viapcib_busy(sc))
    429  1.1  jmcneill 		return EBUSY;
    430  1.1  jmcneill 
    431  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTADD, ((slave & 0x7f) << 1) | 1);
    432  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCNT, SMBHSTCNT_QUICK);
    433  1.1  jmcneill 	if (viapcib_wait(sc))
    434  1.1  jmcneill 		return EBUSY;
    435  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCNT, SMBHSTCNT_QUICK | SMBHSTCNT_START);
    436  1.1  jmcneill 
    437  1.1  jmcneill 	return viapcib_wait(sc);
    438  1.1  jmcneill }
    439  1.1  jmcneill 
    440  1.1  jmcneill static int
    441  1.1  jmcneill viapcib_smbus_send_byte(void *opaque, i2c_addr_t slave, uint8_t byte)
    442  1.1  jmcneill {
    443  1.1  jmcneill 	struct viapcib_softc *sc;
    444  1.1  jmcneill 
    445  1.1  jmcneill 	sc = (struct viapcib_softc *)opaque;
    446  1.1  jmcneill 
    447  1.1  jmcneill 	DPRINTF(("viapcib_smbus_send_byte(%p, 0x%x, 0x%x)\n", opaque,
    448  1.1  jmcneill 	    slave, byte));
    449  1.1  jmcneill 
    450  1.1  jmcneill 	viapcib_clear(sc);
    451  1.1  jmcneill 	if (viapcib_busy(sc))
    452  1.1  jmcneill 		return EBUSY;
    453  1.1  jmcneill 
    454  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTADD, (slave & 0x7f) << 1);
    455  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCMD, byte);
    456  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCNT, SMBHSTCNT_SENDRECV);
    457  1.1  jmcneill 	if (viapcib_wait(sc))
    458  1.1  jmcneill 		return EBUSY;
    459  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCNT,
    460  1.1  jmcneill 	    SMBHSTCNT_START | SMBHSTCNT_SENDRECV);
    461  1.1  jmcneill 
    462  1.1  jmcneill 	return viapcib_wait(sc);
    463  1.1  jmcneill }
    464  1.1  jmcneill 
    465  1.1  jmcneill static int
    466  1.1  jmcneill viapcib_smbus_receive_byte(void *opaque, i2c_addr_t slave, uint8_t *pbyte)
    467  1.1  jmcneill {
    468  1.1  jmcneill 	struct viapcib_softc *sc;
    469  1.1  jmcneill 	int rv;
    470  1.1  jmcneill 
    471  1.1  jmcneill 	sc = (struct viapcib_softc *)opaque;
    472  1.1  jmcneill 
    473  1.1  jmcneill 	DPRINTF(("viapcib_smbus_receive_byte(%p, 0x%x, %p)\n", opaque,
    474  1.1  jmcneill 	    slave, pbyte));
    475  1.1  jmcneill 
    476  1.1  jmcneill 	viapcib_clear(sc);
    477  1.1  jmcneill 	if (viapcib_busy(sc))
    478  1.1  jmcneill 		return EBUSY;
    479  1.1  jmcneill 
    480  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTADD, ((slave & 0x7f) << 1) | 1);
    481  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCNT, SMBHSTCNT_SENDRECV);
    482  1.1  jmcneill 	if (viapcib_wait(sc))
    483  1.1  jmcneill 		return EBUSY;
    484  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCNT,
    485  1.1  jmcneill 	    SMBHSTCNT_START | SMBHSTCNT_SENDRECV);
    486  1.1  jmcneill 
    487  1.1  jmcneill 	rv = viapcib_wait(sc);
    488  1.1  jmcneill 	if (rv == 0)
    489  1.1  jmcneill 		*pbyte = viapcib_smbus_read(sc, SMBHSTDAT0);
    490  1.1  jmcneill 
    491  1.1  jmcneill 	return rv;
    492  1.1  jmcneill }
    493  1.1  jmcneill 
    494  1.1  jmcneill static int
    495  1.1  jmcneill viapcib_smbus_write_byte(void *opaque, i2c_addr_t slave, uint8_t cmd,
    496  1.1  jmcneill 		   int8_t byte)
    497  1.1  jmcneill {
    498  1.1  jmcneill 	struct viapcib_softc *sc;
    499  1.1  jmcneill 
    500  1.1  jmcneill 	sc = (struct viapcib_softc *)opaque;
    501  1.1  jmcneill 
    502  1.1  jmcneill 	DPRINTF(("viapcib_smbus_write_byte(%p, 0x%x, 0x%x, 0x%x)\n", opaque,
    503  1.1  jmcneill 	    slave, cmd, byte));
    504  1.1  jmcneill 
    505  1.1  jmcneill 	viapcib_clear(sc);
    506  1.1  jmcneill 	if (viapcib_busy(sc))
    507  1.1  jmcneill 		return EBUSY;
    508  1.1  jmcneill 
    509  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTADD, (slave & 0x7f) << 1);
    510  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCMD, cmd);
    511  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTDAT0, byte);
    512  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCNT, SMBHSTCNT_BYTE);
    513  1.1  jmcneill 	if (viapcib_wait(sc))
    514  1.1  jmcneill 		return EBUSY;
    515  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCNT, SMBHSTCNT_START | SMBHSTCNT_BYTE);
    516  1.1  jmcneill 
    517  1.1  jmcneill 	return viapcib_wait(sc);
    518  1.1  jmcneill }
    519  1.1  jmcneill 
    520  1.1  jmcneill static int
    521  1.1  jmcneill viapcib_smbus_read_byte(void *opaque, i2c_addr_t slave, uint8_t cmd,
    522  1.1  jmcneill 		  int8_t *pbyte)
    523  1.1  jmcneill {
    524  1.1  jmcneill 	struct viapcib_softc *sc;
    525  1.1  jmcneill 	int rv;
    526  1.1  jmcneill 
    527  1.1  jmcneill 	sc = (struct viapcib_softc *)opaque;
    528  1.1  jmcneill 
    529  1.1  jmcneill 	DPRINTF(("viapcib_smbus_read_byte(%p, 0x%x, 0x%x, %p)\n", opaque,
    530  1.1  jmcneill 	    slave, cmd, pbyte));
    531  1.1  jmcneill 
    532  1.1  jmcneill 	viapcib_clear(sc);
    533  1.1  jmcneill 	if (viapcib_busy(sc))
    534  1.1  jmcneill 		return EBUSY;
    535  1.1  jmcneill 
    536  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTADD, ((slave & 0x7f) << 1) | 1);
    537  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCMD, cmd);
    538  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCNT, SMBHSTCNT_BYTE);
    539  1.1  jmcneill 	if (viapcib_wait(sc))
    540  1.1  jmcneill 		return EBUSY;
    541  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCNT, SMBHSTCNT_START | SMBHSTCNT_BYTE);
    542  1.1  jmcneill 	rv = viapcib_wait(sc);
    543  1.1  jmcneill 	if (rv == 0)
    544  1.1  jmcneill 		*pbyte = viapcib_smbus_read(sc, SMBHSTDAT0);
    545  1.1  jmcneill 
    546  1.1  jmcneill 	return rv;
    547  1.1  jmcneill }
    548  1.1  jmcneill 
    549  1.1  jmcneill static int
    550  1.1  jmcneill viapcib_smbus_write_word(void *opaque, i2c_addr_t slave, uint8_t cmd,
    551  1.1  jmcneill 		   int16_t word)
    552  1.1  jmcneill {
    553  1.1  jmcneill 	struct viapcib_softc *sc;
    554  1.1  jmcneill 
    555  1.1  jmcneill 	sc = (struct viapcib_softc *)opaque;
    556  1.1  jmcneill 
    557  1.1  jmcneill 	DPRINTF(("viapcib_smbus_write_word(%p, 0x%x, 0x%x, 0x%x)\n", opaque,
    558  1.1  jmcneill 	    slave, cmd, word));
    559  1.1  jmcneill 
    560  1.1  jmcneill 	viapcib_clear(sc);
    561  1.1  jmcneill 	if (viapcib_busy(sc))
    562  1.1  jmcneill 		return EBUSY;
    563  1.1  jmcneill 
    564  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTADD, (slave & 0x7f) << 1);
    565  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCMD, cmd);
    566  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTDAT0, word & 0x00ff);
    567  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTDAT1, (word & 0xff00) >> 8);
    568  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCNT, SMBHSTCNT_WORD);
    569  1.1  jmcneill 	if (viapcib_wait(sc))
    570  1.1  jmcneill 		return EBUSY;
    571  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCNT, SMBHSTCNT_START | SMBHSTCNT_WORD);
    572  1.1  jmcneill 
    573  1.1  jmcneill 	return viapcib_wait(sc);
    574  1.1  jmcneill }
    575  1.1  jmcneill 
    576  1.1  jmcneill static int
    577  1.1  jmcneill viapcib_smbus_read_word(void *opaque, i2c_addr_t slave, uint8_t cmd,
    578  1.1  jmcneill 		  int16_t *pword)
    579  1.1  jmcneill {
    580  1.1  jmcneill 	struct viapcib_softc *sc;
    581  1.1  jmcneill 	int rv;
    582  1.1  jmcneill 	int8_t high, low;
    583  1.1  jmcneill 
    584  1.1  jmcneill 	sc = (struct viapcib_softc *)opaque;
    585  1.1  jmcneill 
    586  1.1  jmcneill 	DPRINTF(("viapcib_smbus_read_word(%p, 0x%x, 0x%x, %p)\n", opaque,
    587  1.1  jmcneill 	    slave, cmd, pword));
    588  1.1  jmcneill 
    589  1.1  jmcneill 	viapcib_clear(sc);
    590  1.1  jmcneill 	if (viapcib_busy(sc))
    591  1.1  jmcneill 		return EBUSY;
    592  1.1  jmcneill 
    593  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTADD, ((slave & 0x7f) << 1) | 1);
    594  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCMD, cmd);
    595  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCNT, SMBHSTCNT_WORD);
    596  1.1  jmcneill 	if (viapcib_wait(sc))
    597  1.1  jmcneill 		return EBUSY;
    598  1.1  jmcneill 	viapcib_smbus_write(sc, SMBHSTCNT, SMBHSTCNT_START | SMBHSTCNT_WORD);
    599  1.1  jmcneill 
    600  1.1  jmcneill 	rv = viapcib_wait(sc);
    601  1.1  jmcneill 	if (rv == 0) {
    602  1.1  jmcneill 		low = viapcib_smbus_read(sc, SMBHSTDAT0);
    603  1.1  jmcneill 		high = viapcib_smbus_read(sc, SMBHSTDAT1);
    604  1.1  jmcneill 		*pword = ((high & 0xff) << 8) | (low & 0xff);
    605  1.1  jmcneill 	}
    606  1.1  jmcneill 
    607  1.1  jmcneill 	return rv;
    608  1.1  jmcneill }
    609  1.1  jmcneill 
    610  1.1  jmcneill static int
    611  1.1  jmcneill viapcib_smbus_block_write(void *opaque, i2c_addr_t slave, uint8_t cmd,
    612  1.1  jmcneill 		    int cnt, void *data)
    613  1.1  jmcneill {
    614  1.1  jmcneill 	struct viapcib_softc *sc;
    615  1.1  jmcneill 	int8_t *buf;
    616  1.1  jmcneill 	int remain, len, i;
    617  1.1  jmcneill 	int rv;
    618  1.1  jmcneill 
    619  1.1  jmcneill 	sc = (struct viapcib_softc *)opaque;
    620  1.1  jmcneill 	buf = (int8_t *)data;
    621  1.1  jmcneill 	rv = 0;
    622  1.1  jmcneill 
    623  1.1  jmcneill 	DPRINTF(("viapcib_smbus_block_write(%p, 0x%x, 0x%x, %d, %p)\n",
    624  1.1  jmcneill 	    opaque, slave, cmd, cnt, data));
    625  1.1  jmcneill 
    626  1.1  jmcneill 	viapcib_clear(sc);
    627  1.1  jmcneill 	if (viapcib_busy(sc))
    628  1.1  jmcneill 		return EBUSY;
    629  1.1  jmcneill 
    630  1.1  jmcneill 	remain = cnt;
    631  1.1  jmcneill 	while (remain) {
    632  1.1  jmcneill 		len = min(remain, SMB_MAXBLOCKSIZE);
    633  1.1  jmcneill 
    634  1.1  jmcneill 		viapcib_smbus_write(sc, SMBHSTADD, (slave & 0x7f) << 1);
    635  1.1  jmcneill 		viapcib_smbus_write(sc, SMBHSTCMD, cmd);
    636  1.1  jmcneill 		viapcib_smbus_write(sc, SMBHSTDAT0, len);
    637  1.1  jmcneill 		i = viapcib_smbus_read(sc, SMBHSTCNT);
    638  1.1  jmcneill 		/* XXX FreeBSD does this, but it looks wrong */
    639  1.1  jmcneill 		for (i = 0; i < len; i++) {
    640  1.1  jmcneill 			viapcib_smbus_write(sc, SMBBLKDAT,
    641  1.1  jmcneill 			    buf[cnt - remain + i]);
    642  1.1  jmcneill 		}
    643  1.1  jmcneill 		viapcib_smbus_write(sc, SMBHSTCNT, SMBHSTCNT_BLOCK);
    644  1.1  jmcneill 		if (viapcib_wait(sc))
    645  1.1  jmcneill 			return EBUSY;
    646  1.1  jmcneill 		viapcib_smbus_write(sc, SMBHSTCNT,
    647  1.1  jmcneill 		    SMBHSTCNT_START | SMBHSTCNT_BLOCK);
    648  1.1  jmcneill 		if (viapcib_wait(sc))
    649  1.1  jmcneill 			return EBUSY;
    650  1.1  jmcneill 
    651  1.1  jmcneill 		remain -= len;
    652  1.1  jmcneill 	}
    653  1.1  jmcneill 
    654  1.1  jmcneill 	return rv;
    655  1.1  jmcneill }
    656  1.1  jmcneill 
    657  1.1  jmcneill static int
    658  1.1  jmcneill viapcib_smbus_block_read(void *opaque, i2c_addr_t slave, uint8_t cmd,
    659  1.1  jmcneill 			 int cnt, void *data)
    660  1.1  jmcneill {
    661  1.1  jmcneill 	struct viapcib_softc *sc;
    662  1.1  jmcneill 	int8_t *buf;
    663  1.1  jmcneill 	int remain, len, i;
    664  1.1  jmcneill 	int rv;
    665  1.1  jmcneill 
    666  1.1  jmcneill 	sc = (struct viapcib_softc *)opaque;
    667  1.1  jmcneill 	buf = (int8_t *)data;
    668  1.1  jmcneill 	rv = 0;
    669  1.1  jmcneill 
    670  1.1  jmcneill 	DPRINTF(("viapcib_smbus_block_read(%p, 0x%x, 0x%x, %d, %p)\n",
    671  1.1  jmcneill 	    opaque, slave, cmd, cnt, data));
    672  1.1  jmcneill 
    673  1.1  jmcneill 	viapcib_clear(sc);
    674  1.1  jmcneill 	if (viapcib_busy(sc))
    675  1.1  jmcneill 		return EBUSY;
    676  1.1  jmcneill 
    677  1.1  jmcneill 	remain = cnt;
    678  1.1  jmcneill 	while (remain) {
    679  1.1  jmcneill 		viapcib_smbus_write(sc, SMBHSTADD, ((slave & 0x7f) << 1) | 1);
    680  1.1  jmcneill 		viapcib_smbus_write(sc, SMBHSTCMD, cmd);
    681  1.1  jmcneill 		viapcib_smbus_write(sc, SMBHSTCNT, SMBHSTCNT_BLOCK);
    682  1.1  jmcneill 		if (viapcib_wait(sc))
    683  1.1  jmcneill 			return EBUSY;
    684  1.1  jmcneill 		viapcib_smbus_write(sc, SMBHSTCNT,
    685  1.1  jmcneill 		    SMBHSTCNT_START | SMBHSTCNT_BLOCK);
    686  1.1  jmcneill 		if (viapcib_wait(sc))
    687  1.1  jmcneill 			return EBUSY;
    688  1.1  jmcneill 
    689  1.1  jmcneill 		len = viapcib_smbus_read(sc, SMBHSTDAT0);
    690  1.1  jmcneill 		i = viapcib_smbus_read(sc, SMBHSTCNT);
    691  1.1  jmcneill 
    692  1.1  jmcneill 		len = min(len, remain);
    693  1.1  jmcneill 
    694  1.1  jmcneill 		/* FreeBSD does this too... */
    695  1.1  jmcneill 		for (i = 0; i < len; i++) {
    696  1.1  jmcneill 			buf[cnt - remain + i] =
    697  1.1  jmcneill 			    viapcib_smbus_read(sc, SMBBLKDAT);
    698  1.1  jmcneill 		}
    699  1.1  jmcneill 
    700  1.1  jmcneill 		remain -= len;
    701  1.1  jmcneill 	}
    702  1.1  jmcneill 
    703  1.1  jmcneill 	return rv;
    704  1.1  jmcneill }
    705