1 1.9 thorpej /* $NetBSD: twl4030.c,v 1.9 2025/09/17 13:49:13 thorpej Exp $ */ 2 1.1 jmcneill 3 1.1 jmcneill /*- 4 1.1 jmcneill * Copyright (c) 2019 Jared 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.3 jmcneill #include "opt_fdt.h" 30 1.3 jmcneill 31 1.1 jmcneill #include <sys/cdefs.h> 32 1.9 thorpej __KERNEL_RCSID(0, "$NetBSD: twl4030.c,v 1.9 2025/09/17 13:49:13 thorpej 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 #include <sys/gpio.h> 42 1.1 jmcneill 43 1.1 jmcneill #include <dev/i2c/i2cvar.h> 44 1.1 jmcneill 45 1.1 jmcneill #include <dev/fdt/fdtvar.h> 46 1.1 jmcneill 47 1.1 jmcneill #define TWL_PIN_COUNT 16 48 1.1 jmcneill 49 1.1 jmcneill /* TWL4030 is a multi-function IC. Each module is at a separate I2C address */ 50 1.1 jmcneill #define ADDR_USB 0x00 51 1.1 jmcneill #define ADDR_INT 0x01 52 1.1 jmcneill #define ADDR_AUX 0x02 53 1.1 jmcneill #define ADDR_POWER 0x03 54 1.1 jmcneill 55 1.2 jmcneill /* INTBR registers */ 56 1.2 jmcneill #define IDCODE_7_0 0x85 57 1.2 jmcneill #define IDCODE_15_8 0x86 58 1.2 jmcneill #define IDCODE_23_16 0x87 59 1.2 jmcneill #define IDCODE_31_24 0x88 60 1.2 jmcneill 61 1.1 jmcneill /* GPIO registers */ 62 1.1 jmcneill #define GPIOBASE 0x98 63 1.1 jmcneill #define GPIODATAIN(pin) (GPIOBASE + 0x00 + (pin) / 8) 64 1.1 jmcneill #define GPIODATADIR(pin) (GPIOBASE + 0x03 + (pin) / 8) 65 1.1 jmcneill #define CLEARGPIODATAOUT(pin) (GPIOBASE + 0x09 + (pin) / 8) 66 1.1 jmcneill #define SETGPIODATAOUT(pin) (GPIOBASE + 0x0c + (pin) / 8) 67 1.1 jmcneill #define PIN_BIT(pin) __BIT((pin) % 8) 68 1.1 jmcneill #define GPIOPUPDCTR(pin) (GPIOBASE + 0x13 + (n) / 4) 69 1.1 jmcneill #define PUPD_BITS(pin) __BITS((pin) % 4 + 1, (pin) % 4) 70 1.1 jmcneill 71 1.2 jmcneill /* POWER registers */ 72 1.2 jmcneill #define SECONDS_REG 0x1c 73 1.2 jmcneill #define MINUTES_REG 0x1d 74 1.2 jmcneill #define HOURS_REG 0x1e 75 1.2 jmcneill #define DAYS_REG 0x1f 76 1.2 jmcneill #define MONTHS_REG 0x20 77 1.2 jmcneill #define YEARS_REG 0x21 78 1.2 jmcneill #define WEEKS_REG 0x22 79 1.2 jmcneill #define RTC_CTRL_REG 0x29 80 1.2 jmcneill #define GET_TIME __BIT(6) 81 1.2 jmcneill #define STOP_RTC __BIT(0) 82 1.2 jmcneill 83 1.1 jmcneill struct twl_softc { 84 1.1 jmcneill device_t sc_dev; 85 1.1 jmcneill i2c_tag_t sc_i2c; 86 1.1 jmcneill i2c_addr_t sc_addr; 87 1.1 jmcneill int sc_phandle; 88 1.1 jmcneill 89 1.1 jmcneill int sc_npins; 90 1.2 jmcneill 91 1.2 jmcneill struct todr_chip_handle sc_todr; 92 1.1 jmcneill }; 93 1.1 jmcneill 94 1.1 jmcneill struct twl_pin { 95 1.1 jmcneill struct twl_softc *pin_sc; 96 1.1 jmcneill int pin_num; 97 1.1 jmcneill int pin_flags; 98 1.1 jmcneill bool pin_actlo; 99 1.1 jmcneill }; 100 1.1 jmcneill 101 1.1 jmcneill static const struct device_compatible_entry compat_data[] = { 102 1.4 thorpej { .compat = "ti,twl4030" }, 103 1.5 thorpej DEVICE_COMPAT_EOL 104 1.5 thorpej }; 105 1.4 thorpej 106 1.5 thorpej #ifdef FDT 107 1.5 thorpej static const struct device_compatible_entry rtc_compat_data[] = { 108 1.5 thorpej { .compat = "ti,twl4030-rtc" }, 109 1.5 thorpej DEVICE_COMPAT_EOL 110 1.1 jmcneill }; 111 1.1 jmcneill 112 1.5 thorpej static const struct device_compatible_entry gpio_compat_data[] = { 113 1.5 thorpej { .compat = "ti,twl4030-gpio" }, 114 1.5 thorpej DEVICE_COMPAT_EOL 115 1.5 thorpej }; 116 1.3 jmcneill #endif 117 1.1 jmcneill 118 1.1 jmcneill static uint8_t 119 1.1 jmcneill twl_read(struct twl_softc *sc, uint8_t mod, uint8_t reg, int flags) 120 1.1 jmcneill { 121 1.1 jmcneill uint8_t val = 0; 122 1.1 jmcneill int error; 123 1.1 jmcneill 124 1.1 jmcneill error = iic_exec(sc->sc_i2c, I2C_OP_READ_WITH_STOP, sc->sc_addr + mod, 125 1.1 jmcneill ®, 1, &val, 1, flags); 126 1.1 jmcneill if (error != 0) 127 1.1 jmcneill aprint_error_dev(sc->sc_dev, "error reading reg %#x: %d\n", reg, error); 128 1.1 jmcneill 129 1.1 jmcneill return val; 130 1.1 jmcneill } 131 1.1 jmcneill 132 1.1 jmcneill static void 133 1.1 jmcneill twl_write(struct twl_softc *sc, uint8_t mod, uint8_t reg, uint8_t val, int flags) 134 1.1 jmcneill { 135 1.1 jmcneill uint8_t buf[2]; 136 1.1 jmcneill int error; 137 1.1 jmcneill 138 1.1 jmcneill buf[0] = reg; 139 1.1 jmcneill buf[1] = val; 140 1.1 jmcneill 141 1.1 jmcneill error = iic_exec(sc->sc_i2c, I2C_OP_WRITE_WITH_STOP, sc->sc_addr + mod, 142 1.1 jmcneill NULL, 0, buf, 2, flags); 143 1.1 jmcneill if (error != 0) 144 1.1 jmcneill aprint_error_dev(sc->sc_dev, "error writing reg %#x: %d\n", reg, error); 145 1.1 jmcneill } 146 1.1 jmcneill 147 1.1 jmcneill #define I2C_LOCK(sc) iic_acquire_bus((sc)->sc_i2c, I2C_F_POLL) 148 1.1 jmcneill #define I2C_UNLOCK(sc) iic_release_bus((sc)->sc_i2c, I2C_F_POLL) 149 1.1 jmcneill 150 1.1 jmcneill #define INT_READ(sc, reg) twl_read((sc), ADDR_INT, (reg), I2C_F_POLL) 151 1.1 jmcneill #define INT_WRITE(sc, reg, val) twl_write((sc), ADDR_INT, (reg), (val), I2C_F_POLL) 152 1.1 jmcneill 153 1.2 jmcneill #define POWER_READ(sc, reg) twl_read((sc), ADDR_POWER, (reg), I2C_F_POLL) 154 1.2 jmcneill #define POWER_WRITE(sc, reg, val) twl_write((sc), ADDR_POWER, (reg), (val), I2C_F_POLL) 155 1.2 jmcneill 156 1.2 jmcneill static void 157 1.2 jmcneill twl_rtc_enable(struct twl_softc *sc, bool onoff) 158 1.2 jmcneill { 159 1.2 jmcneill uint8_t rtc_ctrl; 160 1.2 jmcneill 161 1.2 jmcneill rtc_ctrl = POWER_READ(sc, RTC_CTRL_REG); 162 1.2 jmcneill if (onoff) 163 1.2 jmcneill rtc_ctrl |= STOP_RTC; /* 1: RTC is running */ 164 1.2 jmcneill else 165 1.2 jmcneill rtc_ctrl &= ~STOP_RTC; /* 0: RTC is frozen */ 166 1.2 jmcneill POWER_WRITE(sc, RTC_CTRL_REG, rtc_ctrl); 167 1.2 jmcneill } 168 1.2 jmcneill 169 1.2 jmcneill static int 170 1.2 jmcneill twl_rtc_gettime(todr_chip_handle_t tch, struct clock_ymdhms *dt) 171 1.2 jmcneill { 172 1.7 thorpej struct twl_softc *sc = device_private(tch->todr_dev); 173 1.2 jmcneill uint8_t seconds_reg, minutes_reg, hours_reg, 174 1.2 jmcneill days_reg, months_reg, years_reg, weeks_reg; 175 1.2 jmcneill 176 1.2 jmcneill iic_acquire_bus(sc->sc_i2c, I2C_F_POLL); 177 1.2 jmcneill seconds_reg = POWER_READ(sc, SECONDS_REG); 178 1.2 jmcneill minutes_reg = POWER_READ(sc, MINUTES_REG); 179 1.2 jmcneill hours_reg = POWER_READ(sc, HOURS_REG); 180 1.2 jmcneill days_reg = POWER_READ(sc, DAYS_REG); 181 1.2 jmcneill months_reg = POWER_READ(sc, MONTHS_REG); 182 1.2 jmcneill years_reg = POWER_READ(sc, YEARS_REG); 183 1.2 jmcneill weeks_reg = POWER_READ(sc, WEEKS_REG); 184 1.2 jmcneill iic_release_bus(sc->sc_i2c, I2C_F_POLL); 185 1.2 jmcneill 186 1.2 jmcneill dt->dt_sec = bcdtobin(seconds_reg); 187 1.2 jmcneill dt->dt_min = bcdtobin(minutes_reg); 188 1.2 jmcneill dt->dt_hour = bcdtobin(hours_reg); 189 1.2 jmcneill dt->dt_day = bcdtobin(days_reg); 190 1.2 jmcneill dt->dt_mon = bcdtobin(months_reg); 191 1.2 jmcneill dt->dt_year = bcdtobin(years_reg) + 2000; 192 1.2 jmcneill dt->dt_wday = bcdtobin(weeks_reg); 193 1.2 jmcneill 194 1.2 jmcneill return 0; 195 1.2 jmcneill } 196 1.2 jmcneill 197 1.2 jmcneill static int 198 1.2 jmcneill twl_rtc_settime(todr_chip_handle_t tch, struct clock_ymdhms *dt) 199 1.2 jmcneill { 200 1.7 thorpej struct twl_softc *sc = device_private(tch->todr_dev); 201 1.2 jmcneill 202 1.2 jmcneill iic_acquire_bus(sc->sc_i2c, I2C_F_POLL); 203 1.2 jmcneill twl_rtc_enable(sc, false); 204 1.2 jmcneill POWER_WRITE(sc, SECONDS_REG, bintobcd(dt->dt_sec)); 205 1.2 jmcneill POWER_WRITE(sc, MINUTES_REG, bintobcd(dt->dt_min)); 206 1.2 jmcneill POWER_WRITE(sc, HOURS_REG, bintobcd(dt->dt_hour)); 207 1.2 jmcneill POWER_WRITE(sc, DAYS_REG, bintobcd(dt->dt_day)); 208 1.2 jmcneill POWER_WRITE(sc, MONTHS_REG, bintobcd(dt->dt_mon)); 209 1.2 jmcneill POWER_WRITE(sc, YEARS_REG, bintobcd(dt->dt_year % 100)); 210 1.2 jmcneill POWER_WRITE(sc, WEEKS_REG, bintobcd(dt->dt_wday)); 211 1.2 jmcneill twl_rtc_enable(sc, true); 212 1.2 jmcneill iic_release_bus(sc->sc_i2c, I2C_F_POLL); 213 1.2 jmcneill 214 1.2 jmcneill return 0; 215 1.2 jmcneill } 216 1.2 jmcneill 217 1.3 jmcneill #ifdef FDT 218 1.1 jmcneill static int 219 1.1 jmcneill twl_gpio_config(struct twl_softc *sc, int pin, int flags) 220 1.1 jmcneill { 221 1.1 jmcneill uint8_t dir; 222 1.1 jmcneill 223 1.1 jmcneill KASSERT(pin >= 0 && pin < sc->sc_npins); 224 1.1 jmcneill 225 1.1 jmcneill dir = INT_READ(sc, GPIODATADIR(pin)); 226 1.1 jmcneill 227 1.1 jmcneill switch (flags & (GPIO_PIN_INPUT|GPIO_PIN_OUTPUT)) { 228 1.1 jmcneill case GPIO_PIN_INPUT: 229 1.1 jmcneill dir &= ~PIN_BIT(pin); 230 1.1 jmcneill break; 231 1.1 jmcneill case GPIO_PIN_OUTPUT: 232 1.1 jmcneill dir |= PIN_BIT(pin); 233 1.1 jmcneill break; 234 1.1 jmcneill default: 235 1.1 jmcneill return EINVAL; 236 1.1 jmcneill } 237 1.1 jmcneill 238 1.1 jmcneill INT_WRITE(sc, GPIODATADIR(pin), dir); 239 1.1 jmcneill 240 1.1 jmcneill return 0; 241 1.1 jmcneill } 242 1.1 jmcneill 243 1.1 jmcneill static void * 244 1.1 jmcneill twl_gpio_acquire(device_t dev, const void *data, size_t len, int flags) 245 1.1 jmcneill { 246 1.1 jmcneill struct twl_softc * const sc = device_private(dev); 247 1.1 jmcneill struct twl_pin *gpin; 248 1.1 jmcneill const u_int *gpio = data; 249 1.1 jmcneill int error; 250 1.1 jmcneill 251 1.1 jmcneill if (len != 12) 252 1.1 jmcneill return NULL; 253 1.1 jmcneill 254 1.1 jmcneill const uint8_t pin = be32toh(gpio[1]) & 0xff; 255 1.1 jmcneill const bool actlo = (be32toh(gpio[2]) & __BIT(0)) != 0; 256 1.1 jmcneill 257 1.1 jmcneill if (pin >= sc->sc_npins) 258 1.1 jmcneill return NULL; 259 1.1 jmcneill 260 1.1 jmcneill I2C_LOCK(sc); 261 1.1 jmcneill error = twl_gpio_config(sc, pin, flags); 262 1.1 jmcneill I2C_UNLOCK(sc); 263 1.1 jmcneill 264 1.1 jmcneill if (error != 0) { 265 1.1 jmcneill device_printf(dev, "bad pin %d config %#x\n", pin, flags); 266 1.1 jmcneill return NULL; 267 1.1 jmcneill } 268 1.1 jmcneill 269 1.1 jmcneill gpin = kmem_zalloc(sizeof(*gpin), KM_SLEEP); 270 1.1 jmcneill gpin->pin_sc = sc; 271 1.1 jmcneill gpin->pin_num = pin; 272 1.1 jmcneill gpin->pin_flags = flags; 273 1.1 jmcneill gpin->pin_actlo = actlo; 274 1.1 jmcneill 275 1.1 jmcneill return gpin; 276 1.1 jmcneill } 277 1.1 jmcneill 278 1.1 jmcneill static void 279 1.1 jmcneill twl_gpio_release(device_t dev, void *priv) 280 1.1 jmcneill { 281 1.1 jmcneill struct twl_softc * const sc = device_private(dev); 282 1.1 jmcneill struct twl_pin *gpin = priv; 283 1.1 jmcneill 284 1.1 jmcneill I2C_LOCK(sc); 285 1.1 jmcneill twl_gpio_config(sc, gpin->pin_num, GPIO_PIN_INPUT); 286 1.1 jmcneill I2C_UNLOCK(sc); 287 1.1 jmcneill 288 1.1 jmcneill kmem_free(gpin, sizeof(*gpin)); 289 1.1 jmcneill } 290 1.1 jmcneill 291 1.1 jmcneill static int 292 1.1 jmcneill twl_gpio_read(device_t dev, void *priv, bool raw) 293 1.1 jmcneill { 294 1.1 jmcneill struct twl_softc * const sc = device_private(dev); 295 1.1 jmcneill struct twl_pin *gpin = priv; 296 1.1 jmcneill uint8_t gpio; 297 1.1 jmcneill int val; 298 1.1 jmcneill 299 1.1 jmcneill I2C_LOCK(sc); 300 1.1 jmcneill gpio = INT_READ(sc, GPIODATAIN(gpin->pin_num)); 301 1.1 jmcneill I2C_UNLOCK(sc); 302 1.1 jmcneill 303 1.1 jmcneill val = __SHIFTOUT(gpio, PIN_BIT(gpin->pin_num)); 304 1.1 jmcneill if (!raw && gpin->pin_actlo) 305 1.1 jmcneill val = !val; 306 1.1 jmcneill 307 1.1 jmcneill return val; 308 1.1 jmcneill } 309 1.1 jmcneill 310 1.1 jmcneill static void 311 1.1 jmcneill twl_gpio_write(device_t dev, void *priv, int val, bool raw) 312 1.1 jmcneill { 313 1.1 jmcneill struct twl_softc * const sc = device_private(dev); 314 1.1 jmcneill struct twl_pin *gpin = priv; 315 1.1 jmcneill 316 1.1 jmcneill if (!raw && gpin->pin_actlo) 317 1.1 jmcneill val = !val; 318 1.1 jmcneill 319 1.1 jmcneill I2C_LOCK(sc); 320 1.1 jmcneill if (val) 321 1.1 jmcneill INT_WRITE(sc, SETGPIODATAOUT(gpin->pin_num), PIN_BIT(gpin->pin_num)); 322 1.1 jmcneill else 323 1.1 jmcneill INT_WRITE(sc, CLEARGPIODATAOUT(gpin->pin_num), PIN_BIT(gpin->pin_num)); 324 1.1 jmcneill I2C_UNLOCK(sc); 325 1.1 jmcneill } 326 1.1 jmcneill 327 1.1 jmcneill static struct fdtbus_gpio_controller_func twl_gpio_funcs = { 328 1.1 jmcneill .acquire = twl_gpio_acquire, 329 1.1 jmcneill .release = twl_gpio_release, 330 1.1 jmcneill .read = twl_gpio_read, 331 1.1 jmcneill .write = twl_gpio_write, 332 1.1 jmcneill }; 333 1.3 jmcneill #endif /* !FDT */ 334 1.1 jmcneill 335 1.1 jmcneill static void 336 1.2 jmcneill twl_rtc_attach(struct twl_softc *sc, const int phandle) 337 1.2 jmcneill { 338 1.2 jmcneill iic_acquire_bus(sc->sc_i2c, I2C_F_POLL); 339 1.2 jmcneill twl_rtc_enable(sc, true); 340 1.2 jmcneill iic_release_bus(sc->sc_i2c, I2C_F_POLL); 341 1.2 jmcneill 342 1.2 jmcneill sc->sc_todr.todr_gettime_ymdhms = twl_rtc_gettime; 343 1.2 jmcneill sc->sc_todr.todr_settime_ymdhms = twl_rtc_settime; 344 1.7 thorpej sc->sc_todr.todr_dev = sc->sc_dev; 345 1.3 jmcneill todr_attach(&sc->sc_todr); 346 1.2 jmcneill } 347 1.2 jmcneill 348 1.2 jmcneill static void 349 1.1 jmcneill twl_gpio_attach(struct twl_softc *sc, const int phandle) 350 1.1 jmcneill { 351 1.3 jmcneill #ifdef FDT 352 1.1 jmcneill fdtbus_register_gpio_controller(sc->sc_dev, phandle, &twl_gpio_funcs); 353 1.3 jmcneill #endif 354 1.1 jmcneill } 355 1.1 jmcneill 356 1.1 jmcneill static int 357 1.1 jmcneill twl_match(device_t parent, cfdata_t match, void *aux) 358 1.1 jmcneill { 359 1.1 jmcneill struct i2c_attach_args *ia = aux; 360 1.1 jmcneill int match_result; 361 1.1 jmcneill 362 1.1 jmcneill if (iic_use_direct_match(ia, match, compat_data, &match_result)) 363 1.1 jmcneill return match_result; 364 1.1 jmcneill 365 1.3 jmcneill if (ia->ia_addr == 0x48) 366 1.3 jmcneill return I2C_MATCH_ADDRESS_ONLY; 367 1.3 jmcneill 368 1.1 jmcneill return 0; 369 1.1 jmcneill } 370 1.1 jmcneill 371 1.1 jmcneill static void 372 1.1 jmcneill twl_attach(device_t parent, device_t self, void *aux) 373 1.1 jmcneill { 374 1.1 jmcneill struct twl_softc * const sc = device_private(self); 375 1.1 jmcneill struct i2c_attach_args *ia = aux; 376 1.2 jmcneill uint32_t idcode; 377 1.1 jmcneill 378 1.1 jmcneill sc->sc_dev = self; 379 1.1 jmcneill sc->sc_i2c = ia->ia_tag; 380 1.1 jmcneill sc->sc_addr = ia->ia_addr; 381 1.1 jmcneill sc->sc_npins = TWL_PIN_COUNT; 382 1.1 jmcneill 383 1.1 jmcneill aprint_naive("\n"); 384 1.1 jmcneill aprint_normal(": TWL4030"); 385 1.1 jmcneill 386 1.3 jmcneill #ifdef FDT 387 1.9 thorpej if (devhandle_type(device_handle(self)) == DEVHANDLE_TYPE_OF) { 388 1.9 thorpej sc->sc_phandle = devhandle_to_of(device_handle(self)); 389 1.9 thorpej for (int child = OF_child(sc->sc_phandle); child; 390 1.9 thorpej child = OF_peer(child)) { 391 1.9 thorpej if (of_compatible_match(child, gpio_compat_data)) { 392 1.9 thorpej aprint_normal(", GPIO"); 393 1.9 thorpej twl_gpio_attach(sc, child); 394 1.9 thorpej } else if (of_compatible_match(child, 395 1.9 thorpej rtc_compat_data)) { 396 1.9 thorpej aprint_normal(", RTC"); 397 1.9 thorpej twl_rtc_attach(sc, child); 398 1.9 thorpej } 399 1.1 jmcneill } 400 1.9 thorpej } else 401 1.9 thorpej #endif 402 1.9 thorpej { 403 1.9 thorpej aprint_normal("\n"); 404 1.9 thorpej twl_gpio_attach(sc, -1); 405 1.9 thorpej twl_rtc_attach(sc, -1); 406 1.1 jmcneill } 407 1.2 jmcneill 408 1.2 jmcneill I2C_LOCK(sc); 409 1.2 jmcneill idcode = INT_READ(sc, IDCODE_7_0); 410 1.2 jmcneill idcode |= (uint32_t)INT_READ(sc, IDCODE_15_8) << 8; 411 1.2 jmcneill idcode |= (uint32_t)INT_READ(sc, IDCODE_23_16) << 16; 412 1.2 jmcneill idcode |= (uint32_t)INT_READ(sc, IDCODE_31_24) << 24; 413 1.2 jmcneill I2C_UNLOCK(sc); 414 1.2 jmcneill 415 1.2 jmcneill aprint_normal(", IDCODE 0x%08x\n", idcode); 416 1.1 jmcneill } 417 1.1 jmcneill 418 1.1 jmcneill CFATTACH_DECL_NEW(twl, sizeof(struct twl_softc), 419 1.1 jmcneill twl_match, twl_attach, NULL, NULL); 420