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#define pr_fmt(fmt) "arcnet:" KBUILD_MODNAME ": " fmt
28
29#include <linux/module.h>
30#include <linux/gfp.h>
31#include <linux/init.h>
32#include <linux/if_arp.h>
33#include <net/arp.h>
34#include <linux/netdevice.h>
35#include <linux/skbuff.h>
36
37#include "arcdevice.h"
38
39static __be16 type_trans(struct sk_buff *skb, struct net_device *dev);
40static void rx(struct net_device *dev, int bufnum,
41 struct archdr *pkthdr, int length);
42static int build_header(struct sk_buff *skb, struct net_device *dev,
43 unsigned short type, uint8_t daddr);
44static int prepare_tx(struct net_device *dev, struct archdr *pkt, int length,
45 int bufnum);
46
47static struct ArcProto rfc1051_proto = {
48 .suffix = 's',
49 .mtu = XMTU - RFC1051_HDR_SIZE,
50 .is_ip = 1,
51 .rx = rx,
52 .build_header = build_header,
53 .prepare_tx = prepare_tx,
54 .continue_tx = NULL,
55 .ack_tx = NULL
56};
57
58static int __init arcnet_rfc1051_init(void)
59{
60 pr_info("%s\n", "RFC1051 \"simple standard\" (`s') encapsulation support loaded");
61
62 arc_proto_map[ARC_P_IP_RFC1051]
63 = arc_proto_map[ARC_P_ARP_RFC1051]
64 = &rfc1051_proto;
65
66
67 if (arc_bcast_proto == arc_proto_default)
68 arc_bcast_proto = &rfc1051_proto;
69
70 return 0;
71}
72
73static void __exit arcnet_rfc1051_exit(void)
74{
75 arcnet_unregister_proto(&rfc1051_proto);
76}
77
78module_init(arcnet_rfc1051_init);
79module_exit(arcnet_rfc1051_exit);
80
81MODULE_LICENSE("GPL");
82
83
84
85
86
87static __be16 type_trans(struct sk_buff *skb, struct net_device *dev)
88{
89 struct archdr *pkt = (struct archdr *)skb->data;
90 struct arc_rfc1051 *soft = &pkt->soft.rfc1051;
91 int hdr_size = ARC_HDR_SIZE + RFC1051_HDR_SIZE;
92
93
94 skb_reset_mac_header(skb);
95 skb_pull(skb, hdr_size);
96
97 if (pkt->hard.dest == 0) {
98 skb->pkt_type = PACKET_BROADCAST;
99 } else if (dev->flags & IFF_PROMISC) {
100
101 if (pkt->hard.dest != dev->dev_addr[0])
102 skb->pkt_type = PACKET_OTHERHOST;
103 }
104
105 switch (soft->proto) {
106 case ARC_P_IP_RFC1051:
107 return htons(ETH_P_IP);
108 case ARC_P_ARP_RFC1051:
109 return htons(ETH_P_ARP);
110
111 default:
112 dev->stats.rx_errors++;
113 dev->stats.rx_crc_errors++;
114 return 0;
115 }
116
117 return htons(ETH_P_IP);
118}
119
120
121static void rx(struct net_device *dev, int bufnum,
122 struct archdr *pkthdr, int length)
123{
124 struct arcnet_local *lp = netdev_priv(dev);
125 struct sk_buff *skb;
126 struct archdr *pkt = pkthdr;
127 int ofs;
128
129 arc_printk(D_DURING, dev, "it's a raw packet (length=%d)\n", length);
130
131 if (length >= MinTU)
132 ofs = 512 - length;
133 else
134 ofs = 256 - length;
135
136 skb = alloc_skb(length + ARC_HDR_SIZE, GFP_ATOMIC);
137 if (!skb) {
138 dev->stats.rx_dropped++;
139 return;
140 }
141 skb_put(skb, length + ARC_HDR_SIZE);
142 skb->dev = dev;
143
144 pkt = (struct archdr *)skb->data;
145
146
147 memcpy(pkt, pkthdr, sizeof(struct archdr));
148 if (length > sizeof(pkt->soft))
149 lp->hw.copy_from_card(dev, bufnum, ofs + sizeof(pkt->soft),
150 pkt->soft.raw + sizeof(pkt->soft),
151 length - sizeof(pkt->soft));
152
153 if (BUGLVL(D_SKB))
154 arcnet_dump_skb(dev, skb, "rx");
155
156 skb->protocol = type_trans(skb, dev);
157 netif_rx(skb);
158}
159
160
161static int build_header(struct sk_buff *skb, struct net_device *dev,
162 unsigned short type, uint8_t daddr)
163{
164 int hdr_size = ARC_HDR_SIZE + RFC1051_HDR_SIZE;
165 struct archdr *pkt = skb_push(skb, hdr_size);
166 struct arc_rfc1051 *soft = &pkt->soft.rfc1051;
167
168
169 switch (type) {
170 case ETH_P_IP:
171 soft->proto = ARC_P_IP_RFC1051;
172 break;
173 case ETH_P_ARP:
174 soft->proto = ARC_P_ARP_RFC1051;
175 break;
176 default:
177 arc_printk(D_NORMAL, dev, "RFC1051: I don't understand protocol %d (%Xh)\n",
178 type, type);
179 dev->stats.tx_errors++;
180 dev->stats.tx_aborted_errors++;
181 return 0;
182 }
183
184
185
186
187
188
189
190 pkt->hard.source = *dev->dev_addr;
191
192
193
194 if (dev->flags & (IFF_LOOPBACK | IFF_NOARP)) {
195
196
197
198 pkt->hard.dest = 0;
199 return hdr_size;
200 }
201
202 pkt->hard.dest = daddr;
203
204 return hdr_size;
205}
206
207static int prepare_tx(struct net_device *dev, struct archdr *pkt, int length,
208 int bufnum)
209{
210 struct arcnet_local *lp = netdev_priv(dev);
211 struct arc_hardware *hard = &pkt->hard;
212 int ofs;
213
214 arc_printk(D_DURING, dev, "prepare_tx: txbufs=%d/%d/%d\n",
215 lp->next_tx, lp->cur_tx, bufnum);
216
217
218 length -= ARC_HDR_SIZE;
219
220 if (length > XMTU) {
221
222 arc_printk(D_NORMAL, dev, "Bug! prepare_tx with size %d (> %d)\n",
223 length, XMTU);
224 length = XMTU;
225 }
226 if (length > MinTU) {
227 hard->offset[0] = 0;
228 hard->offset[1] = ofs = 512 - length;
229 } else if (length > MTU) {
230 hard->offset[0] = 0;
231 hard->offset[1] = ofs = 512 - length - 3;
232 } else {
233 hard->offset[0] = ofs = 256 - length;
234 }
235
236 lp->hw.copy_to_card(dev, bufnum, 0, hard, ARC_HDR_SIZE);
237 lp->hw.copy_to_card(dev, bufnum, ofs, &pkt->soft, length);
238
239 lp->lastload_dest = hard->dest;
240
241 return 1;
242}
243