[NET] drivers/net: statistics cleanup #1 -- save memory and shrink code
[linux-2.6] / drivers / net / de600.c
1 static const char version[] = "de600.c: $Revision: 1.41-2.5 $,  Bjorn Ekwall (bj0rn@blox.se)\n";
2 /*
3  *      de600.c
4  *
5  *      Linux driver for the D-Link DE-600 Ethernet pocket adapter.
6  *
7  *      Portions (C) Copyright 1993, 1994 by Bjorn Ekwall
8  *      The Author may be reached as bj0rn@blox.se
9  *
10  *      Based on adapter information gathered from DE600.ASM by D-Link Inc.,
11  *      as included on disk C in the v.2.11 of PC/TCP from FTP Software.
12  *      For DE600.asm:
13  *              Portions (C) Copyright 1990 D-Link, Inc.
14  *              Copyright, 1988-1992, Russell Nelson, Crynwr Software
15  *
16  *      Adapted to the sample network driver core for linux,
17  *      written by: Donald Becker <becker@super.org>
18  *              (Now at <becker@scyld.com>)
19  *
20  **************************************************************/
21 /*
22  *      This program is free software; you can redistribute it and/or modify
23  *      it under the terms of the GNU General Public License as published by
24  *      the Free Software Foundation; either version 2, or (at your option)
25  *      any later version.
26  *
27  *      This program is distributed in the hope that it will be useful,
28  *      but WITHOUT ANY WARRANTY; without even the implied warranty of
29  *      MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
30  *      GNU General Public License for more details.
31  *
32  *      You should have received a copy of the GNU General Public License
33  *      along with this program; if not, write to the Free Software
34  *      Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
35  *
36  **************************************************************/
37
38 /* Add more time here if your adapter won't work OK: */
39 #define DE600_SLOW_DOWN udelay(delay_time)
40
41 /* use 0 for production, 1 for verification, >2 for debug */
42 #ifdef DE600_DEBUG
43 #define PRINTK(x) if (de600_debug >= 2) printk x
44 #else
45 #define DE600_DEBUG 0
46 #define PRINTK(x) /**/
47 #endif
48
49 #include <linux/module.h>
50 #include <linux/kernel.h>
51 #include <linux/types.h>
52 #include <linux/fcntl.h>
53 #include <linux/string.h>
54 #include <linux/interrupt.h>
55 #include <linux/ioport.h>
56 #include <linux/in.h>
57 #include <asm/system.h>
58 #include <linux/errno.h>
59 #include <linux/init.h>
60 #include <linux/delay.h>
61 #include <linux/inet.h>
62 #include <linux/netdevice.h>
63 #include <linux/etherdevice.h>
64 #include <linux/skbuff.h>
65
66 #include <asm/io.h>
67
68 #include "de600.h"
69
70 static unsigned int de600_debug = DE600_DEBUG;
71 module_param(de600_debug, int, 0);
72 MODULE_PARM_DESC(de600_debug, "DE-600 debug level (0-2)");
73
74 static unsigned int check_lost = 1;
75 module_param(check_lost, bool, 0);
76 MODULE_PARM_DESC(check_lost, "If set then check for unplugged de600");
77
78 static unsigned int delay_time = 10;
79 module_param(delay_time, int, 0);
80 MODULE_PARM_DESC(delay_time, "DE-600 deley on I/O in microseconds");
81
82
83 /*
84  * D-Link driver variables:
85  */
86
87 static volatile int             rx_page;
88
89 #define TX_PAGES 2
90 static volatile int             tx_fifo[TX_PAGES];
91 static volatile int             tx_fifo_in;
92 static volatile int             tx_fifo_out;
93 static volatile int             free_tx_pages = TX_PAGES;
94 static int                      was_down;
95 static DEFINE_SPINLOCK(de600_lock);
96
97 static inline u8 de600_read_status(struct net_device *dev)
98 {
99         u8 status;
100
101         outb_p(STATUS, DATA_PORT);
102         status = inb(STATUS_PORT);
103         outb_p(NULL_COMMAND | HI_NIBBLE, DATA_PORT);
104
105         return status;
106 }
107
108 static inline u8 de600_read_byte(unsigned char type, struct net_device *dev)
109 {
110         /* dev used by macros */
111         u8 lo;
112         outb_p((type), DATA_PORT);
113         lo = ((unsigned char)inb(STATUS_PORT)) >> 4;
114         outb_p((type) | HI_NIBBLE, DATA_PORT);
115         return ((unsigned char)inb(STATUS_PORT) & (unsigned char)0xf0) | lo;
116 }
117
118 /*
119  * Open/initialize the board.  This is called (in the current kernel)
120  * after booting when 'ifconfig <dev->name> $IP_ADDR' is run (in rc.inet1).
121  *
122  * This routine should set everything up anew at each open, even
123  * registers that "should" only need to be set once at boot, so that
124  * there is a non-reboot way to recover if something goes wrong.
125  */
126
127 static int de600_open(struct net_device *dev)
128 {
129         unsigned long flags;
130         int ret = request_irq(DE600_IRQ, de600_interrupt, 0, dev->name, dev);
131         if (ret) {
132                 printk(KERN_ERR "%s: unable to get IRQ %d\n", dev->name, DE600_IRQ);
133                 return ret;
134         }
135         spin_lock_irqsave(&de600_lock, flags);
136         ret = adapter_init(dev);
137         spin_unlock_irqrestore(&de600_lock, flags);
138         return ret;
139 }
140
141 /*
142  * The inverse routine to de600_open().
143  */
144
145 static int de600_close(struct net_device *dev)
146 {
147         select_nic();
148         rx_page = 0;
149         de600_put_command(RESET);
150         de600_put_command(STOP_RESET);
151         de600_put_command(0);
152         select_prn();
153         free_irq(DE600_IRQ, dev);
154         return 0;
155 }
156
157 static inline void trigger_interrupt(struct net_device *dev)
158 {
159         de600_put_command(FLIP_IRQ);
160         select_prn();
161         DE600_SLOW_DOWN;
162         select_nic();
163         de600_put_command(0);
164 }
165
166 /*
167  * Copy a buffer to the adapter transmit page memory.
168  * Start sending.
169  */
170
171 static int de600_start_xmit(struct sk_buff *skb, struct net_device *dev)
172 {
173         unsigned long flags;
174         int     transmit_from;
175         int     len;
176         int     tickssofar;
177         u8      *buffer = skb->data;
178         int     i;
179
180         if (free_tx_pages <= 0) {       /* Do timeouts, to avoid hangs. */
181                 tickssofar = jiffies - dev->trans_start;
182                 if (tickssofar < 5)
183                         return 1;
184                 /* else */
185                 printk(KERN_WARNING "%s: transmit timed out (%d), %s?\n", dev->name, tickssofar, "network cable problem");
186                 /* Restart the adapter. */
187                 spin_lock_irqsave(&de600_lock, flags);
188                 if (adapter_init(dev)) {
189                         spin_unlock_irqrestore(&de600_lock, flags);
190                         return 1;
191                 }
192                 spin_unlock_irqrestore(&de600_lock, flags);
193         }
194
195         /* Start real output */
196         PRINTK(("de600_start_xmit:len=%d, page %d/%d\n", skb->len, tx_fifo_in, free_tx_pages));
197
198         if ((len = skb->len) < RUNT)
199                 len = RUNT;
200
201         spin_lock_irqsave(&de600_lock, flags);
202         select_nic();
203         tx_fifo[tx_fifo_in] = transmit_from = tx_page_adr(tx_fifo_in) - len;
204         tx_fifo_in = (tx_fifo_in + 1) % TX_PAGES; /* Next free tx page */
205
206         if(check_lost)
207         {
208                 /* This costs about 40 instructions per packet... */
209                 de600_setup_address(NODE_ADDRESS, RW_ADDR);
210                 de600_read_byte(READ_DATA, dev);
211                 if (was_down || (de600_read_byte(READ_DATA, dev) != 0xde)) {
212                         if (adapter_init(dev)) {
213                                 spin_unlock_irqrestore(&de600_lock, flags);
214                                 return 1;
215                         }
216                 }
217         }
218
219         de600_setup_address(transmit_from, RW_ADDR);
220         for (i = 0;  i < skb->len ; ++i, ++buffer)
221                 de600_put_byte(*buffer);
222         for (; i < len; ++i)
223                 de600_put_byte(0);
224
225         if (free_tx_pages-- == TX_PAGES) { /* No transmission going on */
226                 dev->trans_start = jiffies;
227                 netif_start_queue(dev); /* allow more packets into adapter */
228                 /* Send page and generate a faked interrupt */
229                 de600_setup_address(transmit_from, TX_ADDR);
230                 de600_put_command(TX_ENABLE);
231         }
232         else {
233                 if (free_tx_pages)
234                         netif_start_queue(dev);
235                 else
236                         netif_stop_queue(dev);
237                 select_prn();
238         }
239         spin_unlock_irqrestore(&de600_lock, flags);
240         dev_kfree_skb(skb);
241         return 0;
242 }
243
244 /*
245  * The typical workload of the driver:
246  * Handle the network interface interrupts.
247  */
248
249 static irqreturn_t de600_interrupt(int irq, void *dev_id)
250 {
251         struct net_device       *dev = dev_id;
252         u8              irq_status;
253         int             retrig = 0;
254         int             boguscount = 0;
255
256         spin_lock(&de600_lock);
257
258         select_nic();
259         irq_status = de600_read_status(dev);
260
261         do {
262                 PRINTK(("de600_interrupt (%02X)\n", irq_status));
263
264                 if (irq_status & RX_GOOD)
265                         de600_rx_intr(dev);
266                 else if (!(irq_status & RX_BUSY))
267                         de600_put_command(RX_ENABLE);
268
269                 /* Any transmission in progress? */
270                 if (free_tx_pages < TX_PAGES)
271                         retrig = de600_tx_intr(dev, irq_status);
272                 else
273                         retrig = 0;
274
275                 irq_status = de600_read_status(dev);
276         } while ( (irq_status & RX_GOOD) || ((++boguscount < 100) && retrig) );
277         /*
278          * Yeah, it _looks_ like busy waiting, smells like busy waiting
279          * and I know it's not PC, but please, it will only occur once
280          * in a while and then only for a loop or so (< 1ms for sure!)
281          */
282
283         /* Enable adapter interrupts */
284         select_prn();
285         if (retrig)
286                 trigger_interrupt(dev);
287         spin_unlock(&de600_lock);
288         return IRQ_HANDLED;
289 }
290
291 static int de600_tx_intr(struct net_device *dev, int irq_status)
292 {
293         /*
294          * Returns 1 if tx still not done
295          */
296
297         /* Check if current transmission is done yet */
298         if (irq_status & TX_BUSY)
299                 return 1; /* tx not done, try again */
300
301         /* else */
302         /* If last transmission OK then bump fifo index */
303         if (!(irq_status & TX_FAILED16)) {
304                 tx_fifo_out = (tx_fifo_out + 1) % TX_PAGES;
305                 ++free_tx_pages;
306                 dev->stats.tx_packets++;
307                 netif_wake_queue(dev);
308         }
309
310         /* More to send, or resend last packet? */
311         if ((free_tx_pages < TX_PAGES) || (irq_status & TX_FAILED16)) {
312                 dev->trans_start = jiffies;
313                 de600_setup_address(tx_fifo[tx_fifo_out], TX_ADDR);
314                 de600_put_command(TX_ENABLE);
315                 return 1;
316         }
317         /* else */
318
319         return 0;
320 }
321
322 /*
323  * We have a good packet, get it out of the adapter.
324  */
325 static void de600_rx_intr(struct net_device *dev)
326 {
327         struct sk_buff  *skb;
328         int             i;
329         int             read_from;
330         int             size;
331         unsigned char   *buffer;
332
333         /* Get size of received packet */
334         size = de600_read_byte(RX_LEN, dev);    /* low byte */
335         size += (de600_read_byte(RX_LEN, dev) << 8);    /* high byte */
336         size -= 4;      /* Ignore trailing 4 CRC-bytes */
337
338         /* Tell adapter where to store next incoming packet, enable receiver */
339         read_from = rx_page_adr();
340         next_rx_page();
341         de600_put_command(RX_ENABLE);
342
343         if ((size < 32)  ||  (size > 1535)) {
344                 printk(KERN_WARNING "%s: Bogus packet size %d.\n", dev->name, size);
345                 if (size > 10000)
346                         adapter_init(dev);
347                 return;
348         }
349
350         skb = dev_alloc_skb(size+2);
351         if (skb == NULL) {
352                 printk("%s: Couldn't allocate a sk_buff of size %d.\n", dev->name, size);
353                 return;
354         }
355         /* else */
356
357         skb_reserve(skb,2);     /* Align */
358
359         /* 'skb->data' points to the start of sk_buff data area. */
360         buffer = skb_put(skb,size);
361
362         /* copy the packet into the buffer */
363         de600_setup_address(read_from, RW_ADDR);
364         for (i = size; i > 0; --i, ++buffer)
365                 *buffer = de600_read_byte(READ_DATA, dev);
366
367         skb->protocol=eth_type_trans(skb,dev);
368
369         netif_rx(skb);
370
371         /* update stats */
372         dev->last_rx = jiffies;
373         dev->stats.rx_packets++; /* count all receives */
374         dev->stats.rx_bytes += size; /* count all received bytes */
375
376         /*
377          * If any worth-while packets have been received, netif_rx()
378          * will work on them when we get to the tasklets.
379          */
380 }
381
382 static struct net_device * __init de600_probe(void)
383 {
384         int     i;
385         struct net_device *dev;
386         int err;
387
388         dev = alloc_etherdev(0);
389         if (!dev)
390                 return ERR_PTR(-ENOMEM);
391
392
393         if (!request_region(DE600_IO, 3, "de600")) {
394                 printk(KERN_WARNING "DE600: port 0x%x busy\n", DE600_IO);
395                 err = -EBUSY;
396                 goto out;
397         }
398
399         printk(KERN_INFO "%s: D-Link DE-600 pocket adapter", dev->name);
400         /* Alpha testers must have the version number to report bugs. */
401         if (de600_debug > 1)
402                 printk(version);
403
404         /* probe for adapter */
405         err = -ENODEV;
406         rx_page = 0;
407         select_nic();
408         (void)de600_read_status(dev);
409         de600_put_command(RESET);
410         de600_put_command(STOP_RESET);
411         if (de600_read_status(dev) & 0xf0) {
412                 printk(": not at I/O %#3x.\n", DATA_PORT);
413                 goto out1;
414         }
415
416         /*
417          * Maybe we found one,
418          * have to check if it is a D-Link DE-600 adapter...
419          */
420
421         /* Get the adapter ethernet address from the ROM */
422         de600_setup_address(NODE_ADDRESS, RW_ADDR);
423         for (i = 0; i < ETH_ALEN; i++) {
424                 dev->dev_addr[i] = de600_read_byte(READ_DATA, dev);
425                 dev->broadcast[i] = 0xff;
426         }
427
428         /* Check magic code */
429         if ((dev->dev_addr[1] == 0xde) && (dev->dev_addr[2] == 0x15)) {
430                 /* OK, install real address */
431                 dev->dev_addr[0] = 0x00;
432                 dev->dev_addr[1] = 0x80;
433                 dev->dev_addr[2] = 0xc8;
434                 dev->dev_addr[3] &= 0x0f;
435                 dev->dev_addr[3] |= 0x70;
436         } else {
437                 printk(" not identified in the printer port\n");
438                 goto out1;
439         }
440
441         printk(", Ethernet Address: %02X", dev->dev_addr[0]);
442         for (i = 1; i < ETH_ALEN; i++)
443                 printk(":%02X",dev->dev_addr[i]);
444         printk("\n");
445
446         dev->open = de600_open;
447         dev->stop = de600_close;
448         dev->hard_start_xmit = &de600_start_xmit;
449
450         dev->flags&=~IFF_MULTICAST;
451
452         select_prn();
453
454         err = register_netdev(dev);
455         if (err)
456                 goto out1;
457
458         return dev;
459
460 out1:
461         release_region(DE600_IO, 3);
462 out:
463         free_netdev(dev);
464         return ERR_PTR(err);
465 }
466
467 static int adapter_init(struct net_device *dev)
468 {
469         int     i;
470
471         select_nic();
472         rx_page = 0; /* used by RESET */
473         de600_put_command(RESET);
474         de600_put_command(STOP_RESET);
475
476         /* Check if it is still there... */
477         /* Get the some bytes of the adapter ethernet address from the ROM */
478         de600_setup_address(NODE_ADDRESS, RW_ADDR);
479         de600_read_byte(READ_DATA, dev);
480         if ((de600_read_byte(READ_DATA, dev) != 0xde) ||
481             (de600_read_byte(READ_DATA, dev) != 0x15)) {
482         /* was: if (de600_read_status(dev) & 0xf0) { */
483                 printk("Something has happened to the DE-600!  Please check it and do a new ifconfig!\n");
484                 /* Goodbye, cruel world... */
485                 dev->flags &= ~IFF_UP;
486                 de600_close(dev);
487                 was_down = 1;
488                 netif_stop_queue(dev); /* Transmit busy...  */
489                 return 1; /* failed */
490         }
491
492         if (was_down) {
493                 printk(KERN_INFO "%s: Thanks, I feel much better now!\n", dev->name);
494                 was_down = 0;
495         }
496
497         tx_fifo_in = 0;
498         tx_fifo_out = 0;
499         free_tx_pages = TX_PAGES;
500
501
502         /* set the ether address. */
503         de600_setup_address(NODE_ADDRESS, RW_ADDR);
504         for (i = 0; i < ETH_ALEN; i++)
505                 de600_put_byte(dev->dev_addr[i]);
506
507         /* where to start saving incoming packets */
508         rx_page = RX_BP | RX_BASE_PAGE;
509         de600_setup_address(MEM_4K, RW_ADDR);
510         /* Enable receiver */
511         de600_put_command(RX_ENABLE);
512         select_prn();
513
514         netif_start_queue(dev);
515
516         return 0; /* OK */
517 }
518
519 static struct net_device *de600_dev;
520
521 static int __init de600_init(void)
522 {
523         de600_dev = de600_probe();
524         if (IS_ERR(de600_dev))
525                 return PTR_ERR(de600_dev);
526         return 0;
527 }
528
529 static void __exit de600_exit(void)
530 {
531         unregister_netdev(de600_dev);
532         release_region(DE600_IO, 3);
533         free_netdev(de600_dev);
534 }
535
536 module_init(de600_init);
537 module_exit(de600_exit);
538
539 MODULE_LICENSE("GPL");