1217 lines · 33.4 KB · C
RawDownload
/* * 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.