twl4030.c revision 1.3.2.2
1 1.3.2.2 martin /* $NetBSD: twl4030.c,v 1.3.2.2 2019/11/27 13:46:45 martin Exp $ */ 2 1.3.2.2 martin 3 1.3.2.2 martin /*- 4 1.3.2.2 martin * Copyright (c) 2019 Jared McNeill <jmcneill (at) invisible.ca> 5 1.3.2.2 martin * All rights reserved. 6 1.3.2.2 martin * 7 1.3.2.2 martin * Redistribution and use in source and binary forms, with or without 8 1.3.2.2 martin * modification, are permitted provided that the following conditions 9 1.3.2.2 martin * are met: 10 1.3.2.2 martin * 1. Redistributions of source code must retain the above copyright 11 1.3.2.2 martin * notice, this list of conditions and the following disclaimer. 12 1.3.2.2 martin * 2. Redistributions in binary form must reproduce the above copyright 13 1.3.2.2 martin * notice, this list of conditions and the following disclaimer in the 14 1.3.2.2 martin * documentation and/or other materials provided with the distribution. 15 1.3.2.2 martin * 16 1.3.2.2 martin * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 17 1.3.2.2 martin * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 18 1.3.2.2 martin * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 19 1.3.2.2 martin * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 20 1.3.2.2 martin * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 21 1.3.2.2 martin * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 22 1.3.2.2 martin * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 23 1.3.2.2 martin * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 24 1.3.2.2 martin * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 25 1.3.2.2 martin * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 26 1.3.2.2 martin * POSSIBILITY OF SUCH DAMAGE. 27 1.3.2.2 martin */ 28 1.3.2.2 martin 29 1.3.2.2 martin #include "opt_fdt.h" 30 1.3.2.2 martin 31 1.3.2.2 martin #include <sys/cdefs.h> 32 1.3.2.2 martin __KERNEL_RCSID(0, "$NetBSD: twl4030.c,v 1.3.2.2 2019/11/27 13:46:45 martin Exp $"); 33 1.3.2.2 martin 34 1.3.2.2 martin #include <sys/param.h> 35 1.3.2.2 martin #include <sys/systm.h> 36 1.3.2.2 martin #include <sys/kernel.h> 37 1.3.2.2 martin #include <sys/device.h> 38 1.3.2.2 martin #include <sys/conf.h> 39 1.3.2.2 martin #include <sys/bus.h> 40 1.3.2.2 martin #include <sys/kmem.h> 41 1.3.2.2 martin #include <sys/gpio.h> 42 1.3.2.2 martin 43 1.3.2.2 martin #include <dev/i2c/i2cvar.h> 44 1.3.2.2 martin 45 1.3.2.2 martin #include <dev/fdt/fdtvar.h> 46 1.3.2.2 martin 47 1.3.2.2 martin #define TWL_PIN_COUNT 16 48 1.3.2.2 martin 49 1.3.2.2 martin /* TWL4030 is a multi-function IC. Each module is at a separate I2C address */ 50 1.3.2.2 martin #define ADDR_USB 0x00 51 1.3.2.2 martin #define ADDR_INT 0x01 52 1.3.2.2 martin #define ADDR_AUX 0x02 53 1.3.2.2 martin #define ADDR_POWER 0x03 54 1.3.2.2 martin 55 1.3.2.2 martin /* INTBR registers */ 56 1.3.2.2 martin #define IDCODE_7_0 0x85 57 1.3.2.2 martin #define IDCODE_15_8 0x86 58 1.3.2.2 martin #define IDCODE_23_16 0x87 59 1.3.2.2 martin #define IDCODE_31_24 0x88 60 1.3.2.2 martin 61 1.3.2.2 martin /* GPIO registers */ 62 1.3.2.2 martin #define GPIOBASE 0x98 63 1.3.2.2 martin #define GPIODATAIN(pin) (GPIOBASE + 0x00 + (pin) / 8) 64 1.3.2.2 martin #define GPIODATADIR(pin) (GPIOBASE + 0x03 + (pin) / 8) 65 1.3.2.2 martin #define CLEARGPIODATAOUT(pin) (GPIOBASE + 0x09 + (pin) / 8) 66 1.3.2.2 martin #define SETGPIODATAOUT(pin) (GPIOBASE + 0x0c + (pin) / 8) 67 1.3.2.2 martin #define PIN_BIT(pin) __BIT((pin) % 8) 68 1.3.2.2 martin #define GPIOPUPDCTR(pin) (GPIOBASE + 0x13 + (n) / 4) 69 1.3.2.2 martin #define PUPD_BITS(pin) __BITS((pin) % 4 + 1, (pin) % 4) 70 1.3.2.2 martin 71 1.3.2.2 martin /* POWER registers */ 72 1.3.2.2 martin #define SECONDS_REG 0x1c 73 1.3.2.2 martin #define MINUTES_REG 0x1d 74 1.3.2.2 martin #define HOURS_REG 0x1e 75 1.3.2.2 martin #define DAYS_REG 0x1f 76 1.3.2.2 martin #define MONTHS_REG 0x20 77 1.3.2.2 martin #define YEARS_REG 0x21 78 1.3.2.2 martin #define WEEKS_REG 0x22 79 1.3.2.2 martin #define RTC_CTRL_REG 0x29 80 1.3.2.2 martin #define GET_TIME __BIT(6) 81 1.3.2.2 martin #define STOP_RTC __BIT(0) 82 1.3.2.2 martin 83 1.3.2.2 martin struct twl_softc { 84 1.3.2.2 martin device_t sc_dev; 85 1.3.2.2 martin i2c_tag_t sc_i2c; 86 1.3.2.2 martin i2c_addr_t sc_addr; 87 1.3.2.2 martin int sc_phandle; 88 1.3.2.2 martin 89 1.3.2.2 martin int sc_npins; 90 1.3.2.2 martin 91 1.3.2.2 martin struct todr_chip_handle sc_todr; 92 1.3.2.2 martin }; 93 1.3.2.2 martin 94 1.3.2.2 martin struct twl_pin { 95 1.3.2.2 martin struct twl_softc *pin_sc; 96 1.3.2.2 martin int pin_num; 97 1.3.2.2 martin int pin_flags; 98 1.3.2.2 martin bool pin_actlo; 99 1.3.2.2 martin }; 100 1.3.2.2 martin 101 1.3.2.2 martin static const struct device_compatible_entry compat_data[] = { 102 1.3.2.2 martin { "ti,twl4030", 0 }, 103 1.3.2.2 martin { NULL, 0 } 104 1.3.2.2 martin }; 105 1.3.2.2 martin 106 1.3.2.2 martin #ifdef FDT 107 1.3.2.2 martin static const char * const rtc_compatible[] = { "ti,twl4030-rtc", NULL }; 108 1.3.2.2 martin static const char * const gpio_compatible[] = { "ti,twl4030-gpio", NULL }; 109 1.3.2.2 martin #endif 110 1.3.2.2 martin 111 1.3.2.2 martin static uint8_t 112 1.3.2.2 martin twl_read(struct twl_softc *sc, uint8_t mod, uint8_t reg, int flags) 113 1.3.2.2 martin { 114 1.3.2.2 martin uint8_t val = 0; 115 1.3.2.2 martin int error; 116 1.3.2.2 martin 117 1.3.2.2 martin error = iic_exec(sc->sc_i2c, I2C_OP_READ_WITH_STOP, sc->sc_addr + mod, 118 1.3.2.2 martin ®, 1, &val, 1, flags); 119 1.3.2.2 martin if (error != 0) 120 1.3.2.2 martin aprint_error_dev(sc->sc_dev, "error reading reg %#x: %d\n", reg, error); 121 1.3.2.2 martin 122 1.3.2.2 martin return val; 123 1.3.2.2 martin } 124 1.3.2.2 martin 125 1.3.2.2 martin static void 126 1.3.2.2 martin twl_write(struct twl_softc *sc, uint8_t mod, uint8_t reg, uint8_t val, int flags) 127 1.3.2.2 martin { 128 1.3.2.2 martin uint8_t buf[2]; 129 1.3.2.2 martin int error; 130 1.3.2.2 martin 131 1.3.2.2 martin buf[0] = reg; 132 1.3.2.2 martin buf[1] = val; 133 1.3.2.2 martin 134 1.3.2.2 martin error = iic_exec(sc->sc_i2c, I2C_OP_WRITE_WITH_STOP, sc->sc_addr + mod, 135 1.3.2.2 martin NULL, 0, buf, 2, flags); 136 1.3.2.2 martin if (error != 0) 137 1.3.2.2 martin aprint_error_dev(sc->sc_dev, "error writing reg %#x: %d\n", reg, error); 138 1.3.2.2 martin } 139 1.3.2.2 martin 140 1.3.2.2 martin #define I2C_LOCK(sc) iic_acquire_bus((sc)->sc_i2c, I2C_F_POLL) 141 1.3.2.2 martin #define I2C_UNLOCK(sc) iic_release_bus((sc)->sc_i2c, I2C_F_POLL) 142 1.3.2.2 martin 143 1.3.2.2 martin #define INT_READ(sc, reg) twl_read((sc), ADDR_INT, (reg), I2C_F_POLL) 144 1.3.2.2 martin #define INT_WRITE(sc, reg, val) twl_write((sc), ADDR_INT, (reg), (val), I2C_F_POLL) 145 1.3.2.2 martin 146 1.3.2.2 martin #define POWER_READ(sc, reg) twl_read((sc), ADDR_POWER, (reg), I2C_F_POLL) 147 1.3.2.2 martin #define POWER_WRITE(sc, reg, val) twl_write((sc), ADDR_POWER, (reg), (val), I2C_F_POLL) 148 1.3.2.2 martin 149 1.3.2.2 martin static void 150 1.3.2.2 martin twl_rtc_enable(struct twl_softc *sc, bool onoff) 151 1.3.2.2 martin { 152 1.3.2.2 martin uint8_t rtc_ctrl; 153 1.3.2.2 martin 154 1.3.2.2 martin rtc_ctrl = POWER_READ(sc, RTC_CTRL_REG); 155 1.3.2.2 martin if (onoff) 156 1.3.2.2 martin rtc_ctrl |= STOP_RTC; /* 1: RTC is running */ 157 1.3.2.2 martin else 158 1.3.2.2 martin rtc_ctrl &= ~STOP_RTC; /* 0: RTC is frozen */ 159 1.3.2.2 martin POWER_WRITE(sc, RTC_CTRL_REG, rtc_ctrl); 160 1.3.2.2 martin } 161 1.3.2.2 martin 162 1.3.2.2 martin static int 163 1.3.2.2 martin twl_rtc_gettime(todr_chip_handle_t tch, struct clock_ymdhms *dt) 164 1.3.2.2 martin { 165 1.3.2.2 martin struct twl_softc *sc = tch->cookie; 166 1.3.2.2 martin uint8_t seconds_reg, minutes_reg, hours_reg, 167 1.3.2.2 martin days_reg, months_reg, years_reg, weeks_reg; 168 1.3.2.2 martin 169 1.3.2.2 martin iic_acquire_bus(sc->sc_i2c, I2C_F_POLL); 170 1.3.2.2 martin seconds_reg = POWER_READ(sc, SECONDS_REG); 171 1.3.2.2 martin minutes_reg = POWER_READ(sc, MINUTES_REG); 172 1.3.2.2 martin hours_reg = POWER_READ(sc, HOURS_REG); 173 1.3.2.2 martin days_reg = POWER_READ(sc, DAYS_REG); 174 1.3.2.2 martin months_reg = POWER_READ(sc, MONTHS_REG); 175 1.3.2.2 martin years_reg = POWER_READ(sc, YEARS_REG); 176 1.3.2.2 martin weeks_reg = POWER_READ(sc, WEEKS_REG); 177 1.3.2.2 martin iic_release_bus(sc->sc_i2c, I2C_F_POLL); 178 1.3.2.2 martin 179 1.3.2.2 martin dt->dt_sec = bcdtobin(seconds_reg); 180 1.3.2.2 martin dt->dt_min = bcdtobin(minutes_reg); 181 1.3.2.2 martin dt->dt_hour = bcdtobin(hours_reg); 182 1.3.2.2 martin dt->dt_day = bcdtobin(days_reg); 183 1.3.2.2 martin dt->dt_mon = bcdtobin(months_reg); 184 1.3.2.2 martin dt->dt_year = bcdtobin(years_reg) + 2000; 185 1.3.2.2 martin dt->dt_wday = bcdtobin(weeks_reg); 186 1.3.2.2 martin 187 1.3.2.2 martin return 0; 188 1.3.2.2 martin } 189 1.3.2.2 martin 190 1.3.2.2 martin static int 191 1.3.2.2 martin twl_rtc_settime(todr_chip_handle_t tch, struct clock_ymdhms *dt) 192 1.3.2.2 martin { 193 1.3.2.2 martin struct twl_softc *sc = tch->cookie; 194 1.3.2.2 martin 195 1.3.2.2 martin iic_acquire_bus(sc->sc_i2c, I2C_F_POLL); 196 1.3.2.2 martin twl_rtc_enable(sc, false); 197 1.3.2.2 martin POWER_WRITE(sc, SECONDS_REG, bintobcd(dt->dt_sec)); 198 1.3.2.2 martin POWER_WRITE(sc, MINUTES_REG, bintobcd(dt->dt_min)); 199 1.3.2.2 martin POWER_WRITE(sc, HOURS_REG, bintobcd(dt->dt_hour)); 200 1.3.2.2 martin POWER_WRITE(sc, DAYS_REG, bintobcd(dt->dt_day)); 201 1.3.2.2 martin POWER_WRITE(sc, MONTHS_REG, bintobcd(dt->dt_mon)); 202 1.3.2.2 martin POWER_WRITE(sc, YEARS_REG, bintobcd(dt->dt_year % 100)); 203 1.3.2.2 martin POWER_WRITE(sc, WEEKS_REG, bintobcd(dt->dt_wday)); 204 1.3.2.2 martin twl_rtc_enable(sc, true); 205 1.3.2.2 martin iic_release_bus(sc->sc_i2c, I2C_F_POLL); 206 1.3.2.2 martin 207 1.3.2.2 martin return 0; 208 1.3.2.2 martin } 209 1.3.2.2 martin 210 1.3.2.2 martin #ifdef FDT 211 1.3.2.2 martin static int 212 1.3.2.2 martin twl_gpio_config(struct twl_softc *sc, int pin, int flags) 213 1.3.2.2 martin { 214 1.3.2.2 martin uint8_t dir; 215 1.3.2.2 martin 216 1.3.2.2 martin KASSERT(pin >= 0 && pin < sc->sc_npins); 217 1.3.2.2 martin 218 1.3.2.2 martin dir = INT_READ(sc, GPIODATADIR(pin)); 219 1.3.2.2 martin 220 1.3.2.2 martin switch (flags & (GPIO_PIN_INPUT|GPIO_PIN_OUTPUT)) { 221 1.3.2.2 martin case GPIO_PIN_INPUT: 222 1.3.2.2 martin dir &= ~PIN_BIT(pin); 223 1.3.2.2 martin break; 224 1.3.2.2 martin case GPIO_PIN_OUTPUT: 225 1.3.2.2 martin dir |= PIN_BIT(pin); 226 1.3.2.2 martin break; 227 1.3.2.2 martin default: 228 1.3.2.2 martin return EINVAL; 229 1.3.2.2 martin } 230 1.3.2.2 martin 231 1.3.2.2 martin INT_WRITE(sc, GPIODATADIR(pin), dir); 232 1.3.2.2 martin 233 1.3.2.2 martin return 0; 234 1.3.2.2 martin } 235 1.3.2.2 martin 236 1.3.2.2 martin static void * 237 1.3.2.2 martin twl_gpio_acquire(device_t dev, const void *data, size_t len, int flags) 238 1.3.2.2 martin { 239 1.3.2.2 martin struct twl_softc * const sc = device_private(dev); 240 1.3.2.2 martin struct twl_pin *gpin; 241 1.3.2.2 martin const u_int *gpio = data; 242 1.3.2.2 martin int error; 243 1.3.2.2 martin 244 1.3.2.2 martin if (len != 12) 245 1.3.2.2 martin return NULL; 246 1.3.2.2 martin 247 1.3.2.2 martin const uint8_t pin = be32toh(gpio[1]) & 0xff; 248 1.3.2.2 martin const bool actlo = (be32toh(gpio[2]) & __BIT(0)) != 0; 249 1.3.2.2 martin 250 1.3.2.2 martin if (pin >= sc->sc_npins) 251 1.3.2.2 martin return NULL; 252 1.3.2.2 martin 253 1.3.2.2 martin I2C_LOCK(sc); 254 1.3.2.2 martin error = twl_gpio_config(sc, pin, flags); 255 1.3.2.2 martin I2C_UNLOCK(sc); 256 1.3.2.2 martin 257 1.3.2.2 martin if (error != 0) { 258 1.3.2.2 martin device_printf(dev, "bad pin %d config %#x\n", pin, flags); 259 1.3.2.2 martin return NULL; 260 1.3.2.2 martin } 261 1.3.2.2 martin 262 1.3.2.2 martin gpin = kmem_zalloc(sizeof(*gpin), KM_SLEEP); 263 1.3.2.2 martin gpin->pin_sc = sc; 264 1.3.2.2 martin gpin->pin_num = pin; 265 1.3.2.2 martin gpin->pin_flags = flags; 266 1.3.2.2 martin gpin->pin_actlo = actlo; 267 1.3.2.2 martin 268 1.3.2.2 martin return gpin; 269 1.3.2.2 martin } 270 1.3.2.2 martin 271 1.3.2.2 martin static void 272 1.3.2.2 martin twl_gpio_release(device_t dev, void *priv) 273 1.3.2.2 martin { 274 1.3.2.2 martin struct twl_softc * const sc = device_private(dev); 275 1.3.2.2 martin struct twl_pin *gpin = priv; 276 1.3.2.2 martin 277 1.3.2.2 martin I2C_LOCK(sc); 278 1.3.2.2 martin twl_gpio_config(sc, gpin->pin_num, GPIO_PIN_INPUT); 279 1.3.2.2 martin I2C_UNLOCK(sc); 280 1.3.2.2 martin 281 1.3.2.2 martin kmem_free(gpin, sizeof(*gpin)); 282 1.3.2.2 martin } 283 1.3.2.2 martin 284 1.3.2.2 martin static int 285 1.3.2.2 martin twl_gpio_read(device_t dev, void *priv, bool raw) 286 1.3.2.2 martin { 287 1.3.2.2 martin struct twl_softc * const sc = device_private(dev); 288 1.3.2.2 martin struct twl_pin *gpin = priv; 289 1.3.2.2 martin uint8_t gpio; 290 1.3.2.2 martin int val; 291 1.3.2.2 martin 292 1.3.2.2 martin I2C_LOCK(sc); 293 1.3.2.2 martin gpio = INT_READ(sc, GPIODATAIN(gpin->pin_num)); 294 1.3.2.2 martin I2C_UNLOCK(sc); 295 1.3.2.2 martin 296 1.3.2.2 martin val = __SHIFTOUT(gpio, PIN_BIT(gpin->pin_num)); 297 1.3.2.2 martin if (!raw && gpin->pin_actlo) 298 1.3.2.2 martin val = !val; 299 1.3.2.2 martin 300 1.3.2.2 martin return val; 301 1.3.2.2 martin } 302 1.3.2.2 martin 303 1.3.2.2 martin static void 304 1.3.2.2 martin twl_gpio_write(device_t dev, void *priv, int val, bool raw) 305 1.3.2.2 martin { 306 1.3.2.2 martin struct twl_softc * const sc = device_private(dev); 307 1.3.2.2 martin struct twl_pin *gpin = priv; 308 1.3.2.2 martin 309 1.3.2.2 martin if (!raw && gpin->pin_actlo) 310 1.3.2.2 martin val = !val; 311 1.3.2.2 martin 312 1.3.2.2 martin I2C_LOCK(sc); 313 1.3.2.2 martin if (val) 314 1.3.2.2 martin INT_WRITE(sc, SETGPIODATAOUT(gpin->pin_num), PIN_BIT(gpin->pin_num)); 315 1.3.2.2 martin else 316 1.3.2.2 martin INT_WRITE(sc, CLEARGPIODATAOUT(gpin->pin_num), PIN_BIT(gpin->pin_num)); 317 1.3.2.2 martin I2C_UNLOCK(sc); 318 1.3.2.2 martin } 319 1.3.2.2 martin 320 1.3.2.2 martin static struct fdtbus_gpio_controller_func twl_gpio_funcs = { 321 1.3.2.2 martin .acquire = twl_gpio_acquire, 322 1.3.2.2 martin .release = twl_gpio_release, 323 1.3.2.2 martin .read = twl_gpio_read, 324 1.3.2.2 martin .write = twl_gpio_write, 325 1.3.2.2 martin }; 326 1.3.2.2 martin #endif /* !FDT */ 327 1.3.2.2 martin 328 1.3.2.2 martin static void 329 1.3.2.2 martin twl_rtc_attach(struct twl_softc *sc, const int phandle) 330 1.3.2.2 martin { 331 1.3.2.2 martin iic_acquire_bus(sc->sc_i2c, I2C_F_POLL); 332 1.3.2.2 martin twl_rtc_enable(sc, true); 333 1.3.2.2 martin iic_release_bus(sc->sc_i2c, I2C_F_POLL); 334 1.3.2.2 martin 335 1.3.2.2 martin sc->sc_todr.todr_gettime_ymdhms = twl_rtc_gettime; 336 1.3.2.2 martin sc->sc_todr.todr_settime_ymdhms = twl_rtc_settime; 337 1.3.2.2 martin sc->sc_todr.cookie = sc; 338 1.3.2.2 martin #ifdef FDT 339 1.3.2.2 martin fdtbus_todr_attach(sc->sc_dev, phandle, &sc->sc_todr); 340 1.3.2.2 martin #else 341 1.3.2.2 martin todr_attach(&sc->sc_todr); 342 1.3.2.2 martin #endif 343 1.3.2.2 martin } 344 1.3.2.2 martin 345 1.3.2.2 martin static void 346 1.3.2.2 martin twl_gpio_attach(struct twl_softc *sc, const int phandle) 347 1.3.2.2 martin { 348 1.3.2.2 martin #ifdef FDT 349 1.3.2.2 martin fdtbus_register_gpio_controller(sc->sc_dev, phandle, &twl_gpio_funcs); 350 1.3.2.2 martin #endif 351 1.3.2.2 martin } 352 1.3.2.2 martin 353 1.3.2.2 martin static int 354 1.3.2.2 martin twl_match(device_t parent, cfdata_t match, void *aux) 355 1.3.2.2 martin { 356 1.3.2.2 martin struct i2c_attach_args *ia = aux; 357 1.3.2.2 martin int match_result; 358 1.3.2.2 martin 359 1.3.2.2 martin if (iic_use_direct_match(ia, match, compat_data, &match_result)) 360 1.3.2.2 martin return match_result; 361 1.3.2.2 martin 362 1.3.2.2 martin if (ia->ia_addr == 0x48) 363 1.3.2.2 martin return I2C_MATCH_ADDRESS_ONLY; 364 1.3.2.2 martin 365 1.3.2.2 martin return 0; 366 1.3.2.2 martin } 367 1.3.2.2 martin 368 1.3.2.2 martin static void 369 1.3.2.2 martin twl_attach(device_t parent, device_t self, void *aux) 370 1.3.2.2 martin { 371 1.3.2.2 martin struct twl_softc * const sc = device_private(self); 372 1.3.2.2 martin struct i2c_attach_args *ia = aux; 373 1.3.2.2 martin uint32_t idcode; 374 1.3.2.2 martin 375 1.3.2.2 martin sc->sc_dev = self; 376 1.3.2.2 martin sc->sc_i2c = ia->ia_tag; 377 1.3.2.2 martin sc->sc_addr = ia->ia_addr; 378 1.3.2.2 martin sc->sc_phandle = ia->ia_cookie; 379 1.3.2.2 martin sc->sc_npins = TWL_PIN_COUNT; 380 1.3.2.2 martin 381 1.3.2.2 martin aprint_naive("\n"); 382 1.3.2.2 martin aprint_normal(": TWL4030"); 383 1.3.2.2 martin 384 1.3.2.2 martin #ifdef FDT 385 1.3.2.2 martin for (int child = OF_child(sc->sc_phandle); child; child = OF_peer(child)) { 386 1.3.2.2 martin if (of_match_compatible(child, gpio_compatible)) { 387 1.3.2.2 martin aprint_normal(", GPIO"); 388 1.3.2.2 martin twl_gpio_attach(sc, child); 389 1.3.2.2 martin } else if (of_match_compatible(child, rtc_compatible)) { 390 1.3.2.2 martin aprint_normal(", RTC"); 391 1.3.2.2 martin twl_rtc_attach(sc, child); 392 1.3.2.2 martin } 393 1.3.2.2 martin } 394 1.3.2.2 martin #else 395 1.3.2.2 martin aprint_normal("\n"); 396 1.3.2.2 martin twl_gpio_attach(sc, -1); 397 1.3.2.2 martin twl_rtc_attach(sc, -1); 398 1.3.2.2 martin #endif 399 1.3.2.2 martin 400 1.3.2.2 martin I2C_LOCK(sc); 401 1.3.2.2 martin idcode = INT_READ(sc, IDCODE_7_0); 402 1.3.2.2 martin idcode |= (uint32_t)INT_READ(sc, IDCODE_15_8) << 8; 403 1.3.2.2 martin idcode |= (uint32_t)INT_READ(sc, IDCODE_23_16) << 16; 404 1.3.2.2 martin idcode |= (uint32_t)INT_READ(sc, IDCODE_31_24) << 24; 405 1.3.2.2 martin I2C_UNLOCK(sc); 406 1.3.2.2 martin 407 1.3.2.2 martin aprint_normal(", IDCODE 0x%08x\n", idcode); 408 1.3.2.2 martin } 409 1.3.2.2 martin 410 1.3.2.2 martin CFATTACH_DECL_NEW(twl, sizeof(struct twl_softc), 411 1.3.2.2 martin twl_match, twl_attach, NULL, NULL); 412
Indexes created Mon Oct 20 20:10:13 GMT 2025