hysdn_net.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:11k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /* $Id: hysdn_net.c,v 1.1.4.1 2001/11/20 14:19:37 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. #define __NO_VERSION__
  16. #include <linux/module.h>
  17. #include <linux/version.h>
  18. #include <linux/signal.h>
  19. #include <linux/kernel.h>
  20. #include <linux/netdevice.h>
  21. #include <linux/etherdevice.h>
  22. #include <linux/skbuff.h>
  23. #include <linux/inetdevice.h>
  24. #include "hysdn_defs.h"
  25. unsigned int hynet_enable = 0xffffffff; 
  26. MODULE_PARM(hynet_enable, "i");
  27. /* store the actual version for log reporting */
  28. char *hysdn_net_revision = "$Revision: 1.1.4.1 $";
  29. #define MAX_SKB_BUFFERS 20 /* number of buffers for keeping TX-data */
  30. /****************************************************************************/
  31. /* structure containing the complete network data. The structure is aligned */
  32. /* in a way that both, the device and statistics are kept inside it.        */
  33. /* for proper access, the device structure MUST be the first var/struct     */
  34. /* inside the definition.                                                   */
  35. /****************************************************************************/
  36. struct net_local {
  37. struct net_device netdev; /* the network device */
  38. struct net_device_stats stats;
  39. /* additional vars may be added here */
  40. char dev_name[9]; /* our own device name */
  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.  */
  46. spinlock_t lock;
  47. struct sk_buff *skbs[MAX_SKB_BUFFERS]; /* pointers to tx-skbs */
  48. int in_idx, out_idx; /* indexes to buffer ring */
  49. int sk_count; /* number of buffers currently in ring */
  50. int is_open; /* flag controlling module locking */
  51. }; /* net_local */
  52. /*****************************************************/
  53. /* Get the current statistics for this card.         */
  54. /* This may be called with the card open or closed ! */
  55. /*****************************************************/
  56. static struct net_device_stats *
  57. net_get_stats(struct net_device *dev)
  58. {
  59. return (&((struct net_local *) dev)->stats);
  60. } /* net_device_stats */
  61. /*********************************************************************/
  62. /* Open/initialize the board. This is called (in the current kernel) */
  63. /* sometime after booting when the 'ifconfig' program is run.        */
  64. /* This routine should set everything up anew at each open, even     */
  65. /* registers that "should" only need to be set once at boot, so that */
  66. /* there is non-reboot way to recover if something goes wrong.       */
  67. /*********************************************************************/
  68. static int
  69. net_open(struct net_device *dev)
  70. {
  71. struct in_device *in_dev;
  72. hysdn_card *card = dev->priv;
  73. int i;
  74. if (!((struct net_local *) dev)->is_open)
  75. MOD_INC_USE_COUNT; /* increment only if interface is actually down */
  76. ((struct net_local *) dev)->is_open = 1; /* device actually open */
  77. netif_start_queue(dev); /* start tx-queueing */
  78. /* Fill in the MAC-level header (if not already set) */
  79. if (!card->mac_addr[0]) {
  80. for (i = 0; i < ETH_ALEN - sizeof(ulong); i++)
  81. dev->dev_addr[i] = 0xfc;
  82. if ((in_dev = dev->ip_ptr) != NULL) {
  83. struct in_ifaddr *ifa = in_dev->ifa_list;
  84. if (ifa != NULL)
  85. memcpy(dev->dev_addr + (ETH_ALEN - sizeof(ulong)), &ifa->ifa_local, sizeof(ulong));
  86. }
  87. } else
  88. memcpy(dev->dev_addr, card->mac_addr, ETH_ALEN);
  89. return (0);
  90. } /* net_open */
  91. /*******************************************/
  92. /* flush the currently occupied tx-buffers */
  93. /* must only be called when device closed  */
  94. /*******************************************/
  95. static void
  96. flush_tx_buffers(struct net_local *nl)
  97. {
  98. while (nl->sk_count) {
  99. dev_kfree_skb(nl->skbs[nl->out_idx++]); /* free skb */
  100. if (nl->out_idx >= MAX_SKB_BUFFERS)
  101. nl->out_idx = 0; /* wrap around */
  102. nl->sk_count--;
  103. }
  104. } /* flush_tx_buffers */
  105. /*********************************************************************/
  106. /* close/decativate the device. The device is not removed, but only  */
  107. /* deactivated.                                                      */
  108. /*********************************************************************/
  109. static int
  110. net_close(struct net_device *dev)
  111. {
  112. netif_stop_queue(dev); /* disable queueing */
  113. if (((struct net_local *) dev)->is_open)
  114. MOD_DEC_USE_COUNT; /* adjust module counter */
  115. ((struct net_local *) dev)->is_open = 0;
  116. flush_tx_buffers((struct net_local *) dev);
  117. return (0); /* success */
  118. } /* net_close */
  119. /************************************/
  120. /* send a packet on this interface. */
  121. /* new style for kernel >= 2.3.33   */
  122. /************************************/
  123. static int
  124. net_send_packet(struct sk_buff *skb, struct net_device *dev)
  125. {
  126. struct net_local *lp = (struct net_local *) dev;
  127. spin_lock_irq(&lp->lock);
  128. lp->skbs[lp->in_idx++] = skb; /* add to buffer list */
  129. if (lp->in_idx >= MAX_SKB_BUFFERS)
  130. lp->in_idx = 0; /* wrap around */
  131. lp->sk_count++; /* adjust counter */
  132. dev->trans_start = jiffies;
  133. /* If we just used up the very last entry in the
  134.  * TX ring on this device, tell the queueing
  135.  * layer to send no more.
  136.  */
  137. if (lp->sk_count >= MAX_SKB_BUFFERS)
  138. netif_stop_queue(dev);
  139. /* When the TX completion hw interrupt arrives, this
  140.  * is when the transmit statistics are updated.
  141.  */
  142. spin_unlock_irq(&lp->lock);
  143. if (lp->sk_count <= 3) {
  144. queue_task(&((hysdn_card *) dev->priv)->irq_queue, &tq_immediate);
  145. mark_bh(IMMEDIATE_BH);
  146. }
  147. return (0); /* success */
  148. } /* net_send_packet */
  149. /***********************************************************************/
  150. /* acknowlegde a packet send. The network layer will be informed about */
  151. /* completion                                                          */
  152. /***********************************************************************/
  153. void
  154. hysdn_tx_netack(hysdn_card * card)
  155. {
  156. struct net_local *lp = card->netif;
  157. if (!lp)
  158. return; /* non existing device */
  159. if (!lp->sk_count)
  160. return; /* error condition */
  161. lp->stats.tx_packets++;
  162. lp->stats.tx_bytes += lp->skbs[lp->out_idx]->len;
  163. dev_kfree_skb(lp->skbs[lp->out_idx++]); /* free skb */
  164. if (lp->out_idx >= MAX_SKB_BUFFERS)
  165. lp->out_idx = 0; /* wrap around */
  166. if (lp->sk_count-- == MAX_SKB_BUFFERS) /* dec usage count */
  167. netif_start_queue((struct net_device *) lp);
  168. } /* hysdn_tx_netack */
  169. /*****************************************************/
  170. /* we got a packet from the network, go and queue it */
  171. /*****************************************************/
  172. void
  173. hysdn_rx_netpkt(hysdn_card * card, uchar * buf, word len)
  174. {
  175. struct net_local *lp = card->netif;
  176. struct sk_buff *skb;
  177. if (!lp)
  178. return; /* non existing device */
  179. lp->stats.rx_bytes += len;
  180. skb = dev_alloc_skb(len);
  181. if (skb == NULL) {
  182. printk(KERN_NOTICE "%s: Memory squeeze, dropping packet.n",
  183.        lp->netdev.name);
  184. lp->stats.rx_dropped++;
  185. return;
  186. }
  187. skb->dev = &lp->netdev;
  188. /* copy the data */
  189. memcpy(skb_put(skb, len), buf, len);
  190. /* determine the used protocol */
  191. skb->protocol = eth_type_trans(skb, &lp->netdev);
  192. netif_rx(skb);
  193. lp->stats.rx_packets++; /* adjust packet count */
  194. } /* hysdn_rx_netpkt */
  195. /*****************************************************/
  196. /* return the pointer to a network packet to be send */
  197. /*****************************************************/
  198. struct sk_buff *
  199. hysdn_tx_netget(hysdn_card * card)
  200. {
  201. struct net_local *lp = card->netif;
  202. if (!lp)
  203. return (NULL); /* non existing device */
  204. if (!lp->sk_count)
  205. return (NULL); /* nothing available */
  206. return (lp->skbs[lp->out_idx]); /* next packet to send */
  207. } /* hysdn_tx_netget */
  208. /*******************************************/
  209. /* init function called by register device */
  210. /*******************************************/
  211. static int
  212. net_init(struct net_device *dev)
  213. {
  214. /* setup the function table */
  215. dev->open = net_open;
  216. dev->stop = net_close;
  217. dev->hard_start_xmit = net_send_packet;
  218. dev->get_stats = net_get_stats;
  219. /* Fill in the fields of the device structure with ethernet values. */
  220. ether_setup(dev);
  221. return (0); /* success */
  222. } /* net_init */
  223. /*****************************************************************************/
  224. /* hysdn_net_create creates a new net device for the given card. If a device */
  225. /* already exists, it will be deleted and created a new one. The return value */
  226. /* 0 announces success, else a negative error code will be returned.         */
  227. /*****************************************************************************/
  228. int
  229. hysdn_net_create(hysdn_card * card)
  230. {
  231. struct net_device *dev;
  232. int i;
  233. if(!card) {
  234. printk(KERN_WARNING "No card-pt in hysdn_net_create!n");
  235. return (-ENOMEM);
  236. }
  237. hysdn_net_release(card); /* release an existing net device */
  238. if ((dev = kmalloc(sizeof(struct net_local), GFP_KERNEL)) == NULL) {
  239. printk(KERN_WARNING "HYSDN: unable to allocate memn");
  240. return (-ENOMEM);
  241. }
  242. memset(dev, 0, sizeof(struct net_local)); /* clean the structure */
  243. spin_lock_init(&((struct net_local *) dev)->lock);
  244. /* initialise necessary or informing fields */
  245. dev->base_addr = card->iobase; /* IO address */
  246. dev->irq = card->irq; /* irq */
  247. dev->init = net_init; /* the init function of the device */
  248. if(dev->name) {
  249. strcpy(dev->name, ((struct net_local *) dev)->dev_name);
  250. if ((i = register_netdev(dev))) {
  251. printk(KERN_WARNING "HYSDN: unable to create network devicen");
  252. kfree(dev);
  253. return (i);
  254. }
  255. dev->priv = card; /* remember pointer to own data structure */
  256. card->netif = dev; /* setup the local pointer */
  257. if (card->debug_flags & LOG_NET_INIT)
  258. hysdn_addlog(card, "network device created");
  259. return (0); /* and return success */
  260. } /* hysdn_net_create */
  261. /***************************************************************************/
  262. /* hysdn_net_release deletes the net device for the given card. The return */
  263. /* value 0 announces success, else a negative error code will be returned. */
  264. /***************************************************************************/
  265. int
  266. hysdn_net_release(hysdn_card * card)
  267. {
  268. struct net_device *dev = card->netif;
  269. if (!dev)
  270. return (0); /* non existing */
  271. card->netif = NULL; /* clear out pointer */
  272. dev->stop(dev); /* close the device */
  273. flush_tx_buffers((struct net_local *) dev); /* empty buffers */
  274. unregister_netdev(dev); /* release the device */
  275. kfree(dev); /* release the memory allocated */
  276. if (card->debug_flags & LOG_NET_INIT)
  277. hysdn_addlog(card, "network device deleted");
  278. return (0); /* always successful */
  279. } /* hysdn_net_release */
  280. /*****************************************************************************/
  281. /* hysdn_net_getname returns a pointer to the name of the network interface. */
  282. /* if the interface is not existing, a "-" is returned.                      */
  283. /*****************************************************************************/
  284. char *
  285. hysdn_net_getname(hysdn_card * card)
  286. {
  287. struct net_device *dev = card->netif;
  288. if (!dev)
  289. return ("-"); /* non existing */
  290. return (dev->name);
  291. } /* hysdn_net_getname */