]>
Commit | Line | Data |
---|---|---|
32f09511 PG |
1 | diff -u -r -N -X /home/greear/exclude.list linux/include/linux/if_ether.h linux.dev/include/linux/if_ether.h |
2 | --- linux/include/linux/if_ether.h Sun Dec 10 17:49:44 2000 | |
3 | +++ linux.dev/include/linux/if_ether.h Thu Jan 4 20:41:19 2001 | |
4 | @@ -32,6 +32,36 @@ | |
5 | #define ETH_DATA_LEN 1500 /* Max. octets in payload */ | |
6 | #define ETH_FRAME_LEN 1514 /* Max. octets in frame sans FCS */ | |
7 | ||
8 | + | |
9 | +#ifdef CONFIG_VLAN_802_1Q | |
10 | + | |
11 | + | |
12 | +#define VLAN_ETH_ALEN 6 /* Octets in one ethernet addr */ | |
13 | +#define VLAN_ETH_HLEN 18 /* Total octets in header. */ | |
14 | +#define VLAN_ETH_ZLEN 64 /* Min. octets in frame sans FCS */ | |
15 | + | |
16 | +/* These could be bumped up by 4, but I'm not sure if all the underlying | |
17 | + * drivers would like it. | |
18 | + * UPDATE: Bumping it by 4, as per Klika's suggestion below. --BLG | |
19 | + * | |
20 | + * According to 802.3ac, the packet can be 4 bytes longer. --Klika Jan | |
21 | + */ | |
22 | +#define VLAN_ETH_DATA_LEN 1500 /* Max. octets in payload */ | |
23 | +#define VLAN_ETH_FRAME_LEN 1518 /* Max. octets in frame sans FCS */ | |
24 | + | |
25 | +struct vlan_ethhdr | |
26 | +{ | |
27 | + unsigned char h_dest[ETH_ALEN]; /* destination eth addr */ | |
28 | + unsigned char h_source[ETH_ALEN]; /* source ether addr */ | |
29 | + unsigned short h_vlan_proto; /* Should always be 0x8100 */ | |
30 | + unsigned short h_vlan_TCI; /* Encapsulates priority and VLAN ID */ | |
31 | + unsigned short h_vlan_encapsulated_proto; /* packet type ID field (or len) */ | |
32 | +}; | |
33 | + | |
34 | + | |
35 | +#endif | |
36 | + | |
37 | + | |
38 | /* | |
39 | * These are the defined Ethernet Protocol ID's. | |
40 | */ | |
41 | @@ -54,6 +84,7 @@ | |
42 | #define ETH_P_RARP 0x8035 /* Reverse Addr Res packet */ | |
43 | #define ETH_P_ATALK 0x809B /* Appletalk DDP */ | |
44 | #define ETH_P_AARP 0x80F3 /* Appletalk AARP */ | |
45 | +#define ETH_P_802_1Q 0x8100 /* 802.1Q VLAN Extended Header */ | |
46 | #define ETH_P_IPX 0x8137 /* IPX over DIX */ | |
47 | #define ETH_P_IPV6 0x86DD /* IPv6 over bluebook */ | |
48 | #define ETH_P_ATMMPOA 0x884c /* MultiProtocol Over ATM */ | |
49 | diff -u -r -N -X /home/greear/exclude.list linux/include/linux/if_vlan.h linux.dev/include/linux/if_vlan.h | |
50 | --- linux/include/linux/if_vlan.h Wed Dec 31 17:00:00 1969 | |
51 | +++ linux.dev/include/linux/if_vlan.h Sun Jan 14 14:30:56 2001 | |
52 | @@ -0,0 +1,238 @@ | |
53 | +/* -*- linux-c -*- | |
54 | + * VLAN An implementation of 802.1Q VLAN tagging. | |
55 | + * | |
56 | + * Version: 0.0.1 03/06/99 | |
57 | + * | |
58 | + * Authors: Ben Greear <greearb@candelatech.com> | |
59 | + * | |
60 | + * This program is free software; you can redistribute it and/or | |
61 | + * modify it under the terms of the GNU General Public License | |
62 | + * as published by the Free Software Foundation; either version | |
63 | + * 2 of the License, or (at your option) any later version. | |
64 | + * | |
65 | + */ | |
66 | + | |
67 | +#ifndef _LINUX_IF_VLAN_H_ | |
68 | +#define _LINUX_IF_VLAN_H_ | |
69 | + | |
70 | +#ifdef __KERNEL__ | |
71 | + | |
72 | + | |
73 | +/* externally defined structs */ | |
74 | +struct vlan_group; | |
75 | +struct device; | |
76 | +struct sk_buff; | |
77 | +struct packet_type; | |
78 | +struct vlan_collection; | |
79 | + | |
80 | + | |
81 | +#include <linux/proc_fs.h> /* for proc_dir_entry */ | |
82 | + | |
83 | + | |
84 | + | |
85 | +/* Find a VLAN device by the MAC address of it's Ethernet device, and | |
86 | + * it's VLAN ID. The default configuration is to have VLAN's scope | |
87 | + * to be box-wide, so the MAC will be ignored. The mac will only be | |
88 | + * looked at if we are configured to have a seperate set of VLANs per | |
89 | + * each MAC addressable interface. Note that this latter option does | |
90 | + * NOT follow the spec for VLANs, but may be useful for doing very | |
91 | + * large quantities of VLAN MUX/DEMUX onto FrameRelay or ATM PVCs. | |
92 | + */ | |
93 | +struct device *find_802_1Q_vlan_dev(struct device* real_dev, | |
94 | + unsigned short VID); /* vlan.c */ | |
95 | + | |
96 | + | |
97 | +int register_netdevice(struct device *dev); /* found in dev.c */ | |
98 | +int unregister_netdevice(struct device *dev); /* found in dev.c */ | |
99 | +int dev_new_index(void); /* dev.c */ | |
100 | + | |
101 | +/* found in vlan_dev.c */ | |
102 | +struct net_device_stats* vlan_dev_get_stats(struct device* dev); | |
103 | +int vlan_dev_rebuild_header(struct sk_buff *skb); | |
104 | +int vlan_dev_type_trans(struct sk_buff *skb, struct device *dev, | |
105 | + struct packet_type* ptype); | |
106 | +int vlan_dev_hard_header(struct sk_buff *skb, struct device *dev, | |
107 | + unsigned short type, void *daddr, void *saddr, | |
108 | + unsigned len); | |
109 | +int vlan_dev_hard_start_xmit(struct sk_buff *skb, struct device *dev); | |
110 | +int vlan_dev_change_mtu(struct device *dev, int new_mtu); | |
111 | +int vlan_dev_set_mac_address(struct device *dev, void* addr); | |
112 | +int vlan_dev_open(struct device* dev); | |
113 | +int vlan_dev_stop(struct device* dev); | |
114 | +int vlan_dev_init(struct device* dev); | |
115 | +void vlan_dev_destruct(struct device* dev); | |
116 | +int vlan_dev_set_vlan_flag(char* dev_name, __u32 flag, short flag_val); | |
117 | +/* I'm ignorant of these right now. --BLG | |
118 | +int vlan_dev_header_cache(struct neighbour *neigh, struct hh_cache *hh); | |
119 | +void vlan_dev_header_cache_update(struct hh_cache *hh, struct device *dev, | |
120 | + unsigned char * haddr); | |
121 | +*/ | |
122 | +void vlan_dev_copy_and_sum(struct sk_buff *dest, unsigned char *src, | |
123 | + int length, int base); | |
124 | +int vlan_dev_set_ingress_priority(char* dev_name, __u32 skb_prio, short vlan_prio); | |
125 | +int vlan_dev_set_egress_priority(char* dev_name, __u32 skb_prio, short vlan_prio); | |
126 | + | |
127 | +/* VLAN multicast stuff */ | |
128 | +/* Delete all of the MC list entries from this vlan device. Also deals | |
129 | + * with the underlying device... | |
130 | + */ | |
131 | +void vlan_flush_mc_list(struct device* dev); | |
132 | +/* copy the mc_list into the vlan_info structure. */ | |
133 | +void vlan_copy_mc_list(struct dev_mc_list* mc_list, struct vlan_dev_info* vlan_info); | |
134 | +/** dmi is a single entry into a dev_mc_list, a single node. mc_list is | |
135 | + * an entire list, and we'll iterate through it. | |
136 | + */ | |
137 | +int vlan_should_add_mc(struct dev_mc_list *dmi, struct dev_mc_list *mc_list); | |
138 | +/** Taken from Gleb + Lennert's VLAN code, and modified... */ | |
139 | +void vlan_dev_set_multicast_list(struct device *vlan_dev); | |
140 | + | |
141 | + | |
142 | +int vlan_collection_add_vlan(struct vlan_collection* vc, unsigned short vlan_id, | |
143 | + unsigned short flags); | |
144 | +int vlan_collection_remove_vlan(struct vlan_collection* vc, | |
145 | + struct device* vlan_dev); | |
146 | +int vlan_collection_remove_vlan_id(struct vlan_collection* vc, unsigned short vlan_id); | |
147 | + | |
148 | + | |
149 | + | |
150 | +/* found in vlan.c */ | |
151 | +/* Our listing of VLAN group(s) */ | |
152 | +extern struct vlan_group* p802_1Q_vlan_list; | |
153 | + | |
154 | + | |
155 | +#define VLAN_NAME "vlan" | |
156 | + | |
157 | +/* if this changes, algorithm will have to be reworked because this | |
158 | + * depends on completely exhausting the VLAN identifier space. Thus | |
159 | + * it gives constant time lookup, but it many cases it wastes memory. | |
160 | + */ | |
161 | +#define VLAN_GROUP_ARRAY_LEN 4096 | |
162 | + | |
163 | +struct vlan_group { | |
164 | + int real_dev_ifindex; /* The index of the ethernet(like?) device the vlan is attached to. */ | |
165 | + struct device* vlan_devices[VLAN_GROUP_ARRAY_LEN]; | |
166 | + | |
167 | + struct vlan_group* next; /* the next in the list */ | |
168 | +}; | |
169 | + | |
170 | + | |
171 | +/* __Flags__ relating to the vlan ports */ | |
172 | +#define VLAN_FLAG_ALLOW_802_3 1 | |
173 | +#define VLAN_FLAG_ALLOW_802_1Q 2 | |
174 | +#define VLAN_FLAG_IS_IN_USE 4 | |
175 | + | |
176 | + | |
177 | +struct vlan_priority_tci_mapping { | |
178 | + unsigned long priority; | |
179 | + unsigned short vlan_qos; /* This should be shifted when first set, so we only do it | |
180 | + * at provisioning time. | |
181 | + * ((skb->priority << 13) & 0xE000) | |
182 | + */ | |
183 | + struct vlan_priority_tci_mapping* next; | |
184 | +}; | |
185 | + | |
186 | +/* Holds information that makes sense if this device is a VLAN device. */ | |
187 | +struct vlan_dev_info { | |
188 | + /** This will be the mapping that correlates skb->priority to | |
189 | + * 3 bits of VLAN QOS tags... | |
190 | + */ | |
191 | + unsigned long ingress_priority_map[8]; | |
192 | + struct vlan_priority_tci_mapping* egress_priority_map[16]; /* hash table */ | |
193 | + | |
194 | + unsigned short vlan_id; /* The VLAN Identifier for this interface. */ | |
195 | + unsigned short flags; /* (1 << 0) re_order_header This option will cause the | |
196 | + * VLAN code to move around the ethernet header on | |
197 | + * ingress to make the skb look **exactly** like it | |
198 | + * came in from an ethernet port. This destroys some of | |
199 | + * the VLAN information in the skb, but it fixes programs | |
200 | + * like DHCP that use packet-filtering and don't understand | |
201 | + * 802.1Q | |
202 | + */ | |
203 | + struct dev_mc_list* old_mc_list; /* old multi-cast list for the VLAN interface.. | |
204 | + * we save this so we can tell what changes were | |
205 | + * made, in order to feed the right changes down | |
206 | + * to the real hardware... | |
207 | + */ | |
208 | + int old_allmulti; /* similar to above. */ | |
209 | + int old_promiscuity; /* similar to above. */ | |
210 | + struct device* real_dev; /* the underlying device/interface */ | |
211 | + struct proc_dir_entry dent; /* Holds the proc data */ | |
212 | + unsigned long cnt_inc_headroom_on_tx; /* How many times did we have to grow the skb on TX. */ | |
213 | + unsigned long cnt_encap_on_xmit; /* How many times did we have to encapsulate the skb on TX. */ | |
214 | +}; | |
215 | + | |
216 | +static inline unsigned short vlan_dev_get_egress_qos_mask(struct device* dev, struct sk_buff* skb) { | |
217 | + struct vlan_priority_tci_mapping* mp = dev->vlan_dev->egress_priority_map[(skb->priority & 0xF)]; | |
218 | + while (mp) { | |
219 | + if (mp->priority == skb->priority) { | |
220 | + return mp->vlan_qos; /* This should already be shifted to mask correctly with | |
221 | + * the VLAN's TCI | |
222 | + */ | |
223 | + } | |
224 | + mp = mp->next; | |
225 | + } | |
226 | + return 0; | |
227 | +} | |
228 | + | |
229 | +static inline int vlan_dmi_equals(struct dev_mc_list *dmi1, | |
230 | + struct dev_mc_list *dmi2) { | |
231 | + return ((dmi1->dmi_addrlen == dmi2->dmi_addrlen) && | |
232 | + (memcmp(dmi1->dmi_addr, dmi2->dmi_addr, dmi1->dmi_addrlen) == 0)); | |
233 | +} | |
234 | + | |
235 | +static inline void vlan_destroy_mc_list(struct dev_mc_list *mc_list) { | |
236 | + struct dev_mc_list *dmi = mc_list, *next; | |
237 | + | |
238 | + while(dmi) { | |
239 | + next = dmi->next; | |
240 | + kfree(dmi); | |
241 | + dmi = next; | |
242 | + } | |
243 | +} | |
244 | + | |
245 | +#endif /* __KERNEL__ */ | |
246 | + | |
247 | +/** These are the IOCTLs relating to the /proc/net/vlan/ * files. | |
248 | + * Not all may be supported at this time, and some may be primarily | |
249 | + * used for testing and obtaining non-standard access to kernel | |
250 | + * devices. | |
251 | + */ | |
252 | + | |
253 | +#define VLAN_IOCTL 0x52 /* TODO: Can I just make these up??? */ | |
254 | + | |
255 | +enum vlan_ioctls { | |
256 | + ADD_VLAN_IOCTL = (VLAN_IOCTL << 8), | |
257 | + DEL_VLAN_IOCTL, | |
258 | + SET_INGRESS_PRIORITY_IOCTL, | |
259 | + SET_EGRESS_PRIORITY_IOCTL, | |
260 | + GET_INGRESS_PRIORITY_IOCTL, | |
261 | + GET_EGRESS_PRIORITY_IOCTL, | |
262 | + SET_NAME_TYPE_IOCTL, | |
263 | + SET_VLAN_FLAG_IOCTL | |
264 | +}; /* vlan_ioctl enum */ | |
265 | + | |
266 | +enum vlan_name_types { | |
267 | + VLAN_NAME_TYPE_PLUS_VID, /* Name will look like: vlan0005 */ | |
268 | + VLAN_NAME_TYPE_RAW_PLUS_VID, /* name will look like: eth1.0005 */ | |
269 | + VLAN_NAME_TYPE_PLUS_VID_NO_PAD, /* Name will look like: vlan5 */ | |
270 | + VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD, /* Name will look like: eth0.5 */ | |
271 | + VLAN_NAME_TYPE_HIGHEST | |
272 | +}; | |
273 | + | |
274 | +struct vlan_ioctl_args { | |
275 | + char dev1[24]; | |
276 | + | |
277 | + union { | |
278 | + char dev2[24]; | |
279 | + int VID; | |
280 | + unsigned long skb_priority; | |
281 | + unsigned long name_type; | |
282 | + unsigned long bind_type; | |
283 | + unsigned long flag; /* Matches vlan_dev_info flags */ | |
284 | + } u; | |
285 | + | |
286 | + short vlan_qos; /* Can also be flag-value, 1 to set, 0 to clear. */ | |
287 | +}; | |
288 | + | |
289 | + | |
290 | +#endif | |
291 | diff -u -r -N -X /home/greear/exclude.list linux/include/linux/netdevice.h linux.dev/include/linux/netdevice.h | |
292 | --- linux/include/linux/netdevice.h Sun Dec 31 14:36:46 2000 | |
293 | +++ linux.dev/include/linux/netdevice.h Sun Jan 14 14:23:12 2001 | |
294 | @@ -37,8 +37,15 @@ | |
295 | #ifdef CONFIG_NET_PROFILE | |
296 | #include <net/profile.h> | |
297 | #endif | |
298 | + | |
299 | +#if (defined(CONFIG_VLAN_802_1Q)) | |
300 | +struct vlan_dev_info; | |
301 | +#endif | |
302 | + | |
303 | #endif | |
304 | ||
305 | + | |
306 | + | |
307 | struct divert_blk; | |
308 | ||
309 | /* | |
310 | @@ -53,7 +60,11 @@ | |
311 | */ | |
312 | ||
313 | #if !defined(CONFIG_AX25) && !defined(CONFIG_AX25_MODULE) && !defined(CONFIG_TR) | |
314 | +#if defined(CONFIG_VLAN_802_1Q) | |
315 | +#define LL_MAX_HEADER 36 | |
316 | +#else | |
317 | #define LL_MAX_HEADER 32 | |
318 | +#endif | |
319 | #else | |
320 | #if defined(CONFIG_AX25) || defined(CONFIG_AX25_MODULE) | |
321 | #define LL_MAX_HEADER 96 | |
322 | @@ -155,11 +166,19 @@ | |
323 | { | |
324 | struct hh_cache *hh_next; /* Next entry */ | |
325 | atomic_t hh_refcnt; /* number of users */ | |
326 | - unsigned short hh_type; /* protocol identifier, f.e ETH_P_IP */ | |
327 | + unsigned short hh_type; /* protocol identifier, f.e ETH_P_IP | |
328 | + * NOTE: For VLANs, this will be the | |
329 | + * encapuslated type. --BLG | |
330 | + */ | |
331 | int (*hh_output)(struct sk_buff *skb); | |
332 | rwlock_t hh_lock; | |
333 | + | |
334 | /* cached hardware header; allow for machine alignment needs. */ | |
335 | - unsigned long hh_data[16/sizeof(unsigned long)]; | |
336 | +#ifdef CONFIG_VLAN_802_1Q /* we need 4 extra bytes for VLAN headers */ | |
337 | + unsigned long hh_data[20/sizeof(unsigned long)]; | |
338 | +#else | |
339 | + unsigned long hh_data[16/sizeof(unsigned long)]; | |
340 | +#endif | |
341 | }; | |
342 | ||
343 | ||
344 | @@ -317,7 +336,13 @@ | |
345 | int tx_semaphore; | |
346 | #define NETDEV_FASTROUTE_HMASK 0xF | |
347 | /* Semi-private data. Keep it at the end of device struct. */ | |
348 | + | |
349 | struct dst_entry *fastpath[NETDEV_FASTROUTE_HMASK+1]; | |
350 | +#endif | |
351 | + | |
352 | +#ifdef CONFIG_VLAN_802_1Q | |
353 | + /* Holds information that makes sense if this device is a VLAN device. */ | |
354 | + struct vlan_dev_info* vlan_dev; | |
355 | #endif | |
356 | ||
357 | #ifdef CONFIG_NET_DIVERT | |
358 | diff -u -r -N -X /home/greear/exclude.list linux/net/802_1Q/Makefile linux.dev/net/802_1Q/Makefile | |
359 | --- linux/net/802_1Q/Makefile Wed Dec 31 17:00:00 1969 | |
360 | +++ linux.dev/net/802_1Q/Makefile Fri Dec 29 19:51:33 2000 | |
361 | @@ -0,0 +1,26 @@ | |
362 | +# | |
363 | +# Makefile for the Linux Ethernet layer. | |
364 | +# | |
365 | +# Note! Dependencies are done automagically by 'make dep', which also | |
366 | +# removes any old dependencies. DON'T put your own dependencies here | |
367 | +# unless it's something special (ie not a .c file). | |
368 | +# | |
369 | +# Note 2! The CFLAGS definition is now in the main makefile... | |
370 | + | |
371 | +O_TARGET := 802_1Q.o | |
372 | + | |
373 | +OBJS := vlan.o vlanproc.o vlan_dev.o | |
374 | + | |
375 | +ifeq ($(CONFIG_SYSCTL),y) | |
376 | +OBJS += sysctl_net_vlan.o | |
377 | +endif | |
378 | + | |
379 | + | |
380 | +ifdef CONFIG_NET | |
381 | +O_OBJS := $(OBJS) $(OBJ2) | |
382 | +endif | |
383 | + | |
384 | +include $(TOPDIR)/Rules.make | |
385 | + | |
386 | +tar: | |
387 | + tar -cvf /dev/f1 . | |
388 | diff -u -r -N -X /home/greear/exclude.list linux/net/802_1Q/sysctl_net_vlan.c linux.dev/net/802_1Q/sysctl_net_vlan.c | |
389 | --- linux/net/802_1Q/sysctl_net_vlan.c Wed Dec 31 17:00:00 1969 | |
390 | +++ linux.dev/net/802_1Q/sysctl_net_vlan.c Fri Dec 29 19:51:33 2000 | |
391 | @@ -0,0 +1,18 @@ | |
392 | +/* | |
393 | + * sysctl_net_vlan.c: sysctl interface to net Ethernet VLAN subsystem. | |
394 | + * | |
395 | + * Begun Dec 20, 1998, Ben Greear | |
396 | + * | |
397 | + * TODO: What, if anything, should this do?? | |
398 | + */ | |
399 | + | |
400 | +#ifdef CONFIG_VLAN_802_1Q | |
401 | + | |
402 | +#include <linux/mm.h> | |
403 | +#include <linux/sysctl.h> | |
404 | + | |
405 | +ctl_table ether_vlan_table[] = { | |
406 | + {0} | |
407 | +}; | |
408 | + | |
409 | +#endif | |
410 | diff -u -r -N -X /home/greear/exclude.list linux/net/802_1Q/vlan.c linux.dev/net/802_1Q/vlan.c | |
411 | --- linux/net/802_1Q/vlan.c Wed Dec 31 17:00:00 1969 | |
412 | +++ linux.dev/net/802_1Q/vlan.c Sun Jan 14 14:55:46 2001 | |
413 | @@ -0,0 +1,447 @@ | |
414 | +/* -*- linux-c -*- | |
415 | + * INET An implementation of the TCP/IP protocol suite for the LINUX | |
416 | + * operating system. INET is implemented using the BSD Socket | |
417 | + * interface as the means of communication with the user level. | |
418 | + * | |
419 | + * Ethernet-type device handling. | |
420 | + * | |
421 | + * Version: @(#)vlan.c started 12/21/98 | |
422 | + * | |
423 | + * Authors: Ben Greear <greearb@candelatech.com>, <greearb@agcs.com> | |
424 | + * | |
425 | + * Fixes: | |
426 | + * | |
427 | + * This program is free software; you can redistribute it and/or | |
428 | + * modify it under the terms of the GNU General Public License | |
429 | + * as published by the Free Software Foundation; either version | |
430 | + * 2 of the License, or (at your option) any later version. | |
431 | + */ | |
432 | + | |
433 | +#include <asm/uaccess.h> /* for copy_from_user */ | |
434 | +#include <linux/module.h> | |
435 | +#include <linux/netdevice.h> | |
436 | +#include <linux/skbuff.h> | |
437 | +#include <net/datalink.h> | |
438 | +#include <linux/mm.h> | |
439 | +#include <linux/in.h> | |
440 | +#include <linux/init.h> | |
441 | +#include <net/p8022.h> | |
442 | +#include <net/arp.h> | |
443 | + | |
444 | +#include <linux/if_vlan.h> | |
445 | +#include "vlan.h" | |
446 | +#include "vlanproc.h" | |
447 | + | |
448 | +extern int register_netdevice(struct device *dev); /* found in dev.c */ | |
449 | +extern int unregister_netdevice(struct device *dev); /* found in dev.c */ | |
450 | +extern int dev_new_index(void); /* dev.c */ | |
451 | + | |
452 | +extern int eth_header_parse(struct sk_buff *skb, unsigned char *haddr); /* eth.c */ | |
453 | + | |
454 | +extern struct Qdisc noqueue_qdisc; | |
455 | + | |
456 | +/* Global VLAN variables */ | |
457 | + | |
458 | +/* Our listing of VLAN group(s) */ | |
459 | +struct vlan_group *p802_1Q_vlan_list = NULL; | |
460 | + | |
461 | +static char vlan_fullname[] = "802.1Q VLAN Support"; | |
462 | +static unsigned int vlan_version = 1; | |
463 | +static unsigned int vlan_release = 0; | |
464 | +static char vlan_copyright[] = "(c) 2000 Ben Greear (GPL)"; | |
465 | + | |
466 | +/** These may be changed at run-time through IOCTLs */ | |
467 | +unsigned short vlan_name_type = 0; /* determines interface naming scheme */ | |
468 | +unsigned long vlan_bad_proto_recvd = 0; /* Counter for how many NON-VLAN protos we've received on a VLAN. */ | |
469 | + | |
470 | + | |
471 | +static struct packet_type vlan_packet_type = | |
472 | +{ | |
473 | + 0, /* MUTTER ntohs(ETH_P_802_1Q),*/ | |
474 | + NULL, | |
475 | + vlan_dev_type_trans, /* VLAN receive method */ | |
476 | + NULL, | |
477 | + NULL, | |
478 | +}; | |
479 | + | |
480 | +/* End of global variables definitions. */ | |
481 | + | |
482 | +#ifdef MODULE | |
483 | + | |
484 | +/* | |
485 | + * Kernel Loadable Module Entry Points | |
486 | + * | |
487 | + * Module 'insert' entry point. | |
488 | + * o print announcement | |
489 | + * o initialize static data | |
490 | + * o create /proc/net/vlan directory and static entries | |
491 | + * | |
492 | + * Return: 0 Ok | |
493 | + * < 0 error. | |
494 | + * Context: process | |
495 | + */ | |
496 | +int init_module (void) { | |
497 | + printk(VLAN_INF __FUNCTION__); | |
498 | + | |
499 | + vlan_proto_init(NULL); | |
500 | + return 0; | |
501 | +} | |
502 | + | |
503 | +/* | |
504 | + * Module 'remove' entry point. | |
505 | + * o delete /proc/net/router directory and static entries. | |
506 | + */ | |
507 | +void cleanup_module (void) { | |
508 | + vlan_proto_cleanup(); // TODO: Define this so modules work. | |
509 | +} | |
510 | + | |
511 | +#else | |
512 | + | |
513 | + | |
514 | +/** Non-module init entry point. */ | |
515 | +__initfunc(void vlan_system_init(void)) { | |
516 | + printk(VLAN_INF __FUNCTION__); | |
517 | + | |
518 | + /* protocol initialization */ | |
519 | + vlan_proto_init(NULL); | |
520 | + | |
521 | +} | |
522 | +#endif | |
523 | + | |
524 | +/* | |
525 | + * Function vlan_proto_init (pro) | |
526 | + * | |
527 | + * Initialize VLAN protocol layer, | |
528 | + * | |
529 | + */ | |
530 | +void vlan_proto_init(struct net_proto *pro) { | |
531 | + | |
532 | + int err; | |
533 | + printk(VLAN_INF "%s v%u.%u %s\n", | |
534 | + vlan_fullname, vlan_version, vlan_release, vlan_copyright); | |
535 | + | |
536 | + /* proc file system initialization */ | |
537 | + err = vlan_proc_init(); | |
538 | + if (err < 0) { | |
539 | + printk(KERN_ERR __FUNCTION__ | |
540 | + "%s: can't create entry in proc filesystem!\n", VLAN_NAME); | |
541 | + } | |
542 | + | |
543 | + /* network byte order!! */ | |
544 | + vlan_packet_type.type = htons(ETH_P_802_1Q); | |
545 | + dev_add_pack(&vlan_packet_type); | |
546 | + printk(VLAN_INF "%s Initialization complete.\n", VLAN_NAME); | |
547 | +} | |
548 | + | |
549 | + | |
550 | + | |
551 | +/** Will search linearly for now, based on device index. Could | |
552 | + * hash, or directly link, this some day. --Ben | |
553 | + */ | |
554 | +struct vlan_group* vlan_find_group(int real_dev_ifindex) { | |
555 | + struct vlan_group* grp = NULL; | |
556 | + | |
557 | + for (grp = p802_1Q_vlan_list; | |
558 | + ((grp != NULL) && (grp->real_dev_ifindex != real_dev_ifindex)); | |
559 | + grp = grp->next) { | |
560 | +#ifdef VLAN_DEBUG | |
561 | + printk(VLAN_DBG __FUNCTION__ ": grp_idx: %i real_dev_idx: %i\n", | |
562 | + grp->real_dev_ifindex, real_dev_ifindex); | |
563 | +#endif | |
564 | + ; | |
565 | + } /* for */ | |
566 | + | |
567 | + return grp; | |
568 | +} | |
569 | + | |
570 | +/* Find the protocol handler. Assumes VID < 0xFFF. | |
571 | + */ | |
572 | +struct device *find_802_1Q_vlan_dev(struct device* real_dev, unsigned short VID) { | |
573 | + | |
574 | + struct vlan_group* grp = vlan_find_group(real_dev->ifindex); | |
575 | + | |
576 | +#ifdef VLAN_DEBUG | |
577 | + printk(VLAN_DBG __FUNCTION__ ": idx: %i grp: %p\n", real_dev->ifindex, grp); | |
578 | +#endif | |
579 | + | |
580 | + /* When here, we have found the correct group, if it exists. */ | |
581 | + | |
582 | + if (grp) { /* then we found one */ | |
583 | + return grp->vlan_devices[VID]; /* return the vlan device */ | |
584 | + }//if | |
585 | + | |
586 | + return NULL; | |
587 | +}/* find_802_1Q_vlan_dev */ | |
588 | + | |
589 | + | |
590 | + | |
591 | +int unregister_802_1Q_vlan_dev(int real_dev_ifindex, unsigned short vlan_id) { | |
592 | + struct vlan_group* grp; | |
593 | + struct device* dev = NULL; | |
594 | + | |
595 | +#ifdef VLAN_DEBUG | |
596 | + printk(VLAN_DBG __FUNCTION__ ": VID: %i\n", vlan_id); | |
597 | +#endif | |
598 | + | |
599 | + /* sanity check */ | |
600 | + if ((vlan_id >= 0xFFF) || (vlan_id <= 0)) { | |
601 | + return -EINVAL; | |
602 | + } | |
603 | + | |
604 | + grp = vlan_find_group(real_dev_ifindex); | |
605 | + /* When here, we have found the correct group, if it exists. */ | |
606 | + | |
607 | + if (grp) { | |
608 | + dev = grp->vlan_devices[vlan_id]; | |
609 | + if (dev) { | |
610 | + | |
611 | + /* Remove proc entry */ | |
612 | + vlan_proc_rem_dev(dev); | |
613 | + | |
614 | + /* take it out of our own structures */ | |
615 | + grp->vlan_devices[vlan_id] = NULL; | |
616 | + | |
617 | + /* Take it out of the global list of devices. | |
618 | + * NOTE: This deletes dev, don't access it again!! | |
619 | + */ | |
620 | + unregister_netdevice(dev); | |
621 | + | |
622 | + }/* if */ | |
623 | + }/* if */ | |
624 | + return 0; | |
625 | +}/* unregister vlan device */ | |
626 | + | |
627 | + | |
628 | + | |
629 | +int unregister_802_1Q_vlan_device(const char* vlan_IF_name) { | |
630 | + struct device* dev = NULL; | |
631 | + | |
632 | +#ifdef VLAN_DEBUG | |
633 | + printk(VLAN_DBG __FUNCTION__ ": unregister VLAN by name, name -:%s:-\n", | |
634 | + vlan_IF_name); | |
635 | +#endif | |
636 | + | |
637 | + dev = dev_get(vlan_IF_name); | |
638 | + | |
639 | + if (dev && dev->vlan_dev) { | |
640 | + return unregister_802_1Q_vlan_dev(dev->vlan_dev->real_dev->ifindex, | |
641 | + (unsigned short)(dev->vlan_dev->vlan_id)); | |
642 | + } | |
643 | + else { | |
644 | +#ifdef VLAN_DEBUG | |
645 | + printk(VLAN_DBG __FUNCTION__ ": WARNING: Could not find dev\n"); | |
646 | +#endif | |
647 | + return -EINVAL; | |
648 | + } | |
649 | +}/* unregister vlan device */ | |
650 | + | |
651 | + | |
652 | +/* | |
653 | + TODO: This for modules or something?? --BLG | |
654 | + | |
655 | + EXPORT_SYMBOL(register_802_1Q_vlan_device); | |
656 | + EXPORT_SYMBOL(unregister_802_1Q_vlan_device); | |
657 | + | |
658 | +*/ | |
659 | + | |
660 | +/* Attach a VLAN device to a mac address (ie Ethernet Card). | |
661 | + * Returns the device that was created, or NULL if there was | |
662 | + * an error of some kind. | |
663 | + */ | |
664 | +struct device *register_802_1Q_vlan_device(const char* eth_IF_name, | |
665 | + unsigned short VLAN_ID) { | |
666 | + struct vlan_group* grp; | |
667 | + struct device *new_dev; | |
668 | + struct device *real_dev; /* the ethernet device */ | |
669 | + int malloc_size = 0; | |
670 | + | |
671 | +#ifdef VLAN_DEBUG | |
672 | + printk(VLAN_DBG __FUNCTION__ ": if_name -:%s:- vid: %i\n", | |
673 | + eth_IF_name, VLAN_ID); | |
674 | +#endif | |
675 | + | |
676 | + /* find the device relating to eth_IF_name. | |
677 | + * TODO: Make sure it's an ethernet device. */ | |
678 | + real_dev = dev_get(eth_IF_name); | |
679 | + | |
680 | + if (real_dev != NULL) { | |
681 | + /* printk(KERN_ALERT "Found real_dev"); */ | |
682 | + | |
683 | + if ((VLAN_ID > 0) && (VLAN_ID < 0xFFF)) { | |
684 | + | |
685 | + /* printk(KERN_ALERT "VID is in range"); */ | |
686 | + | |
687 | + if (find_802_1Q_vlan_dev(real_dev, VLAN_ID)) { | |
688 | + /* was already registered. */ | |
689 | + printk(VLAN_DBG __FUNCTION__ ": ALREADY had VLAN registered\n"); | |
690 | + return NULL; | |
691 | + } | |
692 | + | |
693 | + malloc_size = (sizeof(struct device)); | |
694 | + | |
695 | + new_dev = (struct device*) kmalloc(malloc_size, GFP_KERNEL); | |
696 | + VLAN_MEM_DBG("device malloc, addr: %p size: %i\n", new_dev, malloc_size); | |
697 | + | |
698 | + if (new_dev != NULL) { | |
699 | + /* printk(KERN_ALERT "Got a new device.."); */ | |
700 | + | |
701 | + memset(new_dev, 0, malloc_size); /* zero everything out */ | |
702 | + | |
703 | + /* set us up to not use a Qdisc, as the underlying Hardware device | |
704 | + * can do all the queueing we could want. | |
705 | + */ | |
706 | + new_dev->qdisc_sleeping = &noqueue_qdisc; | |
707 | + | |
708 | + /* Gotta set up the fields for the device. */ | |
709 | + new_dev->name = (char*)(kmalloc(IFNAMSIZ + 1, GFP_KERNEL)); | |
710 | + VLAN_MEM_DBG("new_dev->name malloc, addr: %p size: %i\n", new_dev->name, IFNAMSIZ + 1); | |
711 | + | |
712 | + if (new_dev->name) { | |
713 | + memset(new_dev->name, 0, IFNAMSIZ + 1); /* zero everything out */ | |
714 | + } | |
715 | + else { | |
716 | + kfree(new_dev); | |
717 | + VLAN_FMEM_DBG("new_dev free, addr: %p\n", new_dev); | |
718 | + return NULL; | |
719 | + } | |
720 | + | |
721 | + if (vlan_name_type == VLAN_NAME_TYPE_RAW_PLUS_VID) { | |
722 | + /* name will look like: eth1.0005 */ | |
723 | + sprintf(new_dev->name, "%s.%.4i", real_dev->name, VLAN_ID); | |
724 | + } | |
725 | + else if (vlan_name_type == VLAN_NAME_TYPE_PLUS_VID_NO_PAD) { | |
726 | + /* Put our vlan.VID in the name. Name will look like: vlan5 */ | |
727 | + sprintf(new_dev->name, "vlan%i", VLAN_ID); | |
728 | + } | |
729 | + else if (vlan_name_type == VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD) { | |
730 | + /* Put our vlan.VID in the name. Name will look like: eth0.5 */ | |
731 | + sprintf(new_dev->name, "%s.%i", real_dev->name, VLAN_ID); | |
732 | + } | |
733 | + else { /* (vlan_name_type == VLAN_NAME_TYPE_PLUS_VID) { */ | |
734 | + /* Put our vlan.VID in the name. Name will look like: vlan0005 */ | |
735 | + /* default case */ | |
736 | + sprintf(new_dev->name, "vlan%.4i", VLAN_ID); | |
737 | + } | |
738 | + | |
739 | + | |
740 | +#ifdef VLAN_DEBUG | |
741 | + printk(VLAN_DBG "Allocated new name -:%s:-\n", new_dev->name); | |
742 | +#endif | |
743 | + /* set up method calls */ | |
744 | + new_dev->init = vlan_dev_init; | |
745 | + new_dev->destructor = vlan_dev_destruct; | |
746 | + | |
747 | + /* new_dev->ifindex = 0; it will be set when added to | |
748 | + * the global list. | |
749 | + * iflink is set as well. */ | |
750 | + | |
751 | + new_dev->get_stats = vlan_dev_get_stats; | |
752 | + | |
753 | + /* IFF_BROADCAST|IFF_MULTICAST; ??? */ | |
754 | + new_dev->flags = real_dev->flags; | |
755 | + new_dev->flags &= ~IFF_UP; | |
756 | + | |
757 | + /* need 4 bytes for extra VLAN header info, hope | |
758 | + * underlying device can handle it. */ | |
759 | + new_dev->mtu = real_dev->mtu; | |
760 | + | |
761 | + new_dev->type = real_dev->type; /* TODO: is this true? */ | |
762 | + | |
763 | + /* Regular ethernet + 4 bytes (18 total). */ | |
764 | + new_dev->hard_header_len = VLAN_ETH_HLEN; | |
765 | + | |
766 | + new_dev->priv = kmalloc(sizeof(struct net_device_stats), | |
767 | + GFP_KERNEL); | |
768 | + VLAN_MEM_DBG("new_dev->priv malloc, addr: %p size: %i\n", new_dev->priv, | |
769 | + sizeof(struct net_device_stats)); | |
770 | + | |
771 | + if (new_dev->priv) { | |
772 | + memset(new_dev->priv, 0, sizeof(struct net_device_stats)); | |
773 | + }//if | |
774 | + | |
775 | + memcpy(new_dev->broadcast, real_dev->broadcast, real_dev->addr_len); | |
776 | + memcpy(new_dev->dev_addr, real_dev->dev_addr, real_dev->addr_len); | |
777 | + new_dev->addr_len = real_dev->addr_len; | |
778 | + | |
779 | + new_dev->open = vlan_dev_open; | |
780 | + new_dev->stop = vlan_dev_stop; | |
781 | + new_dev->hard_header = vlan_dev_hard_header; | |
782 | + /*new_dev->hard_header_cache = vlan_header_cache;*/ | |
783 | + /*new_dev->header_cache_update = vlan_header_cache_update;*/ | |
784 | + new_dev->hard_start_xmit = vlan_dev_hard_start_xmit; | |
785 | + new_dev->rebuild_header = vlan_dev_rebuild_header; | |
786 | + new_dev->hard_header_parse = eth_header_parse; /* trivial. */ | |
787 | + new_dev->set_mac_address = vlan_dev_set_mac_address; | |
788 | + new_dev->set_multicast_list = vlan_dev_set_multicast_list; | |
789 | + | |
790 | + new_dev->vlan_dev = (struct vlan_dev_info*) kmalloc(sizeof(struct vlan_dev_info), | |
791 | + GFP_KERNEL); | |
792 | + VLAN_MEM_DBG("new_dev->vlan_dev malloc, addr: %p size: %i\n", new_dev->vlan_dev, | |
793 | + sizeof(struct vlan_dev_info)); | |
794 | + if (new_dev->vlan_dev == NULL) { | |
795 | + kfree(new_dev->priv); | |
796 | + VLAN_FMEM_DBG("new_dev->priv free, addr: %p\n", new_dev->priv); | |
797 | + kfree(new_dev->name); | |
798 | + VLAN_FMEM_DBG("new_dev->name free, addr: %p\n", new_dev->name); | |
799 | + kfree(new_dev); | |
800 | + VLAN_FMEM_DBG("new_dev free, addr: %p\n", new_dev); | |
801 | + return NULL; | |
802 | + } | |
803 | + else { | |
804 | + /* Initialize it. */ | |
805 | + memset(new_dev->vlan_dev, 0, sizeof(struct vlan_dev_info)); | |
806 | + | |
807 | + new_dev->vlan_dev->vlan_id = VLAN_ID; /* 1 through 0xFFF */ | |
808 | + /* TODO: have to be careful deleting real devices now. */ | |
809 | + new_dev->vlan_dev->real_dev = real_dev; | |
810 | + | |
811 | + memset(&(new_dev->vlan_dev->dent), 0, sizeof(struct proc_dir_entry)); | |
812 | + } | |
813 | + | |
814 | + /* So, got the sucker initialized, now lets place it into our local | |
815 | + * structure. | |
816 | + */ | |
817 | + | |
818 | + grp = vlan_find_group(real_dev->ifindex); | |
819 | + | |
820 | + /* When here, we have found the correct group, if it exists. */ | |
821 | + | |
822 | + if (!grp) { /* need to add a new group */ | |
823 | + /* printk(VLAN_DBG "VLAN REGISTER: " | |
824 | + "Need to add new vlan group.\n");*/ | |
825 | + | |
826 | + grp = kmalloc(sizeof(struct vlan_group), GFP_KERNEL); | |
827 | + VLAN_MEM_DBG("grp malloc, addr: %p size: %i\n", grp, sizeof(struct vlan_group)); | |
828 | + | |
829 | + if (grp) { | |
830 | + printk(KERN_ALERT "VLAN REGISTER: Allocated new group, idx: %i\n", | |
831 | + real_dev->ifindex); | |
832 | + memset(grp, 0, sizeof(struct vlan_group)); | |
833 | + grp->real_dev_ifindex = real_dev->ifindex; | |
834 | + grp->next = p802_1Q_vlan_list; | |
835 | + p802_1Q_vlan_list = grp; | |
836 | + } | |
837 | + else { | |
838 | + kfree(new_dev->name); | |
839 | + VLAN_FMEM_DBG("new_dev->name free, addr: %p\n", new_dev->name); | |
840 | + kfree(new_dev->priv); | |
841 | + VLAN_FMEM_DBG("new_dev->priv free, addr: %p\n", new_dev->priv); | |
842 | + kfree(new_dev); | |
843 | + VLAN_FMEM_DBG("new_dev free, addr: %p\n", new_dev); | |
844 | + return NULL; | |
845 | + } | |
846 | + }/* if */ | |
847 | + | |
848 | + grp->vlan_devices[VLAN_ID] = new_dev; | |
849 | + | |
850 | + /* Now, add it to the global list of devices. */ | |
851 | + /* printk(KERN_ALERT "Registering new device."); */ | |
852 | + register_netdevice(new_dev); | |
853 | + vlan_proc_add_dev(new_dev); /* create it's proc entry */ | |
854 | + return new_dev; | |
855 | + } | |
856 | + }//if | |
857 | + }//if | |
858 | + | |
859 | + return NULL; | |
860 | +}/* register (create) VLAN device */ | |
861 | diff -u -r -N -X /home/greear/exclude.list linux/net/802_1Q/vlan.h linux.dev/net/802_1Q/vlan.h | |
862 | --- linux/net/802_1Q/vlan.h Wed Dec 31 17:00:00 1969 | |
863 | +++ linux.dev/net/802_1Q/vlan.h Sun Jan 14 14:30:56 2001 | |
864 | @@ -0,0 +1,44 @@ | |
865 | +#ifndef __BEN_VLAN_802_1Q_INC__ | |
866 | +#define __BEN_VLAN_802_1Q_INC__ | |
867 | + | |
868 | +#include <linux/if_vlan.h> | |
869 | + | |
870 | +/* If this is undefined, the name will look like: vlan0005 */ | |
871 | +/* #define USE_RAW_IN_NAME Use this one if you like it: eth.0005 */ | |
872 | + | |
873 | +/* Uncomment this if you want debug traces to be shown. */ | |
874 | +/* #define VLAN_DEBUG */ | |
875 | + | |
876 | +#define VLAN_ERR KERN_ERR | |
877 | +#define VLAN_INF KERN_ALERT | |
878 | +#define VLAN_DBG KERN_DEBUG /* change these... to debug, having a hard time | |
879 | + * changing the log level at run-time..for some reason. | |
880 | + */ | |
881 | + | |
882 | +/* | |
883 | + | |
884 | +These I use for memory debugging. I feared a leak at one time, but | |
885 | +I never found it..and the problem seems to have dissappeared. Still, | |
886 | +I'll bet they might prove useful again... --Ben | |
887 | + | |
888 | +#define VLAN_MEM_DBG(x, y, z) printk(VLAN_DBG __FUNCTION__ ": " x, y, z); | |
889 | +#define VLAN_FMEM_DBG(x, y) printk(VLAN_DBG __FUNCTION__ ": " x, y); | |
890 | +*/ | |
891 | + | |
892 | +/* This way they don't do anything! */ | |
893 | +#define VLAN_MEM_DBG(x, y, z) | |
894 | +#define VLAN_FMEM_DBG(x, y) | |
895 | + | |
896 | + | |
897 | +extern unsigned short vlan_name_type; | |
898 | +extern unsigned long vlan_bad_proto_recvd; /* Counter for how many NON-VLAN protos we've received on a VLAN. */ | |
899 | + | |
900 | +/* Add some headers for the public VLAN methods. */ | |
901 | +int unregister_802_1Q_vlan_device(const char* vlan_IF_name); | |
902 | +struct device *register_802_1Q_vlan_device(const char* eth_IF_name, | |
903 | + unsigned short VID); | |
904 | + | |
905 | +void vlan_system_init(void); | |
906 | +void vlan_proto_init(struct net_proto *pro); | |
907 | + | |
908 | +#endif | |
909 | diff -u -r -N -X /home/greear/exclude.list linux/net/802_1Q/vlan_dev.c linux.dev/net/802_1Q/vlan_dev.c | |
910 | --- linux/net/802_1Q/vlan_dev.c Wed Dec 31 17:00:00 1969 | |
911 | +++ linux.dev/net/802_1Q/vlan_dev.c Sun Jan 14 19:21:08 2001 | |
912 | @@ -0,0 +1,766 @@ | |
913 | +/* -*- linux-c -*- | |
914 | + * INET An implementation of the TCP/IP protocol suite for the LINUX | |
915 | + * operating system. INET is implemented using the BSD Socket | |
916 | + * interface as the means of communication with the user level. | |
917 | + * | |
918 | + * Ethernet-type device handling. | |
919 | + * | |
920 | + * Version: @(#)vlan_dev.c Started 3/29/99 | |
921 | + * | |
922 | + * Authors: Ben Greear <greearb@candelatech.com>, <greearb@agcs.com> | |
923 | + * | |
924 | + * Fixes: | |
925 | + * | |
926 | + * This program is free software; you can redistribute it and/or | |
927 | + * modify it under the terms of the GNU General Public License | |
928 | + * as published by the Free Software Foundation; either version | |
929 | + * 2 of the License, or (at your option) any later version. | |
930 | + */ | |
931 | + | |
932 | +#include <asm/uaccess.h> /* for copy_from_user */ | |
933 | +#include <linux/module.h> | |
934 | +#include <linux/netdevice.h> | |
935 | +#include <linux/skbuff.h> | |
936 | +#include <net/datalink.h> | |
937 | +#include <linux/mm.h> | |
938 | +#include <linux/in.h> | |
939 | +#include <linux/init.h> | |
940 | +#include <net/p8022.h> | |
941 | +#include <net/arp.h> | |
942 | +#include "vlan.h" | |
943 | +#include "vlanproc.h" | |
944 | +#include <linux/if_vlan.h> | |
945 | +#include <net/ip.h> | |
946 | +#include <asm/checksum.h> | |
947 | + | |
948 | + | |
949 | +struct net_device_stats* vlan_dev_get_stats(struct device* dev) { | |
950 | + return (struct net_device_stats*)(dev->priv); | |
951 | +} | |
952 | + | |
953 | + | |
954 | +/* | |
955 | + * Rebuild the Ethernet MAC header. This is called after an ARP | |
956 | + * (or in future other address resolution) has completed on this | |
957 | + * sk_buff. We now let ARP fill in the other fields. | |
958 | + * | |
959 | + * This routine CANNOT use cached dst->neigh! | |
960 | + * Really, it is used only when dst->neigh is wrong. | |
961 | + * | |
962 | + * TODO: This needs a checkup, I'm ignorant here. --BLG | |
963 | + */ | |
964 | +int vlan_dev_rebuild_header(struct sk_buff *skb) { | |
965 | + | |
966 | + struct device *dev = skb->dev; | |
967 | + struct vlan_ethhdr *veth = (struct vlan_ethhdr*)(skb->data); | |
968 | + | |
969 | + switch (veth->h_vlan_encapsulated_proto) | |
970 | + { | |
971 | +#ifdef CONFIG_INET | |
972 | + case __constant_htons(ETH_P_IP): | |
973 | + | |
974 | + /* TODO: Confirm this will work with VLAN headers... */ | |
975 | + return arp_find(veth->h_dest, skb); | |
976 | +#endif | |
977 | + default: | |
978 | + printk(VLAN_DBG | |
979 | + "%s: unable to resolve type %X addresses.\n", | |
980 | + dev->name, (int)veth->h_vlan_encapsulated_proto); | |
981 | + | |
982 | + memcpy(veth->h_source, dev->dev_addr, ETH_ALEN); | |
983 | + break; | |
984 | + }/* switch */ | |
985 | + | |
986 | + return 0; | |
987 | +}/* vlan_dev_rebuild_header */ | |
988 | + | |
989 | + | |
990 | + | |
991 | +/* | |
992 | + * Determine the packet's protocol ID. The rule here is that we | |
993 | + * assume 802.3 if the type field is short enough to be a length. | |
994 | + * This is normal practice and works for any 'now in use' protocol. | |
995 | + * | |
996 | + * Also, at this point we assume that we ARE dealing exclusively with | |
997 | + * VLAN packets, or packets that should be made into VLAN packets based | |
998 | + * on a default VLAN ID. | |
999 | + * | |
1000 | + * NOTE: Should be similar to ethernet/eth.c. | |
1001 | + * | |
1002 | + * SANITY NOTE: This method is called when a packet is moving up the stack | |
1003 | + * towards userland. To get here, it would have already passed | |
1004 | + * through the ethernet/eth.c eth_type_trans() method. | |
1005 | + */ | |
1006 | +int vlan_dev_type_trans(struct sk_buff *skb, struct device *dev, | |
1007 | + struct packet_type* ptype) { | |
1008 | + unsigned char* rawp = NULL; | |
1009 | + struct vlan_ethhdr *veth = (struct vlan_ethhdr*)(skb->mac.ethernet); | |
1010 | + unsigned short vid = 0; | |
1011 | + struct net_device_stats* stats; | |
1012 | + | |
1013 | + /* Do we have a VLAN packet? If not, then throw it away, after printing an error. | |
1014 | + * | |
1015 | + */ | |
1016 | + if (veth->h_vlan_proto != __constant_htons(ETH_P_802_1Q)) { | |
1017 | + printk(VLAN_INF __FUNCTION__ ": VLAN device received NON-VLAN protocol: %hx\n", htons(veth->h_vlan_proto)); | |
1018 | + vlan_bad_proto_recvd++; | |
1019 | + kfree_skb(skb); | |
1020 | + return -EINVAL; | |
1021 | + } | |
1022 | + else { | |
1023 | + vid = ((unsigned short)(ntohs(veth->h_vlan_TCI)) & 0xFFF); | |
1024 | + } | |
1025 | + | |
1026 | +#ifdef VLAN_DEBUG | |
1027 | + printk(VLAN_DBG __FUNCTION__ ": skb: %p vlan_id: %hx dev: %s, encap_proto: %hx\n", | |
1028 | + skb, vid, dev->name, veth->h_vlan_encapsulated_proto); | |
1029 | +#endif | |
1030 | + | |
1031 | + /* Ok, we will find the correct VLAN device, strip the header, | |
1032 | + and then go on as usual. | |
1033 | + */ | |
1034 | + | |
1035 | + /* we have 12 bits of vlan ID. */ | |
1036 | + /* If it's NULL, we will tag the skb to be junked below */ | |
1037 | + skb->dev = find_802_1Q_vlan_dev(dev, vid); | |
1038 | + | |
1039 | + if (!skb->dev) { | |
1040 | +#ifdef VLAN_DEBUG | |
1041 | + printk(VLAN_DBG __FUNCTION__ ": ERROR: No device for VID: %i on dev: %s [%i]\n", | |
1042 | + (unsigned int)(vid), dev->name, dev->ifindex); | |
1043 | +#endif | |
1044 | + kfree_skb(skb); | |
1045 | + return -1; | |
1046 | + } | |
1047 | + | |
1048 | + stats = (struct net_device_stats*)(skb->dev->priv); | |
1049 | + | |
1050 | + /* | |
1051 | + * Deal with ingress priority mapping. | |
1052 | + */ | |
1053 | + skb->priority = skb->dev->vlan_dev->ingress_priority_map[(ntohs(veth->h_vlan_TCI) >> 13) & 0x7]; | |
1054 | + | |
1055 | +#ifdef VLAN_DEBUG | |
1056 | + printk(VLAN_DBG __FUNCTION__ ": priority: %lu for TCI: %hu (hbo) on vlan_dev: %s\n", | |
1057 | + (unsigned long)(skb->priority), ntohs(veth->h_vlan_TCI), skb->dev->name); | |
1058 | +#endif | |
1059 | + | |
1060 | + /* Bump the rx counters for the VLAN device. */ | |
1061 | + stats->rx_packets++; | |
1062 | + stats->rx_bytes += skb->len; | |
1063 | + | |
1064 | + /* NOTE: The underlying device SHOULD NOT PULL THE MAC BYTES OFF. | |
1065 | + (it doesn't seem to.) | |
1066 | + */ | |
1067 | + skb_pull(skb, VLAN_ETH_HLEN); /* take off the VLAN header */ | |
1068 | + | |
1069 | + | |
1070 | + /* VLAN and regular Ethernet headers have the addresses in the same place. | |
1071 | + * TODO: Add code to deal with VLAN control packets?? --BLG | |
1072 | + * Is there such a thing?? | |
1073 | + */ | |
1074 | + if (*(veth->h_dest) & 1) { | |
1075 | + stats->multicast++; | |
1076 | + if (memcmp(veth->h_dest, dev->broadcast, ETH_ALEN) == 0) | |
1077 | + skb->pkt_type = PACKET_BROADCAST; | |
1078 | + else | |
1079 | + skb->pkt_type = PACKET_MULTICAST; | |
1080 | + } | |
1081 | + | |
1082 | + /* | |
1083 | + * This ALLMULTI check should be redundant by 1.4 | |
1084 | + * so don't forget to remove it. | |
1085 | + * | |
1086 | + * Seems, you forgot to remove it. All silly devices | |
1087 | + * seems to set IFF_PROMISC. | |
1088 | + */ | |
1089 | + | |
1090 | + else if (dev->flags & (IFF_PROMISC/*|IFF_ALLMULTI*/)) { | |
1091 | + if (memcmp(veth->h_dest, dev->dev_addr, ETH_ALEN) != 0) | |
1092 | + skb->pkt_type = PACKET_OTHERHOST; | |
1093 | + } | |
1094 | + | |
1095 | + /* Was a VLAN packet, grab the encapsulated protocol, which the layer | |
1096 | + * three protocols care about. | |
1097 | + */ | |
1098 | + if (ntohs(veth->h_vlan_encapsulated_proto) >= 1536) { | |
1099 | + | |
1100 | + skb->protocol = veth->h_vlan_encapsulated_proto; | |
1101 | + /* place it back on the queue to be handled by true layer 3 protocols. | |
1102 | + */ | |
1103 | + | |
1104 | + /* See if we are configured to re-write the VLAN header to make it look like | |
1105 | + * ethernet... | |
1106 | + */ | |
1107 | + if (skb->dev->vlan_dev->flags & 1) { | |
1108 | + /* Lifted from Gleb's VLAN code... */ | |
1109 | + memmove(skb->data - (VLAN_ETH_HLEN - 4), skb->data - VLAN_ETH_HLEN, 12); | |
1110 | + skb->mac.raw += 4; | |
1111 | + } | |
1112 | + netif_rx(skb); | |
1113 | + return 0; | |
1114 | + } | |
1115 | + | |
1116 | + rawp = skb->data; | |
1117 | + | |
1118 | + /* | |
1119 | + * This is a magic hack to spot IPX packets. Older Novell breaks | |
1120 | + * the protocol design and runs IPX over 802.3 without an 802.2 LLC | |
1121 | + * layer. We look for FFFF which isn't a used 802.2 SSAP/DSAP. This | |
1122 | + * won't work for fault tolerant netware but does for the rest. | |
1123 | + */ | |
1124 | + if (*(unsigned short *)rawp == 0xFFFF) { | |
1125 | + skb->protocol = __constant_htons(ETH_P_802_3); | |
1126 | + /* place it back on the queue to be handled by true layer 3 protocols. | |
1127 | + */ | |
1128 | + | |
1129 | + /* See if we are configured to re-write the VLAN header to make it look like | |
1130 | + * ethernet... | |
1131 | + */ | |
1132 | + if (skb->dev->vlan_dev->flags & 1) { | |
1133 | + /* Lifted from Gleb's VLAN code... */ | |
1134 | + memmove(skb->data - (VLAN_ETH_HLEN - 4), skb->data - VLAN_ETH_HLEN, 12); | |
1135 | + skb->mac.raw += 4; | |
1136 | + } | |
1137 | + netif_rx(skb); | |
1138 | + return 0; | |
1139 | + } | |
1140 | + | |
1141 | + /* | |
1142 | + * Real 802.2 LLC | |
1143 | + */ | |
1144 | + skb->protocol = __constant_htons(ETH_P_802_2); | |
1145 | + /* place it back on the queue to be handled by upper layer protocols. | |
1146 | + */ | |
1147 | + | |
1148 | + /* See if we are configured to re-write the VLAN header to make it look like | |
1149 | + * ethernet... | |
1150 | + */ | |
1151 | + if (skb->dev->vlan_dev->flags & 1) { | |
1152 | + /* Lifted from Gleb's VLAN code... */ | |
1153 | + memmove(skb->data - (VLAN_ETH_HLEN - 4), skb->data - VLAN_ETH_HLEN, 12); | |
1154 | + skb->mac.raw += 4; | |
1155 | + } | |
1156 | + netif_rx(skb); | |
1157 | + return 0; | |
1158 | +} | |
1159 | + | |
1160 | + | |
1161 | +/* | |
1162 | + * Create the Ethernet VLAN MAC header for an arbitrary protocol layer | |
1163 | + * | |
1164 | + * saddr=NULL means use device source address | |
1165 | + * daddr=NULL means leave destination address (eg unresolved arp) | |
1166 | + * | |
1167 | + * This is called when the SKB is moving down the stack towards the | |
1168 | + * physical devices. | |
1169 | + */ | |
1170 | +int vlan_dev_hard_header(struct sk_buff *skb, struct device *dev, | |
1171 | + unsigned short type, void *daddr, void *saddr, | |
1172 | + unsigned len) { | |
1173 | + struct vlan_ethhdr *veth; | |
1174 | + unsigned short veth_TCI = 0; | |
1175 | + | |
1176 | +#ifdef VLAN_DEBUG | |
1177 | + printk(VLAN_DBG __FUNCTION__ ": skb: %p type: %hx len: %x vlan_id: %hx, daddr: %p\n", | |
1178 | + skb, type, len, dev->vlan_dev->vlan_id, daddr); | |
1179 | +#endif | |
1180 | + | |
1181 | + veth = (struct vlan_ethhdr*)skb_push(skb, VLAN_ETH_HLEN); | |
1182 | + | |
1183 | + /* build the four bytes that make this a VLAN header. */ | |
1184 | + | |
1185 | + /* first, the ethernet type */ | |
1186 | + veth->h_vlan_proto = __constant_htons(ETH_P_802_1Q); | |
1187 | + | |
1188 | + /* Now, construct the second two bytes. This field looks something | |
1189 | + * like: | |
1190 | + * usr_priority: 3 bits (high bits) | |
1191 | + * CFI 1 bit | |
1192 | + * VLAN ID 12 bits (low bits) | |
1193 | + * | |
1194 | + */ | |
1195 | + veth_TCI = dev->vlan_dev->vlan_id; | |
1196 | + veth_TCI |= vlan_dev_get_egress_qos_mask(dev, skb); | |
1197 | + | |
1198 | + veth->h_vlan_TCI = htons(veth_TCI); | |
1199 | + | |
1200 | + /* Rest should be the same as a normal header. */ | |
1201 | + /* | |
1202 | + * Set the protocol type. For a packet of type ETH_P_802_3 we put the length | |
1203 | + * in here instead. It is up to the 802.2 layer to carry protocol information. | |
1204 | + * | |
1205 | + */ | |
1206 | + | |
1207 | + if (type != ETH_P_802_3) | |
1208 | + veth->h_vlan_encapsulated_proto = htons(type); | |
1209 | + else | |
1210 | + veth->h_vlan_encapsulated_proto = htons(len); | |
1211 | + | |
1212 | + /* | |
1213 | + * Set the source hardware address. | |
1214 | + */ | |
1215 | + | |
1216 | + if (saddr) | |
1217 | + memcpy(veth->h_source, saddr, ETH_ALEN); | |
1218 | + else | |
1219 | + memcpy(veth->h_source, dev->dev_addr, ETH_ALEN); | |
1220 | + | |
1221 | + /* | |
1222 | + * Anyway, the loopback-device should never use this function... | |
1223 | + * This is especially true with VLAN's. --BLG | |
1224 | + */ | |
1225 | + | |
1226 | + if (dev->flags & (IFF_LOOPBACK | IFF_NOARP)) { | |
1227 | + memset(veth->h_dest, 0, ETH_ALEN); | |
1228 | + return (VLAN_ETH_HLEN); /* was: dev->hard_header_len */ | |
1229 | + } | |
1230 | + | |
1231 | + if (daddr) { | |
1232 | + memcpy(veth->h_dest, daddr, ETH_ALEN); | |
1233 | + return (VLAN_ETH_HLEN); /* was: dev->hard_header_len */ | |
1234 | + } | |
1235 | + | |
1236 | + return -(VLAN_ETH_HLEN); /* was: dev->hard_header_len */ | |
1237 | + | |
1238 | +} /* vlan_hard_header, put on the VLAN hardware header */ | |
1239 | + | |
1240 | + | |
1241 | +int vlan_dev_hard_start_xmit(struct sk_buff *skb, struct device *dev) { | |
1242 | + struct net_device_stats* stats = (struct net_device_stats*)(dev->priv); | |
1243 | + struct vlan_ethhdr *veth = (struct vlan_ethhdr*)(skb->data); | |
1244 | + | |
1245 | + /* Handle non-VLAN frames if they are sent to us, for example by DHCP. */ | |
1246 | + if (veth->h_vlan_proto != __constant_htons(ETH_P_802_1Q)) { | |
1247 | + /* This is not a VLAN frame...but we can fix that! */ | |
1248 | + unsigned short veth_TCI = 0; | |
1249 | + dev->vlan_dev->cnt_encap_on_xmit++; | |
1250 | + | |
1251 | + if (skb_headroom(skb) < 4) { | |
1252 | + struct sk_buff* sk_tmp = skb; | |
1253 | + skb = skb_realloc_headroom(sk_tmp, 4); | |
1254 | + kfree_skb(sk_tmp); | |
1255 | + if (skb == NULL) { | |
1256 | + stats->tx_dropped++; | |
1257 | + kfree_skb(sk_tmp); | |
1258 | + return -ENOMEM; | |
1259 | + } | |
1260 | + dev->vlan_dev->cnt_inc_headroom_on_tx++; | |
1261 | + } | |
1262 | + else { | |
1263 | + if( !(skb = skb_unshare(skb, GFP_ATOMIC)) ) { | |
1264 | + printk(KERN_ERR "vlan: failed to unshare skbuff\n"); | |
1265 | + stats->tx_dropped++; | |
1266 | + return -ENOMEM; | |
1267 | + } | |
1268 | + } | |
1269 | + veth = (struct vlan_ethhdr*)skb_push(skb, 4); | |
1270 | + | |
1271 | + /* Move the mac addresses to the beginning of the new header. */ | |
1272 | + memmove(skb->data, skb->data + 4, 12); | |
1273 | + | |
1274 | + /* first, the ethernet type */ | |
1275 | + veth->h_vlan_proto = __constant_htons(ETH_P_802_1Q); | |
1276 | + | |
1277 | + /* Now, construct the second two bytes. This field looks something | |
1278 | + * like: | |
1279 | + * usr_priority: 3 bits (high bits) | |
1280 | + * CFI 1 bit | |
1281 | + * VLAN ID 12 bits (low bits) | |
1282 | + * | |
1283 | + */ | |
1284 | + veth_TCI = dev->vlan_dev->vlan_id; | |
1285 | + veth_TCI |= vlan_dev_get_egress_qos_mask(dev, skb); | |
1286 | + | |
1287 | + veth->h_vlan_TCI = htons(veth_TCI); | |
1288 | + }/* If we needed to encapsulate the frame */ | |
1289 | + | |
1290 | + skb->dev = dev->vlan_dev->real_dev; | |
1291 | + | |
1292 | + | |
1293 | +#ifdef VLAN_DEBUG | |
1294 | + printk(VLAN_DBG __FUNCTION__ ": about to send skb: %p to dev: %s\n", skb, skb->dev->name); | |
1295 | +#endif | |
1296 | + | |
1297 | + dev_queue_xmit(skb); | |
1298 | + stats->tx_packets++; /* for statics only */ | |
1299 | + stats->tx_bytes += skb->len; | |
1300 | + return 0; | |
1301 | +}/* vlan_dev_hard_start_xmit */ | |
1302 | + | |
1303 | + | |
1304 | +int vlan_dev_change_mtu(struct device *dev, int new_mtu) { | |
1305 | + /* TODO: gotta make sure the underlying layer can handle it, | |
1306 | + * maybe an IFF_VLAN_CAPABLE flag for devices? | |
1307 | + */ | |
1308 | + | |
1309 | + dev->mtu = new_mtu; | |
1310 | + return new_mtu; | |
1311 | +} | |
1312 | + | |
1313 | +int vlan_dev_open(struct device* dev) { | |
1314 | + dev->flags |= IFF_UP; | |
1315 | + return 0; | |
1316 | +} | |
1317 | + | |
1318 | +int vlan_dev_stop(struct device* dev) { | |
1319 | + dev->flags &= ~IFF_UP; | |
1320 | + return 0; | |
1321 | +} | |
1322 | + | |
1323 | +int vlan_dev_init(struct device* dev) { | |
1324 | + /* TODO: figure this out, maybe do nothing?? */ | |
1325 | + return 0; | |
1326 | +} | |
1327 | + | |
1328 | +void vlan_dev_destruct(struct device* dev) { | |
1329 | + kfree(dev->name); | |
1330 | + VLAN_FMEM_DBG("dev->name free, addr: %p\n", dev->name); | |
1331 | + dev->name = NULL; /* better safe than hosed */ | |
1332 | + | |
1333 | + kfree(dev->priv); | |
1334 | + VLAN_FMEM_DBG("dev->priv free, addr: %p\n", dev->priv); | |
1335 | + dev->priv = NULL; | |
1336 | + | |
1337 | + kfree(dev->vlan_dev); | |
1338 | + VLAN_FMEM_DBG("dev->vlan_dev free, addr: %p\n", dev->vlan_dev); | |
1339 | + dev->vlan_dev = NULL; | |
1340 | + | |
1341 | + kfree(dev); | |
1342 | + VLAN_FMEM_DBG("device free, addr: %p\n", dev); | |
1343 | + dev = NULL; | |
1344 | + | |
1345 | + return; | |
1346 | +} | |
1347 | + | |
1348 | + | |
1349 | +/* TODO: Not to sure if the VLAN stuff works here. Need to understand | |
1350 | + * this better. --BLG | |
1351 | + */ | |
1352 | +/* | |
1353 | +int vlan_dev_header_cache(struct neighbour *neigh, struct hh_cache *hh) { | |
1354 | + unsigned short type = hh->hh_type; | |
1355 | + struct vlan_ethhdr *veth = (struct vlan_ethhdr*)(((u8*)hh->hh_data) + 2); | |
1356 | + struct device *dev = neigh->dev; | |
1357 | + | |
1358 | + if (type == __constant_htons(ETH_P_802_3)) { | |
1359 | + return -1; | |
1360 | + } | |
1361 | + | |
1362 | + veth->h_vlan_proto = __constant_htons(ETH_P_802_1Q); | |
1363 | + memcpy(veth->h_source, dev->dev_addr, ETH_ALEN); | |
1364 | + memcpy(veth->h_dest, neigh->ha, ETH_ALEN); | |
1365 | + | |
1366 | + * VLAN specific attributes. * | |
1367 | + veth->h_vlan_TCI = htons(dev->VLAN_id); * TODO: Add priority control (high 3 bits.) * | |
1368 | + veth->h_vlan_encapsulated_proto = type; * should already be in network order * | |
1369 | + | |
1370 | + return 0; | |
1371 | +} | |
1372 | +*/ | |
1373 | + | |
1374 | +/* | |
1375 | + * Called by Address Resolution module to notify changes in address. | |
1376 | + */ | |
1377 | +/* | |
1378 | +void vlan_dev_header_cache_update(struct hh_cache *hh, struct device *dev, | |
1379 | + unsigned char * haddr) { | |
1380 | + memcpy(((u8*)hh->hh_data) + 2, haddr, VLAN_ETH_HLEN); | |
1381 | +} | |
1382 | +*/ | |
1383 | + | |
1384 | +#ifndef CONFIG_IP_ROUTER | |
1385 | + | |
1386 | +/* | |
1387 | + * Copy from an ethernet device memory space to an sk_buff while | |
1388 | + * checksumming if IP | |
1389 | + * | |
1390 | + * TODO: Find out who calls this: This was lifted from eth.c, and | |
1391 | + * was called eth_copy_and_sum. --BLG | |
1392 | + */ | |
1393 | + | |
1394 | +void vlan_dev_copy_and_sum(struct sk_buff *dest, unsigned char *src, | |
1395 | + int length, int base) { | |
1396 | + struct vlan_ethhdr* veth; | |
1397 | + struct iphdr *iph; | |
1398 | + int ip_length; | |
1399 | + | |
1400 | + veth = (struct vlan_ethhdr*)(src); | |
1401 | + | |
1402 | + /* This grabs the VLAN part of the header too. */ | |
1403 | + if (veth->h_vlan_encapsulated_proto != __constant_htons(ETH_P_IP)) { | |
1404 | + memcpy(dest->data, src, length); | |
1405 | + return; | |
1406 | + } | |
1407 | + | |
1408 | + /* | |
1409 | + * We have to watch for padded packets. The csum doesn't include the | |
1410 | + * padding, and there is no point in copying the padding anyway. | |
1411 | + * We have to use the smaller of length and ip_length because it | |
1412 | + * can happen that ip_length > length. | |
1413 | + */ | |
1414 | + | |
1415 | + /* ethernet is always >= 34 */ | |
1416 | + memcpy(dest->data, src, sizeof(struct iphdr) + VLAN_ETH_HLEN); | |
1417 | + | |
1418 | + length -= sizeof(struct iphdr) + VLAN_ETH_HLEN; | |
1419 | + iph = (struct iphdr*)(src + VLAN_ETH_HLEN); | |
1420 | + ip_length = ntohs(iph->tot_len) - sizeof(struct iphdr); | |
1421 | + | |
1422 | + /* Also watch out for bogons - min IP size is 8 (rfc-1042) */ | |
1423 | + if ((ip_length <= length) && (ip_length > 7)) | |
1424 | + length=ip_length; | |
1425 | + | |
1426 | + dest->csum = csum_partial_copy(src + sizeof(struct iphdr) + VLAN_ETH_HLEN, | |
1427 | + dest->data + sizeof(struct iphdr) + VLAN_ETH_HLEN, | |
1428 | + length, base); | |
1429 | + dest->ip_summed=1; | |
1430 | + | |
1431 | +} /* vlan_copy_and_sum */ | |
1432 | + | |
1433 | +#endif //! CONFIG_IP_ROUTER | |
1434 | + | |
1435 | + | |
1436 | +int vlan_dev_set_ingress_priority(char* dev_name, __u32 skb_prio, short vlan_prio) { | |
1437 | + struct device* dev = dev_get(dev_name); | |
1438 | + | |
1439 | + if (dev) { | |
1440 | + if (dev->vlan_dev) { /* can't put a dflt ID on a vlan device */ | |
1441 | + /* see if a priority mapping exists.. */ | |
1442 | + dev->vlan_dev->ingress_priority_map[vlan_prio & 0x7] = skb_prio; | |
1443 | + return 0; | |
1444 | + } | |
1445 | + } | |
1446 | + return -EINVAL; | |
1447 | +} | |
1448 | + | |
1449 | +int vlan_dev_set_egress_priority(char* dev_name, __u32 skb_prio, short vlan_prio) { | |
1450 | + struct device* dev = dev_get(dev_name); | |
1451 | + struct vlan_priority_tci_mapping* mp = NULL; | |
1452 | + struct vlan_priority_tci_mapping* np; | |
1453 | + | |
1454 | + if (dev) { | |
1455 | + if (dev->vlan_dev) { /* can't put a dflt ID on a vlan device */ | |
1456 | + /* see if a priority mapping exists.. */ | |
1457 | + mp = dev->vlan_dev->egress_priority_map[skb_prio & 0xF]; | |
1458 | + while (mp) { | |
1459 | + if (mp->priority == skb_prio) { | |
1460 | + mp->vlan_qos = ((vlan_prio << 13) & 0xE000); | |
1461 | + return 0; | |
1462 | + } | |
1463 | + } | |
1464 | + /* create a new mapping then. */ | |
1465 | + mp = dev->vlan_dev->egress_priority_map[skb_prio & 0xF]; | |
1466 | + np = kmalloc(sizeof(struct vlan_priority_tci_mapping), GFP_KERNEL); | |
1467 | + if (np) { | |
1468 | + np->next = mp; | |
1469 | + np->priority = skb_prio; | |
1470 | + np->vlan_qos = ((vlan_prio << 13) & 0xE000); | |
1471 | + dev->vlan_dev->egress_priority_map[skb_prio & 0xF] = np; | |
1472 | + return 0; | |
1473 | + } | |
1474 | + else { | |
1475 | + return -ENOBUFS; | |
1476 | + } | |
1477 | + } | |
1478 | + } | |
1479 | + return -EINVAL; | |
1480 | +} | |
1481 | + | |
1482 | +/* Flags are defined in the vlan_dev_info class in include/linux/if_vlan.h file. */ | |
1483 | +int vlan_dev_set_vlan_flag(char* dev_name, __u32 flag, short flag_val) { | |
1484 | + struct device* dev = dev_get(dev_name); | |
1485 | + | |
1486 | + if (dev) { | |
1487 | + if (dev->vlan_dev) { | |
1488 | + /* verify flag is supported */ | |
1489 | + if (flag == 1) { | |
1490 | + if (flag_val) { | |
1491 | + dev->vlan_dev->flags |= 1; | |
1492 | + } | |
1493 | + else { | |
1494 | + dev->vlan_dev->flags &= ~1; | |
1495 | + } | |
1496 | + return 0; | |
1497 | + } | |
1498 | + else { | |
1499 | + return -EINVAL; | |
1500 | + } | |
1501 | + }/* if it's a vlan device */ | |
1502 | + }/* if we found the device */ | |
1503 | + return -EINVAL; | |
1504 | +} | |
1505 | + | |
1506 | + | |
1507 | +int vlan_dev_set_mac_address(struct device *dev, void* addr_struct_p) { | |
1508 | + int i; | |
1509 | + struct sockaddr *addr = (struct sockaddr*)(addr_struct_p); | |
1510 | + | |
1511 | + if (dev->start) { | |
1512 | + return -EBUSY; | |
1513 | + } | |
1514 | + | |
1515 | + memcpy(dev->dev_addr, addr->sa_data, dev->addr_len); | |
1516 | + | |
1517 | + printk("%s: Setting MAC address to ", dev->name); | |
1518 | + for (i = 0; i < 6; i++) { | |
1519 | + printk(" %2.2x", dev->dev_addr[i]); | |
1520 | + } | |
1521 | + printk(".\n"); | |
1522 | + | |
1523 | + if (memcmp(dev->vlan_dev->real_dev->dev_addr, dev->dev_addr, dev->addr_len) != 0) { | |
1524 | + if (dev->vlan_dev->real_dev->flags & IFF_PROMISC) { | |
1525 | + /* Already promiscious...leave it alone. */ | |
1526 | + printk("VLAN (%s): Good, underlying device (%s) is already promiscious.\n", | |
1527 | + dev->name, dev->vlan_dev->real_dev->name); | |
1528 | + } | |
1529 | + else { | |
1530 | + int flgs = dev->vlan_dev->real_dev->flags; | |
1531 | + printk("VLAN (%s): Setting underlying device (%s) to promiscious mode.\n", | |
1532 | + dev->name, dev->vlan_dev->real_dev->name); | |
1533 | + flgs |= IFF_PROMISC; | |
1534 | + dev_change_flags(dev->vlan_dev->real_dev, flgs); | |
1535 | + /* This should work, but doesn't: | |
1536 | + dev_set_promiscuity(dev->vlan_dev->real_dev, 1); | |
1537 | + */ | |
1538 | + } | |
1539 | + } | |
1540 | + else { | |
1541 | + printk("VLAN (%s): Underlying device (%s) has same MAC, not checking promiscious mode.\n", | |
1542 | + dev->name, dev->vlan_dev->real_dev->name); | |
1543 | + } | |
1544 | + return 0; | |
1545 | +} | |
1546 | + | |
1547 | + | |
1548 | +/** Taken from Gleb + Lennert's VLAN code, and modified... */ | |
1549 | +void vlan_dev_set_multicast_list(struct device *vlan_dev) { | |
1550 | + struct dev_mc_list *dmi; | |
1551 | + struct device *real_dev; | |
1552 | + int inc; | |
1553 | + | |
1554 | + if (vlan_dev && vlan_dev->vlan_dev) { | |
1555 | + /* Then it's a real vlan device, as far as we can tell.. */ | |
1556 | + real_dev = vlan_dev->vlan_dev->real_dev; | |
1557 | + | |
1558 | + /* compare the current promiscuity to the last promisc we had.. */ | |
1559 | + inc = vlan_dev->promiscuity - vlan_dev->vlan_dev->old_promiscuity; | |
1560 | + | |
1561 | + if (inc) { | |
1562 | + printk(KERN_INFO "vlan: dev_set_promiscuity(master, %d)\n", inc); | |
1563 | + dev_set_promiscuity(real_dev, inc); /* found in dev.c */ | |
1564 | + vlan_dev->vlan_dev->old_promiscuity = vlan_dev->promiscuity; | |
1565 | + } | |
1566 | + | |
1567 | + inc = vlan_dev->allmulti - vlan_dev->vlan_dev->old_allmulti; | |
1568 | + | |
1569 | + if (inc) { | |
1570 | + printk(KERN_INFO "vlan: dev_set_allmulti(master, %d)\n", inc); | |
1571 | + dev_set_allmulti(real_dev, inc); /* dev.c */ | |
1572 | + vlan_dev->vlan_dev->old_allmulti = vlan_dev->allmulti; | |
1573 | + } | |
1574 | + | |
1575 | + /* looking for addresses to add to master's list */ | |
1576 | + for (dmi = vlan_dev->mc_list; dmi!=NULL; dmi=dmi->next) { | |
1577 | + if (vlan_should_add_mc(dmi, vlan_dev->vlan_dev->old_mc_list)) { | |
1578 | + dev_mc_add(real_dev, dmi->dmi_addr, dmi->dmi_addrlen, 0); | |
1579 | + printk(KERN_INFO "vlan: add %.2x:%.2x:%.2x:%.2x:%.2x:%.2x mcast address to master interface\n", | |
1580 | + dmi->dmi_addr[0], | |
1581 | + dmi->dmi_addr[1], | |
1582 | + dmi->dmi_addr[2], | |
1583 | + dmi->dmi_addr[3], | |
1584 | + dmi->dmi_addr[4], | |
1585 | + dmi->dmi_addr[5]); | |
1586 | + } | |
1587 | + } | |
1588 | + | |
1589 | + /* looking for addresses to delete from master's list */ | |
1590 | + for (dmi = vlan_dev->mc_list; dmi!=NULL; dmi=dmi->next) { | |
1591 | + if (vlan_should_add_mc(dmi, vlan_dev->mc_list)) { | |
1592 | + /* if we think we should add it to the new list, then we should really | |
1593 | + * delete it from the real list on the underlying device. | |
1594 | + */ | |
1595 | + dev_mc_delete(real_dev, dmi->dmi_addr, dmi->dmi_addrlen, 0); | |
1596 | + printk(KERN_INFO "vlan: del %.2x:%.2x:%.2x:%.2x:%.2x:%.2x mcast address from master interface\n", | |
1597 | + dmi->dmi_addr[0], | |
1598 | + dmi->dmi_addr[1], | |
1599 | + dmi->dmi_addr[2], | |
1600 | + dmi->dmi_addr[3], | |
1601 | + dmi->dmi_addr[4], | |
1602 | + dmi->dmi_addr[5]); | |
1603 | + } | |
1604 | + } | |
1605 | + | |
1606 | + /* save multicast list */ | |
1607 | + vlan_copy_mc_list(vlan_dev->mc_list, vlan_dev->vlan_dev); | |
1608 | + }/* if we were sent a valid device */ | |
1609 | +}/* vlan_dev_set_multicast */ | |
1610 | + | |
1611 | + | |
1612 | +/** dmi is a single entry into a dev_mc_list, a single node. mc_list is | |
1613 | + * an entire list, and we'll iterate through it. | |
1614 | + */ | |
1615 | +int vlan_should_add_mc(struct dev_mc_list *dmi, struct dev_mc_list *mc_list) { | |
1616 | + struct dev_mc_list *idmi; /* iterator */ | |
1617 | + | |
1618 | + for (idmi=mc_list; idmi!=NULL;) { | |
1619 | + if (vlan_dmi_equals(dmi, idmi)) { | |
1620 | + if (dmi->dmi_users > idmi->dmi_users) | |
1621 | + return 1; | |
1622 | + else | |
1623 | + return 0; | |
1624 | + } | |
1625 | + else { | |
1626 | + idmi = idmi->next; | |
1627 | + } | |
1628 | + } | |
1629 | + | |
1630 | + return 1; | |
1631 | +} | |
1632 | + | |
1633 | + | |
1634 | +void vlan_copy_mc_list(struct dev_mc_list *mc_list, struct vlan_dev_info *vlan_info) { | |
1635 | + struct dev_mc_list *dmi, *new_dmi; | |
1636 | + | |
1637 | + vlan_destroy_mc_list(vlan_info->old_mc_list); | |
1638 | + vlan_info->old_mc_list = NULL; | |
1639 | + | |
1640 | + for (dmi=mc_list; dmi!=NULL; dmi=dmi->next) { | |
1641 | + new_dmi = kmalloc(sizeof(*new_dmi), GFP_KERNEL); | |
1642 | + if (new_dmi == NULL) { | |
1643 | + printk(KERN_ERR "vlan: cannot allocate memory. Multicast may not work properly from now.\n"); | |
1644 | + return; | |
1645 | + } | |
1646 | + | |
1647 | + new_dmi->next = vlan_info->old_mc_list; | |
1648 | + vlan_info->old_mc_list = new_dmi; | |
1649 | + | |
1650 | + new_dmi->dmi_addrlen = dmi->dmi_addrlen; | |
1651 | + memcpy(new_dmi->dmi_addr, dmi->dmi_addr, dmi->dmi_addrlen); | |
1652 | + new_dmi->dmi_users = dmi->dmi_users; | |
1653 | + new_dmi->dmi_gusers = dmi->dmi_gusers; | |
1654 | + } | |
1655 | +} | |
1656 | + | |
1657 | +void vlan_flush_mc_list(struct device *dev) { | |
1658 | + struct dev_mc_list *dmi = dev->mc_list; | |
1659 | + | |
1660 | + while (dmi) { | |
1661 | + dev_mc_delete(dev, dmi->dmi_addr, dmi->dmi_addrlen, 0); | |
1662 | + printk(KERN_INFO "vlan: del %.2x:%.2x:%.2x:%.2x:%.2x:%.2x mcast address from master interface\n", | |
1663 | + dmi->dmi_addr[0], | |
1664 | + dmi->dmi_addr[1], | |
1665 | + dmi->dmi_addr[2], | |
1666 | + dmi->dmi_addr[3], | |
1667 | + dmi->dmi_addr[4], | |
1668 | + dmi->dmi_addr[5]); | |
1669 | + dmi = dev->mc_list; | |
1670 | + } | |
1671 | + | |
1672 | + vlan_destroy_mc_list(dev->mc_list); | |
1673 | + if (dev->vlan_dev) { | |
1674 | + vlan_destroy_mc_list(dev->vlan_dev->old_mc_list); | |
1675 | + dev->vlan_dev->old_mc_list = NULL; | |
1676 | + } | |
1677 | + dev->mc_list = NULL; | |
1678 | +}/* vlan_flush_mc_list */ | |
1679 | diff -u -r -N -X /home/greear/exclude.list linux/net/802_1Q/vlanproc.c linux.dev/net/802_1Q/vlanproc.c | |
1680 | --- linux/net/802_1Q/vlanproc.c Wed Dec 31 17:00:00 1969 | |
1681 | +++ linux.dev/net/802_1Q/vlanproc.c Fri Dec 29 19:51:33 2000 | |
1682 | @@ -0,0 +1,654 @@ | |
1683 | +/* * -*- linux-c -*- */ | |
1684 | +/***************************************************************************** | |
1685 | + * vlanproc.c VLAN Module. /proc filesystem interface. | |
1686 | +* | |
1687 | +* Author: Ben Greear, <greearb@candelatech.com> coppied from wanproc.c | |
1688 | +* by: Gene Kozin <genek@compuserve.com> | |
1689 | +* | |
1690 | +* Copyright: (c) 1998-2000 Ben Greear | |
1691 | +* | |
1692 | +* This program is free software; you can redistribute it and/or | |
1693 | +* modify it under the terms of the GNU General Public License | |
1694 | +* as published by the Free Software Foundation; either version | |
1695 | +* 2 of the License, or (at your option) any later version. | |
1696 | +* ============================================================================ | |
1697 | +* Jan 20, 1998 Ben Greear Initial Version | |
1698 | +*****************************************************************************/ | |
1699 | + | |
1700 | +#include <linux/config.h> | |
1701 | +#include <linux/stddef.h> /* offsetof(), etc. */ | |
1702 | +#include <linux/errno.h> /* return codes */ | |
1703 | +#include <linux/kernel.h> | |
1704 | +#include <linux/malloc.h> /* kmalloc(), kfree() */ | |
1705 | +#include <linux/mm.h> /* verify_area(), etc. */ | |
1706 | +#include <linux/string.h> /* inline mem*, str* functions */ | |
1707 | +#include <linux/init.h> /* __initfunc et al. */ | |
1708 | +#include <asm/segment.h> /* kernel <-> user copy */ | |
1709 | +#include <asm/byteorder.h> /* htons(), etc. */ | |
1710 | +#include <asm/uaccess.h> /* copy_to_user */ | |
1711 | +#include <asm/io.h> | |
1712 | +#include <linux/proc_fs.h> | |
1713 | +#include <linux/fs.h> | |
1714 | +#include <linux/netdevice.h> | |
1715 | +#include <linux/if_vlan.h> | |
1716 | +#include "vlanproc.h" | |
1717 | +#include "vlan.h" | |
1718 | + | |
1719 | +/****** Defines and Macros **************************************************/ | |
1720 | + | |
1721 | +#ifndef min | |
1722 | +#define min(a,b) (((a)<(b))?(a):(b)) | |
1723 | +#endif | |
1724 | +#ifndef max | |
1725 | +#define max(a,b) (((a)>(b))?(a):(b)) | |
1726 | +#endif | |
1727 | + | |
1728 | + | |
1729 | +/****** Function Prototypes *************************************************/ | |
1730 | + | |
1731 | +#ifdef CONFIG_PROC_FS | |
1732 | + | |
1733 | +/* Proc filesystem interface */ | |
1734 | +static int vlan_proc_perms(struct inode *, int); | |
1735 | +static ssize_t vlan_proc_read(struct file* file, char* buf, size_t count, | |
1736 | + loff_t *ppos); | |
1737 | + | |
1738 | +/* Methods for preparing data for reading proc entries */ | |
1739 | + | |
1740 | +static int vlan_config_get_info(char* buf, char** start, off_t offs, int len, | |
1741 | + int dummy); | |
1742 | +static int vlandev_get_info(char* buf, char** start, off_t offs, int len, | |
1743 | + int dummy); | |
1744 | + | |
1745 | + | |
1746 | +/* Miscellaneous */ | |
1747 | + | |
1748 | +/* | |
1749 | + * Global Data | |
1750 | + */ | |
1751 | + | |
1752 | +/* | |
1753 | + * Names of the proc directory entries | |
1754 | + */ | |
1755 | + | |
1756 | +static char name_root[] = "vlan"; | |
1757 | +static char name_conf[] = "config"; | |
1758 | +static char term_msg[] = "***KERNEL: Out of buffer space!***\n"; | |
1759 | + | |
1760 | + | |
1761 | +/* | |
1762 | + * VLAN device IOCTL. | |
1763 | + * o execute requested action or pass command to the device driver | |
1764 | + */ | |
1765 | + | |
1766 | +int vlan_ioctl(struct inode* inode, struct file* file, | |
1767 | + unsigned int cmd, unsigned long arg) { | |
1768 | + int err = 0; | |
1769 | + /* | |
1770 | + struct proc_dir_entry* dent; | |
1771 | + struct device* dev; | |
1772 | + */ | |
1773 | + struct vlan_ioctl_args args; | |
1774 | + | |
1775 | + printk(VLAN_DBG __FUNCTION__ ": cmd: %x\n", cmd); | |
1776 | + | |
1777 | + /* everything here needs root permissions, except aguably the | |
1778 | + * hack ioctls for sending packets. However, I know _I_ don't | |
1779 | + * want users running that on my network! --BLG | |
1780 | + */ | |
1781 | + if (!capable(CAP_NET_ADMIN)){ | |
1782 | + return -EPERM; | |
1783 | + } | |
1784 | + | |
1785 | + if ((cmd >> 8) != VLAN_IOCTL) { | |
1786 | + printk(VLAN_DBG __FUNCTION__ ": Not a VLAN IOCTL: %x \n", cmd); | |
1787 | + return -EINVAL; | |
1788 | + } | |
1789 | + | |
1790 | + if (copy_from_user(&args, (void*)arg, sizeof(struct vlan_ioctl_args))) | |
1791 | + return -EFAULT; | |
1792 | + | |
1793 | + /* Null terminate this sucker, just in case. */ | |
1794 | + args.dev1[23] = 0; | |
1795 | + args.u.dev2[23] = 0; | |
1796 | + | |
1797 | + /* | |
1798 | + dent = inode->u.generic_ip; | |
1799 | + if ((dent == NULL) || (dent->data == NULL)) | |
1800 | + return -EINVAL; | |
1801 | + | |
1802 | + dev = dent->data; | |
1803 | + */ | |
1804 | + | |
1805 | + switch (cmd) | |
1806 | + { | |
1807 | + case SET_INGRESS_PRIORITY_IOCTL: | |
1808 | + err = vlan_dev_set_ingress_priority(args.dev1, args.u.skb_priority, args.vlan_qos); | |
1809 | + break; | |
1810 | + | |
1811 | + case SET_EGRESS_PRIORITY_IOCTL: | |
1812 | + err = vlan_dev_set_egress_priority(args.dev1, args.u.skb_priority, args.vlan_qos); | |
1813 | + break; | |
1814 | + | |
1815 | + case SET_VLAN_FLAG_IOCTL: | |
1816 | + err = vlan_dev_set_vlan_flag(args.dev1, args.u.flag, args.vlan_qos); | |
1817 | + break; | |
1818 | + | |
1819 | + case SET_NAME_TYPE_IOCTL: | |
1820 | + if ((args.u.name_type >= 0) && (args.u.name_type < VLAN_NAME_TYPE_HIGHEST)) { | |
1821 | + vlan_name_type = args.u.name_type; | |
1822 | + err = 0; | |
1823 | + } | |
1824 | + else { | |
1825 | + err = -EINVAL; | |
1826 | + } | |
1827 | + break; | |
1828 | + | |
1829 | + /* TODO: Figure out how to pass info back... | |
1830 | + case GET_INGRESS_PRIORITY_IOCTL: | |
1831 | + err = vlan_dev_get_ingress_priority(args); | |
1832 | + break; | |
1833 | + | |
1834 | + case GET_EGRESS_PRIORITY_IOCTL: | |
1835 | + err = vlan_dev_get_egress_priority(args); | |
1836 | + break; | |
1837 | + */ | |
1838 | + | |
1839 | + case ADD_VLAN_IOCTL: | |
1840 | + /* we have been given the name of the Ethernet Device we want to | |
1841 | + * talk to: args.dev1 We also have the | |
1842 | + * VLAN ID: args.u.VID | |
1843 | + */ | |
1844 | + if (register_802_1Q_vlan_device(args.dev1, args.u.VID)) { | |
1845 | + err = 0; | |
1846 | + } | |
1847 | + else { | |
1848 | + err = -EINVAL; | |
1849 | + } | |
1850 | + break; | |
1851 | + | |
1852 | + case DEL_VLAN_IOCTL: | |
1853 | + /* Here, the args.dev1 is the actual VLAN we want to get rid of. */ | |
1854 | + | |
1855 | + err = unregister_802_1Q_vlan_device(args.dev1); | |
1856 | + break; | |
1857 | + | |
1858 | + default: | |
1859 | + /* pass on to underlying device instead?? */ | |
1860 | + printk(VLAN_DBG __FUNCTION__ ": Unknown VLAN IOCTL: %x \n", cmd); | |
1861 | + return -EINVAL; | |
1862 | + }/* switch */ | |
1863 | + return err; | |
1864 | +} | |
1865 | + | |
1866 | +/* | |
1867 | + * Structures for interfacing with the /proc filesystem. | |
1868 | + * VLAN creates its own directory /proc/net/vlan with the folowing | |
1869 | + * entries: | |
1870 | + * config device status/configuration | |
1871 | + * <device> entry for each device | |
1872 | + */ | |
1873 | + | |
1874 | +/* | |
1875 | + * Generic /proc/net/vlan/<file> file and inode operations | |
1876 | + */ | |
1877 | + | |
1878 | +static struct file_operations vlan_fops = { | |
1879 | + NULL, /* lseek */ | |
1880 | + vlan_proc_read, /* read */ | |
1881 | + NULL, /* write */ | |
1882 | + NULL, /* readdir */ | |
1883 | + NULL, /* select */ | |
1884 | + vlan_ioctl, /* ioctl */ | |
1885 | + NULL, /* mmap */ | |
1886 | + NULL, /* no special open code */ | |
1887 | + NULL, /* flush */ | |
1888 | + NULL, /* no special release code */ | |
1889 | + NULL /* can't fsync */ | |
1890 | +}; | |
1891 | + | |
1892 | +static struct inode_operations vlan_inode = { | |
1893 | + &vlan_fops, | |
1894 | + NULL, /* create */ | |
1895 | + NULL, /* lookup */ | |
1896 | + NULL, /* link */ | |
1897 | + NULL, /* unlink */ | |
1898 | + NULL, /* symlink */ | |
1899 | + NULL, /* mkdir */ | |
1900 | + NULL, /* rmdir */ | |
1901 | + NULL, /* mknod */ | |
1902 | + NULL, /* rename */ | |
1903 | + NULL, /* follow link */ | |
1904 | + NULL, /* readlink */ | |
1905 | + NULL, /* readpage */ | |
1906 | + NULL, /* writepage */ | |
1907 | + NULL, /* bmap */ | |
1908 | + NULL, /* truncate */ | |
1909 | + vlan_proc_perms | |
1910 | +}; | |
1911 | + | |
1912 | +/* | |
1913 | + * /proc/net/vlan/<device> file and inode operations | |
1914 | + */ | |
1915 | + | |
1916 | +static struct file_operations vlandev_fops = { | |
1917 | + NULL, /* lseek */ | |
1918 | + vlan_proc_read, /* read */ | |
1919 | + NULL, /* write */ | |
1920 | + NULL, /* readdir */ | |
1921 | + NULL, /* select */ | |
1922 | + vlan_ioctl, /* ioctl */ | |
1923 | + NULL, /* mmap */ | |
1924 | + NULL, /* no special open code */ | |
1925 | + NULL, /* flush */ | |
1926 | + NULL, /* no special release code */ | |
1927 | + NULL /* can't fsync */ | |
1928 | +}; | |
1929 | + | |
1930 | +static struct inode_operations vlandev_inode = { | |
1931 | + &vlandev_fops, | |
1932 | + NULL, /* create */ | |
1933 | + NULL, /* lookup */ | |
1934 | + NULL, /* link */ | |
1935 | + NULL, /* unlink */ | |
1936 | + NULL, /* symlink */ | |
1937 | + NULL, /* mkdir */ | |
1938 | + NULL, /* rmdir */ | |
1939 | + NULL, /* mknod */ | |
1940 | + NULL, /* rename */ | |
1941 | + NULL, /* readlink */ | |
1942 | + NULL, /* follow_link */ | |
1943 | + NULL, /* readpage */ | |
1944 | + NULL, /* writepage */ | |
1945 | + NULL, /* bmap */ | |
1946 | + NULL, /* truncate */ | |
1947 | + vlan_proc_perms | |
1948 | +}; | |
1949 | + | |
1950 | + | |
1951 | +/* | |
1952 | + * Proc filesystem derectory entries. | |
1953 | + */ | |
1954 | + | |
1955 | +/* | |
1956 | + * /proc/net/vlan | |
1957 | + */ | |
1958 | + | |
1959 | +static struct proc_dir_entry proc_vlan = { | |
1960 | + 0, /* .low_ino */ | |
1961 | + sizeof(name_root) - 1, /* .namelen */ | |
1962 | + name_root, /* .name */ | |
1963 | + 0555 | S_IFDIR, /* .mode */ | |
1964 | + 2, /* .nlink */ | |
1965 | + 0, /* .uid */ | |
1966 | + 0, /* .gid */ | |
1967 | + 0, /* .size */ | |
1968 | + &proc_dir_inode_operations, /* .ops */ | |
1969 | + NULL, /* .get_info */ | |
1970 | + NULL, /* .fill_node */ | |
1971 | + NULL, /* .next */ | |
1972 | + NULL, /* .parent */ | |
1973 | + NULL, /* .subdir */ | |
1974 | + NULL, /* .data */ | |
1975 | +}; | |
1976 | + | |
1977 | +/* | |
1978 | + * /proc/net/vlan/config | |
1979 | + */ | |
1980 | + | |
1981 | +static struct proc_dir_entry proc_vlan_conf = { | |
1982 | + 0, /* .low_ino */ | |
1983 | + sizeof(name_conf) - 1, /* .namelen */ | |
1984 | + name_conf, /* .name */ | |
1985 | + 0444 | S_IFREG, /* .mode */ | |
1986 | + 1, /* .nlink */ | |
1987 | + 0, /* .uid */ | |
1988 | + 0, /* .gid */ | |
1989 | + 0, /* .size */ | |
1990 | + &vlan_inode, /* .ops */ | |
1991 | + &vlan_config_get_info, /* .get_info */ | |
1992 | + NULL, /* .fill_node */ | |
1993 | + NULL, /* .next */ | |
1994 | + NULL, /* .parent */ | |
1995 | + NULL, /* .subdir */ | |
1996 | + NULL, /* .data */ | |
1997 | +}; | |
1998 | + | |
1999 | + | |
2000 | +/* Strings */ | |
2001 | +static char conf_hdr[] = "VLAN Dev name | VLAN ID\n"; | |
2002 | + | |
2003 | + | |
2004 | +/* | |
2005 | + * Interface functions | |
2006 | + */ | |
2007 | + | |
2008 | +/* | |
2009 | + * Initialize vlan proc interface. | |
2010 | + */ | |
2011 | + | |
2012 | +__initfunc(int vlan_proc_init (void)) { | |
2013 | + int err = proc_register(proc_net, &proc_vlan); | |
2014 | + | |
2015 | + if (!err) { | |
2016 | + proc_register(&proc_vlan, &proc_vlan_conf); | |
2017 | + } | |
2018 | + return err; | |
2019 | +} | |
2020 | + | |
2021 | +/* | |
2022 | + * Clean up router proc interface. | |
2023 | + */ | |
2024 | + | |
2025 | +void vlan_proc_cleanup (void) { | |
2026 | + proc_unregister(&proc_vlan, proc_vlan_conf.low_ino); | |
2027 | + proc_unregister(proc_net, proc_vlan.low_ino); | |
2028 | +} | |
2029 | + | |
2030 | + | |
2031 | +/* | |
2032 | + * Add directory entry for VLAN device. | |
2033 | + */ | |
2034 | + | |
2035 | +int vlan_proc_add_dev (struct device* vlandev) { | |
2036 | + if (!vlandev->vlan_dev) { | |
2037 | + printk(KERN_ERR "ERROR: vlan_proc_add, device -:%s:- is NOT a VLAN\n", | |
2038 | + vlandev->name); | |
2039 | + return -EINVAL; | |
2040 | + } | |
2041 | + | |
2042 | + memset(&(vlandev->vlan_dev->dent), 0, sizeof(vlandev->vlan_dev->dent)); | |
2043 | + vlandev->vlan_dev->dent.namelen = strlen(vlandev->name); | |
2044 | + vlandev->vlan_dev->dent.name = vlandev->name; | |
2045 | + vlandev->vlan_dev->dent.mode = 0444 | S_IFREG; | |
2046 | + vlandev->vlan_dev->dent.nlink = 1; | |
2047 | + vlandev->vlan_dev->dent.ops = &vlandev_inode; | |
2048 | + vlandev->vlan_dev->dent.get_info = &vlandev_get_info; | |
2049 | + vlandev->vlan_dev->dent.data = vlandev; | |
2050 | + | |
2051 | +#ifdef VLAN_DEBUG | |
2052 | + printk(KERN_ERR "vlan_proc_add, device -:%s:- being added.\n", | |
2053 | + vlandev->name); | |
2054 | +#endif | |
2055 | + | |
2056 | + return proc_register(&proc_vlan, &vlandev->vlan_dev->dent); | |
2057 | +} | |
2058 | + | |
2059 | + | |
2060 | + | |
2061 | +/* | |
2062 | + * Delete directory entry for VLAN device. | |
2063 | + */ | |
2064 | +int vlan_proc_rem_dev(struct device* vlandev) { | |
2065 | + if (!vlandev || !vlandev->vlan_dev) { | |
2066 | +#ifdef VLAN_DEBUG | |
2067 | + printk(VLAN_DBG __FUNCTION__ ": invalid argument: %p\n", vlandev); | |
2068 | +#endif | |
2069 | + return -EINVAL; | |
2070 | + } | |
2071 | + | |
2072 | +#ifdef VLAN_DEBUG | |
2073 | + printk(VLAN_DBG __FUNCTION__ ": calling proc_unregister for dev: %p\n", | |
2074 | + vlandev); | |
2075 | +#endif | |
2076 | + return proc_unregister(&proc_vlan, vlandev->vlan_dev->dent.low_ino); | |
2077 | +} | |
2078 | + | |
2079 | + | |
2080 | +/****** Proc filesystem entry points ****************************************/ | |
2081 | + | |
2082 | +/* | |
2083 | + * Verify access rights. | |
2084 | + */ | |
2085 | + | |
2086 | +static int vlan_proc_perms (struct inode* inode, int op) { | |
2087 | + return 0; | |
2088 | +} | |
2089 | + | |
2090 | +/* | |
2091 | + * Read VLAN proc directory entry. | |
2092 | + * This is universal routine for reading all entries in /proc/net/vlan | |
2093 | + * directory. Each directory entry contains a pointer to the 'method' for | |
2094 | + * preparing data for that entry. | |
2095 | + * o verify arguments | |
2096 | + * o allocate kernel buffer | |
2097 | + * o call get_info() to prepare data | |
2098 | + * o copy data to user space | |
2099 | + * o release kernel buffer | |
2100 | + * | |
2101 | + * Return: number of bytes copied to user space (0, if no data) | |
2102 | + * <0 error | |
2103 | + */ | |
2104 | +static ssize_t vlan_proc_read(struct file* file, char* buf, size_t count, | |
2105 | + loff_t *ppos) { | |
2106 | + struct inode *inode = file->f_dentry->d_inode; | |
2107 | + struct proc_dir_entry* dent; | |
2108 | + char* page; | |
2109 | + int pos, offs, len; | |
2110 | + | |
2111 | + if (count <= 0) | |
2112 | + return 0; | |
2113 | + | |
2114 | + dent = inode->u.generic_ip; | |
2115 | + if ((dent == NULL) || (dent->get_info == NULL)) | |
2116 | + return 0; | |
2117 | + | |
2118 | + page = kmalloc(VLAN_PROC_BUFSZ, GFP_KERNEL); | |
2119 | + VLAN_MEM_DBG("page malloc, addr: %p size: %i\n", page, VLAN_PROC_BUFSZ); | |
2120 | + | |
2121 | + if (page == NULL) | |
2122 | + return -ENOBUFS; | |
2123 | + | |
2124 | + pos = dent->get_info(page, dent->data, 0, 0, 0); | |
2125 | + offs = file->f_pos; | |
2126 | + if (offs < pos) { | |
2127 | + len = min(pos - offs, count); | |
2128 | + if (copy_to_user(buf, (page + offs), len)) { | |
2129 | + return -EFAULT; | |
2130 | + } | |
2131 | + file->f_pos += len; | |
2132 | + } | |
2133 | + else { | |
2134 | + len = 0; | |
2135 | + } | |
2136 | + | |
2137 | + kfree(page); | |
2138 | + VLAN_FMEM_DBG("page free, addr: %p\n", page); | |
2139 | + return len; | |
2140 | +}/* vlan_proc_read */ | |
2141 | + | |
2142 | + | |
2143 | +static int vlan_proc_get_vlan_info(char* buf, unsigned int cnt) { | |
2144 | + struct device* vlandev = NULL; | |
2145 | + struct vlan_group* grp = NULL; | |
2146 | + int i = 0; | |
2147 | + char* nm_type = NULL; | |
2148 | + | |
2149 | + printk(VLAN_DBG __FUNCTION__ ": cnt == %i\n", cnt); | |
2150 | + | |
2151 | + if (vlan_name_type == VLAN_NAME_TYPE_RAW_PLUS_VID) { | |
2152 | + nm_type = "VLAN_NAME_TYPE_RAW_PLUS_VID"; | |
2153 | + } | |
2154 | + else if (vlan_name_type == VLAN_NAME_TYPE_PLUS_VID_NO_PAD) { | |
2155 | + nm_type = "VLAN_NAME_TYPE_PLUS_VID_NO_PAD"; | |
2156 | + } | |
2157 | + else if (vlan_name_type == VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD) { | |
2158 | + nm_type = "VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD"; | |
2159 | + } | |
2160 | + else if (vlan_name_type == VLAN_NAME_TYPE_PLUS_VID) { | |
2161 | + nm_type = "VLAN_NAME_TYPE_PLUS_VID"; | |
2162 | + } | |
2163 | + else { | |
2164 | + nm_type = "UNKNOWN"; | |
2165 | + } | |
2166 | + | |
2167 | + cnt += sprintf(buf + cnt, "Name-Type: %s bad_proto_recvd: %lu\n", | |
2168 | + nm_type, vlan_bad_proto_recvd); | |
2169 | + | |
2170 | + for (grp = p802_1Q_vlan_list; grp != NULL; grp = grp->next) { | |
2171 | + /* loop through all devices for this device */ | |
2172 | + printk(VLAN_DBG __FUNCTION__ ": found a group, addr: %p\n", grp); | |
2173 | + for (i = 0; i < VLAN_GROUP_ARRAY_LEN; i++) { | |
2174 | + /* printk(VLAN_DBG __FUNCTION__ ": checking index[%i]\n", i); */ | |
2175 | + if ((vlandev = grp->vlan_devices[i])) { | |
2176 | + printk(VLAN_DBG __FUNCTION__ ": found a vlan_dev, addr: %p\n", vlandev); | |
2177 | + if ((cnt + 100) > VLAN_PROC_BUFSZ) { | |
2178 | + if ((cnt + strlen(term_msg)) >= VLAN_PROC_BUFSZ) { | |
2179 | + /* should never get here */ | |
2180 | + return cnt; | |
2181 | + } | |
2182 | + else { | |
2183 | + cnt += sprintf(buf + cnt, "%s", term_msg); | |
2184 | + return cnt; | |
2185 | + } | |
2186 | + }/* if running out of buffer space */ | |
2187 | + else { | |
2188 | + if (!vlandev->vlan_dev) { | |
2189 | + printk(KERN_ERR __FUNCTION__ ": ERROR: vlandev->vlan_dev is NULL\n"); | |
2190 | + } | |
2191 | + else { | |
2192 | + printk(VLAN_DBG __FUNCTION__ ": got a good vlandev, addr: %p\n", vlandev->vlan_dev); | |
2193 | + cnt += sprintf(buf + cnt, "%-15s| %d | %s\n", | |
2194 | + vlandev->name, vlandev->vlan_dev->vlan_id, vlandev->vlan_dev->real_dev->name); | |
2195 | + }/* else */ | |
2196 | + }/* else */ | |
2197 | + }/* if we have a vlan of this number */ | |
2198 | + }/* for all VLAN's */ | |
2199 | + }/* for each vlan group, default is only one.*/ | |
2200 | + | |
2201 | + return cnt; | |
2202 | +}/* vlan_proc_get_vlan_info */ | |
2203 | + | |
2204 | +/* | |
2205 | + * Prepare data for reading 'Config' entry. | |
2206 | + * Return length of data. | |
2207 | + */ | |
2208 | + | |
2209 | +static int vlan_config_get_info(char* buf, char** start, off_t offs, int len, | |
2210 | + int dummy) { | |
2211 | + strcpy(buf, conf_hdr); | |
2212 | + return vlan_proc_get_vlan_info(buf, (unsigned int)(strlen(conf_hdr))); | |
2213 | +} | |
2214 | + | |
2215 | + | |
2216 | +/* | |
2217 | + * Prepare data for reading <device> entry. | |
2218 | + * Return length of data. | |
2219 | + * | |
2220 | + * On entry, the 'start' argument will contain a pointer to VLAN device | |
2221 | + * data space. | |
2222 | + */ | |
2223 | + | |
2224 | +static int vlandev_get_info(char* buf, char** start, off_t offs, int len, | |
2225 | + int dummy) { | |
2226 | + struct device* vlandev = (void*)start; | |
2227 | + struct net_device_stats* stats; | |
2228 | + int cnt = 0; | |
2229 | + struct vlan_priority_tci_mapping* mp; | |
2230 | + int i; | |
2231 | + | |
2232 | +#ifdef VLAN_DEBUG | |
2233 | + printk(VLAN_DBG __FUNCTION__ ": vlandev: %p\n", vlandev); | |
2234 | +#endif | |
2235 | + | |
2236 | + if ((vlandev == NULL) || (!vlandev->vlan_dev)) { | |
2237 | + return 0; | |
2238 | + } | |
2239 | + | |
2240 | + cnt += sprintf(buf + cnt, "%s VID: %d REORDER_HDR: %i\n", | |
2241 | + vlandev->name, vlandev->vlan_dev->vlan_id, (int)(vlandev->vlan_dev->flags & 1)); | |
2242 | + stats = (struct net_device_stats*)(vlandev->priv); | |
2243 | + | |
2244 | + cnt += sprintf(buf + cnt, "%30s: %12lu\n", | |
2245 | + "total frames received", stats->rx_packets); | |
2246 | + | |
2247 | + cnt += sprintf(buf + cnt, "%30s: %12lu\n", | |
2248 | + "total bytes received", stats->rx_bytes); | |
2249 | + | |
2250 | + cnt += sprintf(buf + cnt, "%30s: %12lu\n", | |
2251 | + "Broadcast/Multicast Rcvd", stats->multicast); | |
2252 | + | |
2253 | + cnt += sprintf(buf + cnt, "\n%30s: %12lu\n", | |
2254 | + "total frames transmitted", stats->tx_packets); | |
2255 | + | |
2256 | + cnt += sprintf(buf + cnt, "%30s: %12lu\n", | |
2257 | + "total bytes transmitted", stats->tx_bytes); | |
2258 | + | |
2259 | + cnt += sprintf(buf + cnt, "%30s: %12lu\n", | |
2260 | + "total headroom inc", vlandev->vlan_dev->cnt_inc_headroom_on_tx); | |
2261 | + | |
2262 | + cnt += sprintf(buf + cnt, "%30s: %12lu\n", | |
2263 | + "total encap on xmit", vlandev->vlan_dev->cnt_encap_on_xmit); | |
2264 | + | |
2265 | + cnt += sprintf(buf + cnt, "Device: %s", vlandev->vlan_dev->real_dev->name); | |
2266 | + | |
2267 | + /* now show all PRIORITY mappings relating to this VLAN */ | |
2268 | + cnt += sprintf(buf + cnt, "\nINGRESS priority mappings: 0:%lu 1:%lu 2:%lu 3:%lu 4:%lu 5:%lu 6:%lu 7:%lu\n", | |
2269 | + vlandev->vlan_dev->ingress_priority_map[0], | |
2270 | + vlandev->vlan_dev->ingress_priority_map[1], | |
2271 | + vlandev->vlan_dev->ingress_priority_map[2], | |
2272 | + vlandev->vlan_dev->ingress_priority_map[3], | |
2273 | + vlandev->vlan_dev->ingress_priority_map[4], | |
2274 | + vlandev->vlan_dev->ingress_priority_map[5], | |
2275 | + vlandev->vlan_dev->ingress_priority_map[6], | |
2276 | + vlandev->vlan_dev->ingress_priority_map[7]); | |
2277 | + | |
2278 | + cnt += sprintf(buf + cnt, "EGRESSS priority Mappings: "); | |
2279 | + | |
2280 | + for (i = 0; i<16; i++) { | |
2281 | + mp = vlandev->vlan_dev->egress_priority_map[i]; | |
2282 | + while (mp) { | |
2283 | + cnt += sprintf(buf + cnt, "%lu:%hu ", mp->priority, ((mp->vlan_qos >> 13) & 0x7)); | |
2284 | + | |
2285 | + if ((cnt + 100) > VLAN_PROC_BUFSZ) { | |
2286 | + if ((cnt + strlen(term_msg)) >= VLAN_PROC_BUFSZ) { | |
2287 | + /* should never get here */ | |
2288 | + return cnt; | |
2289 | + } | |
2290 | + else { | |
2291 | + cnt += sprintf(buf + cnt, "%s", term_msg); | |
2292 | + return cnt; | |
2293 | + } | |
2294 | + }/* if running out of buffer space */ | |
2295 | + mp = mp->next; | |
2296 | + } | |
2297 | + }/* for */ | |
2298 | + | |
2299 | + cnt += sprintf(buf + cnt, "\n"); | |
2300 | + | |
2301 | + return cnt; | |
2302 | +} | |
2303 | + | |
2304 | + | |
2305 | +/* | |
2306 | + * End | |
2307 | + */ | |
2308 | + | |
2309 | +#else | |
2310 | + | |
2311 | +/* | |
2312 | + * No /proc - output stubs | |
2313 | + */ | |
2314 | + | |
2315 | +__initfunc(int vlan_proc_init(void)) | |
2316 | +{ | |
2317 | + return 0; | |
2318 | +} | |
2319 | + | |
2320 | +void vlan_proc_cleanup(void) | |
2321 | +{ | |
2322 | + return; | |
2323 | +} | |
2324 | + | |
2325 | + | |
2326 | +int vlan_proc_add_dev(struct device *vlandev) | |
2327 | +{ | |
2328 | + return 0; | |
2329 | +} | |
2330 | + | |
2331 | +int vlan_proc_rem_dev(struct device *vlandev) | |
2332 | +{ | |
2333 | + return 0; | |
2334 | +} | |
2335 | + | |
2336 | +#endif | |
2337 | diff -u -r -N -X /home/greear/exclude.list linux/net/802_1Q/vlanproc.h linux.dev/net/802_1Q/vlanproc.h | |
2338 | --- linux/net/802_1Q/vlanproc.h Wed Dec 31 17:00:00 1969 | |
2339 | +++ linux.dev/net/802_1Q/vlanproc.h Fri Dec 29 19:51:33 2000 | |
2340 | @@ -0,0 +1,27 @@ | |
2341 | + | |
2342 | +#ifndef __BEN_VLAN_PROC_INC__ | |
2343 | +#define __BEN_VLAN_PROC_INC__ | |
2344 | + | |
2345 | + | |
2346 | +int vlan_proc_init(void); | |
2347 | + | |
2348 | +int vlan_proc_rem_dev(struct device* vlandev); | |
2349 | +int vlan_proc_add_dev (struct device* vlandev); | |
2350 | +void vlan_proc_cleanup (void); | |
2351 | + | |
2352 | + | |
2353 | +#define VLAN_PROC_BUFSZ (4096) /* buffer size for printing proc info */ | |
2354 | + | |
2355 | +/****** Data Types **********************************************************/ | |
2356 | + | |
2357 | +/* | |
2358 | +typedef struct vlan_stat_entry { | |
2359 | + struct vlan_stat_entry * next; | |
2360 | + char *description; * description string * | |
2361 | + void *data; * -> data * | |
2362 | + unsigned data_type; * data type * | |
2363 | +} vlan_stat_entry_t; | |
2364 | +*/ | |
2365 | + | |
2366 | + | |
2367 | +#endif | |
2368 | diff -u -r -N -X /home/greear/exclude.list linux/net/Config.in linux.dev/net/Config.in | |
2369 | --- linux/net/Config.in Sun Dec 10 17:49:44 2000 | |
2370 | +++ linux.dev/net/Config.in Fri Dec 29 19:51:33 2000 | |
2371 | @@ -44,6 +44,9 @@ | |
2372 | fi | |
2373 | bool 'Frame Diverter (EXPERIMENTAL)' CONFIG_NET_DIVERT | |
2374 | bool '802.2 LLC (EXPERIMENTAL)' CONFIG_LLC | |
2375 | + | |
2376 | + bool '802.1Q VLAN Support (EXPERIMENTAL)' CONFIG_VLAN_802_1Q | |
2377 | + | |
2378 | # if [ "$CONFIG_LLC" = "y" ]; then | |
2379 | # bool 'Netbeui (EXPERIMENTAL)' CONFIG_NETBEUI | |
2380 | # fi | |
2381 | diff -u -r -N -X /home/greear/exclude.list linux/net/Makefile linux.dev/net/Makefile | |
2382 | --- linux/net/Makefile Mon Mar 22 12:18:17 1999 | |
2383 | +++ linux.dev/net/Makefile Fri Dec 29 19:51:33 2000 | |
2384 | @@ -10,7 +10,7 @@ | |
2385 | MOD_SUB_DIRS := ipv4 | |
2386 | ALL_SUB_DIRS := 802 ax25 bridge core ethernet ipv4 ipv6 ipx unix appletalk \ | |
2387 | netrom rose lapb x25 wanrouter netlink sched packet sunrpc \ | |
2388 | - econet irda atm #decnet | |
2389 | + econet irda atm 802_1Q #decnet | |
2390 | SUB_DIRS := core ethernet sched | |
2391 | MOD_LIST_NAME := NET_MISC_MODULES | |
2392 | ||
2393 | @@ -62,6 +62,10 @@ | |
2394 | else | |
2395 | ifeq ($(CONFIG_BRIDGE),m) | |
2396 | MOD_SUB_DIRS += bridge | |
2397 | endif | |
2398 | +endif | |
2399 | + | |
2400 | +ifeq ($(CONFIG_VLAN_802_1Q),y) | |
2401 | +SUB_DIRS += 802_1Q | |
2402 | endif | |
2403 | ||
2404 | ifeq ($(CONFIG_IPX),y) | |
2405 | diff -u -r -N -X /home/greear/exclude.list linux/net/core/dev.c linux.dev/net/core/dev.c | |
2406 | --- linux/net/core/dev.c Sun Dec 10 17:49:44 2000 | |
2407 | +++ linux.dev/net/core/dev.c Sun Jan 14 14:16:43 2001 | |
2408 | @@ -1,4 +1,4 @@ | |
2409 | -/* | |
2410 | +/* -*- linux-c -*- | |
2411 | * NET3 Protocol independent device support routines. | |
2412 | * | |
2413 | * This program is free software; you can redistribute it and/or | |
2414 | @@ -94,6 +94,11 @@ | |
2415 | #ifdef CONFIG_NET_RADIO | |
2416 | #include <linux/wireless.h> | |
2417 | #endif /* CONFIG_NET_RADIO */ | |
2418 | + | |
2419 | +#ifdef CONFIG_VLAN_802_1Q | |
2420 | +#include "../802_1Q/vlan.h" | |
2421 | +#endif | |
2422 | + | |
2423 | #ifdef CONFIG_PLIP | |
2424 | extern int plip_init(void); | |
2425 | #endif | |
2426 | @@ -123,9 +128,17 @@ | |
2427 | * and the routines to invoke. | |
2428 | * | |
2429 | * Why 16. Because with 16 the only overlap we get on a hash of the | |
2430 | - * low nibble of the protocol value is RARP/SNAP/X.25. | |
2431 | + * low nibble of the protocol value is RARP/SNAP/X.25. | |
2432 | + * | |
2433 | + * NOTE: That is no longer true with the addition of VLAN tags. Not | |
2434 | + * sure which should go first, but I bet it won't make much | |
2435 | + * difference if we are running VLANs. The good news is that | |
2436 | + * this protocol won't be in the list unless compiled in, so | |
2437 | + * the average user (w/out VLANs) will not be adversly affected. | |
2438 | + * --BLG | |
2439 | * | |
2440 | * 0800 IP | |
2441 | + * 8100 802.1Q VLAN | |
2442 | * 0001 802.3 | |
2443 | * 0002 AX.25 | |
2444 | * 0004 802.2 | |
2445 | @@ -170,6 +183,256 @@ | |
2446 | static void dev_clear_backlog(struct device *dev); | |
2447 | ||
2448 | ||
2449 | +/* Taking this out, because lo has problems for some people. Feel | |
2450 | + * free to turn it back on and give me (greearb@candelatech.com) bug | |
2451 | + * reports if you can re-produce the problem. --Ben | |
2452 | + | |
2453 | + #define BENS_FAST_DEV_LOOKUP | |
2454 | + | |
2455 | +*/ | |
2456 | +#ifdef BENS_FAST_DEV_LOOKUP | |
2457 | +/* Fast Device Lookup code. Should give much better than | |
2458 | + * linear speed when looking for devices by idx or name. | |
2459 | + * --Ben (greearb@candelatech.com) | |
2460 | + */ | |
2461 | +#define FDL_HASH_LEN 256 | |
2462 | + | |
2463 | +/* #define FDL_DEBUG */ | |
2464 | + | |
2465 | +struct dev_hash_node { | |
2466 | + struct device* dev; | |
2467 | + struct dev_hash_node* next; | |
2468 | +}; | |
2469 | + | |
2470 | +struct dev_hash_node* fdl_name_base[FDL_HASH_LEN];/* hashed by name */ | |
2471 | +struct dev_hash_node* fdl_idx_base[FDL_HASH_LEN]; /* hashed by index */ | |
2472 | +int fdl_initialized_yet = 0; | |
2473 | + | |
2474 | +/* TODO: Make these inline methods */ | |
2475 | +/* Nice cheesy little hash method to be used on device-names (eth0, ppp0, etc) */ | |
2476 | +int fdl_calc_name_idx(const char* dev_name) { | |
2477 | + int tmp = 0; | |
2478 | + int i; | |
2479 | +#ifdef FDL_DEBUG | |
2480 | + printk(KERN_ERR "fdl_calc_name_idx, name: %s\n", dev_name); | |
2481 | +#endif | |
2482 | + for (i = 0; dev_name[i]; i++) { | |
2483 | + tmp += (int)(dev_name[i]); | |
2484 | + } | |
2485 | + if (i > 3) { | |
2486 | + tmp += (dev_name[i-2] * 10); /* might add a little spread to the hash */ | |
2487 | + tmp += (dev_name[i-3] * 100); /* might add a little spread to the hash */ | |
2488 | + } | |
2489 | +#ifdef FDL_DEBUG | |
2490 | + printk(KERN_ERR "fdl_calc_name_idx, rslt: %i\n", (int)(tmp % FDL_HASH_LEN)); | |
2491 | +#endif | |
2492 | + return (tmp % FDL_HASH_LEN); | |
2493 | +} | |
2494 | + | |
2495 | +int fdl_calc_index_idx(const int ifindex) { | |
2496 | + return (ifindex % FDL_HASH_LEN); | |
2497 | +} | |
2498 | + | |
2499 | + | |
2500 | +/* Better have a lock on the dev_base before calling this... */ | |
2501 | +int __fdl_ensure_init(void) { | |
2502 | +#ifdef FDL_DEBUG | |
2503 | + printk(KERN_ERR "__fdl_ensure_init, enter\n"); | |
2504 | +#endif | |
2505 | + if (! fdl_initialized_yet) { | |
2506 | + /* only do this once.. */ | |
2507 | + int i; | |
2508 | + int idx = 0; /* into the hash table */ | |
2509 | + struct device* dev = dev_base; | |
2510 | + struct dev_hash_node* dhn; | |
2511 | + | |
2512 | +#ifdef FDL_DEBUG | |
2513 | + printk(KERN_ERR "__fdl_ensure_init, doing real work..."); | |
2514 | +#endif | |
2515 | + | |
2516 | + fdl_initialized_yet = 1; /* it has been attempted at least... */ | |
2517 | + | |
2518 | + for (i = 0; i<FDL_HASH_LEN; i++) { | |
2519 | + fdl_name_base[i] = NULL; | |
2520 | + fdl_idx_base[i] = NULL; | |
2521 | + } | |
2522 | + | |
2523 | + /* add any current devices to the hash tables at this time. Note that | |
2524 | + * this method must be called with locks on the dev_base acquired. | |
2525 | + */ | |
2526 | + while (dev) { | |
2527 | + | |
2528 | +#ifdef FDL_DEBUG | |
2529 | + printk(KERN_ERR "__fdl_ensure_init, dev: %p dev: %s, idx: %i\n", dev, dev->name, idx); | |
2530 | +#endif | |
2531 | + /* first, take care of the hash-by-name */ | |
2532 | + idx = fdl_calc_name_idx(dev->name); | |
2533 | + dhn = kmalloc(sizeof(struct dev_hash_node), GFP_ATOMIC); | |
2534 | + if (dhn) { | |
2535 | + dhn->dev = dev; | |
2536 | + dhn->next = fdl_name_base[idx]; | |
2537 | + fdl_name_base[idx] = dhn; | |
2538 | + } | |
2539 | + else { | |
2540 | + /* Nasty..couldn't get memory... */ | |
2541 | + return -ENOMEM; | |
2542 | + } | |
2543 | + | |
2544 | + /* now, do the hash-by-idx */ | |
2545 | + idx = fdl_calc_index_idx(dev->ifindex); | |
2546 | + dhn = kmalloc(sizeof(struct dev_hash_node), GFP_ATOMIC); | |
2547 | + if (dhn) { | |
2548 | + dhn->dev = dev; | |
2549 | + dhn->next = fdl_idx_base[idx]; | |
2550 | + fdl_idx_base[idx] = dhn; | |
2551 | + } | |
2552 | + else { | |
2553 | + /* Nasty..couldn't get memory... */ | |
2554 | + return -ENOMEM; | |
2555 | + } | |
2556 | + | |
2557 | + dev = dev->next; | |
2558 | + } | |
2559 | + fdl_initialized_yet = 2; /* initialization actually worked */ | |
2560 | + } | |
2561 | +#ifdef FDL_DEBUG | |
2562 | + printk(KERN_ERR "__fdl_ensure_init, end, fdl_initialized_yet: %i\n", fdl_initialized_yet); | |
2563 | +#endif | |
2564 | + if (fdl_initialized_yet == 2) { | |
2565 | + return 0; | |
2566 | + } | |
2567 | + else { | |
2568 | + return -1; | |
2569 | + } | |
2570 | +}/* fdl_ensure_init */ | |
2571 | + | |
2572 | + | |
2573 | +/* called from register_netdevice, assumes dev is locked, and that no one | |
2574 | + * will be calling __find_dev_by_name before this exits.. etc. | |
2575 | + */ | |
2576 | +int __fdl_register_netdevice(struct device* dev) { | |
2577 | + if (__fdl_ensure_init() == 0) { | |
2578 | + /* first, take care of the hash-by-name */ | |
2579 | + int idx = fdl_calc_name_idx(dev->name); | |
2580 | + struct dev_hash_node* dhn = kmalloc(sizeof(struct dev_hash_node), GFP_ATOMIC); | |
2581 | + | |
2582 | +#ifdef FDL_DEBUG | |
2583 | + printk(KERN_ERR "__fdl_register_netdevice, dev: %p dev: %s, idx: %i", dev, dev->name, idx); | |
2584 | +#endif | |
2585 | + | |
2586 | + if (dhn) { | |
2587 | + dhn->dev = dev; | |
2588 | + dhn->next = fdl_name_base[idx]; | |
2589 | + fdl_name_base[idx] = dhn; | |
2590 | + } | |
2591 | + else { | |
2592 | + /* Nasty..couldn't get memory... */ | |
2593 | + /* Don't try to use these hash tables any more... */ | |
2594 | + fdl_initialized_yet = 1; /* tried, but failed */ | |
2595 | + return -ENOMEM; | |
2596 | + } | |
2597 | + | |
2598 | + /* now, do the hash-by-idx */ | |
2599 | + idx = fdl_calc_index_idx(dev->ifindex); | |
2600 | + dhn = kmalloc(sizeof(struct dev_hash_node), GFP_ATOMIC); | |
2601 | + | |
2602 | +#ifdef FDL_DEBUG | |
2603 | + printk(KERN_ERR "__fdl_register_netdevice, ifindex: %i, idx: %i", dev->ifindex, idx); | |
2604 | +#endif | |
2605 | + | |
2606 | + if (dhn) { | |
2607 | + dhn->dev = dev; | |
2608 | + dhn->next = fdl_idx_base[idx]; | |
2609 | + fdl_idx_base[idx] = dhn; | |
2610 | + } | |
2611 | + else { | |
2612 | + /* Nasty..couldn't get memory... */ | |
2613 | + /* Don't try to use these hash tables any more... */ | |
2614 | + fdl_initialized_yet = 1; /* tried, but failed */ | |
2615 | + return -ENOMEM; | |
2616 | + } | |
2617 | + } | |
2618 | + return 0; | |
2619 | +} /* fdl_register_netdevice */ | |
2620 | + | |
2621 | + | |
2622 | +/* called from register_netdevice, assumes dev is locked, and that no one | |
2623 | + * will be calling __find_dev_by_name, etc. Returns 0 if found & removed one, | |
2624 | + * returns -1 otherwise. | |
2625 | + */ | |
2626 | +int __fdl_unregister_netdevice(struct device* dev) { | |
2627 | + int retval = -1; | |
2628 | + if (fdl_initialized_yet == 2) { /* If we've been initialized correctly... */ | |
2629 | + /* first, take care of the hash-by-name */ | |
2630 | + int idx = fdl_calc_name_idx(dev->name); | |
2631 | + struct dev_hash_node* prev = fdl_name_base[idx]; | |
2632 | + struct dev_hash_node* cur = NULL; | |
2633 | + | |
2634 | +#ifdef FDL_DEBUG | |
2635 | + printk(KERN_ERR "__fdl_unregister_netdevice, dev: %p dev: %s, idx: %i", dev, dev->name, idx); | |
2636 | +#endif | |
2637 | + | |
2638 | + if (prev) { | |
2639 | + if (strcmp(dev->name, prev->dev->name) == 0) { | |
2640 | + /* it's the first one... */ | |
2641 | + fdl_name_base[idx] = prev->next; | |
2642 | + kfree(prev); | |
2643 | + retval = 0; | |
2644 | + } | |
2645 | + else { | |
2646 | + cur = prev->next; | |
2647 | + while (cur) { | |
2648 | + if (strcmp(dev->name, cur->dev->name) == 0) { | |
2649 | + prev->next = cur->next; | |
2650 | + kfree(cur); | |
2651 | + retval = 0; | |
2652 | + break; | |
2653 | + } | |
2654 | + else { | |
2655 | + prev = cur; | |
2656 | + cur = cur->next; | |
2657 | + } | |
2658 | + } | |
2659 | + } | |
2660 | + } | |
2661 | + | |
2662 | + /* Now, the hash-by-index */ | |
2663 | + idx = fdl_calc_index_idx(dev->ifindex); | |
2664 | + prev = fdl_idx_base[idx]; | |
2665 | + cur = NULL; | |
2666 | + if (prev) { | |
2667 | + if (dev->ifindex == prev->dev->ifindex) { | |
2668 | + /* it's the first one... */ | |
2669 | + fdl_idx_base[idx] = prev->next; | |
2670 | + kfree(prev); | |
2671 | + retval = 0; | |
2672 | + } | |
2673 | + else { | |
2674 | + cur = prev->next; | |
2675 | + while (cur) { | |
2676 | + if (dev->ifindex == cur->dev->ifindex) { | |
2677 | + prev->next = cur->next; | |
2678 | + kfree(cur); | |
2679 | + retval = 0; | |
2680 | + break; | |
2681 | + } | |
2682 | + else { | |
2683 | + prev = cur; | |
2684 | + cur = cur->next; | |
2685 | + } | |
2686 | + } | |
2687 | + } | |
2688 | + } | |
2689 | + }/* if we ensured init OK */ | |
2690 | + return retval; | |
2691 | +} /* fdl_unregister_netdevice */ | |
2692 | + | |
2693 | + | |
2694 | + | |
2695 | +#endif /* BENS_FAST_DEV_LOOKUP */ | |
2696 | + | |
2697 | + | |
2698 | + | |
2699 | /****************************************************************************************** | |
2700 | ||
2701 | Protocol management and registration routines | |
2702 | @@ -267,6 +530,25 @@ | |
2703 | { | |
2704 | struct device *dev; | |
2705 | ||
2706 | +#ifdef BENS_FAST_DEV_LOOKUP | |
2707 | + int idx = fdl_calc_name_idx(name); | |
2708 | + struct dev_hash_node* dhn; | |
2709 | + if (fdl_initialized_yet == 2) { | |
2710 | +#ifdef FDL_DEBUG | |
2711 | + printk(KERN_ERR "__dev_get_by_name, name: %s idx: %i\n", name, idx); | |
2712 | +#endif | |
2713 | + dhn = fdl_name_base[idx]; | |
2714 | + while (dhn) { | |
2715 | + if (strcmp(dhn->dev->name, name) == 0) { | |
2716 | + /* printk(KERN_ERR "__dev_get_by_name, found it: %p\n", dhn->dev); */ | |
2717 | + return dhn->dev; | |
2718 | + } | |
2719 | + dhn = dhn->next; | |
2720 | + } | |
2721 | + /* printk(KERN_ERR "__dev_get_by_name, didn't find it for name: %s\n", name); */ | |
2722 | + return NULL; | |
2723 | + } | |
2724 | +#endif | |
2725 | for (dev = dev_base; dev != NULL; dev = dev->next) | |
2726 | { | |
2727 | if (strcmp(dev->name, name) == 0) | |
2728 | @@ -278,7 +560,19 @@ | |
2729 | struct device * dev_get_by_index(int ifindex) | |
2730 | { | |
2731 | struct device *dev; | |
2732 | - | |
2733 | +#ifdef BENS_FAST_DEV_LOOKUP | |
2734 | + int idx = fdl_calc_index_idx(ifindex); | |
2735 | + struct dev_hash_node* dhn; | |
2736 | + if (fdl_initialized_yet == 2) { /* have we gone through initialization before... */ | |
2737 | + dhn = fdl_idx_base[idx]; | |
2738 | + while (dhn) { | |
2739 | + if (dhn->dev->ifindex == ifindex) | |
2740 | + return dhn->dev; | |
2741 | + dhn = dhn->next; | |
2742 | + } | |
2743 | + return NULL; | |
2744 | + } | |
2745 | +#endif | |
2746 | for (dev = dev_base; dev != NULL; dev = dev->next) | |
2747 | { | |
2748 | if (dev->ifindex == ifindex) | |
2749 | @@ -310,14 +604,17 @@ | |
2750 | int i; | |
2751 | /* | |
2752 | * If you need over 100 please also fix the algorithm... | |
2753 | - */ | |
2754 | - for(i=0;i<100;i++) | |
2755 | + * | |
2756 | + * Increased it to deal with VLAN interfaces. It is unlikely | |
2757 | + * that this many will ever be added, but it can't hurt! -BLG | |
2758 | + */ | |
2759 | + for(i=0;i<8192;i++) | |
2760 | { | |
2761 | sprintf(dev->name,name,i); | |
2762 | if(dev_get(dev->name)==NULL) | |
2763 | return i; | |
2764 | } | |
2765 | - return -ENFILE; /* Over 100 of the things .. bail out! */ | |
2766 | + return -ENFILE; /* Over 8192 of the things .. bail out! */ | |
2767 | } | |
2768 | ||
2769 | struct device *dev_alloc(const char *name, int *err) | |
2770 | @@ -956,7 +1253,7 @@ | |
2771 | } | |
2772 | ||
2773 | /* | |
2774 | - * Fetch the packet protocol ID. | |
2775 | + * Fetch the packet protocol ID. (In Network Byte Order --BLG) | |
2776 | */ | |
2777 | ||
2778 | type = skb->protocol; | |
2779 | @@ -1603,8 +1900,15 @@ | |
2780 | return -EBUSY; | |
2781 | if (dev_get(ifr->ifr_newname)) | |
2782 | return -EEXIST; | |
2783 | +#ifdef BENS_FAST_DEV_LOOKUP | |
2784 | + /* Doesn't seem to need any additional locking in kernel 2.2 series... --Ben */ | |
2785 | + __fdl_unregister_netdevice(dev); /* take it out of the name hash table */ | |
2786 | +#endif | |
2787 | memcpy(dev->name, ifr->ifr_newname, IFNAMSIZ); | |
2788 | dev->name[IFNAMSIZ-1] = 0; | |
2789 | +#ifdef BENS_FAST_DEV_LOOKUP | |
2790 | + __fdl_register_netdevice(dev); /* put it back in the name hash table, with the new name */ | |
2791 | +#endif | |
2792 | notifier_call_chain(&netdev_chain, NETDEV_CHANGENAME, dev); | |
2793 | return 0; | |
2794 | ||
2795 | @@ -1809,6 +2113,12 @@ | |
2796 | return -EEXIST; | |
2797 | } | |
2798 | dev->next = NULL; | |
2799 | +#ifdef BENS_FAST_DEV_LOOKUP | |
2800 | + /* Must do this before dp is set to dev, or it could be added twice, once | |
2801 | + * on initialization based on dev_base, and once again after that... | |
2802 | + */ | |
2803 | + __fdl_register_netdevice(dev); | |
2804 | +#endif | |
2805 | *dp = dev; | |
2806 | #ifdef CONFIG_NET_DIVERT | |
2807 | ret=alloc_divert_blk(dev); | |
2808 | @@ -1834,6 +2144,13 @@ | |
2809 | dev->ifindex = dev_new_index(); | |
2810 | if (dev->iflink == -1) | |
2811 | dev->iflink = dev->ifindex; | |
2812 | + | |
2813 | +#ifdef BENS_FAST_DEV_LOOKUP | |
2814 | + /* Must do this before dp is set to dev, or it could be added twice, once | |
2815 | + * on initialization based on dev_base, and once again after that... | |
2816 | + */ | |
2817 | + __fdl_register_netdevice(dev); | |
2818 | +#endif | |
2819 | *dp = dev; | |
2820 | ||
2821 | /* Notify protocols, that a new device appeared. */ | |
2822 | @@ -1885,6 +2202,9 @@ | |
2823 | for (dp = &dev_base; (d=*dp) != NULL; dp=&d->next) { | |
2824 | if (d == dev) { | |
2825 | *dp = d->next; | |
2826 | +#ifdef BENS_FAST_DEV_LOOKUP | |
2827 | + __fdl_unregister_netdevice(dev); | |
2828 | +#endif | |
2829 | synchronize_bh(); | |
2830 | d->next = NULL; | |
2831 | ||
2832 | diff -u -r -N -X /home/greear/exclude.list linux/net/ethernet/eth.c linux.dev/net/ethernet/eth.c | |
2833 | --- linux/net/ethernet/eth.c Tue Jan 4 11:12:26 2000 | |
2834 | +++ linux.dev/net/ethernet/eth.c Fri Dec 29 19:51:33 2000 | |
2835 | @@ -174,17 +174,32 @@ | |
2836 | * Determine the packet's protocol ID. The rule here is that we | |
2837 | * assume 802.3 if the type field is short enough to be a length. | |
2838 | * This is normal practice and works for any 'now in use' protocol. | |
2839 | + * | |
2840 | + * NOTE: It is likely that you will want to change vlan_type_trans in | |
2841 | + * 802_1Q/vlan.c if you change anything here. | |
2842 | */ | |
2843 | ||
2844 | unsigned short eth_type_trans(struct sk_buff *skb, struct device *dev) | |
2845 | { | |
2846 | struct ethhdr *eth; | |
2847 | unsigned char *rawp; | |
2848 | - | |
2849 | - skb->mac.raw=skb->data; | |
2850 | - skb_pull(skb,dev->hard_header_len); | |
2851 | - eth= skb->mac.ethernet; | |
2852 | - | |
2853 | + | |
2854 | + skb->mac.raw=skb->data; | |
2855 | + | |
2856 | +#ifdef CONFIG_VLAN_802_1Q | |
2857 | + /* Moving this below to be more selective. Reason is that for VLAN | |
2858 | + * devices, we do not want to pull the header, we'll let the VLAN | |
2859 | + * device do that instead. This makes default vlans (based on incoming | |
2860 | + * port), much more sane! --BLG | |
2861 | + */ | |
2862 | + | |
2863 | + /* skb_pull(skb,dev->hard_header_len); */ | |
2864 | +#else | |
2865 | + skb_pull(skb,dev->hard_header_len); | |
2866 | +#endif | |
2867 | + | |
2868 | + eth= skb->mac.ethernet; | |
2869 | + | |
2870 | if(*eth->h_dest&1) | |
2871 | { | |
2872 | if(memcmp(eth->h_dest,dev->broadcast, ETH_ALEN)==0) | |
2873 | @@ -206,7 +221,21 @@ | |
2874 | if(memcmp(eth->h_dest,dev->dev_addr, ETH_ALEN)) | |
2875 | skb->pkt_type=PACKET_OTHERHOST; | |
2876 | } | |
2877 | - | |
2878 | + | |
2879 | +#ifdef CONFIG_VLAN_802_1Q | |
2880 | + if (ntohs(eth->h_proto) == ETH_P_802_1Q) { | |
2881 | + /* then we have to convert this into a VLAN looking packet. | |
2882 | + * We'll wait to do that in the VLAN protocol handler. | |
2883 | + * | |
2884 | + * NOTE: We DO NOT PULL ANYTHING FROM THE SKB HERE!!! | |
2885 | + */ | |
2886 | + return __constant_htons(ETH_P_802_1Q); | |
2887 | + } | |
2888 | + else { | |
2889 | + skb_pull(skb, dev->hard_header_len); | |
2890 | + } | |
2891 | +#endif | |
2892 | + | |
2893 | if (ntohs(eth->h_proto) >= 1536) | |
2894 | return eth->h_proto; | |
2895 | ||
2896 | diff -u -r -N -X /home/greear/exclude.list linux/net/protocols.c linux.dev/net/protocols.c | |
2897 | --- linux/net/protocols.c Thu Dec 17 10:03:57 1998 | |
2898 | +++ linux.dev/net/protocols.c Fri Dec 29 19:51:33 2000 | |
2899 | @@ -34,6 +34,10 @@ | |
2900 | extern void packet_proto_init(struct net_proto *pro); | |
2901 | #endif | |
2902 | ||
2903 | +#ifdef CONFIG_VLAN_802_1Q | |
2904 | +extern void vlan_proto_init(struct net_proto* pro); | |
2905 | +#endif | |
2906 | + | |
2907 | #if defined(CONFIG_IPX) || defined(CONFIG_IPX_MODULE) | |
2908 | #define NEED_802 | |
2909 | #include <net/ipxcall.h> | |
2910 | @@ -169,5 +173,9 @@ | |
2911 | { "IrDA", irda_proto_init }, /* IrDA protocols */ | |
2912 | #endif | |
2913 | ||
2914 | +#ifdef CONFIG_VLAN_802_1Q | |
2915 | + { "VLAN", vlan_proto_init }, /* 802.1Q VLAN Support. --BLG */ | |
2916 | +#endif | |
2917 | + | |
2918 | { NULL, NULL } /* End marker */ | |
2919 | }; |