psnap.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:3k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  * SNAP data link layer. Derived from 802.2
  3.  *
  4.  * Alan Cox <Alan.Cox@linux.org>, from the 802.2 layer by Greg Page.
  5.  * Merged in additions from Greg Page's psnap.c.
  6.  *
  7.  * This program is free software; you can redistribute it and/or
  8.  * modify it under the terms of the GNU General Public License
  9.  * as published by the Free Software Foundation; either version
  10.  * 2 of the License, or (at your option) any later version.
  11.  */
  12. #include <linux/module.h>
  13. #include <linux/netdevice.h>
  14. #include <linux/skbuff.h>
  15. #include <net/datalink.h>
  16. #include <net/p8022.h>
  17. #include <net/psnap.h>
  18. #include <linux/mm.h>
  19. #include <linux/in.h>
  20. #include <linux/init.h>
  21. static struct datalink_proto *snap_list = NULL;
  22. static struct datalink_proto *snap_dl = NULL; /* 802.2 DL for SNAP */
  23. /*
  24.  * Find a snap client by matching the 5 bytes.
  25.  */
  26. static struct datalink_proto *find_snap_client(unsigned char *desc)
  27. {
  28. struct datalink_proto *proto;
  29. for (proto = snap_list; proto != NULL && memcmp(proto->type, desc, 5) ; proto = proto->next);
  30. return proto;
  31. }
  32. /*
  33.  * A SNAP packet has arrived
  34.  */
  35. int snap_rcv(struct sk_buff *skb, struct net_device *dev, struct packet_type *pt)
  36. {
  37. static struct packet_type psnap_packet_type =
  38. {
  39. 0,
  40. NULL, /* All Devices */
  41. snap_rcv,
  42. NULL,
  43. NULL,
  44. };
  45. struct datalink_proto *proto;
  46. proto = find_snap_client(skb->h.raw);
  47. if (proto != NULL)
  48. {
  49. /*
  50.  * Pass the frame on.
  51.  */
  52. skb->h.raw += 5;
  53. skb->nh.raw += 5;
  54. skb_pull(skb,5);
  55. if (psnap_packet_type.type == 0)
  56. psnap_packet_type.type=htons(ETH_P_SNAP);
  57. return proto->rcvfunc(skb, dev, &psnap_packet_type);
  58. }
  59. skb->sk = NULL;
  60. kfree_skb(skb);
  61. return 0;
  62. }
  63. /*
  64.  * Put a SNAP header on a frame and pass to 802.2
  65.  */
  66. static void snap_datalink_header(struct datalink_proto *dl, struct sk_buff *skb, unsigned char *dest_node)
  67. {
  68. memcpy(skb_push(skb,5),dl->type,5);
  69. snap_dl->datalink_header(snap_dl, skb, dest_node);
  70. }
  71. /*
  72.  * Set up the SNAP layer
  73.  */
  74. EXPORT_SYMBOL(register_snap_client);
  75. EXPORT_SYMBOL(unregister_snap_client);
  76. static int __init snap_init(void)
  77. {
  78. snap_dl=register_8022_client(0xAA, snap_rcv);
  79. if(snap_dl==NULL)
  80. printk("SNAP - unable to register with 802.2n");
  81. return 0;
  82. }
  83. module_init(snap_init);
  84. /*
  85.  * Register SNAP clients. We don't yet use this for IP.
  86.  */
  87. struct datalink_proto *register_snap_client(unsigned char *desc, int (*rcvfunc)(struct sk_buff *, struct net_device *, struct packet_type *))
  88. {
  89. struct datalink_proto *proto;
  90. if (find_snap_client(desc) != NULL)
  91. return NULL;
  92. proto = (struct datalink_proto *) kmalloc(sizeof(*proto), GFP_ATOMIC);
  93. if (proto != NULL)
  94. {
  95. memcpy(proto->type, desc,5);
  96. proto->type_len = 5;
  97. proto->rcvfunc = rcvfunc;
  98. proto->header_length = 5+snap_dl->header_length;
  99. proto->datalink_header = snap_datalink_header;
  100. proto->string_name = "SNAP";
  101. proto->next = snap_list;
  102. snap_list = proto;
  103. }
  104. return proto;
  105. }
  106. /*
  107.  * Unregister SNAP clients. Protocols no longer want to play with us ...
  108.  */
  109. void unregister_snap_client(unsigned char *desc)
  110. {
  111. struct datalink_proto **clients = &snap_list;
  112. struct datalink_proto *tmp;
  113. unsigned long flags;
  114. save_flags(flags);
  115. cli();
  116. while ((tmp = *clients) != NULL)
  117. {
  118. if (memcmp(tmp->type,desc,5) == 0)
  119. {
  120. *clients = tmp->next;
  121. kfree(tmp);
  122. break;
  123. }
  124. else
  125. clients = &tmp->next;
  126. }
  127. restore_flags(flags);
  128. }