1 1.33 thorpej /* $NetBSD: cuda.c,v 1.33 2025/09/22 12:50:13 thorpej Exp $ */ 2 1.1 macallan 3 1.1 macallan /*- 4 1.1 macallan * Copyright (c) 2006 Michael Lorenz 5 1.1 macallan * All rights reserved. 6 1.1 macallan * 7 1.1 macallan * Redistribution and use in source and binary forms, with or without 8 1.1 macallan * modification, are permitted provided that the following conditions 9 1.1 macallan * are met: 10 1.1 macallan * 1. Redistributions of source code must retain the above copyright 11 1.1 macallan * notice, this list of conditions and the following disclaimer. 12 1.1 macallan * 2. Redistributions in binary form must reproduce the above copyright 13 1.1 macallan * notice, this list of conditions and the following disclaimer in the 14 1.1 macallan * documentation and/or other materials provided with the distribution. 15 1.1 macallan * 16 1.1 macallan * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 17 1.1 macallan * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 18 1.1 macallan * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 19 1.1 macallan * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 20 1.1 macallan * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 21 1.1 macallan * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 22 1.1 macallan * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 23 1.1 macallan * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 24 1.1 macallan * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 25 1.1 macallan * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 26 1.1 macallan * POSSIBILITY OF SUCH DAMAGE. 27 1.1 macallan */ 28 1.1 macallan 29 1.1 macallan #include <sys/cdefs.h> 30 1.33 thorpej __KERNEL_RCSID(0, "$NetBSD: cuda.c,v 1.33 2025/09/22 12:50:13 thorpej Exp $"); 31 1.1 macallan 32 1.1 macallan #include <sys/param.h> 33 1.1 macallan #include <sys/systm.h> 34 1.1 macallan #include <sys/kernel.h> 35 1.1 macallan #include <sys/device.h> 36 1.1 macallan #include <sys/proc.h> 37 1.8 macallan #include <sys/mutex.h> 38 1.1 macallan 39 1.17 dyoung #include <sys/bus.h> 40 1.1 macallan #include <machine/autoconf.h> 41 1.4 garbled #include <machine/pio.h> 42 1.1 macallan #include <dev/clock_subr.h> 43 1.33 thorpej 44 1.1 macallan #include <dev/i2c/i2cvar.h> 45 1.33 thorpej #include <dev/i2c/i2c_calls.h> 46 1.33 thorpej #include <dev/i2c/i2c_enum.h> 47 1.1 macallan 48 1.1 macallan #include <macppc/dev/viareg.h> 49 1.1 macallan #include <macppc/dev/cudavar.h> 50 1.1 macallan 51 1.1 macallan #include <dev/ofw/openfirm.h> 52 1.1 macallan #include <dev/adb/adbvar.h> 53 1.1 macallan #include "opt_cuda.h" 54 1.1 macallan 55 1.1 macallan #ifdef CUDA_DEBUG 56 1.1 macallan #define DPRINTF printf 57 1.1 macallan #else 58 1.1 macallan #define DPRINTF while (0) printf 59 1.1 macallan #endif 60 1.1 macallan 61 1.1 macallan #define CUDA_NOTREADY 0x1 /* has not been initialized yet */ 62 1.1 macallan #define CUDA_IDLE 0x2 /* the bus is currently idle */ 63 1.1 macallan #define CUDA_OUT 0x3 /* sending out a command */ 64 1.1 macallan #define CUDA_IN 0x4 /* receiving data */ 65 1.1 macallan #define CUDA_POLLING 0x5 /* polling - II only */ 66 1.1 macallan 67 1.8 macallan static void cuda_attach(device_t, device_t, void *); 68 1.8 macallan static int cuda_match(device_t, struct cfdata *, void *); 69 1.1 macallan static void cuda_autopoll(void *, int); 70 1.1 macallan 71 1.1 macallan static int cuda_intr(void *); 72 1.1 macallan 73 1.1 macallan typedef struct _cuda_handler { 74 1.1 macallan int (*handler)(void *, int, uint8_t *); 75 1.1 macallan void *cookie; 76 1.1 macallan } CudaHandler; 77 1.1 macallan 78 1.1 macallan struct cuda_softc { 79 1.8 macallan device_t sc_dev; 80 1.1 macallan void *sc_ih; 81 1.1 macallan CudaHandler sc_handlers[16]; 82 1.1 macallan struct todr_chip_handle sc_todr; 83 1.1 macallan struct adb_bus_accessops sc_adbops; 84 1.1 macallan struct i2c_controller sc_i2c; 85 1.1 macallan bus_space_tag_t sc_memt; 86 1.1 macallan bus_space_handle_t sc_memh; 87 1.33 thorpej 88 1.33 thorpej /* 89 1.33 thorpej * We provide our own i2c device enumeration method, so we 90 1.33 thorpej * need to subclass our device handle. 91 1.33 thorpej */ 92 1.33 thorpej struct devhandle_impl sc_devhandle_impl; 93 1.33 thorpej 94 1.1 macallan int sc_node; 95 1.1 macallan int sc_state; 96 1.1 macallan int sc_waiting; 97 1.1 macallan int sc_polling; 98 1.1 macallan int sc_sent; 99 1.1 macallan int sc_out_length; 100 1.1 macallan int sc_received; 101 1.1 macallan int sc_iic_done; 102 1.1 macallan int sc_error; 103 1.1 macallan /* time */ 104 1.1 macallan uint32_t sc_tod; 105 1.1 macallan uint32_t sc_autopoll; 106 1.30 macallan kcondvar_t sc_todev; 107 1.30 macallan kmutex_t sc_todevmtx; 108 1.1 macallan /* ADB */ 109 1.1 macallan void (*sc_adb_handler)(void *, int, uint8_t *); 110 1.1 macallan void *sc_adb_cookie; 111 1.1 macallan uint32_t sc_i2c_read_len; 112 1.1 macallan /* internal buffers */ 113 1.1 macallan uint8_t sc_in[256]; 114 1.1 macallan uint8_t sc_out[256]; 115 1.1 macallan }; 116 1.1 macallan 117 1.8 macallan CFATTACH_DECL_NEW(cuda, sizeof(struct cuda_softc), 118 1.1 macallan cuda_match, cuda_attach, NULL, NULL); 119 1.1 macallan 120 1.1 macallan static inline void cuda_write_reg(struct cuda_softc *, int, uint8_t); 121 1.1 macallan static inline uint8_t cuda_read_reg(struct cuda_softc *, int); 122 1.1 macallan static void cuda_idle(struct cuda_softc *); 123 1.1 macallan static void cuda_tip(struct cuda_softc *); 124 1.1 macallan static void cuda_clear_tip(struct cuda_softc *); 125 1.1 macallan static void cuda_in(struct cuda_softc *); 126 1.1 macallan static void cuda_out(struct cuda_softc *); 127 1.1 macallan static void cuda_toggle_ack(struct cuda_softc *); 128 1.1 macallan static void cuda_ack_off(struct cuda_softc *); 129 1.1 macallan static int cuda_intr_state(struct cuda_softc *); 130 1.1 macallan 131 1.1 macallan static void cuda_init(struct cuda_softc *); 132 1.1 macallan 133 1.1 macallan /* 134 1.1 macallan * send a message to Cuda. 135 1.1 macallan */ 136 1.1 macallan /* cookie, flags, length, data */ 137 1.1 macallan static int cuda_send(void *, int, int, uint8_t *); 138 1.1 macallan static void cuda_poll(void *); 139 1.1 macallan static void cuda_adb_poll(void *); 140 1.1 macallan static int cuda_set_handler(void *, int, int (*)(void *, int, uint8_t *), void *); 141 1.1 macallan 142 1.1 macallan static int cuda_error_handler(void *, int, uint8_t *); 143 1.1 macallan 144 1.1 macallan static int cuda_todr_handler(void *, int, uint8_t *); 145 1.15 tsutsui static int cuda_todr_set(todr_chip_handle_t, struct timeval *); 146 1.15 tsutsui static int cuda_todr_get(todr_chip_handle_t, struct timeval *); 147 1.1 macallan 148 1.1 macallan static int cuda_adb_handler(void *, int, uint8_t *); 149 1.8 macallan static void cuda_final(device_t); 150 1.1 macallan 151 1.1 macallan static struct cuda_attach_args *cuda0 = NULL; 152 1.1 macallan 153 1.1 macallan /* ADB bus attachment stuff */ 154 1.1 macallan static int cuda_adb_send(void *, int, int, int, uint8_t *); 155 1.1 macallan static int cuda_adb_set_handler(void *, void (*)(void *, int, uint8_t *), void *); 156 1.1 macallan 157 1.1 macallan /* i2c stuff */ 158 1.1 macallan static int cuda_i2c_exec(void *, i2c_op_t, i2c_addr_t, const void *, size_t, 159 1.1 macallan void *, size_t, int); 160 1.1 macallan 161 1.33 thorpej static const struct i2c_deventry cuda_i2c_devices[] = { 162 1.33 thorpej { .name = "videopll", 163 1.33 thorpej .compat = "aapl,valkyrie-videopll", 164 1.33 thorpej .addr = 0x50, 165 1.33 thorpej .data = "/valkyrie" }, 166 1.33 thorpej 167 1.33 thorpej { .name = "sgsmix", 168 1.33 thorpej .compat = "st,tda7433", 169 1.33 thorpej .addr = 0x8a, 170 1.33 thorpej .data = "/perch" }, 171 1.33 thorpej 172 1.33 thorpej I2C_DEVENTRY_EOL 173 1.33 thorpej }; 174 1.33 thorpej 175 1.33 thorpej static int 176 1.33 thorpej cuda_i2c_enumerate_devices(device_t dev, devhandle_t call_handle, void *v) 177 1.33 thorpej { 178 1.33 thorpej struct i2c_enumerate_devices_args *args = v; 179 1.33 thorpej const struct i2c_deventry *entry; 180 1.33 thorpej bool cbrv; 181 1.33 thorpej 182 1.33 thorpej for (entry = cuda_i2c_devices; entry->name != NULL; entry++) { 183 1.33 thorpej if (OF_finddevice((const char *)entry->data) == -1) { 184 1.33 thorpej continue; 185 1.33 thorpej } 186 1.33 thorpej cbrv = i2c_enumerate_device(dev, args, entry->name, 187 1.33 thorpej entry->compat, 0, entry->addr, devhandle_invalid()); 188 1.33 thorpej if (!cbrv) { 189 1.33 thorpej break; 190 1.33 thorpej } 191 1.33 thorpej } 192 1.33 thorpej 193 1.33 thorpej return 0; 194 1.33 thorpej } 195 1.33 thorpej 196 1.33 thorpej static device_call_t 197 1.33 thorpej cuda_devhandle_lookup_device_call(devhandle_t handle, const char *name, 198 1.33 thorpej devhandle_t *call_handlep) 199 1.33 thorpej { 200 1.33 thorpej if (strcmp(name, I2C_ENUMERATE_DEVICES_STR) == 0) { 201 1.33 thorpej return cuda_i2c_enumerate_devices; 202 1.33 thorpej } 203 1.33 thorpej 204 1.33 thorpej /* Defer everything else to the "super". */ 205 1.33 thorpej return NULL; 206 1.33 thorpej } 207 1.33 thorpej 208 1.1 macallan static int 209 1.8 macallan cuda_match(device_t parent, struct cfdata *cf, void *aux) 210 1.1 macallan { 211 1.1 macallan struct confargs *ca = aux; 212 1.1 macallan 213 1.1 macallan if (ca->ca_nreg < 8) 214 1.1 macallan return 0; 215 1.1 macallan 216 1.1 macallan if (ca->ca_nintr < 4) 217 1.1 macallan return 0; 218 1.1 macallan 219 1.1 macallan if (strcmp(ca->ca_name, "via-cuda") == 0) { 220 1.1 macallan return 10; /* beat adb* at obio? */ 221 1.1 macallan } 222 1.1 macallan 223 1.1 macallan return 0; 224 1.1 macallan } 225 1.1 macallan 226 1.1 macallan static void 227 1.16 matt cuda_attach(device_t parent, device_t self, void *aux) 228 1.1 macallan { 229 1.1 macallan struct confargs *ca = aux; 230 1.16 matt struct cuda_softc *sc = device_private(self); 231 1.1 macallan static struct cuda_attach_args caa; 232 1.1 macallan int irq = ca->ca_intr[0]; 233 1.1 macallan int node, i, child; 234 1.1 macallan char name[32]; 235 1.1 macallan 236 1.16 matt sc->sc_dev = self; 237 1.5 garbled node = of_getnode_byname(OF_parent(ca->ca_node), "extint-gpio1"); 238 1.1 macallan if (node) 239 1.1 macallan OF_getprop(node, "interrupts", &irq, 4); 240 1.1 macallan 241 1.16 matt aprint_normal(" irq %d", irq); 242 1.1 macallan 243 1.1 macallan sc->sc_node = ca->ca_node; 244 1.1 macallan sc->sc_memt = ca->ca_tag; 245 1.1 macallan 246 1.1 macallan sc->sc_sent = 0; 247 1.1 macallan sc->sc_received = 0; 248 1.1 macallan sc->sc_waiting = 0; 249 1.1 macallan sc->sc_polling = 0; 250 1.1 macallan sc->sc_state = CUDA_NOTREADY; 251 1.1 macallan sc->sc_error = 0; 252 1.1 macallan sc->sc_i2c_read_len = 0; 253 1.1 macallan 254 1.30 macallan cv_init(&sc->sc_todev, "cuda_event"); 255 1.30 macallan mutex_init(&sc->sc_todevmtx, MUTEX_DEFAULT, IPL_NONE); 256 1.30 macallan 257 1.1 macallan if (bus_space_map(sc->sc_memt, ca->ca_reg[0] + ca->ca_baseaddr, 258 1.1 macallan ca->ca_reg[1], 0, &sc->sc_memh) != 0) { 259 1.1 macallan 260 1.16 matt aprint_normal(": unable to map registers\n"); 261 1.1 macallan return; 262 1.1 macallan } 263 1.27 rin sc->sc_ih = intr_establish_xname(irq, IST_EDGE, IPL_TTY, cuda_intr, sc, 264 1.27 rin device_xname(self)); 265 1.1 macallan printf("\n"); 266 1.1 macallan 267 1.1 macallan for (i = 0; i < 16; i++) { 268 1.1 macallan sc->sc_handlers[i].handler = NULL; 269 1.1 macallan sc->sc_handlers[i].cookie = NULL; 270 1.1 macallan } 271 1.1 macallan 272 1.1 macallan cuda_init(sc); 273 1.1 macallan 274 1.1 macallan /* now attach children */ 275 1.16 matt config_interrupts(self, cuda_final); 276 1.1 macallan cuda_set_handler(sc, CUDA_ERROR, cuda_error_handler, sc); 277 1.1 macallan cuda_set_handler(sc, CUDA_PSEUDO, cuda_todr_handler, sc); 278 1.1 macallan 279 1.1 macallan child = OF_child(ca->ca_node); 280 1.1 macallan while (child != 0) { 281 1.1 macallan 282 1.1 macallan if (OF_getprop(child, "name", name, 32) == 0) 283 1.1 macallan continue; 284 1.1 macallan if (strncmp(name, "adb", 4) == 0) { 285 1.1 macallan 286 1.1 macallan cuda_set_handler(sc, CUDA_ADB, cuda_adb_handler, sc); 287 1.1 macallan sc->sc_adbops.cookie = sc; 288 1.1 macallan sc->sc_adbops.send = cuda_adb_send; 289 1.1 macallan sc->sc_adbops.poll = cuda_adb_poll; 290 1.1 macallan sc->sc_adbops.autopoll = cuda_autopoll; 291 1.1 macallan sc->sc_adbops.set_handler = cuda_adb_set_handler; 292 1.28 thorpej config_found(self, &sc->sc_adbops, nadb_print, 293 1.29 thorpej CFARGS(.iattr = "adb_bus")); 294 1.1 macallan } else if (strncmp(name, "rtc", 4) == 0) { 295 1.1 macallan 296 1.1 macallan sc->sc_todr.todr_gettime = cuda_todr_get; 297 1.1 macallan sc->sc_todr.todr_settime = cuda_todr_set; 298 1.31 thorpej sc->sc_todr.todr_dev = self; 299 1.1 macallan todr_attach(&sc->sc_todr); 300 1.1 macallan } 301 1.1 macallan child = OF_peer(child); 302 1.1 macallan } 303 1.1 macallan 304 1.1 macallan caa.cookie = sc; 305 1.1 macallan caa.set_handler = cuda_set_handler; 306 1.1 macallan caa.send = cuda_send; 307 1.1 macallan caa.poll = cuda_poll; 308 1.2 macallan #if notyet 309 1.29 thorpej config_found(self, &caa, cuda_print, CFARGS_NONE); 310 1.2 macallan #endif 311 1.22 macallan 312 1.33 thorpej /* 313 1.33 thorpej * There are no OF nodes for our I2C devices, so we provide 314 1.33 thorpej * our own enumeration method. 315 1.33 thorpej */ 316 1.24 thorpej iic_tag_init(&sc->sc_i2c); 317 1.1 macallan sc->sc_i2c.ic_cookie = sc; 318 1.1 macallan sc->sc_i2c.ic_exec = cuda_i2c_exec; 319 1.32 thorpej 320 1.33 thorpej iicbus_attach_with_devhandle(self, &sc->sc_i2c, 321 1.33 thorpej devhandle_subclass(device_handle(self), 322 1.33 thorpej &sc->sc_devhandle_impl, 323 1.33 thorpej cuda_devhandle_lookup_device_call)); 324 1.1 macallan 325 1.1 macallan if (cuda0 == NULL) 326 1.1 macallan cuda0 = &caa; 327 1.1 macallan } 328 1.1 macallan 329 1.1 macallan static void 330 1.1 macallan cuda_init(struct cuda_softc *sc) 331 1.1 macallan { 332 1.1 macallan uint8_t reg; 333 1.1 macallan 334 1.1 macallan reg = cuda_read_reg(sc, vDirB); 335 1.1 macallan reg |= 0x30; /* register B bits 4 and 5: outputs */ 336 1.1 macallan cuda_write_reg(sc, vDirB, reg); 337 1.1 macallan 338 1.1 macallan reg = cuda_read_reg(sc, vDirB); 339 1.1 macallan reg &= 0xf7; /* register B bit 3: input */ 340 1.1 macallan cuda_write_reg(sc, vDirB, reg); 341 1.1 macallan 342 1.1 macallan reg = cuda_read_reg(sc, vACR); 343 1.1 macallan reg &= ~vSR_OUT; /* make sure SR is set to IN */ 344 1.1 macallan cuda_write_reg(sc, vACR, reg); 345 1.1 macallan 346 1.1 macallan cuda_write_reg(sc, vACR, (cuda_read_reg(sc, vACR) | 0x0c) & ~0x10); 347 1.1 macallan 348 1.1 macallan sc->sc_state = CUDA_IDLE; /* used by all types of hardware */ 349 1.1 macallan 350 1.1 macallan cuda_write_reg(sc, vIER, 0x84); /* make sure VIA interrupts are on */ 351 1.1 macallan cuda_idle(sc); /* set ADB bus state to idle */ 352 1.1 macallan 353 1.1 macallan /* sort of a device reset */ 354 1.19 mrg (void)cuda_read_reg(sc, vSR); /* clear interrupt */ 355 1.1 macallan cuda_write_reg(sc, vIER, 0x04); /* no interrupts while clearing */ 356 1.1 macallan cuda_idle(sc); /* reset state to idle */ 357 1.1 macallan delay(150); 358 1.1 macallan cuda_tip(sc); /* signal start of frame */ 359 1.1 macallan delay(150); 360 1.1 macallan cuda_toggle_ack(sc); 361 1.1 macallan delay(150); 362 1.1 macallan cuda_clear_tip(sc); 363 1.1 macallan delay(150); 364 1.1 macallan cuda_idle(sc); /* back to idle state */ 365 1.19 mrg (void)cuda_read_reg(sc, vSR); /* clear interrupt */ 366 1.1 macallan cuda_write_reg(sc, vIER, 0x84); /* ints ok now */ 367 1.1 macallan } 368 1.1 macallan 369 1.1 macallan static void 370 1.8 macallan cuda_final(device_t dev) 371 1.1 macallan { 372 1.8 macallan struct cuda_softc *sc = device_private(dev); 373 1.1 macallan 374 1.1 macallan sc->sc_polling = 0; 375 1.1 macallan } 376 1.1 macallan 377 1.1 macallan static inline void 378 1.1 macallan cuda_write_reg(struct cuda_softc *sc, int offset, uint8_t value) 379 1.1 macallan { 380 1.1 macallan 381 1.1 macallan bus_space_write_1(sc->sc_memt, sc->sc_memh, offset, value); 382 1.1 macallan } 383 1.1 macallan 384 1.1 macallan static inline uint8_t 385 1.1 macallan cuda_read_reg(struct cuda_softc *sc, int offset) 386 1.1 macallan { 387 1.1 macallan 388 1.1 macallan return bus_space_read_1(sc->sc_memt, sc->sc_memh, offset); 389 1.1 macallan } 390 1.1 macallan 391 1.1 macallan static int 392 1.1 macallan cuda_set_handler(void *cookie, int type, 393 1.1 macallan int (*handler)(void *, int, uint8_t *), void *hcookie) 394 1.1 macallan { 395 1.1 macallan struct cuda_softc *sc = cookie; 396 1.1 macallan CudaHandler *me; 397 1.1 macallan 398 1.1 macallan if ((type >= 0) && (type < 16)) { 399 1.1 macallan me = &sc->sc_handlers[type]; 400 1.1 macallan me->handler = handler; 401 1.1 macallan me->cookie = hcookie; 402 1.1 macallan return 0; 403 1.1 macallan } 404 1.1 macallan return -1; 405 1.1 macallan } 406 1.1 macallan 407 1.1 macallan static int 408 1.1 macallan cuda_send(void *cookie, int poll, int length, uint8_t *msg) 409 1.1 macallan { 410 1.1 macallan struct cuda_softc *sc = cookie; 411 1.1 macallan int s; 412 1.1 macallan 413 1.1 macallan DPRINTF("cuda_send %08x\n", (uint32_t)cookie); 414 1.1 macallan if (sc->sc_state == CUDA_NOTREADY) 415 1.1 macallan return -1; 416 1.1 macallan 417 1.1 macallan s = splhigh(); 418 1.1 macallan 419 1.18 joerg if (sc->sc_state == CUDA_IDLE /*&& 420 1.18 joerg (cuda_read_reg(sc, vBufB) & vPB3) == vPB3*/) { 421 1.1 macallan /* fine */ 422 1.1 macallan DPRINTF("chip is idle\n"); 423 1.1 macallan } else { 424 1.1 macallan DPRINTF("cuda state is %d\n", sc->sc_state); 425 1.1 macallan if (sc->sc_waiting == 0) { 426 1.1 macallan sc->sc_waiting = 1; 427 1.1 macallan } else { 428 1.1 macallan splx(s); 429 1.1 macallan return -1; 430 1.1 macallan } 431 1.1 macallan } 432 1.1 macallan 433 1.1 macallan sc->sc_error = 0; 434 1.1 macallan memcpy(sc->sc_out, msg, length); 435 1.1 macallan sc->sc_out_length = length; 436 1.1 macallan sc->sc_sent = 0; 437 1.1 macallan 438 1.1 macallan if (sc->sc_waiting != 1) { 439 1.1 macallan 440 1.1 macallan delay(150); 441 1.1 macallan sc->sc_state = CUDA_OUT; 442 1.1 macallan cuda_out(sc); 443 1.1 macallan cuda_write_reg(sc, vSR, sc->sc_out[0]); 444 1.1 macallan cuda_ack_off(sc); 445 1.1 macallan cuda_tip(sc); 446 1.1 macallan } 447 1.1 macallan sc->sc_waiting = 1; 448 1.1 macallan 449 1.1 macallan if (sc->sc_polling || poll || cold) { 450 1.1 macallan cuda_poll(sc); 451 1.1 macallan } 452 1.1 macallan 453 1.1 macallan splx(s); 454 1.1 macallan 455 1.1 macallan return 0; 456 1.1 macallan } 457 1.1 macallan 458 1.1 macallan static void 459 1.1 macallan cuda_poll(void *cookie) 460 1.1 macallan { 461 1.1 macallan struct cuda_softc *sc = cookie; 462 1.2 macallan int s; 463 1.1 macallan 464 1.1 macallan DPRINTF("polling\n"); 465 1.1 macallan while ((sc->sc_state != CUDA_IDLE) || 466 1.1 macallan (cuda_intr_state(sc)) || 467 1.1 macallan (sc->sc_waiting == 1)) { 468 1.1 macallan if ((cuda_read_reg(sc, vIFR) & vSR_INT) == vSR_INT) { 469 1.2 macallan s = splhigh(); 470 1.1 macallan cuda_intr(sc); 471 1.2 macallan splx(s); 472 1.1 macallan } 473 1.1 macallan } 474 1.1 macallan } 475 1.1 macallan 476 1.1 macallan static void 477 1.1 macallan cuda_adb_poll(void *cookie) 478 1.1 macallan { 479 1.1 macallan struct cuda_softc *sc = cookie; 480 1.2 macallan int s; 481 1.1 macallan 482 1.2 macallan s = splhigh(); 483 1.1 macallan cuda_intr(sc); 484 1.2 macallan splx(s); 485 1.1 macallan } 486 1.1 macallan 487 1.1 macallan static void 488 1.1 macallan cuda_idle(struct cuda_softc *sc) 489 1.1 macallan { 490 1.1 macallan uint8_t reg; 491 1.1 macallan 492 1.1 macallan reg = cuda_read_reg(sc, vBufB); 493 1.1 macallan reg |= (vPB4 | vPB5); 494 1.1 macallan cuda_write_reg(sc, vBufB, reg); 495 1.1 macallan } 496 1.1 macallan 497 1.1 macallan static void 498 1.1 macallan cuda_tip(struct cuda_softc *sc) 499 1.1 macallan { 500 1.1 macallan uint8_t reg; 501 1.1 macallan 502 1.1 macallan reg = cuda_read_reg(sc, vBufB); 503 1.1 macallan reg &= ~vPB5; 504 1.1 macallan cuda_write_reg(sc, vBufB, reg); 505 1.1 macallan } 506 1.1 macallan 507 1.1 macallan static void 508 1.1 macallan cuda_clear_tip(struct cuda_softc *sc) 509 1.1 macallan { 510 1.1 macallan uint8_t reg; 511 1.1 macallan 512 1.1 macallan reg = cuda_read_reg(sc, vBufB); 513 1.1 macallan reg |= vPB5; 514 1.1 macallan cuda_write_reg(sc, vBufB, reg); 515 1.1 macallan } 516 1.1 macallan 517 1.1 macallan static void 518 1.1 macallan cuda_in(struct cuda_softc *sc) 519 1.1 macallan { 520 1.1 macallan uint8_t reg; 521 1.1 macallan 522 1.1 macallan reg = cuda_read_reg(sc, vACR); 523 1.1 macallan reg &= ~vSR_OUT; 524 1.1 macallan cuda_write_reg(sc, vACR, reg); 525 1.1 macallan } 526 1.1 macallan 527 1.1 macallan static void 528 1.1 macallan cuda_out(struct cuda_softc *sc) 529 1.1 macallan { 530 1.1 macallan uint8_t reg; 531 1.1 macallan 532 1.1 macallan reg = cuda_read_reg(sc, vACR); 533 1.1 macallan reg |= vSR_OUT; 534 1.1 macallan cuda_write_reg(sc, vACR, reg); 535 1.1 macallan } 536 1.1 macallan 537 1.1 macallan static void 538 1.1 macallan cuda_toggle_ack(struct cuda_softc *sc) 539 1.1 macallan { 540 1.1 macallan uint8_t reg; 541 1.1 macallan 542 1.1 macallan reg = cuda_read_reg(sc, vBufB); 543 1.1 macallan reg ^= vPB4; 544 1.1 macallan cuda_write_reg(sc, vBufB, reg); 545 1.1 macallan } 546 1.1 macallan 547 1.1 macallan static void 548 1.1 macallan cuda_ack_off(struct cuda_softc *sc) 549 1.1 macallan { 550 1.1 macallan uint8_t reg; 551 1.1 macallan 552 1.1 macallan reg = cuda_read_reg(sc, vBufB); 553 1.1 macallan reg |= vPB4; 554 1.1 macallan cuda_write_reg(sc, vBufB, reg); 555 1.1 macallan } 556 1.1 macallan 557 1.1 macallan static int 558 1.1 macallan cuda_intr_state(struct cuda_softc *sc) 559 1.1 macallan { 560 1.1 macallan return ((cuda_read_reg(sc, vBufB) & vPB3) == 0); 561 1.1 macallan } 562 1.1 macallan 563 1.1 macallan static int 564 1.1 macallan cuda_intr(void *arg) 565 1.1 macallan { 566 1.1 macallan struct cuda_softc *sc = arg; 567 1.19 mrg int ending, type; 568 1.1 macallan uint8_t reg; 569 1.1 macallan 570 1.1 macallan reg = cuda_read_reg(sc, vIFR); /* Read the interrupts */ 571 1.2 macallan DPRINTF("["); 572 1.1 macallan if ((reg & 0x80) == 0) { 573 1.2 macallan DPRINTF("irq %02x]", reg); 574 1.1 macallan return 0; /* No interrupts to process */ 575 1.1 macallan } 576 1.1 macallan DPRINTF(":"); 577 1.1 macallan 578 1.2 macallan cuda_write_reg(sc, vIFR, 0x7f); /* Clear 'em */ 579 1.1 macallan 580 1.1 macallan switch_start: 581 1.1 macallan switch (sc->sc_state) { 582 1.1 macallan case CUDA_IDLE: 583 1.1 macallan /* 584 1.1 macallan * This is an unexpected packet, so grab the first (dummy) 585 1.1 macallan * byte, set up the proper vars, and tell the chip we are 586 1.1 macallan * starting to receive the packet by setting the TIP bit. 587 1.1 macallan */ 588 1.1 macallan sc->sc_in[1] = cuda_read_reg(sc, vSR); 589 1.1 macallan DPRINTF("start: %02x", sc->sc_in[1]); 590 1.1 macallan if (cuda_intr_state(sc) == 0) { 591 1.1 macallan /* must have been a fake start */ 592 1.1 macallan DPRINTF(" ... fake start\n"); 593 1.1 macallan if (sc->sc_waiting) { 594 1.1 macallan /* start over */ 595 1.1 macallan delay(150); 596 1.1 macallan sc->sc_state = CUDA_OUT; 597 1.1 macallan sc->sc_sent = 0; 598 1.1 macallan cuda_out(sc); 599 1.1 macallan cuda_write_reg(sc, vSR, sc->sc_out[1]); 600 1.1 macallan cuda_ack_off(sc); 601 1.1 macallan cuda_tip(sc); 602 1.1 macallan } 603 1.1 macallan break; 604 1.1 macallan } 605 1.1 macallan 606 1.1 macallan cuda_in(sc); 607 1.1 macallan cuda_tip(sc); 608 1.1 macallan 609 1.1 macallan sc->sc_received = 1; 610 1.1 macallan sc->sc_state = CUDA_IN; 611 1.1 macallan DPRINTF(" CUDA_IN"); 612 1.1 macallan break; 613 1.1 macallan 614 1.1 macallan case CUDA_IN: 615 1.1 macallan sc->sc_in[sc->sc_received] = cuda_read_reg(sc, vSR); 616 1.1 macallan DPRINTF(" %02x", sc->sc_in[sc->sc_received]); 617 1.1 macallan ending = 0; 618 1.1 macallan if (sc->sc_received > 255) { 619 1.1 macallan /* bitch only once */ 620 1.1 macallan if (sc->sc_received == 256) { 621 1.20 macallan aprint_error_dev(sc->sc_dev, 622 1.20 macallan "input overflow\n"); 623 1.1 macallan ending = 1; 624 1.1 macallan } 625 1.1 macallan } else 626 1.1 macallan sc->sc_received++; 627 1.1 macallan if (sc->sc_received > 3) { 628 1.1 macallan if ((sc->sc_in[3] == CMD_IIC) && 629 1.1 macallan (sc->sc_received > (sc->sc_i2c_read_len + 4))) { 630 1.1 macallan ending = 1; 631 1.1 macallan } 632 1.1 macallan } 633 1.1 macallan 634 1.1 macallan /* intr off means this is the last byte (end of frame) */ 635 1.1 macallan if (cuda_intr_state(sc) == 0) { 636 1.1 macallan ending = 1; 637 1.1 macallan DPRINTF(".\n"); 638 1.1 macallan } else { 639 1.1 macallan cuda_toggle_ack(sc); 640 1.1 macallan } 641 1.1 macallan 642 1.1 macallan if (ending == 1) { /* end of message? */ 643 1.1 macallan 644 1.1 macallan sc->sc_in[0] = sc->sc_received - 1; 645 1.1 macallan 646 1.1 macallan /* reset vars and signal the end of this frame */ 647 1.1 macallan cuda_idle(sc); 648 1.1 macallan 649 1.1 macallan /* check if we have a handler for this message */ 650 1.1 macallan type = sc->sc_in[1]; 651 1.1 macallan if ((type >= 0) && (type < 16)) { 652 1.1 macallan CudaHandler *me = &sc->sc_handlers[type]; 653 1.1 macallan 654 1.1 macallan if (me->handler != NULL) { 655 1.1 macallan me->handler(me->cookie, 656 1.1 macallan sc->sc_received - 1, &sc->sc_in[1]); 657 1.1 macallan } else { 658 1.20 macallan aprint_error_dev(sc->sc_dev, 659 1.20 macallan "no handler for type %02x\n", type); 660 1.1 macallan panic("barf"); 661 1.1 macallan } 662 1.1 macallan } 663 1.1 macallan 664 1.2 macallan DPRINTF("CUDA_IDLE"); 665 1.2 macallan sc->sc_state = CUDA_IDLE; 666 1.2 macallan 667 1.1 macallan sc->sc_received = 0; 668 1.1 macallan 669 1.1 macallan /* 670 1.1 macallan * If there is something waiting to be sent out, 671 1.2 macallan * set everything up and send the first byte. 672 1.1 macallan */ 673 1.1 macallan if (sc->sc_waiting == 1) { 674 1.1 macallan 675 1.1 macallan DPRINTF("pending write\n"); 676 1.1 macallan delay(1500); /* required */ 677 1.1 macallan sc->sc_sent = 0; 678 1.1 macallan sc->sc_state = CUDA_OUT; 679 1.1 macallan 680 1.1 macallan /* 681 1.1 macallan * If the interrupt is on, we were too slow 682 1.1 macallan * and the chip has already started to send 683 1.1 macallan * something to us, so back out of the write 684 1.1 macallan * and start a read cycle. 685 1.1 macallan */ 686 1.1 macallan if (cuda_intr_state(sc)) { 687 1.1 macallan cuda_in(sc); 688 1.1 macallan cuda_idle(sc); 689 1.1 macallan sc->sc_sent = 0; 690 1.1 macallan sc->sc_state = CUDA_IDLE; 691 1.1 macallan sc->sc_received = 0; 692 1.1 macallan delay(150); 693 1.1 macallan DPRINTF("too slow - incoming message\n"); 694 1.1 macallan goto switch_start; 695 1.1 macallan } 696 1.1 macallan /* 697 1.1 macallan * If we got here, it's ok to start sending 698 1.1 macallan * so load the first byte and tell the chip 699 1.1 macallan * we want to send. 700 1.1 macallan */ 701 1.2 macallan DPRINTF("sending "); 702 1.2 macallan 703 1.1 macallan cuda_out(sc); 704 1.1 macallan cuda_write_reg(sc, vSR, 705 1.1 macallan sc->sc_out[sc->sc_sent]); 706 1.2 macallan cuda_ack_off(sc); 707 1.2 macallan cuda_tip(sc); 708 1.1 macallan } 709 1.1 macallan } 710 1.1 macallan break; 711 1.1 macallan 712 1.1 macallan case CUDA_OUT: 713 1.19 mrg (void)cuda_read_reg(sc, vSR); /* reset SR-intr in IFR */ 714 1.1 macallan 715 1.1 macallan sc->sc_sent++; 716 1.1 macallan if (cuda_intr_state(sc)) { /* ADB intr low during write */ 717 1.1 macallan 718 1.1 macallan DPRINTF("incoming msg during send\n"); 719 1.1 macallan cuda_in(sc); /* make sure SR is set to IN */ 720 1.1 macallan cuda_idle(sc); 721 1.1 macallan sc->sc_sent = 0; /* must start all over */ 722 1.1 macallan sc->sc_state = CUDA_IDLE; /* new state */ 723 1.1 macallan sc->sc_received = 0; 724 1.1 macallan sc->sc_waiting = 1; /* must retry when done with 725 1.1 macallan * read */ 726 1.1 macallan delay(150); 727 1.1 macallan goto switch_start; /* process next state right 728 1.1 macallan * now */ 729 1.1 macallan break; 730 1.1 macallan } 731 1.1 macallan if (sc->sc_out_length == sc->sc_sent) { /* check for done */ 732 1.1 macallan 733 1.1 macallan sc->sc_waiting = 0; /* done writing */ 734 1.1 macallan sc->sc_state = CUDA_IDLE; /* signal bus is idle */ 735 1.1 macallan cuda_in(sc); 736 1.1 macallan cuda_idle(sc); 737 1.1 macallan DPRINTF("done sending\n"); 738 1.1 macallan } else { 739 1.1 macallan /* send next byte */ 740 1.1 macallan cuda_write_reg(sc, vSR, sc->sc_out[sc->sc_sent]); 741 1.20 macallan DPRINTF("%02x", sc->sc_out[sc->sc_sent]); 742 1.1 macallan cuda_toggle_ack(sc); /* signal byte ready to 743 1.1 macallan * shift */ 744 1.1 macallan } 745 1.1 macallan break; 746 1.1 macallan 747 1.1 macallan case CUDA_NOTREADY: 748 1.1 macallan DPRINTF("adb: not yet initialized\n"); 749 1.1 macallan break; 750 1.1 macallan 751 1.1 macallan default: 752 1.1 macallan DPRINTF("intr: unknown ADB state\n"); 753 1.1 macallan break; 754 1.1 macallan } 755 1.1 macallan 756 1.2 macallan DPRINTF("]"); 757 1.1 macallan return 1; 758 1.1 macallan } 759 1.1 macallan 760 1.1 macallan static int 761 1.1 macallan cuda_error_handler(void *cookie, int len, uint8_t *data) 762 1.1 macallan { 763 1.1 macallan struct cuda_softc *sc = cookie; 764 1.1 macallan 765 1.1 macallan /* 766 1.1 macallan * something went wrong 767 1.1 macallan * byte 3 seems to be the failed command 768 1.1 macallan */ 769 1.1 macallan sc->sc_error = 1; 770 1.30 macallan DPRINTF("cuda error %02x %02x %02x %02x\n", data[0], data[1], data[2], data[3]); 771 1.30 macallan cv_signal(&sc->sc_todev); 772 1.1 macallan return 0; 773 1.1 macallan } 774 1.1 macallan 775 1.1 macallan 776 1.1 macallan /* real time clock */ 777 1.1 macallan 778 1.1 macallan static int 779 1.1 macallan cuda_todr_handler(void *cookie, int len, uint8_t *data) 780 1.1 macallan { 781 1.1 macallan struct cuda_softc *sc = cookie; 782 1.1 macallan 783 1.1 macallan #ifdef CUDA_DEBUG 784 1.1 macallan int i; 785 1.1 macallan printf("msg: %02x", data[0]); 786 1.1 macallan for (i = 1; i < len; i++) { 787 1.1 macallan printf(" %02x", data[i]); 788 1.1 macallan } 789 1.1 macallan printf("\n"); 790 1.1 macallan #endif 791 1.1 macallan 792 1.1 macallan switch(data[2]) { 793 1.1 macallan case CMD_READ_RTC: 794 1.1 macallan memcpy(&sc->sc_tod, &data[3], 4); 795 1.1 macallan break; 796 1.1 macallan case CMD_WRITE_RTC: 797 1.1 macallan sc->sc_tod = 0xffffffff; 798 1.1 macallan break; 799 1.1 macallan case CMD_AUTOPOLL: 800 1.1 macallan sc->sc_autopoll = 1; 801 1.1 macallan break; 802 1.1 macallan case CMD_IIC: 803 1.1 macallan sc->sc_iic_done = len; 804 1.1 macallan break; 805 1.1 macallan } 806 1.30 macallan cv_signal(&sc->sc_todev); 807 1.1 macallan return 0; 808 1.1 macallan } 809 1.1 macallan 810 1.1 macallan #define DIFF19041970 2082844800 811 1.1 macallan 812 1.1 macallan static int 813 1.15 tsutsui cuda_todr_get(todr_chip_handle_t tch, struct timeval *tvp) 814 1.1 macallan { 815 1.31 thorpej struct cuda_softc *sc = device_private(tch->todr_dev); 816 1.1 macallan int cnt = 0; 817 1.1 macallan uint8_t cmd[] = { CUDA_PSEUDO, CMD_READ_RTC}; 818 1.1 macallan 819 1.1 macallan sc->sc_tod = 0; 820 1.20 macallan while (sc->sc_tod == 0) { 821 1.20 macallan cuda_send(sc, 0, 2, cmd); 822 1.1 macallan 823 1.20 macallan while ((sc->sc_tod == 0) && (cnt < 10)) { 824 1.30 macallan mutex_enter(&sc->sc_todevmtx); 825 1.30 macallan cv_timedwait(&sc->sc_todev, &sc->sc_todevmtx, hz); 826 1.30 macallan mutex_exit(&sc->sc_todevmtx); 827 1.30 macallan 828 1.20 macallan cnt++; 829 1.20 macallan } 830 1.20 macallan 831 1.20 macallan if (sc->sc_tod == 0) { 832 1.20 macallan aprint_error_dev(sc->sc_dev, 833 1.20 macallan "unable to read a sane RTC value\n"); 834 1.20 macallan return EIO; 835 1.20 macallan } 836 1.20 macallan if ((sc->sc_tod > 0xf0000000UL) || 837 1.20 macallan (sc->sc_tod < DIFF19041970)) { 838 1.20 macallan /* huh? try again */ 839 1.20 macallan sc->sc_tod = 0; 840 1.20 macallan aprint_verbose_dev(sc->sc_dev, 841 1.20 macallan "got garbage reading RTC, trying again\n"); 842 1.20 macallan } 843 1.1 macallan } 844 1.1 macallan 845 1.1 macallan tvp->tv_sec = sc->sc_tod - DIFF19041970; 846 1.12 macallan DPRINTF("tod: %" PRIo64 "\n", tvp->tv_sec); 847 1.1 macallan tvp->tv_usec = 0; 848 1.1 macallan return 0; 849 1.1 macallan } 850 1.1 macallan 851 1.1 macallan static int 852 1.15 tsutsui cuda_todr_set(todr_chip_handle_t tch, struct timeval *tvp) 853 1.1 macallan { 854 1.31 thorpej struct cuda_softc *sc = device_private(tch->todr_dev); 855 1.1 macallan uint32_t sec; 856 1.1 macallan uint8_t cmd[] = {CUDA_PSEUDO, CMD_WRITE_RTC, 0, 0, 0, 0}; 857 1.1 macallan 858 1.1 macallan sec = tvp->tv_sec + DIFF19041970; 859 1.1 macallan memcpy(&cmd[2], &sec, 4); 860 1.1 macallan sc->sc_tod = 0; 861 1.1 macallan if (cuda_send(sc, 0, 6, cmd) == 0) { 862 1.1 macallan while (sc->sc_tod == 0) { 863 1.30 macallan mutex_enter(&sc->sc_todevmtx); 864 1.30 macallan cv_timedwait(&sc->sc_todev, &sc->sc_todevmtx, hz); 865 1.30 macallan mutex_exit(&sc->sc_todevmtx); 866 1.1 macallan } 867 1.1 macallan return 0; 868 1.1 macallan } 869 1.20 macallan aprint_error_dev(sc->sc_dev, "%s failed\n", __func__); 870 1.1 macallan return -1; 871 1.1 macallan 872 1.1 macallan } 873 1.1 macallan 874 1.1 macallan /* poweroff and reboot */ 875 1.1 macallan 876 1.1 macallan void 877 1.14 cegger cuda_poweroff(void) 878 1.1 macallan { 879 1.1 macallan struct cuda_softc *sc; 880 1.1 macallan uint8_t cmd[] = {CUDA_PSEUDO, CMD_POWEROFF}; 881 1.1 macallan 882 1.1 macallan if (cuda0 == NULL) 883 1.1 macallan return; 884 1.1 macallan sc = cuda0->cookie; 885 1.1 macallan sc->sc_polling = 1; 886 1.1 macallan cuda0->poll(sc); 887 1.1 macallan if (cuda0->send(sc, 1, 2, cmd) == 0) 888 1.1 macallan while (1); 889 1.1 macallan } 890 1.1 macallan 891 1.1 macallan void 892 1.14 cegger cuda_restart(void) 893 1.1 macallan { 894 1.1 macallan struct cuda_softc *sc; 895 1.1 macallan uint8_t cmd[] = {CUDA_PSEUDO, CMD_RESET}; 896 1.1 macallan 897 1.1 macallan if (cuda0 == NULL) 898 1.1 macallan return; 899 1.1 macallan sc = cuda0->cookie; 900 1.1 macallan sc->sc_polling = 1; 901 1.1 macallan cuda0->poll(sc); 902 1.1 macallan if (cuda0->send(sc, 1, 2, cmd) == 0) 903 1.1 macallan while (1); 904 1.1 macallan } 905 1.1 macallan 906 1.1 macallan /* ADB message handling */ 907 1.1 macallan 908 1.1 macallan static void 909 1.1 macallan cuda_autopoll(void *cookie, int flag) 910 1.1 macallan { 911 1.1 macallan struct cuda_softc *sc = cookie; 912 1.1 macallan uint8_t cmd[] = {CUDA_PSEUDO, CMD_AUTOPOLL, (flag != 0)}; 913 1.1 macallan 914 1.1 macallan if (cmd[2] == sc->sc_autopoll) 915 1.1 macallan return; 916 1.1 macallan 917 1.1 macallan sc->sc_autopoll = -1; 918 1.1 macallan cuda_send(sc, 0, 3, cmd); 919 1.1 macallan while(sc->sc_autopoll == -1) { 920 1.1 macallan if (sc->sc_polling || cold) { 921 1.1 macallan cuda_poll(sc); 922 1.30 macallan } else { 923 1.30 macallan mutex_enter(&sc->sc_todevmtx); 924 1.30 macallan cv_timedwait(&sc->sc_todev, &sc->sc_todevmtx, hz); 925 1.30 macallan mutex_exit(&sc->sc_todevmtx); 926 1.30 macallan } 927 1.1 macallan } 928 1.1 macallan } 929 1.1 macallan 930 1.1 macallan static int 931 1.1 macallan cuda_adb_handler(void *cookie, int len, uint8_t *data) 932 1.1 macallan { 933 1.1 macallan struct cuda_softc *sc = cookie; 934 1.1 macallan 935 1.1 macallan if (sc->sc_adb_handler != NULL) { 936 1.1 macallan sc->sc_adb_handler(sc->sc_adb_cookie, len - 1, 937 1.1 macallan &data[1]); 938 1.1 macallan return 0; 939 1.1 macallan } 940 1.1 macallan return -1; 941 1.1 macallan } 942 1.1 macallan 943 1.1 macallan static int 944 1.1 macallan cuda_adb_send(void *cookie, int poll, int command, int len, uint8_t *data) 945 1.1 macallan { 946 1.1 macallan struct cuda_softc *sc = cookie; 947 1.1 macallan int i, s = 0; 948 1.1 macallan uint8_t packet[16]; 949 1.1 macallan 950 1.1 macallan /* construct an ADB command packet and send it */ 951 1.1 macallan packet[0] = CUDA_ADB; 952 1.1 macallan packet[1] = command; 953 1.1 macallan for (i = 0; i < len; i++) 954 1.1 macallan packet[i + 2] = data[i]; 955 1.1 macallan if (poll || cold) { 956 1.1 macallan s = splhigh(); 957 1.1 macallan cuda_poll(sc); 958 1.1 macallan } 959 1.1 macallan cuda_send(sc, poll, len + 2, packet); 960 1.1 macallan if (poll || cold) { 961 1.1 macallan cuda_poll(sc); 962 1.1 macallan splx(s); 963 1.1 macallan } 964 1.1 macallan return 0; 965 1.1 macallan } 966 1.1 macallan 967 1.1 macallan static int 968 1.1 macallan cuda_adb_set_handler(void *cookie, void (*handler)(void *, int, uint8_t *), 969 1.1 macallan void *hcookie) 970 1.1 macallan { 971 1.1 macallan struct cuda_softc *sc = cookie; 972 1.1 macallan 973 1.1 macallan /* register a callback for incoming ADB messages */ 974 1.1 macallan sc->sc_adb_handler = handler; 975 1.1 macallan sc->sc_adb_cookie = hcookie; 976 1.1 macallan return 0; 977 1.1 macallan } 978 1.1 macallan 979 1.1 macallan /* i2c message handling */ 980 1.1 macallan 981 1.1 macallan static int 982 1.1 macallan cuda_i2c_exec(void *cookie, i2c_op_t op, i2c_addr_t addr, const void *_send, 983 1.1 macallan size_t send_len, void *_recv, size_t recv_len, int flags) 984 1.1 macallan { 985 1.1 macallan struct cuda_softc *sc = cookie; 986 1.1 macallan const uint8_t *send = _send; 987 1.1 macallan uint8_t *recv = _recv; 988 1.1 macallan uint8_t command[16] = {CUDA_PSEUDO, CMD_IIC}; 989 1.1 macallan 990 1.1 macallan DPRINTF("cuda_i2c_exec(%02x)\n", addr); 991 1.1 macallan command[2] = addr; 992 1.1 macallan 993 1.13 pgoyette /* Copy command and output data bytes, if any, to buffer */ 994 1.13 pgoyette if (send_len > 0) 995 1.23 riastrad memcpy(&command[3], send, uimin((int)send_len, 12)); 996 1.13 pgoyette else if (I2C_OP_READ_P(op) && (recv_len == 0)) { 997 1.13 pgoyette /* 998 1.13 pgoyette * If no data bytes in either direction, it's a "quick" 999 1.13 pgoyette * i2c operation. We don't know how to do a quick_read 1000 1.13 pgoyette * since that requires us to set the low bit of the 1001 1.13 pgoyette * address byte after it has been left-shifted. 1002 1.13 pgoyette */ 1003 1.13 pgoyette sc->sc_error = 0; 1004 1.13 pgoyette return -1; 1005 1.13 pgoyette } 1006 1.1 macallan 1007 1.1 macallan sc->sc_iic_done = 0; 1008 1.1 macallan cuda_send(sc, sc->sc_polling, send_len + 3, command); 1009 1.1 macallan 1010 1.1 macallan while ((sc->sc_iic_done == 0) && (sc->sc_error == 0)) { 1011 1.1 macallan if (sc->sc_polling || cold) { 1012 1.1 macallan cuda_poll(sc); 1013 1.30 macallan } else { 1014 1.30 macallan mutex_enter(&sc->sc_todevmtx); 1015 1.30 macallan cv_timedwait(&sc->sc_todev, &sc->sc_todevmtx, hz); 1016 1.30 macallan mutex_exit(&sc->sc_todevmtx); 1017 1.30 macallan } 1018 1.1 macallan } 1019 1.1 macallan 1020 1.1 macallan if (sc->sc_error) { 1021 1.1 macallan sc->sc_error = 0; 1022 1.20 macallan aprint_error_dev(sc->sc_dev, "error doing I2C\n"); 1023 1.1 macallan return -1; 1024 1.1 macallan } 1025 1.1 macallan 1026 1.1 macallan /* see if we're supposed to do a read */ 1027 1.1 macallan if (recv_len > 0) { 1028 1.1 macallan sc->sc_iic_done = 0; 1029 1.1 macallan command[2] |= 1; 1030 1.1 macallan command[3] = 0; 1031 1.1 macallan 1032 1.1 macallan /* 1033 1.1 macallan * XXX we need to do something to limit the size of the answer 1034 1.1 macallan * - apparently the chip keeps sending until we tell it to stop 1035 1.1 macallan */ 1036 1.1 macallan sc->sc_i2c_read_len = recv_len; 1037 1.1 macallan DPRINTF("rcv_len: %d\n", recv_len); 1038 1.1 macallan cuda_send(sc, sc->sc_polling, 3, command); 1039 1.1 macallan while ((sc->sc_iic_done == 0) && (sc->sc_error == 0)) { 1040 1.1 macallan if (sc->sc_polling || cold) { 1041 1.1 macallan cuda_poll(sc); 1042 1.30 macallan } else { 1043 1.30 macallan mutex_enter(&sc->sc_todevmtx); 1044 1.30 macallan cv_timedwait(&sc->sc_todev, &sc->sc_todevmtx, hz); 1045 1.30 macallan mutex_exit(&sc->sc_todevmtx); 1046 1.30 macallan } 1047 1.1 macallan } 1048 1.1 macallan 1049 1.1 macallan if (sc->sc_error) { 1050 1.20 macallan aprint_error_dev(sc->sc_dev, 1051 1.20 macallan "error trying to read from I2C\n"); 1052 1.1 macallan sc->sc_error = 0; 1053 1.1 macallan return -1; 1054 1.1 macallan } 1055 1.1 macallan } 1056 1.1 macallan 1057 1.1 macallan DPRINTF("received: %d\n", sc->sc_iic_done); 1058 1.1 macallan if ((sc->sc_iic_done > 3) && (recv_len > 0)) { 1059 1.1 macallan int rlen; 1060 1.1 macallan 1061 1.1 macallan /* we got an answer */ 1062 1.23 riastrad rlen = uimin(sc->sc_iic_done - 3, recv_len); 1063 1.1 macallan memcpy(recv, &sc->sc_in[4], rlen); 1064 1.1 macallan #ifdef CUDA_DEBUG 1065 1.1 macallan { 1066 1.1 macallan int i; 1067 1.1 macallan printf("ret:"); 1068 1.1 macallan for (i = 0; i < rlen; i++) 1069 1.1 macallan printf(" %02x", recv[i]); 1070 1.1 macallan printf("\n"); 1071 1.1 macallan } 1072 1.1 macallan #endif 1073 1.1 macallan return rlen; 1074 1.1 macallan } 1075 1.1 macallan return 0; 1076 1.1 macallan } 1077