Home | History | Annotate | Line # | Download | only in dev
cuda.c revision 1.17.16.1
      1  1.17.16.1     rmind /*	$NetBSD: cuda.c,v 1.17.16.1 2013/08/28 23:59:18 rmind 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.16.1     rmind __KERNEL_RCSID(0, "$NetBSD: cuda.c,v 1.17.16.1 2013/08/28 23:59:18 rmind 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 	volatile int i;
    274        1.1  macallan 	uint8_t reg;
    275        1.1  macallan 
    276        1.1  macallan 	reg = cuda_read_reg(sc, vDirB);
    277        1.1  macallan 	reg |= 0x30;	/* register B bits 4 and 5: outputs */
    278        1.1  macallan 	cuda_write_reg(sc, vDirB, reg);
    279        1.1  macallan 
    280        1.1  macallan 	reg = cuda_read_reg(sc, vDirB);
    281        1.1  macallan 	reg &= 0xf7;	/* register B bit 3: input */
    282        1.1  macallan 	cuda_write_reg(sc, vDirB, reg);
    283        1.1  macallan 
    284        1.1  macallan 	reg = cuda_read_reg(sc, vACR);
    285        1.1  macallan 	reg &= ~vSR_OUT;	/* make sure SR is set to IN */
    286        1.1  macallan 	cuda_write_reg(sc, vACR, reg);
    287        1.1  macallan 
    288        1.1  macallan 	cuda_write_reg(sc, vACR, (cuda_read_reg(sc, vACR) | 0x0c) & ~0x10);
    289        1.1  macallan 
    290        1.1  macallan 	sc->sc_state = CUDA_IDLE;	/* used by all types of hardware */
    291        1.1  macallan 
    292        1.1  macallan 	cuda_write_reg(sc, vIER, 0x84); /* make sure VIA interrupts are on */
    293        1.1  macallan 	cuda_idle(sc);	/* set ADB bus state to idle */
    294        1.1  macallan 
    295        1.1  macallan 	/* sort of a device reset */
    296        1.1  macallan 	i = cuda_read_reg(sc, vSR);	/* clear interrupt */
    297        1.1  macallan 	cuda_write_reg(sc, vIER, 0x04); /* no interrupts while clearing */
    298        1.1  macallan 	cuda_idle(sc);	/* reset state to idle */
    299        1.1  macallan 	delay(150);
    300        1.1  macallan 	cuda_tip(sc);	/* signal start of frame */
    301        1.1  macallan 	delay(150);
    302        1.1  macallan 	cuda_toggle_ack(sc);
    303        1.1  macallan 	delay(150);
    304        1.1  macallan 	cuda_clear_tip(sc);
    305        1.1  macallan 	delay(150);
    306        1.1  macallan 	cuda_idle(sc);	/* back to idle state */
    307        1.1  macallan 	i = cuda_read_reg(sc, vSR);	/* clear interrupt */
    308        1.1  macallan 	cuda_write_reg(sc, vIER, 0x84);	/* ints ok now */
    309        1.1  macallan }
    310        1.1  macallan 
    311        1.1  macallan static void
    312        1.8  macallan cuda_final(device_t dev)
    313        1.1  macallan {
    314        1.8  macallan 	struct cuda_softc *sc = device_private(dev);
    315        1.1  macallan 
    316        1.1  macallan 	sc->sc_polling = 0;
    317        1.1  macallan }
    318        1.1  macallan 
    319        1.1  macallan static inline void
    320        1.1  macallan cuda_write_reg(struct cuda_softc *sc, int offset, uint8_t value)
    321        1.1  macallan {
    322        1.1  macallan 
    323        1.1  macallan 	bus_space_write_1(sc->sc_memt, sc->sc_memh, offset, value);
    324        1.1  macallan }
    325        1.1  macallan 
    326        1.1  macallan static inline uint8_t
    327        1.1  macallan cuda_read_reg(struct cuda_softc *sc, int offset)
    328        1.1  macallan {
    329        1.1  macallan 
    330        1.1  macallan 	return bus_space_read_1(sc->sc_memt, sc->sc_memh, offset);
    331        1.1  macallan }
    332        1.1  macallan 
    333        1.1  macallan static int
    334        1.1  macallan cuda_set_handler(void *cookie, int type,
    335        1.1  macallan     int (*handler)(void *, int, uint8_t *), void *hcookie)
    336        1.1  macallan {
    337        1.1  macallan 	struct cuda_softc *sc = cookie;
    338        1.1  macallan 	CudaHandler *me;
    339        1.1  macallan 
    340        1.1  macallan 	if ((type >= 0) && (type < 16)) {
    341        1.1  macallan 		me = &sc->sc_handlers[type];
    342        1.1  macallan 		me->handler = handler;
    343        1.1  macallan 		me->cookie = hcookie;
    344        1.1  macallan 		return 0;
    345        1.1  macallan 	}
    346        1.1  macallan 	return -1;
    347        1.1  macallan }
    348        1.1  macallan 
    349        1.1  macallan static int
    350        1.1  macallan cuda_send(void *cookie, int poll, int length, uint8_t *msg)
    351        1.1  macallan {
    352        1.1  macallan 	struct cuda_softc *sc = cookie;
    353        1.1  macallan 	int s;
    354        1.1  macallan 
    355        1.1  macallan 	DPRINTF("cuda_send %08x\n", (uint32_t)cookie);
    356        1.1  macallan 	if (sc->sc_state == CUDA_NOTREADY)
    357        1.1  macallan 		return -1;
    358        1.1  macallan 
    359        1.1  macallan 	s = splhigh();
    360        1.1  macallan 
    361  1.17.16.1     rmind 	if (sc->sc_state == CUDA_IDLE /*&&
    362  1.17.16.1     rmind 	    (cuda_read_reg(sc, vBufB) & vPB3) == vPB3*/) {
    363        1.1  macallan 		/* fine */
    364        1.1  macallan 		DPRINTF("chip is idle\n");
    365        1.1  macallan 	} else {
    366        1.1  macallan 		DPRINTF("cuda state is %d\n", sc->sc_state);
    367        1.1  macallan 		if (sc->sc_waiting == 0) {
    368        1.1  macallan 			sc->sc_waiting = 1;
    369        1.1  macallan 		} else {
    370        1.1  macallan 			splx(s);
    371        1.1  macallan 			return -1;
    372        1.1  macallan 		}
    373        1.1  macallan 	}
    374        1.1  macallan 
    375        1.1  macallan 	sc->sc_error = 0;
    376        1.1  macallan 	memcpy(sc->sc_out, msg, length);
    377        1.1  macallan 	sc->sc_out_length = length;
    378        1.1  macallan 	sc->sc_sent = 0;
    379        1.1  macallan 
    380        1.1  macallan 	if (sc->sc_waiting != 1) {
    381        1.1  macallan 
    382        1.1  macallan 		delay(150);
    383        1.1  macallan 		sc->sc_state = CUDA_OUT;
    384        1.1  macallan 		cuda_out(sc);
    385        1.1  macallan 		cuda_write_reg(sc, vSR, sc->sc_out[0]);
    386        1.1  macallan 		cuda_ack_off(sc);
    387        1.1  macallan 		cuda_tip(sc);
    388        1.1  macallan 	}
    389        1.1  macallan 	sc->sc_waiting = 1;
    390        1.1  macallan 
    391        1.1  macallan 	if (sc->sc_polling || poll || cold) {
    392        1.1  macallan 		cuda_poll(sc);
    393        1.1  macallan 	}
    394        1.1  macallan 
    395        1.1  macallan 	splx(s);
    396        1.1  macallan 
    397        1.1  macallan 	return 0;
    398        1.1  macallan }
    399        1.1  macallan 
    400        1.1  macallan static void
    401        1.1  macallan cuda_poll(void *cookie)
    402        1.1  macallan {
    403        1.1  macallan 	struct cuda_softc *sc = cookie;
    404        1.2  macallan 	int s;
    405        1.1  macallan 
    406        1.1  macallan 	DPRINTF("polling\n");
    407        1.1  macallan 	while ((sc->sc_state != CUDA_IDLE) ||
    408        1.1  macallan 	       (cuda_intr_state(sc)) ||
    409        1.1  macallan 	       (sc->sc_waiting == 1)) {
    410        1.1  macallan 		if ((cuda_read_reg(sc, vIFR) & vSR_INT) == vSR_INT) {
    411        1.2  macallan 			s = splhigh();
    412        1.1  macallan 			cuda_intr(sc);
    413        1.2  macallan 			splx(s);
    414        1.1  macallan 		}
    415        1.1  macallan 	}
    416        1.1  macallan }
    417        1.1  macallan 
    418        1.1  macallan static void
    419        1.1  macallan cuda_adb_poll(void *cookie)
    420        1.1  macallan {
    421        1.1  macallan 	struct cuda_softc *sc = cookie;
    422        1.2  macallan 	int s;
    423        1.1  macallan 
    424        1.2  macallan 	s = splhigh();
    425        1.1  macallan 	cuda_intr(sc);
    426        1.2  macallan 	splx(s);
    427        1.1  macallan }
    428        1.1  macallan 
    429        1.1  macallan static void
    430        1.1  macallan cuda_idle(struct cuda_softc *sc)
    431        1.1  macallan {
    432        1.1  macallan 	uint8_t reg;
    433        1.1  macallan 
    434        1.1  macallan 	reg = cuda_read_reg(sc, vBufB);
    435        1.1  macallan 	reg |= (vPB4 | vPB5);
    436        1.1  macallan 	cuda_write_reg(sc, vBufB, reg);
    437        1.1  macallan }
    438        1.1  macallan 
    439        1.1  macallan static void
    440        1.1  macallan cuda_tip(struct cuda_softc *sc)
    441        1.1  macallan {
    442        1.1  macallan 	uint8_t reg;
    443        1.1  macallan 
    444        1.1  macallan 	reg = cuda_read_reg(sc, vBufB);
    445        1.1  macallan 	reg &= ~vPB5;
    446        1.1  macallan 	cuda_write_reg(sc, vBufB, reg);
    447        1.1  macallan }
    448        1.1  macallan 
    449        1.1  macallan static void
    450        1.1  macallan cuda_clear_tip(struct cuda_softc *sc)
    451        1.1  macallan {
    452        1.1  macallan 	uint8_t reg;
    453        1.1  macallan 
    454        1.1  macallan 	reg = cuda_read_reg(sc, vBufB);
    455        1.1  macallan 	reg |= vPB5;
    456        1.1  macallan 	cuda_write_reg(sc, vBufB, reg);
    457        1.1  macallan }
    458        1.1  macallan 
    459        1.1  macallan static void
    460        1.1  macallan cuda_in(struct cuda_softc *sc)
    461        1.1  macallan {
    462        1.1  macallan 	uint8_t reg;
    463        1.1  macallan 
    464        1.1  macallan 	reg = cuda_read_reg(sc, vACR);
    465        1.1  macallan 	reg &= ~vSR_OUT;
    466        1.1  macallan 	cuda_write_reg(sc, vACR, reg);
    467        1.1  macallan }
    468        1.1  macallan 
    469        1.1  macallan static void
    470        1.1  macallan cuda_out(struct cuda_softc *sc)
    471        1.1  macallan {
    472        1.1  macallan 	uint8_t reg;
    473        1.1  macallan 
    474        1.1  macallan 	reg = cuda_read_reg(sc, vACR);
    475        1.1  macallan 	reg |= vSR_OUT;
    476        1.1  macallan 	cuda_write_reg(sc, vACR, reg);
    477        1.1  macallan }
    478        1.1  macallan 
    479        1.1  macallan static void
    480        1.1  macallan cuda_toggle_ack(struct cuda_softc *sc)
    481        1.1  macallan {
    482        1.1  macallan 	uint8_t reg;
    483        1.1  macallan 
    484        1.1  macallan 	reg = cuda_read_reg(sc, vBufB);
    485        1.1  macallan 	reg ^= vPB4;
    486        1.1  macallan 	cuda_write_reg(sc, vBufB, reg);
    487        1.1  macallan }
    488        1.1  macallan 
    489        1.1  macallan static void
    490        1.1  macallan cuda_ack_off(struct cuda_softc *sc)
    491        1.1  macallan {
    492        1.1  macallan 	uint8_t reg;
    493        1.1  macallan 
    494        1.1  macallan 	reg = cuda_read_reg(sc, vBufB);
    495        1.1  macallan 	reg |= vPB4;
    496        1.1  macallan 	cuda_write_reg(sc, vBufB, reg);
    497        1.1  macallan }
    498        1.1  macallan 
    499        1.1  macallan static int
    500        1.1  macallan cuda_intr_state(struct cuda_softc *sc)
    501        1.1  macallan {
    502        1.1  macallan 	return ((cuda_read_reg(sc, vBufB) & vPB3) == 0);
    503        1.1  macallan }
    504        1.1  macallan 
    505        1.1  macallan static int
    506        1.1  macallan cuda_intr(void *arg)
    507        1.1  macallan {
    508        1.1  macallan 	struct cuda_softc *sc = arg;
    509        1.1  macallan 	int i, ending, type;
    510        1.1  macallan 	uint8_t reg;
    511        1.1  macallan 
    512        1.1  macallan 	reg = cuda_read_reg(sc, vIFR);		/* Read the interrupts */
    513        1.2  macallan 	DPRINTF("[");
    514        1.1  macallan 	if ((reg & 0x80) == 0) {
    515        1.2  macallan 		DPRINTF("irq %02x]", reg);
    516        1.1  macallan 		return 0;			/* No interrupts to process */
    517        1.1  macallan 	}
    518        1.1  macallan 	DPRINTF(":");
    519        1.1  macallan 
    520        1.2  macallan 	cuda_write_reg(sc, vIFR, 0x7f);	/* Clear 'em */
    521        1.1  macallan 
    522        1.1  macallan switch_start:
    523        1.1  macallan 	switch (sc->sc_state) {
    524        1.1  macallan 	case CUDA_IDLE:
    525        1.1  macallan 		/*
    526        1.1  macallan 		 * This is an unexpected packet, so grab the first (dummy)
    527        1.1  macallan 		 * byte, set up the proper vars, and tell the chip we are
    528        1.1  macallan 		 * starting to receive the packet by setting the TIP bit.
    529        1.1  macallan 		 */
    530        1.1  macallan 		sc->sc_in[1] = cuda_read_reg(sc, vSR);
    531        1.1  macallan 		DPRINTF("start: %02x", sc->sc_in[1]);
    532        1.1  macallan 		if (cuda_intr_state(sc) == 0) {
    533        1.1  macallan 			/* must have been a fake start */
    534        1.1  macallan 			DPRINTF(" ... fake start\n");
    535        1.1  macallan 			if (sc->sc_waiting) {
    536        1.1  macallan 				/* start over */
    537        1.1  macallan 				delay(150);
    538        1.1  macallan 				sc->sc_state = CUDA_OUT;
    539        1.1  macallan 				sc->sc_sent = 0;
    540        1.1  macallan 				cuda_out(sc);
    541        1.1  macallan 				cuda_write_reg(sc, vSR, sc->sc_out[1]);
    542        1.1  macallan 				cuda_ack_off(sc);
    543        1.1  macallan 				cuda_tip(sc);
    544        1.1  macallan 			}
    545        1.1  macallan 			break;
    546        1.1  macallan 		}
    547        1.1  macallan 
    548        1.1  macallan 		cuda_in(sc);
    549        1.1  macallan 		cuda_tip(sc);
    550        1.1  macallan 
    551        1.1  macallan 		sc->sc_received = 1;
    552        1.1  macallan 		sc->sc_state = CUDA_IN;
    553        1.1  macallan 		DPRINTF(" CUDA_IN");
    554        1.1  macallan 		break;
    555        1.1  macallan 
    556        1.1  macallan 	case CUDA_IN:
    557        1.1  macallan 		sc->sc_in[sc->sc_received] = cuda_read_reg(sc, vSR);
    558        1.1  macallan 		DPRINTF(" %02x", sc->sc_in[sc->sc_received]);
    559        1.1  macallan 		ending = 0;
    560        1.1  macallan 		if (sc->sc_received > 255) {
    561        1.1  macallan 			/* bitch only once */
    562        1.1  macallan 			if (sc->sc_received == 256) {
    563        1.1  macallan 				printf("%s: input overflow\n",
    564        1.8  macallan 				    device_xname(sc->sc_dev));
    565        1.1  macallan 				ending = 1;
    566        1.1  macallan 			}
    567        1.1  macallan 		} else
    568        1.1  macallan 			sc->sc_received++;
    569        1.1  macallan 		if (sc->sc_received > 3) {
    570        1.1  macallan 			if ((sc->sc_in[3] == CMD_IIC) &&
    571        1.1  macallan 			    (sc->sc_received > (sc->sc_i2c_read_len + 4))) {
    572        1.1  macallan 				ending = 1;
    573        1.1  macallan 			}
    574        1.1  macallan 		}
    575        1.1  macallan 
    576        1.1  macallan 		/* intr off means this is the last byte (end of frame) */
    577        1.1  macallan 		if (cuda_intr_state(sc) == 0) {
    578        1.1  macallan 			ending = 1;
    579        1.1  macallan 			DPRINTF(".\n");
    580        1.1  macallan 		} else {
    581        1.1  macallan 			cuda_toggle_ack(sc);
    582        1.1  macallan 		}
    583        1.1  macallan 
    584        1.1  macallan 		if (ending == 1) {	/* end of message? */
    585        1.1  macallan 
    586        1.1  macallan 			sc->sc_in[0] = sc->sc_received - 1;
    587        1.1  macallan 
    588        1.1  macallan 			/* reset vars and signal the end of this frame */
    589        1.1  macallan 			cuda_idle(sc);
    590        1.1  macallan 
    591        1.1  macallan 			/* check if we have a handler for this message */
    592        1.1  macallan 			type = sc->sc_in[1];
    593        1.1  macallan 			if ((type >= 0) && (type < 16)) {
    594        1.1  macallan 				CudaHandler *me = &sc->sc_handlers[type];
    595        1.1  macallan 
    596        1.1  macallan 				if (me->handler != NULL) {
    597        1.1  macallan 					me->handler(me->cookie,
    598        1.1  macallan 					    sc->sc_received - 1, &sc->sc_in[1]);
    599        1.1  macallan 				} else {
    600        1.1  macallan 					printf("no handler for type %02x\n", type);
    601        1.1  macallan 					panic("barf");
    602        1.1  macallan 				}
    603        1.1  macallan 			}
    604        1.1  macallan 
    605        1.2  macallan 			DPRINTF("CUDA_IDLE");
    606        1.2  macallan 			sc->sc_state = CUDA_IDLE;
    607        1.2  macallan 
    608        1.1  macallan 			sc->sc_received = 0;
    609        1.1  macallan 
    610        1.1  macallan 			/*
    611        1.1  macallan 			 * If there is something waiting to be sent out,
    612        1.2  macallan 			 * set everything up and send the first byte.
    613        1.1  macallan 			 */
    614        1.1  macallan 			if (sc->sc_waiting == 1) {
    615        1.1  macallan 
    616        1.1  macallan 				DPRINTF("pending write\n");
    617        1.1  macallan 				delay(1500);	/* required */
    618        1.1  macallan 				sc->sc_sent = 0;
    619        1.1  macallan 				sc->sc_state = CUDA_OUT;
    620        1.1  macallan 
    621        1.1  macallan 				/*
    622        1.1  macallan 				 * If the interrupt is on, we were too slow
    623        1.1  macallan 				 * and the chip has already started to send
    624        1.1  macallan 				 * something to us, so back out of the write
    625        1.1  macallan 				 * and start a read cycle.
    626        1.1  macallan 				 */
    627        1.1  macallan 				if (cuda_intr_state(sc)) {
    628        1.1  macallan 					cuda_in(sc);
    629        1.1  macallan 					cuda_idle(sc);
    630        1.1  macallan 					sc->sc_sent = 0;
    631        1.1  macallan 					sc->sc_state = CUDA_IDLE;
    632        1.1  macallan 					sc->sc_received = 0;
    633        1.1  macallan 					delay(150);
    634        1.1  macallan 					DPRINTF("too slow - incoming message\n");
    635        1.1  macallan 					goto switch_start;
    636        1.1  macallan 				}
    637        1.1  macallan 				/*
    638        1.1  macallan 				 * If we got here, it's ok to start sending
    639        1.1  macallan 				 * so load the first byte and tell the chip
    640        1.1  macallan 				 * we want to send.
    641        1.1  macallan 				 */
    642        1.2  macallan 				DPRINTF("sending ");
    643        1.2  macallan 
    644        1.1  macallan 				cuda_out(sc);
    645        1.1  macallan 				cuda_write_reg(sc, vSR,
    646        1.1  macallan 				    sc->sc_out[sc->sc_sent]);
    647        1.2  macallan 				cuda_ack_off(sc);
    648        1.2  macallan 				cuda_tip(sc);
    649        1.1  macallan 			}
    650        1.1  macallan 		}
    651        1.1  macallan 		break;
    652        1.1  macallan 
    653        1.1  macallan 	case CUDA_OUT:
    654        1.1  macallan 		i = cuda_read_reg(sc, vSR);	/* reset SR-intr in IFR */
    655        1.1  macallan 
    656        1.1  macallan 		sc->sc_sent++;
    657        1.1  macallan 		if (cuda_intr_state(sc)) {	/* ADB intr low during write */
    658        1.1  macallan 
    659        1.1  macallan 			DPRINTF("incoming msg during send\n");
    660        1.1  macallan 			cuda_in(sc);	/* make sure SR is set to IN */
    661        1.1  macallan 			cuda_idle(sc);
    662        1.1  macallan 			sc->sc_sent = 0;	/* must start all over */
    663        1.1  macallan 			sc->sc_state = CUDA_IDLE;	/* new state */
    664        1.1  macallan 			sc->sc_received = 0;
    665        1.1  macallan 			sc->sc_waiting = 1;	/* must retry when done with
    666        1.1  macallan 						 * read */
    667        1.1  macallan 			delay(150);
    668        1.1  macallan 			goto switch_start;	/* process next state right
    669        1.1  macallan 						 * now */
    670        1.1  macallan 			break;
    671        1.1  macallan 		}
    672        1.1  macallan 		if (sc->sc_out_length == sc->sc_sent) {	/* check for done */
    673        1.1  macallan 
    674        1.1  macallan 			sc->sc_waiting = 0;	/* done writing */
    675        1.1  macallan 			sc->sc_state = CUDA_IDLE;	/* signal bus is idle */
    676        1.1  macallan 			cuda_in(sc);
    677        1.1  macallan 			cuda_idle(sc);
    678        1.1  macallan 			DPRINTF("done sending\n");
    679        1.1  macallan 		} else {
    680        1.1  macallan 			/* send next byte */
    681        1.1  macallan 			cuda_write_reg(sc, vSR, sc->sc_out[sc->sc_sent]);
    682        1.1  macallan 			cuda_toggle_ack(sc);	/* signal byte ready to
    683        1.1  macallan 							 * shift */
    684        1.1  macallan 		}
    685        1.1  macallan 		break;
    686        1.1  macallan 
    687        1.1  macallan 	case CUDA_NOTREADY:
    688        1.1  macallan 		DPRINTF("adb: not yet initialized\n");
    689        1.1  macallan 		break;
    690        1.1  macallan 
    691        1.1  macallan 	default:
    692        1.1  macallan 		DPRINTF("intr: unknown ADB state\n");
    693        1.1  macallan 		break;
    694        1.1  macallan 	}
    695        1.1  macallan 
    696        1.2  macallan 	DPRINTF("]");
    697        1.1  macallan 	return 1;
    698        1.1  macallan }
    699        1.1  macallan 
    700        1.1  macallan static int
    701        1.1  macallan cuda_error_handler(void *cookie, int len, uint8_t *data)
    702        1.1  macallan {
    703        1.1  macallan 	struct cuda_softc *sc = cookie;
    704        1.1  macallan 
    705        1.1  macallan 	/*
    706        1.1  macallan 	 * something went wrong
    707        1.1  macallan 	 * byte 3 seems to be the failed command
    708        1.1  macallan 	 */
    709        1.1  macallan 	sc->sc_error = 1;
    710        1.1  macallan 	wakeup(&sc->sc_todev);
    711        1.1  macallan 	return 0;
    712        1.1  macallan }
    713        1.1  macallan 
    714        1.1  macallan 
    715        1.1  macallan /* real time clock */
    716        1.1  macallan 
    717        1.1  macallan static int
    718        1.1  macallan cuda_todr_handler(void *cookie, int len, uint8_t *data)
    719        1.1  macallan {
    720        1.1  macallan 	struct cuda_softc *sc = cookie;
    721        1.1  macallan 
    722        1.1  macallan #ifdef CUDA_DEBUG
    723        1.1  macallan 	int i;
    724        1.1  macallan 	printf("msg: %02x", data[0]);
    725        1.1  macallan 	for (i = 1; i < len; i++) {
    726        1.1  macallan 		printf(" %02x", data[i]);
    727        1.1  macallan 	}
    728        1.1  macallan 	printf("\n");
    729        1.1  macallan #endif
    730        1.1  macallan 
    731        1.1  macallan 	switch(data[2]) {
    732        1.1  macallan 		case CMD_READ_RTC:
    733        1.1  macallan 			memcpy(&sc->sc_tod, &data[3], 4);
    734        1.1  macallan 			break;
    735        1.1  macallan 		case CMD_WRITE_RTC:
    736        1.1  macallan 			sc->sc_tod = 0xffffffff;
    737        1.1  macallan 			break;
    738        1.1  macallan 		case CMD_AUTOPOLL:
    739        1.1  macallan 			sc->sc_autopoll = 1;
    740        1.1  macallan 			break;
    741        1.1  macallan 		case CMD_IIC:
    742        1.1  macallan 			sc->sc_iic_done = len;
    743        1.1  macallan 			break;
    744        1.1  macallan 	}
    745        1.1  macallan 	wakeup(&sc->sc_todev);
    746        1.1  macallan 	return 0;
    747        1.1  macallan }
    748        1.1  macallan 
    749        1.1  macallan #define DIFF19041970 2082844800
    750        1.1  macallan 
    751        1.1  macallan static int
    752       1.15   tsutsui cuda_todr_get(todr_chip_handle_t tch, struct timeval *tvp)
    753        1.1  macallan {
    754        1.1  macallan 	struct cuda_softc *sc = tch->cookie;
    755        1.1  macallan 	int cnt = 0;
    756        1.1  macallan 	uint8_t cmd[] = { CUDA_PSEUDO, CMD_READ_RTC};
    757        1.1  macallan 
    758        1.1  macallan 	sc->sc_tod = 0;
    759        1.1  macallan 	cuda_send(sc, 0, 2, cmd);
    760        1.1  macallan 
    761        1.1  macallan 	while ((sc->sc_tod == 0) && (cnt < 10)) {
    762        1.1  macallan 		tsleep(&sc->sc_todev, 0, "todr", 10);
    763        1.1  macallan 		cnt++;
    764        1.1  macallan 	}
    765        1.1  macallan 
    766        1.1  macallan 	if (sc->sc_tod == 0)
    767        1.1  macallan 		return EIO;
    768        1.1  macallan 
    769        1.1  macallan 	tvp->tv_sec = sc->sc_tod - DIFF19041970;
    770       1.12  macallan 	DPRINTF("tod: %" PRIo64 "\n", tvp->tv_sec);
    771        1.1  macallan 	tvp->tv_usec = 0;
    772        1.1  macallan 	return 0;
    773        1.1  macallan }
    774        1.1  macallan 
    775        1.1  macallan static int
    776       1.15   tsutsui cuda_todr_set(todr_chip_handle_t tch, struct timeval *tvp)
    777        1.1  macallan {
    778        1.1  macallan 	struct cuda_softc *sc = tch->cookie;
    779        1.1  macallan 	uint32_t sec;
    780        1.1  macallan 	uint8_t cmd[] = {CUDA_PSEUDO, CMD_WRITE_RTC, 0, 0, 0, 0};
    781        1.1  macallan 
    782        1.1  macallan 	sec = tvp->tv_sec + DIFF19041970;
    783        1.1  macallan 	memcpy(&cmd[2], &sec, 4);
    784        1.1  macallan 	sc->sc_tod = 0;
    785        1.1  macallan 	if (cuda_send(sc, 0, 6, cmd) == 0) {
    786        1.1  macallan 		while (sc->sc_tod == 0) {
    787        1.1  macallan 			tsleep(&sc->sc_todev, 0, "todr", 10);
    788        1.1  macallan 		}
    789        1.1  macallan 		return 0;
    790        1.1  macallan 	}
    791        1.1  macallan 	return -1;
    792        1.1  macallan 
    793        1.1  macallan }
    794        1.1  macallan 
    795        1.1  macallan /* poweroff and reboot */
    796        1.1  macallan 
    797        1.1  macallan void
    798       1.14    cegger cuda_poweroff(void)
    799        1.1  macallan {
    800        1.1  macallan 	struct cuda_softc *sc;
    801        1.1  macallan 	uint8_t cmd[] = {CUDA_PSEUDO, CMD_POWEROFF};
    802        1.1  macallan 
    803        1.1  macallan 	if (cuda0 == NULL)
    804        1.1  macallan 		return;
    805        1.1  macallan 	sc = cuda0->cookie;
    806        1.1  macallan 	sc->sc_polling = 1;
    807        1.1  macallan 	cuda0->poll(sc);
    808        1.1  macallan 	if (cuda0->send(sc, 1, 2, cmd) == 0)
    809        1.1  macallan 		while (1);
    810        1.1  macallan }
    811        1.1  macallan 
    812        1.1  macallan void
    813       1.14    cegger cuda_restart(void)
    814        1.1  macallan {
    815        1.1  macallan 	struct cuda_softc *sc;
    816        1.1  macallan 	uint8_t cmd[] = {CUDA_PSEUDO, CMD_RESET};
    817        1.1  macallan 
    818        1.1  macallan 	if (cuda0 == NULL)
    819        1.1  macallan 		return;
    820        1.1  macallan 	sc = cuda0->cookie;
    821        1.1  macallan 	sc->sc_polling = 1;
    822        1.1  macallan 	cuda0->poll(sc);
    823        1.1  macallan 	if (cuda0->send(sc, 1, 2, cmd) == 0)
    824        1.1  macallan 		while (1);
    825        1.1  macallan }
    826        1.1  macallan 
    827        1.1  macallan /* ADB message handling */
    828        1.1  macallan 
    829        1.1  macallan static void
    830        1.1  macallan cuda_autopoll(void *cookie, int flag)
    831        1.1  macallan {
    832        1.1  macallan 	struct cuda_softc *sc = cookie;
    833        1.1  macallan 	uint8_t cmd[] = {CUDA_PSEUDO, CMD_AUTOPOLL, (flag != 0)};
    834        1.1  macallan 
    835        1.1  macallan 	if (cmd[2] == sc->sc_autopoll)
    836        1.1  macallan 		return;
    837        1.1  macallan 
    838        1.1  macallan 	sc->sc_autopoll = -1;
    839        1.1  macallan 	cuda_send(sc, 0, 3, cmd);
    840        1.1  macallan 	while(sc->sc_autopoll == -1) {
    841        1.1  macallan 		if (sc->sc_polling || cold) {
    842        1.1  macallan 			cuda_poll(sc);
    843        1.1  macallan 		} else
    844        1.1  macallan 			tsleep(&sc->sc_todev, 0, "autopoll", 100);
    845        1.1  macallan 	}
    846        1.1  macallan }
    847        1.1  macallan 
    848        1.1  macallan static int
    849        1.1  macallan cuda_adb_handler(void *cookie, int len, uint8_t *data)
    850        1.1  macallan {
    851        1.1  macallan 	struct cuda_softc *sc = cookie;
    852        1.1  macallan 
    853        1.1  macallan 	if (sc->sc_adb_handler != NULL) {
    854        1.1  macallan 		sc->sc_adb_handler(sc->sc_adb_cookie, len - 1,
    855        1.1  macallan 		    &data[1]);
    856        1.1  macallan 		return 0;
    857        1.1  macallan 	}
    858        1.1  macallan 	return -1;
    859        1.1  macallan }
    860        1.1  macallan 
    861        1.1  macallan static int
    862        1.1  macallan cuda_adb_send(void *cookie, int poll, int command, int len, uint8_t *data)
    863        1.1  macallan {
    864        1.1  macallan 	struct cuda_softc *sc = cookie;
    865        1.1  macallan 	int i, s = 0;
    866        1.1  macallan 	uint8_t packet[16];
    867        1.1  macallan 
    868        1.1  macallan 	/* construct an ADB command packet and send it */
    869        1.1  macallan 	packet[0] = CUDA_ADB;
    870        1.1  macallan 	packet[1] = command;
    871        1.1  macallan 	for (i = 0; i < len; i++)
    872        1.1  macallan 		packet[i + 2] = data[i];
    873        1.1  macallan 	if (poll || cold) {
    874        1.1  macallan 		s = splhigh();
    875        1.1  macallan 		cuda_poll(sc);
    876        1.1  macallan 	}
    877        1.1  macallan 	cuda_send(sc, poll, len + 2, packet);
    878        1.1  macallan 	if (poll || cold) {
    879        1.1  macallan 		cuda_poll(sc);
    880        1.1  macallan 		splx(s);
    881        1.1  macallan 	}
    882        1.1  macallan 	return 0;
    883        1.1  macallan }
    884        1.1  macallan 
    885        1.1  macallan static int
    886        1.1  macallan cuda_adb_set_handler(void *cookie, void (*handler)(void *, int, uint8_t *),
    887        1.1  macallan     void *hcookie)
    888        1.1  macallan {
    889        1.1  macallan 	struct cuda_softc *sc = cookie;
    890        1.1  macallan 
    891        1.1  macallan 	/* register a callback for incoming ADB messages */
    892        1.1  macallan 	sc->sc_adb_handler = handler;
    893        1.1  macallan 	sc->sc_adb_cookie = hcookie;
    894        1.1  macallan 	return 0;
    895        1.1  macallan }
    896        1.1  macallan 
    897        1.1  macallan /* i2c message handling */
    898        1.1  macallan 
    899        1.1  macallan static int
    900        1.1  macallan cuda_i2c_acquire_bus(void *cookie, int flags)
    901        1.1  macallan {
    902        1.8  macallan 	struct cuda_softc *sc = cookie;
    903        1.8  macallan 
    904        1.8  macallan 	mutex_enter(&sc->sc_buslock);
    905        1.1  macallan 	return 0;
    906        1.1  macallan }
    907        1.1  macallan 
    908        1.1  macallan static void
    909        1.1  macallan cuda_i2c_release_bus(void *cookie, int flags)
    910        1.1  macallan {
    911        1.8  macallan 	struct cuda_softc *sc = cookie;
    912        1.8  macallan 
    913        1.8  macallan 	mutex_exit(&sc->sc_buslock);
    914        1.1  macallan }
    915        1.1  macallan 
    916        1.1  macallan static int
    917        1.1  macallan cuda_i2c_exec(void *cookie, i2c_op_t op, i2c_addr_t addr, const void *_send,
    918        1.1  macallan     size_t send_len, void *_recv, size_t recv_len, int flags)
    919        1.1  macallan {
    920        1.1  macallan 	struct cuda_softc *sc = cookie;
    921        1.1  macallan 	const uint8_t *send = _send;
    922        1.1  macallan 	uint8_t *recv = _recv;
    923        1.1  macallan 	uint8_t command[16] = {CUDA_PSEUDO, CMD_IIC};
    924        1.1  macallan 
    925        1.1  macallan 	DPRINTF("cuda_i2c_exec(%02x)\n", addr);
    926        1.1  macallan 	command[2] = addr;
    927        1.1  macallan 
    928       1.13  pgoyette 	/* Copy command and output data bytes, if any, to buffer */
    929       1.13  pgoyette 	if (send_len > 0)
    930       1.13  pgoyette 		memcpy(&command[3], send, min((int)send_len, 12));
    931       1.13  pgoyette 	else if (I2C_OP_READ_P(op) && (recv_len == 0)) {
    932       1.13  pgoyette 		/*
    933       1.13  pgoyette 		 * If no data bytes in either direction, it's a "quick"
    934       1.13  pgoyette 		 * i2c operation.  We don't know how to do a quick_read
    935       1.13  pgoyette 		 * since that requires us to set the low bit of the
    936       1.13  pgoyette 		 * address byte after it has been left-shifted.
    937       1.13  pgoyette 		 */
    938       1.13  pgoyette 		sc->sc_error = 0;
    939       1.13  pgoyette 		return -1;
    940       1.13  pgoyette 	}
    941        1.1  macallan 
    942        1.1  macallan 	sc->sc_iic_done = 0;
    943        1.1  macallan 	cuda_send(sc, sc->sc_polling, send_len + 3, command);
    944        1.1  macallan 
    945        1.1  macallan 	while ((sc->sc_iic_done == 0) && (sc->sc_error == 0)) {
    946        1.1  macallan 		if (sc->sc_polling || cold) {
    947        1.1  macallan 			cuda_poll(sc);
    948        1.1  macallan 		} else
    949        1.1  macallan 			tsleep(&sc->sc_todev, 0, "i2c", 1000);
    950        1.1  macallan 	}
    951        1.1  macallan 
    952        1.1  macallan 	if (sc->sc_error) {
    953        1.1  macallan 		sc->sc_error = 0;
    954        1.1  macallan 		return -1;
    955        1.1  macallan 	}
    956        1.1  macallan 
    957        1.1  macallan 	/* see if we're supposed to do a read */
    958        1.1  macallan 	if (recv_len > 0) {
    959        1.1  macallan 		sc->sc_iic_done = 0;
    960        1.1  macallan 		command[2] |= 1;
    961        1.1  macallan 		command[3] = 0;
    962        1.1  macallan 
    963        1.1  macallan 		/*
    964        1.1  macallan 		 * XXX we need to do something to limit the size of the answer
    965        1.1  macallan 		 * - apparently the chip keeps sending until we tell it to stop
    966        1.1  macallan 		 */
    967        1.1  macallan 		sc->sc_i2c_read_len = recv_len;
    968        1.1  macallan 		DPRINTF("rcv_len: %d\n", recv_len);
    969        1.1  macallan 		cuda_send(sc, sc->sc_polling, 3, command);
    970        1.1  macallan 		while ((sc->sc_iic_done == 0) && (sc->sc_error == 0)) {
    971        1.1  macallan 			if (sc->sc_polling || cold) {
    972        1.1  macallan 				cuda_poll(sc);
    973        1.1  macallan 			} else
    974        1.1  macallan 				tsleep(&sc->sc_todev, 0, "i2c", 1000);
    975        1.1  macallan 		}
    976        1.1  macallan 
    977        1.1  macallan 		if (sc->sc_error) {
    978        1.1  macallan 			printf("error trying to read\n");
    979        1.1  macallan 			sc->sc_error = 0;
    980        1.1  macallan 			return -1;
    981        1.1  macallan 		}
    982        1.1  macallan 	}
    983        1.1  macallan 
    984        1.1  macallan 	DPRINTF("received: %d\n", sc->sc_iic_done);
    985        1.1  macallan 	if ((sc->sc_iic_done > 3) && (recv_len > 0)) {
    986        1.1  macallan 		int rlen;
    987        1.1  macallan 
    988        1.1  macallan 		/* we got an answer */
    989        1.1  macallan 		rlen = min(sc->sc_iic_done - 3, recv_len);
    990        1.1  macallan 		memcpy(recv, &sc->sc_in[4], rlen);
    991        1.1  macallan #ifdef CUDA_DEBUG
    992        1.1  macallan 		{
    993        1.1  macallan 			int i;
    994        1.1  macallan 			printf("ret:");
    995        1.1  macallan 			for (i = 0; i < rlen; i++)
    996        1.1  macallan 				printf(" %02x", recv[i]);
    997        1.1  macallan 			printf("\n");
    998        1.1  macallan 		}
    999        1.1  macallan #endif
   1000        1.1  macallan 		return rlen;
   1001        1.1  macallan 	}
   1002        1.1  macallan 	return 0;
   1003        1.1  macallan }
   1004