Blame view

kernel/linux-imx6_3.14.28/net/802/fc.c 3.29 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
  /*
   * NET3:	Fibre Channel device handling subroutines
   *
   *		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.
   *
   *		Vineet Abraham <vma@iol.unh.edu>
   *		v 1.0 03/22/99
   */
  
  #include <asm/uaccess.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/fcdevice.h>
  #include <linux/skbuff.h>
  #include <linux/errno.h>
  #include <linux/timer.h>
  #include <linux/net.h>
  #include <linux/proc_fs.h>
  #include <linux/init.h>
  #include <linux/export.h>
  #include <net/arp.h>
  
  /*
   *	Put the headers on a Fibre Channel packet.
   */
  
  static int fc_header(struct sk_buff *skb, struct net_device *dev,
  		     unsigned short type,
  		     const void *daddr, const void *saddr, unsigned int len)
  {
  	struct fch_hdr *fch;
  	int hdr_len;
  
  	/*
  	 * Add the 802.2 SNAP header if IP as the IPv4 code calls
  	 * dev->hard_header directly.
  	 */
  	if (type == ETH_P_IP || type == ETH_P_ARP)
  	{
  		struct fcllc *fcllc;
  
  		hdr_len = sizeof(struct fch_hdr) + sizeof(struct fcllc);
  		fch = (struct fch_hdr *)skb_push(skb, hdr_len);
  		fcllc = (struct fcllc *)(fch+1);
  		fcllc->dsap = fcllc->ssap = EXTENDED_SAP;
  		fcllc->llc = UI_CMD;
  		fcllc->protid[0] = fcllc->protid[1] = fcllc->protid[2] = 0x00;
  		fcllc->ethertype = htons(type);
  	}
  	else
  	{
  		hdr_len = sizeof(struct fch_hdr);
  		fch = (struct fch_hdr *)skb_push(skb, hdr_len);
  	}
  
  	if(saddr)
  		memcpy(fch->saddr,saddr,dev->addr_len);
  	else
  		memcpy(fch->saddr,dev->dev_addr,dev->addr_len);
  
  	if(daddr)
  	{
  		memcpy(fch->daddr,daddr,dev->addr_len);
  		return hdr_len;
  	}
  	return -hdr_len;
  }
  
  /*
   *	A neighbour discovery of some species (eg arp) has completed. We
   *	can now send the packet.
   */
  
  static int fc_rebuild_header(struct sk_buff *skb)
  {
  #ifdef CONFIG_INET
  	struct fch_hdr *fch=(struct fch_hdr *)skb->data;
  	struct fcllc *fcllc=(struct fcllc *)(skb->data+sizeof(struct fch_hdr));
  	if(fcllc->ethertype != htons(ETH_P_IP)) {
  		printk("fc_rebuild_header: Don't know how to resolve type %04X addresses ?
  ", ntohs(fcllc->ethertype));
  		return 0;
  	}
  	return arp_find(fch->daddr, skb);
  #else
  	return 0;
  #endif
  }
  
  static const struct header_ops fc_header_ops = {
  	.create	 = fc_header,
  	.rebuild = fc_rebuild_header,
  };
  
  static void fc_setup(struct net_device *dev)
  {
  	dev->header_ops		= &fc_header_ops;
  	dev->type		= ARPHRD_IEEE802;
  	dev->hard_header_len	= FC_HLEN;
  	dev->mtu		= 2024;
  	dev->addr_len		= FC_ALEN;
  	dev->tx_queue_len	= 100; /* Long queues on fc */
  	dev->flags		= IFF_BROADCAST;
  
  	memset(dev->broadcast, 0xFF, FC_ALEN);
  }
  
  /**
   * alloc_fcdev - Register fibre channel device
   * @sizeof_priv: Size of additional driver-private structure to be allocated
   *	for this fibre channel device
   *
   * Fill in the fields of the device structure with fibre channel-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_fcdev(int sizeof_priv)
  {
  	return alloc_netdev(sizeof_priv, "fc%d", fc_setup);
  }
  EXPORT_SYMBOL(alloc_fcdev);