[net-next-2.6.git] / drivers / isdn / hysdn / hysdn_net.c

/* $Id: hysdn_net.c,v 1.8.6.4 2001/09/23 22:24:54 kai Exp $
 *
 * Linux driver for HYSDN cards, net (ethernet type) handling routines.
 *
 * Author    Werner Cornelius (werner@titro.de) for Hypercope GmbH
 * Copyright 1999 by Werner Cornelius (werner@titro.de)
 *
 * This software may be used and distributed according to the terms
 * of the GNU General Public License, incorporated herein by reference.
 *
 * This net module has been inspired by the skeleton driver from
 * Donald Becker (becker@CESDIS.gsfc.nasa.gov)
 *
 */

#include <linux/module.h>
#include <linux/signal.h>
#include <linux/kernel.h>
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/skbuff.h>
#include <linux/inetdevice.h>

#include "hysdn_defs.h"

unsigned int hynet_enable = 0xffffffff; 
module_param(hynet_enable, uint, 0);

/* store the actual version for log reporting */
char *hysdn_net_revision = "$Revision: 1.8.6.4 $";

#define MAX_SKB_BUFFERS 20	/* number of buffers for keeping TX-data */

/****************************************************************************/
/* structure containing the complete network data. The structure is aligned */
/* in a way that both, the device and statistics are kept inside it.        */
/* for proper access, the device structure MUST be the first var/struct     */
/* inside the definition.                                                   */
/****************************************************************************/
struct net_local {
	/* Tx control lock.  This protects the transmit buffer ring
	 * state along with the "tx full" state of the driver.  This
	 * means all netif_queue flow control actions are protected
	 * by this lock as well.
	 */
	struct net_device *dev;
	spinlock_t lock;
	struct sk_buff *skbs[MAX_SKB_BUFFERS];	/* pointers to tx-skbs */
	int in_idx, out_idx;	/* indexes to buffer ring */
	int sk_count;		/* number of buffers currently in ring */
};				/* net_local */


/*********************************************************************/
/* Open/initialize the board. This is called (in the current kernel) */
/* sometime after booting when the 'ifconfig' program is run.        */
/* This routine should set everything up anew at each open, even     */
/* registers that "should" only need to be set once at boot, so that */
/* there is non-reboot way to recover if something goes wrong.       */
/*********************************************************************/
static int
net_open(struct net_device *dev)
{
	struct in_device *in_dev;
	hysdn_card *card = dev->ml_priv;
	int i;

	netif_start_queue(dev);	/* start tx-queueing */

	/* Fill in the MAC-level header (if not already set) */
	if (!card->mac_addr[0]) {
		for (i = 0; i < ETH_ALEN; i++)
			dev->dev_addr[i] = 0xfc;
		if ((in_dev = dev->ip_ptr) != NULL) {
			struct in_ifaddr *ifa = in_dev->ifa_list;
			if (ifa != NULL)
				memcpy(dev->dev_addr + (ETH_ALEN - sizeof(ifa->ifa_local)), &ifa->ifa_local, sizeof(ifa->ifa_local));
		}
	} else
		memcpy(dev->dev_addr, card->mac_addr, ETH_ALEN);

	return (0);
}				/* net_open */

/*******************************************/
/* flush the currently occupied tx-buffers */
/* must only be called when device closed  */
/*******************************************/
static void
flush_tx_buffers(struct net_local *nl)
{

	while (nl->sk_count) {
		dev_kfree_skb(nl->skbs[nl->out_idx++]);		/* free skb */
		if (nl->out_idx >= MAX_SKB_BUFFERS)
			nl->out_idx = 0;	/* wrap around */
		nl->sk_count--;
	}
}				/* flush_tx_buffers */


/*********************************************************************/
/* close/decativate the device. The device is not removed, but only  */
/* deactivated.                                                      */
/*********************************************************************/
static int
net_close(struct net_device *dev)
{

	netif_stop_queue(dev);	/* disable queueing */

	flush_tx_buffers((struct net_local *) dev);

	return (0);		/* success */
}				/* net_close */

/************************************/
/* send a packet on this interface. */
/* new style for kernel >= 2.3.33   */
/************************************/
static netdev_tx_t
net_send_packet(struct sk_buff *skb, struct net_device *dev)
{
	struct net_local *lp = (struct net_local *) dev;

	spin_lock_irq(&lp->lock);

	lp->skbs[lp->in_idx++] = skb;	/* add to buffer list */
	if (lp->in_idx >= MAX_SKB_BUFFERS)
		lp->in_idx = 0;	/* wrap around */
	lp->sk_count++;		/* adjust counter */
	dev->trans_start = jiffies;

	/* If we just used up the very last entry in the
	 * TX ring on this device, tell the queueing
	 * layer to send no more.
	 */
	if (lp->sk_count >= MAX_SKB_BUFFERS)
		netif_stop_queue(dev);

	/* When the TX completion hw interrupt arrives, this
	 * is when the transmit statistics are updated.
	 */

	spin_unlock_irq(&lp->lock);

	if (lp->sk_count <= 3) {
		schedule_work(&((hysdn_card *) dev->ml_priv)->irq_queue);
	}
	return NETDEV_TX_OK;	/* success */
}				/* net_send_packet */


/***********************************************************************/
/* acknowlegde a packet send. The network layer will be informed about */
/* completion                                                          */
/***********************************************************************/
void
hysdn_tx_netack(hysdn_card * card)
{
	struct net_local *lp = card->netif;

	if (!lp)
		return;		/* non existing device */


	if (!lp->sk_count)
		return;		/* error condition */

	lp->dev->stats.tx_packets++;
	lp->dev->stats.tx_bytes += lp->skbs[lp->out_idx]->len;

	dev_kfree_skb(lp->skbs[lp->out_idx++]);		/* free skb */
	if (lp->out_idx >= MAX_SKB_BUFFERS)
		lp->out_idx = 0;	/* wrap around */

	if (lp->sk_count-- == MAX_SKB_BUFFERS)	/* dec usage count */
		netif_start_queue((struct net_device *) lp);
}				/* hysdn_tx_netack */

/*****************************************************/
/* we got a packet from the network, go and queue it */
/*****************************************************/
void
hysdn_rx_netpkt(hysdn_card * card, unsigned char *buf, unsigned short len)
{
	struct net_local *lp = card->netif;
	struct net_device *dev;
	struct sk_buff *skb;

	if (!lp)
		return;		/* non existing device */

	dev = lp->dev;
	dev->stats.rx_bytes += len;

	skb = dev_alloc_skb(len);
	if (skb == NULL) {
		printk(KERN_NOTICE "%s: Memory squeeze, dropping packet.\n",
		       dev->name);
		dev->stats.rx_dropped++;
		return;
	}
	/* copy the data */
	memcpy(skb_put(skb, len), buf, len);

	/* determine the used protocol */
	skb->protocol = eth_type_trans(skb, dev);

	dev->stats.rx_packets++;	/* adjust packet count */

	netif_rx(skb);
}				/* hysdn_rx_netpkt */

/*****************************************************/
/* return the pointer to a network packet to be send */
/*****************************************************/
struct sk_buff *
hysdn_tx_netget(hysdn_card * card)
{
	struct net_local *lp = card->netif;

	if (!lp)
		return (NULL);	/* non existing device */

	if (!lp->sk_count)
		return (NULL);	/* nothing available */

	return (lp->skbs[lp->out_idx]);		/* next packet to send */
}				/* hysdn_tx_netget */

static const struct net_device_ops hysdn_netdev_ops = {
	.ndo_open 		= net_open,
	.ndo_stop		= net_close,
	.ndo_start_xmit		= net_send_packet,
	.ndo_change_mtu		= eth_change_mtu,
	.ndo_set_mac_address 	= eth_mac_addr,
	.ndo_validate_addr	= eth_validate_addr,
};


/*****************************************************************************/
/* hysdn_net_create creates a new net device for the given card. If a device */
/* already exists, it will be deleted and created a new one. The return value */
/* 0 announces success, else a negative error code will be returned.         */
/*****************************************************************************/
int
hysdn_net_create(hysdn_card * card)
{
	struct net_device *dev;
	int i;
	struct net_local *lp;

	if(!card) {
		printk(KERN_WARNING "No card-pt in hysdn_net_create!\n");
		return (-ENOMEM);
	}
	hysdn_net_release(card);	/* release an existing net device */

	dev = alloc_etherdev(sizeof(struct net_local));
	if (!dev) {
		printk(KERN_WARNING "HYSDN: unable to allocate mem\n");
		return (-ENOMEM);
	}

	lp = netdev_priv(dev);
	lp->dev = dev;

	dev->netdev_ops = &hysdn_netdev_ops;
	spin_lock_init(&((struct net_local *) dev)->lock);

	/* initialise necessary or informing fields */
	dev->base_addr = card->iobase;	/* IO address */
	dev->irq = card->irq;	/* irq */

	dev->netdev_ops = &hysdn_netdev_ops;
	if ((i = register_netdev(dev))) {
		printk(KERN_WARNING "HYSDN: unable to create network device\n");
		free_netdev(dev);
		return (i);
	}
	dev->ml_priv = card;	/* remember pointer to own data structure */
	card->netif = dev;	/* setup the local pointer */

	if (card->debug_flags & LOG_NET_INIT)
		hysdn_addlog(card, "network device created");
	return (0);		/* and return success */
}				/* hysdn_net_create */

/***************************************************************************/
/* hysdn_net_release deletes the net device for the given card. The return */
/* value 0 announces success, else a negative error code will be returned. */
/***************************************************************************/
int
hysdn_net_release(hysdn_card * card)
{
	struct net_device *dev = card->netif;

	if (!dev)
		return (0);	/* non existing */

	card->netif = NULL;	/* clear out pointer */
	net_close(dev);

	flush_tx_buffers((struct net_local *) dev);	/* empty buffers */

	unregister_netdev(dev);	/* release the device */
	free_netdev(dev);	/* release the memory allocated */
	if (card->debug_flags & LOG_NET_INIT)
		hysdn_addlog(card, "network device deleted");

	return (0);		/* always successful */
}				/* hysdn_net_release */

/*****************************************************************************/
/* hysdn_net_getname returns a pointer to the name of the network interface. */
/* if the interface is not existing, a "-" is returned.                      */
/*****************************************************************************/
char *
hysdn_net_getname(hysdn_card * card)
{
	struct net_device *dev = card->netif;

	if (!dev)
		return ("-");	/* non existing */

	return (dev->name);
}				/* hysdn_net_getname */
Commit	Line	Data
1da177e4 LT	1	/* $Id: hysdn_net.c,v 1.8.6.4 2001/09/23 22:24:54 kai Exp $
	2	*
	3	* Linux driver for HYSDN cards, net (ethernet type) handling routines.
	4	*
	5	* Author Werner Cornelius (werner@titro.de) for Hypercope GmbH
	6	* Copyright 1999 by Werner Cornelius (werner@titro.de)
	7	*
	8	* This software may be used and distributed according to the terms
	9	* of the GNU General Public License, incorporated herein by reference.
	10	*
	11	* This net module has been inspired by the skeleton driver from
	12	* Donald Becker (becker@CESDIS.gsfc.nasa.gov)
	13	*
	14	*/
	15
	16	#include <linux/module.h>
1da177e4 LT	17	#include <linux/signal.h>
	18	#include <linux/kernel.h>
	19	#include <linux/netdevice.h>
	20	#include <linux/etherdevice.h>
	21	#include <linux/skbuff.h>
	22	#include <linux/inetdevice.h>
	23
	24	#include "hysdn_defs.h"
	25
	26	unsigned int hynet_enable = 0xffffffff;
8d3b33f6	27	module_param(hynet_enable, uint, 0);
1da177e4 LT	28
	29	/* store the actual version for log reporting */
	30	char *hysdn_net_revision = "$Revision: 1.8.6.4 $";
	31
	32	#define MAX_SKB_BUFFERS 20 /* number of buffers for keeping TX-data */
	33
	34	/****************************************************************************/
	35	/* structure containing the complete network data. The structure is aligned */
	36	/* in a way that both, the device and statistics are kept inside it. */
	37	/* for proper access, the device structure MUST be the first var/struct */
	38	/* inside the definition. */
	39	/****************************************************************************/
	40	struct net_local {
1da177e4 LT	41	/* Tx control lock. This protects the transmit buffer ring
	42	* state along with the "tx full" state of the driver. This
	43	* means all netif_queue flow control actions are protected
	44	* by this lock as well.
	45	*/
0e2445fb	46	struct net_device *dev;
1da177e4 LT	47	spinlock_t lock;
	48	struct sk_buff skbs[MAX_SKB_BUFFERS]; / pointers to tx-skbs */
	49	int in_idx, out_idx; /* indexes to buffer ring */
	50	int sk_count; /* number of buffers currently in ring */
	51	}; /* net_local */
	52
	53
1da177e4 LT	54
	55	/*********************************************************************/
	56	/* Open/initialize the board. This is called (in the current kernel) */
	57	/* sometime after booting when the 'ifconfig' program is run. */
	58	/* This routine should set everything up anew at each open, even */
	59	/* registers that "should" only need to be set once at boot, so that */
	60	/* there is non-reboot way to recover if something goes wrong. */
	61	/*********************************************************************/
	62	static int
	63	net_open(struct net_device *dev)
	64	{
	65	struct in_device *in_dev;
25dd7e6a	66	hysdn_card *card = dev->ml_priv;
1da177e4 LT	67	int i;
	68
	69	netif_start_queue(dev); /* start tx-queueing */
	70
	71	/* Fill in the MAC-level header (if not already set) */
	72	if (!card->mac_addr[0]) {
bd091410	73	for (i = 0; i < ETH_ALEN; i++)
1da177e4 LT	74	dev->dev_addr[i] = 0xfc;
	75	if ((in_dev = dev->ip_ptr) != NULL) {
	76	struct in_ifaddr *ifa = in_dev->ifa_list;
	77	if (ifa != NULL)
bd091410	78	memcpy(dev->dev_addr + (ETH_ALEN - sizeof(ifa->ifa_local)), &ifa->ifa_local, sizeof(ifa->ifa_local));
1da177e4 LT	79	}
	80	} else
	81	memcpy(dev->dev_addr, card->mac_addr, ETH_ALEN);
	82
	83	return (0);
	84	} /* net_open */
	85
	86	/*******************************************/
	87	/* flush the currently occupied tx-buffers */
	88	/* must only be called when device closed */
	89	/*******************************************/
	90	static void
	91	flush_tx_buffers(struct net_local *nl)
	92	{
	93
	94	while (nl->sk_count) {
	95	dev_kfree_skb(nl->skbs[nl->out_idx++]); /* free skb */
	96	if (nl->out_idx >= MAX_SKB_BUFFERS)
	97	nl->out_idx = 0; /* wrap around */
	98	nl->sk_count--;
	99	}
	100	} /* flush_tx_buffers */
	101
	102
	103	/*********************************************************************/
	104	/* close/decativate the device. The device is not removed, but only */
	105	/* deactivated. */
	106	/*********************************************************************/
	107	static int
	108	net_close(struct net_device *dev)
	109	{
	110
	111	netif_stop_queue(dev); /* disable queueing */
	112
	113	flush_tx_buffers((struct net_local *) dev);
	114
	115	return (0); /* success */
	116	} /* net_close */
	117
	118	/************************************/
	119	/* send a packet on this interface. */
	120	/* new style for kernel >= 2.3.33 */
	121	/************************************/
8b62ff2d	122	static netdev_tx_t
1da177e4 LT	123	net_send_packet(struct sk_buff skb, struct net_device dev)
	124	{
	125	struct net_local lp = (struct net_local ) dev;
	126
	127	spin_lock_irq(&lp->lock);
	128
	129	lp->skbs[lp->in_idx++] = skb; /* add to buffer list */
	130	if (lp->in_idx >= MAX_SKB_BUFFERS)
	131	lp->in_idx = 0; /* wrap around */
	132	lp->sk_count++; /* adjust counter */
	133	dev->trans_start = jiffies;
	134
	135	/* If we just used up the very last entry in the
	136	* TX ring on this device, tell the queueing
	137	* layer to send no more.
	138	*/
	139	if (lp->sk_count >= MAX_SKB_BUFFERS)
	140	netif_stop_queue(dev);
	141
	142	/* When the TX completion hw interrupt arrives, this
	143	* is when the transmit statistics are updated.
	144	*/
	145
	146	spin_unlock_irq(&lp->lock);
	147
	148	if (lp->sk_count <= 3) {
25dd7e6a	149	schedule_work(&((hysdn_card *) dev->ml_priv)->irq_queue);
1da177e4	150	}
ec634fe3	151	return NETDEV_TX_OK; /* success */
1da177e4 LT	152	} /* net_send_packet */
	153
	154
	155
	156	/***********************************************************************/
	157	/* acknowlegde a packet send. The network layer will be informed about */
	158	/* completion */
	159	/***********************************************************************/
	160	void
	161	hysdn_tx_netack(hysdn_card * card)
	162	{
	163	struct net_local *lp = card->netif;
	164
	165	if (!lp)
	166	return; /* non existing device */
	167
	168
	169	if (!lp->sk_count)
	170	return; /* error condition */
	171
0e2445fb SH	172	lp->dev->stats.tx_packets++;
0e2445fb SH	173	lp->dev->stats.tx_bytes += lp->skbs[lp->out_idx]->len;
1da177e4 LT	174
	175	dev_kfree_skb(lp->skbs[lp->out_idx++]); /* free skb */
	176	if (lp->out_idx >= MAX_SKB_BUFFERS)
	177	lp->out_idx = 0; /* wrap around */
	178
	179	if (lp->sk_count-- == MAX_SKB_BUFFERS) /* dec usage count */
	180	netif_start_queue((struct net_device *) lp);
	181	} /* hysdn_tx_netack */
	182
	183	/*****************************************************/
	184	/* we got a packet from the network, go and queue it */
	185	/*****************************************************/
	186	void
c721bcce	187	hysdn_rx_netpkt(hysdn_card * card, unsigned char *buf, unsigned short len)
1da177e4 LT	188	{
1da177e4 LT	189	struct net_local *lp = card->netif;
d41de3c1	190	struct net_device *dev;
1da177e4 LT	191	struct sk_buff *skb;
	192
	193	if (!lp)
	194	return; /* non existing device */
	195
d41de3c1	196	dev = lp->dev;
0e2445fb	197	dev->stats.rx_bytes += len;
1da177e4 LT	198
	199	skb = dev_alloc_skb(len);
	200	if (skb == NULL) {
	201	printk(KERN_NOTICE "%s: Memory squeeze, dropping packet.\n",
0e2445fb SH	202	dev->name);
0e2445fb SH	203	dev->stats.rx_dropped++;
1da177e4 LT	204	return;
1da177e4 LT	205	}
1da177e4 LT	206	/* copy the data */
	207	memcpy(skb_put(skb, len), buf, len);
	208
	209	/* determine the used protocol */
0e2445fb	210	skb->protocol = eth_type_trans(skb, dev);
1da177e4	211
0e2445fb	212	dev->stats.rx_packets++; /* adjust packet count */
1da177e4	213
0e2445fb	214	netif_rx(skb);
1da177e4 LT	215	} /* hysdn_rx_netpkt */
	216
	217	/*****************************************************/
	218	/* return the pointer to a network packet to be send */
	219	/*****************************************************/
	220	struct sk_buff *
	221	hysdn_tx_netget(hysdn_card * card)
	222	{
	223	struct net_local *lp = card->netif;
	224
	225	if (!lp)
	226	return (NULL); /* non existing device */
	227
	228	if (!lp->sk_count)
	229	return (NULL); /* nothing available */
	230
	231	return (lp->skbs[lp->out_idx]); /* next packet to send */
	232	} /* hysdn_tx_netget */
	233
0e2445fb SH	234	static const struct net_device_ops hysdn_netdev_ops = {
	235	.ndo_open = net_open,
	236	.ndo_stop = net_close,
	237	.ndo_start_xmit = net_send_packet,
	238	.ndo_change_mtu = eth_change_mtu,
	239	.ndo_set_mac_address = eth_mac_addr,
	240	.ndo_validate_addr = eth_validate_addr,
	241	};
1da177e4	242
1da177e4 LT	243
	244	/*****************************************************************************/
	245	/* hysdn_net_create creates a new net device for the given card. If a device */
	246	/* already exists, it will be deleted and created a new one. The return value */
	247	/* 0 announces success, else a negative error code will be returned. */
	248	/*****************************************************************************/
	249	int
	250	hysdn_net_create(hysdn_card * card)
	251	{
	252	struct net_device *dev;
	253	int i;
0e2445fb SH	254	struct net_local *lp;
0e2445fb SH	255
1da177e4 LT	256	if(!card) {
	257	printk(KERN_WARNING "No card-pt in hysdn_net_create!\n");
	258	return (-ENOMEM);
	259	}
	260	hysdn_net_release(card); /* release an existing net device */
0e2445fb SH	261
	262	dev = alloc_etherdev(sizeof(struct net_local));
	263	if (!dev) {
1da177e4 LT	264	printk(KERN_WARNING "HYSDN: unable to allocate mem\n");
	265	return (-ENOMEM);
	266	}
1da177e4	267
0e2445fb SH	268	lp = netdev_priv(dev);
	269	lp->dev = dev;
	270
	271	dev->netdev_ops = &hysdn_netdev_ops;
1da177e4 LT	272	spin_lock_init(&((struct net_local *) dev)->lock);
	273
	274	/* initialise necessary or informing fields */
	275	dev->base_addr = card->iobase; /* IO address */
	276	dev->irq = card->irq; /* irq */
0e2445fb SH	277
0e2445fb SH	278	dev->netdev_ops = &hysdn_netdev_ops;
1da177e4 LT	279	if ((i = register_netdev(dev))) {
1da177e4 LT	280	printk(KERN_WARNING "HYSDN: unable to create network device\n");
0e2445fb	281	free_netdev(dev);
1da177e4 LT	282	return (i);
1da177e4 LT	283	}
25dd7e6a	284	dev->ml_priv = card; /* remember pointer to own data structure */
1da177e4 LT	285	card->netif = dev; /* setup the local pointer */
	286
	287	if (card->debug_flags & LOG_NET_INIT)
	288	hysdn_addlog(card, "network device created");
	289	return (0); /* and return success */
	290	} /* hysdn_net_create */
	291
	292	/***************************************************************************/
	293	/* hysdn_net_release deletes the net device for the given card. The return */
	294	/* value 0 announces success, else a negative error code will be returned. */
	295	/***************************************************************************/
	296	int
	297	hysdn_net_release(hysdn_card * card)
	298	{
	299	struct net_device *dev = card->netif;
	300
	301	if (!dev)
	302	return (0); /* non existing */
	303
	304	card->netif = NULL; /* clear out pointer */
0e2445fb	305	net_close(dev);
1da177e4 LT	306
	307	flush_tx_buffers((struct net_local ) dev); / empty buffers */
	308
	309	unregister_netdev(dev); /* release the device */
	310	free_netdev(dev); /* release the memory allocated */
	311	if (card->debug_flags & LOG_NET_INIT)
	312	hysdn_addlog(card, "network device deleted");
	313
	314	return (0); /* always successful */
	315	} /* hysdn_net_release */
	316
	317	/*****************************************************************************/
	318	/* hysdn_net_getname returns a pointer to the name of the network interface. */
	319	/* if the interface is not existing, a "-" is returned. */
	320	/*****************************************************************************/
	321	char *
	322	hysdn_net_getname(hysdn_card * card)
	323	{
	324	struct net_device *dev = card->netif;
	325
	326	if (!dev)
	327	return ("-"); /* non existing */
	328
	329	return (dev->name);
	330	} /* hysdn_net_getname */