Home | History | Annotate | Line # | Download | only in i2c 
      1 /*	$NetBSD: lm_i2c.c,v 1.7 2021/06/13 09:48:44 mlelstv Exp $	*/
      2 
      3 /*-
      4  * Copyright (c) 2000 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Bill Squier.
      9  *
     10  * Redistribution and use in source and binary forms, with or without
     11  * modification, are permitted provided that the following conditions
     12  * are met:
     13  * 1. Redistributions of source code must retain the above copyright
     14  *    notice, this list of conditions and the following disclaimer.
     15  * 2. Redistributions in binary form must reproduce the above copyright
     16  *    notice, this list of conditions and the following disclaimer in the
     17  *    documentation and/or other materials provided with the distribution.
     18  *
     19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  * POSSIBILITY OF SUCH DAMAGE.
     30  */
     31 
     32 #include <sys/cdefs.h>
     33 __KERNEL_RCSID(0, "$NetBSD: lm_i2c.c,v 1.7 2021/06/13 09:48:44 mlelstv Exp $");
     34 
     35 #include <sys/param.h>
     36 #include <sys/systm.h>
     37 #include <sys/kernel.h>
     38 #include <sys/device.h>
     39 #include <sys/conf.h>
     40 #include <sys/kmem.h>
     41 
     42 #include <dev/i2c/i2cvar.h>
     43 
     44 #include <dev/sysmon/sysmonvar.h>
     45 
     46 #include <dev/ic/nslm7xvar.h>
     47 
     48 int 	lm_i2c_match(device_t, cfdata_t, void *);
     49 void 	lm_i2c_attach(device_t, device_t, void *);
     50 int 	lm_i2c_detach(device_t, int);
     51 
     52 uint8_t lm_i2c_readreg(struct lm_softc *, int);
     53 void 	lm_i2c_writereg(struct lm_softc *, int, uint8_t);
     54 
     55 struct lm_i2c_softc {
     56 	struct lm_softc sc_lmsc;
     57 	i2c_tag_t sc_tag;
     58 	i2c_addr_t sc_addr;
     59 };
     60 
     61 CFATTACH_DECL_NEW(lm_iic, sizeof(struct lm_i2c_softc),
     62     lm_i2c_match, lm_i2c_attach, lm_i2c_detach, NULL);
     63 
     64 int
     65 lm_i2c_match(device_t parent, cfdata_t match, void *aux)
     66 {
     67 	struct i2c_attach_args *ia = aux;
     68 	int rv = 0;
     69 	struct lm_i2c_softc *sc;
     70 
     71 	/* Must supply an address */
     72 	if (ia->ia_addr < 1)
     73 		return 0;
     74 
     75 	/* XXXJRT filter addresses //at all// please? */
     76 
     77 	/* Bus independent probe */
     78 	sc = kmem_zalloc(sizeof(*sc), KM_SLEEP);
     79 	sc->sc_lmsc.lm_writereg = lm_i2c_writereg;
     80 	sc->sc_lmsc.lm_readreg = lm_i2c_readreg;
     81 	sc->sc_tag = ia->ia_tag;
     82 	sc->sc_addr = ia->ia_addr;
     83 	rv = lm_match(&sc->sc_lmsc);
     84 	kmem_free(sc, sizeof(*sc));
     85 
     86 	return rv ? I2C_MATCH_ADDRESS_AND_PROBE : 0;
     87 }
     88 
     89 
     90 void
     91 lm_i2c_attach(device_t parent, device_t self, void *aux)
     92 {
     93 	struct lm_i2c_softc *sc = device_private(self);
     94 	struct i2c_attach_args *ia = aux;
     95 
     96 	sc->sc_tag = ia->ia_tag;
     97 	sc->sc_addr = ia->ia_addr;
     98 
     99 	/* Bus-independent attachment */
    100 	sc->sc_lmsc.sc_dev = self;
    101 	sc->sc_lmsc.lm_writereg = lm_i2c_writereg;
    102 	sc->sc_lmsc.lm_readreg = lm_i2c_readreg;
    103 
    104 	lm_attach(&sc->sc_lmsc);
    105 }
    106 
    107 int
    108 lm_i2c_detach(device_t self, int flags)
    109 {
    110 	struct lm_i2c_softc *sc = device_private(self);
    111 
    112 	lm_detach(&sc->sc_lmsc);
    113 	return 0;
    114 }
    115 
    116 uint8_t
    117 lm_i2c_readreg(struct lm_softc *lmsc, int reg)
    118 {
    119 	struct lm_i2c_softc *sc = (struct lm_i2c_softc *)lmsc;
    120 	uint8_t cmd, data;
    121 
    122 	if (iic_acquire_bus(sc->sc_tag, 0))
    123 		return 0;
    124 
    125 	cmd = reg;
    126 	iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP,
    127 		 sc->sc_addr, &cmd, sizeof cmd, &data, sizeof data, 0);
    128 
    129 	iic_release_bus(sc->sc_tag, 0);
    130 
    131 	return data;
    132 }
    133 
    134 
    135 void
    136 lm_i2c_writereg(struct lm_softc *lmsc, int reg, uint8_t val)
    137 {
    138 	struct lm_i2c_softc *sc = (struct lm_i2c_softc *)lmsc;
    139 	uint8_t cmd, data;
    140 
    141 	if (iic_acquire_bus(sc->sc_tag, 0))
    142 		return;
    143 
    144 	cmd = reg;
    145 	data = val;
    146 	iic_exec(sc->sc_tag, I2C_OP_WRITE_WITH_STOP,
    147 		 sc->sc_addr, &cmd, sizeof cmd, &data, sizeof data, 0);
    148 
    149 	iic_release_bus(sc->sc_tag, 0);
    150 }
    151