/* * Linux ARCnet driver - device-independent routines * * Written 1997 by David Woodhouse. * Written 1994-1999 by Avery Pennarun. * Written 1999-2000 by Martin Mares <mj@ucw.cz>. * Derived from skeleton.c by Donald Becker. * * Special thanks to Contemporary Controls, Inc. (www.ccontrols.com) * for sponsoring the further development of this driver. * * ********************** * * The original copyright was as follows: * * skeleton.c Written 1993 by Donald Becker. * Copyright 1993 United States Government as represented by the * Director, National Security Agency. This software may only be used * and distributed according to the terms of the GNU General Public License as * modified by SRC, incorporated herein by reference. * * ********************** * * The change log is now in a file called ChangeLog in this directory. * * Sources: * - Crynwr arcnet.com/arcether.com packet drivers. * - arcnet.c v0.00 dated 1/1/94 and apparently by * Donald Becker - it didn't work :) * - skeleton.c v0.05 dated 11/16/93 by Donald Becker * (from Linux Kernel 1.1.45) * - RFC's 1201 and 1051 - re: TCP/IP over ARCnet * - The official ARCnet COM9026 data sheets (!) thanks to * Ken Cornetet <kcornete@nyx10.cs.du.edu> * - The official ARCnet COM20020 data sheets. * - Information on some more obscure ARCnet controller chips, thanks * to the nice people at SMSC. * - net/inet/eth.c (from kernel 1.1.50) for header-building info. * - Alternate Linux ARCnet source by V.Shergin <vsher@sao.stavropol.su> * - Textual information and more alternate source from Joachim Koenig * <jojo@repas.de> */ #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt #include <linux/module.h>#include <linux/types.h>#include <linux/delay.h>#include <linux/netdevice.h>#include <linux/if_arp.h>#include <net/arp.h>#include <linux/init.h>#include <linux/jiffies.h>#include <linux/errqueue.h> #include <linux/leds.h>#include <linux/workqueue.h> #include "arcdevice.h"#include "com9026.h" /* "do nothing" functions for protocol drivers */static void null_rx(struct net_device *dev, int bufnum, struct archdr *pkthdr, int length);static int null_build_header(struct sk_buff *skb, struct net_device *dev, unsigned short type, uint8_t daddr);static int null_prepare_tx(struct net_device *dev, struct archdr *pkt, int length, int bufnum); static void arcnet_rx(struct net_device *dev, int bufnum); /* one ArcProto per possible proto ID. None of the elements of * arc_proto_map are allowed to be NULL; they will get set to * arc_proto_default instead. It also must not be NULL; if you would like * to set it to NULL, set it to &arc_proto_null instead. */struct ArcProto *arc_proto_map[256];EXPORT_SYMBOL(arc_proto_map); struct ArcProto *arc_proto_default;EXPORT_SYMBOL(arc_proto_default); struct ArcProto *arc_bcast_proto;EXPORT_SYMBOL(arc_bcast_proto); struct ArcProto *arc_raw_proto;EXPORT_SYMBOL(arc_raw_proto); static struct ArcProto arc_proto_null = { .suffix = '?', .mtu = XMTU, .is_ip = 0, .rx = null_rx, .build_header = null_build_header, .prepare_tx = null_prepare_tx, .continue_tx = NULL, .ack_tx = NULL}; /* Exported function prototypes */int arcnet_debug = ARCNET_DEBUG;EXPORT_SYMBOL(arcnet_debug); /* Internal function prototypes */static int arcnet_header(struct sk_buff *skb, struct net_device *dev, unsigned short type, const void *daddr, const void *saddr, unsigned len);static int go_tx(struct net_device *dev); static int debug = ARCNET_DEBUG;module_param(debug, int, 0);MODULE_DESCRIPTION("ARCnet core driver");MODULE_LICENSE("GPL"); static int __init arcnet_init(void){ int count; arcnet_debug = debug; pr_info("arcnet loaded\n"); /* initialize the protocol map */ arc_raw_proto = arc_proto_default = arc_bcast_proto = &arc_proto_null; for (count = 0; count < 256; count++) arc_proto_map[count] = arc_proto_default; if (BUGLVL(D_DURING)) pr_info("struct sizes: %zd %zd %zd %zd %zd\n", sizeof(struct arc_hardware), sizeof(struct arc_rfc1201), sizeof(struct arc_rfc1051), sizeof(struct arc_eth_encap), sizeof(struct archdr)); return 0;} static void __exit arcnet_exit(void){} module_init(arcnet_init);module_exit(arcnet_exit); /* Dump the contents of an sk_buff */#if ARCNET_DEBUG_MAX & D_SKBvoid arcnet_dump_skb(struct net_device *dev, struct sk_buff *skb, char *desc){ char hdr[32]; /* dump the packet */ snprintf(hdr, sizeof(hdr), "%6s:%s skb->data:", dev->name, desc); print_hex_dump(KERN_DEBUG, hdr, DUMP_PREFIX_OFFSET, 16, 1, skb->data, skb->len, true);}EXPORT_SYMBOL(arcnet_dump_skb);#endif /* Dump the contents of an ARCnet buffer */#if (ARCNET_DEBUG_MAX & (D_RX | D_TX))static void arcnet_dump_packet(struct net_device *dev, int bufnum, char *desc, int take_arcnet_lock){ struct arcnet_local *lp = netdev_priv(dev); int i, length; unsigned long flags = 0; static uint8_t buf[512]; char hdr[32]; /* hw.copy_from_card expects IRQ context so take the IRQ lock * to keep it single threaded */ if (take_arcnet_lock) spin_lock_irqsave(&lp->lock, flags); lp->hw.copy_from_card(dev, bufnum, 0, buf, 512); if (take_arcnet_lock) spin_unlock_irqrestore(&lp->lock, flags); /* if the offset[0] byte is nonzero, this is a 256-byte packet */ length = (buf[2] ? 256 : 512); /* dump the packet */ snprintf(hdr, sizeof(hdr), "%6s:%s packet dump:", dev->name, desc); print_hex_dump(KERN_DEBUG, hdr, DUMP_PREFIX_OFFSET, 16, 1, buf, length, true);} #else #define arcnet_dump_packet(dev, bufnum, desc, take_arcnet_lock) do { } while (0) #endif /* Trigger a LED event in response to a ARCNET device event */void arcnet_led_event(struct net_device *dev, enum arcnet_led_event event){ struct arcnet_local *lp = netdev_priv(dev); switch (event) { case ARCNET_LED_EVENT_RECON: led_trigger_blink_oneshot(lp->recon_led_trig, 350, 350, 0); break; case ARCNET_LED_EVENT_OPEN: led_trigger_event(lp->tx_led_trig, LED_OFF); led_trigger_event(lp->recon_led_trig, LED_OFF); break; case ARCNET_LED_EVENT_STOP: led_trigger_event(lp->tx_led_trig, LED_OFF); led_trigger_event(lp->recon_led_trig, LED_OFF); break; case ARCNET_LED_EVENT_TX: led_trigger_blink_oneshot(lp->tx_led_trig, 50, 50, 0); break; }}EXPORT_SYMBOL_GPL(arcnet_led_event); static void arcnet_led_release(struct device *gendev, void *res){ struct arcnet_local *lp = netdev_priv(to_net_dev(gendev)); led_trigger_unregister_simple(lp->tx_led_trig); led_trigger_unregister_simple(lp->recon_led_trig);} /* Register ARCNET LED triggers for a arcnet device * * This is normally called from a driver's probe function */void devm_arcnet_led_init(struct net_device *netdev, int index, int subid){ struct arcnet_local *lp = netdev_priv(netdev); void *res; res = devres_alloc(arcnet_led_release, 0, GFP_KERNEL); if (!res) { netdev_err(netdev, "cannot register LED triggers\n"); return; } snprintf(lp->tx_led_trig_name, sizeof(lp->tx_led_trig_name), "arc%d-%d-tx", index, subid); snprintf(lp->recon_led_trig_name, sizeof(lp->recon_led_trig_name), "arc%d-%d-recon", index, subid); led_trigger_register_simple(lp->tx_led_trig_name, &lp->tx_led_trig); led_trigger_register_simple(lp->recon_led_trig_name, &lp->recon_led_trig); devres_add(&netdev->dev, res);}EXPORT_SYMBOL_GPL(devm_arcnet_led_init); /* Unregister a protocol driver from the arc_proto_map. Protocol drivers * are responsible for registering themselves, but the unregister routine * is pretty generic so we'll do it here. */void arcnet_unregister_proto(struct ArcProto *proto){ int count; if (arc_proto_default == proto) arc_proto_default = &arc_proto_null; if (arc_bcast_proto == proto) arc_bcast_proto = arc_proto_default; if (arc_raw_proto == proto) arc_raw_proto = arc_proto_default; for (count = 0; count < 256; count++) { if (arc_proto_map[count] == proto) arc_proto_map[count] = arc_proto_default; }}EXPORT_SYMBOL(arcnet_unregister_proto); /* Add a buffer to the queue. Only the interrupt handler is allowed to do * this, unless interrupts are disabled. * * Note: we don't check for a full queue, since there aren't enough buffers * to more than fill it. */static void release_arcbuf(struct net_device *dev, int bufnum){ struct arcnet_local *lp = netdev_priv(dev); int i; lp->buf_queue[lp->first_free_buf++] = bufnum; lp->first_free_buf %= 5; if (BUGLVL(D_DURING)) { arc_printk(D_DURING, dev, "release_arcbuf: freed #%d; buffer queue is now: ", bufnum); for (i = lp->next_buf; i != lp->first_free_buf; i = (i + 1) % 5) arc_cont(D_DURING, "#%d ", lp->buf_queue[i]); arc_cont(D_DURING, "\n"); }} /* Get a buffer from the queue. * If this returns -1, there are no buffers available. */static int get_arcbuf(struct net_device *dev){ struct arcnet_local *lp = netdev_priv(dev); int buf = -1, i; if (!atomic_dec_and_test(&lp->buf_lock)) { /* already in this function */ arc_printk(D_NORMAL, dev, "get_arcbuf: overlap (%d)!\n", lp->buf_lock.counter); } else { /* we can continue */ if (lp->next_buf >= 5) lp->next_buf -= 5; if (lp->next_buf == lp->first_free_buf) { arc_printk(D_NORMAL, dev, "get_arcbuf: BUG: no buffers are available??\n"); } else { buf = lp->buf_queue[lp->next_buf++]; lp->next_buf %= 5; } } if (BUGLVL(D_DURING)) { arc_printk(D_DURING, dev, "get_arcbuf: got #%d; buffer queue is now: ", buf); for (i = lp->next_buf; i != lp->first_free_buf; i = (i + 1) % 5) arc_cont(D_DURING, "#%d ", lp->buf_queue[i]); arc_cont(D_DURING, "\n"); } atomic_inc(&lp->buf_lock); return buf;} static int choose_mtu(void){ int count, mtu = 65535; /* choose the smallest MTU of all available encaps */ for (count = 0; count < 256; count++) { if (arc_proto_map[count] != &arc_proto_null && arc_proto_map[count]->mtu < mtu) { mtu = arc_proto_map[count]->mtu; } } return mtu == 65535 ? XMTU : mtu;} static const struct header_ops arcnet_header_ops = { .create = arcnet_header,}; static const struct net_device_ops arcnet_netdev_ops = { .ndo_open = arcnet_open, .ndo_stop = arcnet_close, .ndo_start_xmit = arcnet_send_packet, .ndo_tx_timeout = arcnet_timeout,}; /* Setup a struct device for ARCnet. */static void arcdev_setup(struct net_device *dev){ dev->type = ARPHRD_ARCNET; dev->netdev_ops = &arcnet_netdev_ops; dev->header_ops = &arcnet_header_ops; dev->hard_header_len = sizeof(struct arc_hardware); dev->mtu = choose_mtu(); dev->addr_len = ARCNET_ALEN; dev->tx_queue_len = 100; dev->broadcast[0] = 0x00; /* for us, broadcasts are address 0 */ dev->watchdog_timeo = TX_TIMEOUT; /* New-style flags. */ dev->flags = IFF_BROADCAST;} static void arcnet_timer(struct timer_list *t){ struct arcnet_local *lp = timer_container_of(lp, t, timer); struct net_device *dev = lp->dev; spin_lock_irq(&lp->lock); if (!lp->reset_in_progress && !netif_carrier_ok(dev)) { netif_carrier_on(dev); netdev_info(dev, "link up\n"); } spin_unlock_irq(&lp->lock);} static void reset_device_work(struct work_struct *work){ struct arcnet_local *lp; struct net_device *dev; lp = container_of(work, struct arcnet_local, reset_work); dev = lp->dev; /* Do not bring the network interface back up if an ifdown * was already done. */ if (!netif_running(dev) || !lp->reset_in_progress) return; rtnl_lock(); /* Do another check, in case of an ifdown that was triggered in * the small race window between the exit condition above and * acquiring RTNL. */ if (!netif_running(dev) || !lp->reset_in_progress) goto out; dev_close(dev); dev_open(dev, NULL); out: rtnl_unlock();} static void arcnet_reply_work(struct work_struct *t){ struct arcnet_local *lp = from_work(lp, t, reply_work); struct sk_buff *ackskb, *skb; struct sock_exterr_skb *serr; struct sock *sk; int ret; local_irq_disable(); skb = lp->outgoing.skb; if (!skb || !skb->sk) { local_irq_enable(); return; } sock_hold(skb->sk); sk = skb->sk; ackskb = skb_clone_sk(skb); sock_put(skb->sk); if (!ackskb) { local_irq_enable(); return; } serr = SKB_EXT_ERR(ackskb); memset(serr, 0, sizeof(*serr)); serr->ee.ee_errno = ENOMSG; serr->ee.ee_origin = SO_EE_ORIGIN_TXSTATUS; serr->ee.ee_data = skb_shinfo(skb)->tskey; serr->ee.ee_info = lp->reply_status; /* finally erasing outgoing skb */ dev_kfree_skb(lp->outgoing.skb); lp->outgoing.skb = NULL; ackskb->dev = lp->dev; ret = sock_queue_err_skb(sk, ackskb); if (ret) dev_kfree_skb_irq(ackskb); local_irq_enable();}; struct net_device *alloc_arcdev(const char *name){ struct net_device *dev; dev = alloc_netdev(sizeof(struct arcnet_local), name && *name ? name : "arc%d", NET_NAME_UNKNOWN, arcdev_setup); if (dev) { struct arcnet_local *lp = netdev_priv(dev); lp->dev = dev; spin_lock_init(&lp->lock); timer_setup(&lp->timer, arcnet_timer, 0); INIT_WORK(&lp->reset_work, reset_device_work); } return dev;}EXPORT_SYMBOL(alloc_arcdev); void free_arcdev(struct net_device *dev){ struct arcnet_local *lp = netdev_priv(dev); /* Do not cancel this at ->ndo_close(), as the workqueue itself * indirectly calls the ifdown path through dev_close(). */Lines 1–500 of 1217. Load more
/* * Linux ARCnet driver - device-independent routines * * Written 1997 by David Woodhouse. * Written 1994-1999 by Avery Pennarun. * Written 1999-2000 by Martin Mares <mj@ucw.cz>. * Derived from skeleton.c by Donald Becker. * * Special thanks to Contemporary Controls, Inc. (www.ccontrols.com) * for sponsoring the further development of this driver. * * ********************** * * The original copyright was as follows: * * skeleton.c Written 1993 by Donald Becker. * Copyright 1993 United States Government as represented by the * Director, National Security Agency. This software may only be used * and distributed according to the terms of the GNU General Public License as * modified by SRC, incorporated herein by reference. * * ********************** * * The change log is now in a file called ChangeLog in this directory. * * Sources: * - Crynwr arcnet.com/arcether.com packet drivers. * - arcnet.c v0.00 dated 1/1/94 and apparently by * Donald Becker - it didn't work :) * - skeleton.c v0.05 dated 11/16/93 by Donald Becker * (from Linux Kernel 1.1.45) * - RFC's 1201 and 1051 - re: TCP/IP over ARCnet * - The official ARCnet COM9026 data sheets (!) thanks to * Ken Cornetet <kcornete@nyx10.cs.du.edu> * - The official ARCnet COM20020 data sheets. * - Information on some more obscure ARCnet controller chips, thanks * to the nice people at SMSC. * - net/inet/eth.c (from kernel 1.1.50) for header-building info. * - Alternate Linux ARCnet source by V.Shergin <vsher@sao.stavropol.su> * - Textual information and more alternate source from Joachim Koenig * <jojo@repas.de> */ #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt #include <linux/module.h> #include <linux/types.h> #include <linux/delay.h> #include <linux/netdevice.h> #include <linux/if_arp.h> #include <net/arp.h> #include <linux/init.h> #include <linux/jiffies.h> #include <linux/errqueue.h> #include <linux/leds.h> #include <linux/workqueue.h> #include "arcdevice.h" #include "com9026.h" /* "do nothing" functions for protocol drivers */ static void null_rx(struct net_device *dev, int bufnum, struct archdr *pkthdr, int length); static int null_build_header(struct sk_buff *skb, struct net_device *dev, unsigned short type, uint8_t daddr); static int null_prepare_tx(struct net_device *dev, struct archdr *pkt, int length, int bufnum); static void arcnet_rx(struct net_device *dev, int bufnum); /* one ArcProto per possible proto ID. None of the elements of * arc_proto_map are allowed to be NULL; they will get set to * arc_proto_default instead. It also must not be NULL; if you would like * to set it to NULL, set it to &arc_proto_null instead. */ struct ArcProto *arc_proto_map[256]; EXPORT_SYMBOL(arc_proto_map); struct ArcProto *arc_proto_default; EXPORT_SYMBOL(arc_proto_default); struct ArcProto *arc_bcast_proto; EXPORT_SYMBOL(arc_bcast_proto); struct ArcProto *arc_raw_proto; EXPORT_SYMBOL(arc_raw_proto); static struct ArcProto arc_proto_null = { .suffix = '?', .mtu = XMTU, .is_ip = 0, .rx = null_rx, .build_header = null_build_header, .prepare_tx = null_prepare_tx, .continue_tx = NULL, .ack_tx = NULL }; /* Exported function prototypes */ int arcnet_debug = ARCNET_DEBUG; EXPORT_SYMBOL(arcnet_debug); /* Internal function prototypes */ static int arcnet_header(struct sk_buff *skb, struct net_device *dev, unsigned short type, const void *daddr, const void *saddr, unsigned len); static int go_tx(struct net_device *dev); static int debug = ARCNET_DEBUG; module_param(debug, int, 0); MODULE_DESCRIPTION("ARCnet core driver"); MODULE_LICENSE("GPL"); static int __init arcnet_init(void) { int count; arcnet_debug = debug; pr_info("arcnet loaded\n"); /* initialize the protocol map */ arc_raw_proto = arc_proto_default = arc_bcast_proto = &arc_proto_null; for (count = 0; count < 256; count++) arc_proto_map[count] = arc_proto_default; if (BUGLVL(D_DURING)) pr_info("struct sizes: %zd %zd %zd %zd %zd\n", sizeof(struct arc_hardware), sizeof(struct arc_rfc1201), sizeof(struct arc_rfc1051), sizeof(struct arc_eth_encap), sizeof(struct archdr)); return 0; } static void __exit arcnet_exit(void) { } module_init(arcnet_init); module_exit(arcnet_exit); /* Dump the contents of an sk_buff */ #if ARCNET_DEBUG_MAX & D_SKB void arcnet_dump_skb(struct net_device *dev, struct sk_buff *skb, char *desc) { char hdr[32]; /* dump the packet */ snprintf(hdr, sizeof(hdr), "%6s:%s skb->data:", dev->name, desc); print_hex_dump(KERN_DEBUG, hdr, DUMP_PREFIX_OFFSET, 16, 1, skb->data, skb->len, true); } EXPORT_SYMBOL(arcnet_dump_skb); #endif /* Dump the contents of an ARCnet buffer */ #if (ARCNET_DEBUG_MAX & (D_RX | D_TX)) static void arcnet_dump_packet(struct net_device *dev, int bufnum, char *desc, int take_arcnet_lock) { struct arcnet_local *lp = netdev_priv(dev); int i, length; unsigned long flags = 0; static uint8_t buf[512]; char hdr[32]; /* hw.copy_from_card expects IRQ context so take the IRQ lock * to keep it single threaded */ if (take_arcnet_lock) spin_lock_irqsave(&lp->lock, flags); lp->hw.copy_from_card(dev, bufnum, 0, buf, 512); if (take_arcnet_lock) spin_unlock_irqrestore(&lp->lock, flags); /* if the offset[0] byte is nonzero, this is a 256-byte packet */ length = (buf[2] ? 256 : 512); /* dump the packet */ snprintf(hdr, sizeof(hdr), "%6s:%s packet dump:", dev->name, desc); print_hex_dump(KERN_DEBUG, hdr, DUMP_PREFIX_OFFSET, 16, 1, buf, length, true); } #else #define arcnet_dump_packet(dev, bufnum, desc, take_arcnet_lock) do { } while (0) #endif /* Trigger a LED event in response to a ARCNET device event */ void arcnet_led_event(struct net_device *dev, enum arcnet_led_event event) { struct arcnet_local *lp = netdev_priv(dev); switch (event) { case ARCNET_LED_EVENT_RECON: led_trigger_blink_oneshot(lp->recon_led_trig, 350, 350, 0); break; case ARCNET_LED_EVENT_OPEN: led_trigger_event(lp->tx_led_trig, LED_OFF); led_trigger_event(lp->recon_led_trig, LED_OFF); break; case ARCNET_LED_EVENT_STOP: led_trigger_event(lp->tx_led_trig, LED_OFF); led_trigger_event(lp->recon_led_trig, LED_OFF); break; case ARCNET_LED_EVENT_TX: led_trigger_blink_oneshot(lp->tx_led_trig, 50, 50, 0); break; } } EXPORT_SYMBOL_GPL(arcnet_led_event); static void arcnet_led_release(struct device *gendev, void *res) { struct arcnet_local *lp = netdev_priv(to_net_dev(gendev)); led_trigger_unregister_simple(lp->tx_led_trig); led_trigger_unregister_simple(lp->recon_led_trig); } /* Register ARCNET LED triggers for a arcnet device * * This is normally called from a driver's probe function */ void devm_arcnet_led_init(struct net_device *netdev, int index, int subid) { struct arcnet_local *lp = netdev_priv(netdev); void *res; res = devres_alloc(arcnet_led_release, 0, GFP_KERNEL); if (!res) { netdev_err(netdev, "cannot register LED triggers\n"); return; } snprintf(lp->tx_led_trig_name, sizeof(lp->tx_led_trig_name), "arc%d-%d-tx", index, subid); snprintf(lp->recon_led_trig_name, sizeof(lp->recon_led_trig_name), "arc%d-%d-recon", index, subid); led_trigger_register_simple(lp->tx_led_trig_name, &lp->tx_led_trig); led_trigger_register_simple(lp->recon_led_trig_name, &lp->recon_led_trig); devres_add(&netdev->dev, res); } EXPORT_SYMBOL_GPL(devm_arcnet_led_init); /* Unregister a protocol driver from the arc_proto_map. Protocol drivers * are responsible for registering themselves, but the unregister routine * is pretty generic so we'll do it here. */ void arcnet_unregister_proto(struct ArcProto *proto) { int count; if (arc_proto_default == proto) arc_proto_default = &arc_proto_null; if (arc_bcast_proto == proto) arc_bcast_proto = arc_proto_default; if (arc_raw_proto == proto) arc_raw_proto = arc_proto_default; for (count = 0; count < 256; count++) { if (arc_proto_map[count] == proto) arc_proto_map[count] = arc_proto_default; } } EXPORT_SYMBOL(arcnet_unregister_proto); /* Add a buffer to the queue. Only the interrupt handler is allowed to do * this, unless interrupts are disabled. * * Note: we don't check for a full queue, since there aren't enough buffers * to more than fill it. */ static void release_arcbuf(struct net_device *dev, int bufnum) { struct arcnet_local *lp = netdev_priv(dev); int i; lp->buf_queue[lp->first_free_buf++] = bufnum; lp->first_free_buf %= 5; if (BUGLVL(D_DURING)) { arc_printk(D_DURING, dev, "release_arcbuf: freed #%d; buffer queue is now: ", bufnum); for (i = lp->next_buf; i != lp->first_free_buf; i = (i + 1) % 5) arc_cont(D_DURING, "#%d ", lp->buf_queue[i]); arc_cont(D_DURING, "\n"); } } /* Get a buffer from the queue. * If this returns -1, there are no buffers available. */ static int get_arcbuf(struct net_device *dev) { struct arcnet_local *lp = netdev_priv(dev); int buf = -1, i; if (!atomic_dec_and_test(&lp->buf_lock)) { /* already in this function */ arc_printk(D_NORMAL, dev, "get_arcbuf: overlap (%d)!\n", lp->buf_lock.counter); } else { /* we can continue */ if (lp->next_buf >= 5) lp->next_buf -= 5; if (lp->next_buf == lp->first_free_buf) { arc_printk(D_NORMAL, dev, "get_arcbuf: BUG: no buffers are available??\n"); } else { buf = lp->buf_queue[lp->next_buf++]; lp->next_buf %= 5; } } if (BUGLVL(D_DURING)) { arc_printk(D_DURING, dev, "get_arcbuf: got #%d; buffer queue is now: ", buf); for (i = lp->next_buf; i != lp->first_free_buf; i = (i + 1) % 5) arc_cont(D_DURING, "#%d ", lp->buf_queue[i]); arc_cont(D_DURING, "\n"); } atomic_inc(&lp->buf_lock); return buf; } static int choose_mtu(void) { int count, mtu = 65535; /* choose the smallest MTU of all available encaps */ for (count = 0; count < 256; count++) { if (arc_proto_map[count] != &arc_proto_null && arc_proto_map[count]->mtu < mtu) { mtu = arc_proto_map[count]->mtu; } } return mtu == 65535 ? XMTU : mtu; } static const struct header_ops arcnet_header_ops = { .create = arcnet_header, }; static const struct net_device_ops arcnet_netdev_ops = { .ndo_open = arcnet_open, .ndo_stop = arcnet_close, .ndo_start_xmit = arcnet_send_packet, .ndo_tx_timeout = arcnet_timeout, }; /* Setup a struct device for ARCnet. */ static void arcdev_setup(struct net_device *dev) { dev->type = ARPHRD_ARCNET; dev->netdev_ops = &arcnet_netdev_ops; dev->header_ops = &arcnet_header_ops; dev->hard_header_len = sizeof(struct arc_hardware); dev->mtu = choose_mtu(); dev->addr_len = ARCNET_ALEN; dev->tx_queue_len = 100; dev->broadcast[0] = 0x00; /* for us, broadcasts are address 0 */ dev->watchdog_timeo = TX_TIMEOUT; /* New-style flags. */ dev->flags = IFF_BROADCAST; } static void arcnet_timer(struct timer_list *t) { struct arcnet_local *lp = timer_container_of(lp, t, timer); struct net_device *dev = lp->dev; spin_lock_irq(&lp->lock); if (!lp->reset_in_progress && !netif_carrier_ok(dev)) { netif_carrier_on(dev); netdev_info(dev, "link up\n"); } spin_unlock_irq(&lp->lock); } static void reset_device_work(struct work_struct *work) { struct arcnet_local *lp; struct net_device *dev; lp = container_of(work, struct arcnet_local, reset_work); dev = lp->dev; /* Do not bring the network interface back up if an ifdown * was already done. */ if (!netif_running(dev) || !lp->reset_in_progress) return; rtnl_lock(); /* Do another check, in case of an ifdown that was triggered in * the small race window between the exit condition above and * acquiring RTNL. */ if (!netif_running(dev) || !lp->reset_in_progress) goto out; dev_close(dev); dev_open(dev, NULL); out: rtnl_unlock(); } static void arcnet_reply_work(struct work_struct *t) { struct arcnet_local *lp = from_work(lp, t, reply_work); struct sk_buff *ackskb, *skb; struct sock_exterr_skb *serr; struct sock *sk; int ret; local_irq_disable(); skb = lp->outgoing.skb; if (!skb || !skb->sk) { local_irq_enable(); return; } sock_hold(skb->sk); sk = skb->sk; ackskb = skb_clone_sk(skb); sock_put(skb->sk); if (!ackskb) { local_irq_enable(); return; } serr = SKB_EXT_ERR(ackskb); memset(serr, 0, sizeof(*serr)); serr->ee.ee_errno = ENOMSG; serr->ee.ee_origin = SO_EE_ORIGIN_TXSTATUS; serr->ee.ee_data = skb_shinfo(skb)->tskey; serr->ee.ee_info = lp->reply_status; /* finally erasing outgoing skb */ dev_kfree_skb(lp->outgoing.skb); lp->outgoing.skb = NULL; ackskb->dev = lp->dev; ret = sock_queue_err_skb(sk, ackskb); if (ret) dev_kfree_skb_irq(ackskb); local_irq_enable(); }; struct net_device *alloc_arcdev(const char *name) { struct net_device *dev; dev = alloc_netdev(sizeof(struct arcnet_local), name && *name ? name : "arc%d", NET_NAME_UNKNOWN, arcdev_setup); if (dev) { struct arcnet_local *lp = netdev_priv(dev); lp->dev = dev; spin_lock_init(&lp->lock); timer_setup(&lp->timer, arcnet_timer, 0); INIT_WORK(&lp->reset_work, reset_device_work); } return dev; } EXPORT_SYMBOL(alloc_arcdev); void free_arcdev(struct net_device *dev) { struct arcnet_local *lp = netdev_priv(dev); /* Do not cancel this at ->ndo_close(), as the workqueue itself * indirectly calls the ifdown path through dev_close(). */