diff -u -r -N -X /home/greear/exclude.list linux/include/linux/if_ether.h linux.dev/include/linux/if_ether.h --- linux/include/linux/if_ether.h Sun Dec 10 17:49:44 2000 +++ linux.dev/include/linux/if_ether.h Thu Jan 4 20:41:19 2001 @@ -32,6 +32,36 @@ #define ETH_DATA_LEN 1500 /* Max. octets in payload */ #define ETH_FRAME_LEN 1514 /* Max. octets in frame sans FCS */ + +#ifdef CONFIG_VLAN_802_1Q + + +#define VLAN_ETH_ALEN 6 /* Octets in one ethernet addr */ +#define VLAN_ETH_HLEN 18 /* Total octets in header. */ +#define VLAN_ETH_ZLEN 64 /* Min. octets in frame sans FCS */ + +/* These could be bumped up by 4, but I'm not sure if all the underlying + * drivers would like it. + * UPDATE: Bumping it by 4, as per Klika's suggestion below. --BLG + * + * According to 802.3ac, the packet can be 4 bytes longer. --Klika Jan + */ +#define VLAN_ETH_DATA_LEN 1500 /* Max. octets in payload */ +#define VLAN_ETH_FRAME_LEN 1518 /* Max. octets in frame sans FCS */ + +struct vlan_ethhdr +{ + unsigned char h_dest[ETH_ALEN]; /* destination eth addr */ + unsigned char h_source[ETH_ALEN]; /* source ether addr */ + unsigned short h_vlan_proto; /* Should always be 0x8100 */ + unsigned short h_vlan_TCI; /* Encapsulates priority and VLAN ID */ + unsigned short h_vlan_encapsulated_proto; /* packet type ID field (or len) */ +}; + + +#endif + + /* * These are the defined Ethernet Protocol ID's. */ @@ -54,6 +84,7 @@ #define ETH_P_RARP 0x8035 /* Reverse Addr Res packet */ #define ETH_P_ATALK 0x809B /* Appletalk DDP */ #define ETH_P_AARP 0x80F3 /* Appletalk AARP */ +#define ETH_P_802_1Q 0x8100 /* 802.1Q VLAN Extended Header */ #define ETH_P_IPX 0x8137 /* IPX over DIX */ #define ETH_P_IPV6 0x86DD /* IPv6 over bluebook */ #define ETH_P_ATMMPOA 0x884c /* MultiProtocol Over ATM */ diff -u -r -N -X /home/greear/exclude.list linux/include/linux/if_vlan.h linux.dev/include/linux/if_vlan.h --- linux/include/linux/if_vlan.h Wed Dec 31 17:00:00 1969 +++ linux.dev/include/linux/if_vlan.h Sun Jan 14 14:30:56 2001 @@ -0,0 +1,238 @@ +/* -*- linux-c -*- + * VLAN An implementation of 802.1Q VLAN tagging. + * + * Version: 0.0.1 03/06/99 + * + * Authors: Ben Greear + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License + * as published by the Free Software Foundation; either version + * 2 of the License, or (at your option) any later version. + * + */ + +#ifndef _LINUX_IF_VLAN_H_ +#define _LINUX_IF_VLAN_H_ + +#ifdef __KERNEL__ + + +/* externally defined structs */ +struct vlan_group; +struct device; +struct sk_buff; +struct packet_type; +struct vlan_collection; + + +#include /* for proc_dir_entry */ + + + +/* Find a VLAN device by the MAC address of it's Ethernet device, and + * it's VLAN ID. The default configuration is to have VLAN's scope + * to be box-wide, so the MAC will be ignored. The mac will only be + * looked at if we are configured to have a seperate set of VLANs per + * each MAC addressable interface. Note that this latter option does + * NOT follow the spec for VLANs, but may be useful for doing very + * large quantities of VLAN MUX/DEMUX onto FrameRelay or ATM PVCs. + */ +struct device *find_802_1Q_vlan_dev(struct device* real_dev, + unsigned short VID); /* vlan.c */ + + +int register_netdevice(struct device *dev); /* found in dev.c */ +int unregister_netdevice(struct device *dev); /* found in dev.c */ +int dev_new_index(void); /* dev.c */ + +/* found in vlan_dev.c */ +struct net_device_stats* vlan_dev_get_stats(struct device* dev); +int vlan_dev_rebuild_header(struct sk_buff *skb); +int vlan_dev_type_trans(struct sk_buff *skb, struct device *dev, + struct packet_type* ptype); +int vlan_dev_hard_header(struct sk_buff *skb, struct device *dev, + unsigned short type, void *daddr, void *saddr, + unsigned len); +int vlan_dev_hard_start_xmit(struct sk_buff *skb, struct device *dev); +int vlan_dev_change_mtu(struct device *dev, int new_mtu); +int vlan_dev_set_mac_address(struct device *dev, void* addr); +int vlan_dev_open(struct device* dev); +int vlan_dev_stop(struct device* dev); +int vlan_dev_init(struct device* dev); +void vlan_dev_destruct(struct device* dev); +int vlan_dev_set_vlan_flag(char* dev_name, __u32 flag, short flag_val); +/* I'm ignorant of these right now. --BLG +int vlan_dev_header_cache(struct neighbour *neigh, struct hh_cache *hh); +void vlan_dev_header_cache_update(struct hh_cache *hh, struct device *dev, + unsigned char * haddr); +*/ +void vlan_dev_copy_and_sum(struct sk_buff *dest, unsigned char *src, + int length, int base); +int vlan_dev_set_ingress_priority(char* dev_name, __u32 skb_prio, short vlan_prio); +int vlan_dev_set_egress_priority(char* dev_name, __u32 skb_prio, short vlan_prio); + +/* VLAN multicast stuff */ +/* Delete all of the MC list entries from this vlan device. Also deals + * with the underlying device... + */ +void vlan_flush_mc_list(struct device* dev); +/* copy the mc_list into the vlan_info structure. */ +void vlan_copy_mc_list(struct dev_mc_list* mc_list, struct vlan_dev_info* vlan_info); +/** dmi is a single entry into a dev_mc_list, a single node. mc_list is + * an entire list, and we'll iterate through it. + */ +int vlan_should_add_mc(struct dev_mc_list *dmi, struct dev_mc_list *mc_list); +/** Taken from Gleb + Lennert's VLAN code, and modified... */ +void vlan_dev_set_multicast_list(struct device *vlan_dev); + + +int vlan_collection_add_vlan(struct vlan_collection* vc, unsigned short vlan_id, + unsigned short flags); +int vlan_collection_remove_vlan(struct vlan_collection* vc, + struct device* vlan_dev); +int vlan_collection_remove_vlan_id(struct vlan_collection* vc, unsigned short vlan_id); + + + +/* found in vlan.c */ +/* Our listing of VLAN group(s) */ +extern struct vlan_group* p802_1Q_vlan_list; + + +#define VLAN_NAME "vlan" + +/* if this changes, algorithm will have to be reworked because this + * depends on completely exhausting the VLAN identifier space. Thus + * it gives constant time lookup, but it many cases it wastes memory. + */ +#define VLAN_GROUP_ARRAY_LEN 4096 + +struct vlan_group { + int real_dev_ifindex; /* The index of the ethernet(like?) device the vlan is attached to. */ + struct device* vlan_devices[VLAN_GROUP_ARRAY_LEN]; + + struct vlan_group* next; /* the next in the list */ +}; + + +/* __Flags__ relating to the vlan ports */ +#define VLAN_FLAG_ALLOW_802_3 1 +#define VLAN_FLAG_ALLOW_802_1Q 2 +#define VLAN_FLAG_IS_IN_USE 4 + + +struct vlan_priority_tci_mapping { + unsigned long priority; + unsigned short vlan_qos; /* This should be shifted when first set, so we only do it + * at provisioning time. + * ((skb->priority << 13) & 0xE000) + */ + struct vlan_priority_tci_mapping* next; +}; + +/* Holds information that makes sense if this device is a VLAN device. */ +struct vlan_dev_info { + /** This will be the mapping that correlates skb->priority to + * 3 bits of VLAN QOS tags... + */ + unsigned long ingress_priority_map[8]; + struct vlan_priority_tci_mapping* egress_priority_map[16]; /* hash table */ + + unsigned short vlan_id; /* The VLAN Identifier for this interface. */ + unsigned short flags; /* (1 << 0) re_order_header This option will cause the + * VLAN code to move around the ethernet header on + * ingress to make the skb look **exactly** like it + * came in from an ethernet port. This destroys some of + * the VLAN information in the skb, but it fixes programs + * like DHCP that use packet-filtering and don't understand + * 802.1Q + */ + struct dev_mc_list* old_mc_list; /* old multi-cast list for the VLAN interface.. + * we save this so we can tell what changes were + * made, in order to feed the right changes down + * to the real hardware... + */ + int old_allmulti; /* similar to above. */ + int old_promiscuity; /* similar to above. */ + struct device* real_dev; /* the underlying device/interface */ + struct proc_dir_entry dent; /* Holds the proc data */ + unsigned long cnt_inc_headroom_on_tx; /* How many times did we have to grow the skb on TX. */ + unsigned long cnt_encap_on_xmit; /* How many times did we have to encapsulate the skb on TX. */ +}; + +static inline unsigned short vlan_dev_get_egress_qos_mask(struct device* dev, struct sk_buff* skb) { + struct vlan_priority_tci_mapping* mp = dev->vlan_dev->egress_priority_map[(skb->priority & 0xF)]; + while (mp) { + if (mp->priority == skb->priority) { + return mp->vlan_qos; /* This should already be shifted to mask correctly with + * the VLAN's TCI + */ + } + mp = mp->next; + } + return 0; +} + +static inline int vlan_dmi_equals(struct dev_mc_list *dmi1, + struct dev_mc_list *dmi2) { + return ((dmi1->dmi_addrlen == dmi2->dmi_addrlen) && + (memcmp(dmi1->dmi_addr, dmi2->dmi_addr, dmi1->dmi_addrlen) == 0)); +} + +static inline void vlan_destroy_mc_list(struct dev_mc_list *mc_list) { + struct dev_mc_list *dmi = mc_list, *next; + + while(dmi) { + next = dmi->next; + kfree(dmi); + dmi = next; + } +} + +#endif /* __KERNEL__ */ + +/** These are the IOCTLs relating to the /proc/net/vlan/ * files. + * Not all may be supported at this time, and some may be primarily + * used for testing and obtaining non-standard access to kernel + * devices. + */ + +#define VLAN_IOCTL 0x52 /* TODO: Can I just make these up??? */ + +enum vlan_ioctls { + ADD_VLAN_IOCTL = (VLAN_IOCTL << 8), + DEL_VLAN_IOCTL, + SET_INGRESS_PRIORITY_IOCTL, + SET_EGRESS_PRIORITY_IOCTL, + GET_INGRESS_PRIORITY_IOCTL, + GET_EGRESS_PRIORITY_IOCTL, + SET_NAME_TYPE_IOCTL, + SET_VLAN_FLAG_IOCTL +}; /* vlan_ioctl enum */ + +enum vlan_name_types { + VLAN_NAME_TYPE_PLUS_VID, /* Name will look like: vlan0005 */ + VLAN_NAME_TYPE_RAW_PLUS_VID, /* name will look like: eth1.0005 */ + VLAN_NAME_TYPE_PLUS_VID_NO_PAD, /* Name will look like: vlan5 */ + VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD, /* Name will look like: eth0.5 */ + VLAN_NAME_TYPE_HIGHEST +}; + +struct vlan_ioctl_args { + char dev1[24]; + + union { + char dev2[24]; + int VID; + unsigned long skb_priority; + unsigned long name_type; + unsigned long bind_type; + unsigned long flag; /* Matches vlan_dev_info flags */ + } u; + + short vlan_qos; /* Can also be flag-value, 1 to set, 0 to clear. */ +}; + + +#endif diff -u -r -N -X /home/greear/exclude.list linux/include/linux/netdevice.h linux.dev/include/linux/netdevice.h --- linux/include/linux/netdevice.h Sun Dec 31 14:36:46 2000 +++ linux.dev/include/linux/netdevice.h Sun Jan 14 14:23:12 2001 @@ -37,8 +37,15 @@ #ifdef CONFIG_NET_PROFILE #include #endif + +#if (defined(CONFIG_VLAN_802_1Q)) +struct vlan_dev_info; +#endif + #endif + + struct divert_blk; /* @@ -53,7 +60,11 @@ */ #if !defined(CONFIG_AX25) && !defined(CONFIG_AX25_MODULE) && !defined(CONFIG_TR) +#if defined(CONFIG_VLAN_802_1Q) +#define LL_MAX_HEADER 36 +#else #define LL_MAX_HEADER 32 +#endif #else #if defined(CONFIG_AX25) || defined(CONFIG_AX25_MODULE) #define LL_MAX_HEADER 96 @@ -155,11 +166,19 @@ { struct hh_cache *hh_next; /* Next entry */ atomic_t hh_refcnt; /* number of users */ - unsigned short hh_type; /* protocol identifier, f.e ETH_P_IP */ + unsigned short hh_type; /* protocol identifier, f.e ETH_P_IP + * NOTE: For VLANs, this will be the + * encapuslated type. --BLG + */ int (*hh_output)(struct sk_buff *skb); rwlock_t hh_lock; + /* cached hardware header; allow for machine alignment needs. */ - unsigned long hh_data[16/sizeof(unsigned long)]; +#ifdef CONFIG_VLAN_802_1Q /* we need 4 extra bytes for VLAN headers */ + unsigned long hh_data[20/sizeof(unsigned long)]; +#else + unsigned long hh_data[16/sizeof(unsigned long)]; +#endif }; @@ -317,7 +336,13 @@ int tx_semaphore; #define NETDEV_FASTROUTE_HMASK 0xF /* Semi-private data. Keep it at the end of device struct. */ + struct dst_entry *fastpath[NETDEV_FASTROUTE_HMASK+1]; +#endif + +#ifdef CONFIG_VLAN_802_1Q + /* Holds information that makes sense if this device is a VLAN device. */ + struct vlan_dev_info* vlan_dev; #endif #ifdef CONFIG_NET_DIVERT diff -u -r -N -X /home/greear/exclude.list linux/net/802_1Q/Makefile linux.dev/net/802_1Q/Makefile --- linux/net/802_1Q/Makefile Wed Dec 31 17:00:00 1969 +++ linux.dev/net/802_1Q/Makefile Fri Dec 29 19:51:33 2000 @@ -0,0 +1,26 @@ +# +# Makefile for the Linux Ethernet layer. +# +# Note! Dependencies are done automagically by 'make dep', which also +# removes any old dependencies. DON'T put your own dependencies here +# unless it's something special (ie not a .c file). +# +# Note 2! The CFLAGS definition is now in the main makefile... + +O_TARGET := 802_1Q.o + +OBJS := vlan.o vlanproc.o vlan_dev.o + +ifeq ($(CONFIG_SYSCTL),y) +OBJS += sysctl_net_vlan.o +endif + + +ifdef CONFIG_NET +O_OBJS := $(OBJS) $(OBJ2) +endif + +include $(TOPDIR)/Rules.make + +tar: + tar -cvf /dev/f1 . 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 --- linux/net/802_1Q/sysctl_net_vlan.c Wed Dec 31 17:00:00 1969 +++ linux.dev/net/802_1Q/sysctl_net_vlan.c Fri Dec 29 19:51:33 2000 @@ -0,0 +1,18 @@ +/* + * sysctl_net_vlan.c: sysctl interface to net Ethernet VLAN subsystem. + * + * Begun Dec 20, 1998, Ben Greear + * + * TODO: What, if anything, should this do?? + */ + +#ifdef CONFIG_VLAN_802_1Q + +#include +#include + +ctl_table ether_vlan_table[] = { + {0} +}; + +#endif diff -u -r -N -X /home/greear/exclude.list linux/net/802_1Q/vlan.c linux.dev/net/802_1Q/vlan.c --- linux/net/802_1Q/vlan.c Wed Dec 31 17:00:00 1969 +++ linux.dev/net/802_1Q/vlan.c Sun Jan 14 14:55:46 2001 @@ -0,0 +1,447 @@ +/* -*- linux-c -*- + * INET An implementation of the TCP/IP protocol suite for the LINUX + * operating system. INET is implemented using the BSD Socket + * interface as the means of communication with the user level. + * + * Ethernet-type device handling. + * + * Version: @(#)vlan.c started 12/21/98 + * + * Authors: Ben Greear , + * + * Fixes: + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License + * as published by the Free Software Foundation; either version + * 2 of the License, or (at your option) any later version. + */ + +#include /* for copy_from_user */ +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#include +#include "vlan.h" +#include "vlanproc.h" + +extern int register_netdevice(struct device *dev); /* found in dev.c */ +extern int unregister_netdevice(struct device *dev); /* found in dev.c */ +extern int dev_new_index(void); /* dev.c */ + +extern int eth_header_parse(struct sk_buff *skb, unsigned char *haddr); /* eth.c */ + +extern struct Qdisc noqueue_qdisc; + +/* Global VLAN variables */ + +/* Our listing of VLAN group(s) */ +struct vlan_group *p802_1Q_vlan_list = NULL; + +static char vlan_fullname[] = "802.1Q VLAN Support"; +static unsigned int vlan_version = 1; +static unsigned int vlan_release = 0; +static char vlan_copyright[] = "(c) 2000 Ben Greear (GPL)"; + +/** These may be changed at run-time through IOCTLs */ +unsigned short vlan_name_type = 0; /* determines interface naming scheme */ +unsigned long vlan_bad_proto_recvd = 0; /* Counter for how many NON-VLAN protos we've received on a VLAN. */ + + +static struct packet_type vlan_packet_type = +{ + 0, /* MUTTER ntohs(ETH_P_802_1Q),*/ + NULL, + vlan_dev_type_trans, /* VLAN receive method */ + NULL, + NULL, +}; + +/* End of global variables definitions. */ + +#ifdef MODULE + +/* + * Kernel Loadable Module Entry Points + * + * Module 'insert' entry point. + * o print announcement + * o initialize static data + * o create /proc/net/vlan directory and static entries + * + * Return: 0 Ok + * < 0 error. + * Context: process + */ +int init_module (void) { + printk(VLAN_INF __FUNCTION__); + + vlan_proto_init(NULL); + return 0; +} + +/* + * Module 'remove' entry point. + * o delete /proc/net/router directory and static entries. + */ +void cleanup_module (void) { + vlan_proto_cleanup(); // TODO: Define this so modules work. +} + +#else + + +/** Non-module init entry point. */ +__initfunc(void vlan_system_init(void)) { + printk(VLAN_INF __FUNCTION__); + + /* protocol initialization */ + vlan_proto_init(NULL); + +} +#endif + +/* + * Function vlan_proto_init (pro) + * + * Initialize VLAN protocol layer, + * + */ +void vlan_proto_init(struct net_proto *pro) { + + int err; + printk(VLAN_INF "%s v%u.%u %s\n", + vlan_fullname, vlan_version, vlan_release, vlan_copyright); + + /* proc file system initialization */ + err = vlan_proc_init(); + if (err < 0) { + printk(KERN_ERR __FUNCTION__ + "%s: can't create entry in proc filesystem!\n", VLAN_NAME); + } + + /* network byte order!! */ + vlan_packet_type.type = htons(ETH_P_802_1Q); + dev_add_pack(&vlan_packet_type); + printk(VLAN_INF "%s Initialization complete.\n", VLAN_NAME); +} + + + +/** Will search linearly for now, based on device index. Could + * hash, or directly link, this some day. --Ben + */ +struct vlan_group* vlan_find_group(int real_dev_ifindex) { + struct vlan_group* grp = NULL; + + for (grp = p802_1Q_vlan_list; + ((grp != NULL) && (grp->real_dev_ifindex != real_dev_ifindex)); + grp = grp->next) { +#ifdef VLAN_DEBUG + printk(VLAN_DBG __FUNCTION__ ": grp_idx: %i real_dev_idx: %i\n", + grp->real_dev_ifindex, real_dev_ifindex); +#endif + ; + } /* for */ + + return grp; +} + +/* Find the protocol handler. Assumes VID < 0xFFF. + */ +struct device *find_802_1Q_vlan_dev(struct device* real_dev, unsigned short VID) { + + struct vlan_group* grp = vlan_find_group(real_dev->ifindex); + +#ifdef VLAN_DEBUG + printk(VLAN_DBG __FUNCTION__ ": idx: %i grp: %p\n", real_dev->ifindex, grp); +#endif + + /* When here, we have found the correct group, if it exists. */ + + if (grp) { /* then we found one */ + return grp->vlan_devices[VID]; /* return the vlan device */ + }//if + + return NULL; +}/* find_802_1Q_vlan_dev */ + + + +int unregister_802_1Q_vlan_dev(int real_dev_ifindex, unsigned short vlan_id) { + struct vlan_group* grp; + struct device* dev = NULL; + +#ifdef VLAN_DEBUG + printk(VLAN_DBG __FUNCTION__ ": VID: %i\n", vlan_id); +#endif + + /* sanity check */ + if ((vlan_id >= 0xFFF) || (vlan_id <= 0)) { + return -EINVAL; + } + + grp = vlan_find_group(real_dev_ifindex); + /* When here, we have found the correct group, if it exists. */ + + if (grp) { + dev = grp->vlan_devices[vlan_id]; + if (dev) { + + /* Remove proc entry */ + vlan_proc_rem_dev(dev); + + /* take it out of our own structures */ + grp->vlan_devices[vlan_id] = NULL; + + /* Take it out of the global list of devices. + * NOTE: This deletes dev, don't access it again!! + */ + unregister_netdevice(dev); + + }/* if */ + }/* if */ + return 0; +}/* unregister vlan device */ + + + +int unregister_802_1Q_vlan_device(const char* vlan_IF_name) { + struct device* dev = NULL; + +#ifdef VLAN_DEBUG + printk(VLAN_DBG __FUNCTION__ ": unregister VLAN by name, name -:%s:-\n", + vlan_IF_name); +#endif + + dev = dev_get(vlan_IF_name); + + if (dev && dev->vlan_dev) { + return unregister_802_1Q_vlan_dev(dev->vlan_dev->real_dev->ifindex, + (unsigned short)(dev->vlan_dev->vlan_id)); + } + else { +#ifdef VLAN_DEBUG + printk(VLAN_DBG __FUNCTION__ ": WARNING: Could not find dev\n"); +#endif + return -EINVAL; + } +}/* unregister vlan device */ + + +/* + TODO: This for modules or something?? --BLG + + EXPORT_SYMBOL(register_802_1Q_vlan_device); + EXPORT_SYMBOL(unregister_802_1Q_vlan_device); + +*/ + +/* Attach a VLAN device to a mac address (ie Ethernet Card). + * Returns the device that was created, or NULL if there was + * an error of some kind. + */ +struct device *register_802_1Q_vlan_device(const char* eth_IF_name, + unsigned short VLAN_ID) { + struct vlan_group* grp; + struct device *new_dev; + struct device *real_dev; /* the ethernet device */ + int malloc_size = 0; + +#ifdef VLAN_DEBUG + printk(VLAN_DBG __FUNCTION__ ": if_name -:%s:- vid: %i\n", + eth_IF_name, VLAN_ID); +#endif + + /* find the device relating to eth_IF_name. + * TODO: Make sure it's an ethernet device. */ + real_dev = dev_get(eth_IF_name); + + if (real_dev != NULL) { + /* printk(KERN_ALERT "Found real_dev"); */ + + if ((VLAN_ID > 0) && (VLAN_ID < 0xFFF)) { + + /* printk(KERN_ALERT "VID is in range"); */ + + if (find_802_1Q_vlan_dev(real_dev, VLAN_ID)) { + /* was already registered. */ + printk(VLAN_DBG __FUNCTION__ ": ALREADY had VLAN registered\n"); + return NULL; + } + + malloc_size = (sizeof(struct device)); + + new_dev = (struct device*) kmalloc(malloc_size, GFP_KERNEL); + VLAN_MEM_DBG("device malloc, addr: %p size: %i\n", new_dev, malloc_size); + + if (new_dev != NULL) { + /* printk(KERN_ALERT "Got a new device.."); */ + + memset(new_dev, 0, malloc_size); /* zero everything out */ + + /* set us up to not use a Qdisc, as the underlying Hardware device + * can do all the queueing we could want. + */ + new_dev->qdisc_sleeping = &noqueue_qdisc; + + /* Gotta set up the fields for the device. */ + new_dev->name = (char*)(kmalloc(IFNAMSIZ + 1, GFP_KERNEL)); + VLAN_MEM_DBG("new_dev->name malloc, addr: %p size: %i\n", new_dev->name, IFNAMSIZ + 1); + + if (new_dev->name) { + memset(new_dev->name, 0, IFNAMSIZ + 1); /* zero everything out */ + } + else { + kfree(new_dev); + VLAN_FMEM_DBG("new_dev free, addr: %p\n", new_dev); + return NULL; + } + + if (vlan_name_type == VLAN_NAME_TYPE_RAW_PLUS_VID) { + /* name will look like: eth1.0005 */ + sprintf(new_dev->name, "%s.%.4i", real_dev->name, VLAN_ID); + } + else if (vlan_name_type == VLAN_NAME_TYPE_PLUS_VID_NO_PAD) { + /* Put our vlan.VID in the name. Name will look like: vlan5 */ + sprintf(new_dev->name, "vlan%i", VLAN_ID); + } + else if (vlan_name_type == VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD) { + /* Put our vlan.VID in the name. Name will look like: eth0.5 */ + sprintf(new_dev->name, "%s.%i", real_dev->name, VLAN_ID); + } + else { /* (vlan_name_type == VLAN_NAME_TYPE_PLUS_VID) { */ + /* Put our vlan.VID in the name. Name will look like: vlan0005 */ + /* default case */ + sprintf(new_dev->name, "vlan%.4i", VLAN_ID); + } + + +#ifdef VLAN_DEBUG + printk(VLAN_DBG "Allocated new name -:%s:-\n", new_dev->name); +#endif + /* set up method calls */ + new_dev->init = vlan_dev_init; + new_dev->destructor = vlan_dev_destruct; + + /* new_dev->ifindex = 0; it will be set when added to + * the global list. + * iflink is set as well. */ + + new_dev->get_stats = vlan_dev_get_stats; + + /* IFF_BROADCAST|IFF_MULTICAST; ??? */ + new_dev->flags = real_dev->flags; + new_dev->flags &= ~IFF_UP; + + /* need 4 bytes for extra VLAN header info, hope + * underlying device can handle it. */ + new_dev->mtu = real_dev->mtu; + + new_dev->type = real_dev->type; /* TODO: is this true? */ + + /* Regular ethernet + 4 bytes (18 total). */ + new_dev->hard_header_len = VLAN_ETH_HLEN; + + new_dev->priv = kmalloc(sizeof(struct net_device_stats), + GFP_KERNEL); + VLAN_MEM_DBG("new_dev->priv malloc, addr: %p size: %i\n", new_dev->priv, + sizeof(struct net_device_stats)); + + if (new_dev->priv) { + memset(new_dev->priv, 0, sizeof(struct net_device_stats)); + }//if + + memcpy(new_dev->broadcast, real_dev->broadcast, real_dev->addr_len); + memcpy(new_dev->dev_addr, real_dev->dev_addr, real_dev->addr_len); + new_dev->addr_len = real_dev->addr_len; + + new_dev->open = vlan_dev_open; + new_dev->stop = vlan_dev_stop; + new_dev->hard_header = vlan_dev_hard_header; + /*new_dev->hard_header_cache = vlan_header_cache;*/ + /*new_dev->header_cache_update = vlan_header_cache_update;*/ + new_dev->hard_start_xmit = vlan_dev_hard_start_xmit; + new_dev->rebuild_header = vlan_dev_rebuild_header; + new_dev->hard_header_parse = eth_header_parse; /* trivial. */ + new_dev->set_mac_address = vlan_dev_set_mac_address; + new_dev->set_multicast_list = vlan_dev_set_multicast_list; + + new_dev->vlan_dev = (struct vlan_dev_info*) kmalloc(sizeof(struct vlan_dev_info), + GFP_KERNEL); + VLAN_MEM_DBG("new_dev->vlan_dev malloc, addr: %p size: %i\n", new_dev->vlan_dev, + sizeof(struct vlan_dev_info)); + if (new_dev->vlan_dev == NULL) { + kfree(new_dev->priv); + VLAN_FMEM_DBG("new_dev->priv free, addr: %p\n", new_dev->priv); + kfree(new_dev->name); + VLAN_FMEM_DBG("new_dev->name free, addr: %p\n", new_dev->name); + kfree(new_dev); + VLAN_FMEM_DBG("new_dev free, addr: %p\n", new_dev); + return NULL; + } + else { + /* Initialize it. */ + memset(new_dev->vlan_dev, 0, sizeof(struct vlan_dev_info)); + + new_dev->vlan_dev->vlan_id = VLAN_ID; /* 1 through 0xFFF */ + /* TODO: have to be careful deleting real devices now. */ + new_dev->vlan_dev->real_dev = real_dev; + + memset(&(new_dev->vlan_dev->dent), 0, sizeof(struct proc_dir_entry)); + } + + /* So, got the sucker initialized, now lets place it into our local + * structure. + */ + + grp = vlan_find_group(real_dev->ifindex); + + /* When here, we have found the correct group, if it exists. */ + + if (!grp) { /* need to add a new group */ + /* printk(VLAN_DBG "VLAN REGISTER: " + "Need to add new vlan group.\n");*/ + + grp = kmalloc(sizeof(struct vlan_group), GFP_KERNEL); + VLAN_MEM_DBG("grp malloc, addr: %p size: %i\n", grp, sizeof(struct vlan_group)); + + if (grp) { + printk(KERN_ALERT "VLAN REGISTER: Allocated new group, idx: %i\n", + real_dev->ifindex); + memset(grp, 0, sizeof(struct vlan_group)); + grp->real_dev_ifindex = real_dev->ifindex; + grp->next = p802_1Q_vlan_list; + p802_1Q_vlan_list = grp; + } + else { + kfree(new_dev->name); + VLAN_FMEM_DBG("new_dev->name free, addr: %p\n", new_dev->name); + kfree(new_dev->priv); + VLAN_FMEM_DBG("new_dev->priv free, addr: %p\n", new_dev->priv); + kfree(new_dev); + VLAN_FMEM_DBG("new_dev free, addr: %p\n", new_dev); + return NULL; + } + }/* if */ + + grp->vlan_devices[VLAN_ID] = new_dev; + + /* Now, add it to the global list of devices. */ + /* printk(KERN_ALERT "Registering new device."); */ + register_netdevice(new_dev); + vlan_proc_add_dev(new_dev); /* create it's proc entry */ + return new_dev; + } + }//if + }//if + + return NULL; +}/* register (create) VLAN device */ diff -u -r -N -X /home/greear/exclude.list linux/net/802_1Q/vlan.h linux.dev/net/802_1Q/vlan.h --- linux/net/802_1Q/vlan.h Wed Dec 31 17:00:00 1969 +++ linux.dev/net/802_1Q/vlan.h Sun Jan 14 14:30:56 2001 @@ -0,0 +1,44 @@ +#ifndef __BEN_VLAN_802_1Q_INC__ +#define __BEN_VLAN_802_1Q_INC__ + +#include + +/* If this is undefined, the name will look like: vlan0005 */ +/* #define USE_RAW_IN_NAME Use this one if you like it: eth.0005 */ + +/* Uncomment this if you want debug traces to be shown. */ +/* #define VLAN_DEBUG */ + +#define VLAN_ERR KERN_ERR +#define VLAN_INF KERN_ALERT +#define VLAN_DBG KERN_DEBUG /* change these... to debug, having a hard time + * changing the log level at run-time..for some reason. + */ + +/* + +These I use for memory debugging. I feared a leak at one time, but +I never found it..and the problem seems to have dissappeared. Still, +I'll bet they might prove useful again... --Ben + +#define VLAN_MEM_DBG(x, y, z) printk(VLAN_DBG __FUNCTION__ ": " x, y, z); +#define VLAN_FMEM_DBG(x, y) printk(VLAN_DBG __FUNCTION__ ": " x, y); +*/ + +/* This way they don't do anything! */ +#define VLAN_MEM_DBG(x, y, z) +#define VLAN_FMEM_DBG(x, y) + + +extern unsigned short vlan_name_type; +extern unsigned long vlan_bad_proto_recvd; /* Counter for how many NON-VLAN protos we've received on a VLAN. */ + +/* Add some headers for the public VLAN methods. */ +int unregister_802_1Q_vlan_device(const char* vlan_IF_name); +struct device *register_802_1Q_vlan_device(const char* eth_IF_name, + unsigned short VID); + +void vlan_system_init(void); +void vlan_proto_init(struct net_proto *pro); + +#endif diff -u -r -N -X /home/greear/exclude.list linux/net/802_1Q/vlan_dev.c linux.dev/net/802_1Q/vlan_dev.c --- linux/net/802_1Q/vlan_dev.c Wed Dec 31 17:00:00 1969 +++ linux.dev/net/802_1Q/vlan_dev.c Sun Jan 14 19:21:08 2001 @@ -0,0 +1,766 @@ +/* -*- linux-c -*- + * INET An implementation of the TCP/IP protocol suite for the LINUX + * operating system. INET is implemented using the BSD Socket + * interface as the means of communication with the user level. + * + * Ethernet-type device handling. + * + * Version: @(#)vlan_dev.c Started 3/29/99 + * + * Authors: Ben Greear , + * + * Fixes: + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License + * as published by the Free Software Foundation; either version + * 2 of the License, or (at your option) any later version. + */ + +#include /* for copy_from_user */ +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include "vlan.h" +#include "vlanproc.h" +#include +#include +#include + + +struct net_device_stats* vlan_dev_get_stats(struct device* dev) { + return (struct net_device_stats*)(dev->priv); +} + + +/* + * Rebuild the Ethernet MAC header. This is called after an ARP + * (or in future other address resolution) has completed on this + * sk_buff. We now let ARP fill in the other fields. + * + * This routine CANNOT use cached dst->neigh! + * Really, it is used only when dst->neigh is wrong. + * + * TODO: This needs a checkup, I'm ignorant here. --BLG + */ +int vlan_dev_rebuild_header(struct sk_buff *skb) { + + struct device *dev = skb->dev; + struct vlan_ethhdr *veth = (struct vlan_ethhdr*)(skb->data); + + switch (veth->h_vlan_encapsulated_proto) + { +#ifdef CONFIG_INET + case __constant_htons(ETH_P_IP): + + /* TODO: Confirm this will work with VLAN headers... */ + return arp_find(veth->h_dest, skb); +#endif + default: + printk(VLAN_DBG + "%s: unable to resolve type %X addresses.\n", + dev->name, (int)veth->h_vlan_encapsulated_proto); + + memcpy(veth->h_source, dev->dev_addr, ETH_ALEN); + break; + }/* switch */ + + return 0; +}/* vlan_dev_rebuild_header */ + + + +/* + * Determine the packet's protocol ID. The rule here is that we + * assume 802.3 if the type field is short enough to be a length. + * This is normal practice and works for any 'now in use' protocol. + * + * Also, at this point we assume that we ARE dealing exclusively with + * VLAN packets, or packets that should be made into VLAN packets based + * on a default VLAN ID. + * + * NOTE: Should be similar to ethernet/eth.c. + * + * SANITY NOTE: This method is called when a packet is moving up the stack + * towards userland. To get here, it would have already passed + * through the ethernet/eth.c eth_type_trans() method. + */ +int vlan_dev_type_trans(struct sk_buff *skb, struct device *dev, + struct packet_type* ptype) { + unsigned char* rawp = NULL; + struct vlan_ethhdr *veth = (struct vlan_ethhdr*)(skb->mac.ethernet); + unsigned short vid = 0; + struct net_device_stats* stats; + + /* Do we have a VLAN packet? If not, then throw it away, after printing an error. + * + */ + if (veth->h_vlan_proto != __constant_htons(ETH_P_802_1Q)) { + printk(VLAN_INF __FUNCTION__ ": VLAN device received NON-VLAN protocol: %hx\n", htons(veth->h_vlan_proto)); + vlan_bad_proto_recvd++; + kfree_skb(skb); + return -EINVAL; + } + else { + vid = ((unsigned short)(ntohs(veth->h_vlan_TCI)) & 0xFFF); + } + +#ifdef VLAN_DEBUG + printk(VLAN_DBG __FUNCTION__ ": skb: %p vlan_id: %hx dev: %s, encap_proto: %hx\n", + skb, vid, dev->name, veth->h_vlan_encapsulated_proto); +#endif + + /* Ok, we will find the correct VLAN device, strip the header, + and then go on as usual. + */ + + /* we have 12 bits of vlan ID. */ + /* If it's NULL, we will tag the skb to be junked below */ + skb->dev = find_802_1Q_vlan_dev(dev, vid); + + if (!skb->dev) { +#ifdef VLAN_DEBUG + printk(VLAN_DBG __FUNCTION__ ": ERROR: No device for VID: %i on dev: %s [%i]\n", + (unsigned int)(vid), dev->name, dev->ifindex); +#endif + kfree_skb(skb); + return -1; + } + + stats = (struct net_device_stats*)(skb->dev->priv); + + /* + * Deal with ingress priority mapping. + */ + skb->priority = skb->dev->vlan_dev->ingress_priority_map[(ntohs(veth->h_vlan_TCI) >> 13) & 0x7]; + +#ifdef VLAN_DEBUG + printk(VLAN_DBG __FUNCTION__ ": priority: %lu for TCI: %hu (hbo) on vlan_dev: %s\n", + (unsigned long)(skb->priority), ntohs(veth->h_vlan_TCI), skb->dev->name); +#endif + + /* Bump the rx counters for the VLAN device. */ + stats->rx_packets++; + stats->rx_bytes += skb->len; + + /* NOTE: The underlying device SHOULD NOT PULL THE MAC BYTES OFF. + (it doesn't seem to.) + */ + skb_pull(skb, VLAN_ETH_HLEN); /* take off the VLAN header */ + + + /* VLAN and regular Ethernet headers have the addresses in the same place. + * TODO: Add code to deal with VLAN control packets?? --BLG + * Is there such a thing?? + */ + if (*(veth->h_dest) & 1) { + stats->multicast++; + if (memcmp(veth->h_dest, dev->broadcast, ETH_ALEN) == 0) + skb->pkt_type = PACKET_BROADCAST; + else + skb->pkt_type = PACKET_MULTICAST; + } + + /* + * This ALLMULTI check should be redundant by 1.4 + * so don't forget to remove it. + * + * Seems, you forgot to remove it. All silly devices + * seems to set IFF_PROMISC. + */ + + else if (dev->flags & (IFF_PROMISC/*|IFF_ALLMULTI*/)) { + if (memcmp(veth->h_dest, dev->dev_addr, ETH_ALEN) != 0) + skb->pkt_type = PACKET_OTHERHOST; + } + + /* Was a VLAN packet, grab the encapsulated protocol, which the layer + * three protocols care about. + */ + if (ntohs(veth->h_vlan_encapsulated_proto) >= 1536) { + + skb->protocol = veth->h_vlan_encapsulated_proto; + /* place it back on the queue to be handled by true layer 3 protocols. + */ + + /* See if we are configured to re-write the VLAN header to make it look like + * ethernet... + */ + if (skb->dev->vlan_dev->flags & 1) { + /* Lifted from Gleb's VLAN code... */ + memmove(skb->data - (VLAN_ETH_HLEN - 4), skb->data - VLAN_ETH_HLEN, 12); + skb->mac.raw += 4; + } + netif_rx(skb); + return 0; + } + + rawp = skb->data; + + /* + * This is a magic hack to spot IPX packets. Older Novell breaks + * the protocol design and runs IPX over 802.3 without an 802.2 LLC + * layer. We look for FFFF which isn't a used 802.2 SSAP/DSAP. This + * won't work for fault tolerant netware but does for the rest. + */ + if (*(unsigned short *)rawp == 0xFFFF) { + skb->protocol = __constant_htons(ETH_P_802_3); + /* place it back on the queue to be handled by true layer 3 protocols. + */ + + /* See if we are configured to re-write the VLAN header to make it look like + * ethernet... + */ + if (skb->dev->vlan_dev->flags & 1) { + /* Lifted from Gleb's VLAN code... */ + memmove(skb->data - (VLAN_ETH_HLEN - 4), skb->data - VLAN_ETH_HLEN, 12); + skb->mac.raw += 4; + } + netif_rx(skb); + return 0; + } + + /* + * Real 802.2 LLC + */ + skb->protocol = __constant_htons(ETH_P_802_2); + /* place it back on the queue to be handled by upper layer protocols. + */ + + /* See if we are configured to re-write the VLAN header to make it look like + * ethernet... + */ + if (skb->dev->vlan_dev->flags & 1) { + /* Lifted from Gleb's VLAN code... */ + memmove(skb->data - (VLAN_ETH_HLEN - 4), skb->data - VLAN_ETH_HLEN, 12); + skb->mac.raw += 4; + } + netif_rx(skb); + return 0; +} + + +/* + * Create the Ethernet VLAN MAC header for an arbitrary protocol layer + * + * saddr=NULL means use device source address + * daddr=NULL means leave destination address (eg unresolved arp) + * + * This is called when the SKB is moving down the stack towards the + * physical devices. + */ +int vlan_dev_hard_header(struct sk_buff *skb, struct device *dev, + unsigned short type, void *daddr, void *saddr, + unsigned len) { + struct vlan_ethhdr *veth; + unsigned short veth_TCI = 0; + +#ifdef VLAN_DEBUG + printk(VLAN_DBG __FUNCTION__ ": skb: %p type: %hx len: %x vlan_id: %hx, daddr: %p\n", + skb, type, len, dev->vlan_dev->vlan_id, daddr); +#endif + + veth = (struct vlan_ethhdr*)skb_push(skb, VLAN_ETH_HLEN); + + /* build the four bytes that make this a VLAN header. */ + + /* first, the ethernet type */ + veth->h_vlan_proto = __constant_htons(ETH_P_802_1Q); + + /* Now, construct the second two bytes. This field looks something + * like: + * usr_priority: 3 bits (high bits) + * CFI 1 bit + * VLAN ID 12 bits (low bits) + * + */ + veth_TCI = dev->vlan_dev->vlan_id; + veth_TCI |= vlan_dev_get_egress_qos_mask(dev, skb); + + veth->h_vlan_TCI = htons(veth_TCI); + + /* Rest should be the same as a normal header. */ + /* + * Set the protocol type. For a packet of type ETH_P_802_3 we put the length + * in here instead. It is up to the 802.2 layer to carry protocol information. + * + */ + + if (type != ETH_P_802_3) + veth->h_vlan_encapsulated_proto = htons(type); + else + veth->h_vlan_encapsulated_proto = htons(len); + + /* + * Set the source hardware address. + */ + + if (saddr) + memcpy(veth->h_source, saddr, ETH_ALEN); + else + memcpy(veth->h_source, dev->dev_addr, ETH_ALEN); + + /* + * Anyway, the loopback-device should never use this function... + * This is especially true with VLAN's. --BLG + */ + + if (dev->flags & (IFF_LOOPBACK | IFF_NOARP)) { + memset(veth->h_dest, 0, ETH_ALEN); + return (VLAN_ETH_HLEN); /* was: dev->hard_header_len */ + } + + if (daddr) { + memcpy(veth->h_dest, daddr, ETH_ALEN); + return (VLAN_ETH_HLEN); /* was: dev->hard_header_len */ + } + + return -(VLAN_ETH_HLEN); /* was: dev->hard_header_len */ + +} /* vlan_hard_header, put on the VLAN hardware header */ + + +int vlan_dev_hard_start_xmit(struct sk_buff *skb, struct device *dev) { + struct net_device_stats* stats = (struct net_device_stats*)(dev->priv); + struct vlan_ethhdr *veth = (struct vlan_ethhdr*)(skb->data); + + /* Handle non-VLAN frames if they are sent to us, for example by DHCP. */ + if (veth->h_vlan_proto != __constant_htons(ETH_P_802_1Q)) { + /* This is not a VLAN frame...but we can fix that! */ + unsigned short veth_TCI = 0; + dev->vlan_dev->cnt_encap_on_xmit++; + + if (skb_headroom(skb) < 4) { + struct sk_buff* sk_tmp = skb; + skb = skb_realloc_headroom(sk_tmp, 4); + kfree_skb(sk_tmp); + if (skb == NULL) { + stats->tx_dropped++; + kfree_skb(sk_tmp); + return -ENOMEM; + } + dev->vlan_dev->cnt_inc_headroom_on_tx++; + } + else { + if( !(skb = skb_unshare(skb, GFP_ATOMIC)) ) { + printk(KERN_ERR "vlan: failed to unshare skbuff\n"); + stats->tx_dropped++; + return -ENOMEM; + } + } + veth = (struct vlan_ethhdr*)skb_push(skb, 4); + + /* Move the mac addresses to the beginning of the new header. */ + memmove(skb->data, skb->data + 4, 12); + + /* first, the ethernet type */ + veth->h_vlan_proto = __constant_htons(ETH_P_802_1Q); + + /* Now, construct the second two bytes. This field looks something + * like: + * usr_priority: 3 bits (high bits) + * CFI 1 bit + * VLAN ID 12 bits (low bits) + * + */ + veth_TCI = dev->vlan_dev->vlan_id; + veth_TCI |= vlan_dev_get_egress_qos_mask(dev, skb); + + veth->h_vlan_TCI = htons(veth_TCI); + }/* If we needed to encapsulate the frame */ + + skb->dev = dev->vlan_dev->real_dev; + + +#ifdef VLAN_DEBUG + printk(VLAN_DBG __FUNCTION__ ": about to send skb: %p to dev: %s\n", skb, skb->dev->name); +#endif + + dev_queue_xmit(skb); + stats->tx_packets++; /* for statics only */ + stats->tx_bytes += skb->len; + return 0; +}/* vlan_dev_hard_start_xmit */ + + +int vlan_dev_change_mtu(struct device *dev, int new_mtu) { + /* TODO: gotta make sure the underlying layer can handle it, + * maybe an IFF_VLAN_CAPABLE flag for devices? + */ + + dev->mtu = new_mtu; + return new_mtu; +} + +int vlan_dev_open(struct device* dev) { + dev->flags |= IFF_UP; + return 0; +} + +int vlan_dev_stop(struct device* dev) { + dev->flags &= ~IFF_UP; + return 0; +} + +int vlan_dev_init(struct device* dev) { + /* TODO: figure this out, maybe do nothing?? */ + return 0; +} + +void vlan_dev_destruct(struct device* dev) { + kfree(dev->name); + VLAN_FMEM_DBG("dev->name free, addr: %p\n", dev->name); + dev->name = NULL; /* better safe than hosed */ + + kfree(dev->priv); + VLAN_FMEM_DBG("dev->priv free, addr: %p\n", dev->priv); + dev->priv = NULL; + + kfree(dev->vlan_dev); + VLAN_FMEM_DBG("dev->vlan_dev free, addr: %p\n", dev->vlan_dev); + dev->vlan_dev = NULL; + + kfree(dev); + VLAN_FMEM_DBG("device free, addr: %p\n", dev); + dev = NULL; + + return; +} + + +/* TODO: Not to sure if the VLAN stuff works here. Need to understand + * this better. --BLG + */ +/* +int vlan_dev_header_cache(struct neighbour *neigh, struct hh_cache *hh) { + unsigned short type = hh->hh_type; + struct vlan_ethhdr *veth = (struct vlan_ethhdr*)(((u8*)hh->hh_data) + 2); + struct device *dev = neigh->dev; + + if (type == __constant_htons(ETH_P_802_3)) { + return -1; + } + + veth->h_vlan_proto = __constant_htons(ETH_P_802_1Q); + memcpy(veth->h_source, dev->dev_addr, ETH_ALEN); + memcpy(veth->h_dest, neigh->ha, ETH_ALEN); + + * VLAN specific attributes. * + veth->h_vlan_TCI = htons(dev->VLAN_id); * TODO: Add priority control (high 3 bits.) * + veth->h_vlan_encapsulated_proto = type; * should already be in network order * + + return 0; +} +*/ + +/* + * Called by Address Resolution module to notify changes in address. + */ +/* +void vlan_dev_header_cache_update(struct hh_cache *hh, struct device *dev, + unsigned char * haddr) { + memcpy(((u8*)hh->hh_data) + 2, haddr, VLAN_ETH_HLEN); +} +*/ + +#ifndef CONFIG_IP_ROUTER + +/* + * Copy from an ethernet device memory space to an sk_buff while + * checksumming if IP + * + * TODO: Find out who calls this: This was lifted from eth.c, and + * was called eth_copy_and_sum. --BLG + */ + +void vlan_dev_copy_and_sum(struct sk_buff *dest, unsigned char *src, + int length, int base) { + struct vlan_ethhdr* veth; + struct iphdr *iph; + int ip_length; + + veth = (struct vlan_ethhdr*)(src); + + /* This grabs the VLAN part of the header too. */ + if (veth->h_vlan_encapsulated_proto != __constant_htons(ETH_P_IP)) { + memcpy(dest->data, src, length); + return; + } + + /* + * We have to watch for padded packets. The csum doesn't include the + * padding, and there is no point in copying the padding anyway. + * We have to use the smaller of length and ip_length because it + * can happen that ip_length > length. + */ + + /* ethernet is always >= 34 */ + memcpy(dest->data, src, sizeof(struct iphdr) + VLAN_ETH_HLEN); + + length -= sizeof(struct iphdr) + VLAN_ETH_HLEN; + iph = (struct iphdr*)(src + VLAN_ETH_HLEN); + ip_length = ntohs(iph->tot_len) - sizeof(struct iphdr); + + /* Also watch out for bogons - min IP size is 8 (rfc-1042) */ + if ((ip_length <= length) && (ip_length > 7)) + length=ip_length; + + dest->csum = csum_partial_copy(src + sizeof(struct iphdr) + VLAN_ETH_HLEN, + dest->data + sizeof(struct iphdr) + VLAN_ETH_HLEN, + length, base); + dest->ip_summed=1; + +} /* vlan_copy_and_sum */ + +#endif //! CONFIG_IP_ROUTER + + +int vlan_dev_set_ingress_priority(char* dev_name, __u32 skb_prio, short vlan_prio) { + struct device* dev = dev_get(dev_name); + + if (dev) { + if (dev->vlan_dev) { /* can't put a dflt ID on a vlan device */ + /* see if a priority mapping exists.. */ + dev->vlan_dev->ingress_priority_map[vlan_prio & 0x7] = skb_prio; + return 0; + } + } + return -EINVAL; +} + +int vlan_dev_set_egress_priority(char* dev_name, __u32 skb_prio, short vlan_prio) { + struct device* dev = dev_get(dev_name); + struct vlan_priority_tci_mapping* mp = NULL; + struct vlan_priority_tci_mapping* np; + + if (dev) { + if (dev->vlan_dev) { /* can't put a dflt ID on a vlan device */ + /* see if a priority mapping exists.. */ + mp = dev->vlan_dev->egress_priority_map[skb_prio & 0xF]; + while (mp) { + if (mp->priority == skb_prio) { + mp->vlan_qos = ((vlan_prio << 13) & 0xE000); + return 0; + } + } + /* create a new mapping then. */ + mp = dev->vlan_dev->egress_priority_map[skb_prio & 0xF]; + np = kmalloc(sizeof(struct vlan_priority_tci_mapping), GFP_KERNEL); + if (np) { + np->next = mp; + np->priority = skb_prio; + np->vlan_qos = ((vlan_prio << 13) & 0xE000); + dev->vlan_dev->egress_priority_map[skb_prio & 0xF] = np; + return 0; + } + else { + return -ENOBUFS; + } + } + } + return -EINVAL; +} + +/* Flags are defined in the vlan_dev_info class in include/linux/if_vlan.h file. */ +int vlan_dev_set_vlan_flag(char* dev_name, __u32 flag, short flag_val) { + struct device* dev = dev_get(dev_name); + + if (dev) { + if (dev->vlan_dev) { + /* verify flag is supported */ + if (flag == 1) { + if (flag_val) { + dev->vlan_dev->flags |= 1; + } + else { + dev->vlan_dev->flags &= ~1; + } + return 0; + } + else { + return -EINVAL; + } + }/* if it's a vlan device */ + }/* if we found the device */ + return -EINVAL; +} + + +int vlan_dev_set_mac_address(struct device *dev, void* addr_struct_p) { + int i; + struct sockaddr *addr = (struct sockaddr*)(addr_struct_p); + + if (dev->start) { + return -EBUSY; + } + + memcpy(dev->dev_addr, addr->sa_data, dev->addr_len); + + printk("%s: Setting MAC address to ", dev->name); + for (i = 0; i < 6; i++) { + printk(" %2.2x", dev->dev_addr[i]); + } + printk(".\n"); + + if (memcmp(dev->vlan_dev->real_dev->dev_addr, dev->dev_addr, dev->addr_len) != 0) { + if (dev->vlan_dev->real_dev->flags & IFF_PROMISC) { + /* Already promiscious...leave it alone. */ + printk("VLAN (%s): Good, underlying device (%s) is already promiscious.\n", + dev->name, dev->vlan_dev->real_dev->name); + } + else { + int flgs = dev->vlan_dev->real_dev->flags; + printk("VLAN (%s): Setting underlying device (%s) to promiscious mode.\n", + dev->name, dev->vlan_dev->real_dev->name); + flgs |= IFF_PROMISC; + dev_change_flags(dev->vlan_dev->real_dev, flgs); + /* This should work, but doesn't: + dev_set_promiscuity(dev->vlan_dev->real_dev, 1); + */ + } + } + else { + printk("VLAN (%s): Underlying device (%s) has same MAC, not checking promiscious mode.\n", + dev->name, dev->vlan_dev->real_dev->name); + } + return 0; +} + + +/** Taken from Gleb + Lennert's VLAN code, and modified... */ +void vlan_dev_set_multicast_list(struct device *vlan_dev) { + struct dev_mc_list *dmi; + struct device *real_dev; + int inc; + + if (vlan_dev && vlan_dev->vlan_dev) { + /* Then it's a real vlan device, as far as we can tell.. */ + real_dev = vlan_dev->vlan_dev->real_dev; + + /* compare the current promiscuity to the last promisc we had.. */ + inc = vlan_dev->promiscuity - vlan_dev->vlan_dev->old_promiscuity; + + if (inc) { + printk(KERN_INFO "vlan: dev_set_promiscuity(master, %d)\n", inc); + dev_set_promiscuity(real_dev, inc); /* found in dev.c */ + vlan_dev->vlan_dev->old_promiscuity = vlan_dev->promiscuity; + } + + inc = vlan_dev->allmulti - vlan_dev->vlan_dev->old_allmulti; + + if (inc) { + printk(KERN_INFO "vlan: dev_set_allmulti(master, %d)\n", inc); + dev_set_allmulti(real_dev, inc); /* dev.c */ + vlan_dev->vlan_dev->old_allmulti = vlan_dev->allmulti; + } + + /* looking for addresses to add to master's list */ + for (dmi = vlan_dev->mc_list; dmi!=NULL; dmi=dmi->next) { + if (vlan_should_add_mc(dmi, vlan_dev->vlan_dev->old_mc_list)) { + dev_mc_add(real_dev, dmi->dmi_addr, dmi->dmi_addrlen, 0); + printk(KERN_INFO "vlan: add %.2x:%.2x:%.2x:%.2x:%.2x:%.2x mcast address to master interface\n", + dmi->dmi_addr[0], + dmi->dmi_addr[1], + dmi->dmi_addr[2], + dmi->dmi_addr[3], + dmi->dmi_addr[4], + dmi->dmi_addr[5]); + } + } + + /* looking for addresses to delete from master's list */ + for (dmi = vlan_dev->mc_list; dmi!=NULL; dmi=dmi->next) { + if (vlan_should_add_mc(dmi, vlan_dev->mc_list)) { + /* if we think we should add it to the new list, then we should really + * delete it from the real list on the underlying device. + */ + dev_mc_delete(real_dev, dmi->dmi_addr, dmi->dmi_addrlen, 0); + printk(KERN_INFO "vlan: del %.2x:%.2x:%.2x:%.2x:%.2x:%.2x mcast address from master interface\n", + dmi->dmi_addr[0], + dmi->dmi_addr[1], + dmi->dmi_addr[2], + dmi->dmi_addr[3], + dmi->dmi_addr[4], + dmi->dmi_addr[5]); + } + } + + /* save multicast list */ + vlan_copy_mc_list(vlan_dev->mc_list, vlan_dev->vlan_dev); + }/* if we were sent a valid device */ +}/* vlan_dev_set_multicast */ + + +/** dmi is a single entry into a dev_mc_list, a single node. mc_list is + * an entire list, and we'll iterate through it. + */ +int vlan_should_add_mc(struct dev_mc_list *dmi, struct dev_mc_list *mc_list) { + struct dev_mc_list *idmi; /* iterator */ + + for (idmi=mc_list; idmi!=NULL;) { + if (vlan_dmi_equals(dmi, idmi)) { + if (dmi->dmi_users > idmi->dmi_users) + return 1; + else + return 0; + } + else { + idmi = idmi->next; + } + } + + return 1; +} + + +void vlan_copy_mc_list(struct dev_mc_list *mc_list, struct vlan_dev_info *vlan_info) { + struct dev_mc_list *dmi, *new_dmi; + + vlan_destroy_mc_list(vlan_info->old_mc_list); + vlan_info->old_mc_list = NULL; + + for (dmi=mc_list; dmi!=NULL; dmi=dmi->next) { + new_dmi = kmalloc(sizeof(*new_dmi), GFP_KERNEL); + if (new_dmi == NULL) { + printk(KERN_ERR "vlan: cannot allocate memory. Multicast may not work properly from now.\n"); + return; + } + + new_dmi->next = vlan_info->old_mc_list; + vlan_info->old_mc_list = new_dmi; + + new_dmi->dmi_addrlen = dmi->dmi_addrlen; + memcpy(new_dmi->dmi_addr, dmi->dmi_addr, dmi->dmi_addrlen); + new_dmi->dmi_users = dmi->dmi_users; + new_dmi->dmi_gusers = dmi->dmi_gusers; + } +} + +void vlan_flush_mc_list(struct device *dev) { + struct dev_mc_list *dmi = dev->mc_list; + + while (dmi) { + dev_mc_delete(dev, dmi->dmi_addr, dmi->dmi_addrlen, 0); + printk(KERN_INFO "vlan: del %.2x:%.2x:%.2x:%.2x:%.2x:%.2x mcast address from master interface\n", + dmi->dmi_addr[0], + dmi->dmi_addr[1], + dmi->dmi_addr[2], + dmi->dmi_addr[3], + dmi->dmi_addr[4], + dmi->dmi_addr[5]); + dmi = dev->mc_list; + } + + vlan_destroy_mc_list(dev->mc_list); + if (dev->vlan_dev) { + vlan_destroy_mc_list(dev->vlan_dev->old_mc_list); + dev->vlan_dev->old_mc_list = NULL; + } + dev->mc_list = NULL; +}/* vlan_flush_mc_list */ diff -u -r -N -X /home/greear/exclude.list linux/net/802_1Q/vlanproc.c linux.dev/net/802_1Q/vlanproc.c --- linux/net/802_1Q/vlanproc.c Wed Dec 31 17:00:00 1969 +++ linux.dev/net/802_1Q/vlanproc.c Fri Dec 29 19:51:33 2000 @@ -0,0 +1,654 @@ +/* * -*- linux-c -*- */ +/***************************************************************************** + * vlanproc.c VLAN Module. /proc filesystem interface. +* +* Author: Ben Greear, coppied from wanproc.c +* by: Gene Kozin +* +* Copyright: (c) 1998-2000 Ben Greear +* +* This program is free software; you can redistribute it and/or +* modify it under the terms of the GNU General Public License +* as published by the Free Software Foundation; either version +* 2 of the License, or (at your option) any later version. +* ============================================================================ +* Jan 20, 1998 Ben Greear Initial Version +*****************************************************************************/ + +#include +#include /* offsetof(), etc. */ +#include /* return codes */ +#include +#include /* kmalloc(), kfree() */ +#include /* verify_area(), etc. */ +#include /* inline mem*, str* functions */ +#include /* __initfunc et al. */ +#include /* kernel <-> user copy */ +#include /* htons(), etc. */ +#include /* copy_to_user */ +#include +#include +#include +#include +#include +#include "vlanproc.h" +#include "vlan.h" + +/****** Defines and Macros **************************************************/ + +#ifndef min +#define min(a,b) (((a)<(b))?(a):(b)) +#endif +#ifndef max +#define max(a,b) (((a)>(b))?(a):(b)) +#endif + + +/****** Function Prototypes *************************************************/ + +#ifdef CONFIG_PROC_FS + +/* Proc filesystem interface */ +static int vlan_proc_perms(struct inode *, int); +static ssize_t vlan_proc_read(struct file* file, char* buf, size_t count, + loff_t *ppos); + +/* Methods for preparing data for reading proc entries */ + +static int vlan_config_get_info(char* buf, char** start, off_t offs, int len, + int dummy); +static int vlandev_get_info(char* buf, char** start, off_t offs, int len, + int dummy); + + +/* Miscellaneous */ + +/* + * Global Data + */ + +/* + * Names of the proc directory entries + */ + +static char name_root[] = "vlan"; +static char name_conf[] = "config"; +static char term_msg[] = "***KERNEL: Out of buffer space!***\n"; + + +/* + * VLAN device IOCTL. + * o execute requested action or pass command to the device driver + */ + +int vlan_ioctl(struct inode* inode, struct file* file, + unsigned int cmd, unsigned long arg) { + int err = 0; + /* + struct proc_dir_entry* dent; + struct device* dev; + */ + struct vlan_ioctl_args args; + + printk(VLAN_DBG __FUNCTION__ ": cmd: %x\n", cmd); + + /* everything here needs root permissions, except aguably the + * hack ioctls for sending packets. However, I know _I_ don't + * want users running that on my network! --BLG + */ + if (!capable(CAP_NET_ADMIN)){ + return -EPERM; + } + + if ((cmd >> 8) != VLAN_IOCTL) { + printk(VLAN_DBG __FUNCTION__ ": Not a VLAN IOCTL: %x \n", cmd); + return -EINVAL; + } + + if (copy_from_user(&args, (void*)arg, sizeof(struct vlan_ioctl_args))) + return -EFAULT; + + /* Null terminate this sucker, just in case. */ + args.dev1[23] = 0; + args.u.dev2[23] = 0; + + /* + dent = inode->u.generic_ip; + if ((dent == NULL) || (dent->data == NULL)) + return -EINVAL; + + dev = dent->data; + */ + + switch (cmd) + { + case SET_INGRESS_PRIORITY_IOCTL: + err = vlan_dev_set_ingress_priority(args.dev1, args.u.skb_priority, args.vlan_qos); + break; + + case SET_EGRESS_PRIORITY_IOCTL: + err = vlan_dev_set_egress_priority(args.dev1, args.u.skb_priority, args.vlan_qos); + break; + + case SET_VLAN_FLAG_IOCTL: + err = vlan_dev_set_vlan_flag(args.dev1, args.u.flag, args.vlan_qos); + break; + + case SET_NAME_TYPE_IOCTL: + if ((args.u.name_type >= 0) && (args.u.name_type < VLAN_NAME_TYPE_HIGHEST)) { + vlan_name_type = args.u.name_type; + err = 0; + } + else { + err = -EINVAL; + } + break; + + /* TODO: Figure out how to pass info back... + case GET_INGRESS_PRIORITY_IOCTL: + err = vlan_dev_get_ingress_priority(args); + break; + + case GET_EGRESS_PRIORITY_IOCTL: + err = vlan_dev_get_egress_priority(args); + break; + */ + + case ADD_VLAN_IOCTL: + /* we have been given the name of the Ethernet Device we want to + * talk to: args.dev1 We also have the + * VLAN ID: args.u.VID + */ + if (register_802_1Q_vlan_device(args.dev1, args.u.VID)) { + err = 0; + } + else { + err = -EINVAL; + } + break; + + case DEL_VLAN_IOCTL: + /* Here, the args.dev1 is the actual VLAN we want to get rid of. */ + + err = unregister_802_1Q_vlan_device(args.dev1); + break; + + default: + /* pass on to underlying device instead?? */ + printk(VLAN_DBG __FUNCTION__ ": Unknown VLAN IOCTL: %x \n", cmd); + return -EINVAL; + }/* switch */ + return err; +} + +/* + * Structures for interfacing with the /proc filesystem. + * VLAN creates its own directory /proc/net/vlan with the folowing + * entries: + * config device status/configuration + * entry for each device + */ + +/* + * Generic /proc/net/vlan/ file and inode operations + */ + +static struct file_operations vlan_fops = { + NULL, /* lseek */ + vlan_proc_read, /* read */ + NULL, /* write */ + NULL, /* readdir */ + NULL, /* select */ + vlan_ioctl, /* ioctl */ + NULL, /* mmap */ + NULL, /* no special open code */ + NULL, /* flush */ + NULL, /* no special release code */ + NULL /* can't fsync */ +}; + +static struct inode_operations vlan_inode = { + &vlan_fops, + NULL, /* create */ + NULL, /* lookup */ + NULL, /* link */ + NULL, /* unlink */ + NULL, /* symlink */ + NULL, /* mkdir */ + NULL, /* rmdir */ + NULL, /* mknod */ + NULL, /* rename */ + NULL, /* follow link */ + NULL, /* readlink */ + NULL, /* readpage */ + NULL, /* writepage */ + NULL, /* bmap */ + NULL, /* truncate */ + vlan_proc_perms +}; + +/* + * /proc/net/vlan/ file and inode operations + */ + +static struct file_operations vlandev_fops = { + NULL, /* lseek */ + vlan_proc_read, /* read */ + NULL, /* write */ + NULL, /* readdir */ + NULL, /* select */ + vlan_ioctl, /* ioctl */ + NULL, /* mmap */ + NULL, /* no special open code */ + NULL, /* flush */ + NULL, /* no special release code */ + NULL /* can't fsync */ +}; + +static struct inode_operations vlandev_inode = { + &vlandev_fops, + NULL, /* create */ + NULL, /* lookup */ + NULL, /* link */ + NULL, /* unlink */ + NULL, /* symlink */ + NULL, /* mkdir */ + NULL, /* rmdir */ + NULL, /* mknod */ + NULL, /* rename */ + NULL, /* readlink */ + NULL, /* follow_link */ + NULL, /* readpage */ + NULL, /* writepage */ + NULL, /* bmap */ + NULL, /* truncate */ + vlan_proc_perms +}; + + +/* + * Proc filesystem derectory entries. + */ + +/* + * /proc/net/vlan + */ + +static struct proc_dir_entry proc_vlan = { + 0, /* .low_ino */ + sizeof(name_root) - 1, /* .namelen */ + name_root, /* .name */ + 0555 | S_IFDIR, /* .mode */ + 2, /* .nlink */ + 0, /* .uid */ + 0, /* .gid */ + 0, /* .size */ + &proc_dir_inode_operations, /* .ops */ + NULL, /* .get_info */ + NULL, /* .fill_node */ + NULL, /* .next */ + NULL, /* .parent */ + NULL, /* .subdir */ + NULL, /* .data */ +}; + +/* + * /proc/net/vlan/config + */ + +static struct proc_dir_entry proc_vlan_conf = { + 0, /* .low_ino */ + sizeof(name_conf) - 1, /* .namelen */ + name_conf, /* .name */ + 0444 | S_IFREG, /* .mode */ + 1, /* .nlink */ + 0, /* .uid */ + 0, /* .gid */ + 0, /* .size */ + &vlan_inode, /* .ops */ + &vlan_config_get_info, /* .get_info */ + NULL, /* .fill_node */ + NULL, /* .next */ + NULL, /* .parent */ + NULL, /* .subdir */ + NULL, /* .data */ +}; + + +/* Strings */ +static char conf_hdr[] = "VLAN Dev name | VLAN ID\n"; + + +/* + * Interface functions + */ + +/* + * Initialize vlan proc interface. + */ + +__initfunc(int vlan_proc_init (void)) { + int err = proc_register(proc_net, &proc_vlan); + + if (!err) { + proc_register(&proc_vlan, &proc_vlan_conf); + } + return err; +} + +/* + * Clean up router proc interface. + */ + +void vlan_proc_cleanup (void) { + proc_unregister(&proc_vlan, proc_vlan_conf.low_ino); + proc_unregister(proc_net, proc_vlan.low_ino); +} + + +/* + * Add directory entry for VLAN device. + */ + +int vlan_proc_add_dev (struct device* vlandev) { + if (!vlandev->vlan_dev) { + printk(KERN_ERR "ERROR: vlan_proc_add, device -:%s:- is NOT a VLAN\n", + vlandev->name); + return -EINVAL; + } + + memset(&(vlandev->vlan_dev->dent), 0, sizeof(vlandev->vlan_dev->dent)); + vlandev->vlan_dev->dent.namelen = strlen(vlandev->name); + vlandev->vlan_dev->dent.name = vlandev->name; + vlandev->vlan_dev->dent.mode = 0444 | S_IFREG; + vlandev->vlan_dev->dent.nlink = 1; + vlandev->vlan_dev->dent.ops = &vlandev_inode; + vlandev->vlan_dev->dent.get_info = &vlandev_get_info; + vlandev->vlan_dev->dent.data = vlandev; + +#ifdef VLAN_DEBUG + printk(KERN_ERR "vlan_proc_add, device -:%s:- being added.\n", + vlandev->name); +#endif + + return proc_register(&proc_vlan, &vlandev->vlan_dev->dent); +} + + + +/* + * Delete directory entry for VLAN device. + */ +int vlan_proc_rem_dev(struct device* vlandev) { + if (!vlandev || !vlandev->vlan_dev) { +#ifdef VLAN_DEBUG + printk(VLAN_DBG __FUNCTION__ ": invalid argument: %p\n", vlandev); +#endif + return -EINVAL; + } + +#ifdef VLAN_DEBUG + printk(VLAN_DBG __FUNCTION__ ": calling proc_unregister for dev: %p\n", + vlandev); +#endif + return proc_unregister(&proc_vlan, vlandev->vlan_dev->dent.low_ino); +} + + +/****** Proc filesystem entry points ****************************************/ + +/* + * Verify access rights. + */ + +static int vlan_proc_perms (struct inode* inode, int op) { + return 0; +} + +/* + * Read VLAN proc directory entry. + * This is universal routine for reading all entries in /proc/net/vlan + * directory. Each directory entry contains a pointer to the 'method' for + * preparing data for that entry. + * o verify arguments + * o allocate kernel buffer + * o call get_info() to prepare data + * o copy data to user space + * o release kernel buffer + * + * Return: number of bytes copied to user space (0, if no data) + * <0 error + */ +static ssize_t vlan_proc_read(struct file* file, char* buf, size_t count, + loff_t *ppos) { + struct inode *inode = file->f_dentry->d_inode; + struct proc_dir_entry* dent; + char* page; + int pos, offs, len; + + if (count <= 0) + return 0; + + dent = inode->u.generic_ip; + if ((dent == NULL) || (dent->get_info == NULL)) + return 0; + + page = kmalloc(VLAN_PROC_BUFSZ, GFP_KERNEL); + VLAN_MEM_DBG("page malloc, addr: %p size: %i\n", page, VLAN_PROC_BUFSZ); + + if (page == NULL) + return -ENOBUFS; + + pos = dent->get_info(page, dent->data, 0, 0, 0); + offs = file->f_pos; + if (offs < pos) { + len = min(pos - offs, count); + if (copy_to_user(buf, (page + offs), len)) { + return -EFAULT; + } + file->f_pos += len; + } + else { + len = 0; + } + + kfree(page); + VLAN_FMEM_DBG("page free, addr: %p\n", page); + return len; +}/* vlan_proc_read */ + + +static int vlan_proc_get_vlan_info(char* buf, unsigned int cnt) { + struct device* vlandev = NULL; + struct vlan_group* grp = NULL; + int i = 0; + char* nm_type = NULL; + + printk(VLAN_DBG __FUNCTION__ ": cnt == %i\n", cnt); + + if (vlan_name_type == VLAN_NAME_TYPE_RAW_PLUS_VID) { + nm_type = "VLAN_NAME_TYPE_RAW_PLUS_VID"; + } + else if (vlan_name_type == VLAN_NAME_TYPE_PLUS_VID_NO_PAD) { + nm_type = "VLAN_NAME_TYPE_PLUS_VID_NO_PAD"; + } + else if (vlan_name_type == VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD) { + nm_type = "VLAN_NAME_TYPE_RAW_PLUS_VID_NO_PAD"; + } + else if (vlan_name_type == VLAN_NAME_TYPE_PLUS_VID) { + nm_type = "VLAN_NAME_TYPE_PLUS_VID"; + } + else { + nm_type = "UNKNOWN"; + } + + cnt += sprintf(buf + cnt, "Name-Type: %s bad_proto_recvd: %lu\n", + nm_type, vlan_bad_proto_recvd); + + for (grp = p802_1Q_vlan_list; grp != NULL; grp = grp->next) { + /* loop through all devices for this device */ + printk(VLAN_DBG __FUNCTION__ ": found a group, addr: %p\n", grp); + for (i = 0; i < VLAN_GROUP_ARRAY_LEN; i++) { + /* printk(VLAN_DBG __FUNCTION__ ": checking index[%i]\n", i); */ + if ((vlandev = grp->vlan_devices[i])) { + printk(VLAN_DBG __FUNCTION__ ": found a vlan_dev, addr: %p\n", vlandev); + if ((cnt + 100) > VLAN_PROC_BUFSZ) { + if ((cnt + strlen(term_msg)) >= VLAN_PROC_BUFSZ) { + /* should never get here */ + return cnt; + } + else { + cnt += sprintf(buf + cnt, "%s", term_msg); + return cnt; + } + }/* if running out of buffer space */ + else { + if (!vlandev->vlan_dev) { + printk(KERN_ERR __FUNCTION__ ": ERROR: vlandev->vlan_dev is NULL\n"); + } + else { + printk(VLAN_DBG __FUNCTION__ ": got a good vlandev, addr: %p\n", vlandev->vlan_dev); + cnt += sprintf(buf + cnt, "%-15s| %d | %s\n", + vlandev->name, vlandev->vlan_dev->vlan_id, vlandev->vlan_dev->real_dev->name); + }/* else */ + }/* else */ + }/* if we have a vlan of this number */ + }/* for all VLAN's */ + }/* for each vlan group, default is only one.*/ + + return cnt; +}/* vlan_proc_get_vlan_info */ + +/* + * Prepare data for reading 'Config' entry. + * Return length of data. + */ + +static int vlan_config_get_info(char* buf, char** start, off_t offs, int len, + int dummy) { + strcpy(buf, conf_hdr); + return vlan_proc_get_vlan_info(buf, (unsigned int)(strlen(conf_hdr))); +} + + +/* + * Prepare data for reading entry. + * Return length of data. + * + * On entry, the 'start' argument will contain a pointer to VLAN device + * data space. + */ + +static int vlandev_get_info(char* buf, char** start, off_t offs, int len, + int dummy) { + struct device* vlandev = (void*)start; + struct net_device_stats* stats; + int cnt = 0; + struct vlan_priority_tci_mapping* mp; + int i; + +#ifdef VLAN_DEBUG + printk(VLAN_DBG __FUNCTION__ ": vlandev: %p\n", vlandev); +#endif + + if ((vlandev == NULL) || (!vlandev->vlan_dev)) { + return 0; + } + + cnt += sprintf(buf + cnt, "%s VID: %d REORDER_HDR: %i\n", + vlandev->name, vlandev->vlan_dev->vlan_id, (int)(vlandev->vlan_dev->flags & 1)); + stats = (struct net_device_stats*)(vlandev->priv); + + cnt += sprintf(buf + cnt, "%30s: %12lu\n", + "total frames received", stats->rx_packets); + + cnt += sprintf(buf + cnt, "%30s: %12lu\n", + "total bytes received", stats->rx_bytes); + + cnt += sprintf(buf + cnt, "%30s: %12lu\n", + "Broadcast/Multicast Rcvd", stats->multicast); + + cnt += sprintf(buf + cnt, "\n%30s: %12lu\n", + "total frames transmitted", stats->tx_packets); + + cnt += sprintf(buf + cnt, "%30s: %12lu\n", + "total bytes transmitted", stats->tx_bytes); + + cnt += sprintf(buf + cnt, "%30s: %12lu\n", + "total headroom inc", vlandev->vlan_dev->cnt_inc_headroom_on_tx); + + cnt += sprintf(buf + cnt, "%30s: %12lu\n", + "total encap on xmit", vlandev->vlan_dev->cnt_encap_on_xmit); + + cnt += sprintf(buf + cnt, "Device: %s", vlandev->vlan_dev->real_dev->name); + + /* now show all PRIORITY mappings relating to this VLAN */ + cnt += sprintf(buf + cnt, "\nINGRESS priority mappings: 0:%lu 1:%lu 2:%lu 3:%lu 4:%lu 5:%lu 6:%lu 7:%lu\n", + vlandev->vlan_dev->ingress_priority_map[0], + vlandev->vlan_dev->ingress_priority_map[1], + vlandev->vlan_dev->ingress_priority_map[2], + vlandev->vlan_dev->ingress_priority_map[3], + vlandev->vlan_dev->ingress_priority_map[4], + vlandev->vlan_dev->ingress_priority_map[5], + vlandev->vlan_dev->ingress_priority_map[6], + vlandev->vlan_dev->ingress_priority_map[7]); + + cnt += sprintf(buf + cnt, "EGRESSS priority Mappings: "); + + for (i = 0; i<16; i++) { + mp = vlandev->vlan_dev->egress_priority_map[i]; + while (mp) { + cnt += sprintf(buf + cnt, "%lu:%hu ", mp->priority, ((mp->vlan_qos >> 13) & 0x7)); + + if ((cnt + 100) > VLAN_PROC_BUFSZ) { + if ((cnt + strlen(term_msg)) >= VLAN_PROC_BUFSZ) { + /* should never get here */ + return cnt; + } + else { + cnt += sprintf(buf + cnt, "%s", term_msg); + return cnt; + } + }/* if running out of buffer space */ + mp = mp->next; + } + }/* for */ + + cnt += sprintf(buf + cnt, "\n"); + + return cnt; +} + + +/* + * End + */ + +#else + +/* + * No /proc - output stubs + */ + +__initfunc(int vlan_proc_init(void)) +{ + return 0; +} + +void vlan_proc_cleanup(void) +{ + return; +} + + +int vlan_proc_add_dev(struct device *vlandev) +{ + return 0; +} + +int vlan_proc_rem_dev(struct device *vlandev) +{ + return 0; +} + +#endif diff -u -r -N -X /home/greear/exclude.list linux/net/802_1Q/vlanproc.h linux.dev/net/802_1Q/vlanproc.h --- linux/net/802_1Q/vlanproc.h Wed Dec 31 17:00:00 1969 +++ linux.dev/net/802_1Q/vlanproc.h Fri Dec 29 19:51:33 2000 @@ -0,0 +1,27 @@ + +#ifndef __BEN_VLAN_PROC_INC__ +#define __BEN_VLAN_PROC_INC__ + + +int vlan_proc_init(void); + +int vlan_proc_rem_dev(struct device* vlandev); +int vlan_proc_add_dev (struct device* vlandev); +void vlan_proc_cleanup (void); + + +#define VLAN_PROC_BUFSZ (4096) /* buffer size for printing proc info */ + +/****** Data Types **********************************************************/ + +/* +typedef struct vlan_stat_entry { + struct vlan_stat_entry * next; + char *description; * description string * + void *data; * -> data * + unsigned data_type; * data type * +} vlan_stat_entry_t; +*/ + + +#endif diff -u -r -N -X /home/greear/exclude.list linux/net/Config.in linux.dev/net/Config.in --- linux/net/Config.in Sun Dec 10 17:49:44 2000 +++ linux.dev/net/Config.in Fri Dec 29 19:51:33 2000 @@ -44,6 +44,9 @@ fi bool 'Frame Diverter (EXPERIMENTAL)' CONFIG_NET_DIVERT bool '802.2 LLC (EXPERIMENTAL)' CONFIG_LLC + + bool '802.1Q VLAN Support (EXPERIMENTAL)' CONFIG_VLAN_802_1Q + # if [ "$CONFIG_LLC" = "y" ]; then # bool 'Netbeui (EXPERIMENTAL)' CONFIG_NETBEUI # fi diff -u -r -N -X /home/greear/exclude.list linux/net/Makefile linux.dev/net/Makefile --- linux/net/Makefile Mon Mar 22 12:18:17 1999 +++ linux.dev/net/Makefile Fri Dec 29 19:51:33 2000 @@ -10,7 +10,7 @@ MOD_SUB_DIRS := ipv4 ALL_SUB_DIRS := 802 ax25 bridge core ethernet ipv4 ipv6 ipx unix appletalk \ netrom rose lapb x25 wanrouter netlink sched packet sunrpc \ - econet irda #decnet + econet irda 802_1Q #decnet SUB_DIRS := core ethernet sched MOD_LIST_NAME := NET_MISC_MODULES @@ -59,6 +59,10 @@ ifeq ($(CONFIG_BRIDGE),y) SUB_DIRS += bridge +endif + +ifeq ($(CONFIG_VLAN_802_1Q),y) +SUB_DIRS += 802_1Q endif ifeq ($(CONFIG_IPX),y) diff -u -r -N -X /home/greear/exclude.list linux/net/core/dev.c linux.dev/net/core/dev.c --- linux/net/core/dev.c Sun Dec 10 17:49:44 2000 +++ linux.dev/net/core/dev.c Sun Jan 14 14:16:43 2001 @@ -1,4 +1,4 @@ -/* +/* -*- linux-c -*- * NET3 Protocol independent device support routines. * * This program is free software; you can redistribute it and/or @@ -94,6 +94,11 @@ #ifdef CONFIG_NET_RADIO #include #endif /* CONFIG_NET_RADIO */ + +#ifdef CONFIG_VLAN_802_1Q +#include "../802_1Q/vlan.h" +#endif + #ifdef CONFIG_PLIP extern int plip_init(void); #endif @@ -123,9 +128,17 @@ * and the routines to invoke. * * Why 16. Because with 16 the only overlap we get on a hash of the - * low nibble of the protocol value is RARP/SNAP/X.25. + * low nibble of the protocol value is RARP/SNAP/X.25. + * + * NOTE: That is no longer true with the addition of VLAN tags. Not + * sure which should go first, but I bet it won't make much + * difference if we are running VLANs. The good news is that + * this protocol won't be in the list unless compiled in, so + * the average user (w/out VLANs) will not be adversly affected. + * --BLG * * 0800 IP + * 8100 802.1Q VLAN * 0001 802.3 * 0002 AX.25 * 0004 802.2 @@ -170,6 +183,256 @@ static void dev_clear_backlog(struct device *dev); +/* Taking this out, because lo has problems for some people. Feel + * free to turn it back on and give me (greearb@candelatech.com) bug + * reports if you can re-produce the problem. --Ben + + #define BENS_FAST_DEV_LOOKUP + +*/ +#ifdef BENS_FAST_DEV_LOOKUP +/* Fast Device Lookup code. Should give much better than + * linear speed when looking for devices by idx or name. + * --Ben (greearb@candelatech.com) + */ +#define FDL_HASH_LEN 256 + +/* #define FDL_DEBUG */ + +struct dev_hash_node { + struct device* dev; + struct dev_hash_node* next; +}; + +struct dev_hash_node* fdl_name_base[FDL_HASH_LEN];/* hashed by name */ +struct dev_hash_node* fdl_idx_base[FDL_HASH_LEN]; /* hashed by index */ +int fdl_initialized_yet = 0; + +/* TODO: Make these inline methods */ +/* Nice cheesy little hash method to be used on device-names (eth0, ppp0, etc) */ +int fdl_calc_name_idx(const char* dev_name) { + int tmp = 0; + int i; +#ifdef FDL_DEBUG + printk(KERN_ERR "fdl_calc_name_idx, name: %s\n", dev_name); +#endif + for (i = 0; dev_name[i]; i++) { + tmp += (int)(dev_name[i]); + } + if (i > 3) { + tmp += (dev_name[i-2] * 10); /* might add a little spread to the hash */ + tmp += (dev_name[i-3] * 100); /* might add a little spread to the hash */ + } +#ifdef FDL_DEBUG + printk(KERN_ERR "fdl_calc_name_idx, rslt: %i\n", (int)(tmp % FDL_HASH_LEN)); +#endif + return (tmp % FDL_HASH_LEN); +} + +int fdl_calc_index_idx(const int ifindex) { + return (ifindex % FDL_HASH_LEN); +} + + +/* Better have a lock on the dev_base before calling this... */ +int __fdl_ensure_init(void) { +#ifdef FDL_DEBUG + printk(KERN_ERR "__fdl_ensure_init, enter\n"); +#endif + if (! fdl_initialized_yet) { + /* only do this once.. */ + int i; + int idx = 0; /* into the hash table */ + struct device* dev = dev_base; + struct dev_hash_node* dhn; + +#ifdef FDL_DEBUG + printk(KERN_ERR "__fdl_ensure_init, doing real work..."); +#endif + + fdl_initialized_yet = 1; /* it has been attempted at least... */ + + for (i = 0; iname, idx); +#endif + /* first, take care of the hash-by-name */ + idx = fdl_calc_name_idx(dev->name); + dhn = kmalloc(sizeof(struct dev_hash_node), GFP_ATOMIC); + if (dhn) { + dhn->dev = dev; + dhn->next = fdl_name_base[idx]; + fdl_name_base[idx] = dhn; + } + else { + /* Nasty..couldn't get memory... */ + return -ENOMEM; + } + + /* now, do the hash-by-idx */ + idx = fdl_calc_index_idx(dev->ifindex); + dhn = kmalloc(sizeof(struct dev_hash_node), GFP_ATOMIC); + if (dhn) { + dhn->dev = dev; + dhn->next = fdl_idx_base[idx]; + fdl_idx_base[idx] = dhn; + } + else { + /* Nasty..couldn't get memory... */ + return -ENOMEM; + } + + dev = dev->next; + } + fdl_initialized_yet = 2; /* initialization actually worked */ + } +#ifdef FDL_DEBUG + printk(KERN_ERR "__fdl_ensure_init, end, fdl_initialized_yet: %i\n", fdl_initialized_yet); +#endif + if (fdl_initialized_yet == 2) { + return 0; + } + else { + return -1; + } +}/* fdl_ensure_init */ + + +/* called from register_netdevice, assumes dev is locked, and that no one + * will be calling __find_dev_by_name before this exits.. etc. + */ +int __fdl_register_netdevice(struct device* dev) { + if (__fdl_ensure_init() == 0) { + /* first, take care of the hash-by-name */ + int idx = fdl_calc_name_idx(dev->name); + struct dev_hash_node* dhn = kmalloc(sizeof(struct dev_hash_node), GFP_ATOMIC); + +#ifdef FDL_DEBUG + printk(KERN_ERR "__fdl_register_netdevice, dev: %p dev: %s, idx: %i", dev, dev->name, idx); +#endif + + if (dhn) { + dhn->dev = dev; + dhn->next = fdl_name_base[idx]; + fdl_name_base[idx] = dhn; + } + else { + /* Nasty..couldn't get memory... */ + /* Don't try to use these hash tables any more... */ + fdl_initialized_yet = 1; /* tried, but failed */ + return -ENOMEM; + } + + /* now, do the hash-by-idx */ + idx = fdl_calc_index_idx(dev->ifindex); + dhn = kmalloc(sizeof(struct dev_hash_node), GFP_ATOMIC); + +#ifdef FDL_DEBUG + printk(KERN_ERR "__fdl_register_netdevice, ifindex: %i, idx: %i", dev->ifindex, idx); +#endif + + if (dhn) { + dhn->dev = dev; + dhn->next = fdl_idx_base[idx]; + fdl_idx_base[idx] = dhn; + } + else { + /* Nasty..couldn't get memory... */ + /* Don't try to use these hash tables any more... */ + fdl_initialized_yet = 1; /* tried, but failed */ + return -ENOMEM; + } + } + return 0; +} /* fdl_register_netdevice */ + + +/* called from register_netdevice, assumes dev is locked, and that no one + * will be calling __find_dev_by_name, etc. Returns 0 if found & removed one, + * returns -1 otherwise. + */ +int __fdl_unregister_netdevice(struct device* dev) { + int retval = -1; + if (fdl_initialized_yet == 2) { /* If we've been initialized correctly... */ + /* first, take care of the hash-by-name */ + int idx = fdl_calc_name_idx(dev->name); + struct dev_hash_node* prev = fdl_name_base[idx]; + struct dev_hash_node* cur = NULL; + +#ifdef FDL_DEBUG + printk(KERN_ERR "__fdl_unregister_netdevice, dev: %p dev: %s, idx: %i", dev, dev->name, idx); +#endif + + if (prev) { + if (strcmp(dev->name, prev->dev->name) == 0) { + /* it's the first one... */ + fdl_name_base[idx] = prev->next; + kfree(prev); + retval = 0; + } + else { + cur = prev->next; + while (cur) { + if (strcmp(dev->name, cur->dev->name) == 0) { + prev->next = cur->next; + kfree(cur); + retval = 0; + break; + } + else { + prev = cur; + cur = cur->next; + } + } + } + } + + /* Now, the hash-by-index */ + idx = fdl_calc_index_idx(dev->ifindex); + prev = fdl_idx_base[idx]; + cur = NULL; + if (prev) { + if (dev->ifindex == prev->dev->ifindex) { + /* it's the first one... */ + fdl_idx_base[idx] = prev->next; + kfree(prev); + retval = 0; + } + else { + cur = prev->next; + while (cur) { + if (dev->ifindex == cur->dev->ifindex) { + prev->next = cur->next; + kfree(cur); + retval = 0; + break; + } + else { + prev = cur; + cur = cur->next; + } + } + } + } + }/* if we ensured init OK */ + return retval; +} /* fdl_unregister_netdevice */ + + + +#endif /* BENS_FAST_DEV_LOOKUP */ + + + /****************************************************************************************** Protocol management and registration routines @@ -267,6 +530,25 @@ { struct device *dev; +#ifdef BENS_FAST_DEV_LOOKUP + int idx = fdl_calc_name_idx(name); + struct dev_hash_node* dhn; + if (fdl_initialized_yet == 2) { +#ifdef FDL_DEBUG + printk(KERN_ERR "__dev_get_by_name, name: %s idx: %i\n", name, idx); +#endif + dhn = fdl_name_base[idx]; + while (dhn) { + if (strcmp(dhn->dev->name, name) == 0) { + /* printk(KERN_ERR "__dev_get_by_name, found it: %p\n", dhn->dev); */ + return dhn->dev; + } + dhn = dhn->next; + } + /* printk(KERN_ERR "__dev_get_by_name, didn't find it for name: %s\n", name); */ + return NULL; + } +#endif for (dev = dev_base; dev != NULL; dev = dev->next) { if (strcmp(dev->name, name) == 0) @@ -278,7 +560,19 @@ struct device * dev_get_by_index(int ifindex) { struct device *dev; - +#ifdef BENS_FAST_DEV_LOOKUP + int idx = fdl_calc_index_idx(ifindex); + struct dev_hash_node* dhn; + if (fdl_initialized_yet == 2) { /* have we gone through initialization before... */ + dhn = fdl_idx_base[idx]; + while (dhn) { + if (dhn->dev->ifindex == ifindex) + return dhn->dev; + dhn = dhn->next; + } + return NULL; + } +#endif for (dev = dev_base; dev != NULL; dev = dev->next) { if (dev->ifindex == ifindex) @@ -310,14 +604,17 @@ int i; /* * If you need over 100 please also fix the algorithm... - */ - for(i=0;i<100;i++) + * + * Increased it to deal with VLAN interfaces. It is unlikely + * that this many will ever be added, but it can't hurt! -BLG + */ + for(i=0;i<8192;i++) { sprintf(dev->name,name,i); if(dev_get(dev->name)==NULL) return i; } - return -ENFILE; /* Over 100 of the things .. bail out! */ + return -ENFILE; /* Over 8192 of the things .. bail out! */ } struct device *dev_alloc(const char *name, int *err) @@ -830,7 +1127,7 @@ if(skb==NULL) return; - offset=skb->data-skb->mac.raw; + offset = skb->data - skb->mac.raw; skb_push(skb,offset); /* Put header back on for bridge */ if(br_receive_frame(skb)) @@ -956,7 +1253,7 @@ } /* - * Fetch the packet protocol ID. + * Fetch the packet protocol ID. (In Network Byte Order --BLG) */ type = skb->protocol; @@ -1603,8 +1900,15 @@ return -EBUSY; if (dev_get(ifr->ifr_newname)) return -EEXIST; +#ifdef BENS_FAST_DEV_LOOKUP + /* Doesn't seem to need any additional locking in kernel 2.2 series... --Ben */ + __fdl_unregister_netdevice(dev); /* take it out of the name hash table */ +#endif memcpy(dev->name, ifr->ifr_newname, IFNAMSIZ); dev->name[IFNAMSIZ-1] = 0; +#ifdef BENS_FAST_DEV_LOOKUP + __fdl_register_netdevice(dev); /* put it back in the name hash table, with the new name */ +#endif notifier_call_chain(&netdev_chain, NETDEV_CHANGENAME, dev); return 0; @@ -1809,6 +2113,12 @@ return -EEXIST; } dev->next = NULL; +#ifdef BENS_FAST_DEV_LOOKUP + /* Must do this before dp is set to dev, or it could be added twice, once + * on initialization based on dev_base, and once again after that... + */ + __fdl_register_netdevice(dev); +#endif *dp = dev; #ifdef CONFIG_NET_DIVERT ret=alloc_divert_blk(dev); @@ -1834,6 +2144,13 @@ dev->ifindex = dev_new_index(); if (dev->iflink == -1) dev->iflink = dev->ifindex; + +#ifdef BENS_FAST_DEV_LOOKUP + /* Must do this before dp is set to dev, or it could be added twice, once + * on initialization based on dev_base, and once again after that... + */ + __fdl_register_netdevice(dev); +#endif *dp = dev; /* Notify protocols, that a new device appeared. */ @@ -1885,6 +2202,9 @@ for (dp = &dev_base; (d=*dp) != NULL; dp=&d->next) { if (d == dev) { *dp = d->next; +#ifdef BENS_FAST_DEV_LOOKUP + __fdl_unregister_netdevice(dev); +#endif synchronize_bh(); d->next = NULL; diff -u -r -N -X /home/greear/exclude.list linux/net/ethernet/eth.c linux.dev/net/ethernet/eth.c --- linux/net/ethernet/eth.c Tue Jan 4 11:12:26 2000 +++ linux.dev/net/ethernet/eth.c Fri Dec 29 19:51:33 2000 @@ -174,17 +174,32 @@ * Determine the packet's protocol ID. The rule here is that we * assume 802.3 if the type field is short enough to be a length. * This is normal practice and works for any 'now in use' protocol. + * + * NOTE: It is likely that you will want to change vlan_type_trans in + * 802_1Q/vlan.c if you change anything here. */ unsigned short eth_type_trans(struct sk_buff *skb, struct device *dev) { struct ethhdr *eth; unsigned char *rawp; - - skb->mac.raw=skb->data; - skb_pull(skb,dev->hard_header_len); - eth= skb->mac.ethernet; - + + skb->mac.raw=skb->data; + +#ifdef CONFIG_VLAN_802_1Q + /* Moving this below to be more selective. Reason is that for VLAN + * devices, we do not want to pull the header, we'll let the VLAN + * device do that instead. This makes default vlans (based on incoming + * port), much more sane! --BLG + */ + + /* skb_pull(skb,dev->hard_header_len); */ +#else + skb_pull(skb,dev->hard_header_len); +#endif + + eth= skb->mac.ethernet; + if(*eth->h_dest&1) { if(memcmp(eth->h_dest,dev->broadcast, ETH_ALEN)==0) @@ -206,7 +221,21 @@ if(memcmp(eth->h_dest,dev->dev_addr, ETH_ALEN)) skb->pkt_type=PACKET_OTHERHOST; } - + +#ifdef CONFIG_VLAN_802_1Q + if (ntohs(eth->h_proto) == ETH_P_802_1Q) { + /* then we have to convert this into a VLAN looking packet. + * We'll wait to do that in the VLAN protocol handler. + * + * NOTE: We DO NOT PULL ANYTHING FROM THE SKB HERE!!! + */ + return __constant_htons(ETH_P_802_1Q); + } + else { + skb_pull(skb, dev->hard_header_len); + } +#endif + if (ntohs(eth->h_proto) >= 1536) return eth->h_proto; diff -u -r -N -X /home/greear/exclude.list linux/net/protocols.c linux.dev/net/protocols.c --- linux/net/protocols.c Thu Dec 17 10:03:57 1998 +++ linux.dev/net/protocols.c Fri Dec 29 19:51:33 2000 @@ -34,6 +34,10 @@ extern void packet_proto_init(struct net_proto *pro); #endif +#ifdef CONFIG_VLAN_802_1Q +extern void vlan_proto_init(struct net_proto* pro); +#endif + #if defined(CONFIG_IPX) || defined(CONFIG_IPX_MODULE) #define NEED_802 #include @@ -169,5 +173,9 @@ { "IrDA", irda_proto_init }, /* IrDA protocols */ #endif +#ifdef CONFIG_VLAN_802_1Q + { "VLAN", vlan_proto_init }, /* 802.1Q VLAN Support. --BLG */ +#endif + { NULL, NULL } /* End marker */ };