| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /***    ltpc.c -- a driver for the LocalTalk PC card. | 
 | 2 |  * | 
 | 3 |  *      Copyright (c) 1995,1996 Bradford W. Johnson <johns393@maroon.tc.umn.edu> | 
 | 4 |  * | 
 | 5 |  *      This software may be used and distributed according to the terms | 
 | 6 |  *      of the GNU General Public License, incorporated herein by reference. | 
 | 7 |  * | 
 | 8 |  *      This is ALPHA code at best.  It may not work for you.  It may | 
 | 9 |  *      damage your equipment.  It may damage your relations with other | 
 | 10 |  *      users of your network.  Use it at your own risk! | 
 | 11 |  * | 
 | 12 |  *      Based in part on: | 
 | 13 |  *      skeleton.c      by Donald Becker | 
 | 14 |  *      dummy.c         by Nick Holloway and Alan Cox | 
 | 15 |  *      loopback.c      by Ross Biro, Fred van Kampen, Donald Becker | 
 | 16 |  *      the netatalk source code (UMICH) | 
 | 17 |  *      lots of work on the card... | 
 | 18 |  * | 
 | 19 |  *      I do not have access to the (proprietary) SDK that goes with the card. | 
 | 20 |  *      If you do, I don't want to know about it, and you can probably write | 
 | 21 |  *      a better driver yourself anyway.  This does mean that the pieces that | 
 | 22 |  *      talk to the card are guesswork on my part, so use at your own risk! | 
 | 23 |  * | 
 | 24 |  *      This is my first try at writing Linux networking code, and is also | 
 | 25 |  *      guesswork.  Again, use at your own risk!  (Although on this part, I'd | 
 | 26 |  *      welcome suggestions) | 
 | 27 |  * | 
 | 28 |  *      This is a loadable kernel module which seems to work at my site | 
 | 29 |  *      consisting of a 1.2.13 linux box running netatalk 1.3.3, and with | 
 | 30 |  *      the kernel support from 1.3.3b2 including patches routing.patch | 
 | 31 |  *      and ddp.disappears.from.chooser.  In order to run it, you will need | 
 | 32 |  *      to patch ddp.c and aarp.c in the kernel, but only a little... | 
 | 33 |  * | 
 | 34 |  *      I'm fairly confident that while this is arguably badly written, the | 
 | 35 |  *      problems that people experience will be "higher level", that is, with | 
 | 36 |  *      complications in the netatalk code.  The driver itself doesn't do | 
 | 37 |  *      anything terribly complicated -- it pretends to be an ether device | 
 | 38 |  *      as far as netatalk is concerned, strips the DDP data out of the ether | 
 | 39 |  *      frame and builds a LLAP packet to send out the card.  In the other | 
 | 40 |  *      direction, it receives LLAP frames from the card and builds a fake | 
 | 41 |  *      ether packet that it then tosses up to the networking code.  You can | 
 | 42 |  *      argue (correctly) that this is an ugly way to do things, but it | 
 | 43 |  *      requires a minimal amount of fooling with the code in ddp.c and aarp.c. | 
 | 44 |  * | 
 | 45 |  *      The card will do a lot more than is used here -- I *think* it has the | 
 | 46 |  *      layers up through ATP.  Even if you knew how that part works (which I | 
 | 47 |  *      don't) it would be a big job to carve up the kernel ddp code to insert | 
 | 48 |  *      things at a higher level, and probably a bad idea... | 
 | 49 |  * | 
 | 50 |  *      There are a number of other cards that do LocalTalk on the PC.  If | 
 | 51 |  *      nobody finds any insurmountable (at the netatalk level) problems | 
 | 52 |  *      here, this driver should encourage people to put some work into the | 
 | 53 |  *      other cards (some of which I gather are still commercially available) | 
 | 54 |  *      and also to put hooks for LocalTalk into the official ddp code. | 
 | 55 |  * | 
 | 56 |  *      I welcome comments and suggestions.  This is my first try at Linux | 
 | 57 |  *      networking stuff, and there are probably lots of things that I did | 
 | 58 |  *      suboptimally.   | 
 | 59 |  * | 
 | 60 |  ***/ | 
 | 61 |  | 
 | 62 | /*** | 
 | 63 |  * | 
 | 64 |  * $Log: ltpc.c,v $ | 
 | 65 |  * Revision 1.1.2.1  2000/03/01 05:35:07  jgarzik | 
 | 66 |  * at and tr cleanup | 
 | 67 |  * | 
 | 68 |  * Revision 1.8  1997/01/28 05:44:54  bradford | 
 | 69 |  * Clean up for non-module a little. | 
 | 70 |  * Hacked about a bit to clean things up - Alan Cox  | 
 | 71 |  * Probably broken it from the origina 1.8 | 
 | 72 |  * | 
 | 73 |  | 
 | 74 |  * 1998/11/09: David Huggins-Daines <dhd@debian.org> | 
 | 75 |  * Cleaned up the initialization code to use the standard autoirq methods, | 
 | 76 |    and to probe for things in the standard order of i/o, irq, dma.  This | 
 | 77 |    removes the "reset the reset" hack, because I couldn't figure out an | 
 | 78 |    easy way to get the card to trigger an interrupt after it. | 
 | 79 |  * Added support for passing configuration parameters on the kernel command | 
 | 80 |    line and through insmod | 
 | 81 |  * Changed the device name from "ltalk0" to "lt0", both to conform with the | 
 | 82 |    other localtalk driver, and to clear up the inconsistency between the | 
 | 83 |    module and the non-module versions of the driver :-) | 
 | 84 |  * Added a bunch of comments (I was going to make some enums for the state | 
 | 85 |    codes and the register offsets, but I'm still not sure exactly what their | 
 | 86 |    semantics are) | 
 | 87 |  * Don't poll anymore in interrupt-driven mode | 
 | 88 |  * It seems to work as a module now (as of 2.1.127), but I don't think | 
 | 89 |    I'm responsible for that... | 
 | 90 |  | 
 | 91 |  * | 
 | 92 |  * Revision 1.7  1996/12/12 03:42:33  bradford | 
 | 93 |  * DMA alloc cribbed from 3c505.c. | 
 | 94 |  * | 
 | 95 |  * Revision 1.6  1996/12/12 03:18:58  bradford | 
 | 96 |  * Added virt_to_bus; works in 2.1.13. | 
 | 97 |  * | 
 | 98 |  * Revision 1.5  1996/12/12 03:13:22  root | 
 | 99 |  * xmitQel initialization -- think through better though. | 
 | 100 |  * | 
 | 101 |  * Revision 1.4  1996/06/18 14:55:55  root | 
 | 102 |  * Change names to ltpc. Tabs. Took a shot at dma alloc, | 
 | 103 |  * although more needs to be done eventually. | 
 | 104 |  * | 
 | 105 |  * Revision 1.3  1996/05/22 14:59:39  root | 
 | 106 |  * Change dev->open, dev->close to track dummy.c in 1.99.(around 7) | 
 | 107 |  * | 
 | 108 |  * Revision 1.2  1996/05/22 14:58:24  root | 
 | 109 |  * Change tabs mostly. | 
 | 110 |  * | 
 | 111 |  * Revision 1.1  1996/04/23 04:45:09  root | 
 | 112 |  * Initial revision | 
 | 113 |  * | 
 | 114 |  * Revision 0.16  1996/03/05 15:59:56  root | 
 | 115 |  * Change ARPHRD_LOCALTLK definition to the "real" one. | 
 | 116 |  * | 
 | 117 |  * Revision 0.15  1996/03/05 06:28:30  root | 
 | 118 |  * Changes for kernel 1.3.70.  Still need a few patches to kernel, but | 
 | 119 |  * it's getting closer. | 
 | 120 |  * | 
 | 121 |  * Revision 0.14  1996/02/25 17:38:32  root | 
 | 122 |  * More cleanups.  Removed query to card on get_stats. | 
 | 123 |  * | 
 | 124 |  * Revision 0.13  1996/02/21  16:27:40  root | 
 | 125 |  * Refix debug_print_skb.  Fix mac.raw gotcha that appeared in 1.3.65. | 
 | 126 |  * Clean up receive code a little. | 
 | 127 |  * | 
 | 128 |  * Revision 0.12  1996/02/19  16:34:53  root | 
 | 129 |  * Fix debug_print_skb.  Kludge outgoing snet to 0 when using startup | 
 | 130 |  * range.  Change debug to mask: 1 for verbose, 2 for higher level stuff | 
 | 131 |  * including packet printing, 4 for lower level (card i/o) stuff. | 
 | 132 |  * | 
 | 133 |  * Revision 0.11  1996/02/12  15:53:38  root | 
 | 134 |  * Added router sends (requires new aarp.c patch) | 
 | 135 |  * | 
 | 136 |  * Revision 0.10  1996/02/11  00:19:35  root | 
 | 137 |  * Change source LTALK_LOGGING debug switch to insmod ... debug=2. | 
 | 138 |  * | 
 | 139 |  * Revision 0.9  1996/02/10  23:59:35  root | 
 | 140 |  * Fixed those fixes for 1.2 -- DANGER!  The at.h that comes with netatalk | 
 | 141 |  * has a *different* definition of struct sockaddr_at than the Linux kernel | 
 | 142 |  * does.  This is an "insidious and invidious" bug... | 
 | 143 |  * (Actually the preceding comment is false -- it's the atalk.h in the | 
 | 144 |  * ancient atalk-0.06 that's the problem) | 
 | 145 |  * | 
 | 146 |  * Revision 0.8  1996/02/10 19:09:00  root | 
 | 147 |  * Merge 1.3 changes.  Tested OK under 1.3.60. | 
 | 148 |  * | 
 | 149 |  * Revision 0.7  1996/02/10 17:56:56  root | 
 | 150 |  * Added debug=1 parameter on insmod for debugging prints.  Tried | 
 | 151 |  * to fix timer unload on rmmod, but I don't think that's the problem. | 
 | 152 |  * | 
 | 153 |  * Revision 0.6  1995/12/31  19:01:09  root | 
 | 154 |  * Clean up rmmod, irq comments per feedback from Corin Anderson (Thanks Corey!) | 
 | 155 |  * Clean up initial probing -- sometimes the card wakes up latched in reset. | 
 | 156 |  * | 
 | 157 |  * Revision 0.5  1995/12/22  06:03:44  root | 
 | 158 |  * Added comments in front and cleaned up a bit. | 
 | 159 |  * This version sent out to people. | 
 | 160 |  * | 
 | 161 |  * Revision 0.4  1995/12/18  03:46:44  root | 
 | 162 |  * Return shortDDP to longDDP fake to 0/0.  Added command structs. | 
 | 163 |  * | 
 | 164 |  ***/ | 
 | 165 |  | 
 | 166 | /* ltpc jumpers are: | 
 | 167 | * | 
 | 168 | *	Interrupts -- set at most one.  If none are set, the driver uses | 
 | 169 | *	polled mode.  Because the card was developed in the XT era, the | 
 | 170 | *	original documentation refers to IRQ2.  Since you'll be running | 
 | 171 | *	this on an AT (or later) class machine, that really means IRQ9. | 
 | 172 | * | 
 | 173 | *	SW1	IRQ 4 | 
 | 174 | *	SW2	IRQ 3 | 
 | 175 | *	SW3	IRQ 9 (2 in original card documentation only applies to XT) | 
 | 176 | * | 
 | 177 | * | 
 | 178 | *	DMA -- choose DMA 1 or 3, and set both corresponding switches. | 
 | 179 | * | 
 | 180 | *	SW4	DMA 3 | 
 | 181 | *	SW5	DMA 1 | 
 | 182 | *	SW6	DMA 3 | 
 | 183 | *	SW7	DMA 1 | 
 | 184 | * | 
 | 185 | * | 
 | 186 | *	I/O address -- choose one.   | 
 | 187 | * | 
 | 188 | *	SW8	220 / 240 | 
 | 189 | */ | 
 | 190 |  | 
 | 191 | /*	To have some stuff logged, do  | 
 | 192 | *	insmod ltpc.o debug=1 | 
 | 193 | * | 
 | 194 | *	For a whole bunch of stuff, use higher numbers. | 
 | 195 | * | 
 | 196 | *	The default is 0, i.e. no messages except for the probe results. | 
 | 197 | */ | 
 | 198 |  | 
 | 199 | /* insmod-tweakable variables */ | 
 | 200 | static int debug; | 
 | 201 | #define DEBUG_VERBOSE 1 | 
 | 202 | #define DEBUG_UPPER 2 | 
 | 203 | #define DEBUG_LOWER 4 | 
 | 204 |  | 
 | 205 | static int io; | 
 | 206 | static int irq; | 
 | 207 | static int dma; | 
 | 208 |  | 
 | 209 | #include <linux/module.h> | 
 | 210 | #include <linux/kernel.h> | 
 | 211 | #include <linux/types.h> | 
 | 212 | #include <linux/fcntl.h> | 
 | 213 | #include <linux/interrupt.h> | 
 | 214 | #include <linux/ptrace.h> | 
 | 215 | #include <linux/ioport.h> | 
 | 216 | #include <linux/spinlock.h> | 
 | 217 | #include <linux/in.h> | 
 | 218 | #include <linux/slab.h> | 
 | 219 | #include <linux/string.h> | 
 | 220 | #include <linux/errno.h> | 
 | 221 | #include <linux/init.h> | 
 | 222 | #include <linux/netdevice.h> | 
 | 223 | #include <linux/etherdevice.h> | 
 | 224 | #include <linux/skbuff.h> | 
 | 225 | #include <linux/if_arp.h> | 
 | 226 | #include <linux/if_ltalk.h> | 
 | 227 | #include <linux/delay.h> | 
 | 228 | #include <linux/timer.h> | 
 | 229 | #include <linux/atalk.h> | 
 | 230 | #include <linux/bitops.h> | 
 | 231 |  | 
 | 232 | #include <asm/system.h> | 
 | 233 | #include <asm/dma.h> | 
 | 234 | #include <asm/io.h> | 
 | 235 |  | 
 | 236 | /* our stuff */ | 
 | 237 | #include "ltpc.h" | 
 | 238 |  | 
 | 239 | static DEFINE_SPINLOCK(txqueue_lock); | 
 | 240 | static DEFINE_SPINLOCK(mbox_lock); | 
 | 241 |  | 
 | 242 | /* function prototypes */ | 
 | 243 | static int do_read(struct net_device *dev, void *cbuf, int cbuflen, | 
 | 244 | 	void *dbuf, int dbuflen); | 
 | 245 | static int sendup_buffer (struct net_device *dev); | 
 | 246 |  | 
 | 247 | /* Dma Memory related stuff, cribbed directly from 3c505.c */ | 
 | 248 |  | 
 | 249 | static unsigned long dma_mem_alloc(int size) | 
 | 250 | { | 
 | 251 |         int order = get_order(size); | 
 | 252 |  | 
 | 253 |         return __get_dma_pages(GFP_KERNEL, order); | 
 | 254 | } | 
 | 255 |  | 
 | 256 | /* DMA data buffer, DMA command buffer */ | 
 | 257 | static unsigned char *ltdmabuf; | 
 | 258 | static unsigned char *ltdmacbuf; | 
 | 259 |  | 
 | 260 | /* private struct, holds our appletalk address */ | 
 | 261 |  | 
 | 262 | struct ltpc_private | 
 | 263 | { | 
 | 264 | 	struct net_device_stats stats; | 
 | 265 | 	struct atalk_addr my_addr; | 
 | 266 | }; | 
 | 267 |  | 
 | 268 | /* transmit queue element struct */ | 
 | 269 |  | 
 | 270 | struct xmitQel { | 
 | 271 | 	struct xmitQel *next; | 
 | 272 | 	/* command buffer */ | 
 | 273 | 	unsigned char *cbuf; | 
 | 274 | 	short cbuflen; | 
 | 275 | 	/* data buffer */ | 
 | 276 | 	unsigned char *dbuf; | 
 | 277 | 	short dbuflen; | 
 | 278 | 	unsigned char QWrite;	/* read or write data */ | 
 | 279 | 	unsigned char mailbox; | 
 | 280 | }; | 
 | 281 |  | 
 | 282 | /* the transmit queue itself */ | 
 | 283 |  | 
 | 284 | static struct xmitQel *xmQhd, *xmQtl; | 
 | 285 |  | 
 | 286 | static void enQ(struct xmitQel *qel) | 
 | 287 | { | 
 | 288 | 	unsigned long flags; | 
 | 289 | 	qel->next = NULL; | 
 | 290 | 	 | 
 | 291 | 	spin_lock_irqsave(&txqueue_lock, flags); | 
 | 292 | 	if (xmQtl) { | 
 | 293 | 		xmQtl->next = qel; | 
 | 294 | 	} else { | 
 | 295 | 		xmQhd = qel; | 
 | 296 | 	} | 
 | 297 | 	xmQtl = qel; | 
 | 298 | 	spin_unlock_irqrestore(&txqueue_lock, flags); | 
 | 299 |  | 
 | 300 | 	if (debug & DEBUG_LOWER) | 
 | 301 | 		printk("enqueued a 0x%02x command\n",qel->cbuf[0]); | 
 | 302 | } | 
 | 303 |  | 
 | 304 | static struct xmitQel *deQ(void) | 
 | 305 | { | 
 | 306 | 	unsigned long flags; | 
 | 307 | 	int i; | 
 | 308 | 	struct xmitQel *qel=NULL; | 
 | 309 | 	 | 
 | 310 | 	spin_lock_irqsave(&txqueue_lock, flags); | 
 | 311 | 	if (xmQhd) { | 
 | 312 | 		qel = xmQhd; | 
 | 313 | 		xmQhd = qel->next; | 
 | 314 | 		if(!xmQhd) xmQtl = NULL; | 
 | 315 | 	} | 
 | 316 | 	spin_unlock_irqrestore(&txqueue_lock, flags); | 
 | 317 |  | 
 | 318 | 	if ((debug & DEBUG_LOWER) && qel) { | 
 | 319 | 		int n; | 
 | 320 | 		printk(KERN_DEBUG "ltpc: dequeued command "); | 
 | 321 | 		n = qel->cbuflen; | 
 | 322 | 		if (n>100) n=100; | 
 | 323 | 		for(i=0;i<n;i++) printk("%02x ",qel->cbuf[i]); | 
 | 324 | 		printk("\n"); | 
 | 325 | 	} | 
 | 326 |  | 
 | 327 | 	return qel; | 
 | 328 | } | 
 | 329 |  | 
 | 330 | /* and... the queue elements we'll be using */ | 
 | 331 | static struct xmitQel qels[16]; | 
 | 332 |  | 
 | 333 | /* and their corresponding mailboxes */ | 
 | 334 | static unsigned char mailbox[16]; | 
 | 335 | static unsigned char mboxinuse[16] = {0,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0}; | 
 | 336 |  | 
 | 337 | static int wait_timeout(struct net_device *dev, int c) | 
 | 338 | { | 
 | 339 | 	/* returns true if it stayed c */ | 
 | 340 | 	/* this uses base+6, but it's ok */ | 
 | 341 | 	int i; | 
 | 342 |  | 
 | 343 | 	/* twenty second or so total */ | 
 | 344 |  | 
 | 345 | 	for(i=0;i<200000;i++) { | 
 | 346 | 		if ( c != inb_p(dev->base_addr+6) ) return 0; | 
 | 347 | 		udelay(100); | 
 | 348 | 	} | 
 | 349 | 	return 1; /* timed out */ | 
 | 350 | } | 
 | 351 |  | 
 | 352 | /* get the first free mailbox */ | 
 | 353 |  | 
 | 354 | static int getmbox(void) | 
 | 355 | { | 
 | 356 | 	unsigned long flags; | 
 | 357 | 	int i; | 
 | 358 |  | 
 | 359 | 	spin_lock_irqsave(&mbox_lock, flags); | 
 | 360 | 	for(i=1;i<16;i++) if(!mboxinuse[i]) { | 
 | 361 | 		mboxinuse[i]=1; | 
 | 362 | 		spin_unlock_irqrestore(&mbox_lock, flags); | 
 | 363 | 		return i; | 
 | 364 | 	} | 
 | 365 | 	spin_unlock_irqrestore(&mbox_lock, flags); | 
 | 366 | 	return 0; | 
 | 367 | } | 
 | 368 |  | 
 | 369 | /* read a command from the card */ | 
 | 370 | static void handlefc(struct net_device *dev) | 
 | 371 | { | 
 | 372 | 	/* called *only* from idle, non-reentrant */ | 
 | 373 | 	int dma = dev->dma; | 
 | 374 | 	int base = dev->base_addr; | 
 | 375 | 	unsigned long flags; | 
 | 376 |  | 
 | 377 |  | 
 | 378 | 	flags=claim_dma_lock(); | 
 | 379 | 	disable_dma(dma); | 
 | 380 | 	clear_dma_ff(dma); | 
 | 381 | 	set_dma_mode(dma,DMA_MODE_READ); | 
 | 382 | 	set_dma_addr(dma,virt_to_bus(ltdmacbuf)); | 
 | 383 | 	set_dma_count(dma,50); | 
 | 384 | 	enable_dma(dma); | 
 | 385 | 	release_dma_lock(flags); | 
 | 386 |  | 
 | 387 | 	inb_p(base+3); | 
 | 388 | 	inb_p(base+2); | 
 | 389 |  | 
 | 390 | 	if ( wait_timeout(dev,0xfc) ) printk("timed out in handlefc\n"); | 
 | 391 | } | 
 | 392 |  | 
 | 393 | /* read data from the card */ | 
 | 394 | static void handlefd(struct net_device *dev) | 
 | 395 | { | 
 | 396 | 	int dma = dev->dma; | 
 | 397 | 	int base = dev->base_addr; | 
 | 398 | 	unsigned long flags; | 
 | 399 |  | 
 | 400 | 	flags=claim_dma_lock(); | 
 | 401 | 	disable_dma(dma); | 
 | 402 | 	clear_dma_ff(dma); | 
 | 403 | 	set_dma_mode(dma,DMA_MODE_READ); | 
 | 404 | 	set_dma_addr(dma,virt_to_bus(ltdmabuf)); | 
 | 405 | 	set_dma_count(dma,800); | 
 | 406 | 	enable_dma(dma); | 
 | 407 | 	release_dma_lock(flags); | 
 | 408 |  | 
 | 409 | 	inb_p(base+3); | 
 | 410 | 	inb_p(base+2); | 
 | 411 |  | 
 | 412 | 	if ( wait_timeout(dev,0xfd) ) printk("timed out in handlefd\n"); | 
 | 413 | 	sendup_buffer(dev); | 
 | 414 | }  | 
 | 415 |  | 
 | 416 | static void handlewrite(struct net_device *dev) | 
 | 417 | { | 
 | 418 | 	/* called *only* from idle, non-reentrant */ | 
 | 419 | 	/* on entry, 0xfb and ltdmabuf holds data */ | 
 | 420 | 	int dma = dev->dma; | 
 | 421 | 	int base = dev->base_addr; | 
 | 422 | 	unsigned long flags; | 
 | 423 | 	 | 
 | 424 | 	flags=claim_dma_lock(); | 
 | 425 | 	disable_dma(dma); | 
 | 426 | 	clear_dma_ff(dma); | 
 | 427 | 	set_dma_mode(dma,DMA_MODE_WRITE); | 
 | 428 | 	set_dma_addr(dma,virt_to_bus(ltdmabuf)); | 
 | 429 | 	set_dma_count(dma,800); | 
 | 430 | 	enable_dma(dma); | 
 | 431 | 	release_dma_lock(flags); | 
 | 432 | 	 | 
 | 433 | 	inb_p(base+3); | 
 | 434 | 	inb_p(base+2); | 
 | 435 |  | 
 | 436 | 	if ( wait_timeout(dev,0xfb) ) { | 
 | 437 | 		flags=claim_dma_lock(); | 
 | 438 | 		printk("timed out in handlewrite, dma res %d\n", | 
 | 439 | 			get_dma_residue(dev->dma) ); | 
 | 440 | 		release_dma_lock(flags); | 
 | 441 | 	} | 
 | 442 | } | 
 | 443 |  | 
 | 444 | static void handleread(struct net_device *dev) | 
 | 445 | { | 
 | 446 | 	/* on entry, 0xfb */ | 
 | 447 | 	/* on exit, ltdmabuf holds data */ | 
 | 448 | 	int dma = dev->dma; | 
 | 449 | 	int base = dev->base_addr; | 
 | 450 | 	unsigned long flags; | 
 | 451 |  | 
 | 452 | 	 | 
 | 453 | 	flags=claim_dma_lock(); | 
 | 454 | 	disable_dma(dma); | 
 | 455 | 	clear_dma_ff(dma); | 
 | 456 | 	set_dma_mode(dma,DMA_MODE_READ); | 
 | 457 | 	set_dma_addr(dma,virt_to_bus(ltdmabuf)); | 
 | 458 | 	set_dma_count(dma,800); | 
 | 459 | 	enable_dma(dma); | 
 | 460 | 	release_dma_lock(flags); | 
 | 461 |  | 
 | 462 | 	inb_p(base+3); | 
 | 463 | 	inb_p(base+2); | 
 | 464 | 	if ( wait_timeout(dev,0xfb) ) printk("timed out in handleread\n"); | 
 | 465 | } | 
 | 466 |  | 
 | 467 | static void handlecommand(struct net_device *dev) | 
 | 468 | { | 
 | 469 | 	/* on entry, 0xfa and ltdmacbuf holds command */ | 
 | 470 | 	int dma = dev->dma; | 
 | 471 | 	int base = dev->base_addr; | 
 | 472 | 	unsigned long flags; | 
 | 473 |  | 
 | 474 | 	flags=claim_dma_lock(); | 
 | 475 | 	disable_dma(dma); | 
 | 476 | 	clear_dma_ff(dma); | 
 | 477 | 	set_dma_mode(dma,DMA_MODE_WRITE); | 
 | 478 | 	set_dma_addr(dma,virt_to_bus(ltdmacbuf)); | 
 | 479 | 	set_dma_count(dma,50); | 
 | 480 | 	enable_dma(dma); | 
 | 481 | 	release_dma_lock(flags); | 
 | 482 | 	inb_p(base+3); | 
 | 483 | 	inb_p(base+2); | 
 | 484 | 	if ( wait_timeout(dev,0xfa) ) printk("timed out in handlecommand\n"); | 
 | 485 | }  | 
 | 486 |  | 
 | 487 | /* ready made command for getting the result from the card */ | 
 | 488 | static unsigned char rescbuf[2] = {LT_GETRESULT,0}; | 
 | 489 | static unsigned char resdbuf[2]; | 
 | 490 |  | 
 | 491 | static int QInIdle; | 
 | 492 |  | 
 | 493 | /* idle expects to be called with the IRQ line high -- either because of | 
 | 494 |  * an interrupt, or because the line is tri-stated | 
 | 495 |  */ | 
 | 496 |  | 
 | 497 | static void idle(struct net_device *dev) | 
 | 498 | { | 
 | 499 | 	unsigned long flags; | 
 | 500 | 	int state; | 
 | 501 | 	/* FIXME This is initialized to shut the warning up, but I need to | 
 | 502 | 	 * think this through again. | 
 | 503 | 	 */ | 
 | 504 | 	struct xmitQel *q = NULL; | 
 | 505 | 	int oops; | 
 | 506 | 	int i; | 
 | 507 | 	int base = dev->base_addr; | 
 | 508 |  | 
 | 509 | 	spin_lock_irqsave(&txqueue_lock, flags); | 
 | 510 | 	if(QInIdle) { | 
 | 511 | 		spin_unlock_irqrestore(&txqueue_lock, flags); | 
 | 512 | 		return; | 
 | 513 | 	} | 
 | 514 | 	QInIdle = 1; | 
 | 515 | 	spin_unlock_irqrestore(&txqueue_lock, flags); | 
 | 516 |  | 
 | 517 | 	/* this tri-states the IRQ line */ | 
 | 518 | 	(void) inb_p(base+6); | 
 | 519 |  | 
 | 520 | 	oops = 100; | 
 | 521 |  | 
 | 522 | loop: | 
 | 523 | 	if (0>oops--) {  | 
 | 524 | 		printk("idle: looped too many times\n"); | 
 | 525 | 		goto done; | 
 | 526 | 	} | 
 | 527 |  | 
 | 528 | 	state = inb_p(base+6); | 
 | 529 | 	if (state != inb_p(base+6)) goto loop; | 
 | 530 |  | 
 | 531 | 	switch(state) { | 
 | 532 | 		case 0xfc: | 
 | 533 | 			/* incoming command */ | 
 | 534 | 			if (debug & DEBUG_LOWER) printk("idle: fc\n"); | 
 | 535 | 			handlefc(dev);  | 
 | 536 | 			break; | 
 | 537 | 		case 0xfd: | 
 | 538 | 			/* incoming data */ | 
 | 539 | 			if(debug & DEBUG_LOWER) printk("idle: fd\n"); | 
 | 540 | 			handlefd(dev);  | 
 | 541 | 			break; | 
 | 542 | 		case 0xf9: | 
 | 543 | 			/* result ready */ | 
 | 544 | 			if (debug & DEBUG_LOWER) printk("idle: f9\n"); | 
 | 545 | 			if(!mboxinuse[0]) { | 
 | 546 | 				mboxinuse[0] = 1; | 
 | 547 | 				qels[0].cbuf = rescbuf; | 
 | 548 | 				qels[0].cbuflen = 2; | 
 | 549 | 				qels[0].dbuf = resdbuf; | 
 | 550 | 				qels[0].dbuflen = 2; | 
 | 551 | 				qels[0].QWrite = 0; | 
 | 552 | 				qels[0].mailbox = 0; | 
 | 553 | 				enQ(&qels[0]); | 
 | 554 | 			} | 
 | 555 | 			inb_p(dev->base_addr+1); | 
 | 556 | 			inb_p(dev->base_addr+0); | 
 | 557 | 			if( wait_timeout(dev,0xf9) ) | 
 | 558 | 				printk("timed out idle f9\n"); | 
 | 559 | 			break; | 
 | 560 | 		case 0xf8: | 
 | 561 | 			/* ?? */ | 
 | 562 | 			if (xmQhd) { | 
 | 563 | 				inb_p(dev->base_addr+1); | 
 | 564 | 				inb_p(dev->base_addr+0); | 
 | 565 | 				if(wait_timeout(dev,0xf8) ) | 
 | 566 | 					printk("timed out idle f8\n"); | 
 | 567 | 			} else { | 
 | 568 | 				goto done; | 
 | 569 | 			} | 
 | 570 | 			break; | 
 | 571 | 		case 0xfa: | 
 | 572 | 			/* waiting for command */ | 
 | 573 | 			if(debug & DEBUG_LOWER) printk("idle: fa\n"); | 
 | 574 | 			if (xmQhd) { | 
 | 575 | 				q=deQ(); | 
 | 576 | 				memcpy(ltdmacbuf,q->cbuf,q->cbuflen); | 
 | 577 | 				ltdmacbuf[1] = q->mailbox; | 
 | 578 | 				if (debug>1) {  | 
 | 579 | 					int n; | 
 | 580 | 					printk("ltpc: sent command     "); | 
 | 581 | 					n = q->cbuflen; | 
 | 582 | 					if (n>100) n=100; | 
 | 583 | 					for(i=0;i<n;i++) | 
 | 584 | 						printk("%02x ",ltdmacbuf[i]); | 
 | 585 | 					printk("\n"); | 
 | 586 | 				} | 
 | 587 | 				handlecommand(dev); | 
 | 588 | 					if(0xfa==inb_p(base+6)) { | 
 | 589 | 						/* we timed out, so return */ | 
 | 590 | 						goto done; | 
 | 591 | 					}  | 
 | 592 | 			} else { | 
 | 593 | 				/* we don't seem to have a command */ | 
 | 594 | 				if (!mboxinuse[0]) { | 
 | 595 | 					mboxinuse[0] = 1; | 
 | 596 | 					qels[0].cbuf = rescbuf; | 
 | 597 | 					qels[0].cbuflen = 2; | 
 | 598 | 					qels[0].dbuf = resdbuf; | 
 | 599 | 					qels[0].dbuflen = 2; | 
 | 600 | 					qels[0].QWrite = 0; | 
 | 601 | 					qels[0].mailbox = 0; | 
 | 602 | 					enQ(&qels[0]); | 
 | 603 | 				} else { | 
 | 604 | 					printk("trouble: response command already queued\n"); | 
 | 605 | 					goto done; | 
 | 606 | 				} | 
 | 607 | 			}  | 
 | 608 | 			break; | 
 | 609 | 		case 0Xfb: | 
 | 610 | 			/* data transfer ready */ | 
 | 611 | 			if(debug & DEBUG_LOWER) printk("idle: fb\n"); | 
 | 612 | 			if(q->QWrite) { | 
 | 613 | 				memcpy(ltdmabuf,q->dbuf,q->dbuflen); | 
 | 614 | 				handlewrite(dev); | 
 | 615 | 			} else { | 
 | 616 | 				handleread(dev); | 
 | 617 | 				/* non-zero mailbox numbers are for | 
 | 618 | 				   commmands, 0 is for GETRESULT | 
 | 619 | 				   requests */ | 
 | 620 | 				if(q->mailbox) { | 
 | 621 | 					memcpy(q->dbuf,ltdmabuf,q->dbuflen); | 
 | 622 | 				} else {  | 
 | 623 | 					/* this was a result */ | 
 | 624 | 					mailbox[ 0x0f & ltdmabuf[0] ] = ltdmabuf[1]; | 
 | 625 | 					mboxinuse[0]=0; | 
 | 626 | 				} | 
 | 627 | 			} | 
 | 628 | 			break; | 
 | 629 | 	} | 
 | 630 | 	goto loop; | 
 | 631 |  | 
 | 632 | done: | 
 | 633 | 	QInIdle=0; | 
 | 634 |  | 
 | 635 | 	/* now set the interrupts back as appropriate */ | 
 | 636 | 	/* the first read takes it out of tri-state (but still high) */ | 
 | 637 | 	/* the second resets it */ | 
 | 638 | 	/* note that after this point, any read of base+6 will | 
 | 639 | 	   trigger an interrupt */ | 
 | 640 |  | 
 | 641 | 	if (dev->irq) { | 
 | 642 | 		inb_p(base+7); | 
 | 643 | 		inb_p(base+7); | 
 | 644 | 	} | 
 | 645 | 	return; | 
 | 646 | } | 
 | 647 |  | 
 | 648 |  | 
 | 649 | static int do_write(struct net_device *dev, void *cbuf, int cbuflen, | 
 | 650 | 	void *dbuf, int dbuflen) | 
 | 651 | { | 
 | 652 |  | 
 | 653 | 	int i = getmbox(); | 
 | 654 | 	int ret; | 
 | 655 |  | 
 | 656 | 	if(i) { | 
 | 657 | 		qels[i].cbuf = (unsigned char *) cbuf; | 
 | 658 | 		qels[i].cbuflen = cbuflen; | 
 | 659 | 		qels[i].dbuf = (unsigned char *) dbuf; | 
 | 660 | 		qels[i].dbuflen = dbuflen; | 
 | 661 | 		qels[i].QWrite = 1; | 
 | 662 | 		qels[i].mailbox = i;  /* this should be initted rather */ | 
 | 663 | 		enQ(&qels[i]); | 
 | 664 | 		idle(dev); | 
 | 665 | 		ret = mailbox[i]; | 
 | 666 | 		mboxinuse[i]=0; | 
 | 667 | 		return ret; | 
 | 668 | 	} | 
 | 669 | 	printk("ltpc: could not allocate mbox\n"); | 
 | 670 | 	return -1; | 
 | 671 | } | 
 | 672 |  | 
 | 673 | static int do_read(struct net_device *dev, void *cbuf, int cbuflen, | 
 | 674 | 	void *dbuf, int dbuflen) | 
 | 675 | { | 
 | 676 |  | 
 | 677 | 	int i = getmbox(); | 
 | 678 | 	int ret; | 
 | 679 |  | 
 | 680 | 	if(i) { | 
 | 681 | 		qels[i].cbuf = (unsigned char *) cbuf; | 
 | 682 | 		qels[i].cbuflen = cbuflen; | 
 | 683 | 		qels[i].dbuf = (unsigned char *) dbuf; | 
 | 684 | 		qels[i].dbuflen = dbuflen; | 
 | 685 | 		qels[i].QWrite = 0; | 
 | 686 | 		qels[i].mailbox = i;  /* this should be initted rather */ | 
 | 687 | 		enQ(&qels[i]); | 
 | 688 | 		idle(dev); | 
 | 689 | 		ret = mailbox[i]; | 
 | 690 | 		mboxinuse[i]=0; | 
 | 691 | 		return ret; | 
 | 692 | 	} | 
 | 693 | 	printk("ltpc: could not allocate mbox\n"); | 
 | 694 | 	return -1; | 
 | 695 | } | 
 | 696 |  | 
 | 697 | /* end of idle handlers -- what should be seen is do_read, do_write */ | 
 | 698 |  | 
 | 699 | static struct timer_list ltpc_timer; | 
 | 700 |  | 
 | 701 | static int ltpc_xmit(struct sk_buff *skb, struct net_device *dev); | 
 | 702 | static struct net_device_stats *ltpc_get_stats(struct net_device *dev); | 
 | 703 |  | 
 | 704 | static int read_30 ( struct net_device *dev) | 
 | 705 | { | 
 | 706 | 	lt_command c; | 
 | 707 | 	c.getflags.command = LT_GETFLAGS; | 
 | 708 | 	return do_read(dev, &c, sizeof(c.getflags),&c,0); | 
 | 709 | } | 
 | 710 |  | 
 | 711 | static int set_30 (struct net_device *dev,int x) | 
 | 712 | { | 
 | 713 | 	lt_command c; | 
 | 714 | 	c.setflags.command = LT_SETFLAGS; | 
 | 715 | 	c.setflags.flags = x; | 
 | 716 | 	return do_write(dev, &c, sizeof(c.setflags),&c,0); | 
 | 717 | } | 
 | 718 |  | 
 | 719 | /* LLAP to DDP translation */ | 
 | 720 |  | 
 | 721 | static int sendup_buffer (struct net_device *dev) | 
 | 722 | { | 
 | 723 | 	/* on entry, command is in ltdmacbuf, data in ltdmabuf */ | 
 | 724 | 	/* called from idle, non-reentrant */ | 
 | 725 |  | 
 | 726 | 	int dnode, snode, llaptype, len;  | 
 | 727 | 	int sklen; | 
 | 728 | 	struct sk_buff *skb; | 
 | 729 | 	struct net_device_stats *stats = &((struct ltpc_private *)dev->priv)->stats; | 
 | 730 | 	struct lt_rcvlap *ltc = (struct lt_rcvlap *) ltdmacbuf; | 
 | 731 |  | 
 | 732 | 	if (ltc->command != LT_RCVLAP) { | 
 | 733 | 		printk("unknown command 0x%02x from ltpc card\n",ltc->command); | 
 | 734 | 		return(-1); | 
 | 735 | 	} | 
 | 736 | 	dnode = ltc->dnode; | 
 | 737 | 	snode = ltc->snode; | 
 | 738 | 	llaptype = ltc->laptype; | 
 | 739 | 	len = ltc->length;  | 
 | 740 |  | 
 | 741 | 	sklen = len; | 
 | 742 | 	if (llaptype == 1)  | 
 | 743 | 		sklen += 8;  /* correct for short ddp */ | 
 | 744 | 	if(sklen > 800) { | 
 | 745 | 		printk(KERN_INFO "%s: nonsense length in ltpc command 0x14: 0x%08x\n", | 
 | 746 | 			dev->name,sklen); | 
 | 747 | 		return -1; | 
 | 748 | 	} | 
 | 749 |  | 
 | 750 | 	if ( (llaptype==0) || (llaptype>2) ) { | 
 | 751 | 		printk(KERN_INFO "%s: unknown LLAP type: %d\n",dev->name,llaptype); | 
 | 752 | 		return -1; | 
 | 753 | 	} | 
 | 754 |  | 
 | 755 |  | 
 | 756 | 	skb = dev_alloc_skb(3+sklen); | 
 | 757 | 	if (skb == NULL)  | 
 | 758 | 	{ | 
 | 759 | 		printk("%s: dropping packet due to memory squeeze.\n", | 
 | 760 | 			dev->name); | 
 | 761 | 		return -1; | 
 | 762 | 	} | 
 | 763 | 	skb->dev = dev; | 
 | 764 |  | 
 | 765 | 	if (sklen > len) | 
 | 766 | 		skb_reserve(skb,8); | 
 | 767 | 	skb_put(skb,len+3); | 
 | 768 | 	skb->protocol = htons(ETH_P_LOCALTALK); | 
 | 769 | 	/* add LLAP header */ | 
 | 770 | 	skb->data[0] = dnode; | 
 | 771 | 	skb->data[1] = snode; | 
 | 772 | 	skb->data[2] = llaptype; | 
 | 773 | 	skb->mac.raw = skb->data;	/* save pointer to llap header */ | 
 | 774 | 	skb_pull(skb,3); | 
 | 775 |  | 
 | 776 | 	/* copy ddp(s,e)hdr + contents */ | 
 | 777 | 	memcpy(skb->data,(void*)ltdmabuf,len); | 
 | 778 |  | 
 | 779 | 	skb->h.raw = skb->data; | 
 | 780 |  | 
 | 781 | 	stats->rx_packets++; | 
 | 782 | 	stats->rx_bytes+=skb->len; | 
 | 783 |  | 
 | 784 | 	/* toss it onwards */ | 
 | 785 | 	netif_rx(skb); | 
 | 786 | 	dev->last_rx = jiffies; | 
 | 787 | 	return 0; | 
 | 788 | } | 
 | 789 |  | 
 | 790 | /* the handler for the board interrupt */ | 
 | 791 |   | 
 | 792 | static irqreturn_t | 
 | 793 | ltpc_interrupt(int irq, void *dev_id, struct pt_regs *reg_ptr) | 
 | 794 | { | 
 | 795 | 	struct net_device *dev = dev_id; | 
 | 796 |  | 
 | 797 | 	if (dev==NULL) { | 
 | 798 | 		printk("ltpc_interrupt: unknown device.\n"); | 
 | 799 | 		return IRQ_NONE; | 
 | 800 | 	} | 
 | 801 |  | 
 | 802 | 	inb_p(dev->base_addr+6);  /* disable further interrupts from board */ | 
 | 803 |  | 
 | 804 | 	idle(dev); /* handle whatever is coming in */ | 
 | 805 |   | 
 | 806 | 	/* idle re-enables interrupts from board */  | 
 | 807 |  | 
 | 808 | 	return IRQ_HANDLED; | 
 | 809 | } | 
 | 810 |  | 
 | 811 | /*** | 
 | 812 |  * | 
 | 813 |  *    The ioctls that the driver responds to are: | 
 | 814 |  * | 
 | 815 |  *    SIOCSIFADDR -- do probe using the passed node hint. | 
 | 816 |  *    SIOCGIFADDR -- return net, node. | 
 | 817 |  * | 
 | 818 |  *    some of this stuff should be done elsewhere. | 
 | 819 |  * | 
 | 820 |  ***/ | 
 | 821 |  | 
 | 822 | static int ltpc_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) | 
 | 823 | { | 
 | 824 | 	struct sockaddr_at *sa = (struct sockaddr_at *) &ifr->ifr_addr; | 
 | 825 | 	/* we'll keep the localtalk node address in dev->pa_addr */ | 
 | 826 | 	struct atalk_addr *aa = &((struct ltpc_private *)dev->priv)->my_addr; | 
 | 827 | 	struct lt_init c; | 
 | 828 | 	int ltflags; | 
 | 829 |  | 
 | 830 | 	if(debug & DEBUG_VERBOSE) printk("ltpc_ioctl called\n"); | 
 | 831 |  | 
 | 832 | 	switch(cmd) { | 
 | 833 | 		case SIOCSIFADDR: | 
 | 834 |  | 
 | 835 | 			aa->s_net  = sa->sat_addr.s_net; | 
 | 836 |        | 
 | 837 | 			/* this does the probe and returns the node addr */ | 
 | 838 | 			c.command = LT_INIT; | 
 | 839 | 			c.hint = sa->sat_addr.s_node; | 
 | 840 |  | 
 | 841 | 			aa->s_node = do_read(dev,&c,sizeof(c),&c,0); | 
 | 842 |  | 
 | 843 | 			/* get all llap frames raw */ | 
 | 844 | 			ltflags = read_30(dev); | 
 | 845 | 			ltflags |= LT_FLAG_ALLLAP; | 
 | 846 | 			set_30 (dev,ltflags);   | 
 | 847 |  | 
 | 848 | 			dev->broadcast[0] = 0xFF; | 
 | 849 | 			dev->dev_addr[0] = aa->s_node; | 
 | 850 |  | 
 | 851 | 			dev->addr_len=1; | 
 | 852 |     | 
 | 853 | 			return 0; | 
 | 854 |  | 
 | 855 | 		case SIOCGIFADDR: | 
 | 856 |  | 
 | 857 | 			sa->sat_addr.s_net = aa->s_net; | 
 | 858 | 			sa->sat_addr.s_node = aa->s_node; | 
 | 859 |  | 
 | 860 | 			return 0; | 
 | 861 |  | 
 | 862 | 		default:  | 
 | 863 | 			return -EINVAL; | 
 | 864 | 	} | 
 | 865 | } | 
 | 866 |  | 
 | 867 | static void set_multicast_list(struct net_device *dev) | 
 | 868 | { | 
 | 869 | 	/* This needs to be present to keep netatalk happy. */ | 
 | 870 | 	/* Actually netatalk needs fixing! */ | 
 | 871 | } | 
 | 872 |  | 
 | 873 | static int ltpc_hard_header (struct sk_buff *skb, struct net_device *dev,  | 
 | 874 | 	unsigned short type, void *daddr, void *saddr, unsigned len) | 
 | 875 | { | 
 | 876 | 	if(debug & DEBUG_VERBOSE) | 
 | 877 | 		printk("ltpc_hard_header called for device %s\n", | 
 | 878 | 			dev->name); | 
 | 879 | 	return 0; | 
 | 880 | } | 
 | 881 |  | 
 | 882 | static int ltpc_poll_counter; | 
 | 883 |  | 
 | 884 | static void ltpc_poll(unsigned long l) | 
 | 885 | { | 
 | 886 | 	struct net_device *dev = (struct net_device *) l; | 
 | 887 |  | 
 | 888 | 	del_timer(<pc_timer); | 
 | 889 |  | 
 | 890 | 	if(debug & DEBUG_VERBOSE) { | 
 | 891 | 		if (!ltpc_poll_counter) { | 
 | 892 | 			ltpc_poll_counter = 50; | 
 | 893 | 			printk("ltpc poll is alive\n"); | 
 | 894 | 		} | 
 | 895 | 		ltpc_poll_counter--; | 
 | 896 | 	} | 
 | 897 |    | 
 | 898 | 	if (!dev) | 
 | 899 | 		return;  /* we've been downed */ | 
 | 900 |  | 
 | 901 | 	/* poll 20 times per second */ | 
 | 902 | 	idle(dev); | 
 | 903 | 	ltpc_timer.expires = jiffies + HZ/20; | 
 | 904 | 	 | 
 | 905 | 	add_timer(<pc_timer); | 
 | 906 | } | 
 | 907 |  | 
 | 908 | /* DDP to LLAP translation */ | 
 | 909 |  | 
 | 910 | static int ltpc_xmit(struct sk_buff *skb, struct net_device *dev) | 
 | 911 | { | 
 | 912 | 	/* in kernel 1.3.xx, on entry skb->data points to ddp header, | 
 | 913 | 	 * and skb->len is the length of the ddp data + ddp header | 
 | 914 | 	 */ | 
 | 915 |  | 
 | 916 | 	struct net_device_stats *stats = &((struct ltpc_private *)dev->priv)->stats; | 
 | 917 |  | 
 | 918 | 	int i; | 
 | 919 | 	struct lt_sendlap cbuf; | 
 | 920 |  | 
 | 921 | 	cbuf.command = LT_SENDLAP; | 
 | 922 | 	cbuf.dnode = skb->data[0]; | 
 | 923 | 	cbuf.laptype = skb->data[2]; | 
 | 924 | 	skb_pull(skb,3);	/* skip past LLAP header */ | 
 | 925 | 	cbuf.length = skb->len;	/* this is host order */ | 
 | 926 | 	skb->h.raw=skb->data; | 
 | 927 |  | 
 | 928 | 	if(debug & DEBUG_UPPER) { | 
 | 929 | 		printk("command "); | 
 | 930 | 		for(i=0;i<6;i++) | 
 | 931 | 			printk("%02x ",((unsigned char *)&cbuf)[i]); | 
 | 932 | 		printk("\n"); | 
 | 933 | 	} | 
 | 934 |  | 
 | 935 | 	do_write(dev,&cbuf,sizeof(cbuf),skb->h.raw,skb->len); | 
 | 936 |  | 
 | 937 | 	if(debug & DEBUG_UPPER) { | 
 | 938 | 		printk("sent %d ddp bytes\n",skb->len); | 
 | 939 | 		for(i=0;i<skb->len;i++) printk("%02x ",skb->h.raw[i]); | 
 | 940 | 		printk("\n"); | 
 | 941 | 	} | 
 | 942 |  | 
 | 943 | 	stats->tx_packets++; | 
 | 944 | 	stats->tx_bytes+=skb->len; | 
 | 945 |  | 
 | 946 | 	dev_kfree_skb(skb); | 
 | 947 | 	return 0; | 
 | 948 | } | 
 | 949 |  | 
 | 950 | static struct net_device_stats *ltpc_get_stats(struct net_device *dev) | 
 | 951 | { | 
 | 952 | 	struct net_device_stats *stats = &((struct ltpc_private *) dev->priv)->stats; | 
 | 953 | 	return stats; | 
 | 954 | } | 
 | 955 |  | 
 | 956 | /* initialization stuff */ | 
 | 957 |    | 
 | 958 | static int __init ltpc_probe_dma(int base, int dma) | 
 | 959 | { | 
 | 960 | 	int want = (dma == 3) ? 2 : (dma == 1) ? 1 : 3; | 
 | 961 |   	unsigned long timeout; | 
 | 962 |   	unsigned long f; | 
 | 963 |    | 
 | 964 |   	if (want & 1) { | 
 | 965 | 		if (request_dma(1,"ltpc")) { | 
 | 966 | 			want &= ~1; | 
 | 967 | 		} else { | 
 | 968 | 			f=claim_dma_lock(); | 
 | 969 | 			disable_dma(1); | 
 | 970 | 			clear_dma_ff(1); | 
 | 971 | 			set_dma_mode(1,DMA_MODE_WRITE); | 
 | 972 | 			set_dma_addr(1,virt_to_bus(ltdmabuf)); | 
 | 973 | 			set_dma_count(1,sizeof(struct lt_mem)); | 
 | 974 | 			enable_dma(1); | 
 | 975 | 			release_dma_lock(f); | 
 | 976 | 		} | 
 | 977 | 	} | 
 | 978 | 	if (want & 2) { | 
 | 979 | 		if (request_dma(3,"ltpc")) { | 
 | 980 | 			want &= ~2; | 
 | 981 | 		} else { | 
 | 982 | 			f=claim_dma_lock(); | 
 | 983 | 			disable_dma(3); | 
 | 984 | 			clear_dma_ff(3); | 
 | 985 | 			set_dma_mode(3,DMA_MODE_WRITE); | 
 | 986 | 			set_dma_addr(3,virt_to_bus(ltdmabuf)); | 
 | 987 | 			set_dma_count(3,sizeof(struct lt_mem)); | 
 | 988 | 			enable_dma(3); | 
 | 989 | 			release_dma_lock(f); | 
 | 990 | 		} | 
 | 991 | 	} | 
 | 992 | 	/* set up request */ | 
 | 993 |  | 
 | 994 | 	/* FIXME -- do timings better! */ | 
 | 995 |  | 
 | 996 | 	ltdmabuf[0] = LT_READMEM; | 
 | 997 | 	ltdmabuf[1] = 1;  /* mailbox */ | 
 | 998 | 	ltdmabuf[2] = 0; ltdmabuf[3] = 0;  /* address */ | 
 | 999 | 	ltdmabuf[4] = 0; ltdmabuf[5] = 1;  /* read 0x0100 bytes */ | 
 | 1000 | 	ltdmabuf[6] = 0; /* dunno if this is necessary */ | 
 | 1001 |  | 
 | 1002 | 	inb_p(io+1); | 
 | 1003 | 	inb_p(io+0); | 
 | 1004 | 	timeout = jiffies+100*HZ/100; | 
 | 1005 | 	while(time_before(jiffies, timeout)) { | 
 | 1006 | 		if ( 0xfa == inb_p(io+6) ) break; | 
 | 1007 | 	} | 
 | 1008 |  | 
 | 1009 | 	inb_p(io+3); | 
 | 1010 | 	inb_p(io+2); | 
 | 1011 | 	while(time_before(jiffies, timeout)) { | 
 | 1012 | 		if ( 0xfb == inb_p(io+6) ) break; | 
 | 1013 | 	} | 
 | 1014 |  | 
 | 1015 | 	/* release the other dma channel (if we opened both of them) */ | 
 | 1016 |  | 
 | 1017 | 	if ((want & 2) && (get_dma_residue(3)==sizeof(struct lt_mem))) { | 
 | 1018 | 		want &= ~2; | 
 | 1019 | 		free_dma(3); | 
 | 1020 | 	} | 
 | 1021 |  | 
 | 1022 | 	if ((want & 1) && (get_dma_residue(1)==sizeof(struct lt_mem))) { | 
 | 1023 | 		want &= ~1; | 
 | 1024 | 		free_dma(1); | 
 | 1025 | 	} | 
 | 1026 |  | 
 | 1027 | 	if (!want) | 
 | 1028 | 		return 0; | 
 | 1029 |  | 
 | 1030 | 	return (want & 2) ? 3 : 1; | 
 | 1031 | } | 
 | 1032 |  | 
 | 1033 | struct net_device * __init ltpc_probe(void) | 
 | 1034 | { | 
 | 1035 | 	struct net_device *dev; | 
 | 1036 | 	int err = -ENOMEM; | 
 | 1037 | 	int x=0,y=0; | 
 | 1038 | 	int autoirq; | 
 | 1039 | 	unsigned long f; | 
 | 1040 | 	unsigned long timeout; | 
 | 1041 |  | 
| Christoph Hellwig | 3ef4e9a | 2005-05-05 14:25:59 -0700 | [diff] [blame] | 1042 | 	dev = alloc_ltalkdev(sizeof(struct ltpc_private)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1043 | 	if (!dev) | 
 | 1044 | 		goto out; | 
 | 1045 |  | 
 | 1046 | 	SET_MODULE_OWNER(dev); | 
 | 1047 |  | 
 | 1048 | 	/* probe for the I/O port address */ | 
 | 1049 | 	 | 
 | 1050 | 	if (io != 0x240 && request_region(0x220,8,"ltpc")) { | 
 | 1051 | 		x = inb_p(0x220+6); | 
 | 1052 | 		if ( (x!=0xff) && (x>=0xf0) ) { | 
 | 1053 | 			io = 0x220; | 
 | 1054 | 			goto got_port; | 
 | 1055 | 		} | 
 | 1056 | 		release_region(0x220,8); | 
 | 1057 | 	} | 
 | 1058 | 	if (io != 0x220 && request_region(0x240,8,"ltpc")) { | 
 | 1059 | 		y = inb_p(0x240+6); | 
 | 1060 | 		if ( (y!=0xff) && (y>=0xf0) ){  | 
 | 1061 | 			io = 0x240; | 
 | 1062 | 			goto got_port; | 
 | 1063 | 		} | 
 | 1064 | 		release_region(0x240,8); | 
 | 1065 | 	}  | 
 | 1066 |  | 
 | 1067 | 	/* give up in despair */ | 
 | 1068 | 	printk(KERN_ERR "LocalTalk card not found; 220 = %02x, 240 = %02x.\n", x,y); | 
 | 1069 | 	err = -ENODEV; | 
 | 1070 | 	goto out1; | 
 | 1071 |  | 
 | 1072 |  got_port: | 
 | 1073 | 	/* probe for the IRQ line */ | 
 | 1074 | 	if (irq < 2) { | 
 | 1075 | 		unsigned long irq_mask; | 
 | 1076 |  | 
 | 1077 | 		irq_mask = probe_irq_on(); | 
 | 1078 | 		/* reset the interrupt line */ | 
 | 1079 | 		inb_p(io+7); | 
 | 1080 | 		inb_p(io+7); | 
 | 1081 | 		/* trigger an interrupt (I hope) */ | 
 | 1082 | 		inb_p(io+6); | 
 | 1083 | 		mdelay(2); | 
 | 1084 | 		autoirq = probe_irq_off(irq_mask); | 
 | 1085 |  | 
 | 1086 | 		if (autoirq == 0) { | 
 | 1087 | 			printk(KERN_ERR "ltpc: probe at %#x failed to detect IRQ line.\n", io); | 
 | 1088 | 		} else { | 
 | 1089 | 			irq = autoirq; | 
 | 1090 | 		} | 
 | 1091 | 	} | 
 | 1092 |  | 
 | 1093 | 	/* allocate a DMA buffer */ | 
 | 1094 | 	ltdmabuf = (unsigned char *) dma_mem_alloc(1000); | 
 | 1095 | 	if (!ltdmabuf) { | 
 | 1096 | 		printk(KERN_ERR "ltpc: mem alloc failed\n"); | 
 | 1097 | 		err = -ENOMEM; | 
 | 1098 | 		goto out2; | 
 | 1099 | 	} | 
 | 1100 |  | 
 | 1101 | 	ltdmacbuf = <dmabuf[800]; | 
 | 1102 |  | 
 | 1103 | 	if(debug & DEBUG_VERBOSE) { | 
 | 1104 | 		printk("ltdmabuf pointer %08lx\n",(unsigned long) ltdmabuf); | 
 | 1105 | 	} | 
 | 1106 |  | 
 | 1107 | 	/* reset the card */ | 
 | 1108 |  | 
 | 1109 | 	inb_p(io+1); | 
 | 1110 | 	inb_p(io+3); | 
 | 1111 |  | 
| Nishanth Aravamudan | 2c4ee8f | 2005-06-22 22:19:52 -0700 | [diff] [blame] | 1112 | 	msleep(20); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1113 |  | 
 | 1114 | 	inb_p(io+0); | 
 | 1115 | 	inb_p(io+2); | 
 | 1116 | 	inb_p(io+7); /* clear reset */ | 
 | 1117 | 	inb_p(io+4);  | 
 | 1118 | 	inb_p(io+5); | 
 | 1119 | 	inb_p(io+5); /* enable dma */ | 
 | 1120 | 	inb_p(io+6); /* tri-state interrupt line */ | 
 | 1121 |  | 
| Nishanth Aravamudan | 2c4ee8f | 2005-06-22 22:19:52 -0700 | [diff] [blame] | 1122 | 	ssleep(1); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1123 | 	 | 
 | 1124 | 	/* now, figure out which dma channel we're using, unless it's | 
 | 1125 | 	   already been specified */ | 
 | 1126 | 	/* well, 0 is a legal DMA channel, but the LTPC card doesn't | 
 | 1127 | 	   use it... */ | 
 | 1128 | 	dma = ltpc_probe_dma(io, dma); | 
 | 1129 | 	if (!dma) {  /* no dma channel */ | 
 | 1130 | 		printk(KERN_ERR "No DMA channel found on ltpc card.\n"); | 
 | 1131 | 		err = -ENODEV; | 
 | 1132 | 		goto out3; | 
 | 1133 | 	} | 
 | 1134 |  | 
 | 1135 | 	/* print out friendly message */ | 
 | 1136 | 	if(irq) | 
 | 1137 | 		printk(KERN_INFO "Apple/Farallon LocalTalk-PC card at %03x, IR%d, DMA%d.\n",io,irq,dma); | 
 | 1138 | 	else | 
 | 1139 | 		printk(KERN_INFO "Apple/Farallon LocalTalk-PC card at %03x, DMA%d.  Using polled mode.\n",io,dma); | 
 | 1140 |  | 
 | 1141 | 	/* Fill in the fields of the device structure with ethernet-generic values. */ | 
 | 1142 | 	dev->hard_start_xmit = ltpc_xmit; | 
 | 1143 | 	dev->hard_header = ltpc_hard_header; | 
 | 1144 | 	dev->get_stats = ltpc_get_stats; | 
 | 1145 |  | 
 | 1146 | 	/* add the ltpc-specific things */ | 
 | 1147 | 	dev->do_ioctl = <pc_ioctl; | 
 | 1148 |  | 
 | 1149 | 	dev->set_multicast_list = &set_multicast_list; | 
 | 1150 | 	dev->mc_list = NULL; | 
 | 1151 | 	dev->base_addr = io; | 
 | 1152 | 	dev->irq = irq; | 
 | 1153 | 	dev->dma = dma; | 
 | 1154 |  | 
 | 1155 | 	/* the card will want to send a result at this point */ | 
 | 1156 | 	/* (I think... leaving out this part makes the kernel crash, | 
 | 1157 |            so I put it back in...) */ | 
 | 1158 |  | 
 | 1159 | 	f=claim_dma_lock(); | 
 | 1160 | 	disable_dma(dma); | 
 | 1161 | 	clear_dma_ff(dma); | 
 | 1162 | 	set_dma_mode(dma,DMA_MODE_READ); | 
 | 1163 | 	set_dma_addr(dma,virt_to_bus(ltdmabuf)); | 
 | 1164 | 	set_dma_count(dma,0x100); | 
 | 1165 | 	enable_dma(dma); | 
 | 1166 | 	release_dma_lock(f); | 
 | 1167 |  | 
 | 1168 | 	(void) inb_p(io+3); | 
 | 1169 | 	(void) inb_p(io+2); | 
 | 1170 | 	timeout = jiffies+100*HZ/100; | 
 | 1171 |  | 
 | 1172 | 	while(time_before(jiffies, timeout)) { | 
 | 1173 | 		if( 0xf9 == inb_p(io+6)) | 
 | 1174 | 			break; | 
 | 1175 | 		schedule(); | 
 | 1176 | 	} | 
 | 1177 |  | 
 | 1178 | 	if(debug & DEBUG_VERBOSE) { | 
 | 1179 | 		printk("setting up timer and irq\n"); | 
 | 1180 | 	} | 
 | 1181 |  | 
 | 1182 | 	/* grab it and don't let go :-) */ | 
 | 1183 | 	if (irq && request_irq( irq, <pc_interrupt, 0, "ltpc", dev) >= 0) | 
 | 1184 | 	{ | 
 | 1185 | 		(void) inb_p(io+7);  /* enable interrupts from board */ | 
 | 1186 | 		(void) inb_p(io+7);  /* and reset irq line */ | 
 | 1187 | 	} else { | 
 | 1188 | 		if( irq ) | 
 | 1189 | 			printk(KERN_ERR "ltpc: IRQ already in use, using polled mode.\n"); | 
 | 1190 | 		dev->irq = 0; | 
 | 1191 | 		/* polled mode -- 20 times per second */ | 
 | 1192 | 		/* this is really, really slow... should it poll more often? */ | 
 | 1193 | 		init_timer(<pc_timer); | 
 | 1194 | 		ltpc_timer.function=ltpc_poll; | 
 | 1195 | 		ltpc_timer.data = (unsigned long) dev; | 
 | 1196 |  | 
 | 1197 | 		ltpc_timer.expires = jiffies + HZ/20; | 
 | 1198 | 		add_timer(<pc_timer); | 
 | 1199 | 	} | 
 | 1200 | 	err = register_netdev(dev); | 
 | 1201 | 	if (err) | 
 | 1202 | 		goto out4; | 
 | 1203 |  | 
 | 1204 | 	return NULL; | 
 | 1205 | out4: | 
 | 1206 | 	del_timer_sync(<pc_timer); | 
 | 1207 | 	if (dev->irq) | 
 | 1208 | 		free_irq(dev->irq, dev); | 
 | 1209 | out3: | 
 | 1210 | 	free_pages((unsigned long)ltdmabuf, get_order(1000)); | 
 | 1211 | out2: | 
 | 1212 | 	release_region(io, 8); | 
 | 1213 | out1: | 
 | 1214 | 	free_netdev(dev); | 
 | 1215 | out: | 
 | 1216 | 	return ERR_PTR(err); | 
 | 1217 | } | 
 | 1218 |  | 
 | 1219 | #ifndef MODULE | 
 | 1220 | /* handles "ltpc=io,irq,dma" kernel command lines */ | 
 | 1221 | static int __init ltpc_setup(char *str) | 
 | 1222 | { | 
 | 1223 | 	int ints[5]; | 
 | 1224 |  | 
 | 1225 | 	str = get_options(str, ARRAY_SIZE(ints), ints); | 
 | 1226 |  | 
 | 1227 | 	if (ints[0] == 0) { | 
 | 1228 | 		if (str && !strncmp(str, "auto", 4)) { | 
 | 1229 | 			/* do nothing :-) */ | 
 | 1230 | 		} | 
 | 1231 | 		else { | 
 | 1232 | 			/* usage message */ | 
 | 1233 | 			printk (KERN_ERR | 
 | 1234 | 				"ltpc: usage: ltpc=auto|iobase[,irq[,dma]]\n"); | 
 | 1235 | 			return 0; | 
 | 1236 | 		} | 
 | 1237 | 	} else { | 
 | 1238 | 		io = ints[1]; | 
 | 1239 | 		if (ints[0] > 1) { | 
 | 1240 | 			irq = ints[2]; | 
 | 1241 | 		} | 
 | 1242 | 		if (ints[0] > 2) { | 
 | 1243 | 			dma = ints[3]; | 
 | 1244 | 		} | 
 | 1245 | 		/* ignore any other paramters */ | 
 | 1246 | 	} | 
 | 1247 | 	return 1; | 
 | 1248 | } | 
 | 1249 |  | 
 | 1250 | __setup("ltpc=", ltpc_setup); | 
 | 1251 | #endif /* MODULE */ | 
 | 1252 |  | 
 | 1253 | static struct net_device *dev_ltpc; | 
 | 1254 |  | 
 | 1255 | #ifdef MODULE | 
 | 1256 |  | 
 | 1257 | MODULE_LICENSE("GPL"); | 
 | 1258 | module_param(debug, int, 0); | 
 | 1259 | module_param(io, int, 0); | 
 | 1260 | module_param(irq, int, 0); | 
 | 1261 | module_param(dma, int, 0); | 
 | 1262 |  | 
 | 1263 |  | 
 | 1264 | int __init init_module(void) | 
 | 1265 | { | 
 | 1266 |         if(io == 0) | 
 | 1267 | 		printk(KERN_NOTICE | 
 | 1268 | 		       "ltpc: Autoprobing is not recommended for modules\n"); | 
 | 1269 |  | 
 | 1270 | 	dev_ltpc = ltpc_probe(); | 
 | 1271 | 	if (IS_ERR(dev_ltpc)) | 
 | 1272 | 		return PTR_ERR(dev_ltpc); | 
 | 1273 | 	return 0; | 
 | 1274 | } | 
 | 1275 | #endif | 
 | 1276 |  | 
 | 1277 | static void __exit ltpc_cleanup(void) | 
 | 1278 | { | 
 | 1279 |  | 
 | 1280 | 	if(debug & DEBUG_VERBOSE) printk("unregister_netdev\n"); | 
 | 1281 | 	unregister_netdev(dev_ltpc); | 
 | 1282 |  | 
 | 1283 | 	ltpc_timer.data = 0;  /* signal the poll routine that we're done */ | 
 | 1284 |  | 
 | 1285 | 	del_timer_sync(<pc_timer); | 
 | 1286 |  | 
 | 1287 | 	if(debug & DEBUG_VERBOSE) printk("freeing irq\n"); | 
 | 1288 |  | 
 | 1289 | 	if (dev_ltpc->irq) | 
 | 1290 | 		free_irq(dev_ltpc->irq, dev_ltpc); | 
 | 1291 |  | 
 | 1292 | 	if(debug & DEBUG_VERBOSE) printk("freeing dma\n"); | 
 | 1293 |  | 
 | 1294 | 	if (dev_ltpc->dma) | 
 | 1295 | 		free_dma(dev_ltpc->dma); | 
 | 1296 |  | 
 | 1297 | 	if(debug & DEBUG_VERBOSE) printk("freeing ioaddr\n"); | 
 | 1298 |  | 
 | 1299 | 	if (dev_ltpc->base_addr) | 
 | 1300 | 		release_region(dev_ltpc->base_addr,8); | 
 | 1301 |  | 
 | 1302 | 	free_netdev(dev_ltpc); | 
 | 1303 |  | 
 | 1304 | 	if(debug & DEBUG_VERBOSE) printk("free_pages\n"); | 
 | 1305 |  | 
 | 1306 | 	free_pages( (unsigned long) ltdmabuf, get_order(1000)); | 
 | 1307 |  | 
 | 1308 | 	if(debug & DEBUG_VERBOSE) printk("returning from cleanup_module\n"); | 
 | 1309 | } | 
 | 1310 |  | 
 | 1311 | module_exit(ltpc_cleanup); |