Home | History | Annotate | Line # | Download | only in i2c
axp809.c revision 1.1
      1  1.1  jmcneill /* $NetBSD: axp809.c,v 1.1 2014/12/07 00:33:26 jmcneill Exp $ */
      2  1.1  jmcneill 
      3  1.1  jmcneill /*-
      4  1.1  jmcneill  * Copyright (c) 2014 Jared D. McNeill <jmcneill (at) invisible.ca>
      5  1.1  jmcneill  * All rights reserved.
      6  1.1  jmcneill  *
      7  1.1  jmcneill  * Redistribution and use in source and binary forms, with or without
      8  1.1  jmcneill  * modification, are permitted provided that the following conditions
      9  1.1  jmcneill  * are met:
     10  1.1  jmcneill  * 1. Redistributions of source code must retain the above copyright
     11  1.1  jmcneill  *    notice, this list of conditions and the following disclaimer.
     12  1.1  jmcneill  * 2. Redistributions in binary form must reproduce the above copyright
     13  1.1  jmcneill  *    notice, this list of conditions and the following disclaimer in the
     14  1.1  jmcneill  *    documentation and/or other materials provided with the distribution.
     15  1.1  jmcneill  *
     16  1.1  jmcneill  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     17  1.1  jmcneill  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     18  1.1  jmcneill  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     19  1.1  jmcneill  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     20  1.1  jmcneill  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     21  1.1  jmcneill  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     22  1.1  jmcneill  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     23  1.1  jmcneill  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     24  1.1  jmcneill  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     25  1.1  jmcneill  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     26  1.1  jmcneill  * POSSIBILITY OF SUCH DAMAGE.
     27  1.1  jmcneill  */
     28  1.1  jmcneill 
     29  1.1  jmcneill #define AXP_DEBUG
     30  1.1  jmcneill 
     31  1.1  jmcneill #include <sys/cdefs.h>
     32  1.1  jmcneill __KERNEL_RCSID(0, "$NetBSD: axp809.c,v 1.1 2014/12/07 00:33:26 jmcneill Exp $");
     33  1.1  jmcneill 
     34  1.1  jmcneill #include <sys/param.h>
     35  1.1  jmcneill #include <sys/systm.h>
     36  1.1  jmcneill #include <sys/kernel.h>
     37  1.1  jmcneill #include <sys/device.h>
     38  1.1  jmcneill #include <sys/conf.h>
     39  1.1  jmcneill #include <sys/bus.h>
     40  1.1  jmcneill #include <sys/kmem.h>
     41  1.1  jmcneill 
     42  1.1  jmcneill #include <dev/i2c/i2cvar.h>
     43  1.1  jmcneill #include <dev/i2c/axp809.h>
     44  1.1  jmcneill 
     45  1.1  jmcneill #define AXP_GPIO1_CTRL_REG	0x92
     46  1.1  jmcneill #define AXP_GPIO1LDO_CTRL_REG	0x93
     47  1.1  jmcneill 
     48  1.1  jmcneill struct axp809_ctrl {
     49  1.1  jmcneill 	device_t	c_dev;
     50  1.1  jmcneill 
     51  1.1  jmcneill 	const char *	c_name;
     52  1.1  jmcneill 	u_int		c_min;
     53  1.1  jmcneill 	u_int		c_max;
     54  1.1  jmcneill 	u_int		c_step1;
     55  1.1  jmcneill 	u_int		c_step1cnt;
     56  1.1  jmcneill 	u_int		c_step2;
     57  1.1  jmcneill 	u_int		c_step2cnt;
     58  1.1  jmcneill 
     59  1.1  jmcneill 	uint8_t		c_enable_reg;
     60  1.1  jmcneill 	uint8_t		c_enable_mask;
     61  1.1  jmcneill 
     62  1.1  jmcneill 	uint8_t		c_voltage_reg;
     63  1.1  jmcneill 	uint8_t		c_voltage_mask;
     64  1.1  jmcneill };
     65  1.1  jmcneill 
     66  1.1  jmcneill #define AXP_CTRL(name, min, max, step, ereg, emask, vreg, vmask)	\
     67  1.1  jmcneill 	{ .c_name = (name), .c_min = (min), .c_max = (max),		\
     68  1.1  jmcneill 	  .c_step1 = (step), .c_step1cnt = (((max) - (min)) / (step)) + 1, \
     69  1.1  jmcneill 	  .c_step2 = 0, .c_step2cnt = 0,				\
     70  1.1  jmcneill 	  .c_enable_reg = AXP_##ereg##_REG, .c_enable_mask = (emask),	\
     71  1.1  jmcneill 	  .c_voltage_reg = AXP_##vreg##_REG, .c_voltage_mask = (vmask) }
     72  1.1  jmcneill 
     73  1.1  jmcneill #define AXP_CTRL2(name, min, max, step1, step1cnt, step2, step2cnt, ereg, emask, vreg, vmask) \
     74  1.1  jmcneill 	{ .c_name = (name), .c_min = (min), .c_max = (max),		\
     75  1.1  jmcneill 	  .c_step1 = (step1), .c_step1cnt = (step1cnt),			\
     76  1.1  jmcneill 	  .c_step2 = (step2), .c_step2cnt = (step2cnt),			\
     77  1.1  jmcneill 	  .c_enable_reg = AXP_##ereg##_REG, .c_enable_mask = (emask),	\
     78  1.1  jmcneill 	  .c_voltage_reg = AXP_##vreg##_REG, .c_voltage_mask = (vmask) }
     79  1.1  jmcneill 
     80  1.1  jmcneill static const struct axp809_ctrl axp809_ctrls[] = {
     81  1.1  jmcneill 	AXP_CTRL("GPIO1", 700, 3300, 100,
     82  1.1  jmcneill 		GPIO1_CTRL, __BIT(0), GPIO1LDO_CTRL, __BITS(4,0)),
     83  1.1  jmcneill };
     84  1.1  jmcneill 
     85  1.1  jmcneill struct axp809_softc {
     86  1.1  jmcneill 	device_t	sc_dev;
     87  1.1  jmcneill 	i2c_tag_t	sc_i2c;
     88  1.1  jmcneill 	i2c_addr_t	sc_addr;
     89  1.1  jmcneill 
     90  1.1  jmcneill 	u_int		sc_nctrl;
     91  1.1  jmcneill 	struct axp809_ctrl *sc_ctrl;
     92  1.1  jmcneill };
     93  1.1  jmcneill 
     94  1.1  jmcneill static int	axp809_match(device_t, cfdata_t, void *);
     95  1.1  jmcneill static void	axp809_attach(device_t, device_t, void *);
     96  1.1  jmcneill 
     97  1.1  jmcneill static int	axp809_read(struct axp809_softc *, uint8_t, uint8_t *);
     98  1.1  jmcneill static int	axp809_write(struct axp809_softc *, uint8_t, uint8_t);
     99  1.1  jmcneill 
    100  1.1  jmcneill static void	axp809_print(struct axp809_ctrl *c);
    101  1.1  jmcneill 
    102  1.1  jmcneill CFATTACH_DECL_NEW(axp809pm, sizeof(struct axp809_softc),
    103  1.1  jmcneill     axp809_match, axp809_attach, NULL, NULL);
    104  1.1  jmcneill 
    105  1.1  jmcneill static int
    106  1.1  jmcneill axp809_match(device_t parent, cfdata_t match, void *aux)
    107  1.1  jmcneill {
    108  1.1  jmcneill 	return 1;
    109  1.1  jmcneill }
    110  1.1  jmcneill 
    111  1.1  jmcneill static void
    112  1.1  jmcneill axp809_attach(device_t parent, device_t self, void *aux)
    113  1.1  jmcneill {
    114  1.1  jmcneill 	struct axp809_softc *sc = device_private(self);
    115  1.1  jmcneill 	struct i2c_attach_args *ia = aux;
    116  1.1  jmcneill 	u_int n;
    117  1.1  jmcneill 
    118  1.1  jmcneill 	sc->sc_dev = self;
    119  1.1  jmcneill 	sc->sc_i2c = ia->ia_tag;
    120  1.1  jmcneill 	sc->sc_addr = ia->ia_addr;
    121  1.1  jmcneill 
    122  1.1  jmcneill 	aprint_naive("\n");
    123  1.1  jmcneill 	aprint_normal("\n");
    124  1.1  jmcneill 
    125  1.1  jmcneill 	sc->sc_nctrl = __arraycount(axp809_ctrls);
    126  1.1  jmcneill 	sc->sc_ctrl = kmem_alloc(sizeof(axp809_ctrls), KM_SLEEP);
    127  1.1  jmcneill 	memcpy(sc->sc_ctrl, axp809_ctrls, sizeof(axp809_ctrls));
    128  1.1  jmcneill 	for (n = 0; n < sc->sc_nctrl; n++) {
    129  1.1  jmcneill 		sc->sc_ctrl[n].c_dev = self;
    130  1.1  jmcneill 	}
    131  1.1  jmcneill 
    132  1.1  jmcneill #ifdef AXP_DEBUG
    133  1.1  jmcneill 	for (n = 0; n < sc->sc_nctrl; n++) {
    134  1.1  jmcneill 		axp809_print(&sc->sc_ctrl[n]);
    135  1.1  jmcneill 	}
    136  1.1  jmcneill #endif
    137  1.1  jmcneill }
    138  1.1  jmcneill 
    139  1.1  jmcneill static int
    140  1.1  jmcneill axp809_read(struct axp809_softc *sc, uint8_t reg, uint8_t *val)
    141  1.1  jmcneill {
    142  1.1  jmcneill 	return iic_smbus_read_byte(sc->sc_i2c, sc->sc_addr, reg, val,
    143  1.1  jmcneill 	    cold ? I2C_F_POLL : 0);
    144  1.1  jmcneill }
    145  1.1  jmcneill 
    146  1.1  jmcneill static int
    147  1.1  jmcneill axp809_write(struct axp809_softc *sc, uint8_t reg, uint8_t val)
    148  1.1  jmcneill {
    149  1.1  jmcneill 	return iic_smbus_write_byte(sc->sc_i2c, sc->sc_addr, reg, val,
    150  1.1  jmcneill 	    cold ? I2C_F_POLL : 0);
    151  1.1  jmcneill }
    152  1.1  jmcneill 
    153  1.1  jmcneill static void
    154  1.1  jmcneill axp809_print(struct axp809_ctrl *c)
    155  1.1  jmcneill {
    156  1.1  jmcneill 	struct axp809_softc *sc = device_private(c->c_dev);
    157  1.1  jmcneill 	u_int voltage;
    158  1.1  jmcneill 	bool enabled;
    159  1.1  jmcneill 
    160  1.1  jmcneill 	device_printf(sc->sc_dev, "%s:", c->c_name);
    161  1.1  jmcneill 	if (c->c_voltage_reg) {
    162  1.1  jmcneill 		if (axp809_get_voltage(c, &voltage)) {
    163  1.1  jmcneill 			printf(" [??? V]");
    164  1.1  jmcneill 		} else {
    165  1.1  jmcneill 			printf(" [%d.%03dV]", voltage / 1000,
    166  1.1  jmcneill 			    voltage % 1000);
    167  1.1  jmcneill 		}
    168  1.1  jmcneill 	}
    169  1.1  jmcneill 	if (c->c_enable_reg) {
    170  1.1  jmcneill 		if (axp809_is_enabled(c, &enabled)) {
    171  1.1  jmcneill 			printf(" [unknown state]");
    172  1.1  jmcneill 		} else {
    173  1.1  jmcneill 			printf(" [%s]", enabled ? "ON" : "OFF");
    174  1.1  jmcneill 		}
    175  1.1  jmcneill 	}
    176  1.1  jmcneill 	printf("\n");
    177  1.1  jmcneill }
    178  1.1  jmcneill 
    179  1.1  jmcneill struct axp809_ctrl *
    180  1.1  jmcneill axp809_lookup(device_t dev, const char *name)
    181  1.1  jmcneill {
    182  1.1  jmcneill 	struct axp809_softc *sc = device_private(dev);
    183  1.1  jmcneill 	struct axp809_ctrl *c;
    184  1.1  jmcneill 	u_int n;
    185  1.1  jmcneill 
    186  1.1  jmcneill 	for (n = 0; n < sc->sc_nctrl; n++) {
    187  1.1  jmcneill 		c = &sc->sc_ctrl[n];
    188  1.1  jmcneill 		if (strcmp(c->c_name, name) == 0) {
    189  1.1  jmcneill 			return c;
    190  1.1  jmcneill 		}
    191  1.1  jmcneill 	}
    192  1.1  jmcneill 
    193  1.1  jmcneill 	return NULL;
    194  1.1  jmcneill }
    195  1.1  jmcneill 
    196  1.1  jmcneill int
    197  1.1  jmcneill axp809_set_voltage(struct axp809_ctrl *c, u_int min, u_int max)
    198  1.1  jmcneill {
    199  1.1  jmcneill 	struct axp809_softc *sc = device_private(c->c_dev);
    200  1.1  jmcneill 	u_int vol, reg_val;
    201  1.1  jmcneill 	int nstep, error;
    202  1.1  jmcneill 	uint8_t val;
    203  1.1  jmcneill 
    204  1.1  jmcneill 	if (!c->c_voltage_mask)
    205  1.1  jmcneill 		return EINVAL;
    206  1.1  jmcneill 
    207  1.1  jmcneill 	if (min < c->c_min || min > c->c_max)
    208  1.1  jmcneill 		return EINVAL;
    209  1.1  jmcneill 
    210  1.1  jmcneill 	reg_val = 0;
    211  1.1  jmcneill 	nstep = 1;
    212  1.1  jmcneill 	vol = c->c_min;
    213  1.1  jmcneill 
    214  1.1  jmcneill 	for (nstep = 0; nstep < c->c_step1cnt && vol < min; nstep++) {
    215  1.1  jmcneill 		++reg_val;
    216  1.1  jmcneill 		vol += c->c_step1;
    217  1.1  jmcneill 	}
    218  1.1  jmcneill 	for (nstep = 0; nstep < c->c_step2cnt && vol < min; nstep++) {
    219  1.1  jmcneill 		++reg_val;
    220  1.1  jmcneill 		vol += c->c_step2;
    221  1.1  jmcneill 	}
    222  1.1  jmcneill 
    223  1.1  jmcneill 	if (vol > max)
    224  1.1  jmcneill 		return EINVAL;
    225  1.1  jmcneill 
    226  1.1  jmcneill 	iic_acquire_bus(sc->sc_i2c, 0);
    227  1.1  jmcneill 	if ((error = axp809_read(sc, c->c_voltage_reg, &val)) != 0)
    228  1.1  jmcneill 		goto done;
    229  1.1  jmcneill 	val &= ~c->c_voltage_mask;
    230  1.1  jmcneill 	val |= __SHIFTIN(reg_val, c->c_voltage_mask);
    231  1.1  jmcneill 	error = axp809_write(sc, c->c_voltage_reg, val);
    232  1.1  jmcneill done:
    233  1.1  jmcneill 	iic_release_bus(sc->sc_i2c, 0);
    234  1.1  jmcneill #ifdef AXP_DEBUG
    235  1.1  jmcneill 	if (error == 0)
    236  1.1  jmcneill 		axp809_print(c);
    237  1.1  jmcneill #endif
    238  1.1  jmcneill 
    239  1.1  jmcneill 	return error;
    240  1.1  jmcneill }
    241  1.1  jmcneill 
    242  1.1  jmcneill int
    243  1.1  jmcneill axp809_get_voltage(struct axp809_ctrl *c, u_int *pvol)
    244  1.1  jmcneill {
    245  1.1  jmcneill 	struct axp809_softc *sc = device_private(c->c_dev);
    246  1.1  jmcneill 	int reg_val, error;
    247  1.1  jmcneill 	uint8_t val;
    248  1.1  jmcneill 
    249  1.1  jmcneill 	if (!c->c_voltage_mask)
    250  1.1  jmcneill 		return EINVAL;
    251  1.1  jmcneill 
    252  1.1  jmcneill 	iic_acquire_bus(sc->sc_i2c, 0);
    253  1.1  jmcneill 	error = axp809_read(sc, c->c_voltage_reg, &val);
    254  1.1  jmcneill 	iic_release_bus(sc->sc_i2c, 0);
    255  1.1  jmcneill 	if (error)
    256  1.1  jmcneill 		return error;
    257  1.1  jmcneill 
    258  1.1  jmcneill 	reg_val = __SHIFTOUT(val, c->c_voltage_mask);
    259  1.1  jmcneill 	if (reg_val < c->c_step1cnt) {
    260  1.1  jmcneill 		*pvol = c->c_min + reg_val * c->c_step1;
    261  1.1  jmcneill 	} else {
    262  1.1  jmcneill 		*pvol = c->c_min + (c->c_step1cnt * c->c_step1) +
    263  1.1  jmcneill 		    ((reg_val - c->c_step1cnt) * c->c_step2);
    264  1.1  jmcneill 	}
    265  1.1  jmcneill 
    266  1.1  jmcneill 	return 0;
    267  1.1  jmcneill }
    268  1.1  jmcneill 
    269  1.1  jmcneill int
    270  1.1  jmcneill axp809_is_enabled(struct axp809_ctrl *c, bool *penabled)
    271  1.1  jmcneill {
    272  1.1  jmcneill 	struct axp809_softc *sc = device_private(c->c_dev);
    273  1.1  jmcneill 	uint8_t val;
    274  1.1  jmcneill 	int error;
    275  1.1  jmcneill 
    276  1.1  jmcneill 	if (!c->c_enable_mask)
    277  1.1  jmcneill 		return EINVAL;
    278  1.1  jmcneill 
    279  1.1  jmcneill 	iic_acquire_bus(sc->sc_i2c, 0);
    280  1.1  jmcneill 	error = axp809_read(sc, c->c_enable_reg, &val);
    281  1.1  jmcneill 	iic_release_bus(sc->sc_i2c, 0);
    282  1.1  jmcneill 	if (error)
    283  1.1  jmcneill 		return error;
    284  1.1  jmcneill 
    285  1.1  jmcneill 	*penabled = !!(val & c->c_enable_mask);
    286  1.1  jmcneill 	return 0;
    287  1.1  jmcneill }
    288  1.1  jmcneill 
    289  1.1  jmcneill int
    290  1.1  jmcneill axp809_enable(struct axp809_ctrl *c)
    291  1.1  jmcneill {
    292  1.1  jmcneill 	struct axp809_softc *sc = device_private(c->c_dev);
    293  1.1  jmcneill 	uint8_t val;
    294  1.1  jmcneill 	int error;
    295  1.1  jmcneill 
    296  1.1  jmcneill 	if (!c->c_enable_mask)
    297  1.1  jmcneill 		return EINVAL;
    298  1.1  jmcneill 
    299  1.1  jmcneill 	iic_acquire_bus(sc->sc_i2c, 0);
    300  1.1  jmcneill 	if ((error = axp809_read(sc, c->c_enable_reg, &val)) != 0)
    301  1.1  jmcneill 		goto done;
    302  1.1  jmcneill 	val |= c->c_enable_mask;
    303  1.1  jmcneill 	error = axp809_write(sc, c->c_enable_reg, val);
    304  1.1  jmcneill done:
    305  1.1  jmcneill 	iic_release_bus(sc->sc_i2c, 0);
    306  1.1  jmcneill #ifdef AXP_DEBUG
    307  1.1  jmcneill 	if (error == 0)
    308  1.1  jmcneill 		axp809_print(c);
    309  1.1  jmcneill #endif
    310  1.1  jmcneill 
    311  1.1  jmcneill 	return error;
    312  1.1  jmcneill }
    313  1.1  jmcneill 
    314  1.1  jmcneill int
    315  1.1  jmcneill axp809_disable(struct axp809_ctrl *c)
    316  1.1  jmcneill {
    317  1.1  jmcneill 	struct axp809_softc *sc = device_private(c->c_dev);
    318  1.1  jmcneill 	uint8_t val;
    319  1.1  jmcneill 	int error;
    320  1.1  jmcneill 
    321  1.1  jmcneill 	if (!c->c_enable_mask)
    322  1.1  jmcneill 		return EINVAL;
    323  1.1  jmcneill 
    324  1.1  jmcneill 	iic_acquire_bus(sc->sc_i2c, 0);
    325  1.1  jmcneill 	if ((error = axp809_read(sc, c->c_enable_reg, &val)) != 0)
    326  1.1  jmcneill 		goto done;
    327  1.1  jmcneill 	val &= ~c->c_enable_mask;
    328  1.1  jmcneill 	error = axp809_write(sc, c->c_enable_reg, val);
    329  1.1  jmcneill done:
    330  1.1  jmcneill 	iic_release_bus(sc->sc_i2c, 0);
    331  1.1  jmcneill #ifdef AXP_DEBUG
    332  1.1  jmcneill 	if (error == 0)
    333  1.1  jmcneill 		axp809_print(c);
    334  1.1  jmcneill #endif
    335  1.1  jmcneill 
    336  1.1  jmcneill 	return error;
    337  1.1  jmcneill }
    338