sys/dev/i2c/lm_i2c.c

   1 /*      $NetBSD: lm_i2c.c,v 1.1 2008/10/12 13:17:28 pgoyette 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.1 2008/10/12 13:17:28 pgoyette 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
  41 #include <dev/i2c/i2cvar.h>
  42
  43 #include <dev/sysmon/sysmonvar.h>
  44
  45 #include <dev/ic/nslm7xvar.h>
  46
  47 int     lm_i2c_match(device_t, cfdata_t, void *);
  48 void    lm_i2c_attach(device_t, device_t, void *);
  49 int     lm_i2c_detach(device_t, int);
  50
  51 uint8_t lm_i2c_readreg(struct lm_softc *, int);
  52 void    lm_i2c_writereg(struct lm_softc *, int, int);
  53
  54 struct lm_i2c_softc {
  55         struct lm_softc sc_lmsc;
  56         i2c_tag_t sc_tag;
  57         i2c_addr_t sc_addr;
  58 };
  59
  60 CFATTACH_DECL_NEW(lm_iic, sizeof(struct lm_i2c_softc),
  61     lm_i2c_match, lm_i2c_attach, lm_i2c_detach, NULL);
  62
  63 int
  64 lm_i2c_match(device_t parent, cfdata_t match, void *aux)
  65 {
  66         struct i2c_attach_args *ia = aux;
  67         int rv = 0;
  68         struct lm_i2c_softc sc;
  69
  70         /* Must supply an address */
  71         if (ia->ia_addr < 1)
  72                 return 0;
  73
  74         /* Bus independent probe */
  75         sc.sc_lmsc.lm_writereg = lm_i2c_writereg;
  76         sc.sc_lmsc.lm_readreg = lm_i2c_readreg;
  77         sc.sc_tag = ia->ia_tag;
  78         sc.sc_addr = ia->ia_addr;
  79         rv = lm_probe(&sc.sc_lmsc);
  80
  81         return rv;
  82 }
  83
  84
  85 void
  86 lm_i2c_attach(device_t parent, device_t self, void *aux)
  87 {
  88         struct lm_i2c_softc *sc = device_private(self);
  89         struct i2c_attach_args *ia = aux;
  90
  91         sc->sc_tag = ia->ia_tag;
  92         sc->sc_addr = ia->ia_addr;
  93
  94         /* Bus-independent attachment */
  95         sc->sc_lmsc.sc_dev = self;
  96         sc->sc_lmsc.lm_writereg = lm_i2c_writereg;
  97         sc->sc_lmsc.lm_readreg = lm_i2c_readreg;
  98
  99         lm_attach(&sc->sc_lmsc);
 100 }
 101
 102 int
 103 lm_i2c_detach(device_t self, int flags)
 104 {
 105         struct lm_i2c_softc *sc = device_private(self);
 106
 107         lm_detach(&sc->sc_lmsc);
 108         return 0;
 109 }
 110
 111 uint8_t
 112 lm_i2c_readreg(struct lm_softc *lmsc, int reg)
 113 {
 114         struct lm_i2c_softc *sc = (struct lm_i2c_softc *)lmsc;
 115         uint8_t cmd, data;
 116
 117         iic_acquire_bus(sc->sc_tag, 0);
 118
 119         cmd = reg;
 120         iic_exec(sc->sc_tag, I2C_OP_READ_WITH_STOP,
 121                  sc->sc_addr, &cmd, sizeof cmd, &data, sizeof data, 0);
 122
 123         iic_release_bus(sc->sc_tag, 0);
 124
 125         return data;
 126 }
 127
 128
 129 void
 130 lm_i2c_writereg(struct lm_softc *lmsc, int reg, int val)
 131 {
 132         struct lm_i2c_softc *sc = (struct lm_i2c_softc *)lmsc;
 133         uint8_t cmd, data;
 134
 135         iic_acquire_bus(sc->sc_tag, 0);
 136
 137         cmd = reg;
 138         data = val;
 139         iic_exec(sc->sc_tag, I2C_OP_WRITE_WITH_STOP,
 140                  sc->sc_addr, &cmd, sizeof cmd, &data, sizeof data, 0);
 141
 142         iic_release_bus(sc->sc_tag, 0);
 143 }