[GitHub/mt8127/android_kernel_alcatel_ttab.git] / net / 802 / fddi.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.
 *
 *		FDDI-type device handling.
 *
 * Version:	@(#)fddi.c	1.0.0	08/12/96
 *
 * Authors:	Lawrence V. Stefani, <stefani@lkg.dec.com>
 *
 *		fddi.c is based on previous eth.c and tr.c work by
 *			Ross Biro
 *			Fred N. van Kempen, <waltje@uWalt.NL.Mugnet.ORG>
 *			Mark Evans, <evansmp@uhura.aston.ac.uk>
 *			Florian La Roche, <rzsfl@rz.uni-sb.de>
 *			Alan Cox, <gw4pts@gw4pts.ampr.org>
 *
 *		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.
 *
 *	Changes
 *		Alan Cox		:	New arp/rebuild header
 *		Maciej W. Rozycki	:	IPv6 support
 */

#include <linux/module.h>
#include <linux/types.h>
#include <linux/kernel.h>
#include <linux/string.h>
#include <linux/mm.h>
#include <linux/socket.h>
#include <linux/in.h>
#include <linux/inet.h>
#include <linux/netdevice.h>
#include <linux/fddidevice.h>
#include <linux/if_ether.h>
#include <linux/skbuff.h>
#include <linux/errno.h>
#include <net/arp.h>
#include <net/sock.h>

/*
 * Create the FDDI MAC header for an arbitrary protocol layer
 *
 * saddr=NULL	means use device source address
 * daddr=NULL	means leave destination address (eg unresolved arp)
 */

static int fddi_header(struct sk_buff *skb, struct net_device *dev,
		       unsigned short type,
		       const void *daddr, const void *saddr, unsigned int len)
{
	int hl = FDDI_K_SNAP_HLEN;
	struct fddihdr *fddi;

	if(type != ETH_P_IP && type != ETH_P_IPV6 && type != ETH_P_ARP)
		hl=FDDI_K_8022_HLEN-3;
	fddi = (struct fddihdr *)skb_push(skb, hl);
	fddi->fc			 = FDDI_FC_K_ASYNC_LLC_DEF;
	if(type == ETH_P_IP || type == ETH_P_IPV6 || type == ETH_P_ARP)
	{
		fddi->hdr.llc_snap.dsap		 = FDDI_EXTENDED_SAP;
		fddi->hdr.llc_snap.ssap		 = FDDI_EXTENDED_SAP;
		fddi->hdr.llc_snap.ctrl		 = FDDI_UI_CMD;
		fddi->hdr.llc_snap.oui[0]	 = 0x00;
		fddi->hdr.llc_snap.oui[1]	 = 0x00;
		fddi->hdr.llc_snap.oui[2]	 = 0x00;
		fddi->hdr.llc_snap.ethertype	 = htons(type);
	}

	/* Set the source and destination hardware addresses */

	if (saddr != NULL)
		memcpy(fddi->saddr, saddr, dev->addr_len);
	else
		memcpy(fddi->saddr, dev->dev_addr, dev->addr_len);

	if (daddr != NULL)
	{
		memcpy(fddi->daddr, daddr, dev->addr_len);
		return hl;
	}

	return -hl;
}


/*
 * Rebuild the FDDI 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.
 */

static int fddi_rebuild_header(struct sk_buff	*skb)
{
	struct fddihdr *fddi = (struct fddihdr *)skb->data;

#ifdef CONFIG_INET
	if (fddi->hdr.llc_snap.ethertype == htons(ETH_P_IP))
		/* Try to get ARP to resolve the header and fill destination address */
		return arp_find(fddi->daddr, skb);
	else
#endif
	{
		printk("%s: Don't know how to resolve type %04X addresses.\n",
		       skb->dev->name, ntohs(fddi->hdr.llc_snap.ethertype));
		return 0;
	}
}


/*
 * Determine the packet's protocol ID and fill in skb fields.
 * This routine is called before an incoming packet is passed
 * up.  It's used to fill in specific skb fields and to set
 * the proper pointer to the start of packet data (skb->data).
 */

__be16 fddi_type_trans(struct sk_buff *skb, struct net_device *dev)
{
	struct fddihdr *fddi = (struct fddihdr *)skb->data;
	__be16 type;

	/*
	 * Set mac.raw field to point to FC byte, set data field to point
	 * to start of packet data.  Assume 802.2 SNAP frames for now.
	 */

	skb->dev = dev;
	skb_reset_mac_header(skb);	/* point to frame control (FC) */

	if(fddi->hdr.llc_8022_1.dsap==0xe0)
	{
		skb_pull(skb, FDDI_K_8022_HLEN-3);
		type = htons(ETH_P_802_2);
	}
	else
	{
		skb_pull(skb, FDDI_K_SNAP_HLEN);		/* adjust for 21 byte header */
		type=fddi->hdr.llc_snap.ethertype;
	}

	/* Set packet type based on destination address and flag settings */

	if (*fddi->daddr & 0x01)
	{
		if (memcmp(fddi->daddr, dev->broadcast, FDDI_K_ALEN) == 0)
			skb->pkt_type = PACKET_BROADCAST;
		else
			skb->pkt_type = PACKET_MULTICAST;
	}

	else if (dev->flags & IFF_PROMISC)
	{
		if (memcmp(fddi->daddr, dev->dev_addr, FDDI_K_ALEN))
			skb->pkt_type = PACKET_OTHERHOST;
	}

	/* Assume 802.2 SNAP frames, for now */

	return type;
}

EXPORT_SYMBOL(fddi_type_trans);

int fddi_change_mtu(struct net_device *dev, int new_mtu)
{
	if ((new_mtu < FDDI_K_SNAP_HLEN) || (new_mtu > FDDI_K_SNAP_DLEN))
		return -EINVAL;
	dev->mtu = new_mtu;
	return 0;
}
EXPORT_SYMBOL(fddi_change_mtu);

static const struct header_ops fddi_header_ops = {
	.create		= fddi_header,
	.rebuild	= fddi_rebuild_header,
};


static void fddi_setup(struct net_device *dev)
{
	dev->header_ops		= &fddi_header_ops;
	dev->type		= ARPHRD_FDDI;
	dev->hard_header_len	= FDDI_K_SNAP_HLEN+3;	/* Assume 802.2 SNAP hdr len + 3 pad bytes */
	dev->mtu		= FDDI_K_SNAP_DLEN;	/* Assume max payload of 802.2 SNAP frame */
	dev->addr_len		= FDDI_K_ALEN;
	dev->tx_queue_len	= 100;			/* Long queues on FDDI */
	dev->flags		= IFF_BROADCAST | IFF_MULTICAST;

	memset(dev->broadcast, 0xFF, FDDI_K_ALEN);
}

/**
 * alloc_fddidev - Register FDDI device
 * @sizeof_priv: Size of additional driver-private structure to be allocated
 *	for this FDDI device
 *
 * Fill in the fields of the device structure with FDDI-generic values.
 *
 * Constructs a new net device, complete with a private data area of
 * size @sizeof_priv.  A 32-byte (not bit) alignment is enforced for
 * this private data area.
 */
struct net_device *alloc_fddidev(int sizeof_priv)
{
	return alloc_netdev(sizeof_priv, "fddi%d", fddi_setup);
}
EXPORT_SYMBOL(alloc_fddidev);

MODULE_LICENSE("GPL");
Commit	Line	Data
1da177e4 LT	1	/*
	2	* INET An implementation of the TCP/IP protocol suite for the LINUX
	3	* operating system. INET is implemented using the BSD Socket
	4	* interface as the means of communication with the user level.
	5	*
	6	* FDDI-type device handling.
	7	*
	8	* Version: @(#)fddi.c 1.0.0 08/12/96
	9	*
	10	* Authors: Lawrence V. Stefani, <stefani@lkg.dec.com>
	11	*
	12	* fddi.c is based on previous eth.c and tr.c work by
02c30a84	13	* Ross Biro
1da177e4 LT	14	* Fred N. van Kempen, <waltje@uWalt.NL.Mugnet.ORG>
	15	* Mark Evans, <evansmp@uhura.aston.ac.uk>
	16	* Florian La Roche, <rzsfl@rz.uni-sb.de>
	17	* Alan Cox, <gw4pts@gw4pts.ampr.org>
9afa0949	18	*
1da177e4 LT	19	* This program is free software; you can redistribute it and/or
	20	* modify it under the terms of the GNU General Public License
	21	* as published by the Free Software Foundation; either version
	22	* 2 of the License, or (at your option) any later version.
	23	*
	24	* Changes
	25	* Alan Cox : New arp/rebuild header
	26	* Maciej W. Rozycki : IPv6 support
	27	*/
9afa0949	28
1da177e4	29	#include <linux/module.h>
1da177e4 LT	30	#include <linux/types.h>
1da177e4 LT	31	#include <linux/kernel.h>
1da177e4 LT	32	#include <linux/string.h>
	33	#include <linux/mm.h>
	34	#include <linux/socket.h>
	35	#include <linux/in.h>
	36	#include <linux/inet.h>
	37	#include <linux/netdevice.h>
	38	#include <linux/fddidevice.h>
	39	#include <linux/if_ether.h>
	40	#include <linux/skbuff.h>
	41	#include <linux/errno.h>
	42	#include <net/arp.h>
	43	#include <net/sock.h>
	44
	45	/*
	46	* Create the FDDI MAC header for an arbitrary protocol layer
	47	*
	48	* saddr=NULL means use device source address
	49	* daddr=NULL means leave destination address (eg unresolved arp)
	50	*/
	51
	52	static int fddi_header(struct sk_buff skb, struct net_device dev,
	53	unsigned short type,
95c96174	54	const void daddr, const void saddr, unsigned int len)
1da177e4 LT	55	{
	56	int hl = FDDI_K_SNAP_HLEN;
	57	struct fddihdr *fddi;
9afa0949	58
1da177e4 LT	59	if(type != ETH_P_IP && type != ETH_P_IPV6 && type != ETH_P_ARP)
	60	hl=FDDI_K_8022_HLEN-3;
	61	fddi = (struct fddihdr *)skb_push(skb, hl);
	62	fddi->fc = FDDI_FC_K_ASYNC_LLC_DEF;
	63	if(type == ETH_P_IP \|\| type == ETH_P_IPV6 \|\| type == ETH_P_ARP)
	64	{
	65	fddi->hdr.llc_snap.dsap = FDDI_EXTENDED_SAP;
	66	fddi->hdr.llc_snap.ssap = FDDI_EXTENDED_SAP;
	67	fddi->hdr.llc_snap.ctrl = FDDI_UI_CMD;
	68	fddi->hdr.llc_snap.oui[0] = 0x00;
	69	fddi->hdr.llc_snap.oui[1] = 0x00;
	70	fddi->hdr.llc_snap.oui[2] = 0x00;
	71	fddi->hdr.llc_snap.ethertype = htons(type);
	72	}
	73
	74	/* Set the source and destination hardware addresses */
9afa0949	75
1da177e4 LT	76	if (saddr != NULL)
	77	memcpy(fddi->saddr, saddr, dev->addr_len);
	78	else
	79	memcpy(fddi->saddr, dev->dev_addr, dev->addr_len);
	80
	81	if (daddr != NULL)
	82	{
	83	memcpy(fddi->daddr, daddr, dev->addr_len);
a02cec21	84	return hl;
1da177e4 LT	85	}
1da177e4 LT	86
a02cec21	87	return -hl;
1da177e4 LT	88	}
	89
	90
	91	/*
	92	* Rebuild the FDDI MAC header. This is called after an ARP
	93	* (or in future other address resolution) has completed on
	94	* this sk_buff. We now let ARP fill in the other fields.
	95	*/
9afa0949	96
1da177e4 LT	97	static int fddi_rebuild_header(struct sk_buff *skb)
	98	{
	99	struct fddihdr fddi = (struct fddihdr )skb->data;
	100
	101	#ifdef CONFIG_INET
2953fd24	102	if (fddi->hdr.llc_snap.ethertype == htons(ETH_P_IP))
1da177e4 LT	103	/* Try to get ARP to resolve the header and fill destination address */
	104	return arp_find(fddi->daddr, skb);
	105	else
9afa0949	106	#endif
1da177e4	107	{
57bf1451 AD	108	printk("%s: Don't know how to resolve type %04X addresses.\n",
57bf1451 AD	109	skb->dev->name, ntohs(fddi->hdr.llc_snap.ethertype));
a02cec21	110	return 0;
1da177e4 LT	111	}
	112	}
	113
	114
	115	/*
	116	* Determine the packet's protocol ID and fill in skb fields.
	117	* This routine is called before an incoming packet is passed
	118	* up. It's used to fill in specific skb fields and to set
	119	* the proper pointer to the start of packet data (skb->data).
	120	*/
9afa0949	121
ab611487	122	__be16 fddi_type_trans(struct sk_buff skb, struct net_device dev)
1da177e4 LT	123	{
1da177e4 LT	124	struct fddihdr fddi = (struct fddihdr )skb->data;
ab611487	125	__be16 type;
9afa0949	126
1da177e4 LT	127	/*
	128	* Set mac.raw field to point to FC byte, set data field to point
	129	* to start of packet data. Assume 802.2 SNAP frames for now.
	130	*/
	131
0a4f23fb	132	skb->dev = dev;
459a98ed	133	skb_reset_mac_header(skb); /* point to frame control (FC) */
9afa0949	134
1da177e4 LT	135	if(fddi->hdr.llc_8022_1.dsap==0xe0)
	136	{
	137	skb_pull(skb, FDDI_K_8022_HLEN-3);
2953fd24	138	type = htons(ETH_P_802_2);
1da177e4 LT	139	}
	140	else
	141	{
	142	skb_pull(skb, FDDI_K_SNAP_HLEN); /* adjust for 21 byte header */
	143	type=fddi->hdr.llc_snap.ethertype;
	144	}
9afa0949	145
1da177e4	146	/* Set packet type based on destination address and flag settings */
9afa0949	147
1da177e4 LT	148	if (*fddi->daddr & 0x01)
	149	{
	150	if (memcmp(fddi->daddr, dev->broadcast, FDDI_K_ALEN) == 0)
	151	skb->pkt_type = PACKET_BROADCAST;
	152	else
	153	skb->pkt_type = PACKET_MULTICAST;
	154	}
9afa0949	155
1da177e4 LT	156	else if (dev->flags & IFF_PROMISC)
	157	{
	158	if (memcmp(fddi->daddr, dev->dev_addr, FDDI_K_ALEN))
	159	skb->pkt_type = PACKET_OTHERHOST;
	160	}
	161
	162	/* Assume 802.2 SNAP frames, for now */
	163
a02cec21	164	return type;
1da177e4 LT	165	}
	166
	167	EXPORT_SYMBOL(fddi_type_trans);
	168
145186a3	169	int fddi_change_mtu(struct net_device *dev, int new_mtu)
1da177e4 LT	170	{
1da177e4 LT	171	if ((new_mtu < FDDI_K_SNAP_HLEN) \|\| (new_mtu > FDDI_K_SNAP_DLEN))
a02cec21	172	return -EINVAL;
1da177e4	173	dev->mtu = new_mtu;
a02cec21	174	return 0;
1da177e4	175	}
145186a3	176	EXPORT_SYMBOL(fddi_change_mtu);
1da177e4	177
3b04ddde SH	178	static const struct header_ops fddi_header_ops = {
	179	.create = fddi_header,
	180	.rebuild = fddi_rebuild_header,
	181	};
	182
145186a3	183
1da177e4 LT	184	static void fddi_setup(struct net_device *dev)
1da177e4 LT	185	{
3b04ddde	186	dev->header_ops = &fddi_header_ops;
1da177e4 LT	187	dev->type = ARPHRD_FDDI;
	188	dev->hard_header_len = FDDI_K_SNAP_HLEN+3; /* Assume 802.2 SNAP hdr len + 3 pad bytes */
	189	dev->mtu = FDDI_K_SNAP_DLEN; /* Assume max payload of 802.2 SNAP frame */
	190	dev->addr_len = FDDI_K_ALEN;
	191	dev->tx_queue_len = 100; /* Long queues on FDDI */
	192	dev->flags = IFF_BROADCAST \| IFF_MULTICAST;
9afa0949	193
1da177e4 LT	194	memset(dev->broadcast, 0xFF, FDDI_K_ALEN);
	195	}
	196
	197	/**
	198	* alloc_fddidev - Register FDDI device
	199	* @sizeof_priv: Size of additional driver-private structure to be allocated
	200	* for this FDDI device
	201	*
	202	* Fill in the fields of the device structure with FDDI-generic values.
	203	*
	204	* Constructs a new net device, complete with a private data area of
	205	* size @sizeof_priv. A 32-byte (not bit) alignment is enforced for
	206	* this private data area.
	207	*/
	208	struct net_device *alloc_fddidev(int sizeof_priv)
	209	{
	210	return alloc_netdev(sizeof_priv, "fddi%d", fddi_setup);
	211	}
	212	EXPORT_SYMBOL(alloc_fddidev);
d9677a45 AB	213
d9677a45 AB	214	MODULE_LICENSE("GPL");