kmemtrace: SLOB hooks.
[linux-2.6/kmemtrace.git] / drivers / net / wan / sealevel.c
blob44a89df1b8bf88bda8233193a2c50cf281db5664
1 /*
2 * Sealevel Systems 4021 driver.
4 * This program is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU General Public License
6 * as published by the Free Software Foundation; either version
7 * 2 of the License, or (at your option) any later version.
9 * (c) Copyright 1999, 2001 Alan Cox
10 * (c) Copyright 2001 Red Hat Inc.
14 #include <linux/module.h>
15 #include <linux/kernel.h>
16 #include <linux/mm.h>
17 #include <linux/net.h>
18 #include <linux/skbuff.h>
19 #include <linux/netdevice.h>
20 #include <linux/if_arp.h>
21 #include <linux/delay.h>
22 #include <linux/ioport.h>
23 #include <linux/init.h>
24 #include <net/arp.h>
26 #include <asm/irq.h>
27 #include <asm/io.h>
28 #include <asm/dma.h>
29 #include <asm/byteorder.h>
30 #include <net/syncppp.h>
31 #include "z85230.h"
34 struct slvl_device
36 void *if_ptr; /* General purpose pointer (used by SPPP) */
37 struct z8530_channel *chan;
38 struct ppp_device pppdev;
39 int channel;
43 struct slvl_board
45 struct slvl_device *dev[2];
46 struct z8530_dev board;
47 int iobase;
51 * Network driver support routines
55 * Frame receive. Simple for our card as we do sync ppp and there
56 * is no funny garbage involved
59 static void sealevel_input(struct z8530_channel *c, struct sk_buff *skb)
61 /* Drop the CRC - it's not a good idea to try and negotiate it ;) */
62 skb_trim(skb, skb->len-2);
63 skb->protocol=htons(ETH_P_WAN_PPP);
64 skb_reset_mac_header(skb);
65 skb->dev=c->netdevice;
67 * Send it to the PPP layer. We don't have time to process
68 * it right now.
70 netif_rx(skb);
71 c->netdevice->last_rx = jiffies;
75 * We've been placed in the UP state
76 */
78 static int sealevel_open(struct net_device *d)
80 struct slvl_device *slvl=d->priv;
81 int err = -1;
82 int unit = slvl->channel;
85 * Link layer up.
88 switch(unit)
90 case 0:
91 err=z8530_sync_dma_open(d, slvl->chan);
92 break;
93 case 1:
94 err=z8530_sync_open(d, slvl->chan);
95 break;
98 if(err)
99 return err;
101 * Begin PPP
103 err=sppp_open(d);
104 if(err)
106 switch(unit)
108 case 0:
109 z8530_sync_dma_close(d, slvl->chan);
110 break;
111 case 1:
112 z8530_sync_close(d, slvl->chan);
113 break;
115 return err;
118 slvl->chan->rx_function=sealevel_input;
121 * Go go go
123 netif_start_queue(d);
124 return 0;
127 static int sealevel_close(struct net_device *d)
129 struct slvl_device *slvl=d->priv;
130 int unit = slvl->channel;
133 * Discard new frames
136 slvl->chan->rx_function=z8530_null_rx;
139 * PPP off
141 sppp_close(d);
143 * Link layer down
146 netif_stop_queue(d);
148 switch(unit)
150 case 0:
151 z8530_sync_dma_close(d, slvl->chan);
152 break;
153 case 1:
154 z8530_sync_close(d, slvl->chan);
155 break;
157 return 0;
160 static int sealevel_ioctl(struct net_device *d, struct ifreq *ifr, int cmd)
162 /* struct slvl_device *slvl=d->priv;
163 z8530_ioctl(d,&slvl->sync.chanA,ifr,cmd) */
164 return sppp_do_ioctl(d, ifr,cmd);
167 static struct net_device_stats *sealevel_get_stats(struct net_device *d)
169 struct slvl_device *slvl=d->priv;
170 if(slvl)
171 return z8530_get_stats(slvl->chan);
172 else
173 return NULL;
177 * Passed PPP frames, fire them downwind.
180 static int sealevel_queue_xmit(struct sk_buff *skb, struct net_device *d)
182 struct slvl_device *slvl=d->priv;
183 return z8530_queue_xmit(slvl->chan, skb);
186 static int sealevel_neigh_setup(struct neighbour *n)
188 if (n->nud_state == NUD_NONE) {
189 n->ops = &arp_broken_ops;
190 n->output = n->ops->output;
192 return 0;
195 static int sealevel_neigh_setup_dev(struct net_device *dev, struct neigh_parms *p)
197 if (p->tbl->family == AF_INET) {
198 p->neigh_setup = sealevel_neigh_setup;
199 p->ucast_probes = 0;
200 p->mcast_probes = 0;
202 return 0;
205 static int sealevel_attach(struct net_device *dev)
207 struct slvl_device *sv = dev->priv;
208 sppp_attach(&sv->pppdev);
209 return 0;
212 static void sealevel_detach(struct net_device *dev)
214 sppp_detach(dev);
217 static void slvl_setup(struct net_device *d)
219 d->open = sealevel_open;
220 d->stop = sealevel_close;
221 d->init = sealevel_attach;
222 d->uninit = sealevel_detach;
223 d->hard_start_xmit = sealevel_queue_xmit;
224 d->get_stats = sealevel_get_stats;
225 d->set_multicast_list = NULL;
226 d->do_ioctl = sealevel_ioctl;
227 d->neigh_setup = sealevel_neigh_setup_dev;
228 d->set_mac_address = NULL;
232 static inline struct slvl_device *slvl_alloc(int iobase, int irq)
234 struct net_device *d;
235 struct slvl_device *sv;
237 d = alloc_netdev(sizeof(struct slvl_device), "hdlc%d",
238 slvl_setup);
240 if (!d)
241 return NULL;
243 sv = d->priv;
244 d->ml_priv = sv;
245 sv->if_ptr = &sv->pppdev;
246 sv->pppdev.dev = d;
247 d->base_addr = iobase;
248 d->irq = irq;
250 return sv;
255 * Allocate and setup Sealevel board.
258 static __init struct slvl_board *slvl_init(int iobase, int irq,
259 int txdma, int rxdma, int slow)
261 struct z8530_dev *dev;
262 struct slvl_board *b;
265 * Get the needed I/O space
268 if(!request_region(iobase, 8, "Sealevel 4021"))
270 printk(KERN_WARNING "sealevel: I/O 0x%X already in use.\n", iobase);
271 return NULL;
274 b = kzalloc(sizeof(struct slvl_board), GFP_KERNEL);
275 if(!b)
276 goto fail3;
278 if (!(b->dev[0]= slvl_alloc(iobase, irq)))
279 goto fail2;
281 b->dev[0]->chan = &b->board.chanA;
282 b->dev[0]->channel = 0;
284 if (!(b->dev[1] = slvl_alloc(iobase, irq)))
285 goto fail1_0;
287 b->dev[1]->chan = &b->board.chanB;
288 b->dev[1]->channel = 1;
290 dev = &b->board;
293 * Stuff in the I/O addressing
296 dev->active = 0;
298 b->iobase = iobase;
301 * Select 8530 delays for the old board
304 if(slow)
305 iobase |= Z8530_PORT_SLEEP;
307 dev->chanA.ctrlio=iobase+1;
308 dev->chanA.dataio=iobase;
309 dev->chanB.ctrlio=iobase+3;
310 dev->chanB.dataio=iobase+2;
312 dev->chanA.irqs=&z8530_nop;
313 dev->chanB.irqs=&z8530_nop;
316 * Assert DTR enable DMA
319 outb(3|(1<<7), b->iobase+4);
322 /* We want a fast IRQ for this device. Actually we'd like an even faster
323 IRQ ;) - This is one driver RtLinux is made for */
325 if(request_irq(irq, &z8530_interrupt, IRQF_DISABLED, "SeaLevel", dev)<0)
327 printk(KERN_WARNING "sealevel: IRQ %d already in use.\n", irq);
328 goto fail1_1;
331 dev->irq=irq;
332 dev->chanA.private=&b->dev[0];
333 dev->chanB.private=&b->dev[1];
334 dev->chanA.netdevice=b->dev[0]->pppdev.dev;
335 dev->chanB.netdevice=b->dev[1]->pppdev.dev;
336 dev->chanA.dev=dev;
337 dev->chanB.dev=dev;
339 dev->chanA.txdma=3;
340 dev->chanA.rxdma=1;
341 if(request_dma(dev->chanA.txdma, "SeaLevel (TX)")!=0)
342 goto fail;
344 if(request_dma(dev->chanA.rxdma, "SeaLevel (RX)")!=0)
345 goto dmafail;
347 disable_irq(irq);
350 * Begin normal initialise
353 if(z8530_init(dev)!=0)
355 printk(KERN_ERR "Z8530 series device not found.\n");
356 enable_irq(irq);
357 goto dmafail2;
359 if(dev->type==Z85C30)
361 z8530_channel_load(&dev->chanA, z8530_hdlc_kilostream);
362 z8530_channel_load(&dev->chanB, z8530_hdlc_kilostream);
364 else
366 z8530_channel_load(&dev->chanA, z8530_hdlc_kilostream_85230);
367 z8530_channel_load(&dev->chanB, z8530_hdlc_kilostream_85230);
371 * Now we can take the IRQ
374 enable_irq(irq);
376 if (register_netdev(b->dev[0]->pppdev.dev))
377 goto dmafail2;
379 if (register_netdev(b->dev[1]->pppdev.dev))
380 goto fail_unit;
382 z8530_describe(dev, "I/O", iobase);
383 dev->active=1;
384 return b;
386 fail_unit:
387 unregister_netdev(b->dev[0]->pppdev.dev);
389 dmafail2:
390 free_dma(dev->chanA.rxdma);
391 dmafail:
392 free_dma(dev->chanA.txdma);
393 fail:
394 free_irq(irq, dev);
395 fail1_1:
396 free_netdev(b->dev[1]->pppdev.dev);
397 fail1_0:
398 free_netdev(b->dev[0]->pppdev.dev);
399 fail2:
400 kfree(b);
401 fail3:
402 release_region(iobase,8);
403 return NULL;
406 static void __exit slvl_shutdown(struct slvl_board *b)
408 int u;
410 z8530_shutdown(&b->board);
412 for(u=0; u<2; u++)
414 struct net_device *d = b->dev[u]->pppdev.dev;
415 unregister_netdev(d);
416 free_netdev(d);
419 free_irq(b->board.irq, &b->board);
420 free_dma(b->board.chanA.rxdma);
421 free_dma(b->board.chanA.txdma);
422 /* DMA off on the card, drop DTR */
423 outb(0, b->iobase);
424 release_region(b->iobase, 8);
425 kfree(b);
429 static int io=0x238;
430 static int txdma=1;
431 static int rxdma=3;
432 static int irq=5;
433 static int slow=0;
435 module_param(io, int, 0);
436 MODULE_PARM_DESC(io, "The I/O base of the Sealevel card");
437 module_param(txdma, int, 0);
438 MODULE_PARM_DESC(txdma, "Transmit DMA channel");
439 module_param(rxdma, int, 0);
440 MODULE_PARM_DESC(rxdma, "Receive DMA channel");
441 module_param(irq, int, 0);
442 MODULE_PARM_DESC(irq, "The interrupt line setting for the SeaLevel card");
443 module_param(slow, bool, 0);
444 MODULE_PARM_DESC(slow, "Set this for an older Sealevel card such as the 4012");
446 MODULE_AUTHOR("Alan Cox");
447 MODULE_LICENSE("GPL");
448 MODULE_DESCRIPTION("Modular driver for the SeaLevel 4021");
450 static struct slvl_board *slvl_unit;
452 static int __init slvl_init_module(void)
454 #ifdef MODULE
455 printk(KERN_INFO "SeaLevel Z85230 Synchronous Driver v 0.02.\n");
456 printk(KERN_INFO "(c) Copyright 1998, Building Number Three Ltd.\n");
457 #endif
458 slvl_unit = slvl_init(io, irq, txdma, rxdma, slow);
460 return slvl_unit ? 0 : -ENODEV;
463 static void __exit slvl_cleanup_module(void)
465 if(slvl_unit)
466 slvl_shutdown(slvl_unit);
469 module_init(slvl_init_module);
470 module_exit(slvl_cleanup_module);