]> Git Repo - J-linux.git/blob - drivers/net/arcnet/arcnet.c
Merge tag 'vfs-6.13-rc7.fixes' of git://git.kernel.org/pub/scm/linux/kernel/git/vfs/vfs
[J-linux.git] / drivers / net / arcnet / arcnet.c
1 /*
2  * Linux ARCnet driver - device-independent routines
3  *
4  * Written 1997 by David Woodhouse.
5  * Written 1994-1999 by Avery Pennarun.
6  * Written 1999-2000 by Martin Mares <[email protected]>.
7  * Derived from skeleton.c by Donald Becker.
8  *
9  * Special thanks to Contemporary Controls, Inc. (www.ccontrols.com)
10  *  for sponsoring the further development of this driver.
11  *
12  * **********************
13  *
14  * The original copyright was as follows:
15  *
16  * skeleton.c Written 1993 by Donald Becker.
17  * Copyright 1993 United States Government as represented by the
18  * Director, National Security Agency.  This software may only be used
19  * and distributed according to the terms of the GNU General Public License as
20  * modified by SRC, incorporated herein by reference.
21  *
22  * **********************
23  *
24  * The change log is now in a file called ChangeLog in this directory.
25  *
26  * Sources:
27  *  - Crynwr arcnet.com/arcether.com packet drivers.
28  *  - arcnet.c v0.00 dated 1/1/94 and apparently by
29  *     Donald Becker - it didn't work :)
30  *  - skeleton.c v0.05 dated 11/16/93 by Donald Becker
31  *     (from Linux Kernel 1.1.45)
32  *  - RFC's 1201 and 1051 - re: TCP/IP over ARCnet
33  *  - The official ARCnet COM9026 data sheets (!) thanks to
34  *     Ken Cornetet <[email protected]>
35  *  - The official ARCnet COM20020 data sheets.
36  *  - Information on some more obscure ARCnet controller chips, thanks
37  *     to the nice people at SMSC.
38  *  - net/inet/eth.c (from kernel 1.1.50) for header-building info.
39  *  - Alternate Linux ARCnet source by V.Shergin <[email protected]>
40  *  - Textual information and more alternate source from Joachim Koenig
41  *     <[email protected]>
42  */
43
44 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
45
46 #include <linux/module.h>
47 #include <linux/types.h>
48 #include <linux/delay.h>
49 #include <linux/netdevice.h>
50 #include <linux/if_arp.h>
51 #include <net/arp.h>
52 #include <linux/init.h>
53 #include <linux/jiffies.h>
54 #include <linux/errqueue.h>
55
56 #include <linux/leds.h>
57 #include <linux/workqueue.h>
58
59 #include "arcdevice.h"
60 #include "com9026.h"
61
62 /* "do nothing" functions for protocol drivers */
63 static void null_rx(struct net_device *dev, int bufnum,
64                     struct archdr *pkthdr, int length);
65 static int null_build_header(struct sk_buff *skb, struct net_device *dev,
66                              unsigned short type, uint8_t daddr);
67 static int null_prepare_tx(struct net_device *dev, struct archdr *pkt,
68                            int length, int bufnum);
69
70 static void arcnet_rx(struct net_device *dev, int bufnum);
71
72 /* one ArcProto per possible proto ID.  None of the elements of
73  * arc_proto_map are allowed to be NULL; they will get set to
74  * arc_proto_default instead.  It also must not be NULL; if you would like
75  * to set it to NULL, set it to &arc_proto_null instead.
76  */
77 struct ArcProto *arc_proto_map[256];
78 EXPORT_SYMBOL(arc_proto_map);
79
80 struct ArcProto *arc_proto_default;
81 EXPORT_SYMBOL(arc_proto_default);
82
83 struct ArcProto *arc_bcast_proto;
84 EXPORT_SYMBOL(arc_bcast_proto);
85
86 struct ArcProto *arc_raw_proto;
87 EXPORT_SYMBOL(arc_raw_proto);
88
89 static struct ArcProto arc_proto_null = {
90         .suffix         = '?',
91         .mtu            = XMTU,
92         .is_ip          = 0,
93         .rx             = null_rx,
94         .build_header   = null_build_header,
95         .prepare_tx     = null_prepare_tx,
96         .continue_tx    = NULL,
97         .ack_tx         = NULL
98 };
99
100 /* Exported function prototypes */
101 int arcnet_debug = ARCNET_DEBUG;
102 EXPORT_SYMBOL(arcnet_debug);
103
104 /* Internal function prototypes */
105 static int arcnet_header(struct sk_buff *skb, struct net_device *dev,
106                          unsigned short type, const void *daddr,
107                          const void *saddr, unsigned len);
108 static int go_tx(struct net_device *dev);
109
110 static int debug = ARCNET_DEBUG;
111 module_param(debug, int, 0);
112 MODULE_DESCRIPTION("ARCnet core driver");
113 MODULE_LICENSE("GPL");
114
115 static int __init arcnet_init(void)
116 {
117         int count;
118
119         arcnet_debug = debug;
120
121         pr_info("arcnet loaded\n");
122
123         /* initialize the protocol map */
124         arc_raw_proto = arc_proto_default = arc_bcast_proto = &arc_proto_null;
125         for (count = 0; count < 256; count++)
126                 arc_proto_map[count] = arc_proto_default;
127
128         if (BUGLVL(D_DURING))
129                 pr_info("struct sizes: %zd %zd %zd %zd %zd\n",
130                         sizeof(struct arc_hardware),
131                         sizeof(struct arc_rfc1201),
132                         sizeof(struct arc_rfc1051),
133                         sizeof(struct arc_eth_encap),
134                         sizeof(struct archdr));
135
136         return 0;
137 }
138
139 static void __exit arcnet_exit(void)
140 {
141 }
142
143 module_init(arcnet_init);
144 module_exit(arcnet_exit);
145
146 /* Dump the contents of an sk_buff */
147 #if ARCNET_DEBUG_MAX & D_SKB
148 void arcnet_dump_skb(struct net_device *dev,
149                      struct sk_buff *skb, char *desc)
150 {
151         char hdr[32];
152
153         /* dump the packet */
154         snprintf(hdr, sizeof(hdr), "%6s:%s skb->data:", dev->name, desc);
155         print_hex_dump(KERN_DEBUG, hdr, DUMP_PREFIX_OFFSET,
156                        16, 1, skb->data, skb->len, true);
157 }
158 EXPORT_SYMBOL(arcnet_dump_skb);
159 #endif
160
161 /* Dump the contents of an ARCnet buffer */
162 #if (ARCNET_DEBUG_MAX & (D_RX | D_TX))
163 static void arcnet_dump_packet(struct net_device *dev, int bufnum,
164                                char *desc, int take_arcnet_lock)
165 {
166         struct arcnet_local *lp = netdev_priv(dev);
167         int i, length;
168         unsigned long flags = 0;
169         static uint8_t buf[512];
170         char hdr[32];
171
172         /* hw.copy_from_card expects IRQ context so take the IRQ lock
173          * to keep it single threaded
174          */
175         if (take_arcnet_lock)
176                 spin_lock_irqsave(&lp->lock, flags);
177
178         lp->hw.copy_from_card(dev, bufnum, 0, buf, 512);
179         if (take_arcnet_lock)
180                 spin_unlock_irqrestore(&lp->lock, flags);
181
182         /* if the offset[0] byte is nonzero, this is a 256-byte packet */
183         length = (buf[2] ? 256 : 512);
184
185         /* dump the packet */
186         snprintf(hdr, sizeof(hdr), "%6s:%s packet dump:", dev->name, desc);
187         print_hex_dump(KERN_DEBUG, hdr, DUMP_PREFIX_OFFSET,
188                        16, 1, buf, length, true);
189 }
190
191 #else
192
193 #define arcnet_dump_packet(dev, bufnum, desc, take_arcnet_lock) do { } while (0)
194
195 #endif
196
197 /* Trigger a LED event in response to a ARCNET device event */
198 void arcnet_led_event(struct net_device *dev, enum arcnet_led_event event)
199 {
200         struct arcnet_local *lp = netdev_priv(dev);
201
202         switch (event) {
203         case ARCNET_LED_EVENT_RECON:
204                 led_trigger_blink_oneshot(lp->recon_led_trig, 350, 350, 0);
205                 break;
206         case ARCNET_LED_EVENT_OPEN:
207                 led_trigger_event(lp->tx_led_trig, LED_OFF);
208                 led_trigger_event(lp->recon_led_trig, LED_OFF);
209                 break;
210         case ARCNET_LED_EVENT_STOP:
211                 led_trigger_event(lp->tx_led_trig, LED_OFF);
212                 led_trigger_event(lp->recon_led_trig, LED_OFF);
213                 break;
214         case ARCNET_LED_EVENT_TX:
215                 led_trigger_blink_oneshot(lp->tx_led_trig, 50, 50, 0);
216                 break;
217         }
218 }
219 EXPORT_SYMBOL_GPL(arcnet_led_event);
220
221 static void arcnet_led_release(struct device *gendev, void *res)
222 {
223         struct arcnet_local *lp = netdev_priv(to_net_dev(gendev));
224
225         led_trigger_unregister_simple(lp->tx_led_trig);
226         led_trigger_unregister_simple(lp->recon_led_trig);
227 }
228
229 /* Register ARCNET LED triggers for a arcnet device
230  *
231  * This is normally called from a driver's probe function
232  */
233 void devm_arcnet_led_init(struct net_device *netdev, int index, int subid)
234 {
235         struct arcnet_local *lp = netdev_priv(netdev);
236         void *res;
237
238         res = devres_alloc(arcnet_led_release, 0, GFP_KERNEL);
239         if (!res) {
240                 netdev_err(netdev, "cannot register LED triggers\n");
241                 return;
242         }
243
244         snprintf(lp->tx_led_trig_name, sizeof(lp->tx_led_trig_name),
245                  "arc%d-%d-tx", index, subid);
246         snprintf(lp->recon_led_trig_name, sizeof(lp->recon_led_trig_name),
247                  "arc%d-%d-recon", index, subid);
248
249         led_trigger_register_simple(lp->tx_led_trig_name,
250                                     &lp->tx_led_trig);
251         led_trigger_register_simple(lp->recon_led_trig_name,
252                                     &lp->recon_led_trig);
253
254         devres_add(&netdev->dev, res);
255 }
256 EXPORT_SYMBOL_GPL(devm_arcnet_led_init);
257
258 /* Unregister a protocol driver from the arc_proto_map.  Protocol drivers
259  * are responsible for registering themselves, but the unregister routine
260  * is pretty generic so we'll do it here.
261  */
262 void arcnet_unregister_proto(struct ArcProto *proto)
263 {
264         int count;
265
266         if (arc_proto_default == proto)
267                 arc_proto_default = &arc_proto_null;
268         if (arc_bcast_proto == proto)
269                 arc_bcast_proto = arc_proto_default;
270         if (arc_raw_proto == proto)
271                 arc_raw_proto = arc_proto_default;
272
273         for (count = 0; count < 256; count++) {
274                 if (arc_proto_map[count] == proto)
275                         arc_proto_map[count] = arc_proto_default;
276         }
277 }
278 EXPORT_SYMBOL(arcnet_unregister_proto);
279
280 /* Add a buffer to the queue.  Only the interrupt handler is allowed to do
281  * this, unless interrupts are disabled.
282  *
283  * Note: we don't check for a full queue, since there aren't enough buffers
284  * to more than fill it.
285  */
286 static void release_arcbuf(struct net_device *dev, int bufnum)
287 {
288         struct arcnet_local *lp = netdev_priv(dev);
289         int i;
290
291         lp->buf_queue[lp->first_free_buf++] = bufnum;
292         lp->first_free_buf %= 5;
293
294         if (BUGLVL(D_DURING)) {
295                 arc_printk(D_DURING, dev, "release_arcbuf: freed #%d; buffer queue is now: ",
296                            bufnum);
297                 for (i = lp->next_buf; i != lp->first_free_buf; i = (i + 1) % 5)
298                         arc_cont(D_DURING, "#%d ", lp->buf_queue[i]);
299                 arc_cont(D_DURING, "\n");
300         }
301 }
302
303 /* Get a buffer from the queue.
304  * If this returns -1, there are no buffers available.
305  */
306 static int get_arcbuf(struct net_device *dev)
307 {
308         struct arcnet_local *lp = netdev_priv(dev);
309         int buf = -1, i;
310
311         if (!atomic_dec_and_test(&lp->buf_lock)) {
312                 /* already in this function */
313                 arc_printk(D_NORMAL, dev, "get_arcbuf: overlap (%d)!\n",
314                            lp->buf_lock.counter);
315         } else {                        /* we can continue */
316                 if (lp->next_buf >= 5)
317                         lp->next_buf -= 5;
318
319                 if (lp->next_buf == lp->first_free_buf) {
320                         arc_printk(D_NORMAL, dev, "get_arcbuf: BUG: no buffers are available??\n");
321                 } else {
322                         buf = lp->buf_queue[lp->next_buf++];
323                         lp->next_buf %= 5;
324                 }
325         }
326
327         if (BUGLVL(D_DURING)) {
328                 arc_printk(D_DURING, dev, "get_arcbuf: got #%d; buffer queue is now: ",
329                            buf);
330                 for (i = lp->next_buf; i != lp->first_free_buf; i = (i + 1) % 5)
331                         arc_cont(D_DURING, "#%d ", lp->buf_queue[i]);
332                 arc_cont(D_DURING, "\n");
333         }
334
335         atomic_inc(&lp->buf_lock);
336         return buf;
337 }
338
339 static int choose_mtu(void)
340 {
341         int count, mtu = 65535;
342
343         /* choose the smallest MTU of all available encaps */
344         for (count = 0; count < 256; count++) {
345                 if (arc_proto_map[count] != &arc_proto_null &&
346                     arc_proto_map[count]->mtu < mtu) {
347                         mtu = arc_proto_map[count]->mtu;
348                 }
349         }
350
351         return mtu == 65535 ? XMTU : mtu;
352 }
353
354 static const struct header_ops arcnet_header_ops = {
355         .create = arcnet_header,
356 };
357
358 static const struct net_device_ops arcnet_netdev_ops = {
359         .ndo_open       = arcnet_open,
360         .ndo_stop       = arcnet_close,
361         .ndo_start_xmit = arcnet_send_packet,
362         .ndo_tx_timeout = arcnet_timeout,
363 };
364
365 /* Setup a struct device for ARCnet. */
366 static void arcdev_setup(struct net_device *dev)
367 {
368         dev->type = ARPHRD_ARCNET;
369         dev->netdev_ops = &arcnet_netdev_ops;
370         dev->header_ops = &arcnet_header_ops;
371         dev->hard_header_len = sizeof(struct arc_hardware);
372         dev->mtu = choose_mtu();
373
374         dev->addr_len = ARCNET_ALEN;
375         dev->tx_queue_len = 100;
376         dev->broadcast[0] = 0x00;       /* for us, broadcasts are address 0 */
377         dev->watchdog_timeo = TX_TIMEOUT;
378
379         /* New-style flags. */
380         dev->flags = IFF_BROADCAST;
381 }
382
383 static void arcnet_timer(struct timer_list *t)
384 {
385         struct arcnet_local *lp = from_timer(lp, t, timer);
386         struct net_device *dev = lp->dev;
387
388         spin_lock_irq(&lp->lock);
389
390         if (!lp->reset_in_progress && !netif_carrier_ok(dev)) {
391                 netif_carrier_on(dev);
392                 netdev_info(dev, "link up\n");
393         }
394
395         spin_unlock_irq(&lp->lock);
396 }
397
398 static void reset_device_work(struct work_struct *work)
399 {
400         struct arcnet_local *lp;
401         struct net_device *dev;
402
403         lp = container_of(work, struct arcnet_local, reset_work);
404         dev = lp->dev;
405
406         /* Do not bring the network interface back up if an ifdown
407          * was already done.
408          */
409         if (!netif_running(dev) || !lp->reset_in_progress)
410                 return;
411
412         rtnl_lock();
413
414         /* Do another check, in case of an ifdown that was triggered in
415          * the small race window between the exit condition above and
416          * acquiring RTNL.
417          */
418         if (!netif_running(dev) || !lp->reset_in_progress)
419                 goto out;
420
421         dev_close(dev);
422         dev_open(dev, NULL);
423
424 out:
425         rtnl_unlock();
426 }
427
428 static void arcnet_reply_work(struct work_struct *t)
429 {
430         struct arcnet_local *lp = from_work(lp, t, reply_work);
431
432         struct sk_buff *ackskb, *skb;
433         struct sock_exterr_skb *serr;
434         struct sock *sk;
435         int ret;
436
437         local_irq_disable();
438         skb = lp->outgoing.skb;
439         if (!skb || !skb->sk) {
440                 local_irq_enable();
441                 return;
442         }
443
444         sock_hold(skb->sk);
445         sk = skb->sk;
446         ackskb = skb_clone_sk(skb);
447         sock_put(skb->sk);
448
449         if (!ackskb) {
450                 local_irq_enable();
451                 return;
452         }
453
454         serr = SKB_EXT_ERR(ackskb);
455         memset(serr, 0, sizeof(*serr));
456         serr->ee.ee_errno = ENOMSG;
457         serr->ee.ee_origin = SO_EE_ORIGIN_TXSTATUS;
458         serr->ee.ee_data = skb_shinfo(skb)->tskey;
459         serr->ee.ee_info = lp->reply_status;
460
461         /* finally erasing outgoing skb */
462         dev_kfree_skb(lp->outgoing.skb);
463         lp->outgoing.skb = NULL;
464
465         ackskb->dev = lp->dev;
466
467         ret = sock_queue_err_skb(sk, ackskb);
468         if (ret)
469                 dev_kfree_skb_irq(ackskb);
470
471         local_irq_enable();
472 };
473
474 struct net_device *alloc_arcdev(const char *name)
475 {
476         struct net_device *dev;
477
478         dev = alloc_netdev(sizeof(struct arcnet_local),
479                            name && *name ? name : "arc%d", NET_NAME_UNKNOWN,
480                            arcdev_setup);
481         if (dev) {
482                 struct arcnet_local *lp = netdev_priv(dev);
483
484                 lp->dev = dev;
485                 spin_lock_init(&lp->lock);
486                 timer_setup(&lp->timer, arcnet_timer, 0);
487                 INIT_WORK(&lp->reset_work, reset_device_work);
488         }
489
490         return dev;
491 }
492 EXPORT_SYMBOL(alloc_arcdev);
493
494 void free_arcdev(struct net_device *dev)
495 {
496         struct arcnet_local *lp = netdev_priv(dev);
497
498         /* Do not cancel this at ->ndo_close(), as the workqueue itself
499          * indirectly calls the ifdown path through dev_close().
500          */
501         cancel_work_sync(&lp->reset_work);
502         free_netdev(dev);
503 }
504 EXPORT_SYMBOL(free_arcdev);
505
506 /* Open/initialize the board.  This is called sometime after booting when
507  * the 'ifconfig' program is run.
508  *
509  * This routine should set everything up anew at each open, even registers
510  * that "should" only need to be set once at boot, so that there is
511  * non-reboot way to recover if something goes wrong.
512  */
513 int arcnet_open(struct net_device *dev)
514 {
515         struct arcnet_local *lp = netdev_priv(dev);
516         int count, newmtu, error;
517
518         arc_printk(D_INIT, dev, "opened.");
519
520         if (!try_module_get(lp->hw.owner))
521                 return -ENODEV;
522
523         if (BUGLVL(D_PROTO)) {
524                 arc_printk(D_PROTO, dev, "protocol map (default is '%c'): ",
525                            arc_proto_default->suffix);
526                 for (count = 0; count < 256; count++)
527                         arc_cont(D_PROTO, "%c", arc_proto_map[count]->suffix);
528                 arc_cont(D_PROTO, "\n");
529         }
530
531         INIT_WORK(&lp->reply_work, arcnet_reply_work);
532
533         arc_printk(D_INIT, dev, "arcnet_open: resetting card.\n");
534
535         /* try to put the card in a defined state - if it fails the first
536          * time, actually reset it.
537          */
538         error = -ENODEV;
539         if (lp->hw.reset(dev, 0) && lp->hw.reset(dev, 1))
540                 goto out_module_put;
541
542         newmtu = choose_mtu();
543         if (newmtu < dev->mtu)
544                 dev->mtu = newmtu;
545
546         arc_printk(D_INIT, dev, "arcnet_open: mtu: %d.\n", dev->mtu);
547
548         /* autodetect the encapsulation for each host. */
549         memset(lp->default_proto, 0, sizeof(lp->default_proto));
550
551         /* the broadcast address is special - use the 'bcast' protocol */
552         for (count = 0; count < 256; count++) {
553                 if (arc_proto_map[count] == arc_bcast_proto) {
554                         lp->default_proto[0] = count;
555                         break;
556                 }
557         }
558
559         /* initialize buffers */
560         atomic_set(&lp->buf_lock, 1);
561
562         lp->next_buf = lp->first_free_buf = 0;
563         release_arcbuf(dev, 0);
564         release_arcbuf(dev, 1);
565         release_arcbuf(dev, 2);
566         release_arcbuf(dev, 3);
567         lp->cur_tx = lp->next_tx = -1;
568         lp->cur_rx = -1;
569
570         lp->rfc1201.sequence = 1;
571
572         /* bring up the hardware driver */
573         if (lp->hw.open)
574                 lp->hw.open(dev);
575
576         if (dev->dev_addr[0] == 0)
577                 arc_printk(D_NORMAL, dev, "WARNING!  Station address 00 is reserved for broadcasts!\n");
578         else if (dev->dev_addr[0] == 255)
579                 arc_printk(D_NORMAL, dev, "WARNING!  Station address FF may confuse DOS networking programs!\n");
580
581         arc_printk(D_DEBUG, dev, "%s: %d: %s\n", __FILE__, __LINE__, __func__);
582         if (lp->hw.status(dev) & RESETflag) {
583                 arc_printk(D_DEBUG, dev, "%s: %d: %s\n",
584                            __FILE__, __LINE__, __func__);
585                 lp->hw.command(dev, CFLAGScmd | RESETclear);
586         }
587
588         arc_printk(D_DEBUG, dev, "%s: %d: %s\n", __FILE__, __LINE__, __func__);
589         /* make sure we're ready to receive IRQ's. */
590         lp->hw.intmask(dev, 0);
591         udelay(1);              /* give it time to set the mask before
592                                  * we reset it again. (may not even be
593                                  * necessary)
594                                  */
595         arc_printk(D_DEBUG, dev, "%s: %d: %s\n", __FILE__, __LINE__, __func__);
596         lp->intmask = NORXflag | RECONflag;
597         lp->hw.intmask(dev, lp->intmask);
598         arc_printk(D_DEBUG, dev, "%s: %d: %s\n", __FILE__, __LINE__, __func__);
599
600         netif_carrier_off(dev);
601         netif_start_queue(dev);
602         mod_timer(&lp->timer, jiffies + msecs_to_jiffies(1000));
603
604         arcnet_led_event(dev, ARCNET_LED_EVENT_OPEN);
605         return 0;
606
607  out_module_put:
608         module_put(lp->hw.owner);
609         return error;
610 }
611 EXPORT_SYMBOL(arcnet_open);
612
613 /* The inverse routine to arcnet_open - shuts down the card. */
614 int arcnet_close(struct net_device *dev)
615 {
616         struct arcnet_local *lp = netdev_priv(dev);
617
618         arcnet_led_event(dev, ARCNET_LED_EVENT_STOP);
619         del_timer_sync(&lp->timer);
620
621         netif_stop_queue(dev);
622         netif_carrier_off(dev);
623
624         cancel_work_sync(&lp->reply_work);
625
626         /* flush TX and disable RX */
627         lp->hw.intmask(dev, 0);
628         lp->hw.command(dev, NOTXcmd);   /* stop transmit */
629         lp->hw.command(dev, NORXcmd);   /* disable receive */
630         mdelay(1);
631
632         /* shut down the card */
633         lp->hw.close(dev);
634
635         /* reset counters */
636         lp->reset_in_progress = 0;
637
638         module_put(lp->hw.owner);
639         return 0;
640 }
641 EXPORT_SYMBOL(arcnet_close);
642
643 static int arcnet_header(struct sk_buff *skb, struct net_device *dev,
644                          unsigned short type, const void *daddr,
645                          const void *saddr, unsigned len)
646 {
647         const struct arcnet_local *lp = netdev_priv(dev);
648         uint8_t _daddr, proto_num;
649         struct ArcProto *proto;
650
651         arc_printk(D_DURING, dev,
652                    "create header from %d to %d; protocol %d (%Xh); size %u.\n",
653                    saddr ? *(uint8_t *)saddr : -1,
654                    daddr ? *(uint8_t *)daddr : -1,
655                    type, type, len);
656
657         if (skb->len != 0 && len != skb->len)
658                 arc_printk(D_NORMAL, dev, "arcnet_header: Yikes!  skb->len(%d) != len(%d)!\n",
659                            skb->len, len);
660
661         /* Type is host order - ? */
662         if (type == ETH_P_ARCNET) {
663                 proto = arc_raw_proto;
664                 arc_printk(D_DEBUG, dev, "arc_raw_proto used. proto='%c'\n",
665                            proto->suffix);
666                 _daddr = daddr ? *(uint8_t *)daddr : 0;
667         } else if (!daddr) {
668                 /* if the dest addr isn't provided, we can't choose an
669                  * encapsulation!  Store the packet type (eg. ETH_P_IP)
670                  * for now, and we'll push on a real header when we do
671                  * rebuild_header.
672                  */
673                 *(uint16_t *)skb_push(skb, 2) = type;
674                 /* XXX: Why not use skb->mac_len? */
675                 if (skb->network_header - skb->mac_header != 2)
676                         arc_printk(D_NORMAL, dev, "arcnet_header: Yikes!  diff (%u) is not 2!\n",
677                                    skb->network_header - skb->mac_header);
678                 return -2;      /* return error -- can't transmit yet! */
679         } else {
680                 /* otherwise, we can just add the header as usual. */
681                 _daddr = *(uint8_t *)daddr;
682                 proto_num = lp->default_proto[_daddr];
683                 proto = arc_proto_map[proto_num];
684                 arc_printk(D_DURING, dev, "building header for %02Xh using protocol '%c'\n",
685                            proto_num, proto->suffix);
686                 if (proto == &arc_proto_null && arc_bcast_proto != proto) {
687                         arc_printk(D_DURING, dev, "actually, let's use '%c' instead.\n",
688                                    arc_bcast_proto->suffix);
689                         proto = arc_bcast_proto;
690                 }
691         }
692         return proto->build_header(skb, dev, type, _daddr);
693 }
694
695 /* Called by the kernel in order to transmit a packet. */
696 netdev_tx_t arcnet_send_packet(struct sk_buff *skb,
697                                struct net_device *dev)
698 {
699         struct arcnet_local *lp = netdev_priv(dev);
700         struct archdr *pkt;
701         struct arc_rfc1201 *soft;
702         struct ArcProto *proto;
703         int txbuf;
704         unsigned long flags;
705         int retval;
706
707         arc_printk(D_DURING, dev,
708                    "transmit requested (status=%Xh, txbufs=%d/%d, len=%d, protocol %x)\n",
709                    lp->hw.status(dev), lp->cur_tx, lp->next_tx, skb->len, skb->protocol);
710
711         pkt = (struct archdr *)skb->data;
712         soft = &pkt->soft.rfc1201;
713         proto = arc_proto_map[soft->proto];
714
715         arc_printk(D_SKB_SIZE, dev, "skb: transmitting %d bytes to %02X\n",
716                    skb->len, pkt->hard.dest);
717         if (BUGLVL(D_SKB))
718                 arcnet_dump_skb(dev, skb, "tx");
719
720         /* fits in one packet? */
721         if (skb->len - ARC_HDR_SIZE > XMTU && !proto->continue_tx) {
722                 arc_printk(D_NORMAL, dev, "fixme: packet too large: compensating badly!\n");
723                 dev_kfree_skb(skb);
724                 return NETDEV_TX_OK;    /* don't try again */
725         }
726
727         /* We're busy transmitting a packet... */
728         netif_stop_queue(dev);
729
730         spin_lock_irqsave(&lp->lock, flags);
731         lp->hw.intmask(dev, 0);
732         if (lp->next_tx == -1)
733                 txbuf = get_arcbuf(dev);
734         else
735                 txbuf = -1;
736
737         if (txbuf != -1) {
738                 lp->outgoing.skb = skb;
739                 if (proto->prepare_tx(dev, pkt, skb->len, txbuf) &&
740                     !proto->ack_tx) {
741                         /* done right away and we don't want to acknowledge
742                          *  the package later - forget about it now
743                          */
744                         dev->stats.tx_bytes += skb->len;
745                 } else {
746                         /* do it the 'split' way */
747                         lp->outgoing.proto = proto;
748                         lp->outgoing.skb = skb;
749                         lp->outgoing.pkt = pkt;
750
751                         if (proto->continue_tx &&
752                             proto->continue_tx(dev, txbuf)) {
753                                 arc_printk(D_NORMAL, dev,
754                                            "bug! continue_tx finished the first time! (proto='%c')\n",
755                                            proto->suffix);
756                         }
757                 }
758                 retval = NETDEV_TX_OK;
759                 lp->next_tx = txbuf;
760         } else {
761                 retval = NETDEV_TX_BUSY;
762         }
763
764         arc_printk(D_DEBUG, dev, "%s: %d: %s, status: %x\n",
765                    __FILE__, __LINE__, __func__, lp->hw.status(dev));
766         /* make sure we didn't ignore a TX IRQ while we were in here */
767         lp->hw.intmask(dev, 0);
768
769         arc_printk(D_DEBUG, dev, "%s: %d: %s\n", __FILE__, __LINE__, __func__);
770         lp->intmask |= TXFREEflag | EXCNAKflag;
771         lp->hw.intmask(dev, lp->intmask);
772         arc_printk(D_DEBUG, dev, "%s: %d: %s, status: %x\n",
773                    __FILE__, __LINE__, __func__, lp->hw.status(dev));
774
775         arcnet_led_event(dev, ARCNET_LED_EVENT_TX);
776
777         spin_unlock_irqrestore(&lp->lock, flags);
778         return retval;          /* no need to try again */
779 }
780 EXPORT_SYMBOL(arcnet_send_packet);
781
782 /* Actually start transmitting a packet that was loaded into a buffer
783  * by prepare_tx.  This should _only_ be called by the interrupt handler.
784  */
785 static int go_tx(struct net_device *dev)
786 {
787         struct arcnet_local *lp = netdev_priv(dev);
788
789         arc_printk(D_DURING, dev, "go_tx: status=%Xh, intmask=%Xh, next_tx=%d, cur_tx=%d\n",
790                    lp->hw.status(dev), lp->intmask, lp->next_tx, lp->cur_tx);
791
792         if (lp->cur_tx != -1 || lp->next_tx == -1)
793                 return 0;
794
795         if (BUGLVL(D_TX))
796                 arcnet_dump_packet(dev, lp->next_tx, "go_tx", 0);
797
798         lp->cur_tx = lp->next_tx;
799         lp->next_tx = -1;
800
801         /* start sending */
802         lp->hw.command(dev, TXcmd | (lp->cur_tx << 3));
803
804         dev->stats.tx_packets++;
805         lp->lasttrans_dest = lp->lastload_dest;
806         lp->lastload_dest = 0;
807         lp->excnak_pending = 0;
808         lp->intmask |= TXFREEflag | EXCNAKflag;
809
810         return 1;
811 }
812
813 /* Called by the kernel when transmit times out */
814 void arcnet_timeout(struct net_device *dev, unsigned int txqueue)
815 {
816         unsigned long flags;
817         struct arcnet_local *lp = netdev_priv(dev);
818         int status = lp->hw.status(dev);
819         char *msg;
820
821         spin_lock_irqsave(&lp->lock, flags);
822         if (status & TXFREEflag) {      /* transmit _DID_ finish */
823                 msg = " - missed IRQ?";
824         } else {
825                 msg = "";
826                 dev->stats.tx_aborted_errors++;
827                 lp->timed_out = 1;
828                 lp->hw.command(dev, NOTXcmd | (lp->cur_tx << 3));
829         }
830         dev->stats.tx_errors++;
831
832         /* make sure we didn't miss a TX or a EXC NAK IRQ */
833         lp->hw.intmask(dev, 0);
834         lp->intmask |= TXFREEflag | EXCNAKflag;
835         lp->hw.intmask(dev, lp->intmask);
836
837         spin_unlock_irqrestore(&lp->lock, flags);
838
839         if (time_after(jiffies, lp->last_timeout + 10 * HZ)) {
840                 arc_printk(D_EXTRA, dev, "tx timed out%s (status=%Xh, intmask=%Xh, dest=%02Xh)\n",
841                            msg, status, lp->intmask, lp->lasttrans_dest);
842                 lp->last_timeout = jiffies;
843         }
844
845         if (lp->cur_tx == -1)
846                 netif_wake_queue(dev);
847 }
848 EXPORT_SYMBOL(arcnet_timeout);
849
850 /* The typical workload of the driver: Handle the network interface
851  * interrupts. Establish which device needs attention, and call the correct
852  * chipset interrupt handler.
853  */
854 irqreturn_t arcnet_interrupt(int irq, void *dev_id)
855 {
856         struct net_device *dev = dev_id;
857         struct arcnet_local *lp;
858         int recbuf, status, diagstatus, didsomething, boguscount;
859         unsigned long flags;
860         int retval = IRQ_NONE;
861
862         arc_printk(D_DURING, dev, "\n");
863
864         arc_printk(D_DURING, dev, "in arcnet_interrupt\n");
865
866         lp = netdev_priv(dev);
867         BUG_ON(!lp);
868
869         spin_lock_irqsave(&lp->lock, flags);
870
871         if (lp->reset_in_progress)
872                 goto out;
873
874         /* RESET flag was enabled - if device is not running, we must
875          * clear it right away (but nothing else).
876          */
877         if (!netif_running(dev)) {
878                 if (lp->hw.status(dev) & RESETflag)
879                         lp->hw.command(dev, CFLAGScmd | RESETclear);
880                 lp->hw.intmask(dev, 0);
881                 spin_unlock_irqrestore(&lp->lock, flags);
882                 return retval;
883         }
884
885         arc_printk(D_DURING, dev, "in arcnet_inthandler (status=%Xh, intmask=%Xh)\n",
886                    lp->hw.status(dev), lp->intmask);
887
888         boguscount = 5;
889         do {
890                 status = lp->hw.status(dev);
891                 diagstatus = (status >> 8) & 0xFF;
892
893                 arc_printk(D_DEBUG, dev, "%s: %d: %s: status=%x\n",
894                            __FILE__, __LINE__, __func__, status);
895                 didsomething = 0;
896
897                 /* RESET flag was enabled - card is resetting and if RX is
898                  * disabled, it's NOT because we just got a packet.
899                  *
900                  * The card is in an undefined state.
901                  * Clear it out and start over.
902                  */
903                 if (status & RESETflag) {
904                         arc_printk(D_NORMAL, dev, "spurious reset (status=%Xh)\n",
905                                    status);
906
907                         lp->reset_in_progress = 1;
908                         netif_stop_queue(dev);
909                         netif_carrier_off(dev);
910                         schedule_work(&lp->reset_work);
911
912                         /* get out of the interrupt handler! */
913                         goto out;
914                 }
915                 /* RX is inhibited - we must have received something.
916                  * Prepare to receive into the next buffer.
917                  *
918                  * We don't actually copy the received packet from the card
919                  * until after the transmit handler runs (and possibly
920                  * launches the next tx); this should improve latency slightly
921                  * if we get both types of interrupts at once.
922                  */
923                 recbuf = -1;
924                 if (status & lp->intmask & NORXflag) {
925                         recbuf = lp->cur_rx;
926                         arc_printk(D_DURING, dev, "Buffer #%d: receive irq (status=%Xh)\n",
927                                    recbuf, status);
928
929                         lp->cur_rx = get_arcbuf(dev);
930                         if (lp->cur_rx != -1) {
931                                 arc_printk(D_DURING, dev, "enabling receive to buffer #%d\n",
932                                            lp->cur_rx);
933                                 lp->hw.command(dev, RXcmd | (lp->cur_rx << 3) | RXbcasts);
934                         }
935                         didsomething++;
936                 }
937
938                 if ((diagstatus & EXCNAKflag)) {
939                         arc_printk(D_DURING, dev, "EXCNAK IRQ (diagstat=%Xh)\n",
940                                    diagstatus);
941
942                         lp->hw.command(dev, NOTXcmd);      /* disable transmit */
943                         lp->excnak_pending = 1;
944
945                         lp->hw.command(dev, EXCNAKclear);
946                         lp->intmask &= ~(EXCNAKflag);
947                         didsomething++;
948                 }
949
950                 /* a transmit finished, and we're interested in it. */
951                 if ((status & lp->intmask & TXFREEflag) || lp->timed_out) {
952                         int ackstatus;
953                         lp->intmask &= ~(TXFREEflag | EXCNAKflag);
954
955                         if (status & TXACKflag)
956                                 ackstatus = 2;
957                         else if (lp->excnak_pending)
958                                 ackstatus = 1;
959                         else
960                                 ackstatus = 0;
961
962                         arc_printk(D_DURING, dev, "TX IRQ (stat=%Xh)\n",
963                                    status);
964
965                         if (lp->cur_tx != -1 && !lp->timed_out) {
966                                 if (!(status & TXACKflag)) {
967                                         if (lp->lasttrans_dest != 0) {
968                                                 arc_printk(D_EXTRA, dev,
969                                                            "transmit was not acknowledged! (status=%Xh, dest=%02Xh)\n",
970                                                            status,
971                                                            lp->lasttrans_dest);
972                                                 dev->stats.tx_errors++;
973                                                 dev->stats.tx_carrier_errors++;
974                                         } else {
975                                                 arc_printk(D_DURING, dev,
976                                                            "broadcast was not acknowledged; that's normal (status=%Xh, dest=%02Xh)\n",
977                                                            status,
978                                                            lp->lasttrans_dest);
979                                         }
980                                 }
981
982                                 if (lp->outgoing.proto &&
983                                     lp->outgoing.proto->ack_tx) {
984                                         lp->outgoing.proto
985                                                 ->ack_tx(dev, ackstatus);
986                                 }
987                                 lp->reply_status = ackstatus;
988                                 queue_work(system_bh_highpri_wq, &lp->reply_work);
989                         }
990                         if (lp->cur_tx != -1)
991                                 release_arcbuf(dev, lp->cur_tx);
992
993                         lp->cur_tx = -1;
994                         lp->timed_out = 0;
995                         didsomething++;
996
997                         /* send another packet if there is one */
998                         go_tx(dev);
999
1000                         /* continue a split packet, if any */
1001                         if (lp->outgoing.proto &&
1002                             lp->outgoing.proto->continue_tx) {
1003                                 int txbuf = get_arcbuf(dev);
1004
1005                                 if (txbuf != -1) {
1006                                         if (lp->outgoing.proto->continue_tx(dev, txbuf)) {
1007                                                 /* that was the last segment */
1008                                                 dev->stats.tx_bytes += lp->outgoing.skb->len;
1009                                                 if (!lp->outgoing.proto->ack_tx) {
1010                                                         dev_kfree_skb_irq(lp->outgoing.skb);
1011                                                         lp->outgoing.proto = NULL;
1012                                                 }
1013                                         }
1014                                         lp->next_tx = txbuf;
1015                                 }
1016                         }
1017                         /* inform upper layers of idleness, if necessary */
1018                         if (lp->cur_tx == -1)
1019                                 netif_wake_queue(dev);
1020                 }
1021                 /* now process the received packet, if any */
1022                 if (recbuf != -1) {
1023                         if (BUGLVL(D_RX))
1024                                 arcnet_dump_packet(dev, recbuf, "rx irq", 0);
1025
1026                         arcnet_rx(dev, recbuf);
1027                         release_arcbuf(dev, recbuf);
1028
1029                         didsomething++;
1030                 }
1031                 if (status & lp->intmask & RECONflag) {
1032                         lp->hw.command(dev, CFLAGScmd | CONFIGclear);
1033                         dev->stats.tx_carrier_errors++;
1034
1035                         arc_printk(D_RECON, dev, "Network reconfiguration detected (status=%Xh)\n",
1036                                    status);
1037                         if (netif_carrier_ok(dev)) {
1038                                 netif_carrier_off(dev);
1039                                 netdev_info(dev, "link down\n");
1040                         }
1041                         mod_timer(&lp->timer, jiffies + msecs_to_jiffies(1000));
1042
1043                         arcnet_led_event(dev, ARCNET_LED_EVENT_RECON);
1044                         /* MYRECON bit is at bit 7 of diagstatus */
1045                         if (diagstatus & 0x80)
1046                                 arc_printk(D_RECON, dev, "Put out that recon myself\n");
1047
1048                         /* is the RECON info empty or old? */
1049                         if (!lp->first_recon || !lp->last_recon ||
1050                             time_after(jiffies, lp->last_recon + HZ * 10)) {
1051                                 if (lp->network_down)
1052                                         arc_printk(D_NORMAL, dev, "reconfiguration detected: cabling restored?\n");
1053                                 lp->first_recon = lp->last_recon = jiffies;
1054                                 lp->num_recons = lp->network_down = 0;
1055
1056                                 arc_printk(D_DURING, dev, "recon: clearing counters.\n");
1057                         } else {        /* add to current RECON counter */
1058                                 lp->last_recon = jiffies;
1059                                 lp->num_recons++;
1060
1061                                 arc_printk(D_DURING, dev, "recon: counter=%d, time=%lds, net=%d\n",
1062                                            lp->num_recons,
1063                                            (lp->last_recon - lp->first_recon) / HZ,
1064                                            lp->network_down);
1065
1066                                 /* if network is marked up;
1067                                  * and first_recon and last_recon are 60+ apart;
1068                                  * and the average no. of recons counted is
1069                                  *    > RECON_THRESHOLD/min;
1070                                  * then print a warning message.
1071                                  */
1072                                 if (!lp->network_down &&
1073                                     (lp->last_recon - lp->first_recon) <= HZ * 60 &&
1074                                     lp->num_recons >= RECON_THRESHOLD) {
1075                                         lp->network_down = 1;
1076                                         arc_printk(D_NORMAL, dev, "many reconfigurations detected: cabling problem?\n");
1077                                 } else if (!lp->network_down &&
1078                                            lp->last_recon - lp->first_recon > HZ * 60) {
1079                                         /* reset counters if we've gone for
1080                                          *  over a minute.
1081                                          */
1082                                         lp->first_recon = lp->last_recon;
1083                                         lp->num_recons = 1;
1084                                 }
1085                         }
1086                 } else if (lp->network_down &&
1087                            time_after(jiffies, lp->last_recon + HZ * 10)) {
1088                         if (lp->network_down)
1089                                 arc_printk(D_NORMAL, dev, "cabling restored?\n");
1090                         lp->first_recon = lp->last_recon = 0;
1091                         lp->num_recons = lp->network_down = 0;
1092
1093                         arc_printk(D_DURING, dev, "not recon: clearing counters anyway.\n");
1094                         netif_carrier_on(dev);
1095                 }
1096
1097                 if (didsomething)
1098                         retval |= IRQ_HANDLED;
1099         } while (--boguscount && didsomething);
1100
1101         arc_printk(D_DURING, dev, "arcnet_interrupt complete (status=%Xh, count=%d)\n",
1102                    lp->hw.status(dev), boguscount);
1103         arc_printk(D_DURING, dev, "\n");
1104
1105         lp->hw.intmask(dev, 0);
1106         udelay(1);
1107         lp->hw.intmask(dev, lp->intmask);
1108
1109 out:
1110         spin_unlock_irqrestore(&lp->lock, flags);
1111         return retval;
1112 }
1113 EXPORT_SYMBOL(arcnet_interrupt);
1114
1115 /* This is a generic packet receiver that calls arcnet??_rx depending on the
1116  * protocol ID found.
1117  */
1118 static void arcnet_rx(struct net_device *dev, int bufnum)
1119 {
1120         struct arcnet_local *lp = netdev_priv(dev);
1121         union {
1122                 struct archdr pkt;
1123                 char buf[512];
1124         } rxdata;
1125         struct arc_rfc1201 *soft;
1126         int length, ofs;
1127
1128         soft = &rxdata.pkt.soft.rfc1201;
1129
1130         lp->hw.copy_from_card(dev, bufnum, 0, &rxdata.pkt, ARC_HDR_SIZE);
1131         if (rxdata.pkt.hard.offset[0]) {
1132                 ofs = rxdata.pkt.hard.offset[0];
1133                 length = 256 - ofs;
1134         } else {
1135                 ofs = rxdata.pkt.hard.offset[1];
1136                 length = 512 - ofs;
1137         }
1138
1139         /* get the full header, if possible */
1140         if (sizeof(rxdata.pkt.soft) <= length) {
1141                 lp->hw.copy_from_card(dev, bufnum, ofs, soft, sizeof(rxdata.pkt.soft));
1142         } else {
1143                 memset(&rxdata.pkt.soft, 0, sizeof(rxdata.pkt.soft));
1144                 lp->hw.copy_from_card(dev, bufnum, ofs, soft, length);
1145         }
1146
1147         arc_printk(D_DURING, dev, "Buffer #%d: received packet from %02Xh to %02Xh (%d+4 bytes)\n",
1148                    bufnum, rxdata.pkt.hard.source, rxdata.pkt.hard.dest, length);
1149
1150         dev->stats.rx_packets++;
1151         dev->stats.rx_bytes += length + ARC_HDR_SIZE;
1152
1153         /* call the right receiver for the protocol */
1154         if (arc_proto_map[soft->proto]->is_ip) {
1155                 if (BUGLVL(D_PROTO)) {
1156                         struct ArcProto
1157                         *oldp = arc_proto_map[lp->default_proto[rxdata.pkt.hard.source]],
1158                         *newp = arc_proto_map[soft->proto];
1159
1160                         if (oldp != newp) {
1161                                 arc_printk(D_PROTO, dev,
1162                                            "got protocol %02Xh; encap for host %02Xh is now '%c' (was '%c')\n",
1163                                            soft->proto, rxdata.pkt.hard.source,
1164                                            newp->suffix, oldp->suffix);
1165                         }
1166                 }
1167
1168                 /* broadcasts will always be done with the last-used encap. */
1169                 lp->default_proto[0] = soft->proto;
1170
1171                 /* in striking contrast, the following isn't a hack. */
1172                 lp->default_proto[rxdata.pkt.hard.source] = soft->proto;
1173         }
1174         /* call the protocol-specific receiver. */
1175         arc_proto_map[soft->proto]->rx(dev, bufnum, &rxdata.pkt, length);
1176 }
1177
1178 static void null_rx(struct net_device *dev, int bufnum,
1179                     struct archdr *pkthdr, int length)
1180 {
1181         arc_printk(D_PROTO, dev,
1182                    "rx: don't know how to deal with proto %02Xh from host %02Xh.\n",
1183                    pkthdr->soft.rfc1201.proto, pkthdr->hard.source);
1184 }
1185
1186 static int null_build_header(struct sk_buff *skb, struct net_device *dev,
1187                              unsigned short type, uint8_t daddr)
1188 {
1189         struct arcnet_local *lp = netdev_priv(dev);
1190
1191         arc_printk(D_PROTO, dev,
1192                    "tx: can't build header for encap %02Xh; load a protocol driver.\n",
1193                    lp->default_proto[daddr]);
1194
1195         /* always fails */
1196         return 0;
1197 }
1198
1199 /* the "do nothing" prepare_tx function warns that there's nothing to do. */
1200 static int null_prepare_tx(struct net_device *dev, struct archdr *pkt,
1201                            int length, int bufnum)
1202 {
1203         struct arcnet_local *lp = netdev_priv(dev);
1204         struct arc_hardware newpkt;
1205
1206         arc_printk(D_PROTO, dev, "tx: no encap for this host; load a protocol driver.\n");
1207
1208         /* send a packet to myself -- will never get received, of course */
1209         newpkt.source = newpkt.dest = dev->dev_addr[0];
1210
1211         /* only one byte of actual data (and it's random) */
1212         newpkt.offset[0] = 0xFF;
1213
1214         lp->hw.copy_to_card(dev, bufnum, 0, &newpkt, ARC_HDR_SIZE);
1215
1216         return 1;               /* done */
1217 }
This page took 0.098358 seconds and 4 git commands to generate.