xref: /openbmc/linux/drivers/macintosh/via-cuda.c (revision 51d3082fe6e55aecfa17113dbe98077c749f724c)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  * Device driver for the via-cuda on Apple Powermacs.
31da177e4SLinus Torvalds  *
41da177e4SLinus Torvalds  * The VIA (versatile interface adapter) interfaces to the CUDA,
51da177e4SLinus Torvalds  * a 6805 microprocessor core which controls the ADB (Apple Desktop
61da177e4SLinus Torvalds  * Bus) which connects to the keyboard and mouse.  The CUDA also
71da177e4SLinus Torvalds  * controls system power and the RTC (real time clock) chip.
81da177e4SLinus Torvalds  *
91da177e4SLinus Torvalds  * Copyright (C) 1996 Paul Mackerras.
101da177e4SLinus Torvalds  */
111da177e4SLinus Torvalds #include <stdarg.h>
121da177e4SLinus Torvalds #include <linux/config.h>
131da177e4SLinus Torvalds #include <linux/types.h>
141da177e4SLinus Torvalds #include <linux/errno.h>
151da177e4SLinus Torvalds #include <linux/kernel.h>
161da177e4SLinus Torvalds #include <linux/delay.h>
171da177e4SLinus Torvalds #include <linux/sched.h>
181da177e4SLinus Torvalds #include <linux/adb.h>
191da177e4SLinus Torvalds #include <linux/cuda.h>
201da177e4SLinus Torvalds #include <linux/spinlock.h>
211da177e4SLinus Torvalds #include <linux/interrupt.h>
221da177e4SLinus Torvalds #ifdef CONFIG_PPC
231da177e4SLinus Torvalds #include <asm/prom.h>
241da177e4SLinus Torvalds #include <asm/machdep.h>
251da177e4SLinus Torvalds #else
261da177e4SLinus Torvalds #include <asm/macintosh.h>
271da177e4SLinus Torvalds #include <asm/macints.h>
281da177e4SLinus Torvalds #include <asm/machw.h>
291da177e4SLinus Torvalds #include <asm/mac_via.h>
301da177e4SLinus Torvalds #endif
311da177e4SLinus Torvalds #include <asm/io.h>
321da177e4SLinus Torvalds #include <asm/system.h>
331da177e4SLinus Torvalds #include <linux/init.h>
341da177e4SLinus Torvalds 
351da177e4SLinus Torvalds static volatile unsigned char __iomem *via;
361da177e4SLinus Torvalds static DEFINE_SPINLOCK(cuda_lock);
371da177e4SLinus Torvalds 
381da177e4SLinus Torvalds #ifdef CONFIG_MAC
391da177e4SLinus Torvalds #define CUDA_IRQ IRQ_MAC_ADB
401da177e4SLinus Torvalds #define eieio()
411da177e4SLinus Torvalds #else
421da177e4SLinus Torvalds #define CUDA_IRQ vias->intrs[0].line
431da177e4SLinus Torvalds #endif
441da177e4SLinus Torvalds 
451da177e4SLinus Torvalds /* VIA registers - spaced 0x200 bytes apart */
461da177e4SLinus Torvalds #define RS		0x200		/* skip between registers */
471da177e4SLinus Torvalds #define B		0		/* B-side data */
481da177e4SLinus Torvalds #define A		RS		/* A-side data */
491da177e4SLinus Torvalds #define DIRB		(2*RS)		/* B-side direction (1=output) */
501da177e4SLinus Torvalds #define DIRA		(3*RS)		/* A-side direction (1=output) */
511da177e4SLinus Torvalds #define T1CL		(4*RS)		/* Timer 1 ctr/latch (low 8 bits) */
521da177e4SLinus Torvalds #define T1CH		(5*RS)		/* Timer 1 counter (high 8 bits) */
531da177e4SLinus Torvalds #define T1LL		(6*RS)		/* Timer 1 latch (low 8 bits) */
541da177e4SLinus Torvalds #define T1LH		(7*RS)		/* Timer 1 latch (high 8 bits) */
551da177e4SLinus Torvalds #define T2CL		(8*RS)		/* Timer 2 ctr/latch (low 8 bits) */
561da177e4SLinus Torvalds #define T2CH		(9*RS)		/* Timer 2 counter (high 8 bits) */
571da177e4SLinus Torvalds #define SR		(10*RS)		/* Shift register */
581da177e4SLinus Torvalds #define ACR		(11*RS)		/* Auxiliary control register */
591da177e4SLinus Torvalds #define PCR		(12*RS)		/* Peripheral control register */
601da177e4SLinus Torvalds #define IFR		(13*RS)		/* Interrupt flag register */
611da177e4SLinus Torvalds #define IER		(14*RS)		/* Interrupt enable register */
621da177e4SLinus Torvalds #define ANH		(15*RS)		/* A-side data, no handshake */
631da177e4SLinus Torvalds 
641da177e4SLinus Torvalds /* Bits in B data register: all active low */
651da177e4SLinus Torvalds #define TREQ		0x08		/* Transfer request (input) */
661da177e4SLinus Torvalds #define TACK		0x10		/* Transfer acknowledge (output) */
671da177e4SLinus Torvalds #define TIP		0x20		/* Transfer in progress (output) */
681da177e4SLinus Torvalds 
691da177e4SLinus Torvalds /* Bits in ACR */
701da177e4SLinus Torvalds #define SR_CTRL		0x1c		/* Shift register control bits */
711da177e4SLinus Torvalds #define SR_EXT		0x0c		/* Shift on external clock */
721da177e4SLinus Torvalds #define SR_OUT		0x10		/* Shift out if 1 */
731da177e4SLinus Torvalds 
741da177e4SLinus Torvalds /* Bits in IFR and IER */
751da177e4SLinus Torvalds #define IER_SET		0x80		/* set bits in IER */
761da177e4SLinus Torvalds #define IER_CLR		0		/* clear bits in IER */
771da177e4SLinus Torvalds #define SR_INT		0x04		/* Shift register full/empty */
781da177e4SLinus Torvalds 
791da177e4SLinus Torvalds static enum cuda_state {
801da177e4SLinus Torvalds     idle,
811da177e4SLinus Torvalds     sent_first_byte,
821da177e4SLinus Torvalds     sending,
831da177e4SLinus Torvalds     reading,
841da177e4SLinus Torvalds     read_done,
851da177e4SLinus Torvalds     awaiting_reply
861da177e4SLinus Torvalds } cuda_state;
871da177e4SLinus Torvalds 
881da177e4SLinus Torvalds static struct adb_request *current_req;
891da177e4SLinus Torvalds static struct adb_request *last_req;
901da177e4SLinus Torvalds static unsigned char cuda_rbuf[16];
911da177e4SLinus Torvalds static unsigned char *reply_ptr;
921da177e4SLinus Torvalds static int reading_reply;
931da177e4SLinus Torvalds static int data_index;
941da177e4SLinus Torvalds #ifdef CONFIG_PPC
951da177e4SLinus Torvalds static struct device_node *vias;
961da177e4SLinus Torvalds #endif
971da177e4SLinus Torvalds static int cuda_fully_inited = 0;
981da177e4SLinus Torvalds 
991da177e4SLinus Torvalds #ifdef CONFIG_ADB
1001da177e4SLinus Torvalds static int cuda_probe(void);
1011da177e4SLinus Torvalds static int cuda_init(void);
1021da177e4SLinus Torvalds static int cuda_send_request(struct adb_request *req, int sync);
1031da177e4SLinus Torvalds static int cuda_adb_autopoll(int devs);
1041da177e4SLinus Torvalds static int cuda_reset_adb_bus(void);
1051da177e4SLinus Torvalds #endif /* CONFIG_ADB */
1061da177e4SLinus Torvalds 
1071da177e4SLinus Torvalds static int cuda_init_via(void);
1081da177e4SLinus Torvalds static void cuda_start(void);
1091da177e4SLinus Torvalds static irqreturn_t cuda_interrupt(int irq, void *arg, struct pt_regs *regs);
1101da177e4SLinus Torvalds static void cuda_input(unsigned char *buf, int nb, struct pt_regs *regs);
1111da177e4SLinus Torvalds void cuda_poll(void);
1121da177e4SLinus Torvalds static int cuda_write(struct adb_request *req);
1131da177e4SLinus Torvalds 
1141da177e4SLinus Torvalds int cuda_request(struct adb_request *req,
1151da177e4SLinus Torvalds 		 void (*done)(struct adb_request *), int nbytes, ...);
1161da177e4SLinus Torvalds 
1171da177e4SLinus Torvalds #ifdef CONFIG_ADB
1181da177e4SLinus Torvalds struct adb_driver via_cuda_driver = {
1191da177e4SLinus Torvalds 	"CUDA",
1201da177e4SLinus Torvalds 	cuda_probe,
1211da177e4SLinus Torvalds 	cuda_init,
1221da177e4SLinus Torvalds 	cuda_send_request,
1231da177e4SLinus Torvalds 	cuda_adb_autopoll,
1241da177e4SLinus Torvalds 	cuda_poll,
1251da177e4SLinus Torvalds 	cuda_reset_adb_bus
1261da177e4SLinus Torvalds };
1271da177e4SLinus Torvalds #endif /* CONFIG_ADB */
1281da177e4SLinus Torvalds 
1291da177e4SLinus Torvalds #ifdef CONFIG_PPC
130*51d3082fSBenjamin Herrenschmidt int __init find_via_cuda(void)
1311da177e4SLinus Torvalds {
1321da177e4SLinus Torvalds     struct adb_request req;
133*51d3082fSBenjamin Herrenschmidt     phys_addr_t taddr;
134*51d3082fSBenjamin Herrenschmidt     u32 *reg;
135*51d3082fSBenjamin Herrenschmidt     int err;
1361da177e4SLinus Torvalds 
1371da177e4SLinus Torvalds     if (vias != 0)
1381da177e4SLinus Torvalds 	return 1;
139*51d3082fSBenjamin Herrenschmidt     vias = of_find_node_by_name(NULL, "via-cuda");
1401da177e4SLinus Torvalds     if (vias == 0)
1411da177e4SLinus Torvalds 	return 0;
1421da177e4SLinus Torvalds 
143*51d3082fSBenjamin Herrenschmidt     reg = (u32 *)get_property(vias, "reg", NULL);
144*51d3082fSBenjamin Herrenschmidt     if (reg == NULL) {
145*51d3082fSBenjamin Herrenschmidt 	    printk(KERN_ERR "via-cuda: No \"reg\" property !\n");
146*51d3082fSBenjamin Herrenschmidt 	    goto fail;
1471da177e4SLinus Torvalds     }
148*51d3082fSBenjamin Herrenschmidt     taddr = of_translate_address(vias, reg);
149*51d3082fSBenjamin Herrenschmidt     if (taddr == 0) {
150*51d3082fSBenjamin Herrenschmidt 	    printk(KERN_ERR "via-cuda: Can't translate address !\n");
151*51d3082fSBenjamin Herrenschmidt 	    goto fail;
152*51d3082fSBenjamin Herrenschmidt     }
153*51d3082fSBenjamin Herrenschmidt     via = ioremap(taddr, 0x2000);
154*51d3082fSBenjamin Herrenschmidt     if (via == NULL) {
155*51d3082fSBenjamin Herrenschmidt 	    printk(KERN_ERR "via-cuda: Can't map address !\n");
156*51d3082fSBenjamin Herrenschmidt 	    goto fail;
157*51d3082fSBenjamin Herrenschmidt     }
1581da177e4SLinus Torvalds 
1591da177e4SLinus Torvalds     cuda_state = idle;
1601da177e4SLinus Torvalds     sys_ctrler = SYS_CTRLER_CUDA;
1611da177e4SLinus Torvalds 
1621da177e4SLinus Torvalds     err = cuda_init_via();
1631da177e4SLinus Torvalds     if (err) {
1641da177e4SLinus Torvalds 	printk(KERN_ERR "cuda_init_via() failed\n");
1651da177e4SLinus Torvalds 	via = NULL;
1661da177e4SLinus Torvalds 	return 0;
1671da177e4SLinus Torvalds     }
1681da177e4SLinus Torvalds 
1691da177e4SLinus Torvalds     /* Clear and enable interrupts, but only on PPC. On 68K it's done  */
1701da177e4SLinus Torvalds     /* for us by the main VIA driver in arch/m68k/mac/via.c        */
1711da177e4SLinus Torvalds 
1721da177e4SLinus Torvalds #ifndef CONFIG_MAC
1731da177e4SLinus Torvalds     out_8(&via[IFR], 0x7f);	/* clear interrupts by writing 1s */
1741da177e4SLinus Torvalds     out_8(&via[IER], IER_SET|SR_INT); /* enable interrupt from SR */
1751da177e4SLinus Torvalds #endif
1761da177e4SLinus Torvalds 
1771da177e4SLinus Torvalds     /* enable autopoll */
1781da177e4SLinus Torvalds     cuda_request(&req, NULL, 3, CUDA_PACKET, CUDA_AUTOPOLL, 1);
1791da177e4SLinus Torvalds     while (!req.complete)
1801da177e4SLinus Torvalds 	cuda_poll();
1811da177e4SLinus Torvalds 
1821da177e4SLinus Torvalds     return 1;
183*51d3082fSBenjamin Herrenschmidt 
184*51d3082fSBenjamin Herrenschmidt  fail:
185*51d3082fSBenjamin Herrenschmidt     of_node_put(vias);
186*51d3082fSBenjamin Herrenschmidt     vias = NULL;
187*51d3082fSBenjamin Herrenschmidt     return 0;
1881da177e4SLinus Torvalds }
1891da177e4SLinus Torvalds #endif /* CONFIG_PPC */
1901da177e4SLinus Torvalds 
1911da177e4SLinus Torvalds static int __init via_cuda_start(void)
1921da177e4SLinus Torvalds {
1931da177e4SLinus Torvalds     if (via == NULL)
1941da177e4SLinus Torvalds 	return -ENODEV;
1951da177e4SLinus Torvalds 
1961da177e4SLinus Torvalds #ifdef CONFIG_PPC
1971da177e4SLinus Torvalds     request_OF_resource(vias, 0, NULL);
1981da177e4SLinus Torvalds #endif
1991da177e4SLinus Torvalds 
2001da177e4SLinus Torvalds     if (request_irq(CUDA_IRQ, cuda_interrupt, 0, "ADB", cuda_interrupt)) {
2011da177e4SLinus Torvalds 	printk(KERN_ERR "cuda_init: can't get irq %d\n", CUDA_IRQ);
2021da177e4SLinus Torvalds 	return -EAGAIN;
2031da177e4SLinus Torvalds     }
2041da177e4SLinus Torvalds 
2051da177e4SLinus Torvalds     printk("Macintosh CUDA driver v0.5 for Unified ADB.\n");
2061da177e4SLinus Torvalds 
2071da177e4SLinus Torvalds     cuda_fully_inited = 1;
2081da177e4SLinus Torvalds     return 0;
2091da177e4SLinus Torvalds }
2101da177e4SLinus Torvalds 
2111da177e4SLinus Torvalds device_initcall(via_cuda_start);
2121da177e4SLinus Torvalds 
2131da177e4SLinus Torvalds #ifdef CONFIG_ADB
2141da177e4SLinus Torvalds static int
2151da177e4SLinus Torvalds cuda_probe(void)
2161da177e4SLinus Torvalds {
2171da177e4SLinus Torvalds #ifdef CONFIG_PPC
2181da177e4SLinus Torvalds     if (sys_ctrler != SYS_CTRLER_CUDA)
2191da177e4SLinus Torvalds 	return -ENODEV;
2201da177e4SLinus Torvalds #else
2211da177e4SLinus Torvalds     if (macintosh_config->adb_type != MAC_ADB_CUDA)
2221da177e4SLinus Torvalds 	return -ENODEV;
2231da177e4SLinus Torvalds     via = via1;
2241da177e4SLinus Torvalds #endif
2251da177e4SLinus Torvalds     return 0;
2261da177e4SLinus Torvalds }
2271da177e4SLinus Torvalds 
2281da177e4SLinus Torvalds static int __init
2291da177e4SLinus Torvalds cuda_init(void)
2301da177e4SLinus Torvalds {
2311da177e4SLinus Torvalds #ifdef CONFIG_PPC
2321da177e4SLinus Torvalds     if (via == NULL)
2331da177e4SLinus Torvalds 	return -ENODEV;
2341da177e4SLinus Torvalds     return 0;
2351da177e4SLinus Torvalds #else
2361da177e4SLinus Torvalds     int err = cuda_init_via();
2371da177e4SLinus Torvalds     if (err) {
2381da177e4SLinus Torvalds 	printk(KERN_ERR "cuda_init_via() failed\n");
2391da177e4SLinus Torvalds 	return -ENODEV;
2401da177e4SLinus Torvalds     }
2411da177e4SLinus Torvalds 
2421da177e4SLinus Torvalds     return via_cuda_start();
2431da177e4SLinus Torvalds #endif
2441da177e4SLinus Torvalds }
2451da177e4SLinus Torvalds #endif /* CONFIG_ADB */
2461da177e4SLinus Torvalds 
2471da177e4SLinus Torvalds #define WAIT_FOR(cond, what)					\
2481da177e4SLinus Torvalds     do {                                                        \
2491da177e4SLinus Torvalds     	int x;							\
2501da177e4SLinus Torvalds 	for (x = 1000; !(cond); --x) {				\
2511da177e4SLinus Torvalds 	    if (x == 0) {					\
2521da177e4SLinus Torvalds 		printk("Timeout waiting for " what "\n");	\
2531da177e4SLinus Torvalds 		return -ENXIO;					\
2541da177e4SLinus Torvalds 	    }							\
2551da177e4SLinus Torvalds 	    udelay(100);					\
2561da177e4SLinus Torvalds 	}							\
2571da177e4SLinus Torvalds     } while (0)
2581da177e4SLinus Torvalds 
2591da177e4SLinus Torvalds static int
2601da177e4SLinus Torvalds cuda_init_via(void)
2611da177e4SLinus Torvalds {
2621da177e4SLinus Torvalds     out_8(&via[DIRB], (in_8(&via[DIRB]) | TACK | TIP) & ~TREQ);	/* TACK & TIP out */
2631da177e4SLinus Torvalds     out_8(&via[B], in_8(&via[B]) | TACK | TIP);			/* negate them */
2641da177e4SLinus Torvalds     out_8(&via[ACR] ,(in_8(&via[ACR]) & ~SR_CTRL) | SR_EXT);	/* SR data in */
2651da177e4SLinus Torvalds     (void)in_8(&via[SR]);						/* clear any left-over data */
2661da177e4SLinus Torvalds #ifndef CONFIG_MAC
2671da177e4SLinus Torvalds     out_8(&via[IER], 0x7f);					/* disable interrupts from VIA */
2681da177e4SLinus Torvalds     (void)in_8(&via[IER]);
2691da177e4SLinus Torvalds #endif
2701da177e4SLinus Torvalds 
2711da177e4SLinus Torvalds     /* delay 4ms and then clear any pending interrupt */
2721da177e4SLinus Torvalds     mdelay(4);
2731da177e4SLinus Torvalds     (void)in_8(&via[SR]);
2741da177e4SLinus Torvalds     out_8(&via[IFR], in_8(&via[IFR]) & 0x7f);
2751da177e4SLinus Torvalds 
2761da177e4SLinus Torvalds     /* sync with the CUDA - assert TACK without TIP */
2771da177e4SLinus Torvalds     out_8(&via[B], in_8(&via[B]) & ~TACK);
2781da177e4SLinus Torvalds 
2791da177e4SLinus Torvalds     /* wait for the CUDA to assert TREQ in response */
2801da177e4SLinus Torvalds     WAIT_FOR((in_8(&via[B]) & TREQ) == 0, "CUDA response to sync");
2811da177e4SLinus Torvalds 
2821da177e4SLinus Torvalds     /* wait for the interrupt and then clear it */
2831da177e4SLinus Torvalds     WAIT_FOR(in_8(&via[IFR]) & SR_INT, "CUDA response to sync (2)");
2841da177e4SLinus Torvalds     (void)in_8(&via[SR]);
2851da177e4SLinus Torvalds     out_8(&via[IFR], in_8(&via[IFR]) & 0x7f);
2861da177e4SLinus Torvalds 
2871da177e4SLinus Torvalds     /* finish the sync by negating TACK */
2881da177e4SLinus Torvalds     out_8(&via[B], in_8(&via[B]) | TACK);
2891da177e4SLinus Torvalds 
2901da177e4SLinus Torvalds     /* wait for the CUDA to negate TREQ and the corresponding interrupt */
2911da177e4SLinus Torvalds     WAIT_FOR(in_8(&via[B]) & TREQ, "CUDA response to sync (3)");
2921da177e4SLinus Torvalds     WAIT_FOR(in_8(&via[IFR]) & SR_INT, "CUDA response to sync (4)");
2931da177e4SLinus Torvalds     (void)in_8(&via[SR]);
2941da177e4SLinus Torvalds     out_8(&via[IFR], in_8(&via[IFR]) & 0x7f);
2951da177e4SLinus Torvalds     out_8(&via[B], in_8(&via[B]) | TIP);	/* should be unnecessary */
2961da177e4SLinus Torvalds 
2971da177e4SLinus Torvalds     return 0;
2981da177e4SLinus Torvalds }
2991da177e4SLinus Torvalds 
3001da177e4SLinus Torvalds #ifdef CONFIG_ADB
3011da177e4SLinus Torvalds /* Send an ADB command */
3021da177e4SLinus Torvalds static int
3031da177e4SLinus Torvalds cuda_send_request(struct adb_request *req, int sync)
3041da177e4SLinus Torvalds {
3051da177e4SLinus Torvalds     int i;
3061da177e4SLinus Torvalds 
3071da177e4SLinus Torvalds     if ((via == NULL) || !cuda_fully_inited) {
3081da177e4SLinus Torvalds 	req->complete = 1;
3091da177e4SLinus Torvalds 	return -ENXIO;
3101da177e4SLinus Torvalds     }
3111da177e4SLinus Torvalds 
3121da177e4SLinus Torvalds     req->reply_expected = 1;
3131da177e4SLinus Torvalds 
3141da177e4SLinus Torvalds     i = cuda_write(req);
3151da177e4SLinus Torvalds     if (i)
3161da177e4SLinus Torvalds 	return i;
3171da177e4SLinus Torvalds 
3181da177e4SLinus Torvalds     if (sync) {
3191da177e4SLinus Torvalds 	while (!req->complete)
3201da177e4SLinus Torvalds 	    cuda_poll();
3211da177e4SLinus Torvalds     }
3221da177e4SLinus Torvalds     return 0;
3231da177e4SLinus Torvalds }
3241da177e4SLinus Torvalds 
3251da177e4SLinus Torvalds 
3261da177e4SLinus Torvalds /* Enable/disable autopolling */
3271da177e4SLinus Torvalds static int
3281da177e4SLinus Torvalds cuda_adb_autopoll(int devs)
3291da177e4SLinus Torvalds {
3301da177e4SLinus Torvalds     struct adb_request req;
3311da177e4SLinus Torvalds 
3321da177e4SLinus Torvalds     if ((via == NULL) || !cuda_fully_inited)
3331da177e4SLinus Torvalds 	return -ENXIO;
3341da177e4SLinus Torvalds 
3351da177e4SLinus Torvalds     cuda_request(&req, NULL, 3, CUDA_PACKET, CUDA_AUTOPOLL, (devs? 1: 0));
3361da177e4SLinus Torvalds     while (!req.complete)
3371da177e4SLinus Torvalds 	cuda_poll();
3381da177e4SLinus Torvalds     return 0;
3391da177e4SLinus Torvalds }
3401da177e4SLinus Torvalds 
3411da177e4SLinus Torvalds /* Reset adb bus - how do we do this?? */
3421da177e4SLinus Torvalds static int
3431da177e4SLinus Torvalds cuda_reset_adb_bus(void)
3441da177e4SLinus Torvalds {
3451da177e4SLinus Torvalds     struct adb_request req;
3461da177e4SLinus Torvalds 
3471da177e4SLinus Torvalds     if ((via == NULL) || !cuda_fully_inited)
3481da177e4SLinus Torvalds 	return -ENXIO;
3491da177e4SLinus Torvalds 
3501da177e4SLinus Torvalds     cuda_request(&req, NULL, 2, ADB_PACKET, 0);		/* maybe? */
3511da177e4SLinus Torvalds     while (!req.complete)
3521da177e4SLinus Torvalds 	cuda_poll();
3531da177e4SLinus Torvalds     return 0;
3541da177e4SLinus Torvalds }
3551da177e4SLinus Torvalds #endif /* CONFIG_ADB */
3561da177e4SLinus Torvalds /* Construct and send a cuda request */
3571da177e4SLinus Torvalds int
3581da177e4SLinus Torvalds cuda_request(struct adb_request *req, void (*done)(struct adb_request *),
3591da177e4SLinus Torvalds 	     int nbytes, ...)
3601da177e4SLinus Torvalds {
3611da177e4SLinus Torvalds     va_list list;
3621da177e4SLinus Torvalds     int i;
3631da177e4SLinus Torvalds 
3641da177e4SLinus Torvalds     if (via == NULL) {
3651da177e4SLinus Torvalds 	req->complete = 1;
3661da177e4SLinus Torvalds 	return -ENXIO;
3671da177e4SLinus Torvalds     }
3681da177e4SLinus Torvalds 
3691da177e4SLinus Torvalds     req->nbytes = nbytes;
3701da177e4SLinus Torvalds     req->done = done;
3711da177e4SLinus Torvalds     va_start(list, nbytes);
3721da177e4SLinus Torvalds     for (i = 0; i < nbytes; ++i)
3731da177e4SLinus Torvalds 	req->data[i] = va_arg(list, int);
3741da177e4SLinus Torvalds     va_end(list);
3751da177e4SLinus Torvalds     req->reply_expected = 1;
3761da177e4SLinus Torvalds     return cuda_write(req);
3771da177e4SLinus Torvalds }
3781da177e4SLinus Torvalds 
3791da177e4SLinus Torvalds static int
3801da177e4SLinus Torvalds cuda_write(struct adb_request *req)
3811da177e4SLinus Torvalds {
3821da177e4SLinus Torvalds     unsigned long flags;
3831da177e4SLinus Torvalds 
3841da177e4SLinus Torvalds     if (req->nbytes < 2 || req->data[0] > CUDA_PACKET) {
3851da177e4SLinus Torvalds 	req->complete = 1;
3861da177e4SLinus Torvalds 	return -EINVAL;
3871da177e4SLinus Torvalds     }
3881da177e4SLinus Torvalds     req->next = NULL;
3891da177e4SLinus Torvalds     req->sent = 0;
3901da177e4SLinus Torvalds     req->complete = 0;
3911da177e4SLinus Torvalds     req->reply_len = 0;
3921da177e4SLinus Torvalds 
3931da177e4SLinus Torvalds     spin_lock_irqsave(&cuda_lock, flags);
3941da177e4SLinus Torvalds     if (current_req != 0) {
3951da177e4SLinus Torvalds 	last_req->next = req;
3961da177e4SLinus Torvalds 	last_req = req;
3971da177e4SLinus Torvalds     } else {
3981da177e4SLinus Torvalds 	current_req = req;
3991da177e4SLinus Torvalds 	last_req = req;
4001da177e4SLinus Torvalds 	if (cuda_state == idle)
4011da177e4SLinus Torvalds 	    cuda_start();
4021da177e4SLinus Torvalds     }
4031da177e4SLinus Torvalds     spin_unlock_irqrestore(&cuda_lock, flags);
4041da177e4SLinus Torvalds 
4051da177e4SLinus Torvalds     return 0;
4061da177e4SLinus Torvalds }
4071da177e4SLinus Torvalds 
4081da177e4SLinus Torvalds static void
4091da177e4SLinus Torvalds cuda_start(void)
4101da177e4SLinus Torvalds {
4111da177e4SLinus Torvalds     struct adb_request *req;
4121da177e4SLinus Torvalds 
4131da177e4SLinus Torvalds     /* assert cuda_state == idle */
4141da177e4SLinus Torvalds     /* get the packet to send */
4151da177e4SLinus Torvalds     req = current_req;
4161da177e4SLinus Torvalds     if (req == 0)
4171da177e4SLinus Torvalds 	return;
4181da177e4SLinus Torvalds     if ((in_8(&via[B]) & TREQ) == 0)
4191da177e4SLinus Torvalds 	return;			/* a byte is coming in from the CUDA */
4201da177e4SLinus Torvalds 
4211da177e4SLinus Torvalds     /* set the shift register to shift out and send a byte */
4221da177e4SLinus Torvalds     out_8(&via[ACR], in_8(&via[ACR]) | SR_OUT);
4231da177e4SLinus Torvalds     out_8(&via[SR], req->data[0]);
4241da177e4SLinus Torvalds     out_8(&via[B], in_8(&via[B]) & ~TIP);
4251da177e4SLinus Torvalds     cuda_state = sent_first_byte;
4261da177e4SLinus Torvalds }
4271da177e4SLinus Torvalds 
4281da177e4SLinus Torvalds void
4291da177e4SLinus Torvalds cuda_poll(void)
4301da177e4SLinus Torvalds {
4311da177e4SLinus Torvalds     unsigned long flags;
4321da177e4SLinus Torvalds 
4331da177e4SLinus Torvalds     /* cuda_interrupt only takes a normal lock, we disable
4341da177e4SLinus Torvalds      * interrupts here to avoid re-entering and thus deadlocking.
4351da177e4SLinus Torvalds      * An option would be to disable only the IRQ source with
4361da177e4SLinus Torvalds      * disable_irq(), would that work on m68k ? --BenH
4371da177e4SLinus Torvalds      */
4381da177e4SLinus Torvalds     local_irq_save(flags);
4391da177e4SLinus Torvalds     cuda_interrupt(0, NULL, NULL);
4401da177e4SLinus Torvalds     local_irq_restore(flags);
4411da177e4SLinus Torvalds }
4421da177e4SLinus Torvalds 
4431da177e4SLinus Torvalds static irqreturn_t
4441da177e4SLinus Torvalds cuda_interrupt(int irq, void *arg, struct pt_regs *regs)
4451da177e4SLinus Torvalds {
4461da177e4SLinus Torvalds     int status;
4471da177e4SLinus Torvalds     struct adb_request *req = NULL;
4481da177e4SLinus Torvalds     unsigned char ibuf[16];
4491da177e4SLinus Torvalds     int ibuf_len = 0;
4501da177e4SLinus Torvalds     int complete = 0;
4511da177e4SLinus Torvalds     unsigned char virq;
4521da177e4SLinus Torvalds 
4531da177e4SLinus Torvalds     spin_lock(&cuda_lock);
4541da177e4SLinus Torvalds 
4551da177e4SLinus Torvalds     virq = in_8(&via[IFR]) & 0x7f;
4561da177e4SLinus Torvalds     out_8(&via[IFR], virq);
4571da177e4SLinus Torvalds     if ((virq & SR_INT) == 0) {
4581da177e4SLinus Torvalds         spin_unlock(&cuda_lock);
4591da177e4SLinus Torvalds 	return IRQ_NONE;
4601da177e4SLinus Torvalds     }
4611da177e4SLinus Torvalds 
4621da177e4SLinus Torvalds     status = (~in_8(&via[B]) & (TIP|TREQ)) | (in_8(&via[ACR]) & SR_OUT);
4631da177e4SLinus Torvalds     /* printk("cuda_interrupt: state=%d status=%x\n", cuda_state, status); */
4641da177e4SLinus Torvalds     switch (cuda_state) {
4651da177e4SLinus Torvalds     case idle:
4661da177e4SLinus Torvalds 	/* CUDA has sent us the first byte of data - unsolicited */
4671da177e4SLinus Torvalds 	if (status != TREQ)
4681da177e4SLinus Torvalds 	    printk("cuda: state=idle, status=%x\n", status);
4691da177e4SLinus Torvalds 	(void)in_8(&via[SR]);
4701da177e4SLinus Torvalds 	out_8(&via[B], in_8(&via[B]) & ~TIP);
4711da177e4SLinus Torvalds 	cuda_state = reading;
4721da177e4SLinus Torvalds 	reply_ptr = cuda_rbuf;
4731da177e4SLinus Torvalds 	reading_reply = 0;
4741da177e4SLinus Torvalds 	break;
4751da177e4SLinus Torvalds 
4761da177e4SLinus Torvalds     case awaiting_reply:
4771da177e4SLinus Torvalds 	/* CUDA has sent us the first byte of data of a reply */
4781da177e4SLinus Torvalds 	if (status != TREQ)
4791da177e4SLinus Torvalds 	    printk("cuda: state=awaiting_reply, status=%x\n", status);
4801da177e4SLinus Torvalds 	(void)in_8(&via[SR]);
4811da177e4SLinus Torvalds 	out_8(&via[B], in_8(&via[B]) & ~TIP);
4821da177e4SLinus Torvalds 	cuda_state = reading;
4831da177e4SLinus Torvalds 	reply_ptr = current_req->reply;
4841da177e4SLinus Torvalds 	reading_reply = 1;
4851da177e4SLinus Torvalds 	break;
4861da177e4SLinus Torvalds 
4871da177e4SLinus Torvalds     case sent_first_byte:
4881da177e4SLinus Torvalds 	if (status == TREQ + TIP + SR_OUT) {
4891da177e4SLinus Torvalds 	    /* collision */
4901da177e4SLinus Torvalds 	    out_8(&via[ACR], in_8(&via[ACR]) & ~SR_OUT);
4911da177e4SLinus Torvalds 	    (void)in_8(&via[SR]);
4921da177e4SLinus Torvalds 	    out_8(&via[B], in_8(&via[B]) | TIP | TACK);
4931da177e4SLinus Torvalds 	    cuda_state = idle;
4941da177e4SLinus Torvalds 	} else {
4951da177e4SLinus Torvalds 	    /* assert status == TIP + SR_OUT */
4961da177e4SLinus Torvalds 	    if (status != TIP + SR_OUT)
4971da177e4SLinus Torvalds 		printk("cuda: state=sent_first_byte status=%x\n", status);
4981da177e4SLinus Torvalds 	    out_8(&via[SR], current_req->data[1]);
4991da177e4SLinus Torvalds 	    out_8(&via[B], in_8(&via[B]) ^ TACK);
5001da177e4SLinus Torvalds 	    data_index = 2;
5011da177e4SLinus Torvalds 	    cuda_state = sending;
5021da177e4SLinus Torvalds 	}
5031da177e4SLinus Torvalds 	break;
5041da177e4SLinus Torvalds 
5051da177e4SLinus Torvalds     case sending:
5061da177e4SLinus Torvalds 	req = current_req;
5071da177e4SLinus Torvalds 	if (data_index >= req->nbytes) {
5081da177e4SLinus Torvalds 	    out_8(&via[ACR], in_8(&via[ACR]) & ~SR_OUT);
5091da177e4SLinus Torvalds 	    (void)in_8(&via[SR]);
5101da177e4SLinus Torvalds 	    out_8(&via[B], in_8(&via[B]) | TACK | TIP);
5111da177e4SLinus Torvalds 	    req->sent = 1;
5121da177e4SLinus Torvalds 	    if (req->reply_expected) {
5131da177e4SLinus Torvalds 		cuda_state = awaiting_reply;
5141da177e4SLinus Torvalds 	    } else {
5151da177e4SLinus Torvalds 		current_req = req->next;
5161da177e4SLinus Torvalds 		complete = 1;
5171da177e4SLinus Torvalds 		/* not sure about this */
5181da177e4SLinus Torvalds 		cuda_state = idle;
5191da177e4SLinus Torvalds 		cuda_start();
5201da177e4SLinus Torvalds 	    }
5211da177e4SLinus Torvalds 	} else {
5221da177e4SLinus Torvalds 	    out_8(&via[SR], req->data[data_index++]);
5231da177e4SLinus Torvalds 	    out_8(&via[B], in_8(&via[B]) ^ TACK);
5241da177e4SLinus Torvalds 	}
5251da177e4SLinus Torvalds 	break;
5261da177e4SLinus Torvalds 
5271da177e4SLinus Torvalds     case reading:
5281da177e4SLinus Torvalds 	*reply_ptr++ = in_8(&via[SR]);
5291da177e4SLinus Torvalds 	if (status == TIP) {
5301da177e4SLinus Torvalds 	    /* that's all folks */
5311da177e4SLinus Torvalds 	    out_8(&via[B], in_8(&via[B]) | TACK | TIP);
5321da177e4SLinus Torvalds 	    cuda_state = read_done;
5331da177e4SLinus Torvalds 	} else {
5341da177e4SLinus Torvalds 	    /* assert status == TIP | TREQ */
5351da177e4SLinus Torvalds 	    if (status != TIP + TREQ)
5361da177e4SLinus Torvalds 		printk("cuda: state=reading status=%x\n", status);
5371da177e4SLinus Torvalds 	    out_8(&via[B], in_8(&via[B]) ^ TACK);
5381da177e4SLinus Torvalds 	}
5391da177e4SLinus Torvalds 	break;
5401da177e4SLinus Torvalds 
5411da177e4SLinus Torvalds     case read_done:
5421da177e4SLinus Torvalds 	(void)in_8(&via[SR]);
5431da177e4SLinus Torvalds 	if (reading_reply) {
5441da177e4SLinus Torvalds 	    req = current_req;
5451da177e4SLinus Torvalds 	    req->reply_len = reply_ptr - req->reply;
5461da177e4SLinus Torvalds 	    if (req->data[0] == ADB_PACKET) {
5471da177e4SLinus Torvalds 		/* Have to adjust the reply from ADB commands */
5481da177e4SLinus Torvalds 		if (req->reply_len <= 2 || (req->reply[1] & 2) != 0) {
5491da177e4SLinus Torvalds 		    /* the 0x2 bit indicates no response */
5501da177e4SLinus Torvalds 		    req->reply_len = 0;
5511da177e4SLinus Torvalds 		} else {
5521da177e4SLinus Torvalds 		    /* leave just the command and result bytes in the reply */
5531da177e4SLinus Torvalds 		    req->reply_len -= 2;
5541da177e4SLinus Torvalds 		    memmove(req->reply, req->reply + 2, req->reply_len);
5551da177e4SLinus Torvalds 		}
5561da177e4SLinus Torvalds 	    }
5571da177e4SLinus Torvalds 	    current_req = req->next;
5581da177e4SLinus Torvalds 	    complete = 1;
5591da177e4SLinus Torvalds 	} else {
5601da177e4SLinus Torvalds 	    /* This is tricky. We must break the spinlock to call
5611da177e4SLinus Torvalds 	     * cuda_input. However, doing so means we might get
5621da177e4SLinus Torvalds 	     * re-entered from another CPU getting an interrupt
5631da177e4SLinus Torvalds 	     * or calling cuda_poll(). I ended up using the stack
5641da177e4SLinus Torvalds 	     * (it's only for 16 bytes) and moving the actual
5651da177e4SLinus Torvalds 	     * call to cuda_input to outside of the lock.
5661da177e4SLinus Torvalds 	     */
5671da177e4SLinus Torvalds 	    ibuf_len = reply_ptr - cuda_rbuf;
5681da177e4SLinus Torvalds 	    memcpy(ibuf, cuda_rbuf, ibuf_len);
5691da177e4SLinus Torvalds 	}
5701da177e4SLinus Torvalds 	if (status == TREQ) {
5711da177e4SLinus Torvalds 	    out_8(&via[B], in_8(&via[B]) & ~TIP);
5721da177e4SLinus Torvalds 	    cuda_state = reading;
5731da177e4SLinus Torvalds 	    reply_ptr = cuda_rbuf;
5741da177e4SLinus Torvalds 	    reading_reply = 0;
5751da177e4SLinus Torvalds 	} else {
5761da177e4SLinus Torvalds 	    cuda_state = idle;
5771da177e4SLinus Torvalds 	    cuda_start();
5781da177e4SLinus Torvalds 	}
5791da177e4SLinus Torvalds 	break;
5801da177e4SLinus Torvalds 
5811da177e4SLinus Torvalds     default:
5821da177e4SLinus Torvalds 	printk("cuda_interrupt: unknown cuda_state %d?\n", cuda_state);
5831da177e4SLinus Torvalds     }
5841da177e4SLinus Torvalds     spin_unlock(&cuda_lock);
5851da177e4SLinus Torvalds     if (complete && req) {
5861da177e4SLinus Torvalds     	void (*done)(struct adb_request *) = req->done;
5871da177e4SLinus Torvalds     	mb();
5881da177e4SLinus Torvalds     	req->complete = 1;
5891da177e4SLinus Torvalds     	/* Here, we assume that if the request has a done member, the
5901da177e4SLinus Torvalds     	 * struct request will survive to setting req->complete to 1
5911da177e4SLinus Torvalds     	 */
5921da177e4SLinus Torvalds     	if (done)
5931da177e4SLinus Torvalds 		(*done)(req);
5941da177e4SLinus Torvalds     }
5951da177e4SLinus Torvalds     if (ibuf_len)
5961da177e4SLinus Torvalds 	cuda_input(ibuf, ibuf_len, regs);
5971da177e4SLinus Torvalds     return IRQ_HANDLED;
5981da177e4SLinus Torvalds }
5991da177e4SLinus Torvalds 
6001da177e4SLinus Torvalds static void
6011da177e4SLinus Torvalds cuda_input(unsigned char *buf, int nb, struct pt_regs *regs)
6021da177e4SLinus Torvalds {
6031da177e4SLinus Torvalds     int i;
6041da177e4SLinus Torvalds 
6051da177e4SLinus Torvalds     switch (buf[0]) {
6061da177e4SLinus Torvalds     case ADB_PACKET:
6071da177e4SLinus Torvalds #ifdef CONFIG_XMON
6081da177e4SLinus Torvalds 	if (nb == 5 && buf[2] == 0x2c) {
6091da177e4SLinus Torvalds 	    extern int xmon_wants_key, xmon_adb_keycode;
6101da177e4SLinus Torvalds 	    if (xmon_wants_key) {
6111da177e4SLinus Torvalds 		xmon_adb_keycode = buf[3];
6121da177e4SLinus Torvalds 		return;
6131da177e4SLinus Torvalds 	    }
6141da177e4SLinus Torvalds 	}
6151da177e4SLinus Torvalds #endif /* CONFIG_XMON */
6161da177e4SLinus Torvalds #ifdef CONFIG_ADB
6171da177e4SLinus Torvalds 	adb_input(buf+2, nb-2, regs, buf[1] & 0x40);
6181da177e4SLinus Torvalds #endif /* CONFIG_ADB */
6191da177e4SLinus Torvalds 	break;
6201da177e4SLinus Torvalds 
6211da177e4SLinus Torvalds     default:
6221da177e4SLinus Torvalds 	printk("data from cuda (%d bytes):", nb);
6231da177e4SLinus Torvalds 	for (i = 0; i < nb; ++i)
6241da177e4SLinus Torvalds 	    printk(" %.2x", buf[i]);
6251da177e4SLinus Torvalds 	printk("\n");
6261da177e4SLinus Torvalds     }
6271da177e4SLinus Torvalds }
628