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#include <linux/module.h>
30#include <linux/types.h>
31#include <linux/kernel.h>
32#include <linux/string.h>
33#include <linux/mm.h>
34#include <linux/socket.h>
35#include <linux/in.h>
36#include <linux/inet.h>
37#include <linux/netdevice.h>
38#include <linux/fddidevice.h>
39#include <linux/if_ether.h>
40#include <linux/skbuff.h>
41#include <linux/errno.h>
42#include <net/arp.h>
43#include <net/sock.h>
44
45
46
47
48
49
50
51
52static int fddi_header(struct sk_buff *skb, struct net_device *dev,
53 unsigned short type,
54 const void *daddr, const void *saddr, unsigned int len)
55{
56 int hl = FDDI_K_SNAP_HLEN;
57 struct fddihdr *fddi;
58
59 if(type != ETH_P_IP && type != ETH_P_IPV6 && type != ETH_P_ARP)
60 hl=FDDI_K_8022_HLEN-3;
61 fddi = (struct fddihdr *)skb_push(skb, hl);
62 fddi->fc = FDDI_FC_K_ASYNC_LLC_DEF;
63 if(type == ETH_P_IP || type == ETH_P_IPV6 || type == ETH_P_ARP)
64 {
65 fddi->hdr.llc_snap.dsap = FDDI_EXTENDED_SAP;
66 fddi->hdr.llc_snap.ssap = FDDI_EXTENDED_SAP;
67 fddi->hdr.llc_snap.ctrl = FDDI_UI_CMD;
68 fddi->hdr.llc_snap.oui[0] = 0x00;
69 fddi->hdr.llc_snap.oui[1] = 0x00;
70 fddi->hdr.llc_snap.oui[2] = 0x00;
71 fddi->hdr.llc_snap.ethertype = htons(type);
72 }
73
74
75
76 if (saddr != NULL)
77 memcpy(fddi->saddr, saddr, dev->addr_len);
78 else
79 memcpy(fddi->saddr, dev->dev_addr, dev->addr_len);
80
81 if (daddr != NULL)
82 {
83 memcpy(fddi->daddr, daddr, dev->addr_len);
84 return hl;
85 }
86
87 return -hl;
88}
89
90
91
92
93
94
95
96
97__be16 fddi_type_trans(struct sk_buff *skb, struct net_device *dev)
98{
99 struct fddihdr *fddi = (struct fddihdr *)skb->data;
100 __be16 type;
101
102
103
104
105
106
107 skb->dev = dev;
108 skb_reset_mac_header(skb);
109
110 if(fddi->hdr.llc_8022_1.dsap==0xe0)
111 {
112 skb_pull(skb, FDDI_K_8022_HLEN-3);
113 type = htons(ETH_P_802_2);
114 }
115 else
116 {
117 skb_pull(skb, FDDI_K_SNAP_HLEN);
118 type=fddi->hdr.llc_snap.ethertype;
119 }
120
121
122
123 if (*fddi->daddr & 0x01)
124 {
125 if (memcmp(fddi->daddr, dev->broadcast, FDDI_K_ALEN) == 0)
126 skb->pkt_type = PACKET_BROADCAST;
127 else
128 skb->pkt_type = PACKET_MULTICAST;
129 }
130
131 else if (dev->flags & IFF_PROMISC)
132 {
133 if (memcmp(fddi->daddr, dev->dev_addr, FDDI_K_ALEN))
134 skb->pkt_type = PACKET_OTHERHOST;
135 }
136
137
138
139 return type;
140}
141
142EXPORT_SYMBOL(fddi_type_trans);
143
144int fddi_change_mtu(struct net_device *dev, int new_mtu)
145{
146 if ((new_mtu < FDDI_K_SNAP_HLEN) || (new_mtu > FDDI_K_SNAP_DLEN))
147 return -EINVAL;
148 dev->mtu = new_mtu;
149 return 0;
150}
151EXPORT_SYMBOL(fddi_change_mtu);
152
153static const struct header_ops fddi_header_ops = {
154 .create = fddi_header,
155};
156
157
158static void fddi_setup(struct net_device *dev)
159{
160 dev->header_ops = &fddi_header_ops;
161 dev->type = ARPHRD_FDDI;
162 dev->hard_header_len = FDDI_K_SNAP_HLEN+3;
163 dev->mtu = FDDI_K_SNAP_DLEN;
164 dev->addr_len = FDDI_K_ALEN;
165 dev->tx_queue_len = 100;
166 dev->flags = IFF_BROADCAST | IFF_MULTICAST;
167
168 memset(dev->broadcast, 0xFF, FDDI_K_ALEN);
169}
170
171
172
173
174
175
176
177
178
179
180
181
182struct net_device *alloc_fddidev(int sizeof_priv)
183{
184 return alloc_netdev(sizeof_priv, "fddi%d", NET_NAME_UNKNOWN,
185 fddi_setup);
186}
187EXPORT_SYMBOL(alloc_fddidev);
188
189MODULE_LICENSE("GPL");
190