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/types.h> 131da177e4SLinus Torvalds #include <linux/errno.h> 141da177e4SLinus Torvalds #include <linux/kernel.h> 151da177e4SLinus Torvalds #include <linux/delay.h> 161da177e4SLinus Torvalds #include <linux/adb.h> 171da177e4SLinus Torvalds #include <linux/cuda.h> 181da177e4SLinus Torvalds #include <linux/spinlock.h> 191da177e4SLinus Torvalds #include <linux/interrupt.h> 201da177e4SLinus Torvalds #ifdef CONFIG_PPC 211da177e4SLinus Torvalds #include <asm/prom.h> 221da177e4SLinus Torvalds #include <asm/machdep.h> 231da177e4SLinus Torvalds #else 241da177e4SLinus Torvalds #include <asm/macintosh.h> 251da177e4SLinus Torvalds #include <asm/macints.h> 261da177e4SLinus Torvalds #include <asm/mac_via.h> 271da177e4SLinus Torvalds #endif 281da177e4SLinus Torvalds #include <asm/io.h> 291da177e4SLinus Torvalds #include <asm/system.h> 301da177e4SLinus Torvalds #include <linux/init.h> 311da177e4SLinus Torvalds 321da177e4SLinus Torvalds static volatile unsigned char __iomem *via; 331da177e4SLinus Torvalds static DEFINE_SPINLOCK(cuda_lock); 341da177e4SLinus Torvalds 351da177e4SLinus Torvalds /* VIA registers - spaced 0x200 bytes apart */ 361da177e4SLinus Torvalds #define RS 0x200 /* skip between registers */ 371da177e4SLinus Torvalds #define B 0 /* B-side data */ 381da177e4SLinus Torvalds #define A RS /* A-side data */ 391da177e4SLinus Torvalds #define DIRB (2*RS) /* B-side direction (1=output) */ 401da177e4SLinus Torvalds #define DIRA (3*RS) /* A-side direction (1=output) */ 411da177e4SLinus Torvalds #define T1CL (4*RS) /* Timer 1 ctr/latch (low 8 bits) */ 421da177e4SLinus Torvalds #define T1CH (5*RS) /* Timer 1 counter (high 8 bits) */ 431da177e4SLinus Torvalds #define T1LL (6*RS) /* Timer 1 latch (low 8 bits) */ 441da177e4SLinus Torvalds #define T1LH (7*RS) /* Timer 1 latch (high 8 bits) */ 451da177e4SLinus Torvalds #define T2CL (8*RS) /* Timer 2 ctr/latch (low 8 bits) */ 461da177e4SLinus Torvalds #define T2CH (9*RS) /* Timer 2 counter (high 8 bits) */ 471da177e4SLinus Torvalds #define SR (10*RS) /* Shift register */ 481da177e4SLinus Torvalds #define ACR (11*RS) /* Auxiliary control register */ 491da177e4SLinus Torvalds #define PCR (12*RS) /* Peripheral control register */ 501da177e4SLinus Torvalds #define IFR (13*RS) /* Interrupt flag register */ 511da177e4SLinus Torvalds #define IER (14*RS) /* Interrupt enable register */ 521da177e4SLinus Torvalds #define ANH (15*RS) /* A-side data, no handshake */ 531da177e4SLinus Torvalds 541da177e4SLinus Torvalds /* Bits in B data register: all active low */ 551da177e4SLinus Torvalds #define TREQ 0x08 /* Transfer request (input) */ 561da177e4SLinus Torvalds #define TACK 0x10 /* Transfer acknowledge (output) */ 571da177e4SLinus Torvalds #define TIP 0x20 /* Transfer in progress (output) */ 581da177e4SLinus Torvalds 591da177e4SLinus Torvalds /* Bits in ACR */ 601da177e4SLinus Torvalds #define SR_CTRL 0x1c /* Shift register control bits */ 611da177e4SLinus Torvalds #define SR_EXT 0x0c /* Shift on external clock */ 621da177e4SLinus Torvalds #define SR_OUT 0x10 /* Shift out if 1 */ 631da177e4SLinus Torvalds 641da177e4SLinus Torvalds /* Bits in IFR and IER */ 651da177e4SLinus Torvalds #define IER_SET 0x80 /* set bits in IER */ 661da177e4SLinus Torvalds #define IER_CLR 0 /* clear bits in IER */ 671da177e4SLinus Torvalds #define SR_INT 0x04 /* Shift register full/empty */ 681da177e4SLinus Torvalds 691da177e4SLinus Torvalds static enum cuda_state { 701da177e4SLinus Torvalds idle, 711da177e4SLinus Torvalds sent_first_byte, 721da177e4SLinus Torvalds sending, 731da177e4SLinus Torvalds reading, 741da177e4SLinus Torvalds read_done, 751da177e4SLinus Torvalds awaiting_reply 761da177e4SLinus Torvalds } cuda_state; 771da177e4SLinus Torvalds 781da177e4SLinus Torvalds static struct adb_request *current_req; 791da177e4SLinus Torvalds static struct adb_request *last_req; 801da177e4SLinus Torvalds static unsigned char cuda_rbuf[16]; 811da177e4SLinus Torvalds static unsigned char *reply_ptr; 821da177e4SLinus Torvalds static int reading_reply; 831da177e4SLinus Torvalds static int data_index; 840251c38cSFinn Thain static int cuda_irq; 851da177e4SLinus Torvalds #ifdef CONFIG_PPC 861da177e4SLinus Torvalds static struct device_node *vias; 871da177e4SLinus Torvalds #endif 8887275856SOlaf Hering static int cuda_fully_inited; 891da177e4SLinus Torvalds 901da177e4SLinus Torvalds #ifdef CONFIG_ADB 911da177e4SLinus Torvalds static int cuda_probe(void); 921da177e4SLinus Torvalds static int cuda_send_request(struct adb_request *req, int sync); 931da177e4SLinus Torvalds static int cuda_adb_autopoll(int devs); 941da177e4SLinus Torvalds static int cuda_reset_adb_bus(void); 951da177e4SLinus Torvalds #endif /* CONFIG_ADB */ 961da177e4SLinus Torvalds 971da177e4SLinus Torvalds static int cuda_init_via(void); 981da177e4SLinus Torvalds static void cuda_start(void); 997d12e780SDavid Howells static irqreturn_t cuda_interrupt(int irq, void *arg); 1007d12e780SDavid Howells static void cuda_input(unsigned char *buf, int nb); 1011da177e4SLinus Torvalds void cuda_poll(void); 1021da177e4SLinus Torvalds static int cuda_write(struct adb_request *req); 1031da177e4SLinus Torvalds 1041da177e4SLinus Torvalds int cuda_request(struct adb_request *req, 1051da177e4SLinus Torvalds void (*done)(struct adb_request *), int nbytes, ...); 1061da177e4SLinus Torvalds 1071da177e4SLinus Torvalds #ifdef CONFIG_ADB 1081da177e4SLinus Torvalds struct adb_driver via_cuda_driver = { 109*18814ee8SFinn Thain .name = "CUDA", 110*18814ee8SFinn Thain .probe = cuda_probe, 111*18814ee8SFinn Thain .send_request = cuda_send_request, 112*18814ee8SFinn Thain .autopoll = cuda_adb_autopoll, 113*18814ee8SFinn Thain .poll = cuda_poll, 114*18814ee8SFinn Thain .reset_bus = cuda_reset_adb_bus, 1151da177e4SLinus Torvalds }; 1161da177e4SLinus Torvalds #endif /* CONFIG_ADB */ 1171da177e4SLinus Torvalds 118*18814ee8SFinn Thain #ifdef CONFIG_MAC 119*18814ee8SFinn Thain int __init find_via_cuda(void) 120*18814ee8SFinn Thain { 121*18814ee8SFinn Thain struct adb_request req; 122*18814ee8SFinn Thain int err; 123*18814ee8SFinn Thain 124*18814ee8SFinn Thain if (macintosh_config->adb_type != MAC_ADB_CUDA) 125*18814ee8SFinn Thain return 0; 126*18814ee8SFinn Thain 127*18814ee8SFinn Thain via = via1; 128*18814ee8SFinn Thain cuda_state = idle; 129*18814ee8SFinn Thain 130*18814ee8SFinn Thain err = cuda_init_via(); 131*18814ee8SFinn Thain if (err) { 132*18814ee8SFinn Thain printk(KERN_ERR "cuda_init_via() failed\n"); 133*18814ee8SFinn Thain via = NULL; 134*18814ee8SFinn Thain return 0; 135*18814ee8SFinn Thain } 136*18814ee8SFinn Thain 137*18814ee8SFinn Thain /* enable autopoll */ 138*18814ee8SFinn Thain cuda_request(&req, NULL, 3, CUDA_PACKET, CUDA_AUTOPOLL, 1); 139*18814ee8SFinn Thain while (!req.complete) 140*18814ee8SFinn Thain cuda_poll(); 141*18814ee8SFinn Thain 142*18814ee8SFinn Thain return 1; 143*18814ee8SFinn Thain } 144*18814ee8SFinn Thain #else 14551d3082fSBenjamin Herrenschmidt int __init find_via_cuda(void) 1461da177e4SLinus Torvalds { 1471da177e4SLinus Torvalds struct adb_request req; 14851d3082fSBenjamin Herrenschmidt phys_addr_t taddr; 149018a3d1dSJeremy Kerr const u32 *reg; 15051d3082fSBenjamin Herrenschmidt int err; 1511da177e4SLinus Torvalds 1521da177e4SLinus Torvalds if (vias != 0) 1531da177e4SLinus Torvalds return 1; 15451d3082fSBenjamin Herrenschmidt vias = of_find_node_by_name(NULL, "via-cuda"); 1551da177e4SLinus Torvalds if (vias == 0) 1561da177e4SLinus Torvalds return 0; 1571da177e4SLinus Torvalds 15801b2726dSStephen Rothwell reg = of_get_property(vias, "reg", NULL); 15951d3082fSBenjamin Herrenschmidt if (reg == NULL) { 16051d3082fSBenjamin Herrenschmidt printk(KERN_ERR "via-cuda: No \"reg\" property !\n"); 16151d3082fSBenjamin Herrenschmidt goto fail; 1621da177e4SLinus Torvalds } 16351d3082fSBenjamin Herrenschmidt taddr = of_translate_address(vias, reg); 16451d3082fSBenjamin Herrenschmidt if (taddr == 0) { 16551d3082fSBenjamin Herrenschmidt printk(KERN_ERR "via-cuda: Can't translate address !\n"); 16651d3082fSBenjamin Herrenschmidt goto fail; 16751d3082fSBenjamin Herrenschmidt } 16851d3082fSBenjamin Herrenschmidt via = ioremap(taddr, 0x2000); 16951d3082fSBenjamin Herrenschmidt if (via == NULL) { 17051d3082fSBenjamin Herrenschmidt printk(KERN_ERR "via-cuda: Can't map address !\n"); 17151d3082fSBenjamin Herrenschmidt goto fail; 17251d3082fSBenjamin Herrenschmidt } 1731da177e4SLinus Torvalds 1741da177e4SLinus Torvalds cuda_state = idle; 1751da177e4SLinus Torvalds sys_ctrler = SYS_CTRLER_CUDA; 1761da177e4SLinus Torvalds 1771da177e4SLinus Torvalds err = cuda_init_via(); 1781da177e4SLinus Torvalds if (err) { 1791da177e4SLinus Torvalds printk(KERN_ERR "cuda_init_via() failed\n"); 1801da177e4SLinus Torvalds via = NULL; 1811da177e4SLinus Torvalds return 0; 1821da177e4SLinus Torvalds } 1831da177e4SLinus Torvalds 1841da177e4SLinus Torvalds /* Clear and enable interrupts, but only on PPC. On 68K it's done */ 1851da177e4SLinus Torvalds /* for us by the main VIA driver in arch/m68k/mac/via.c */ 1861da177e4SLinus Torvalds 1871da177e4SLinus Torvalds out_8(&via[IFR], 0x7f); /* clear interrupts by writing 1s */ 1881da177e4SLinus Torvalds out_8(&via[IER], IER_SET|SR_INT); /* enable interrupt from SR */ 1891da177e4SLinus Torvalds 1901da177e4SLinus Torvalds /* enable autopoll */ 1911da177e4SLinus Torvalds cuda_request(&req, NULL, 3, CUDA_PACKET, CUDA_AUTOPOLL, 1); 1921da177e4SLinus Torvalds while (!req.complete) 1931da177e4SLinus Torvalds cuda_poll(); 1941da177e4SLinus Torvalds 1951da177e4SLinus Torvalds return 1; 19651d3082fSBenjamin Herrenschmidt 19751d3082fSBenjamin Herrenschmidt fail: 19851d3082fSBenjamin Herrenschmidt of_node_put(vias); 19951d3082fSBenjamin Herrenschmidt vias = NULL; 20051d3082fSBenjamin Herrenschmidt return 0; 2011da177e4SLinus Torvalds } 202*18814ee8SFinn Thain #endif /* !defined CONFIG_MAC */ 2031da177e4SLinus Torvalds 2041da177e4SLinus Torvalds static int __init via_cuda_start(void) 2051da177e4SLinus Torvalds { 2061da177e4SLinus Torvalds if (via == NULL) 2071da177e4SLinus Torvalds return -ENODEV; 2081da177e4SLinus Torvalds 2090ebfff14SBenjamin Herrenschmidt #ifdef CONFIG_MAC 2100251c38cSFinn Thain cuda_irq = IRQ_MAC_ADB; 211*18814ee8SFinn Thain #else 2120251c38cSFinn Thain cuda_irq = irq_of_parse_and_map(vias, 0); 2130251c38cSFinn Thain if (cuda_irq == NO_IRQ) { 2140ebfff14SBenjamin Herrenschmidt printk(KERN_ERR "via-cuda: can't map interrupts for %s\n", 2150ebfff14SBenjamin Herrenschmidt vias->full_name); 2160ebfff14SBenjamin Herrenschmidt return -ENODEV; 2170ebfff14SBenjamin Herrenschmidt } 218*18814ee8SFinn Thain #endif 2190ebfff14SBenjamin Herrenschmidt 2200251c38cSFinn Thain if (request_irq(cuda_irq, cuda_interrupt, 0, "ADB", cuda_interrupt)) { 2210251c38cSFinn Thain printk(KERN_ERR "via-cuda: can't request irq %d\n", cuda_irq); 2221da177e4SLinus Torvalds return -EAGAIN; 2231da177e4SLinus Torvalds } 2241da177e4SLinus Torvalds 2251da177e4SLinus Torvalds printk("Macintosh CUDA driver v0.5 for Unified ADB.\n"); 2261da177e4SLinus Torvalds 2271da177e4SLinus Torvalds cuda_fully_inited = 1; 2281da177e4SLinus Torvalds return 0; 2291da177e4SLinus Torvalds } 2301da177e4SLinus Torvalds 2311da177e4SLinus Torvalds device_initcall(via_cuda_start); 2321da177e4SLinus Torvalds 2331da177e4SLinus Torvalds #ifdef CONFIG_ADB 2341da177e4SLinus Torvalds static int 2351da177e4SLinus Torvalds cuda_probe(void) 2361da177e4SLinus Torvalds { 2371da177e4SLinus Torvalds #ifdef CONFIG_PPC 2381da177e4SLinus Torvalds if (sys_ctrler != SYS_CTRLER_CUDA) 2391da177e4SLinus Torvalds return -ENODEV; 2401da177e4SLinus Torvalds #else 2411da177e4SLinus Torvalds if (macintosh_config->adb_type != MAC_ADB_CUDA) 2421da177e4SLinus Torvalds return -ENODEV; 2431da177e4SLinus Torvalds #endif 2441da177e4SLinus Torvalds if (via == NULL) 2451da177e4SLinus Torvalds return -ENODEV; 2461da177e4SLinus Torvalds return 0; 2471da177e4SLinus Torvalds } 2481da177e4SLinus Torvalds #endif /* CONFIG_ADB */ 2491da177e4SLinus Torvalds 2501da177e4SLinus Torvalds #define WAIT_FOR(cond, what) \ 2511da177e4SLinus Torvalds do { \ 2521da177e4SLinus Torvalds int x; \ 2531da177e4SLinus Torvalds for (x = 1000; !(cond); --x) { \ 2541da177e4SLinus Torvalds if (x == 0) { \ 2551da177e4SLinus Torvalds printk("Timeout waiting for " what "\n"); \ 2561da177e4SLinus Torvalds return -ENXIO; \ 2571da177e4SLinus Torvalds } \ 2581da177e4SLinus Torvalds udelay(100); \ 2591da177e4SLinus Torvalds } \ 2601da177e4SLinus Torvalds } while (0) 2611da177e4SLinus Torvalds 2621da177e4SLinus Torvalds static int 2631da177e4SLinus Torvalds cuda_init_via(void) 2641da177e4SLinus Torvalds { 2651da177e4SLinus Torvalds out_8(&via[DIRB], (in_8(&via[DIRB]) | TACK | TIP) & ~TREQ); /* TACK & TIP out */ 2661da177e4SLinus Torvalds out_8(&via[B], in_8(&via[B]) | TACK | TIP); /* negate them */ 2671da177e4SLinus Torvalds out_8(&via[ACR] ,(in_8(&via[ACR]) & ~SR_CTRL) | SR_EXT); /* SR data in */ 2681da177e4SLinus Torvalds (void)in_8(&via[SR]); /* clear any left-over data */ 2690251c38cSFinn Thain #ifdef CONFIG_PPC 2701da177e4SLinus Torvalds out_8(&via[IER], 0x7f); /* disable interrupts from VIA */ 2711da177e4SLinus Torvalds (void)in_8(&via[IER]); 2720251c38cSFinn Thain #else 2730251c38cSFinn Thain out_8(&via[IER], SR_INT); /* disable SR interrupt from VIA */ 2741da177e4SLinus Torvalds #endif 2751da177e4SLinus Torvalds 2761da177e4SLinus Torvalds /* delay 4ms and then clear any pending interrupt */ 2771da177e4SLinus Torvalds mdelay(4); 2781da177e4SLinus Torvalds (void)in_8(&via[SR]); 2790251c38cSFinn Thain out_8(&via[IFR], SR_INT); 2801da177e4SLinus Torvalds 2811da177e4SLinus Torvalds /* sync with the CUDA - assert TACK without TIP */ 2821da177e4SLinus Torvalds out_8(&via[B], in_8(&via[B]) & ~TACK); 2831da177e4SLinus Torvalds 2841da177e4SLinus Torvalds /* wait for the CUDA to assert TREQ in response */ 2851da177e4SLinus Torvalds WAIT_FOR((in_8(&via[B]) & TREQ) == 0, "CUDA response to sync"); 2861da177e4SLinus Torvalds 2871da177e4SLinus Torvalds /* wait for the interrupt and then clear it */ 2881da177e4SLinus Torvalds WAIT_FOR(in_8(&via[IFR]) & SR_INT, "CUDA response to sync (2)"); 2891da177e4SLinus Torvalds (void)in_8(&via[SR]); 2900251c38cSFinn Thain out_8(&via[IFR], SR_INT); 2911da177e4SLinus Torvalds 2921da177e4SLinus Torvalds /* finish the sync by negating TACK */ 2931da177e4SLinus Torvalds out_8(&via[B], in_8(&via[B]) | TACK); 2941da177e4SLinus Torvalds 2951da177e4SLinus Torvalds /* wait for the CUDA to negate TREQ and the corresponding interrupt */ 2961da177e4SLinus Torvalds WAIT_FOR(in_8(&via[B]) & TREQ, "CUDA response to sync (3)"); 2971da177e4SLinus Torvalds WAIT_FOR(in_8(&via[IFR]) & SR_INT, "CUDA response to sync (4)"); 2981da177e4SLinus Torvalds (void)in_8(&via[SR]); 2990251c38cSFinn Thain out_8(&via[IFR], SR_INT); 3001da177e4SLinus Torvalds out_8(&via[B], in_8(&via[B]) | TIP); /* should be unnecessary */ 3011da177e4SLinus Torvalds 3021da177e4SLinus Torvalds return 0; 3031da177e4SLinus Torvalds } 3041da177e4SLinus Torvalds 3051da177e4SLinus Torvalds #ifdef CONFIG_ADB 3061da177e4SLinus Torvalds /* Send an ADB command */ 3071da177e4SLinus Torvalds static int 3081da177e4SLinus Torvalds cuda_send_request(struct adb_request *req, int sync) 3091da177e4SLinus Torvalds { 3101da177e4SLinus Torvalds int i; 3111da177e4SLinus Torvalds 3121da177e4SLinus Torvalds if ((via == NULL) || !cuda_fully_inited) { 3131da177e4SLinus Torvalds req->complete = 1; 3141da177e4SLinus Torvalds return -ENXIO; 3151da177e4SLinus Torvalds } 3161da177e4SLinus Torvalds 3171da177e4SLinus Torvalds req->reply_expected = 1; 3181da177e4SLinus Torvalds 3191da177e4SLinus Torvalds i = cuda_write(req); 3201da177e4SLinus Torvalds if (i) 3211da177e4SLinus Torvalds return i; 3221da177e4SLinus Torvalds 3231da177e4SLinus Torvalds if (sync) { 3241da177e4SLinus Torvalds while (!req->complete) 3251da177e4SLinus Torvalds cuda_poll(); 3261da177e4SLinus Torvalds } 3271da177e4SLinus Torvalds return 0; 3281da177e4SLinus Torvalds } 3291da177e4SLinus Torvalds 3301da177e4SLinus Torvalds 3311da177e4SLinus Torvalds /* Enable/disable autopolling */ 3321da177e4SLinus Torvalds static int 3331da177e4SLinus Torvalds cuda_adb_autopoll(int devs) 3341da177e4SLinus Torvalds { 3351da177e4SLinus Torvalds struct adb_request req; 3361da177e4SLinus Torvalds 3371da177e4SLinus Torvalds if ((via == NULL) || !cuda_fully_inited) 3381da177e4SLinus Torvalds return -ENXIO; 3391da177e4SLinus Torvalds 3401da177e4SLinus Torvalds cuda_request(&req, NULL, 3, CUDA_PACKET, CUDA_AUTOPOLL, (devs? 1: 0)); 3411da177e4SLinus Torvalds while (!req.complete) 3421da177e4SLinus Torvalds cuda_poll(); 3431da177e4SLinus Torvalds return 0; 3441da177e4SLinus Torvalds } 3451da177e4SLinus Torvalds 3461da177e4SLinus Torvalds /* Reset adb bus - how do we do this?? */ 3471da177e4SLinus Torvalds static int 3481da177e4SLinus Torvalds cuda_reset_adb_bus(void) 3491da177e4SLinus Torvalds { 3501da177e4SLinus Torvalds struct adb_request req; 3511da177e4SLinus Torvalds 3521da177e4SLinus Torvalds if ((via == NULL) || !cuda_fully_inited) 3531da177e4SLinus Torvalds return -ENXIO; 3541da177e4SLinus Torvalds 3551da177e4SLinus Torvalds cuda_request(&req, NULL, 2, ADB_PACKET, 0); /* maybe? */ 3561da177e4SLinus Torvalds while (!req.complete) 3571da177e4SLinus Torvalds cuda_poll(); 3581da177e4SLinus Torvalds return 0; 3591da177e4SLinus Torvalds } 3601da177e4SLinus Torvalds #endif /* CONFIG_ADB */ 3611da177e4SLinus Torvalds /* Construct and send a cuda request */ 3621da177e4SLinus Torvalds int 3631da177e4SLinus Torvalds cuda_request(struct adb_request *req, void (*done)(struct adb_request *), 3641da177e4SLinus Torvalds int nbytes, ...) 3651da177e4SLinus Torvalds { 3661da177e4SLinus Torvalds va_list list; 3671da177e4SLinus Torvalds int i; 3681da177e4SLinus Torvalds 3691da177e4SLinus Torvalds if (via == NULL) { 3701da177e4SLinus Torvalds req->complete = 1; 3711da177e4SLinus Torvalds return -ENXIO; 3721da177e4SLinus Torvalds } 3731da177e4SLinus Torvalds 3741da177e4SLinus Torvalds req->nbytes = nbytes; 3751da177e4SLinus Torvalds req->done = done; 3761da177e4SLinus Torvalds va_start(list, nbytes); 3771da177e4SLinus Torvalds for (i = 0; i < nbytes; ++i) 3781da177e4SLinus Torvalds req->data[i] = va_arg(list, int); 3791da177e4SLinus Torvalds va_end(list); 3801da177e4SLinus Torvalds req->reply_expected = 1; 3811da177e4SLinus Torvalds return cuda_write(req); 3821da177e4SLinus Torvalds } 3831da177e4SLinus Torvalds 3841da177e4SLinus Torvalds static int 3851da177e4SLinus Torvalds cuda_write(struct adb_request *req) 3861da177e4SLinus Torvalds { 3871da177e4SLinus Torvalds unsigned long flags; 3881da177e4SLinus Torvalds 3891da177e4SLinus Torvalds if (req->nbytes < 2 || req->data[0] > CUDA_PACKET) { 3901da177e4SLinus Torvalds req->complete = 1; 3911da177e4SLinus Torvalds return -EINVAL; 3921da177e4SLinus Torvalds } 3931da177e4SLinus Torvalds req->next = NULL; 3941da177e4SLinus Torvalds req->sent = 0; 3951da177e4SLinus Torvalds req->complete = 0; 3961da177e4SLinus Torvalds req->reply_len = 0; 3971da177e4SLinus Torvalds 3981da177e4SLinus Torvalds spin_lock_irqsave(&cuda_lock, flags); 3991da177e4SLinus Torvalds if (current_req != 0) { 4001da177e4SLinus Torvalds last_req->next = req; 4011da177e4SLinus Torvalds last_req = req; 4021da177e4SLinus Torvalds } else { 4031da177e4SLinus Torvalds current_req = req; 4041da177e4SLinus Torvalds last_req = req; 4051da177e4SLinus Torvalds if (cuda_state == idle) 4061da177e4SLinus Torvalds cuda_start(); 4071da177e4SLinus Torvalds } 4081da177e4SLinus Torvalds spin_unlock_irqrestore(&cuda_lock, flags); 4091da177e4SLinus Torvalds 4101da177e4SLinus Torvalds return 0; 4111da177e4SLinus Torvalds } 4121da177e4SLinus Torvalds 4131da177e4SLinus Torvalds static void 4141da177e4SLinus Torvalds cuda_start(void) 4151da177e4SLinus Torvalds { 4161da177e4SLinus Torvalds struct adb_request *req; 4171da177e4SLinus Torvalds 4181da177e4SLinus Torvalds /* assert cuda_state == idle */ 4191da177e4SLinus Torvalds /* get the packet to send */ 4201da177e4SLinus Torvalds req = current_req; 4211da177e4SLinus Torvalds if (req == 0) 4221da177e4SLinus Torvalds return; 4231da177e4SLinus Torvalds if ((in_8(&via[B]) & TREQ) == 0) 4241da177e4SLinus Torvalds return; /* a byte is coming in from the CUDA */ 4251da177e4SLinus Torvalds 4261da177e4SLinus Torvalds /* set the shift register to shift out and send a byte */ 4271da177e4SLinus Torvalds out_8(&via[ACR], in_8(&via[ACR]) | SR_OUT); 4281da177e4SLinus Torvalds out_8(&via[SR], req->data[0]); 4291da177e4SLinus Torvalds out_8(&via[B], in_8(&via[B]) & ~TIP); 4301da177e4SLinus Torvalds cuda_state = sent_first_byte; 4311da177e4SLinus Torvalds } 4321da177e4SLinus Torvalds 4331da177e4SLinus Torvalds void 4341da177e4SLinus Torvalds cuda_poll(void) 4351da177e4SLinus Torvalds { 4361da177e4SLinus Torvalds /* cuda_interrupt only takes a normal lock, we disable 4371da177e4SLinus Torvalds * interrupts here to avoid re-entering and thus deadlocking. 4381da177e4SLinus Torvalds */ 439*18814ee8SFinn Thain if (cuda_irq) 4400251c38cSFinn Thain disable_irq(cuda_irq); 44149f19ce4SOlof Johansson cuda_interrupt(0, NULL); 442*18814ee8SFinn Thain if (cuda_irq) 4430251c38cSFinn Thain enable_irq(cuda_irq); 4441da177e4SLinus Torvalds } 4451da177e4SLinus Torvalds 4461da177e4SLinus Torvalds static irqreturn_t 4477d12e780SDavid Howells cuda_interrupt(int irq, void *arg) 4481da177e4SLinus Torvalds { 4491da177e4SLinus Torvalds int status; 4501da177e4SLinus Torvalds struct adb_request *req = NULL; 4511da177e4SLinus Torvalds unsigned char ibuf[16]; 4521da177e4SLinus Torvalds int ibuf_len = 0; 4531da177e4SLinus Torvalds int complete = 0; 4541da177e4SLinus Torvalds 4551da177e4SLinus Torvalds spin_lock(&cuda_lock); 4561da177e4SLinus Torvalds 457*18814ee8SFinn Thain /* On powermacs, this handler is registered for the VIA IRQ. But they use 4580251c38cSFinn Thain * just the shift register IRQ -- other VIA interrupt sources are disabled. 4590251c38cSFinn Thain * On m68k macs, the VIA IRQ sources are dispatched individually. Unless 4600251c38cSFinn Thain * we are polling, the shift register IRQ flag has already been cleared. 4610251c38cSFinn Thain */ 4620251c38cSFinn Thain 4630251c38cSFinn Thain #ifdef CONFIG_MAC 4640251c38cSFinn Thain if (!arg) 4650251c38cSFinn Thain #endif 4660251c38cSFinn Thain { 4670251c38cSFinn Thain if ((in_8(&via[IFR]) & SR_INT) == 0) { 4681da177e4SLinus Torvalds spin_unlock(&cuda_lock); 4691da177e4SLinus Torvalds return IRQ_NONE; 4700251c38cSFinn Thain } else { 4710251c38cSFinn Thain out_8(&via[IFR], SR_INT); 4720251c38cSFinn Thain } 4731da177e4SLinus Torvalds } 4741da177e4SLinus Torvalds 4751da177e4SLinus Torvalds status = (~in_8(&via[B]) & (TIP|TREQ)) | (in_8(&via[ACR]) & SR_OUT); 4761da177e4SLinus Torvalds /* printk("cuda_interrupt: state=%d status=%x\n", cuda_state, status); */ 4771da177e4SLinus Torvalds switch (cuda_state) { 4781da177e4SLinus Torvalds case idle: 4791da177e4SLinus Torvalds /* CUDA has sent us the first byte of data - unsolicited */ 4801da177e4SLinus Torvalds if (status != TREQ) 4811da177e4SLinus Torvalds printk("cuda: state=idle, status=%x\n", status); 4821da177e4SLinus Torvalds (void)in_8(&via[SR]); 4831da177e4SLinus Torvalds out_8(&via[B], in_8(&via[B]) & ~TIP); 4841da177e4SLinus Torvalds cuda_state = reading; 4851da177e4SLinus Torvalds reply_ptr = cuda_rbuf; 4861da177e4SLinus Torvalds reading_reply = 0; 4871da177e4SLinus Torvalds break; 4881da177e4SLinus Torvalds 4891da177e4SLinus Torvalds case awaiting_reply: 4901da177e4SLinus Torvalds /* CUDA has sent us the first byte of data of a reply */ 4911da177e4SLinus Torvalds if (status != TREQ) 4921da177e4SLinus Torvalds printk("cuda: state=awaiting_reply, status=%x\n", status); 4931da177e4SLinus Torvalds (void)in_8(&via[SR]); 4941da177e4SLinus Torvalds out_8(&via[B], in_8(&via[B]) & ~TIP); 4951da177e4SLinus Torvalds cuda_state = reading; 4961da177e4SLinus Torvalds reply_ptr = current_req->reply; 4971da177e4SLinus Torvalds reading_reply = 1; 4981da177e4SLinus Torvalds break; 4991da177e4SLinus Torvalds 5001da177e4SLinus Torvalds case sent_first_byte: 5011da177e4SLinus Torvalds if (status == TREQ + TIP + SR_OUT) { 5021da177e4SLinus Torvalds /* collision */ 5031da177e4SLinus Torvalds out_8(&via[ACR], in_8(&via[ACR]) & ~SR_OUT); 5041da177e4SLinus Torvalds (void)in_8(&via[SR]); 5051da177e4SLinus Torvalds out_8(&via[B], in_8(&via[B]) | TIP | TACK); 5061da177e4SLinus Torvalds cuda_state = idle; 5071da177e4SLinus Torvalds } else { 5081da177e4SLinus Torvalds /* assert status == TIP + SR_OUT */ 5091da177e4SLinus Torvalds if (status != TIP + SR_OUT) 5101da177e4SLinus Torvalds printk("cuda: state=sent_first_byte status=%x\n", status); 5111da177e4SLinus Torvalds out_8(&via[SR], current_req->data[1]); 5121da177e4SLinus Torvalds out_8(&via[B], in_8(&via[B]) ^ TACK); 5131da177e4SLinus Torvalds data_index = 2; 5141da177e4SLinus Torvalds cuda_state = sending; 5151da177e4SLinus Torvalds } 5161da177e4SLinus Torvalds break; 5171da177e4SLinus Torvalds 5181da177e4SLinus Torvalds case sending: 5191da177e4SLinus Torvalds req = current_req; 5201da177e4SLinus Torvalds if (data_index >= req->nbytes) { 5211da177e4SLinus Torvalds out_8(&via[ACR], in_8(&via[ACR]) & ~SR_OUT); 5221da177e4SLinus Torvalds (void)in_8(&via[SR]); 5231da177e4SLinus Torvalds out_8(&via[B], in_8(&via[B]) | TACK | TIP); 5241da177e4SLinus Torvalds req->sent = 1; 5251da177e4SLinus Torvalds if (req->reply_expected) { 5261da177e4SLinus Torvalds cuda_state = awaiting_reply; 5271da177e4SLinus Torvalds } else { 5281da177e4SLinus Torvalds current_req = req->next; 5291da177e4SLinus Torvalds complete = 1; 5301da177e4SLinus Torvalds /* not sure about this */ 5311da177e4SLinus Torvalds cuda_state = idle; 5321da177e4SLinus Torvalds cuda_start(); 5331da177e4SLinus Torvalds } 5341da177e4SLinus Torvalds } else { 5351da177e4SLinus Torvalds out_8(&via[SR], req->data[data_index++]); 5361da177e4SLinus Torvalds out_8(&via[B], in_8(&via[B]) ^ TACK); 5371da177e4SLinus Torvalds } 5381da177e4SLinus Torvalds break; 5391da177e4SLinus Torvalds 5401da177e4SLinus Torvalds case reading: 5411da177e4SLinus Torvalds *reply_ptr++ = in_8(&via[SR]); 5421da177e4SLinus Torvalds if (status == TIP) { 5431da177e4SLinus Torvalds /* that's all folks */ 5441da177e4SLinus Torvalds out_8(&via[B], in_8(&via[B]) | TACK | TIP); 5451da177e4SLinus Torvalds cuda_state = read_done; 5461da177e4SLinus Torvalds } else { 5471da177e4SLinus Torvalds /* assert status == TIP | TREQ */ 5481da177e4SLinus Torvalds if (status != TIP + TREQ) 5491da177e4SLinus Torvalds printk("cuda: state=reading status=%x\n", status); 5501da177e4SLinus Torvalds out_8(&via[B], in_8(&via[B]) ^ TACK); 5511da177e4SLinus Torvalds } 5521da177e4SLinus Torvalds break; 5531da177e4SLinus Torvalds 5541da177e4SLinus Torvalds case read_done: 5551da177e4SLinus Torvalds (void)in_8(&via[SR]); 5561da177e4SLinus Torvalds if (reading_reply) { 5571da177e4SLinus Torvalds req = current_req; 5581da177e4SLinus Torvalds req->reply_len = reply_ptr - req->reply; 5591da177e4SLinus Torvalds if (req->data[0] == ADB_PACKET) { 5601da177e4SLinus Torvalds /* Have to adjust the reply from ADB commands */ 5611da177e4SLinus Torvalds if (req->reply_len <= 2 || (req->reply[1] & 2) != 0) { 5621da177e4SLinus Torvalds /* the 0x2 bit indicates no response */ 5631da177e4SLinus Torvalds req->reply_len = 0; 5641da177e4SLinus Torvalds } else { 5651da177e4SLinus Torvalds /* leave just the command and result bytes in the reply */ 5661da177e4SLinus Torvalds req->reply_len -= 2; 5671da177e4SLinus Torvalds memmove(req->reply, req->reply + 2, req->reply_len); 5681da177e4SLinus Torvalds } 5691da177e4SLinus Torvalds } 5701da177e4SLinus Torvalds current_req = req->next; 5711da177e4SLinus Torvalds complete = 1; 5721da177e4SLinus Torvalds } else { 5731da177e4SLinus Torvalds /* This is tricky. We must break the spinlock to call 5741da177e4SLinus Torvalds * cuda_input. However, doing so means we might get 5751da177e4SLinus Torvalds * re-entered from another CPU getting an interrupt 5761da177e4SLinus Torvalds * or calling cuda_poll(). I ended up using the stack 5771da177e4SLinus Torvalds * (it's only for 16 bytes) and moving the actual 5781da177e4SLinus Torvalds * call to cuda_input to outside of the lock. 5791da177e4SLinus Torvalds */ 5801da177e4SLinus Torvalds ibuf_len = reply_ptr - cuda_rbuf; 5811da177e4SLinus Torvalds memcpy(ibuf, cuda_rbuf, ibuf_len); 5821da177e4SLinus Torvalds } 5831da177e4SLinus Torvalds if (status == TREQ) { 5841da177e4SLinus Torvalds out_8(&via[B], in_8(&via[B]) & ~TIP); 5851da177e4SLinus Torvalds cuda_state = reading; 5861da177e4SLinus Torvalds reply_ptr = cuda_rbuf; 5871da177e4SLinus Torvalds reading_reply = 0; 5881da177e4SLinus Torvalds } else { 5891da177e4SLinus Torvalds cuda_state = idle; 5901da177e4SLinus Torvalds cuda_start(); 5911da177e4SLinus Torvalds } 5921da177e4SLinus Torvalds break; 5931da177e4SLinus Torvalds 5941da177e4SLinus Torvalds default: 5951da177e4SLinus Torvalds printk("cuda_interrupt: unknown cuda_state %d?\n", cuda_state); 5961da177e4SLinus Torvalds } 5971da177e4SLinus Torvalds spin_unlock(&cuda_lock); 5981da177e4SLinus Torvalds if (complete && req) { 5991da177e4SLinus Torvalds void (*done)(struct adb_request *) = req->done; 6001da177e4SLinus Torvalds mb(); 6011da177e4SLinus Torvalds req->complete = 1; 6021da177e4SLinus Torvalds /* Here, we assume that if the request has a done member, the 6031da177e4SLinus Torvalds * struct request will survive to setting req->complete to 1 6041da177e4SLinus Torvalds */ 6051da177e4SLinus Torvalds if (done) 6061da177e4SLinus Torvalds (*done)(req); 6071da177e4SLinus Torvalds } 6081da177e4SLinus Torvalds if (ibuf_len) 6097d12e780SDavid Howells cuda_input(ibuf, ibuf_len); 6101da177e4SLinus Torvalds return IRQ_HANDLED; 6111da177e4SLinus Torvalds } 6121da177e4SLinus Torvalds 6131da177e4SLinus Torvalds static void 6147d12e780SDavid Howells cuda_input(unsigned char *buf, int nb) 6151da177e4SLinus Torvalds { 6161da177e4SLinus Torvalds int i; 6171da177e4SLinus Torvalds 6181da177e4SLinus Torvalds switch (buf[0]) { 6191da177e4SLinus Torvalds case ADB_PACKET: 6201da177e4SLinus Torvalds #ifdef CONFIG_XMON 6211da177e4SLinus Torvalds if (nb == 5 && buf[2] == 0x2c) { 6221da177e4SLinus Torvalds extern int xmon_wants_key, xmon_adb_keycode; 6231da177e4SLinus Torvalds if (xmon_wants_key) { 6241da177e4SLinus Torvalds xmon_adb_keycode = buf[3]; 6251da177e4SLinus Torvalds return; 6261da177e4SLinus Torvalds } 6271da177e4SLinus Torvalds } 6281da177e4SLinus Torvalds #endif /* CONFIG_XMON */ 6291da177e4SLinus Torvalds #ifdef CONFIG_ADB 6307d12e780SDavid Howells adb_input(buf+2, nb-2, buf[1] & 0x40); 6311da177e4SLinus Torvalds #endif /* CONFIG_ADB */ 6321da177e4SLinus Torvalds break; 6331da177e4SLinus Torvalds 6341da177e4SLinus Torvalds default: 6351da177e4SLinus Torvalds printk("data from cuda (%d bytes):", nb); 6361da177e4SLinus Torvalds for (i = 0; i < nb; ++i) 6371da177e4SLinus Torvalds printk(" %.2x", buf[i]); 6381da177e4SLinus Torvalds printk("\n"); 6391da177e4SLinus Torvalds } 6401da177e4SLinus Torvalds } 641