Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 | #include <linux/module.h> #include <linux/netdevice.h> #include <linux/skbuff.h> #include <net/datalink.h> #include <linux/mm.h> #include <linux/in.h> #include <net/p8022.h> static struct datalink_proto *p8022_list = NULL; /* * We don't handle the loopback SAP stuff, the extended * 802.2 command set, multicast SAP identifiers and non UI * frames. We have the absolute minimum needed for IPX, * IP and Appletalk phase 2. */ static struct datalink_proto * find_8022_client(unsigned char type) { struct datalink_proto *proto; for (proto = p8022_list; ((proto != NULL) && (*(proto->type) != type)); proto = proto->next) ; return proto; } int p8022_rcv(struct sk_buff *skb, struct device *dev, struct packet_type *pt) { struct datalink_proto *proto; proto = find_8022_client(*(skb->h.raw)); if (proto != NULL) { skb->h.raw += 3; skb_pull(skb,3); return proto->rcvfunc(skb, dev, pt); } skb->sk = NULL; kfree_skb(skb, FREE_READ); return 0; } static void p8022_datalink_header(struct datalink_proto *dl, struct sk_buff *skb, unsigned char *dest_node) { struct device *dev = skb->dev; unsigned char *rawp; rawp = skb_push(skb,3); *rawp++ = dl->type[0]; *rawp++ = dl->type[0]; *rawp = 0x03; /* UI */ dev->hard_header(skb, dev, ETH_P_802_3, dest_node, NULL, skb->len); } static struct packet_type p8022_packet_type = { 0, /* MUTTER ntohs(ETH_P_8022),*/ NULL, /* All devices */ p8022_rcv, NULL, NULL, }; static struct symbol_table p8022_proto_syms = { #include <linux/symtab_begin.h> X(register_8022_client), X(unregister_8022_client), #include <linux/symtab_end.h> }; void p8022_proto_init(struct net_proto *pro) { p8022_packet_type.type=htons(ETH_P_802_2); dev_add_pack(&p8022_packet_type); register_symtab(&p8022_proto_syms); } struct datalink_proto * register_8022_client(unsigned char type, int (*rcvfunc)(struct sk_buff *, struct device *, struct packet_type *)) { struct datalink_proto *proto; if (find_8022_client(type) != NULL) return NULL; proto = (struct datalink_proto *) kmalloc(sizeof(*proto), GFP_ATOMIC); if (proto != NULL) { proto->type[0] = type; proto->type_len = 1; proto->rcvfunc = rcvfunc; proto->header_length = 3; proto->datalink_header = p8022_datalink_header; proto->string_name = "802.2"; proto->next = p8022_list; p8022_list = proto; } return proto; } void unregister_8022_client(unsigned char type) { struct datalink_proto *tmp, **clients = &p8022_list; unsigned long flags; save_flags(flags); cli(); while ((tmp = *clients) != NULL) { if (tmp->type[0] == type) { *clients = tmp->next; kfree_s(tmp, sizeof(struct datalink_proto)); break; } else { clients = &tmp->next; } } restore_flags(flags); } |