]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blame - drivers/s390/net/qeth_l3_main.c
projects / mirror_ubuntu-bionic-kernel.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
s390/qeth: fix GSO throughput regression
[mirror_ubuntu-bionic-kernel.git] / drivers / s390 / net / qeth_l3_main.c
CommitLineData
4a71df50 1/*
bbcfcdc8 2 * Copyright IBM Corp. 2007, 2009
4a71df50
FB		 3 * Author(s): Utz Bacher <utz.bacher@de.ibm.com>,
4 * Frank Pavlic <fpavlic@de.ibm.com>,
5 * Thomas Spatzier <tspat@de.ibm.com>,
6 * Frank Blaschka <frank.blaschka@de.ibm.com>
7 */
8
74eacdb9
FB		 9#define KMSG_COMPONENT "qeth"
10#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
11
4a71df50
FB		 12#include <linux/module.h>
13#include <linux/moduleparam.h>
7ff0bcf6 14#include <linux/bitops.h>
4a71df50
FB		 15#include <linux/string.h>
16#include <linux/errno.h>
17#include <linux/kernel.h>
18#include <linux/etherdevice.h>
4a71df50 19#include <linux/ip.h>
64ef8957 20#include <linux/ipv6.h>
4a71df50
FB		 21#include <linux/inetdevice.h>
22#include <linux/igmp.h>
5a0e3ad6 23#include <linux/slab.h>
7ff0bcf6 24#include <linux/if_vlan.h>
4a71df50
FB		 25
26#include <net/ip.h>
27#include <net/arp.h>
87e7597b
DM		 28#include <net/route.h>
29#include <net/ip6_fib.h>
64ef8957 30#include <net/ip6_checksum.h>
b3332930 31#include <net/iucv/af_iucv.h>
5f78e29c 32#include <linux/hashtable.h>
4a71df50 33
4a71df50 34#include "qeth_l3.h"
4a71df50 35
d0ddf30f 36
4a71df50 37static int qeth_l3_set_offline(struct ccwgroup_device *);
4a71df50
FB		 38static int qeth_l3_stop(struct net_device *);
39static void qeth_l3_set_multicast_list(struct net_device *);
4a71df50
FB		 40static int qeth_l3_register_addr_entry(struct qeth_card *,
41 struct qeth_ipaddr *);
42static int qeth_l3_deregister_addr_entry(struct qeth_card *,
43 struct qeth_ipaddr *);
4a71df50 44
4a71df50
FB		 45static int qeth_l3_isxdigit(char *buf)
46{
47 while (*buf) {
48 if (!isxdigit(*buf++))
49 return 0;
50 }
51 return 1;
52}
53
56530d68 54static void qeth_l3_ipaddr4_to_string(const __u8 *addr, char *buf)
4a71df50 55{
5f78e29c 56 sprintf(buf, "%pI4", addr);
4a71df50
FB		 57}
58
56530d68 59static int qeth_l3_string_to_ipaddr4(const char *buf, __u8 *addr)
4a71df50
FB		 60{
61 int count = 0, rc = 0;
a68be015 62 unsigned int in[4];
4a71df50
FB		 63 char c;
64
65 rc = sscanf(buf, "%u.%u.%u.%u%c",
66 &in[0], &in[1], &in[2], &in[3], &c);
67 if (rc != 4 && (rc != 5 || c != '\n'))
68 return -EINVAL;
69 for (count = 0; count < 4; count++) {
70 if (in[count] > 255)
71 return -EINVAL;
72 addr[count] = in[count];
73 }
74 return 0;
75}
76
56530d68 77static void qeth_l3_ipaddr6_to_string(const __u8 *addr, char *buf)
4a71df50 78{
963a9fd2 79 sprintf(buf, "%pI6", addr);
4a71df50
FB		 80}
81
56530d68 82static int qeth_l3_string_to_ipaddr6(const char *buf, __u8 *addr)
4a71df50
FB		 83{
84 const char *end, *end_tmp, *start;
85 __u16 *in;
86 char num[5];
87 int num2, cnt, out, found, save_cnt;
88 unsigned short in_tmp[8] = {0, };
89
90 cnt = out = found = save_cnt = num2 = 0;
91 end = start = buf;
92 in = (__u16 *) addr;
93 memset(in, 0, 16);
94 while (*end) {
95 end = strchr(start, ':');
96 if (end == NULL) {
97 end = buf + strlen(buf);
98 end_tmp = strchr(start, '\n');
99 if (end_tmp != NULL)
100 end = end_tmp;
101 out = 1;
102 }
103 if ((end - start)) {
104 memset(num, 0, 5);
105 if ((end - start) > 4)
106 return -EINVAL;
107 memcpy(num, start, end - start);
108 if (!qeth_l3_isxdigit(num))
109 return -EINVAL;
110 sscanf(start, "%x", &num2);
111 if (found)
112 in_tmp[save_cnt++] = num2;
113 else
114 in[cnt++] = num2;
115 if (out)
116 break;
117 } else {
118 if (found)
119 return -EINVAL;
120 found = 1;
121 }
122 start = ++end;
123 }
124 if (cnt + save_cnt > 8)
125 return -EINVAL;
126 cnt = 7;
127 while (save_cnt)
128 in[cnt--] = in_tmp[--save_cnt];
129 return 0;
130}
131
132void qeth_l3_ipaddr_to_string(enum qeth_prot_versions proto, const __u8 *addr,
133 char *buf)
134{
135 if (proto == QETH_PROT_IPV4)
136 qeth_l3_ipaddr4_to_string(addr, buf);
137 else if (proto == QETH_PROT_IPV6)
138 qeth_l3_ipaddr6_to_string(addr, buf);
139}
140
141int qeth_l3_string_to_ipaddr(const char *buf, enum qeth_prot_versions proto,
142 __u8 *addr)
143{
144 if (proto == QETH_PROT_IPV4)
145 return qeth_l3_string_to_ipaddr4(buf, addr);
146 else if (proto == QETH_PROT_IPV6)
147 return qeth_l3_string_to_ipaddr6(buf, addr);
148 else
149 return -EINVAL;
150}
151
152static void qeth_l3_convert_addr_to_bits(u8 *addr, u8 *bits, int len)
153{
154 int i, j;
155 u8 octet;
156
157 for (i = 0; i < len; ++i) {
158 octet = addr[i];
159 for (j = 7; j >= 0; --j) {
160 bits[i*8 + j] = octet & 1;
161 octet >>= 1;
162 }
163 }
164}
165
6298263a 166int qeth_l3_is_addr_covered_by_ipato(struct qeth_card *card,
4a71df50
FB		 167 struct qeth_ipaddr *addr)
168{
169 struct qeth_ipato_entry *ipatoe;
170 u8 addr_bits[128] = {0, };
171 u8 ipatoe_bits[128] = {0, };
172 int rc = 0;
173
174 if (!card->ipato.enabled)
175 return 0;
176
177 qeth_l3_convert_addr_to_bits((u8 *) &addr->u, addr_bits,
178 (addr->proto == QETH_PROT_IPV4)? 4:16);
179 list_for_each_entry(ipatoe, &card->ipato.entries, entry) {
180 if (addr->proto != ipatoe->proto)
181 continue;
182 qeth_l3_convert_addr_to_bits(ipatoe->addr, ipatoe_bits,
183 (ipatoe->proto == QETH_PROT_IPV4) ?
184 4 : 16);
185 if (addr->proto == QETH_PROT_IPV4)
186 rc = !memcmp(addr_bits, ipatoe_bits,
187 min(32, ipatoe->mask_bits));
188 else
189 rc = !memcmp(addr_bits, ipatoe_bits,
190 min(128, ipatoe->mask_bits));
191 if (rc)
192 break;
193 }
194 /* invert? */
195 if ((addr->proto == QETH_PROT_IPV4) && card->ipato.invert4)
196 rc = !rc;
197 else if ((addr->proto == QETH_PROT_IPV6) && card->ipato.invert6)
198 rc = !rc;
199
200 return rc;
201}
202
5f78e29c
LD		 203inline int
204qeth_l3_ipaddrs_is_equal(struct qeth_ipaddr *addr1, struct qeth_ipaddr *addr2)
4a71df50 205{
5f78e29c
LD		 206 return addr1->proto == addr2->proto &&
207 !memcmp(&addr1->u, &addr2->u, sizeof(addr1->u)) &&
208 !memcmp(&addr1->mac, &addr2->mac, sizeof(addr1->mac));
209}
4a71df50 210
5f78e29c
LD		 211static struct qeth_ipaddr *
212qeth_l3_ip_from_hash(struct qeth_card *card, struct qeth_ipaddr *tmp_addr)
213{
214 struct qeth_ipaddr *addr;
215
216 if (tmp_addr->is_multicast) {
217 hash_for_each_possible(card->ip_mc_htable, addr,
218 hnode, qeth_l3_ipaddr_hash(tmp_addr))
219 if (qeth_l3_ipaddrs_is_equal(tmp_addr, addr))
220 return addr;
4a71df50 221 } else {
5f78e29c
LD		 222 hash_for_each_possible(card->ip_htable, addr,
223 hnode, qeth_l3_ipaddr_hash(tmp_addr))
224 if (qeth_l3_ipaddrs_is_equal(tmp_addr, addr))
225 return addr;
4a71df50 226 }
5f78e29c
LD		 227
228 return NULL;
4a71df50
FB		 229}
230
5f78e29c 231int qeth_l3_delete_ip(struct qeth_card *card, struct qeth_ipaddr *tmp_addr)
4a71df50 232{
4a71df50 233 int rc = 0;
5f78e29c 234 struct qeth_ipaddr *addr;
4a71df50 235
847a50fd 236 QETH_CARD_TEXT(card, 4, "delip");
4a71df50 237
5f78e29c
LD		 238 if (tmp_addr->proto == QETH_PROT_IPV4)
239 QETH_CARD_HEX(card, 4, &tmp_addr->u.a4.addr, 4);
4a71df50 240 else {
5f78e29c
LD		 241 QETH_CARD_HEX(card, 4, &tmp_addr->u.a6.addr, 8);
242 QETH_CARD_HEX(card, 4, ((char *)&tmp_addr->u.a6.addr) + 8, 8);
4a71df50 243 }
5f78e29c
LD		 244
245 addr = qeth_l3_ip_from_hash(card, tmp_addr);
246 if (!addr)
247 return -ENOENT;
248
249 addr->ref_counter--;
cb816192
KM		 250 if (addr->ref_counter > 0 && (addr->type == QETH_IP_TYPE_NORMAL ||
251 addr->type == QETH_IP_TYPE_RXIP))
5f78e29c
LD		 252 return rc;
253 if (addr->in_progress)
254 return -EINPROGRESS;
255
a7531c1c
UB		 256 if (!qeth_card_hw_is_reachable(card)) {
257 addr->disp_flag = QETH_DISP_ADDR_DELETE;
258 return 0;
259 }
260
5f78e29c
LD		 261 rc = qeth_l3_deregister_addr_entry(card, addr);
262
263 hash_del(&addr->hnode);
264 kfree(addr);
265
4a71df50
FB		 266 return rc;
267}
268
5f78e29c 269int qeth_l3_add_ip(struct qeth_card *card, struct qeth_ipaddr *tmp_addr)
4a71df50 270{
4a71df50 271 int rc = 0;
5f78e29c 272 struct qeth_ipaddr *addr;
4a71df50 273
847a50fd 274 QETH_CARD_TEXT(card, 4, "addip");
5f78e29c
LD		 275
276 if (tmp_addr->proto == QETH_PROT_IPV4)
277 QETH_CARD_HEX(card, 4, &tmp_addr->u.a4.addr, 4);
4a71df50 278 else {
5f78e29c
LD		 279 QETH_CARD_HEX(card, 4, &tmp_addr->u.a6.addr, 8);
280 QETH_CARD_HEX(card, 4, ((char *)&tmp_addr->u.a6.addr) + 8, 8);
281 }
282
283 addr = qeth_l3_ip_from_hash(card, tmp_addr);
284 if (!addr) {
285 addr = qeth_l3_get_addr_buffer(tmp_addr->proto);
286 if (!addr)
287 return -ENOMEM;
288
289 memcpy(addr, tmp_addr, sizeof(struct qeth_ipaddr));
290 addr->ref_counter = 1;
291
292 if (addr->type == QETH_IP_TYPE_NORMAL &&
293 qeth_l3_is_addr_covered_by_ipato(card, addr)) {
294 QETH_CARD_TEXT(card, 2, "tkovaddr");
295 addr->set_flags |= QETH_IPA_SETIP_TAKEOVER_FLAG;
296 }
297 hash_add(card->ip_htable, &addr->hnode,
298 qeth_l3_ipaddr_hash(addr));
299
a7531c1c
UB		 300 if (!qeth_card_hw_is_reachable(card)) {
301 addr->disp_flag = QETH_DISP_ADDR_ADD;
302 return 0;
303 }
304
5f78e29c
LD		 305 /* qeth_l3_register_addr_entry can go to sleep
306 * if we add a IPV4 addr. It is caused by the reason
307 * that SETIP ipa cmd starts ARP staff for IPV4 addr.
308 * Thus we should unlock spinlock, and make a protection
309 * using in_progress variable to indicate that there is
310 * an hardware operation with this IPV4 address
311 */
312 if (addr->proto == QETH_PROT_IPV4) {
313 addr->in_progress = 1;
314 spin_unlock_bh(&card->ip_lock);
315 rc = qeth_l3_register_addr_entry(card, addr);
316 spin_lock_bh(&card->ip_lock);
317 addr->in_progress = 0;
318 } else
319 rc = qeth_l3_register_addr_entry(card, addr);
320
321 if (!rc || (rc == IPA_RC_DUPLICATE_IP_ADDRESS) ||
322 (rc == IPA_RC_LAN_OFFLINE)) {
323 addr->disp_flag = QETH_DISP_ADDR_DO_NOTHING;
324 if (addr->ref_counter < 1) {
325 qeth_l3_delete_ip(card, addr);
326 kfree(addr);
327 }
328 } else {
329 hash_del(&addr->hnode);
330 kfree(addr);
331 }
332 } else {
cb816192
KM		 333 if (addr->type == QETH_IP_TYPE_NORMAL ||
334 addr->type == QETH_IP_TYPE_RXIP)
335 addr->ref_counter++;
4a71df50 336 }
5f78e29c 337
4a71df50
FB		 338 return rc;
339}
340
341
b3332930 342struct qeth_ipaddr *qeth_l3_get_addr_buffer(
4a71df50
FB		 343 enum qeth_prot_versions prot)
344{
345 struct qeth_ipaddr *addr;
346
347 addr = kzalloc(sizeof(struct qeth_ipaddr), GFP_ATOMIC);
5f78e29c 348 if (!addr)
4a71df50 349 return NULL;
5f78e29c 350
4a71df50 351 addr->type = QETH_IP_TYPE_NORMAL;
5f78e29c 352 addr->disp_flag = QETH_DISP_ADDR_DO_NOTHING;
4a71df50 353 addr->proto = prot;
4a71df50 354
5f78e29c 355 return addr;
4a71df50
FB		 356}
357
5f78e29c 358static void qeth_l3_clear_ip_htable(struct qeth_card *card, int recover)
4a71df50
FB		 359{
360 struct qeth_ipaddr *addr;
5f78e29c
LD		 361 struct hlist_node *tmp;
362 int i;
4a71df50 363
5f78e29c 364 QETH_CARD_TEXT(card, 4, "clearip");
4a71df50 365
5f78e29c 366 if (recover && card->options.sniffer)
76b11f8e 367 return;
f154b79c 368
5f78e29c
LD		 369 spin_lock_bh(&card->ip_lock);
370
371 hash_for_each_safe(card->ip_htable, i, tmp, addr, hnode) {
372 if (!recover) {
373 hash_del(&addr->hnode);
374 kfree(addr);
4a71df50
FB		 375 continue;
376 }
5f78e29c 377 addr->disp_flag = QETH_DISP_ADDR_ADD;
4a71df50 378 }
4a71df50 379
5f78e29c 380 spin_unlock_bh(&card->ip_lock);
4a71df50 381
5f78e29c
LD		 382 spin_lock_bh(&card->mclock);
383
384 hash_for_each_safe(card->ip_mc_htable, i, tmp, addr, hnode) {
385 hash_del(&addr->hnode);
4a71df50
FB		 386 kfree(addr);
387 }
388
5f78e29c
LD		 389 spin_unlock_bh(&card->mclock);
390
4a71df50 391
5f78e29c
LD		 392}
393static void qeth_l3_recover_ip(struct qeth_card *card)
4a71df50 394{
5f78e29c
LD		 395 struct qeth_ipaddr *addr;
396 struct hlist_node *tmp;
397 int i;
398 int rc;
4a71df50 399
a7531c1c 400 QETH_CARD_TEXT(card, 4, "recovrip");
5f78e29c
LD		 401
402 spin_lock_bh(&card->ip_lock);
403
404 hash_for_each_safe(card->ip_htable, i, tmp, addr, hnode) {
a7531c1c
UB		 405 if (addr->disp_flag == QETH_DISP_ADDR_DELETE) {
406 qeth_l3_deregister_addr_entry(card, addr);
407 hash_del(&addr->hnode);
408 kfree(addr);
409 } else if (addr->disp_flag == QETH_DISP_ADDR_ADD) {
5f78e29c
LD		 410 if (addr->proto == QETH_PROT_IPV4) {
411 addr->in_progress = 1;
412 spin_unlock_bh(&card->ip_lock);
413 rc = qeth_l3_register_addr_entry(card, addr);
414 spin_lock_bh(&card->ip_lock);
415 addr->in_progress = 0;
416 } else
417 rc = qeth_l3_register_addr_entry(card, addr);
418
419 if (!rc) {
420 addr->disp_flag = QETH_DISP_ADDR_DO_NOTHING;
a7531c1c 421 if (addr->ref_counter < 1)
5f78e29c 422 qeth_l3_delete_ip(card, addr);
5f78e29c
LD		 423 } else {
424 hash_del(&addr->hnode);
425 kfree(addr);
426 }
427 }
428 }
4a71df50 429
5f78e29c 430 spin_unlock_bh(&card->ip_lock);
4a71df50 431
4a71df50
FB		 432}
433
434static int qeth_l3_send_setdelmc(struct qeth_card *card,
435 struct qeth_ipaddr *addr, int ipacmd)
436{
437 int rc;
438 struct qeth_cmd_buffer *iob;
439 struct qeth_ipa_cmd *cmd;
440
847a50fd 441 QETH_CARD_TEXT(card, 4, "setdelmc");
4a71df50
FB		 442
443 iob = qeth_get_ipacmd_buffer(card, ipacmd, addr->proto);
1aec42bc
TR		 444 if (!iob)
445 return -ENOMEM;
4a71df50
FB		 446 cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
447 memcpy(&cmd->data.setdelipm.mac, addr->mac, OSA_ADDR_LEN);
448 if (addr->proto == QETH_PROT_IPV6)
449 memcpy(cmd->data.setdelipm.ip6, &addr->u.a6.addr,
450 sizeof(struct in6_addr));
451 else
452 memcpy(&cmd->data.setdelipm.ip4, &addr->u.a4.addr, 4);
453
454 rc = qeth_send_ipa_cmd(card, iob, NULL, NULL);
455
456 return rc;
457}
458
459static void qeth_l3_fill_netmask(u8 *netmask, unsigned int len)
460{
461 int i, j;
462 for (i = 0; i < 16; i++) {
463 j = (len) - (i * 8);
464 if (j >= 8)
465 netmask[i] = 0xff;
466 else if (j > 0)
467 netmask[i] = (u8)(0xFF00 >> j);
468 else
469 netmask[i] = 0;
470 }
471}
472
473static int qeth_l3_send_setdelip(struct qeth_card *card,
474 struct qeth_ipaddr *addr, int ipacmd, unsigned int flags)
475{
476 int rc;
477 struct qeth_cmd_buffer *iob;
478 struct qeth_ipa_cmd *cmd;
479 __u8 netmask[16];
480
847a50fd
CO		 481 QETH_CARD_TEXT(card, 4, "setdelip");
482 QETH_CARD_TEXT_(card, 4, "flags%02X", flags);
4a71df50
FB		 483
484 iob = qeth_get_ipacmd_buffer(card, ipacmd, addr->proto);
1aec42bc
TR		 485 if (!iob)
486 return -ENOMEM;
4a71df50
FB		 487 cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
488 if (addr->proto == QETH_PROT_IPV6) {
489 memcpy(cmd->data.setdelip6.ip_addr, &addr->u.a6.addr,
490 sizeof(struct in6_addr));
491 qeth_l3_fill_netmask(netmask, addr->u.a6.pfxlen);
492 memcpy(cmd->data.setdelip6.mask, netmask,
493 sizeof(struct in6_addr));
494 cmd->data.setdelip6.flags = flags;
495 } else {
496 memcpy(cmd->data.setdelip4.ip_addr, &addr->u.a4.addr, 4);
497 memcpy(cmd->data.setdelip4.mask, &addr->u.a4.mask, 4);
498 cmd->data.setdelip4.flags = flags;
499 }
500
501 rc = qeth_send_ipa_cmd(card, iob, NULL, NULL);
502
503 return rc;
504}
505
506static int qeth_l3_send_setrouting(struct qeth_card *card,
507 enum qeth_routing_types type, enum qeth_prot_versions prot)
508{
509 int rc;
510 struct qeth_ipa_cmd *cmd;
511 struct qeth_cmd_buffer *iob;
512
847a50fd 513 QETH_CARD_TEXT(card, 4, "setroutg");
4a71df50 514 iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SETRTG, prot);
1aec42bc
TR		 515 if (!iob)
516 return -ENOMEM;
4a71df50
FB		 517 cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
518 cmd->data.setrtg.type = (type);
519 rc = qeth_send_ipa_cmd(card, iob, NULL, NULL);
520
521 return rc;
522}
523
82e2e782 524static int qeth_l3_correct_routing_type(struct qeth_card *card,
4a71df50
FB		 525 enum qeth_routing_types *type, enum qeth_prot_versions prot)
526{
527 if (card->info.type == QETH_CARD_TYPE_IQD) {
528 switch (*type) {
529 case NO_ROUTER:
530 case PRIMARY_CONNECTOR:
531 case SECONDARY_CONNECTOR:
532 case MULTICAST_ROUTER:
82e2e782 533 return 0;
4a71df50
FB		 534 default:
535 goto out_inval;
536 }
537 } else {
538 switch (*type) {
539 case NO_ROUTER:
540 case PRIMARY_ROUTER:
541 case SECONDARY_ROUTER:
82e2e782 542 return 0;
4a71df50
FB		 543 case MULTICAST_ROUTER:
544 if (qeth_is_ipafunc_supported(card, prot,
545 IPA_OSA_MC_ROUTER))
82e2e782 546 return 0;
4a71df50
FB		 547 default:
548 goto out_inval;
549 }
550 }
551out_inval:
4a71df50 552 *type = NO_ROUTER;
82e2e782 553 return -EINVAL;
4a71df50
FB		 554}
555
556int qeth_l3_setrouting_v4(struct qeth_card *card)
557{
558 int rc;
559
847a50fd 560 QETH_CARD_TEXT(card, 3, "setrtg4");
4a71df50 561
82e2e782 562 rc = qeth_l3_correct_routing_type(card, &card->options.route4.type,
4a71df50 563 QETH_PROT_IPV4);
82e2e782
SR		 564 if (rc)
565 return rc;
4a71df50
FB		 566
567 rc = qeth_l3_send_setrouting(card, card->options.route4.type,
568 QETH_PROT_IPV4);
569 if (rc) {
570 card->options.route4.type = NO_ROUTER;
14cc21b6
FB		 571 QETH_DBF_MESSAGE(2, "Error (0x%04x) while setting routing type"
572 " on %s. Type set to 'no router'.\n", rc,
573 QETH_CARD_IFNAME(card));
4a71df50
FB		 574 }
575 return rc;
576}
577
578int qeth_l3_setrouting_v6(struct qeth_card *card)
579{
580 int rc = 0;
581
847a50fd 582 QETH_CARD_TEXT(card, 3, "setrtg6");
4a71df50
FB		 583#ifdef CONFIG_QETH_IPV6
584
585 if (!qeth_is_supported(card, IPA_IPV6))
586 return 0;
82e2e782 587 rc = qeth_l3_correct_routing_type(card, &card->options.route6.type,
4a71df50 588 QETH_PROT_IPV6);
82e2e782
SR		 589 if (rc)
590 return rc;
4a71df50
FB		 591
592 rc = qeth_l3_send_setrouting(card, card->options.route6.type,
593 QETH_PROT_IPV6);
594 if (rc) {
595 card->options.route6.type = NO_ROUTER;
14cc21b6
FB		 596 QETH_DBF_MESSAGE(2, "Error (0x%04x) while setting routing type"
597 " on %s. Type set to 'no router'.\n", rc,
598 QETH_CARD_IFNAME(card));
4a71df50
FB		 599 }
600#endif
601 return rc;
602}
603
604/*
605 * IP address takeover related functions
606 */
607static void qeth_l3_clear_ipato_list(struct qeth_card *card)
608{
4a71df50 609 struct qeth_ipato_entry *ipatoe, *tmp;
4a71df50 610
5f78e29c
LD		 611 spin_lock_bh(&card->ip_lock);
612
4a71df50
FB		 613 list_for_each_entry_safe(ipatoe, tmp, &card->ipato.entries, entry) {
614 list_del(&ipatoe->entry);
615 kfree(ipatoe);
616 }
5f78e29c
LD		 617
618 spin_unlock_bh(&card->ip_lock);
4a71df50
FB		 619}
620
621int qeth_l3_add_ipato_entry(struct qeth_card *card,
622 struct qeth_ipato_entry *new)
623{
624 struct qeth_ipato_entry *ipatoe;
4a71df50
FB		 625 int rc = 0;
626
847a50fd 627 QETH_CARD_TEXT(card, 2, "addipato");
5f78e29c
LD		 628
629 spin_lock_bh(&card->ip_lock);
630
4a71df50
FB		 631 list_for_each_entry(ipatoe, &card->ipato.entries, entry) {
632 if (ipatoe->proto != new->proto)
633 continue;
634 if (!memcmp(ipatoe->addr, new->addr,
635 (ipatoe->proto == QETH_PROT_IPV4)? 4:16) &&
636 (ipatoe->mask_bits == new->mask_bits)) {
4a71df50
FB		 637 rc = -EEXIST;
638 break;
639 }
640 }
5f78e29c 641
4a71df50
FB		 642 if (!rc)
643 list_add_tail(&new->entry, &card->ipato.entries);
644
5f78e29c
LD		 645 spin_unlock_bh(&card->ip_lock);
646
4a71df50
FB		 647 return rc;
648}
649
650void qeth_l3_del_ipato_entry(struct qeth_card *card,
651 enum qeth_prot_versions proto, u8 *addr, int mask_bits)
652{
653 struct qeth_ipato_entry *ipatoe, *tmp;
4a71df50 654
847a50fd 655 QETH_CARD_TEXT(card, 2, "delipato");
5f78e29c
LD		 656
657 spin_lock_bh(&card->ip_lock);
658
4a71df50
FB		 659 list_for_each_entry_safe(ipatoe, tmp, &card->ipato.entries, entry) {
660 if (ipatoe->proto != proto)
661 continue;
662 if (!memcmp(ipatoe->addr, addr,
663 (proto == QETH_PROT_IPV4)? 4:16) &&
664 (ipatoe->mask_bits == mask_bits)) {
665 list_del(&ipatoe->entry);
666 kfree(ipatoe);
667 }
668 }
5f78e29c
LD		 669
670 spin_unlock_bh(&card->ip_lock);
4a71df50
FB		 671}
672
673/*
674 * VIPA related functions
675 */
676int qeth_l3_add_vipa(struct qeth_card *card, enum qeth_prot_versions proto,
677 const u8 *addr)
678{
679 struct qeth_ipaddr *ipaddr;
4a71df50
FB		 680 int rc = 0;
681
682 ipaddr = qeth_l3_get_addr_buffer(proto);
683 if (ipaddr) {
684 if (proto == QETH_PROT_IPV4) {
847a50fd 685 QETH_CARD_TEXT(card, 2, "addvipa4");
4a71df50
FB		 686 memcpy(&ipaddr->u.a4.addr, addr, 4);
687 ipaddr->u.a4.mask = 0;
688 } else if (proto == QETH_PROT_IPV6) {
847a50fd 689 QETH_CARD_TEXT(card, 2, "addvipa6");
4a71df50
FB		 690 memcpy(&ipaddr->u.a6.addr, addr, 16);
691 ipaddr->u.a6.pfxlen = 0;
692 }
693 ipaddr->type = QETH_IP_TYPE_VIPA;
694 ipaddr->set_flags = QETH_IPA_SETIP_VIPA_FLAG;
695 ipaddr->del_flags = QETH_IPA_DELIP_VIPA_FLAG;
696 } else
697 return -ENOMEM;
5f78e29c
LD		 698
699 spin_lock_bh(&card->ip_lock);
700
732a59cb 701 if (qeth_l3_ip_from_hash(card, ipaddr))
4a71df50 702 rc = -EEXIST;
5f78e29c
LD		 703 else
704 qeth_l3_add_ip(card, ipaddr);
705
706 spin_unlock_bh(&card->ip_lock);
707
708 kfree(ipaddr);
709
4a71df50
FB		 710 return rc;
711}
712
713void qeth_l3_del_vipa(struct qeth_card *card, enum qeth_prot_versions proto,
714 const u8 *addr)
715{
716 struct qeth_ipaddr *ipaddr;
717
718 ipaddr = qeth_l3_get_addr_buffer(proto);
719 if (ipaddr) {
720 if (proto == QETH_PROT_IPV4) {
847a50fd 721 QETH_CARD_TEXT(card, 2, "delvipa4");
4a71df50
FB		 722 memcpy(&ipaddr->u.a4.addr, addr, 4);
723 ipaddr->u.a4.mask = 0;
724 } else if (proto == QETH_PROT_IPV6) {
847a50fd 725 QETH_CARD_TEXT(card, 2, "delvipa6");
4a71df50
FB		 726 memcpy(&ipaddr->u.a6.addr, addr, 16);
727 ipaddr->u.a6.pfxlen = 0;
728 }
729 ipaddr->type = QETH_IP_TYPE_VIPA;
730 } else
731 return;
5f78e29c
LD		 732
733 spin_lock_bh(&card->ip_lock);
734 qeth_l3_delete_ip(card, ipaddr);
735 spin_unlock_bh(&card->ip_lock);
736
737 kfree(ipaddr);
4a71df50
FB		 738}
739
740/*
741 * proxy ARP related functions
742 */
743int qeth_l3_add_rxip(struct qeth_card *card, enum qeth_prot_versions proto,
744 const u8 *addr)
745{
746 struct qeth_ipaddr *ipaddr;
4a71df50
FB		 747 int rc = 0;
748
749 ipaddr = qeth_l3_get_addr_buffer(proto);
750 if (ipaddr) {
751 if (proto == QETH_PROT_IPV4) {
847a50fd 752 QETH_CARD_TEXT(card, 2, "addrxip4");
4a71df50
FB		 753 memcpy(&ipaddr->u.a4.addr, addr, 4);
754 ipaddr->u.a4.mask = 0;
755 } else if (proto == QETH_PROT_IPV6) {
847a50fd 756 QETH_CARD_TEXT(card, 2, "addrxip6");
4a71df50
FB		 757 memcpy(&ipaddr->u.a6.addr, addr, 16);
758 ipaddr->u.a6.pfxlen = 0;
759 }
5f78e29c 760
4a71df50
FB		 761 ipaddr->type = QETH_IP_TYPE_RXIP;
762 ipaddr->set_flags = QETH_IPA_SETIP_TAKEOVER_FLAG;
763 ipaddr->del_flags = 0;
764 } else
765 return -ENOMEM;
5f78e29c
LD		 766
767 spin_lock_bh(&card->ip_lock);
768
732a59cb 769 if (qeth_l3_ip_from_hash(card, ipaddr))
4a71df50 770 rc = -EEXIST;
5f78e29c
LD		 771 else
772 qeth_l3_add_ip(card, ipaddr);
773
774 spin_unlock_bh(&card->ip_lock);
775
776 kfree(ipaddr);
777
778 return rc;
4a71df50
FB		 779}
780
781void qeth_l3_del_rxip(struct qeth_card *card, enum qeth_prot_versions proto,
782 const u8 *addr)
783{
784 struct qeth_ipaddr *ipaddr;
785
786 ipaddr = qeth_l3_get_addr_buffer(proto);
787 if (ipaddr) {
788 if (proto == QETH_PROT_IPV4) {
ea4ae35a 789 QETH_CARD_TEXT(card, 2, "delrxip4");
4a71df50
FB		 790 memcpy(&ipaddr->u.a4.addr, addr, 4);
791 ipaddr->u.a4.mask = 0;
792 } else if (proto == QETH_PROT_IPV6) {
ea4ae35a 793 QETH_CARD_TEXT(card, 2, "delrxip6");
4a71df50
FB		 794 memcpy(&ipaddr->u.a6.addr, addr, 16);
795 ipaddr->u.a6.pfxlen = 0;
796 }
797 ipaddr->type = QETH_IP_TYPE_RXIP;
798 } else
799 return;
5f78e29c
LD		 800
801 spin_lock_bh(&card->ip_lock);
802 qeth_l3_delete_ip(card, ipaddr);
803 spin_unlock_bh(&card->ip_lock);
804
805 kfree(ipaddr);
4a71df50
FB		 806}
807
808static int qeth_l3_register_addr_entry(struct qeth_card *card,
809 struct qeth_ipaddr *addr)
810{
811 char buf[50];
812 int rc = 0;
813 int cnt = 3;
814
5f78e29c 815
4a71df50 816 if (addr->proto == QETH_PROT_IPV4) {
847a50fd
CO		 817 QETH_CARD_TEXT(card, 2, "setaddr4");
818 QETH_CARD_HEX(card, 3, &addr->u.a4.addr, sizeof(int));
4a71df50 819 } else if (addr->proto == QETH_PROT_IPV6) {
847a50fd
CO		 820 QETH_CARD_TEXT(card, 2, "setaddr6");
821 QETH_CARD_HEX(card, 3, &addr->u.a6.addr, 8);
822 QETH_CARD_HEX(card, 3, ((char *)&addr->u.a6.addr) + 8, 8);
4a71df50 823 } else {
847a50fd
CO		 824 QETH_CARD_TEXT(card, 2, "setaddr?");
825 QETH_CARD_HEX(card, 3, addr, sizeof(struct qeth_ipaddr));
4a71df50
FB		 826 }
827 do {
828 if (addr->is_multicast)
829 rc = qeth_l3_send_setdelmc(card, addr, IPA_CMD_SETIPM);
830 else
831 rc = qeth_l3_send_setdelip(card, addr, IPA_CMD_SETIP,
832 addr->set_flags);
833 if (rc)
847a50fd 834 QETH_CARD_TEXT(card, 2, "failed");
4a71df50
FB		 835 } while ((--cnt > 0) && rc);
836 if (rc) {
847a50fd 837 QETH_CARD_TEXT(card, 2, "FAILED");
4a71df50 838 qeth_l3_ipaddr_to_string(addr->proto, (u8 *)&addr->u, buf);
74eacdb9
FB		 839 dev_warn(&card->gdev->dev,
840 "Registering IP address %s failed\n", buf);
4a71df50
FB		 841 }
842 return rc;
843}
844
845static int qeth_l3_deregister_addr_entry(struct qeth_card *card,
846 struct qeth_ipaddr *addr)
847{
848 int rc = 0;
849
850 if (addr->proto == QETH_PROT_IPV4) {
847a50fd
CO		 851 QETH_CARD_TEXT(card, 2, "deladdr4");
852 QETH_CARD_HEX(card, 3, &addr->u.a4.addr, sizeof(int));
4a71df50 853 } else if (addr->proto == QETH_PROT_IPV6) {
847a50fd
CO		 854 QETH_CARD_TEXT(card, 2, "deladdr6");
855 QETH_CARD_HEX(card, 3, &addr->u.a6.addr, 8);
856 QETH_CARD_HEX(card, 3, ((char *)&addr->u.a6.addr) + 8, 8);
4a71df50 857 } else {
847a50fd
CO		 858 QETH_CARD_TEXT(card, 2, "deladdr?");
859 QETH_CARD_HEX(card, 3, addr, sizeof(struct qeth_ipaddr));
4a71df50
FB		 860 }
861 if (addr->is_multicast)
862 rc = qeth_l3_send_setdelmc(card, addr, IPA_CMD_DELIPM);
863 else
864 rc = qeth_l3_send_setdelip(card, addr, IPA_CMD_DELIP,
865 addr->del_flags);
c4cef07c 866 if (rc)
847a50fd 867 QETH_CARD_TEXT(card, 2, "failed");
4a71df50
FB		 868
869 return rc;
870}
871
cef6ff22 872static u8 qeth_l3_get_qeth_hdr_flags4(int cast_type)
4a71df50
FB		 873{
874 if (cast_type == RTN_MULTICAST)
875 return QETH_CAST_MULTICAST;
876 if (cast_type == RTN_BROADCAST)
877 return QETH_CAST_BROADCAST;
878 return QETH_CAST_UNICAST;
879}
880
cef6ff22 881static u8 qeth_l3_get_qeth_hdr_flags6(int cast_type)
4a71df50
FB		 882{
883 u8 ct = QETH_HDR_PASSTHRU | QETH_HDR_IPV6;
884 if (cast_type == RTN_MULTICAST)
885 return ct | QETH_CAST_MULTICAST;
886 if (cast_type == RTN_ANYCAST)
887 return ct | QETH_CAST_ANYCAST;
888 if (cast_type == RTN_BROADCAST)
889 return ct | QETH_CAST_BROADCAST;
890 return ct | QETH_CAST_UNICAST;
891}
892
4a71df50
FB		 893static int qeth_l3_setadapter_parms(struct qeth_card *card)
894{
699d3fe5 895 int rc = 0;
4a71df50 896
d11ba0c4 897 QETH_DBF_TEXT(SETUP, 2, "setadprm");
4a71df50 898
4a71df50
FB		 899 if (qeth_adp_supported(card, IPA_SETADP_ALTER_MAC_ADDRESS)) {
900 rc = qeth_setadpparms_change_macaddr(card);
901 if (rc)
74eacdb9 902 dev_warn(&card->gdev->dev, "Reading the adapter MAC"
6ea2fde1 903 " address failed\n");
4a71df50
FB		 904 }
905
4a71df50
FB		 906 return rc;
907}
908
4a71df50
FB		 909#ifdef CONFIG_QETH_IPV6
910static int qeth_l3_send_simple_setassparms_ipv6(struct qeth_card *card,
911 enum qeth_ipa_funcs ipa_func, __u16 cmd_code)
912{
913 int rc;
914 struct qeth_cmd_buffer *iob;
915
847a50fd 916 QETH_CARD_TEXT(card, 4, "simassp6");
b475e316 917 iob = qeth_get_setassparms_cmd(card, ipa_func, cmd_code,
4a71df50 918 0, QETH_PROT_IPV6);
1aec42bc
TR		 919 if (!iob)
920 return -ENOMEM;
4d7def2a 921 rc = qeth_send_setassparms(card, iob, 0, 0,
8f43fb00 922 qeth_setassparms_cb, NULL);
4a71df50
FB		 923 return rc;
924}
925#endif
926
4a71df50
FB		 927static int qeth_l3_start_ipa_arp_processing(struct qeth_card *card)
928{
929 int rc;
930
847a50fd 931 QETH_CARD_TEXT(card, 3, "ipaarp");
4a71df50
FB		 932
933 if (!qeth_is_supported(card, IPA_ARP_PROCESSING)) {
74eacdb9
FB		 934 dev_info(&card->gdev->dev,
935 "ARP processing not supported on %s!\n",
936 QETH_CARD_IFNAME(card));
4a71df50
FB		 937 return 0;
938 }
4d7def2a
TR		 939 rc = qeth_send_simple_setassparms(card, IPA_ARP_PROCESSING,
940 IPA_CMD_ASS_START, 0);
4a71df50 941 if (rc) {
74eacdb9
FB		 942 dev_warn(&card->gdev->dev,
943 "Starting ARP processing support for %s failed\n",
944 QETH_CARD_IFNAME(card));
4a71df50
FB		 945 }
946 return rc;
947}
948
4a71df50
FB		 949static int qeth_l3_start_ipa_source_mac(struct qeth_card *card)
950{
951 int rc;
952
847a50fd 953 QETH_CARD_TEXT(card, 3, "stsrcmac");
4a71df50 954
4a71df50 955 if (!qeth_is_supported(card, IPA_SOURCE_MAC)) {
74eacdb9 956 dev_info(&card->gdev->dev,
fe94e2e0 957 "Inbound source MAC-address not supported on %s\n",
74eacdb9 958 QETH_CARD_IFNAME(card));
4a71df50
FB		 959 return -EOPNOTSUPP;
960 }
961
4d7def2a 962 rc = qeth_send_simple_setassparms(card, IPA_SOURCE_MAC,
4a71df50
FB		 963 IPA_CMD_ASS_START, 0);
964 if (rc)
74eacdb9 965 dev_warn(&card->gdev->dev,
fe94e2e0 966 "Starting source MAC-address support for %s failed\n",
74eacdb9 967 QETH_CARD_IFNAME(card));
4a71df50
FB		 968 return rc;
969}
970
971static int qeth_l3_start_ipa_vlan(struct qeth_card *card)
972{
973 int rc = 0;
974
847a50fd 975 QETH_CARD_TEXT(card, 3, "strtvlan");
4a71df50
FB		 976
977 if (!qeth_is_supported(card, IPA_FULL_VLAN)) {
74eacdb9
FB		 978 dev_info(&card->gdev->dev,
979 "VLAN not supported on %s\n", QETH_CARD_IFNAME(card));
4a71df50
FB		 980 return -EOPNOTSUPP;
981 }
982
4d7def2a 983 rc = qeth_send_simple_setassparms(card, IPA_VLAN_PRIO,
4a71df50
FB		 984 IPA_CMD_ASS_START, 0);
985 if (rc) {
74eacdb9
FB		 986 dev_warn(&card->gdev->dev,
987 "Starting VLAN support for %s failed\n",
988 QETH_CARD_IFNAME(card));
4a71df50 989 } else {
74eacdb9 990 dev_info(&card->gdev->dev, "VLAN enabled\n");
4a71df50
FB		 991 }
992 return rc;
993}
994
995static int qeth_l3_start_ipa_multicast(struct qeth_card *card)
996{
997 int rc;
998
847a50fd 999 QETH_CARD_TEXT(card, 3, "stmcast");
4a71df50
FB		 1000
1001 if (!qeth_is_supported(card, IPA_MULTICASTING)) {
74eacdb9
FB		 1002 dev_info(&card->gdev->dev,
1003 "Multicast not supported on %s\n",
1004 QETH_CARD_IFNAME(card));
4a71df50
FB		 1005 return -EOPNOTSUPP;
1006 }
1007
4d7def2a 1008 rc = qeth_send_simple_setassparms(card, IPA_MULTICASTING,
4a71df50
FB		 1009 IPA_CMD_ASS_START, 0);
1010 if (rc) {
74eacdb9
FB		 1011 dev_warn(&card->gdev->dev,
1012 "Starting multicast support for %s failed\n",
1013 QETH_CARD_IFNAME(card));
4a71df50 1014 } else {
74eacdb9 1015 dev_info(&card->gdev->dev, "Multicast enabled\n");
4a71df50
FB		 1016 card->dev->flags |= IFF_MULTICAST;
1017 }
1018 return rc;
1019}
1020
4a71df50
FB		 1021#ifdef CONFIG_QETH_IPV6
1022static int qeth_l3_softsetup_ipv6(struct qeth_card *card)
1023{
1024 int rc;
1025
847a50fd 1026 QETH_CARD_TEXT(card, 3, "softipv6");
4a71df50 1027
1da74b1c 1028 rc = qeth_query_ipassists(card, QETH_PROT_IPV6);
4a71df50 1029 if (rc) {
74eacdb9
FB		 1030 dev_err(&card->gdev->dev,
1031 "Activating IPv6 support for %s failed\n",
1032 QETH_CARD_IFNAME(card));
4a71df50
FB		 1033 return rc;
1034 }
23274596
JW		 1035
1036 if (card->info.type == QETH_CARD_TYPE_IQD)
1037 goto out;
1038
4d7def2a 1039 rc = qeth_send_simple_setassparms(card, IPA_IPV6,
4a71df50
FB		 1040 IPA_CMD_ASS_START, 3);
1041 if (rc) {
74eacdb9
FB		 1042 dev_err(&card->gdev->dev,
1043 "Activating IPv6 support for %s failed\n",
1044 QETH_CARD_IFNAME(card));
4a71df50
FB		 1045 return rc;
1046 }
1047 rc = qeth_l3_send_simple_setassparms_ipv6(card, IPA_IPV6,
1048 IPA_CMD_ASS_START);
1049 if (rc) {
74eacdb9
FB		 1050 dev_err(&card->gdev->dev,
1051 "Activating IPv6 support for %s failed\n",
1052 QETH_CARD_IFNAME(card));
4a71df50
FB		 1053 return rc;
1054 }
1055 rc = qeth_l3_send_simple_setassparms_ipv6(card, IPA_PASSTHRU,
1056 IPA_CMD_ASS_START);
1057 if (rc) {
74eacdb9
FB		 1058 dev_warn(&card->gdev->dev,
1059 "Enabling the passthrough mode for %s failed\n",
1060 QETH_CARD_IFNAME(card));
4a71df50
FB		 1061 return rc;
1062 }
1063out:
74eacdb9 1064 dev_info(&card->gdev->dev, "IPV6 enabled\n");
4a71df50
FB		 1065 return 0;
1066}
1067#endif
1068
1069static int qeth_l3_start_ipa_ipv6(struct qeth_card *card)
1070{
1071 int rc = 0;
1072
847a50fd 1073 QETH_CARD_TEXT(card, 3, "strtipv6");
4a71df50
FB		 1074
1075 if (!qeth_is_supported(card, IPA_IPV6)) {
74eacdb9
FB		 1076 dev_info(&card->gdev->dev,
1077 "IPv6 not supported on %s\n", QETH_CARD_IFNAME(card));
4a71df50
FB		 1078 return 0;
1079 }
1080#ifdef CONFIG_QETH_IPV6
1081 rc = qeth_l3_softsetup_ipv6(card);
1082#endif
1083 return rc ;
1084}
1085
1086static int qeth_l3_start_ipa_broadcast(struct qeth_card *card)
1087{
1088 int rc;
1089
847a50fd 1090 QETH_CARD_TEXT(card, 3, "stbrdcst");
4a71df50
FB		 1091 card->info.broadcast_capable = 0;
1092 if (!qeth_is_supported(card, IPA_FILTERING)) {
74eacdb9
FB		 1093 dev_info(&card->gdev->dev,
1094 "Broadcast not supported on %s\n",
1095 QETH_CARD_IFNAME(card));
4a71df50
FB		 1096 rc = -EOPNOTSUPP;
1097 goto out;
1098 }
4d7def2a 1099 rc = qeth_send_simple_setassparms(card, IPA_FILTERING,
4a71df50
FB		 1100 IPA_CMD_ASS_START, 0);
1101 if (rc) {
74eacdb9
FB		 1102 dev_warn(&card->gdev->dev, "Enabling broadcast filtering for "
1103 "%s failed\n", QETH_CARD_IFNAME(card));
4a71df50
FB		 1104 goto out;
1105 }
1106
4d7def2a 1107 rc = qeth_send_simple_setassparms(card, IPA_FILTERING,
4a71df50
FB		 1108 IPA_CMD_ASS_CONFIGURE, 1);
1109 if (rc) {
74eacdb9
FB		 1110 dev_warn(&card->gdev->dev,
1111 "Setting up broadcast filtering for %s failed\n",
1112 QETH_CARD_IFNAME(card));
4a71df50
FB		 1113 goto out;
1114 }
1115 card->info.broadcast_capable = QETH_BROADCAST_WITH_ECHO;
74eacdb9 1116 dev_info(&card->gdev->dev, "Broadcast enabled\n");
4d7def2a 1117 rc = qeth_send_simple_setassparms(card, IPA_FILTERING,
4a71df50
FB		 1118 IPA_CMD_ASS_ENABLE, 1);
1119 if (rc) {
74eacdb9
FB		 1120 dev_warn(&card->gdev->dev, "Setting up broadcast echo "
1121 "filtering for %s failed\n", QETH_CARD_IFNAME(card));
4a71df50
FB		 1122 goto out;
1123 }
1124 card->info.broadcast_capable = QETH_BROADCAST_WITHOUT_ECHO;
1125out:
1126 if (card->info.broadcast_capable)
1127 card->dev->flags |= IFF_BROADCAST;
1128 else
1129 card->dev->flags &= ~IFF_BROADCAST;
1130 return rc;
1131}
1132
4a71df50
FB		 1133static int qeth_l3_start_ipassists(struct qeth_card *card)
1134{
847a50fd 1135 QETH_CARD_TEXT(card, 3, "strtipas");
d64ecc22 1136
0f54761d
SR		 1137 if (qeth_set_access_ctrl_online(card, 0))
1138 return -EIO;
4a71df50 1139 qeth_l3_start_ipa_arp_processing(card); /* go on*/
4a71df50
FB		 1140 qeth_l3_start_ipa_source_mac(card); /* go on*/
1141 qeth_l3_start_ipa_vlan(card); /* go on*/
1142 qeth_l3_start_ipa_multicast(card); /* go on*/
1143 qeth_l3_start_ipa_ipv6(card); /* go on*/
1144 qeth_l3_start_ipa_broadcast(card); /* go on*/
4a71df50
FB		 1145 return 0;
1146}
1147
4a71df50
FB		 1148static int qeth_l3_iqd_read_initial_mac_cb(struct qeth_card *card,
1149 struct qeth_reply *reply, unsigned long data)
1150{
1151 struct qeth_ipa_cmd *cmd;
1152
1153 cmd = (struct qeth_ipa_cmd *) data;
1154 if (cmd->hdr.return_code == 0)
1155 memcpy(card->dev->dev_addr,
1156 cmd->data.create_destroy_addr.unique_id, ETH_ALEN);
1157 else
1833611d 1158 eth_random_addr(card->dev->dev_addr);
4a71df50
FB		 1159
1160 return 0;
1161}
1162
1163static int qeth_l3_iqd_read_initial_mac(struct qeth_card *card)
1164{
1165 int rc = 0;
1166 struct qeth_cmd_buffer *iob;
1167 struct qeth_ipa_cmd *cmd;
1168
d11ba0c4 1169 QETH_DBF_TEXT(SETUP, 2, "hsrmac");
4a71df50
FB		 1170
1171 iob = qeth_get_ipacmd_buffer(card, IPA_CMD_CREATE_ADDR,
1172 QETH_PROT_IPV6);
1aec42bc
TR		 1173 if (!iob)
1174 return -ENOMEM;
4a71df50
FB		 1175 cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
1176 *((__u16 *) &cmd->data.create_destroy_addr.unique_id[6]) =
1177 card->info.unique_id;
1178
1179 rc = qeth_send_ipa_cmd(card, iob, qeth_l3_iqd_read_initial_mac_cb,
1180 NULL);
1181 return rc;
1182}
1183
1184static int qeth_l3_get_unique_id_cb(struct qeth_card *card,
1185 struct qeth_reply *reply, unsigned long data)
1186{
1187 struct qeth_ipa_cmd *cmd;
1188
1189 cmd = (struct qeth_ipa_cmd *) data;
1190 if (cmd->hdr.return_code == 0)
1191 card->info.unique_id = *((__u16 *)
1192 &cmd->data.create_destroy_addr.unique_id[6]);
1193 else {
1194 card->info.unique_id = UNIQUE_ID_IF_CREATE_ADDR_FAILED |
1195 UNIQUE_ID_NOT_BY_CARD;
74eacdb9
FB		 1196 dev_warn(&card->gdev->dev, "The network adapter failed to "
1197 "generate a unique ID\n");
4a71df50
FB		 1198 }
1199 return 0;
1200}
1201
1202static int qeth_l3_get_unique_id(struct qeth_card *card)
1203{
1204 int rc = 0;
1205 struct qeth_cmd_buffer *iob;
1206 struct qeth_ipa_cmd *cmd;
1207
d11ba0c4 1208 QETH_DBF_TEXT(SETUP, 2, "guniqeid");
4a71df50
FB		 1209
1210 if (!qeth_is_supported(card, IPA_IPV6)) {
1211 card->info.unique_id = UNIQUE_ID_IF_CREATE_ADDR_FAILED |
1212 UNIQUE_ID_NOT_BY_CARD;
1213 return 0;
1214 }
1215
1216 iob = qeth_get_ipacmd_buffer(card, IPA_CMD_CREATE_ADDR,
1217 QETH_PROT_IPV6);
1aec42bc
TR		 1218 if (!iob)
1219 return -ENOMEM;
4a71df50
FB		 1220 cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
1221 *((__u16 *) &cmd->data.create_destroy_addr.unique_id[6]) =
1222 card->info.unique_id;
1223
1224 rc = qeth_send_ipa_cmd(card, iob, qeth_l3_get_unique_id_cb, NULL);
1225 return rc;
1226}
1227
76b11f8e
UB		 1228static int
1229qeth_diags_trace_cb(struct qeth_card *card, struct qeth_reply *reply,
1230 unsigned long data)
1231{
1232 struct qeth_ipa_cmd *cmd;
1233 __u16 rc;
1234
1235 QETH_DBF_TEXT(SETUP, 2, "diastrcb");
1236
1237 cmd = (struct qeth_ipa_cmd *)data;
1238 rc = cmd->hdr.return_code;
a959189a 1239 if (rc)
847a50fd 1240 QETH_CARD_TEXT_(card, 2, "dxter%x", rc);
76b11f8e
UB		 1241 switch (cmd->data.diagass.action) {
1242 case QETH_DIAGS_CMD_TRACE_QUERY:
1243 break;
1244 case QETH_DIAGS_CMD_TRACE_DISABLE:
a959189a
UB		 1245 switch (rc) {
1246 case 0:
1247 case IPA_RC_INVALID_SUBCMD:
1248 card->info.promisc_mode = SET_PROMISC_MODE_OFF;
1249 dev_info(&card->gdev->dev, "The HiperSockets network "
1250 "traffic analyzer is deactivated\n");
1251 break;
1252 default:
1253 break;
1254 }
76b11f8e
UB		 1255 break;
1256 case QETH_DIAGS_CMD_TRACE_ENABLE:
a959189a
UB		 1257 switch (rc) {
1258 case 0:
1259 card->info.promisc_mode = SET_PROMISC_MODE_ON;
1260 dev_info(&card->gdev->dev, "The HiperSockets network "
1261 "traffic analyzer is activated\n");
1262 break;
1263 case IPA_RC_HARDWARE_AUTH_ERROR:
1264 dev_warn(&card->gdev->dev, "The device is not "
1265 "authorized to run as a HiperSockets network "
1266 "traffic analyzer\n");
1267 break;
1268 case IPA_RC_TRACE_ALREADY_ACTIVE:
1269 dev_warn(&card->gdev->dev, "A HiperSockets "
1270 "network traffic analyzer is already "
1271 "active in the HiperSockets LAN\n");
1272 break;
1273 default:
1274 break;
1275 }
76b11f8e
UB		 1276 break;
1277 default:
1278 QETH_DBF_MESSAGE(2, "Unknown sniffer action (0x%04x) on %s\n",
1279 cmd->data.diagass.action, QETH_CARD_IFNAME(card));
1280 }
1281
1282 return 0;
1283}
1284
1285static int
1286qeth_diags_trace(struct qeth_card *card, enum qeth_diags_trace_cmds diags_cmd)
1287{
1288 struct qeth_cmd_buffer *iob;
1289 struct qeth_ipa_cmd *cmd;
1290
1291 QETH_DBF_TEXT(SETUP, 2, "diagtrac");
1292
1293 iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SET_DIAG_ASS, 0);
1aec42bc
TR		 1294 if (!iob)
1295 return -ENOMEM;
76b11f8e
UB		 1296 cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
1297 cmd->data.diagass.subcmd_len = 16;
1298 cmd->data.diagass.subcmd = QETH_DIAGS_CMD_TRACE;
1299 cmd->data.diagass.type = QETH_DIAGS_TYPE_HIPERSOCKET;
1300 cmd->data.diagass.action = diags_cmd;
1301 return qeth_send_ipa_cmd(card, iob, qeth_diags_trace_cb, NULL);
1302}
1303
6bee4e26 1304static void qeth_l3_get_mac_for_ipm(__be32 ipm, char *mac)
4a71df50 1305{
1abd2296 1306 ip_eth_mc_map(ipm, mac);
4a71df50
FB		 1307}
1308
5f78e29c
LD		 1309static void qeth_l3_mark_all_mc_to_be_deleted(struct qeth_card *card)
1310{
1311 struct qeth_ipaddr *addr;
1312 int i;
1313
1314 hash_for_each(card->ip_mc_htable, i, addr, hnode)
1315 addr->disp_flag = QETH_DISP_ADDR_DELETE;
1316
1317}
1318
1319static void qeth_l3_add_all_new_mc(struct qeth_card *card)
1320{
1321 struct qeth_ipaddr *addr;
1322 struct hlist_node *tmp;
1323 int i;
1324 int rc;
1325
1326 hash_for_each_safe(card->ip_mc_htable, i, tmp, addr, hnode) {
1327 if (addr->disp_flag == QETH_DISP_ADDR_ADD) {
1328 rc = qeth_l3_register_addr_entry(card, addr);
1329 if (!rc || (rc == IPA_RC_LAN_OFFLINE))
1330 addr->ref_counter = 1;
1331 else {
1332 hash_del(&addr->hnode);
1333 kfree(addr);
1334 }
1335 }
1336 }
1337
1338}
1339
1340static void qeth_l3_delete_nonused_mc(struct qeth_card *card)
1341{
1342 struct qeth_ipaddr *addr;
1343 struct hlist_node *tmp;
1344 int i;
1345 int rc;
1346
1347 hash_for_each_safe(card->ip_mc_htable, i, tmp, addr, hnode) {
1348 if (addr->disp_flag == QETH_DISP_ADDR_DELETE) {
1349 rc = qeth_l3_deregister_addr_entry(card, addr);
1350 if (!rc || (rc == IPA_RC_MC_ADDR_NOT_FOUND)) {
1351 hash_del(&addr->hnode);
1352 kfree(addr);
1353 }
1354 }
1355 }
1356
1357}
1358
1359
1360static void
1361qeth_l3_add_mc_to_hash(struct qeth_card *card, struct in_device *in4_dev)
4a71df50 1362{
4a71df50 1363 struct ip_mc_list *im4;
5f78e29c 1364 struct qeth_ipaddr *tmp, *ipm;
4a71df50
FB		 1365 char buf[MAX_ADDR_LEN];
1366
847a50fd 1367 QETH_CARD_TEXT(card, 4, "addmc");
5f78e29c
LD		 1368
1369 tmp = qeth_l3_get_addr_buffer(QETH_PROT_IPV4);
1370 if (!tmp)
1371 return;
1372
f3aa3136
SS		 1373 for (im4 = rcu_dereference(in4_dev->mc_list); im4 != NULL;
1374 im4 = rcu_dereference(im4->next_rcu)) {
5f78e29c
LD		 1375 qeth_l3_get_mac_for_ipm(im4->multiaddr, buf);
1376
6bee4e26 1377 tmp->u.a4.addr = be32_to_cpu(im4->multiaddr);
5f78e29c 1378 memcpy(tmp->mac, buf, sizeof(tmp->mac));
bc3ab705 1379 tmp->is_multicast = 1;
5f78e29c
LD		 1380
1381 ipm = qeth_l3_ip_from_hash(card, tmp);
1382 if (ipm) {
1383 ipm->disp_flag = QETH_DISP_ADDR_DO_NOTHING;
1384 } else {
1385 ipm = qeth_l3_get_addr_buffer(QETH_PROT_IPV4);
1386 if (!ipm)
1387 continue;
1388 memcpy(ipm->mac, buf, sizeof(tmp->mac));
6bee4e26 1389 ipm->u.a4.addr = be32_to_cpu(im4->multiaddr);
5f78e29c
LD		 1390 ipm->is_multicast = 1;
1391 ipm->disp_flag = QETH_DISP_ADDR_ADD;
1392 hash_add(card->ip_mc_htable,
1393 &ipm->hnode, qeth_l3_ipaddr_hash(ipm));
1394 }
4a71df50 1395 }
5f78e29c
LD		 1396
1397 kfree(tmp);
4a71df50
FB		 1398}
1399
0347af51 1400/* called with rcu_read_lock */
4a71df50
FB		 1401static void qeth_l3_add_vlan_mc(struct qeth_card *card)
1402{
1403 struct in_device *in_dev;
7ff0bcf6 1404 u16 vid;
4a71df50 1405
847a50fd 1406 QETH_CARD_TEXT(card, 4, "addmcvl");
5f78e29c 1407
7ff0bcf6 1408 if (!qeth_is_supported(card, IPA_FULL_VLAN))
4a71df50
FB		 1409 return;
1410
7ff0bcf6
JP		 1411 for_each_set_bit(vid, card->active_vlans, VLAN_N_VID) {
1412 struct net_device *netdev;
1413
f06c7f9f 1414 netdev = __vlan_find_dev_deep_rcu(card->dev, htons(ETH_P_8021Q),
91b1c1aa 1415 vid);
4a71df50
FB		 1416 if (netdev == NULL ||
1417 !(netdev->flags & IFF_UP))
1418 continue;
0347af51 1419 in_dev = __in_dev_get_rcu(netdev);
4a71df50
FB		 1420 if (!in_dev)
1421 continue;
5f78e29c 1422 qeth_l3_add_mc_to_hash(card, in_dev);
4a71df50
FB		 1423 }
1424}
1425
1426static void qeth_l3_add_multicast_ipv4(struct qeth_card *card)
1427{
1428 struct in_device *in4_dev;
1429
847a50fd 1430 QETH_CARD_TEXT(card, 4, "chkmcv4");
5f78e29c 1431
f3aa3136 1432 rcu_read_lock();
0347af51
JP		 1433 in4_dev = __in_dev_get_rcu(card->dev);
1434 if (in4_dev == NULL)
1435 goto unlock;
5f78e29c 1436 qeth_l3_add_mc_to_hash(card, in4_dev);
4a71df50 1437 qeth_l3_add_vlan_mc(card);
0347af51 1438unlock:
f3aa3136 1439 rcu_read_unlock();
4a71df50
FB		 1440}
1441
1442#ifdef CONFIG_QETH_IPV6
5f78e29c
LD		 1443static void
1444qeth_l3_add_mc6_to_hash(struct qeth_card *card, struct inet6_dev *in6_dev)
4a71df50
FB		 1445{
1446 struct qeth_ipaddr *ipm;
1447 struct ifmcaddr6 *im6;
5f78e29c 1448 struct qeth_ipaddr *tmp;
4a71df50
FB		 1449 char buf[MAX_ADDR_LEN];
1450
847a50fd 1451 QETH_CARD_TEXT(card, 4, "addmc6");
5f78e29c
LD		 1452
1453 tmp = qeth_l3_get_addr_buffer(QETH_PROT_IPV6);
1454 if (!tmp)
1455 return;
1456
4a71df50
FB		 1457 for (im6 = in6_dev->mc_list; im6 != NULL; im6 = im6->next) {
1458 ndisc_mc_map(&im6->mca_addr, buf, in6_dev->dev, 0);
5f78e29c
LD		 1459
1460 memcpy(tmp->mac, buf, sizeof(tmp->mac));
1461 memcpy(&tmp->u.a6.addr, &im6->mca_addr.s6_addr,
1462 sizeof(struct in6_addr));
1463 tmp->is_multicast = 1;
1464
1465 ipm = qeth_l3_ip_from_hash(card, tmp);
1466 if (ipm) {
1467 ipm->disp_flag = QETH_DISP_ADDR_DO_NOTHING;
1468 continue;
1469 }
1470
4a71df50
FB		 1471 ipm = qeth_l3_get_addr_buffer(QETH_PROT_IPV6);
1472 if (!ipm)
1473 continue;
5f78e29c 1474
4a71df50
FB		 1475 memcpy(ipm->mac, buf, OSA_ADDR_LEN);
1476 memcpy(&ipm->u.a6.addr, &im6->mca_addr.s6_addr,
1477 sizeof(struct in6_addr));
5f78e29c
LD		 1478 ipm->is_multicast = 1;
1479 ipm->disp_flag = QETH_DISP_ADDR_ADD;
1480 hash_add(card->ip_mc_htable,
1481 &ipm->hnode, qeth_l3_ipaddr_hash(ipm));
1482
4a71df50 1483 }
5f78e29c 1484 kfree(tmp);
4a71df50
FB		 1485}
1486
0347af51 1487/* called with rcu_read_lock */
4a71df50
FB		 1488static void qeth_l3_add_vlan_mc6(struct qeth_card *card)
1489{
1490 struct inet6_dev *in_dev;
7ff0bcf6 1491 u16 vid;
4a71df50 1492
847a50fd 1493 QETH_CARD_TEXT(card, 4, "admc6vl");
5f78e29c 1494
7ff0bcf6 1495 if (!qeth_is_supported(card, IPA_FULL_VLAN))
4a71df50
FB		 1496 return;
1497
7ff0bcf6
JP		 1498 for_each_set_bit(vid, card->active_vlans, VLAN_N_VID) {
1499 struct net_device *netdev;
1500
f06c7f9f 1501 netdev = __vlan_find_dev_deep_rcu(card->dev, htons(ETH_P_8021Q),
91b1c1aa 1502 vid);
4a71df50
FB		 1503 if (netdev == NULL ||
1504 !(netdev->flags & IFF_UP))
1505 continue;
1506 in_dev = in6_dev_get(netdev);
1507 if (!in_dev)
1508 continue;
1509 read_lock_bh(&in_dev->lock);
5f78e29c 1510 qeth_l3_add_mc6_to_hash(card, in_dev);
4a71df50
FB		 1511 read_unlock_bh(&in_dev->lock);
1512 in6_dev_put(in_dev);
1513 }
1514}
1515
1516static void qeth_l3_add_multicast_ipv6(struct qeth_card *card)
1517{
1518 struct inet6_dev *in6_dev;
1519
847a50fd 1520 QETH_CARD_TEXT(card, 4, "chkmcv6");
5f78e29c 1521
4a71df50
FB		 1522 if (!qeth_is_supported(card, IPA_IPV6))
1523 return ;
1524 in6_dev = in6_dev_get(card->dev);
5f78e29c 1525 if (!in6_dev)
4a71df50 1526 return;
5f78e29c 1527
0347af51 1528 rcu_read_lock();
4a71df50 1529 read_lock_bh(&in6_dev->lock);
5f78e29c 1530 qeth_l3_add_mc6_to_hash(card, in6_dev);
4a71df50
FB		 1531 qeth_l3_add_vlan_mc6(card);
1532 read_unlock_bh(&in6_dev->lock);
0347af51 1533 rcu_read_unlock();
4a71df50
FB		 1534 in6_dev_put(in6_dev);
1535}
1536#endif /* CONFIG_QETH_IPV6 */
1537
1538static void qeth_l3_free_vlan_addresses4(struct qeth_card *card,
1539 unsigned short vid)
1540{
1541 struct in_device *in_dev;
1542 struct in_ifaddr *ifa;
1543 struct qeth_ipaddr *addr;
7ff0bcf6 1544 struct net_device *netdev;
4a71df50 1545
847a50fd 1546 QETH_CARD_TEXT(card, 4, "frvaddr4");
4a71df50 1547
f06c7f9f 1548 netdev = __vlan_find_dev_deep_rcu(card->dev, htons(ETH_P_8021Q), vid);
eabfbe62 1549 if (!netdev)
1550 return;
7ff0bcf6 1551 in_dev = in_dev_get(netdev);
4a71df50
FB		 1552 if (!in_dev)
1553 return;
5f78e29c
LD		 1554
1555 addr = qeth_l3_get_addr_buffer(QETH_PROT_IPV4);
1556 if (!addr)
83cf79a2 1557 goto out;
5f78e29c
LD		 1558
1559 spin_lock_bh(&card->ip_lock);
1560
4a71df50 1561 for (ifa = in_dev->ifa_list; ifa; ifa = ifa->ifa_next) {
6bee4e26
HW		 1562 addr->u.a4.addr = be32_to_cpu(ifa->ifa_address);
1563 addr->u.a4.mask = be32_to_cpu(ifa->ifa_mask);
5f78e29c
LD		 1564 addr->type = QETH_IP_TYPE_NORMAL;
1565 qeth_l3_delete_ip(card, addr);
4a71df50 1566 }
5f78e29c
LD		 1567
1568 spin_unlock_bh(&card->ip_lock);
1569
1570 kfree(addr);
83cf79a2 1571out:
4a71df50
FB		 1572 in_dev_put(in_dev);
1573}
1574
1575static void qeth_l3_free_vlan_addresses6(struct qeth_card *card,
1576 unsigned short vid)
1577{
1578#ifdef CONFIG_QETH_IPV6
1579 struct inet6_dev *in6_dev;
1580 struct inet6_ifaddr *ifa;
1581 struct qeth_ipaddr *addr;
7ff0bcf6 1582 struct net_device *netdev;
4a71df50 1583
847a50fd 1584 QETH_CARD_TEXT(card, 4, "frvaddr6");
4a71df50 1585
f06c7f9f 1586 netdev = __vlan_find_dev_deep_rcu(card->dev, htons(ETH_P_8021Q), vid);
eabfbe62 1587 if (!netdev)
1588 return;
5f78e29c 1589
7ff0bcf6 1590 in6_dev = in6_dev_get(netdev);
4a71df50
FB		 1591 if (!in6_dev)
1592 return;
5f78e29c
LD		 1593
1594 addr = qeth_l3_get_addr_buffer(QETH_PROT_IPV6);
1595 if (!addr)
83cf79a2 1596 goto out;
5f78e29c
LD		 1597
1598 spin_lock_bh(&card->ip_lock);
1599
70f60a22 1600 list_for_each_entry(ifa, &in6_dev->addr_list, if_list) {
5f78e29c
LD		 1601 memcpy(&addr->u.a6.addr, &ifa->addr,
1602 sizeof(struct in6_addr));
1603 addr->u.a6.pfxlen = ifa->prefix_len;
1604 addr->type = QETH_IP_TYPE_NORMAL;
1605 qeth_l3_delete_ip(card, addr);
4a71df50 1606 }
5f78e29c
LD		 1607
1608 spin_unlock_bh(&card->ip_lock);
1609
1610 kfree(addr);
83cf79a2 1611out:
4a71df50
FB		 1612 in6_dev_put(in6_dev);
1613#endif /* CONFIG_QETH_IPV6 */
1614}
1615
1616static void qeth_l3_free_vlan_addresses(struct qeth_card *card,
1617 unsigned short vid)
1618{
0347af51 1619 rcu_read_lock();
4a71df50
FB		 1620 qeth_l3_free_vlan_addresses4(card, vid);
1621 qeth_l3_free_vlan_addresses6(card, vid);
0347af51 1622 rcu_read_unlock();
4a71df50
FB		 1623}
1624
80d5c368
PM		 1625static int qeth_l3_vlan_rx_add_vid(struct net_device *dev,
1626 __be16 proto, u16 vid)
4a71df50 1627{
509e2562 1628 struct qeth_card *card = dev->ml_priv;
4a71df50 1629
7ff0bcf6 1630 set_bit(vid, card->active_vlans);
8e586137 1631 return 0;
4a71df50
FB		 1632}
1633
80d5c368
PM		 1634static int qeth_l3_vlan_rx_kill_vid(struct net_device *dev,
1635 __be16 proto, u16 vid)
4a71df50 1636{
509e2562 1637 struct qeth_card *card = dev->ml_priv;
4a71df50 1638
847a50fd 1639 QETH_CARD_TEXT_(card, 4, "kid:%d", vid);
5f78e29c 1640
8e98ac48 1641 if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
847a50fd 1642 QETH_CARD_TEXT(card, 3, "kidREC");
8e586137 1643 return 0;
8e98ac48 1644 }
4a71df50
FB		 1645 /* unregister IP addresses of vlan device */
1646 qeth_l3_free_vlan_addresses(card, vid);
7ff0bcf6 1647 clear_bit(vid, card->active_vlans);
4a71df50 1648 qeth_l3_set_multicast_list(card->dev);
8e586137 1649 return 0;
4a71df50
FB		 1650}
1651
d7aa9d0b
JW		 1652static void qeth_l3_rebuild_skb(struct qeth_card *card, struct sk_buff *skb,
1653 struct qeth_hdr *hdr)
4a71df50 1654{
6bee4e26 1655 __u16 prot;
4a71df50
FB		 1656 struct iphdr *ip_hdr;
1657 unsigned char tg_addr[MAX_ADDR_LEN];
1658
1659 if (!(hdr->hdr.l3.flags & QETH_HDR_PASSTHRU)) {
6bee4e26
HW		 1660 prot = (hdr->hdr.l3.flags & QETH_HDR_IPV6) ? ETH_P_IPV6 :
1661 ETH_P_IP;
4a71df50
FB		 1662 switch (hdr->hdr.l3.flags & QETH_HDR_CAST_MASK) {
1663 case QETH_CAST_MULTICAST:
1664 switch (prot) {
1665#ifdef CONFIG_QETH_IPV6
6bee4e26 1666 case ETH_P_IPV6:
4a71df50
FB		 1667 ndisc_mc_map((struct in6_addr *)
1668 skb->data + 24,
1669 tg_addr, card->dev, 0);
1670 break;
1671#endif
6bee4e26 1672 case ETH_P_IP:
4a71df50 1673 ip_hdr = (struct iphdr *)skb->data;
4a71df50
FB		 1674 ip_eth_mc_map(ip_hdr->daddr, tg_addr);
1675 break;
1676 default:
1677 memcpy(tg_addr, card->dev->broadcast,
1678 card->dev->addr_len);
1679 }
1680 card->stats.multicast++;
1681 skb->pkt_type = PACKET_MULTICAST;
1682 break;
1683 case QETH_CAST_BROADCAST:
1684 memcpy(tg_addr, card->dev->broadcast,
1685 card->dev->addr_len);
1686 card->stats.multicast++;
1687 skb->pkt_type = PACKET_BROADCAST;
1688 break;
1689 case QETH_CAST_UNICAST:
1690 case QETH_CAST_ANYCAST:
1691 case QETH_CAST_NOCAST:
1692 default:
76b11f8e
UB		 1693 if (card->options.sniffer)
1694 skb->pkt_type = PACKET_OTHERHOST;
1695 else
1696 skb->pkt_type = PACKET_HOST;
4a71df50
FB		 1697 memcpy(tg_addr, card->dev->dev_addr,
1698 card->dev->addr_len);
1699 }
fe94e2e0
UB		 1700 if (hdr->hdr.l3.ext_flags & QETH_HDR_EXT_SRC_MAC_ADDR)
1701 card->dev->header_ops->create(skb, card->dev, prot,
1702 tg_addr, &hdr->hdr.l3.dest_addr[2],
1703 card->dev->addr_len);
1704 else
1705 card->dev->header_ops->create(skb, card->dev, prot,
1706 tg_addr, "FAKELL", card->dev->addr_len);
4a71df50
FB		 1707 }
1708
1abd2296 1709 skb->protocol = eth_type_trans(skb, card->dev);
4a71df50 1710
d7aa9d0b
JW		 1711 /* copy VLAN tag from hdr into skb */
1712 if (!card->options.sniffer &&
1713 (hdr->hdr.l3.ext_flags & (QETH_HDR_EXT_VLAN_FRAME |
1714 QETH_HDR_EXT_INCLUDE_VLAN_TAG))) {
1715 u16 tag = (hdr->hdr.l3.ext_flags & QETH_HDR_EXT_VLAN_FRAME) ?
1716 hdr->hdr.l3.vlan_id :
1717 *((u16 *)&hdr->hdr.l3.dest_addr[12]);
1718 __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), tag);
4a71df50
FB		 1719 }
1720
c5e631a8 1721 if (card->dev->features & NETIF_F_RXCSUM) {
4a71df50 1722 if ((hdr->hdr.l3.ext_flags &
b9139800
UB		 1723 (QETH_HDR_EXT_CSUM_HDR_REQ |
1724 QETH_HDR_EXT_CSUM_TRANSP_REQ)) ==
1725 (QETH_HDR_EXT_CSUM_HDR_REQ |
1726 QETH_HDR_EXT_CSUM_TRANSP_REQ))
4a71df50
FB		 1727 skb->ip_summed = CHECKSUM_UNNECESSARY;
1728 else
b9139800 1729 skb->ip_summed = CHECKSUM_NONE;
c5e631a8
FB		 1730 } else
1731 skb->ip_summed = CHECKSUM_NONE;
4a71df50
FB		 1732}
1733
a1c3ed4c
FB		 1734static int qeth_l3_process_inbound_buffer(struct qeth_card *card,
1735 int budget, int *done)
4a71df50 1736{
a1c3ed4c 1737 int work_done = 0;
4a71df50
FB		 1738 struct sk_buff *skb;
1739 struct qeth_hdr *hdr;
4a71df50 1740 unsigned int len;
b3332930 1741 __u16 magic;
4a71df50 1742
a1c3ed4c 1743 *done = 0;
18af5c17 1744 WARN_ON_ONCE(!budget);
a1c3ed4c
FB		 1745 while (budget) {
1746 skb = qeth_core_get_next_skb(card,
b3332930 1747 &card->qdio.in_q->bufs[card->rx.b_index],
a1c3ed4c
FB		 1748 &card->rx.b_element, &card->rx.e_offset, &hdr);
1749 if (!skb) {
1750 *done = 1;
1751 break;
1752 }
1753 skb->dev = card->dev;
4a71df50
FB		 1754 switch (hdr->hdr.l3.id) {
1755 case QETH_HEADER_TYPE_LAYER3:
b3332930
FB		 1756 magic = *(__u16 *)skb->data;
1757 if ((card->info.type == QETH_CARD_TYPE_IQD) &&
1758 (magic == ETH_P_AF_IUCV)) {
6bee4e26 1759 skb->protocol = cpu_to_be16(ETH_P_AF_IUCV);
b3332930
FB		 1760 skb->pkt_type = PACKET_HOST;
1761 skb->mac_header = NET_SKB_PAD;
1762 skb->dev = card->dev;
1763 len = skb->len;
1764 card->dev->header_ops->create(skb, card->dev, 0,
1765 card->dev->dev_addr, "FAKELL",
1766 card->dev->addr_len);
1767 netif_receive_skb(skb);
1768 } else {
d7aa9d0b 1769 qeth_l3_rebuild_skb(card, skb, hdr);
b3332930 1770 len = skb->len;
b3332930
FB		 1771 napi_gro_receive(&card->napi, skb);
1772 }
4a71df50 1773 break;
76b11f8e
UB		 1774 case QETH_HEADER_TYPE_LAYER2: /* for HiperSockets sniffer */
1775 skb->pkt_type = PACKET_HOST;
1776 skb->protocol = eth_type_trans(skb, skb->dev);
76b11f8e
UB		 1777 len = skb->len;
1778 netif_receive_skb(skb);
1779 break;
4a71df50
FB		 1780 default:
1781 dev_kfree_skb_any(skb);
847a50fd 1782 QETH_CARD_TEXT(card, 3, "inbunkno");
d11ba0c4 1783 QETH_DBF_HEX(CTRL, 3, hdr, QETH_DBF_CTRL_LEN);
4a71df50
FB		 1784 continue;
1785 }
a1c3ed4c
FB		 1786 work_done++;
1787 budget--;
4a71df50
FB		 1788 card->stats.rx_packets++;
1789 card->stats.rx_bytes += len;
1790 }
a1c3ed4c
FB		 1791 return work_done;
1792}
1793
4a71df50
FB		 1794static int qeth_l3_verify_vlan_dev(struct net_device *dev,
1795 struct qeth_card *card)
1796{
1797 int rc = 0;
7ff0bcf6 1798 u16 vid;
4a71df50 1799
7ff0bcf6
JP		 1800 for_each_set_bit(vid, card->active_vlans, VLAN_N_VID) {
1801 struct net_device *netdev;
4a71df50 1802
7ff0bcf6 1803 rcu_read_lock();
f06c7f9f 1804 netdev = __vlan_find_dev_deep_rcu(card->dev, htons(ETH_P_8021Q),
91b1c1aa 1805 vid);
7ff0bcf6
JP		 1806 rcu_read_unlock();
1807 if (netdev == dev) {
4a71df50
FB		 1808 rc = QETH_VLAN_CARD;
1809 break;
1810 }
1811 }
1812
509e2562 1813 if (rc && !(vlan_dev_real_dev(dev)->ml_priv == (void *)card))
4a71df50
FB		 1814 return 0;
1815
1816 return rc;
1817}
1818
1819static int qeth_l3_verify_dev(struct net_device *dev)
1820{
1821 struct qeth_card *card;
4a71df50 1822 int rc = 0;
5f78e29c 1823 unsigned long flags;
4a71df50
FB		 1824
1825 read_lock_irqsave(&qeth_core_card_list.rwlock, flags);
1826 list_for_each_entry(card, &qeth_core_card_list.list, list) {
1827 if (card->dev == dev) {
1828 rc = QETH_REAL_CARD;
1829 break;
1830 }
1831 rc = qeth_l3_verify_vlan_dev(dev, card);
1832 if (rc)
1833 break;
1834 }
1835 read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags);
1836
1837 return rc;
1838}
1839
1840static struct qeth_card *qeth_l3_get_card_from_dev(struct net_device *dev)
1841{
1842 struct qeth_card *card = NULL;
1843 int rc;
1844
1845 rc = qeth_l3_verify_dev(dev);
1846 if (rc == QETH_REAL_CARD)
509e2562 1847 card = dev->ml_priv;
4a71df50 1848 else if (rc == QETH_VLAN_CARD)
509e2562 1849 card = vlan_dev_real_dev(dev)->ml_priv;
e5bd7be5 1850 if (card && card->options.layer2)
4a71df50 1851 card = NULL;
847a50fd
CO		 1852 if (card)
1853 QETH_CARD_TEXT_(card, 4, "%d", rc);
4a71df50
FB		 1854 return card ;
1855}
1856
b2f4de8b 1857static void qeth_l3_stop_card(struct qeth_card *card, int recovery_mode)
4a71df50 1858{
d11ba0c4
PT		 1859 QETH_DBF_TEXT(SETUP, 2, "stopcard");
1860 QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
4a71df50
FB		 1861
1862 qeth_set_allowed_threads(card, 0, 1);
76b11f8e
UB		 1863 if (card->options.sniffer &&
1864 (card->info.promisc_mode == SET_PROMISC_MODE_ON))
1865 qeth_diags_trace(card, QETH_DIAGS_CMD_TRACE_DISABLE);
4a71df50
FB		 1866 if (card->read.state == CH_STATE_UP &&
1867 card->write.state == CH_STATE_UP &&
1868 (card->state == CARD_STATE_UP)) {
1869 if (recovery_mode)
1870 qeth_l3_stop(card->dev);
8af7c5ae 1871 else {
869da90b
UB		 1872 rtnl_lock();
1873 dev_close(card->dev);
1874 rtnl_unlock();
8af7c5ae 1875 }
4a71df50
FB		 1876 card->state = CARD_STATE_SOFTSETUP;
1877 }
1878 if (card->state == CARD_STATE_SOFTSETUP) {
5f78e29c 1879 qeth_l3_clear_ip_htable(card, 1);
4a71df50
FB		 1880 qeth_clear_ipacmd_list(card);
1881 card->state = CARD_STATE_HARDSETUP;
1882 }
1883 if (card->state == CARD_STATE_HARDSETUP) {
4a71df50
FB		 1884 qeth_qdio_clear_card(card, 0);
1885 qeth_clear_qdio_buffers(card);
1886 qeth_clear_working_pool_list(card);
1887 card->state = CARD_STATE_DOWN;
1888 }
1889 if (card->state == CARD_STATE_DOWN) {
1890 qeth_clear_cmd_buffers(&card->read);
1891 qeth_clear_cmd_buffers(&card->write);
1892 }
4a71df50
FB		 1893}
1894
76b11f8e
UB		 1895/*
1896 * test for and Switch promiscuous mode (on or off)
1897 * either for guestlan or HiperSocket Sniffer
1898 */
1899static void
1900qeth_l3_handle_promisc_mode(struct qeth_card *card)
1901{
1902 struct net_device *dev = card->dev;
1903
1904 if (((dev->flags & IFF_PROMISC) &&
1905 (card->info.promisc_mode == SET_PROMISC_MODE_ON)) ||
1906 (!(dev->flags & IFF_PROMISC) &&
1907 (card->info.promisc_mode == SET_PROMISC_MODE_OFF)))
1908 return;
1909
1910 if (card->info.guestlan) { /* Guestlan trace */
1911 if (qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE))
1912 qeth_setadp_promisc_mode(card);
1913 } else if (card->options.sniffer && /* HiperSockets trace */
1914 qeth_adp_supported(card, IPA_SETADP_SET_DIAG_ASSIST)) {
1915 if (dev->flags & IFF_PROMISC) {
847a50fd 1916 QETH_CARD_TEXT(card, 3, "+promisc");
76b11f8e
UB		 1917 qeth_diags_trace(card, QETH_DIAGS_CMD_TRACE_ENABLE);
1918 } else {
847a50fd 1919 QETH_CARD_TEXT(card, 3, "-promisc");
76b11f8e
UB		 1920 qeth_diags_trace(card, QETH_DIAGS_CMD_TRACE_DISABLE);
1921 }
1922 }
1923}
1924
4a71df50
FB		 1925static void qeth_l3_set_multicast_list(struct net_device *dev)
1926{
509e2562 1927 struct qeth_card *card = dev->ml_priv;
4a71df50 1928
847a50fd 1929 QETH_CARD_TEXT(card, 3, "setmulti");
8e98ac48
UB		 1930 if (qeth_threads_running(card, QETH_RECOVER_THREAD) &&
1931 (card->state != CARD_STATE_UP))
1932 return;
76b11f8e 1933 if (!card->options.sniffer) {
5f78e29c
LD		 1934
1935 spin_lock_bh(&card->mclock);
1936
1937 qeth_l3_mark_all_mc_to_be_deleted(card);
1938
76b11f8e 1939 qeth_l3_add_multicast_ipv4(card);
4a71df50 1940#ifdef CONFIG_QETH_IPV6
76b11f8e 1941 qeth_l3_add_multicast_ipv6(card);
4a71df50 1942#endif
5f78e29c
LD		 1943 qeth_l3_delete_nonused_mc(card);
1944 qeth_l3_add_all_new_mc(card);
1945
1946 spin_unlock_bh(&card->mclock);
1947
76b11f8e
UB		 1948 if (!qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE))
1949 return;
1950 }
1951 qeth_l3_handle_promisc_mode(card);
4a71df50
FB		 1952}
1953
1954static const char *qeth_l3_arp_get_error_cause(int *rc)
1955{
1956 switch (*rc) {
1957 case QETH_IPA_ARP_RC_FAILED:
1958 *rc = -EIO;
1959 return "operation failed";
1960 case QETH_IPA_ARP_RC_NOTSUPP:
1961 *rc = -EOPNOTSUPP;
1962 return "operation not supported";
1963 case QETH_IPA_ARP_RC_OUT_OF_RANGE:
1964 *rc = -EINVAL;
1965 return "argument out of range";
1966 case QETH_IPA_ARP_RC_Q_NOTSUPP:
1967 *rc = -EOPNOTSUPP;
1968 return "query operation not supported";
1969 case QETH_IPA_ARP_RC_Q_NO_DATA:
1970 *rc = -ENOENT;
1971 return "no query data available";
1972 default:
1973 return "unknown error";
1974 }
1975}
1976
1977static int qeth_l3_arp_set_no_entries(struct qeth_card *card, int no_entries)
1978{
1979 int tmp;
1980 int rc;
1981
847a50fd 1982 QETH_CARD_TEXT(card, 3, "arpstnoe");
4a71df50
FB		 1983
1984 /*
1985 * currently GuestLAN only supports the ARP assist function
1986 * IPA_CMD_ASS_ARP_QUERY_INFO, but not IPA_CMD_ASS_ARP_SET_NO_ENTRIES;
1987 * thus we say EOPNOTSUPP for this ARP function
1988 */
1989 if (card->info.guestlan)
1990 return -EOPNOTSUPP;
1991 if (!qeth_is_supported(card, IPA_ARP_PROCESSING)) {
4a71df50
FB		 1992 return -EOPNOTSUPP;
1993 }
4d7def2a 1994 rc = qeth_send_simple_setassparms(card, IPA_ARP_PROCESSING,
4a71df50
FB		 1995 IPA_CMD_ASS_ARP_SET_NO_ENTRIES,
1996 no_entries);
1997 if (rc) {
1998 tmp = rc;
14cc21b6
FB		 1999 QETH_DBF_MESSAGE(2, "Could not set number of ARP entries on "
2000 "%s: %s (0x%x/%d)\n", QETH_CARD_IFNAME(card),
4a71df50
FB		 2001 qeth_l3_arp_get_error_cause(&rc), tmp, tmp);
2002 }
2003 return rc;
2004}
2005
d0ddf30f
EL		 2006static __u32 get_arp_entry_size(struct qeth_card *card,
2007 struct qeth_arp_query_data *qdata,
2008 struct qeth_arp_entrytype *type, __u8 strip_entries)
4a71df50 2009{
d0ddf30f
EL		 2010 __u32 rc;
2011 __u8 is_hsi;
4a71df50 2012
d0ddf30f
EL		 2013 is_hsi = qdata->reply_bits == 5;
2014 if (type->ip == QETHARP_IP_ADDR_V4) {
2015 QETH_CARD_TEXT(card, 4, "arpev4");
2016 if (strip_entries) {
2017 rc = is_hsi ? sizeof(struct qeth_arp_qi_entry5_short) :
2018 sizeof(struct qeth_arp_qi_entry7_short);
2019 } else {
2020 rc = is_hsi ? sizeof(struct qeth_arp_qi_entry5) :
2021 sizeof(struct qeth_arp_qi_entry7);
2022 }
2023 } else if (type->ip == QETHARP_IP_ADDR_V6) {
2024 QETH_CARD_TEXT(card, 4, "arpev6");
2025 if (strip_entries) {
2026 rc = is_hsi ?
2027 sizeof(struct qeth_arp_qi_entry5_short_ipv6) :
2028 sizeof(struct qeth_arp_qi_entry7_short_ipv6);
2029 } else {
2030 rc = is_hsi ?
2031 sizeof(struct qeth_arp_qi_entry5_ipv6) :
2032 sizeof(struct qeth_arp_qi_entry7_ipv6);
2033 }
2034 } else {
2035 QETH_CARD_TEXT(card, 4, "arpinv");
2036 rc = 0;
4a71df50 2037 }
d0ddf30f
EL		 2038
2039 return rc;
2040}
2041
2042static int arpentry_matches_prot(struct qeth_arp_entrytype *type, __u16 prot)
2043{
2044 return (type->ip == QETHARP_IP_ADDR_V4 && prot == QETH_PROT_IPV4) ||
2045 (type->ip == QETHARP_IP_ADDR_V6 && prot == QETH_PROT_IPV6);
4a71df50
FB		 2046}
2047
2048static int qeth_l3_arp_query_cb(struct qeth_card *card,
2049 struct qeth_reply *reply, unsigned long data)
2050{
2051 struct qeth_ipa_cmd *cmd;
2052 struct qeth_arp_query_data *qdata;
2053 struct qeth_arp_query_info *qinfo;
4a71df50 2054 int i;
d0ddf30f
EL		 2055 int e;
2056 int entrybytes_done;
2057 int stripped_bytes;
2058 __u8 do_strip_entries;
4a71df50 2059
d0ddf30f 2060 QETH_CARD_TEXT(card, 3, "arpquecb");
4a71df50
FB		 2061
2062 qinfo = (struct qeth_arp_query_info *) reply->param;
2063 cmd = (struct qeth_ipa_cmd *) data;
d0ddf30f 2064 QETH_CARD_TEXT_(card, 4, "%i", cmd->hdr.prot_version);
4a71df50 2065 if (cmd->hdr.return_code) {
d0ddf30f
EL		 2066 QETH_CARD_TEXT(card, 4, "arpcberr");
2067 QETH_CARD_TEXT_(card, 4, "%i", cmd->hdr.return_code);
4a71df50
FB		 2068 return 0;
2069 }
2070 if (cmd->data.setassparms.hdr.return_code) {
2071 cmd->hdr.return_code = cmd->data.setassparms.hdr.return_code;
d0ddf30f
EL		 2072 QETH_CARD_TEXT(card, 4, "setaperr");
2073 QETH_CARD_TEXT_(card, 4, "%i", cmd->hdr.return_code);
4a71df50
FB		 2074 return 0;
2075 }
2076 qdata = &cmd->data.setassparms.data.query_arp;
847a50fd 2077 QETH_CARD_TEXT_(card, 4, "anoen%i", qdata->no_entries);
4a71df50 2078
d0ddf30f
EL		 2079 do_strip_entries = (qinfo->mask_bits & QETH_QARP_STRIP_ENTRIES) > 0;
2080 stripped_bytes = do_strip_entries ? QETH_QARP_MEDIASPECIFIC_BYTES : 0;
2081 entrybytes_done = 0;
2082 for (e = 0; e < qdata->no_entries; ++e) {
2083 char *cur_entry;
2084 __u32 esize;
2085 struct qeth_arp_entrytype *etype;
2086
2087 cur_entry = &qdata->data + entrybytes_done;
2088 etype = &((struct qeth_arp_qi_entry5 *) cur_entry)->type;
2089 if (!arpentry_matches_prot(etype, cmd->hdr.prot_version)) {
2090 QETH_CARD_TEXT(card, 4, "pmis");
2091 QETH_CARD_TEXT_(card, 4, "%i", etype->ip);
2092 break;
2093 }
2094 esize = get_arp_entry_size(card, qdata, etype,
2095 do_strip_entries);
2096 QETH_CARD_TEXT_(card, 5, "esz%i", esize);
2097 if (!esize)
2098 break;
2099
2100 if ((qinfo->udata_len - qinfo->udata_offset) < esize) {
2101 QETH_CARD_TEXT_(card, 4, "qaer3%i", -ENOMEM);
e0a8114c 2102 cmd->hdr.return_code = IPA_RC_ENOMEM;
d0ddf30f
EL		 2103 goto out_error;
2104 }
4a71df50 2105
d0ddf30f
EL		 2106 memcpy(qinfo->udata + qinfo->udata_offset,
2107 &qdata->data + entrybytes_done + stripped_bytes,
2108 esize);
2109 entrybytes_done += esize + stripped_bytes;
2110 qinfo->udata_offset += esize;
2111 ++qinfo->no_entries;
2112 }
4a71df50
FB		 2113 /* check if all replies received ... */
2114 if (cmd->data.setassparms.hdr.seq_no <
2115 cmd->data.setassparms.hdr.number_of_replies)
2116 return 1;
d0ddf30f 2117 QETH_CARD_TEXT_(card, 4, "nove%i", qinfo->no_entries);
4a71df50
FB		 2118 memcpy(qinfo->udata, &qinfo->no_entries, 4);
2119 /* keep STRIP_ENTRIES flag so the user program can distinguish
2120 * stripped entries from normal ones */
2121 if (qinfo->mask_bits & QETH_QARP_STRIP_ENTRIES)
2122 qdata->reply_bits |= QETH_QARP_STRIP_ENTRIES;
2123 memcpy(qinfo->udata + QETH_QARP_MASK_OFFSET, &qdata->reply_bits, 2);
d0ddf30f 2124 QETH_CARD_TEXT_(card, 4, "rc%i", 0);
4a71df50
FB		 2125 return 0;
2126out_error:
2127 i = 0;
2128 memcpy(qinfo->udata, &i, 4);
2129 return 0;
2130}
2131
2132static int qeth_l3_send_ipa_arp_cmd(struct qeth_card *card,
2133 struct qeth_cmd_buffer *iob, int len,
2134 int (*reply_cb)(struct qeth_card *, struct qeth_reply *,
2135 unsigned long),
2136 void *reply_param)
2137{
847a50fd 2138 QETH_CARD_TEXT(card, 4, "sendarp");
4a71df50
FB		 2139
2140 memcpy(iob->data, IPA_PDU_HEADER, IPA_PDU_HEADER_SIZE);
2141 memcpy(QETH_IPA_CMD_DEST_ADDR(iob->data),
2142 &card->token.ulp_connection_r, QETH_MPC_TOKEN_LENGTH);
2143 return qeth_send_control_data(card, IPA_PDU_HEADER_SIZE + len, iob,
2144 reply_cb, reply_param);
2145}
2146
d0ddf30f
EL		 2147static int qeth_l3_query_arp_cache_info(struct qeth_card *card,
2148 enum qeth_prot_versions prot,
2149 struct qeth_arp_query_info *qinfo)
4a71df50
FB		 2150{
2151 struct qeth_cmd_buffer *iob;
d0ddf30f 2152 struct qeth_ipa_cmd *cmd;
4a71df50
FB		 2153 int tmp;
2154 int rc;
2155
d0ddf30f
EL		 2156 QETH_CARD_TEXT_(card, 3, "qarpipv%i", prot);
2157
b475e316
TR		 2158 iob = qeth_get_setassparms_cmd(card, IPA_ARP_PROCESSING,
2159 IPA_CMD_ASS_ARP_QUERY_INFO,
2160 sizeof(struct qeth_arp_query_data)
2161 - sizeof(char),
2162 prot);
1aec42bc
TR		 2163 if (!iob)
2164 return -ENOMEM;
d0ddf30f
EL		 2165 cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
2166 cmd->data.setassparms.data.query_arp.request_bits = 0x000F;
2167 cmd->data.setassparms.data.query_arp.reply_bits = 0;
2168 cmd->data.setassparms.data.query_arp.no_entries = 0;
2169 rc = qeth_l3_send_ipa_arp_cmd(card, iob,
2170 QETH_SETASS_BASE_LEN+QETH_ARP_CMD_LEN,
2171 qeth_l3_arp_query_cb, (void *)qinfo);
2172 if (rc) {
2173 tmp = rc;
2174 QETH_DBF_MESSAGE(2,
2175 "Error while querying ARP cache on %s: %s "
2176 "(0x%x/%d)\n", QETH_CARD_IFNAME(card),
2177 qeth_l3_arp_get_error_cause(&rc), tmp, tmp);
2178 }
2179
2180 return rc;
2181}
2182
2183static int qeth_l3_arp_query(struct qeth_card *card, char __user *udata)
2184{
2185 struct qeth_arp_query_info qinfo = {0, };
2186 int rc;
2187
847a50fd 2188 QETH_CARD_TEXT(card, 3, "arpquery");
4a71df50
FB		 2189
2190 if (!qeth_is_supported(card,/*IPA_QUERY_ARP_ADDR_INFO*/
2191 IPA_ARP_PROCESSING)) {
d0ddf30f
EL		 2192 QETH_CARD_TEXT(card, 3, "arpqnsup");
2193 rc = -EOPNOTSUPP;
2194 goto out;
4a71df50
FB		 2195 }
2196 /* get size of userspace buffer and mask_bits -> 6 bytes */
d0ddf30f
EL		 2197 if (copy_from_user(&qinfo, udata, 6)) {
2198 rc = -EFAULT;
2199 goto out;
2200 }
4a71df50 2201 qinfo.udata = kzalloc(qinfo.udata_len, GFP_KERNEL);
d0ddf30f
EL		 2202 if (!qinfo.udata) {
2203 rc = -ENOMEM;
2204 goto out;
2205 }
4a71df50 2206 qinfo.udata_offset = QETH_QARP_ENTRIES_OFFSET;
d0ddf30f 2207 rc = qeth_l3_query_arp_cache_info(card, QETH_PROT_IPV4, &qinfo);
4a71df50 2208 if (rc) {
4a71df50
FB		 2209 if (copy_to_user(udata, qinfo.udata, 4))
2210 rc = -EFAULT;
77a83ed1
SO		 2211 goto free_and_out;
2212 }
d0ddf30f 2213#ifdef CONFIG_QETH_IPV6
77a83ed1
SO		 2214 if (qinfo.mask_bits & QETH_QARP_WITH_IPV6) {
2215 /* fails in case of GuestLAN QDIO mode */
2216 qeth_l3_query_arp_cache_info(card, QETH_PROT_IPV6, &qinfo);
2217 }
d0ddf30f 2218#endif
77a83ed1
SO		 2219 if (copy_to_user(udata, qinfo.udata, qinfo.udata_len)) {
2220 QETH_CARD_TEXT(card, 4, "qactf");
2221 rc = -EFAULT;
2222 goto free_and_out;
4a71df50 2223 }
77a83ed1
SO		 2224 QETH_CARD_TEXT(card, 4, "qacts");
2225
d0ddf30f 2226free_and_out:
4a71df50 2227 kfree(qinfo.udata);
d0ddf30f 2228out:
4a71df50
FB		 2229 return rc;
2230}
2231
2232static int qeth_l3_arp_add_entry(struct qeth_card *card,
2233 struct qeth_arp_cache_entry *entry)
2234{
2235 struct qeth_cmd_buffer *iob;
2236 char buf[16];
2237 int tmp;
2238 int rc;
2239
847a50fd 2240 QETH_CARD_TEXT(card, 3, "arpadent");
4a71df50
FB		 2241
2242 /*
2243 * currently GuestLAN only supports the ARP assist function
2244 * IPA_CMD_ASS_ARP_QUERY_INFO, but not IPA_CMD_ASS_ARP_ADD_ENTRY;
2245 * thus we say EOPNOTSUPP for this ARP function
2246 */
2247 if (card->info.guestlan)
2248 return -EOPNOTSUPP;
2249 if (!qeth_is_supported(card, IPA_ARP_PROCESSING)) {
4a71df50
FB		 2250 return -EOPNOTSUPP;
2251 }
2252
b475e316 2253 iob = qeth_get_setassparms_cmd(card, IPA_ARP_PROCESSING,
4a71df50
FB		 2254 IPA_CMD_ASS_ARP_ADD_ENTRY,
2255 sizeof(struct qeth_arp_cache_entry),
2256 QETH_PROT_IPV4);
1aec42bc
TR		 2257 if (!iob)
2258 return -ENOMEM;
4d7def2a 2259 rc = qeth_send_setassparms(card, iob,
4a71df50
FB		 2260 sizeof(struct qeth_arp_cache_entry),
2261 (unsigned long) entry,
8f43fb00 2262 qeth_setassparms_cb, NULL);
4a71df50
FB		 2263 if (rc) {
2264 tmp = rc;
2265 qeth_l3_ipaddr4_to_string((u8 *)entry->ipaddr, buf);
14cc21b6
FB		 2266 QETH_DBF_MESSAGE(2, "Could not add ARP entry for address %s "
2267 "on %s: %s (0x%x/%d)\n", buf, QETH_CARD_IFNAME(card),
2268 qeth_l3_arp_get_error_cause(&rc), tmp, tmp);
4a71df50
FB		 2269 }
2270 return rc;
2271}
2272
2273static int qeth_l3_arp_remove_entry(struct qeth_card *card,
2274 struct qeth_arp_cache_entry *entry)
2275{
2276 struct qeth_cmd_buffer *iob;
2277 char buf[16] = {0, };
2278 int tmp;
2279 int rc;
2280
847a50fd 2281 QETH_CARD_TEXT(card, 3, "arprment");
4a71df50
FB		 2282
2283 /*
2284 * currently GuestLAN only supports the ARP assist function
2285 * IPA_CMD_ASS_ARP_QUERY_INFO, but not IPA_CMD_ASS_ARP_REMOVE_ENTRY;
2286 * thus we say EOPNOTSUPP for this ARP function
2287 */
2288 if (card->info.guestlan)
2289 return -EOPNOTSUPP;
2290 if (!qeth_is_supported(card, IPA_ARP_PROCESSING)) {
4a71df50
FB		 2291 return -EOPNOTSUPP;
2292 }
2293 memcpy(buf, entry, 12);
b475e316 2294 iob = qeth_get_setassparms_cmd(card, IPA_ARP_PROCESSING,
4a71df50
FB		 2295 IPA_CMD_ASS_ARP_REMOVE_ENTRY,
2296 12,
2297 QETH_PROT_IPV4);
1aec42bc
TR		 2298 if (!iob)
2299 return -ENOMEM;
4d7def2a 2300 rc = qeth_send_setassparms(card, iob,
4a71df50 2301 12, (unsigned long)buf,
8f43fb00 2302 qeth_setassparms_cb, NULL);
4a71df50
FB		 2303 if (rc) {
2304 tmp = rc;
2305 memset(buf, 0, 16);
2306 qeth_l3_ipaddr4_to_string((u8 *)entry->ipaddr, buf);
14cc21b6
FB		 2307 QETH_DBF_MESSAGE(2, "Could not delete ARP entry for address %s"
2308 " on %s: %s (0x%x/%d)\n", buf, QETH_CARD_IFNAME(card),
2309 qeth_l3_arp_get_error_cause(&rc), tmp, tmp);
4a71df50
FB		 2310 }
2311 return rc;
2312}
2313
2314static int qeth_l3_arp_flush_cache(struct qeth_card *card)
2315{
2316 int rc;
2317 int tmp;
2318
847a50fd 2319 QETH_CARD_TEXT(card, 3, "arpflush");
4a71df50
FB		 2320
2321 /*
2322 * currently GuestLAN only supports the ARP assist function
2323 * IPA_CMD_ASS_ARP_QUERY_INFO, but not IPA_CMD_ASS_ARP_FLUSH_CACHE;
2324 * thus we say EOPNOTSUPP for this ARP function
2325 */
2326 if (card->info.guestlan || (card->info.type == QETH_CARD_TYPE_IQD))
2327 return -EOPNOTSUPP;
2328 if (!qeth_is_supported(card, IPA_ARP_PROCESSING)) {
4a71df50
FB		 2329 return -EOPNOTSUPP;
2330 }
4d7def2a 2331 rc = qeth_send_simple_setassparms(card, IPA_ARP_PROCESSING,
4a71df50
FB		 2332 IPA_CMD_ASS_ARP_FLUSH_CACHE, 0);
2333 if (rc) {
2334 tmp = rc;
14cc21b6
FB		 2335 QETH_DBF_MESSAGE(2, "Could not flush ARP cache on %s: %s "
2336 "(0x%x/%d)\n", QETH_CARD_IFNAME(card),
4a71df50
FB		 2337 qeth_l3_arp_get_error_cause(&rc), tmp, tmp);
2338 }
2339 return rc;
2340}
2341
2342static int qeth_l3_do_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
2343{
509e2562 2344 struct qeth_card *card = dev->ml_priv;
4a71df50 2345 struct qeth_arp_cache_entry arp_entry;
4a71df50
FB		 2346 int rc = 0;
2347
4a71df50
FB		 2348 switch (cmd) {
2349 case SIOC_QETH_ARP_SET_NO_ENTRIES:
2350 if (!capable(CAP_NET_ADMIN)) {
2351 rc = -EPERM;
2352 break;
2353 }
2354 rc = qeth_l3_arp_set_no_entries(card, rq->ifr_ifru.ifru_ivalue);
2355 break;
2356 case SIOC_QETH_ARP_QUERY_INFO:
2357 if (!capable(CAP_NET_ADMIN)) {
2358 rc = -EPERM;
2359 break;
2360 }
2361 rc = qeth_l3_arp_query(card, rq->ifr_ifru.ifru_data);
2362 break;
2363 case SIOC_QETH_ARP_ADD_ENTRY:
2364 if (!capable(CAP_NET_ADMIN)) {
2365 rc = -EPERM;
2366 break;
2367 }
2368 if (copy_from_user(&arp_entry, rq->ifr_ifru.ifru_data,
2369 sizeof(struct qeth_arp_cache_entry)))
2370 rc = -EFAULT;
2371 else
2372 rc = qeth_l3_arp_add_entry(card, &arp_entry);
2373 break;
2374 case SIOC_QETH_ARP_REMOVE_ENTRY:
2375 if (!capable(CAP_NET_ADMIN)) {
2376 rc = -EPERM;
2377 break;
2378 }
2379 if (copy_from_user(&arp_entry, rq->ifr_ifru.ifru_data,
2380 sizeof(struct qeth_arp_cache_entry)))
2381 rc = -EFAULT;
2382 else
2383 rc = qeth_l3_arp_remove_entry(card, &arp_entry);
2384 break;
2385 case SIOC_QETH_ARP_FLUSH_CACHE:
2386 if (!capable(CAP_NET_ADMIN)) {
2387 rc = -EPERM;
2388 break;
2389 }
2390 rc = qeth_l3_arp_flush_cache(card);
2391 break;
4a71df50
FB		 2392 default:
2393 rc = -EOPNOTSUPP;
2394 }
4a71df50
FB		 2395 return rc;
2396}
2397
cef6ff22 2398static int qeth_l3_get_cast_type(struct qeth_card *card, struct sk_buff *skb)
ce73e10e
KDW		 2399{
2400 int cast_type = RTN_UNSPEC;
69cce1d1
DM		 2401 struct neighbour *n = NULL;
2402 struct dst_entry *dst;
2403
1d36cb47 2404 rcu_read_lock();
69cce1d1
DM		 2405 dst = skb_dst(skb);
2406 if (dst)
24db1ba8 2407 n = dst_neigh_lookup_skb(dst, skb);
69cce1d1
DM		 2408 if (n) {
2409 cast_type = n->type;
1d36cb47 2410 rcu_read_unlock();
24db1ba8 2411 neigh_release(n);
ce73e10e
KDW		 2412 if ((cast_type == RTN_BROADCAST) ||
2413 (cast_type == RTN_MULTICAST) ||
2414 (cast_type == RTN_ANYCAST))
2415 return cast_type;
2416 else
2417 return RTN_UNSPEC;
2418 }
1d36cb47
FB		 2419 rcu_read_unlock();
2420
ce73e10e 2421 /* try something else */
6bee4e26 2422 if (be16_to_cpu(skb->protocol) == ETH_P_IPV6)
ce73e10e
KDW		 2423 return (skb_network_header(skb)[24] == 0xff) ?
2424 RTN_MULTICAST : 0;
6bee4e26 2425 else if (be16_to_cpu(skb->protocol) == ETH_P_IP)
ce73e10e
KDW		 2426 return ((skb_network_header(skb)[16] & 0xf0) == 0xe0) ?
2427 RTN_MULTICAST : 0;
2428 /* ... */
2429 if (!memcmp(skb->data, skb->dev->broadcast, 6))
2430 return RTN_BROADCAST;
2431 else {
2432 u16 hdr_mac;
2433
2434 hdr_mac = *((u16 *)skb->data);
2435 /* tr multicast? */
2436 switch (card->info.link_type) {
2437 case QETH_LINK_TYPE_HSTR:
2438 case QETH_LINK_TYPE_LANE_TR:
2439 if ((hdr_mac == QETH_TR_MAC_NC) ||
2440 (hdr_mac == QETH_TR_MAC_C))
2441 return RTN_MULTICAST;
2442 break;
2443 /* eth or so multicast? */
2444 default:
2445 if ((hdr_mac == QETH_ETH_MAC_V4) ||
2446 (hdr_mac == QETH_ETH_MAC_V6))
2447 return RTN_MULTICAST;
2448 }
2449 }
2450 return cast_type;
2451}
2452
b3332930
FB		 2453static void qeth_l3_fill_af_iucv_hdr(struct qeth_card *card,
2454 struct qeth_hdr *hdr, struct sk_buff *skb)
2455{
2456 char daddr[16];
2457 struct af_iucv_trans_hdr *iucv_hdr;
2458
b3332930
FB		 2459 memset(hdr, 0, sizeof(struct qeth_hdr));
2460 hdr->hdr.l3.id = QETH_HEADER_TYPE_LAYER3;
2461 hdr->hdr.l3.ext_flags = 0;
acd9776b 2462 hdr->hdr.l3.length = skb->len - ETH_HLEN;
b3332930 2463 hdr->hdr.l3.flags = QETH_HDR_IPV6 | QETH_CAST_UNICAST;
acd9776b
JW		 2464
2465 iucv_hdr = (struct af_iucv_trans_hdr *) (skb->data + ETH_HLEN);
b3332930
FB		 2466 memset(daddr, 0, sizeof(daddr));
2467 daddr[0] = 0xfe;
2468 daddr[1] = 0x80;
2469 memcpy(&daddr[8], iucv_hdr->destUserID, 8);
2470 memcpy(hdr->hdr.l3.dest_addr, daddr, 16);
2471}
2472
4a71df50
FB		 2473static void qeth_l3_fill_header(struct qeth_card *card, struct qeth_hdr *hdr,
2474 struct sk_buff *skb, int ipv, int cast_type)
2475{
69cce1d1
DM		 2476 struct dst_entry *dst;
2477
4a71df50
FB		 2478 memset(hdr, 0, sizeof(struct qeth_hdr));
2479 hdr->hdr.l3.id = QETH_HEADER_TYPE_LAYER3;
2480 hdr->hdr.l3.ext_flags = 0;
2481
2482 /*
2483 * before we're going to overwrite this location with next hop ip.
2484 * v6 uses passthrough, v4 sets the tag in the QDIO header.
2485 */
df8a39de 2486 if (skb_vlan_tag_present(skb)) {
213298f8
FB		 2487 if ((ipv == 4) || (card->info.type == QETH_CARD_TYPE_IQD))
2488 hdr->hdr.l3.ext_flags = QETH_HDR_EXT_VLAN_FRAME;
2489 else
2490 hdr->hdr.l3.ext_flags = QETH_HDR_EXT_INCLUDE_VLAN_TAG;
df8a39de 2491 hdr->hdr.l3.vlan_id = skb_vlan_tag_get(skb);
4a71df50
FB		 2492 }
2493
2494 hdr->hdr.l3.length = skb->len - sizeof(struct qeth_hdr);
1d36cb47
FB		 2495
2496 rcu_read_lock();
69cce1d1 2497 dst = skb_dst(skb);
4a71df50 2498 if (ipv == 4) {
87e7597b
DM		 2499 struct rtable *rt = (struct rtable *) dst;
2500 __be32 *pkey = &ip_hdr(skb)->daddr;
2501
ec2c6726 2502 if (rt && rt->rt_gateway)
87e7597b
DM		 2503 pkey = &rt->rt_gateway;
2504
4a71df50
FB		 2505 /* IPv4 */
2506 hdr->hdr.l3.flags = qeth_l3_get_qeth_hdr_flags4(cast_type);
2507 memset(hdr->hdr.l3.dest_addr, 0, 12);
87e7597b 2508 *((__be32 *) (&hdr->hdr.l3.dest_addr[12])) = *pkey;
4a71df50 2509 } else if (ipv == 6) {
87e7597b
DM		 2510 struct rt6_info *rt = (struct rt6_info *) dst;
2511 struct in6_addr *pkey = &ipv6_hdr(skb)->daddr;
2512
ec2c6726 2513 if (rt && !ipv6_addr_any(&rt->rt6i_gateway))
87e7597b
DM		 2514 pkey = &rt->rt6i_gateway;
2515
4a71df50
FB		 2516 /* IPv6 */
2517 hdr->hdr.l3.flags = qeth_l3_get_qeth_hdr_flags6(cast_type);
2518 if (card->info.type == QETH_CARD_TYPE_IQD)
2519 hdr->hdr.l3.flags &= ~QETH_HDR_PASSTHRU;
87e7597b 2520 memcpy(hdr->hdr.l3.dest_addr, pkey, 16);
4a71df50 2521 } else {
1abd2296 2522 if (!memcmp(skb->data + sizeof(struct qeth_hdr),
4a71df50
FB		 2523 skb->dev->broadcast, 6)) {
2524 /* broadcast? */
2525 hdr->hdr.l3.flags = QETH_CAST_BROADCAST |
2526 QETH_HDR_PASSTHRU;
2527 } else {
2528 hdr->hdr.l3.flags = (cast_type == RTN_MULTICAST) ?
2529 QETH_CAST_MULTICAST | QETH_HDR_PASSTHRU :
2530 QETH_CAST_UNICAST | QETH_HDR_PASSTHRU;
2531 }
2532 }
1d36cb47 2533 rcu_read_unlock();
4a71df50
FB		 2534}
2535
cef6ff22
JW		 2536static void qeth_l3_hdr_csum(struct qeth_card *card, struct qeth_hdr *hdr,
2537 struct sk_buff *skb)
f6b85b6c
FB		 2538{
2539 struct iphdr *iph = ip_hdr(skb);
2540
2541 /* tcph->check contains already the pseudo hdr checksum
2542 * so just set the header flags
2543 */
2544 if (iph->protocol == IPPROTO_UDP)
2545 hdr->hdr.l3.ext_flags |= QETH_HDR_EXT_UDP;
16c0f936
FB		 2546 hdr->hdr.l3.ext_flags |= QETH_HDR_EXT_CSUM_TRANSP_REQ |
2547 QETH_HDR_EXT_CSUM_HDR_REQ;
2548 iph->check = 0;
f6b85b6c
FB		 2549 if (card->options.performance_stats)
2550 card->perf_stats.tx_csum++;
2551}
2552
64ef8957
FB		 2553static void qeth_tso_fill_header(struct qeth_card *card,
2554 struct qeth_hdr *qhdr, struct sk_buff *skb)
2555{
2556 struct qeth_hdr_tso *hdr = (struct qeth_hdr_tso *)qhdr;
2557 struct tcphdr *tcph = tcp_hdr(skb);
2558 struct iphdr *iph = ip_hdr(skb);
2559 struct ipv6hdr *ip6h = ipv6_hdr(skb);
2560
2561 /*fix header to TSO values ...*/
2562 hdr->hdr.hdr.l3.id = QETH_HEADER_TYPE_TSO;
8fa9208e 2563 hdr->hdr.hdr.l3.length = skb->len - sizeof(struct qeth_hdr_tso);
64ef8957
FB		 2564 /*set values which are fix for the first approach ...*/
2565 hdr->ext.hdr_tot_len = (__u16) sizeof(struct qeth_hdr_ext_tso);
2566 hdr->ext.imb_hdr_no = 1;
2567 hdr->ext.hdr_type = 1;
2568 hdr->ext.hdr_version = 1;
2569 hdr->ext.hdr_len = 28;
2570 /*insert non-fix values */
2571 hdr->ext.mss = skb_shinfo(skb)->gso_size;
f8eb4930 2572 hdr->ext.dg_hdr_len = (__u16)(ip_hdrlen(skb) + tcp_hdrlen(skb));
64ef8957
FB		 2573 hdr->ext.payload_len = (__u16)(skb->len - hdr->ext.dg_hdr_len -
2574 sizeof(struct qeth_hdr_tso));
2575 tcph->check = 0;
6bee4e26 2576 if (be16_to_cpu(skb->protocol) == ETH_P_IPV6) {
64ef8957
FB		 2577 ip6h->payload_len = 0;
2578 tcph->check = ~csum_ipv6_magic(&ip6h->saddr, &ip6h->daddr,
2579 0, IPPROTO_TCP, 0);
2580 } else {
2581 /*OSA want us to set these values ...*/
2582 tcph->check = ~csum_tcpudp_magic(iph->saddr, iph->daddr,
2583 0, IPPROTO_TCP, 0);
2584 iph->tot_len = 0;
2585 iph->check = 0;
2586 }
2587}
2588
2863c613 2589/**
41aeed58
EC		 2590 * qeth_l3_get_elements_no_tso() - find number of SBALEs for skb data for tso
2591 * @card: qeth card structure, to check max. elems.
2592 * @skb: SKB address
2593 * @extra_elems: extra elems needed, to check against max.
2863c613
EC		 2594 *
2595 * Returns the number of pages, and thus QDIO buffer elements, needed to cover
2596 * skb data, including linear part and fragments, but excluding TCP header.
2597 * (Exclusion of TCP header distinguishes it from qeth_get_elements_no().)
2598 * Checks if the result plus extra_elems fits under the limit for the card.
2599 * Returns 0 if it does not.
2600 * Note: extra_elems is not included in the returned result.
2601 */
41aeed58 2602static int qeth_l3_get_elements_no_tso(struct qeth_card *card,
2863c613 2603 struct sk_buff *skb, int extra_elems)
c3b4a740 2604{
2863c613
EC		 2605 addr_t tcpdptr = (addr_t)tcp_hdr(skb) + tcp_hdrlen(skb);
2606 int elements = qeth_get_elements_for_range(
2607 tcpdptr,
2608 (addr_t)skb->data + skb_headlen(skb)) +
8f43fb00 2609 qeth_get_elements_for_frags(skb);
271648b4 2610
2863c613
EC		 2611 if ((elements + extra_elems) > QETH_MAX_BUFFER_ELEMENTS(card)) {
2612 QETH_DBF_MESSAGE(2,
2613 "Invalid size of TSO IP packet (Number=%d / Length=%d). Discarded.\n",
2614 elements + extra_elems, skb->len);
2615 return 0;
2616 }
c3b4a740
FB		 2617 return elements;
2618}
2619
e38db6be
JW		 2620static netdev_tx_t qeth_l3_hard_start_xmit(struct sk_buff *skb,
2621 struct net_device *dev)
4a71df50
FB		 2622{
2623 int rc;
6bee4e26 2624 __be16 *tag;
4a71df50 2625 struct qeth_hdr *hdr = NULL;
2863c613
EC		 2626 int hdr_elements = 0;
2627 int elements;
509e2562 2628 struct qeth_card *card = dev->ml_priv;
4a71df50
FB		 2629 struct sk_buff *new_skb = NULL;
2630 int ipv = qeth_get_ip_version(skb);
ce73e10e 2631 int cast_type = qeth_l3_get_cast_type(card, skb);
290b8348
SR		 2632 struct qeth_qdio_out_q *queue =
2633 card->qdio.out_qs[card->qdio.do_prio_queueing
2634 || (cast_type && card->info.is_multicast_different) ?
2635 qeth_get_priority_queue(card, skb, ipv, cast_type) :
2636 card->qdio.default_out_queue];
4a71df50 2637 int tx_bytes = skb->len;
13ddacb5 2638 unsigned int hd_len = 0;
41aeed58 2639 bool use_tso;
683d718a 2640 int data_offset = -1;
886e1974 2641 unsigned int nr_frags;
4a71df50 2642
b3332930
FB		 2643 if (((card->info.type == QETH_CARD_TYPE_IQD) &&
2644 (((card->options.cq != QETH_CQ_ENABLED) && !ipv) ||
2645 ((card->options.cq == QETH_CQ_ENABLED) &&
6bee4e26 2646 (be16_to_cpu(skb->protocol) != ETH_P_AF_IUCV)))) ||
b3332930 2647 card->options.sniffer)
4a71df50
FB		 2648 goto tx_drop;
2649
2650 if ((card->state != CARD_STATE_UP) || !card->lan_online) {
2651 card->stats.tx_carrier_errors++;
2652 goto tx_drop;
2653 }
2654
2655 if ((cast_type == RTN_BROADCAST) &&
2656 (card->info.broadcast_capable == 0))
2657 goto tx_drop;
2658
2659 if (card->options.performance_stats) {
2660 card->perf_stats.outbound_cnt++;
2661 card->perf_stats.outbound_start_time = qeth_get_micros();
2662 }
2663
41aeed58
EC		 2664 /* Ignore segment size from skb_is_gso(), 1 page is always used. */
2665 use_tso = skb_is_gso(skb) &&
f8eb4930 2666 (skb_shinfo(skb)->gso_type & SKB_GSO_TCPV4);
683d718a 2667
94a9c981 2668 if (card->info.type == QETH_CARD_TYPE_IQD) {
683d718a 2669 new_skb = skb;
acd9776b 2670 data_offset = ETH_HLEN;
f1588177 2671 hd_len = sizeof(*hdr);
683d718a
FB		 2672 hdr = kmem_cache_alloc(qeth_core_header_cache, GFP_ATOMIC);
2673 if (!hdr)
2674 goto tx_drop;
2863c613 2675 hdr_elements++;
683d718a
FB		 2676 } else {
2677 /* create a clone with writeable headroom */
2678 new_skb = skb_realloc_headroom(skb, sizeof(struct qeth_hdr_tso)
2679 + VLAN_HLEN);
2680 if (!new_skb)
2681 goto tx_drop;
4a71df50 2682
21fde749 2683 if (ipv == 4) {
1abd2296 2684 skb_pull(new_skb, ETH_HLEN);
4a71df50
FB		 2685 }
2686
df8a39de 2687 if (ipv != 4 && skb_vlan_tag_present(new_skb)) {
4a71df50
FB		 2688 skb_push(new_skb, VLAN_HLEN);
2689 skb_copy_to_linear_data(new_skb, new_skb->data + 4, 4);
2690 skb_copy_to_linear_data_offset(new_skb, 4,
2691 new_skb->data + 8, 4);
2692 skb_copy_to_linear_data_offset(new_skb, 8,
2693 new_skb->data + 12, 4);
6bee4e26
HW		 2694 tag = (__be16 *)(new_skb->data + 12);
2695 *tag = cpu_to_be16(ETH_P_8021Q);
2696 *(tag + 1) = cpu_to_be16(skb_vlan_tag_get(new_skb));
4a71df50
FB		 2697 }
2698 }
2699
2700 netif_stop_queue(dev);
2701
4a71df50 2702 /* fix hardware limitation: as long as we do not have sbal
64ef8957 2703 * chaining we can not send long frag lists
4a71df50 2704 */
41aeed58
EC		 2705 if ((card->info.type != QETH_CARD_TYPE_IQD) &&
2706 ((use_tso && !qeth_l3_get_elements_no_tso(card, new_skb, 1)) ||
7d969d2e 2707 (!use_tso && !qeth_get_elements_no(card, new_skb, 0, 0)))) {
6059c905
EC		 2708 int lin_rc = skb_linearize(new_skb);
2709
2710 if (card->options.performance_stats) {
2711 if (lin_rc)
2712 card->perf_stats.tx_linfail++;
2713 else
2714 card->perf_stats.tx_lin++;
2715 }
2716 if (lin_rc)
41aeed58 2717 goto tx_drop;
64ef8957 2718 }
886e1974 2719 nr_frags = skb_shinfo(new_skb)->nr_frags;
4a71df50 2720
41aeed58 2721 if (use_tso) {
d58ff351 2722 hdr = skb_push(new_skb, sizeof(struct qeth_hdr_tso));
4a71df50
FB		 2723 memset(hdr, 0, sizeof(struct qeth_hdr_tso));
2724 qeth_l3_fill_header(card, hdr, new_skb, ipv, cast_type);
2725 qeth_tso_fill_header(card, hdr, new_skb);
2863c613 2726 hdr_elements++;
4a71df50 2727 } else {
683d718a 2728 if (data_offset < 0) {
d58ff351 2729 hdr = skb_push(new_skb, sizeof(struct qeth_hdr));
683d718a
FB		 2730 qeth_l3_fill_header(card, hdr, new_skb, ipv,
2731 cast_type);
2732 } else {
6bee4e26 2733 if (be16_to_cpu(new_skb->protocol) == ETH_P_AF_IUCV)
b3332930
FB		 2734 qeth_l3_fill_af_iucv_hdr(card, hdr, new_skb);
2735 else {
2736 qeth_l3_fill_header(card, hdr, new_skb, ipv,
2737 cast_type);
2738 hdr->hdr.l3.length = new_skb->len - data_offset;
2739 }
683d718a 2740 }
f6b85b6c
FB		 2741
2742 if (skb->ip_summed == CHECKSUM_PARTIAL)
2743 qeth_l3_hdr_csum(card, hdr, new_skb);
4a71df50
FB		 2744 }
2745
41aeed58
EC		 2746 elements = use_tso ?
2747 qeth_l3_get_elements_no_tso(card, new_skb, hdr_elements) :
7d969d2e
JW		 2748 qeth_get_elements_no(card, new_skb, hdr_elements,
2749 (data_offset > 0) ? data_offset : 0);
2863c613 2750 if (!elements) {
64ef8957
FB		 2751 if (data_offset >= 0)
2752 kmem_cache_free(qeth_core_header_cache, hdr);
2753 goto tx_drop;
f61a0d05 2754 }
2863c613 2755 elements += hdr_elements;
4a71df50 2756
51aa165c
FB		 2757 if (card->info.type != QETH_CARD_TYPE_IQD) {
2758 int len;
13ddacb5
JW		 2759 if (use_tso) {
2760 hd_len = sizeof(struct qeth_hdr_tso) +
2761 ip_hdrlen(new_skb) + tcp_hdrlen(new_skb);
2762 len = hd_len;
2763 } else {
51aa165c 2764 len = sizeof(struct qeth_hdr_layer3);
13ddacb5 2765 }
51aa165c 2766
d4ae1f5e 2767 if (qeth_hdr_chk_and_bounce(new_skb, &hdr, len))
51aa165c 2768 goto tx_drop;
13ddacb5 2769 rc = qeth_do_send_packet(card, queue, new_skb, hdr, hd_len,
9c3bfda9 2770 hd_len, elements);
51aa165c 2771 } else
7c2e9ba3
JW		 2772 rc = qeth_do_send_packet_fast(queue, new_skb, hdr, data_offset,
2773 hd_len);
4a71df50
FB		 2774
2775 if (!rc) {
2776 card->stats.tx_packets++;
2777 card->stats.tx_bytes += tx_bytes;
2778 if (new_skb != skb)
2779 dev_kfree_skb_any(skb);
2780 if (card->options.performance_stats) {
41aeed58 2781 if (use_tso) {
4a71df50
FB		 2782 card->perf_stats.large_send_bytes += tx_bytes;
2783 card->perf_stats.large_send_cnt++;
2784 }
64ef8957 2785 if (nr_frags) {
4a71df50
FB		 2786 card->perf_stats.sg_skbs_sent++;
2787 /* nr_frags + skb->data */
64ef8957 2788 card->perf_stats.sg_frags_sent += nr_frags + 1;
4a71df50
FB		 2789 }
2790 }
ec634fe3 2791 rc = NETDEV_TX_OK;
4a71df50 2792 } else {
683d718a
FB		 2793 if (data_offset >= 0)
2794 kmem_cache_free(qeth_core_header_cache, hdr);
2795
4a71df50
FB		 2796 if (rc == -EBUSY) {
2797 if (new_skb != skb)
2798 dev_kfree_skb_any(new_skb);
2799 return NETDEV_TX_BUSY;
2800 } else
2801 goto tx_drop;
2802 }
2803
2804 netif_wake_queue(dev);
2805 if (card->options.performance_stats)
2806 card->perf_stats.outbound_time += qeth_get_micros() -
2807 card->perf_stats.outbound_start_time;
2808 return rc;
2809
2810tx_drop:
2811 card->stats.tx_dropped++;
2812 card->stats.tx_errors++;
2813 if ((new_skb != skb) && new_skb)
2814 dev_kfree_skb_any(new_skb);
2815 dev_kfree_skb_any(skb);
d0ec0f54 2816 netif_wake_queue(dev);
4a71df50
FB		 2817 return NETDEV_TX_OK;
2818}
2819
39423440 2820static int __qeth_l3_open(struct net_device *dev)
4a71df50 2821{
509e2562 2822 struct qeth_card *card = dev->ml_priv;
a1c3ed4c 2823 int rc = 0;
4a71df50 2824
847a50fd 2825 QETH_CARD_TEXT(card, 4, "qethopen");
39423440
UB		 2826 if (card->state == CARD_STATE_UP)
2827 return rc;
4a71df50
FB		 2828 if (card->state != CARD_STATE_SOFTSETUP)
2829 return -ENODEV;
2830 card->data.state = CH_STATE_UP;
2831 card->state = CARD_STATE_UP;
4a71df50
FB		 2832 netif_start_queue(dev);
2833
a1c3ed4c
FB		 2834 if (qdio_stop_irq(card->data.ccwdev, 0) >= 0) {
2835 napi_enable(&card->napi);
2836 napi_schedule(&card->napi);
2837 } else
2838 rc = -EIO;
2839 return rc;
4a71df50
FB		 2840}
2841
39423440
UB		 2842static int qeth_l3_open(struct net_device *dev)
2843{
2844 struct qeth_card *card = dev->ml_priv;
2845
2846 QETH_CARD_TEXT(card, 5, "qethope_");
2847 if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
2848 QETH_CARD_TEXT(card, 3, "openREC");
2849 return -ERESTARTSYS;
2850 }
2851 return __qeth_l3_open(dev);
2852}
2853
4a71df50
FB		 2854static int qeth_l3_stop(struct net_device *dev)
2855{
509e2562 2856 struct qeth_card *card = dev->ml_priv;
4a71df50 2857
847a50fd 2858 QETH_CARD_TEXT(card, 4, "qethstop");
4a71df50 2859 netif_tx_disable(dev);
a1c3ed4c 2860 if (card->state == CARD_STATE_UP) {
4a71df50 2861 card->state = CARD_STATE_SOFTSETUP;
a1c3ed4c
FB		 2862 napi_disable(&card->napi);
2863 }
4a71df50
FB		 2864 return 0;
2865}
2866
0fc0b732 2867static const struct ethtool_ops qeth_l3_ethtool_ops = {
4a71df50 2868 .get_link = ethtool_op_get_link,
4a71df50
FB		 2869 .get_strings = qeth_core_get_strings,
2870 .get_ethtool_stats = qeth_core_get_ethtool_stats,
df8b4ec8 2871 .get_sset_count = qeth_core_get_sset_count,
4a71df50 2872 .get_drvinfo = qeth_core_get_drvinfo,
993e19c0 2873 .get_link_ksettings = qeth_core_ethtool_get_link_ksettings,
4a71df50
FB		 2874};
2875
2876/*
2877 * we need NOARP for IPv4 but we want neighbor solicitation for IPv6. Setting
2878 * NOARP on the netdevice is no option because it also turns off neighbor
2879 * solicitation. For IPv4 we install a neighbor_setup function. We don't want
2880 * arp resolution but we want the hard header (packet socket will work
2881 * e.g. tcpdump)
2882 */
2883static int qeth_l3_neigh_setup_noarp(struct neighbour *n)
2884{
2885 n->nud_state = NUD_NOARP;
2886 memcpy(n->ha, "FAKELL", 6);
2887 n->output = n->ops->connected_output;
2888 return 0;
2889}
2890
2891static int
2892qeth_l3_neigh_setup(struct net_device *dev, struct neigh_parms *np)
2893{
2894 if (np->tbl->family == AF_INET)
2895 np->neigh_setup = qeth_l3_neigh_setup_noarp;
2896
2897 return 0;
2898}
2899
3d58cefd 2900static const struct net_device_ops qeth_l3_netdev_ops = {
8403b13c
FB		 2901 .ndo_open = qeth_l3_open,
2902 .ndo_stop = qeth_l3_stop,
2903 .ndo_get_stats = qeth_get_stats,
2904 .ndo_start_xmit = qeth_l3_hard_start_xmit,
2905 .ndo_validate_addr = eth_validate_addr,
afc4b13d 2906 .ndo_set_rx_mode = qeth_l3_set_multicast_list,
942d6984 2907 .ndo_do_ioctl = qeth_do_ioctl,
7ff0bcf6 2908 .ndo_change_mtu = qeth_change_mtu,
8f43fb00
TR		 2909 .ndo_fix_features = qeth_fix_features,
2910 .ndo_set_features = qeth_set_features,
8403b13c
FB		 2911 .ndo_vlan_rx_add_vid = qeth_l3_vlan_rx_add_vid,
2912 .ndo_vlan_rx_kill_vid = qeth_l3_vlan_rx_kill_vid,
7ff0bcf6 2913 .ndo_tx_timeout = qeth_tx_timeout,
8403b13c
FB		 2914};
2915
3d58cefd
FB		 2916static const struct net_device_ops qeth_l3_osa_netdev_ops = {
2917 .ndo_open = qeth_l3_open,
2918 .ndo_stop = qeth_l3_stop,
2919 .ndo_get_stats = qeth_get_stats,
2920 .ndo_start_xmit = qeth_l3_hard_start_xmit,
6d69b1f1 2921 .ndo_features_check = qeth_features_check,
3d58cefd 2922 .ndo_validate_addr = eth_validate_addr,
afc4b13d 2923 .ndo_set_rx_mode = qeth_l3_set_multicast_list,
942d6984 2924 .ndo_do_ioctl = qeth_do_ioctl,
7ff0bcf6 2925 .ndo_change_mtu = qeth_change_mtu,
8f43fb00
TR		 2926 .ndo_fix_features = qeth_fix_features,
2927 .ndo_set_features = qeth_set_features,
3d58cefd
FB		 2928 .ndo_vlan_rx_add_vid = qeth_l3_vlan_rx_add_vid,
2929 .ndo_vlan_rx_kill_vid = qeth_l3_vlan_rx_kill_vid,
7ff0bcf6 2930 .ndo_tx_timeout = qeth_tx_timeout,
3d58cefd
FB		 2931 .ndo_neigh_setup = qeth_l3_neigh_setup,
2932};
2933
4a71df50
FB		 2934static int qeth_l3_setup_netdev(struct qeth_card *card)
2935{
1aec42bc
TR		 2936 int rc;
2937
5113fec0
UB		 2938 if (card->info.type == QETH_CARD_TYPE_OSD ||
2939 card->info.type == QETH_CARD_TYPE_OSX) {
4a71df50
FB		 2940 if ((card->info.link_type == QETH_LINK_TYPE_LANE_TR) ||
2941 (card->info.link_type == QETH_LINK_TYPE_HSTR)) {
1abd2296
PG		 2942 pr_info("qeth_l3: ignoring TR device\n");
2943 return -ENODEV;
4a71df50
FB		 2944 } else {
2945 card->dev = alloc_etherdev(0);
2946 if (!card->dev)
2947 return -ENODEV;
3d58cefd 2948 card->dev->netdev_ops = &qeth_l3_osa_netdev_ops;
4a71df50
FB		 2949
2950 /*IPv6 address autoconfiguration stuff*/
2951 qeth_l3_get_unique_id(card);
2952 if (!(card->info.unique_id & UNIQUE_ID_NOT_BY_CARD))
2953 card->dev->dev_id = card->info.unique_id &
2954 0xffff;
c5e631a8
FB		 2955 if (!card->info.guestlan) {
2956 card->dev->hw_features = NETIF_F_SG |
2957 NETIF_F_RXCSUM | NETIF_F_IP_CSUM |
2958 NETIF_F_TSO;
9bdc4411
HW		 2959 card->dev->vlan_features = NETIF_F_SG |
2960 NETIF_F_RXCSUM | NETIF_F_IP_CSUM |
2961 NETIF_F_TSO;
6d69b1f1 2962 card->dev->features |= NETIF_F_SG;
c5e631a8 2963 }
4a71df50
FB		 2964 }
2965 } else if (card->info.type == QETH_CARD_TYPE_IQD) {
c835a677
TG		 2966 card->dev = alloc_netdev(0, "hsi%d", NET_NAME_UNKNOWN,
2967 ether_setup);
4a71df50
FB		 2968 if (!card->dev)
2969 return -ENODEV;
2970 card->dev->flags |= IFF_NOARP;
3d58cefd 2971 card->dev->netdev_ops = &qeth_l3_netdev_ops;
1aec42bc
TR		 2972 rc = qeth_l3_iqd_read_initial_mac(card);
2973 if (rc)
2974 return rc;
b3332930
FB		 2975 if (card->options.hsuid[0])
2976 memcpy(card->dev->perm_addr, card->options.hsuid, 9);
4a71df50
FB		 2977 } else
2978 return -ENODEV;
2979
509e2562 2980 card->dev->ml_priv = card;
4a71df50 2981 card->dev->watchdog_timeo = QETH_TX_TIMEOUT;
4a71df50 2982 card->dev->mtu = card->info.initial_mtu;
46b3ef4c
JW		 2983 card->dev->min_mtu = 64;
2984 card->dev->max_mtu = ETH_MAX_MTU;
7ad24ea4 2985 card->dev->ethtool_ops = &qeth_l3_ethtool_ops;
f646968f
PM		 2986 card->dev->features |= NETIF_F_HW_VLAN_CTAG_TX |
2987 NETIF_F_HW_VLAN_CTAG_RX |
2988 NETIF_F_HW_VLAN_CTAG_FILTER;
02875878 2989 netif_keep_dst(card->dev);
8bad55f8
EC		 2990 card->dev->gso_max_size = (QETH_MAX_BUFFER_ELEMENTS(card) - 1) *
2991 PAGE_SIZE;
4a71df50
FB		 2992
2993 SET_NETDEV_DEV(card->dev, &card->gdev->dev);
d73ef324 2994 netif_napi_add(card->dev, &card->napi, qeth_poll, QETH_NAPI_WEIGHT);
e5ebe632 2995 netif_carrier_off(card->dev);
4a71df50
FB		 2996 return register_netdev(card->dev);
2997}
2998
79a04e40
UB		 2999static const struct device_type qeth_l3_devtype = {
3000 .name = "qeth_layer3",
3001 .groups = qeth_l3_attr_groups,
3002};
3003
4a71df50
FB		 3004static int qeth_l3_probe_device(struct ccwgroup_device *gdev)
3005{
3006 struct qeth_card *card = dev_get_drvdata(&gdev->dev);
9111e788 3007 int rc;
4a71df50 3008
79a04e40
UB		 3009 if (gdev->dev.type == &qeth_generic_devtype) {
3010 rc = qeth_l3_create_device_attributes(&gdev->dev);
3011 if (rc)
3012 return rc;
3013 }
ebccc739
UB		 3014 hash_init(card->ip_htable);
3015 hash_init(card->ip_mc_htable);
4a71df50 3016 card->options.layer2 = 0;
1da74b1c 3017 card->info.hwtrap = 0;
4a71df50
FB		 3018 return 0;
3019}
3020
3021static void qeth_l3_remove_device(struct ccwgroup_device *cgdev)
3022{
3023 struct qeth_card *card = dev_get_drvdata(&cgdev->dev);
3024
79a04e40
UB		 3025 if (cgdev->dev.type == &qeth_generic_devtype)
3026 qeth_l3_remove_device_attributes(&cgdev->dev);
9dc48ccc 3027
f2148565 3028 qeth_set_allowed_threads(card, 0, 1);
4a71df50
FB		 3029 wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0);
3030
70919e23 3031 if (cgdev->state == CCWGROUP_ONLINE)
4a71df50 3032 qeth_l3_set_offline(cgdev);
4a71df50
FB		 3033
3034 if (card->dev) {
7831b4ff 3035 netif_napi_del(&card->napi);
4a71df50
FB		 3036 unregister_netdev(card->dev);
3037 card->dev = NULL;
3038 }
3039
5f78e29c 3040 qeth_l3_clear_ip_htable(card, 0);
4a71df50
FB		 3041 qeth_l3_clear_ipato_list(card);
3042 return;
3043}
3044
3045static int __qeth_l3_set_online(struct ccwgroup_device *gdev, int recovery_mode)
3046{
3047 struct qeth_card *card = dev_get_drvdata(&gdev->dev);
3048 int rc = 0;
3049 enum qeth_card_states recover_flag;
3050
9dc48ccc 3051 mutex_lock(&card->discipline_mutex);
c4949f07 3052 mutex_lock(&card->conf_mutex);
d11ba0c4
PT		 3053 QETH_DBF_TEXT(SETUP, 2, "setonlin");
3054 QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
4a71df50 3055
4a71df50 3056 recover_flag = card->state;
4a71df50
FB		 3057 rc = qeth_core_hardsetup_card(card);
3058 if (rc) {
1aec42bc 3059 QETH_DBF_TEXT_(SETUP, 2, "2err%04x", rc);
aa909224 3060 rc = -ENODEV;
4a71df50
FB		 3061 goto out_remove;
3062 }
3063
aa909224
UB		 3064 if (!card->dev && qeth_l3_setup_netdev(card)) {
3065 rc = -ENODEV;
4a71df50 3066 goto out_remove;
aa909224 3067 }
4a71df50 3068
1da74b1c
FB		 3069 if (qeth_is_diagass_supported(card, QETH_DIAGS_CMD_TRAP)) {
3070 if (card->info.hwtrap &&
3071 qeth_hw_trap(card, QETH_DIAGS_TRAP_ARM))
3072 card->info.hwtrap = 0;
3073 } else
3074 card->info.hwtrap = 0;
3075
4a71df50 3076 card->state = CARD_STATE_HARDSETUP;
a1c3ed4c 3077 memset(&card->rx, 0, sizeof(struct qeth_rx));
4a71df50
FB		 3078 qeth_print_status_message(card);
3079
3080 /* softsetup */
d11ba0c4 3081 QETH_DBF_TEXT(SETUP, 2, "softsetp");
4a71df50 3082
4a71df50
FB		 3083 rc = qeth_l3_setadapter_parms(card);
3084 if (rc)
1aec42bc 3085 QETH_DBF_TEXT_(SETUP, 2, "2err%04x", rc);
76b11f8e
UB		 3086 if (!card->options.sniffer) {
3087 rc = qeth_l3_start_ipassists(card);
0f54761d 3088 if (rc) {
76b11f8e 3089 QETH_DBF_TEXT_(SETUP, 2, "3err%d", rc);
0f54761d
SR		 3090 goto out_remove;
3091 }
76b11f8e
UB		 3092 rc = qeth_l3_setrouting_v4(card);
3093 if (rc)
1aec42bc 3094 QETH_DBF_TEXT_(SETUP, 2, "4err%04x", rc);
76b11f8e
UB		 3095 rc = qeth_l3_setrouting_v6(card);
3096 if (rc)
1aec42bc 3097 QETH_DBF_TEXT_(SETUP, 2, "5err%04x", rc);
76b11f8e 3098 }
4a71df50
FB		 3099 netif_tx_disable(card->dev);
3100
3101 rc = qeth_init_qdio_queues(card);
3102 if (rc) {
d11ba0c4 3103 QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc);
aa909224 3104 rc = -ENODEV;
4a71df50
FB		 3105 goto out_remove;
3106 }
3107 card->state = CARD_STATE_SOFTSETUP;
4a71df50
FB		 3108
3109 qeth_set_allowed_threads(card, 0xffffffff, 0);
5f78e29c 3110 qeth_l3_recover_ip(card);
2b6203bb
UB		 3111 if (card->lan_online)
3112 netif_carrier_on(card->dev);
3113 else
3114 netif_carrier_off(card->dev);
8af7c5ae 3115 if (recover_flag == CARD_STATE_RECOVER) {
4763b0a0 3116 rtnl_lock();
8af7c5ae 3117 if (recovery_mode)
39423440 3118 __qeth_l3_open(card->dev);
4763b0a0 3119 else
8af7c5ae 3120 dev_open(card->dev);
8af7c5ae 3121 qeth_l3_set_multicast_list(card->dev);
e830baa9 3122 qeth_recover_features(card->dev);
4763b0a0 3123 rtnl_unlock();
4a71df50 3124 }
82f77cf9 3125 qeth_trace_features(card);
4a71df50
FB		 3126 /* let user_space know that device is online */
3127 kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE);
c4949f07 3128 mutex_unlock(&card->conf_mutex);
9dc48ccc 3129 mutex_unlock(&card->discipline_mutex);
4a71df50
FB		 3130 return 0;
3131out_remove:
4a71df50
FB		 3132 qeth_l3_stop_card(card, 0);
3133 ccw_device_set_offline(CARD_DDEV(card));
3134 ccw_device_set_offline(CARD_WDEV(card));
3135 ccw_device_set_offline(CARD_RDEV(card));
22ae2790 3136 qdio_free(CARD_DDEV(card));
4a71df50
FB		 3137 if (recover_flag == CARD_STATE_RECOVER)
3138 card->state = CARD_STATE_RECOVER;
3139 else
3140 card->state = CARD_STATE_DOWN;
c4949f07 3141 mutex_unlock(&card->conf_mutex);
9dc48ccc 3142 mutex_unlock(&card->discipline_mutex);
aa909224 3143 return rc;
4a71df50
FB		 3144}
3145
3146static int qeth_l3_set_online(struct ccwgroup_device *gdev)
3147{
3148 return __qeth_l3_set_online(gdev, 0);
3149}
3150
3151static int __qeth_l3_set_offline(struct ccwgroup_device *cgdev,
3152 int recovery_mode)
3153{
3154 struct qeth_card *card = dev_get_drvdata(&cgdev->dev);
3155 int rc = 0, rc2 = 0, rc3 = 0;
3156 enum qeth_card_states recover_flag;
3157
9dc48ccc 3158 mutex_lock(&card->discipline_mutex);
c4949f07 3159 mutex_lock(&card->conf_mutex);
d11ba0c4
PT		 3160 QETH_DBF_TEXT(SETUP, 3, "setoffl");
3161 QETH_DBF_HEX(SETUP, 3, &card, sizeof(void *));
4a71df50
FB		 3162
3163 if (card->dev && netif_carrier_ok(card->dev))
3164 netif_carrier_off(card->dev);
3165 recover_flag = card->state;
1da74b1c
FB		 3166 if ((!recovery_mode && card->info.hwtrap) || card->info.hwtrap == 2) {
3167 qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM);
3168 card->info.hwtrap = 1;
3169 }
0f5623c9 3170 qeth_l3_stop_card(card, recovery_mode);
72861ae7
EL		 3171 if ((card->options.cq == QETH_CQ_ENABLED) && card->dev) {
3172 rtnl_lock();
3173 call_netdevice_notifiers(NETDEV_REBOOT, card->dev);
3174 rtnl_unlock();
3175 }
4a71df50
FB		 3176 rc = ccw_device_set_offline(CARD_DDEV(card));
3177 rc2 = ccw_device_set_offline(CARD_WDEV(card));
3178 rc3 = ccw_device_set_offline(CARD_RDEV(card));
3179 if (!rc)
3180 rc = (rc2) ? rc2 : rc3;
3181 if (rc)
d11ba0c4 3182 QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
22ae2790 3183 qdio_free(CARD_DDEV(card));
4a71df50
FB		 3184 if (recover_flag == CARD_STATE_UP)
3185 card->state = CARD_STATE_RECOVER;
3186 /* let user_space know that device is offline */
3187 kobject_uevent(&cgdev->dev.kobj, KOBJ_CHANGE);
c4949f07 3188 mutex_unlock(&card->conf_mutex);
9dc48ccc 3189 mutex_unlock(&card->discipline_mutex);
4a71df50
FB		 3190 return 0;
3191}
3192
3193static int qeth_l3_set_offline(struct ccwgroup_device *cgdev)
3194{
3195 return __qeth_l3_set_offline(cgdev, 0);
3196}
3197
3198static int qeth_l3_recover(void *ptr)
3199{
3200 struct qeth_card *card;
3201 int rc = 0;
3202
3203 card = (struct qeth_card *) ptr;
847a50fd
CO		 3204 QETH_CARD_TEXT(card, 2, "recover1");
3205 QETH_CARD_HEX(card, 2, &card, sizeof(void *));
4a71df50
FB		 3206 if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD))
3207 return 0;
847a50fd 3208 QETH_CARD_TEXT(card, 2, "recover2");
74eacdb9
FB		 3209 dev_warn(&card->gdev->dev,
3210 "A recovery process has been started for the device\n");
65d8013c 3211 qeth_set_recovery_task(card);
4a71df50
FB		 3212 __qeth_l3_set_offline(card->gdev, 1);
3213 rc = __qeth_l3_set_online(card->gdev, 1);
4a71df50 3214 if (!rc)
74eacdb9
FB		 3215 dev_info(&card->gdev->dev,
3216 "Device successfully recovered!\n");
28a7e4c9 3217 else {
0f54761d
SR		 3218 qeth_close_dev(card);
3219 dev_warn(&card->gdev->dev, "The qeth device driver "
2efaf5ff 3220 "failed to recover an error on the device\n");
28a7e4c9 3221 }
65d8013c 3222 qeth_clear_recovery_task(card);
a1c3ed4c
FB		 3223 qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD);
3224 qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD);
4a71df50
FB		 3225 return 0;
3226}
3227
bbcfcdc8
FB		 3228static int qeth_l3_pm_suspend(struct ccwgroup_device *gdev)
3229{
3230 struct qeth_card *card = dev_get_drvdata(&gdev->dev);
3231
3232 if (card->dev)
3233 netif_device_detach(card->dev);
3234 qeth_set_allowed_threads(card, 0, 1);
3235 wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0);
3236 if (gdev->state == CCWGROUP_OFFLINE)
3237 return 0;
3238 if (card->state == CARD_STATE_UP) {
1da74b1c
FB		 3239 if (card->info.hwtrap)
3240 qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM);
bbcfcdc8
FB		 3241 __qeth_l3_set_offline(card->gdev, 1);
3242 } else
3243 __qeth_l3_set_offline(card->gdev, 0);
3244 return 0;
3245}
3246
3247static int qeth_l3_pm_resume(struct ccwgroup_device *gdev)
3248{
3249 struct qeth_card *card = dev_get_drvdata(&gdev->dev);
3250 int rc = 0;
3251
3252 if (gdev->state == CCWGROUP_OFFLINE)
3253 goto out;
3254
3255 if (card->state == CARD_STATE_RECOVER) {
3256 rc = __qeth_l3_set_online(card->gdev, 1);
3257 if (rc) {
869da90b
UB		 3258 rtnl_lock();
3259 dev_close(card->dev);
3260 rtnl_unlock();
bbcfcdc8
FB		 3261 }
3262 } else
3263 rc = __qeth_l3_set_online(card->gdev, 0);
3264out:
3265 qeth_set_allowed_threads(card, 0xffffffff, 0);
3266 if (card->dev)
3267 netif_device_attach(card->dev);
3268 if (rc)
3269 dev_warn(&card->gdev->dev, "The qeth device driver "
3270 "failed to recover an error on the device\n");
3271 return rc;
3272}
3273
c044dc21
EC		 3274/* Returns zero if the command is successfully "consumed" */
3275static int qeth_l3_control_event(struct qeth_card *card,
3276 struct qeth_ipa_cmd *cmd)
3277{
3278 return 1;
3279}
3280
c041f2d4 3281struct qeth_discipline qeth_l3_discipline = {
79a04e40 3282 .devtype = &qeth_l3_devtype,
c041f2d4
SO		 3283 .start_poll = qeth_qdio_start_poll,
3284 .input_handler = (qdio_handler_t *) qeth_qdio_input_handler,
3285 .output_handler = (qdio_handler_t *) qeth_qdio_output_handler,
d73ef324 3286 .process_rx_buffer = qeth_l3_process_inbound_buffer,
c041f2d4
SO		 3287 .recover = qeth_l3_recover,
3288 .setup = qeth_l3_probe_device,
4a71df50
FB		 3289 .remove = qeth_l3_remove_device,
3290 .set_online = qeth_l3_set_online,
3291 .set_offline = qeth_l3_set_offline,
bbcfcdc8
FB		 3292 .freeze = qeth_l3_pm_suspend,
3293 .thaw = qeth_l3_pm_resume,
3294 .restore = qeth_l3_pm_resume,
942d6984 3295 .do_ioctl = qeth_l3_do_ioctl,
c044dc21 3296 .control_event_handler = qeth_l3_control_event,
4a71df50 3297};
c041f2d4 3298EXPORT_SYMBOL_GPL(qeth_l3_discipline);
4a71df50
FB		 3299
3300static int qeth_l3_ip_event(struct notifier_block *this,
76fef2b6 3301 unsigned long event, void *ptr)
4a71df50 3302{
5f78e29c 3303
4a71df50
FB		 3304 struct in_ifaddr *ifa = (struct in_ifaddr *)ptr;
3305 struct net_device *dev = (struct net_device *)ifa->ifa_dev->dev;
3306 struct qeth_ipaddr *addr;
3307 struct qeth_card *card;
3308
c346dca1 3309 if (dev_net(dev) != &init_net)
76fef2b6
DM		 3310 return NOTIFY_DONE;
3311
4a71df50
FB		 3312 card = qeth_l3_get_card_from_dev(dev);
3313 if (!card)
3314 return NOTIFY_DONE;
6d8823db 3315 QETH_CARD_TEXT(card, 3, "ipevent");
4a71df50
FB		 3316
3317 addr = qeth_l3_get_addr_buffer(QETH_PROT_IPV4);
5f78e29c 3318 if (addr) {
6bee4e26
HW		 3319 addr->u.a4.addr = be32_to_cpu(ifa->ifa_address);
3320 addr->u.a4.mask = be32_to_cpu(ifa->ifa_mask);
4a71df50
FB		 3321 addr->type = QETH_IP_TYPE_NORMAL;
3322 } else
5f78e29c 3323 return NOTIFY_DONE;
4a71df50
FB		 3324
3325 switch (event) {
3326 case NETDEV_UP:
5f78e29c
LD		 3327 spin_lock_bh(&card->ip_lock);
3328 qeth_l3_add_ip(card, addr);
3329 spin_unlock_bh(&card->ip_lock);
4a71df50
FB		 3330 break;
3331 case NETDEV_DOWN:
5f78e29c
LD		 3332 spin_lock_bh(&card->ip_lock);
3333 qeth_l3_delete_ip(card, addr);
3334 spin_unlock_bh(&card->ip_lock);
4a71df50
FB		 3335 break;
3336 }
5f78e29c
LD		 3337
3338 kfree(addr);
4a71df50
FB		 3339 return NOTIFY_DONE;
3340}
3341
3342static struct notifier_block qeth_l3_ip_notifier = {
3343 qeth_l3_ip_event,
3344 NULL,
3345};
3346
3347#ifdef CONFIG_QETH_IPV6
3348/**
3349 * IPv6 event handler
3350 */
3351static int qeth_l3_ip6_event(struct notifier_block *this,
76fef2b6 3352 unsigned long event, void *ptr)
4a71df50
FB		 3353{
3354 struct inet6_ifaddr *ifa = (struct inet6_ifaddr *)ptr;
3355 struct net_device *dev = (struct net_device *)ifa->idev->dev;
3356 struct qeth_ipaddr *addr;
3357 struct qeth_card *card;
3358
4a71df50
FB		 3359 card = qeth_l3_get_card_from_dev(dev);
3360 if (!card)
3361 return NOTIFY_DONE;
847a50fd 3362 QETH_CARD_TEXT(card, 3, "ip6event");
4a71df50
FB		 3363 if (!qeth_is_supported(card, IPA_IPV6))
3364 return NOTIFY_DONE;
3365
3366 addr = qeth_l3_get_addr_buffer(QETH_PROT_IPV6);
5f78e29c 3367 if (addr) {
4a71df50
FB		 3368 memcpy(&addr->u.a6.addr, &ifa->addr, sizeof(struct in6_addr));
3369 addr->u.a6.pfxlen = ifa->prefix_len;
3370 addr->type = QETH_IP_TYPE_NORMAL;
3371 } else
5f78e29c 3372 return NOTIFY_DONE;
4a71df50
FB		 3373
3374 switch (event) {
3375 case NETDEV_UP:
5f78e29c
LD		 3376 spin_lock_bh(&card->ip_lock);
3377 qeth_l3_add_ip(card, addr);
3378 spin_unlock_bh(&card->ip_lock);
4a71df50
FB		 3379 break;
3380 case NETDEV_DOWN:
5f78e29c
LD		 3381 spin_lock_bh(&card->ip_lock);
3382 qeth_l3_delete_ip(card, addr);
3383 spin_unlock_bh(&card->ip_lock);
4a71df50
FB		 3384 break;
3385 }
5f78e29c
LD		 3386
3387 kfree(addr);
4a71df50
FB		 3388 return NOTIFY_DONE;
3389}
3390
3391static struct notifier_block qeth_l3_ip6_notifier = {
3392 qeth_l3_ip6_event,
3393 NULL,
3394};
3395#endif
3396
3397static int qeth_l3_register_notifiers(void)
3398{
3399 int rc;
3400
847a50fd 3401 QETH_DBF_TEXT(SETUP, 5, "regnotif");
4a71df50
FB		 3402 rc = register_inetaddr_notifier(&qeth_l3_ip_notifier);
3403 if (rc)
3404 return rc;
3405#ifdef CONFIG_QETH_IPV6
3406 rc = register_inet6addr_notifier(&qeth_l3_ip6_notifier);
3407 if (rc) {
3408 unregister_inetaddr_notifier(&qeth_l3_ip_notifier);
3409 return rc;
3410 }
3411#else
baebc70a 3412 pr_warn("There is no IPv6 support for the layer 3 discipline\n");
4a71df50
FB		 3413#endif
3414 return 0;
3415}
3416
3417static void qeth_l3_unregister_notifiers(void)
3418{
3419
847a50fd 3420 QETH_DBF_TEXT(SETUP, 5, "unregnot");
18af5c17 3421 WARN_ON(unregister_inetaddr_notifier(&qeth_l3_ip_notifier));
4a71df50 3422#ifdef CONFIG_QETH_IPV6
18af5c17 3423 WARN_ON(unregister_inet6addr_notifier(&qeth_l3_ip6_notifier));
4a71df50
FB		 3424#endif /* QETH_IPV6 */
3425}
3426
3427static int __init qeth_l3_init(void)
3428{
3429 int rc = 0;
3430
74eacdb9 3431 pr_info("register layer 3 discipline\n");
4a71df50
FB		 3432 rc = qeth_l3_register_notifiers();
3433 return rc;
3434}
3435
3436static void __exit qeth_l3_exit(void)
3437{
3438 qeth_l3_unregister_notifiers();
74eacdb9 3439 pr_info("unregister layer 3 discipline\n");
4a71df50
FB		 3440}
3441
3442module_init(qeth_l3_init);
3443module_exit(qeth_l3_exit);
3444MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>");
3445MODULE_DESCRIPTION("qeth layer 3 discipline");
3446MODULE_LICENSE("GPL");
ubuntu-bionic-kernel mirror