/* $NetBSD: axp809.c,v 1.1 2014/12/07 00:33:26 jmcneill Exp $ */ /*- * Copyright (c) 2014 Jared D. McNeill * All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ #define AXP_DEBUG #include __KERNEL_RCSID(0, "$NetBSD: axp809.c,v 1.1 2014/12/07 00:33:26 jmcneill Exp $"); #include #include #include #include #include #include #include #include #include #define AXP_GPIO1_CTRL_REG 0x92 #define AXP_GPIO1LDO_CTRL_REG 0x93 struct axp809_ctrl { device_t c_dev; const char * c_name; u_int c_min; u_int c_max; u_int c_step1; u_int c_step1cnt; u_int c_step2; u_int c_step2cnt; uint8_t c_enable_reg; uint8_t c_enable_mask; uint8_t c_voltage_reg; uint8_t c_voltage_mask; }; #define AXP_CTRL(name, min, max, step, ereg, emask, vreg, vmask) \ { .c_name = (name), .c_min = (min), .c_max = (max), \ .c_step1 = (step), .c_step1cnt = (((max) - (min)) / (step)) + 1, \ .c_step2 = 0, .c_step2cnt = 0, \ .c_enable_reg = AXP_##ereg##_REG, .c_enable_mask = (emask), \ .c_voltage_reg = AXP_##vreg##_REG, .c_voltage_mask = (vmask) } #define AXP_CTRL2(name, min, max, step1, step1cnt, step2, step2cnt, ereg, emask, vreg, vmask) \ { .c_name = (name), .c_min = (min), .c_max = (max), \ .c_step1 = (step1), .c_step1cnt = (step1cnt), \ .c_step2 = (step2), .c_step2cnt = (step2cnt), \ .c_enable_reg = AXP_##ereg##_REG, .c_enable_mask = (emask), \ .c_voltage_reg = AXP_##vreg##_REG, .c_voltage_mask = (vmask) } static const struct axp809_ctrl axp809_ctrls[] = { AXP_CTRL("GPIO1", 700, 3300, 100, GPIO1_CTRL, __BIT(0), GPIO1LDO_CTRL, __BITS(4,0)), }; struct axp809_softc { device_t sc_dev; i2c_tag_t sc_i2c; i2c_addr_t sc_addr; u_int sc_nctrl; struct axp809_ctrl *sc_ctrl; }; static int axp809_match(device_t, cfdata_t, void *); static void axp809_attach(device_t, device_t, void *); static int axp809_read(struct axp809_softc *, uint8_t, uint8_t *); static int axp809_write(struct axp809_softc *, uint8_t, uint8_t); static void axp809_print(struct axp809_ctrl *c); CFATTACH_DECL_NEW(axp809pm, sizeof(struct axp809_softc), axp809_match, axp809_attach, NULL, NULL); static int axp809_match(device_t parent, cfdata_t match, void *aux) { return 1; } static void axp809_attach(device_t parent, device_t self, void *aux) { struct axp809_softc *sc = device_private(self); struct i2c_attach_args *ia = aux; u_int n; sc->sc_dev = self; sc->sc_i2c = ia->ia_tag; sc->sc_addr = ia->ia_addr; aprint_naive("\n"); aprint_normal("\n"); sc->sc_nctrl = __arraycount(axp809_ctrls); sc->sc_ctrl = kmem_alloc(sizeof(axp809_ctrls), KM_SLEEP); memcpy(sc->sc_ctrl, axp809_ctrls, sizeof(axp809_ctrls)); for (n = 0; n < sc->sc_nctrl; n++) { sc->sc_ctrl[n].c_dev = self; } #ifdef AXP_DEBUG for (n = 0; n < sc->sc_nctrl; n++) { axp809_print(&sc->sc_ctrl[n]); } #endif } static int axp809_read(struct axp809_softc *sc, uint8_t reg, uint8_t *val) { return iic_smbus_read_byte(sc->sc_i2c, sc->sc_addr, reg, val, cold ? I2C_F_POLL : 0); } static int axp809_write(struct axp809_softc *sc, uint8_t reg, uint8_t val) { return iic_smbus_write_byte(sc->sc_i2c, sc->sc_addr, reg, val, cold ? I2C_F_POLL : 0); } static void axp809_print(struct axp809_ctrl *c) { struct axp809_softc *sc = device_private(c->c_dev); u_int voltage; bool enabled; device_printf(sc->sc_dev, "%s:", c->c_name); if (c->c_voltage_reg) { if (axp809_get_voltage(c, &voltage)) { printf(" [??? V]"); } else { printf(" [%d.%03dV]", voltage / 1000, voltage % 1000); } } if (c->c_enable_reg) { if (axp809_is_enabled(c, &enabled)) { printf(" [unknown state]"); } else { printf(" [%s]", enabled ? "ON" : "OFF"); } } printf("\n"); } struct axp809_ctrl * axp809_lookup(device_t dev, const char *name) { struct axp809_softc *sc = device_private(dev); struct axp809_ctrl *c; u_int n; for (n = 0; n < sc->sc_nctrl; n++) { c = &sc->sc_ctrl[n]; if (strcmp(c->c_name, name) == 0) { return c; } } return NULL; } int axp809_set_voltage(struct axp809_ctrl *c, u_int min, u_int max) { struct axp809_softc *sc = device_private(c->c_dev); u_int vol, reg_val; int nstep, error; uint8_t val; if (!c->c_voltage_mask) return EINVAL; if (min < c->c_min || min > c->c_max) return EINVAL; reg_val = 0; nstep = 1; vol = c->c_min; for (nstep = 0; nstep < c->c_step1cnt && vol < min; nstep++) { ++reg_val; vol += c->c_step1; } for (nstep = 0; nstep < c->c_step2cnt && vol < min; nstep++) { ++reg_val; vol += c->c_step2; } if (vol > max) return EINVAL; iic_acquire_bus(sc->sc_i2c, 0); if ((error = axp809_read(sc, c->c_voltage_reg, &val)) != 0) goto done; val &= ~c->c_voltage_mask; val |= __SHIFTIN(reg_val, c->c_voltage_mask); error = axp809_write(sc, c->c_voltage_reg, val); done: iic_release_bus(sc->sc_i2c, 0); #ifdef AXP_DEBUG if (error == 0) axp809_print(c); #endif return error; } int axp809_get_voltage(struct axp809_ctrl *c, u_int *pvol) { struct axp809_softc *sc = device_private(c->c_dev); int reg_val, error; uint8_t val; if (!c->c_voltage_mask) return EINVAL; iic_acquire_bus(sc->sc_i2c, 0); error = axp809_read(sc, c->c_voltage_reg, &val); iic_release_bus(sc->sc_i2c, 0); if (error) return error; reg_val = __SHIFTOUT(val, c->c_voltage_mask); if (reg_val < c->c_step1cnt) { *pvol = c->c_min + reg_val * c->c_step1; } else { *pvol = c->c_min + (c->c_step1cnt * c->c_step1) + ((reg_val - c->c_step1cnt) * c->c_step2); } return 0; } int axp809_is_enabled(struct axp809_ctrl *c, bool *penabled) { struct axp809_softc *sc = device_private(c->c_dev); uint8_t val; int error; if (!c->c_enable_mask) return EINVAL; iic_acquire_bus(sc->sc_i2c, 0); error = axp809_read(sc, c->c_enable_reg, &val); iic_release_bus(sc->sc_i2c, 0); if (error) return error; *penabled = !!(val & c->c_enable_mask); return 0; } int axp809_enable(struct axp809_ctrl *c) { struct axp809_softc *sc = device_private(c->c_dev); uint8_t val; int error; if (!c->c_enable_mask) return EINVAL; iic_acquire_bus(sc->sc_i2c, 0); if ((error = axp809_read(sc, c->c_enable_reg, &val)) != 0) goto done; val |= c->c_enable_mask; error = axp809_write(sc, c->c_enable_reg, val); done: iic_release_bus(sc->sc_i2c, 0); #ifdef AXP_DEBUG if (error == 0) axp809_print(c); #endif return error; } int axp809_disable(struct axp809_ctrl *c) { struct axp809_softc *sc = device_private(c->c_dev); uint8_t val; int error; if (!c->c_enable_mask) return EINVAL; iic_acquire_bus(sc->sc_i2c, 0); if ((error = axp809_read(sc, c->c_enable_reg, &val)) != 0) goto done; val &= ~c->c_enable_mask; error = axp809_write(sc, c->c_enable_reg, val); done: iic_release_bus(sc->sc_i2c, 0); #ifdef AXP_DEBUG if (error == 0) axp809_print(c); #endif return error; }