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