qeth_l3_main.c 68.0 KB
Newer Older
1
// SPDX-License-Identifier: GPL-2.0
F
Frank Blaschka 已提交
2
/*
3
 *    Copyright IBM Corp. 2007, 2009
F
Frank Blaschka 已提交
4 5 6 7 8 9
 *    Author(s): Utz Bacher <utz.bacher@de.ibm.com>,
 *		 Frank Pavlic <fpavlic@de.ibm.com>,
 *		 Thomas Spatzier <tspat@de.ibm.com>,
 *		 Frank Blaschka <frank.blaschka@de.ibm.com>
 */

10 11 12
#define KMSG_COMPONENT "qeth"
#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt

F
Frank Blaschka 已提交
13 14
#include <linux/module.h>
#include <linux/moduleparam.h>
J
Jiri Pirko 已提交
15
#include <linux/bitops.h>
F
Frank Blaschka 已提交
16 17 18 19 20
#include <linux/string.h>
#include <linux/errno.h>
#include <linux/kernel.h>
#include <linux/etherdevice.h>
#include <linux/ip.h>
21
#include <linux/in.h>
F
Frank Blaschka 已提交
22
#include <linux/ipv6.h>
F
Frank Blaschka 已提交
23 24
#include <linux/inetdevice.h>
#include <linux/igmp.h>
25
#include <linux/slab.h>
26
#include <linux/if_ether.h>
J
Jiri Pirko 已提交
27
#include <linux/if_vlan.h>
28
#include <linux/skbuff.h>
F
Frank Blaschka 已提交
29 30 31

#include <net/ip.h>
#include <net/arp.h>
32
#include <net/route.h>
33
#include <net/ipv6.h>
34
#include <net/ip6_route.h>
35
#include <net/ip6_fib.h>
36
#include <net/iucv/af_iucv.h>
37
#include <linux/hashtable.h>
F
Frank Blaschka 已提交
38 39 40

#include "qeth_l3.h"

41

F
Frank Blaschka 已提交
42
static int qeth_l3_set_offline(struct ccwgroup_device *);
43
static void qeth_l3_set_rx_mode(struct net_device *dev);
F
Frank Blaschka 已提交
44 45 46 47 48
static int qeth_l3_register_addr_entry(struct qeth_card *,
		struct qeth_ipaddr *);
static int qeth_l3_deregister_addr_entry(struct qeth_card *,
		struct qeth_ipaddr *);

49
static void qeth_l3_ipaddr4_to_string(const __u8 *addr, char *buf)
F
Frank Blaschka 已提交
50
{
51
	sprintf(buf, "%pI4", addr);
F
Frank Blaschka 已提交
52 53
}

54
static void qeth_l3_ipaddr6_to_string(const __u8 *addr, char *buf)
F
Frank Blaschka 已提交
55
{
J
Joe Perches 已提交
56
	sprintf(buf, "%pI6", addr);
F
Frank Blaschka 已提交
57 58 59 60 61 62 63 64 65 66 67
}

void qeth_l3_ipaddr_to_string(enum qeth_prot_versions proto, const __u8 *addr,
				char *buf)
{
	if (proto == QETH_PROT_IPV4)
		qeth_l3_ipaddr4_to_string(addr, buf);
	else if (proto == QETH_PROT_IPV6)
		qeth_l3_ipaddr6_to_string(addr, buf);
}

68
static struct qeth_ipaddr *qeth_l3_get_addr_buffer(enum qeth_prot_versions prot)
69 70 71 72 73 74 75 76
{
	struct qeth_ipaddr *addr = kmalloc(sizeof(*addr), GFP_ATOMIC);

	if (addr)
		qeth_l3_init_ipaddr(addr, QETH_IP_TYPE_NORMAL, prot);
	return addr;
}

77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94
static struct qeth_ipaddr *qeth_l3_find_addr_by_ip(struct qeth_card *card,
						   struct qeth_ipaddr *query)
{
	u64 key = qeth_l3_ipaddr_hash(query);
	struct qeth_ipaddr *addr;

	if (query->is_multicast) {
		hash_for_each_possible(card->ip_mc_htable, addr, hnode, key)
			if (qeth_l3_addr_match_ip(addr, query))
				return addr;
	} else {
		hash_for_each_possible(card->ip_htable,  addr, hnode, key)
			if (qeth_l3_addr_match_ip(addr, query))
				return addr;
	}
	return NULL;
}

F
Frank Blaschka 已提交
95 96 97 98 99 100 101 102 103 104 105 106 107 108
static void qeth_l3_convert_addr_to_bits(u8 *addr, u8 *bits, int len)
{
	int i, j;
	u8 octet;

	for (i = 0; i < len; ++i) {
		octet = addr[i];
		for (j = 7; j >= 0; --j) {
			bits[i*8 + j] = octet & 1;
			octet >>= 1;
		}
	}
}

109 110
static bool qeth_l3_is_addr_covered_by_ipato(struct qeth_card *card,
					     struct qeth_ipaddr *addr)
F
Frank Blaschka 已提交
111 112 113 114 115 116 117
{
	struct qeth_ipato_entry *ipatoe;
	u8 addr_bits[128] = {0, };
	u8 ipatoe_bits[128] = {0, };
	int rc = 0;

	if (!card->ipato.enabled)
118
		return false;
119
	if (addr->type != QETH_IP_TYPE_NORMAL)
120
		return false;
F
Frank Blaschka 已提交
121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147

	qeth_l3_convert_addr_to_bits((u8 *) &addr->u, addr_bits,
				  (addr->proto == QETH_PROT_IPV4)? 4:16);
	list_for_each_entry(ipatoe, &card->ipato.entries, entry) {
		if (addr->proto != ipatoe->proto)
			continue;
		qeth_l3_convert_addr_to_bits(ipatoe->addr, ipatoe_bits,
					  (ipatoe->proto == QETH_PROT_IPV4) ?
					  4 : 16);
		if (addr->proto == QETH_PROT_IPV4)
			rc = !memcmp(addr_bits, ipatoe_bits,
				     min(32, ipatoe->mask_bits));
		else
			rc = !memcmp(addr_bits, ipatoe_bits,
				     min(128, ipatoe->mask_bits));
		if (rc)
			break;
	}
	/* invert? */
	if ((addr->proto == QETH_PROT_IPV4) && card->ipato.invert4)
		rc = !rc;
	else if ((addr->proto == QETH_PROT_IPV6) && card->ipato.invert6)
		rc = !rc;

	return rc;
}

148 149
static int qeth_l3_delete_ip(struct qeth_card *card,
			     struct qeth_ipaddr *tmp_addr)
F
Frank Blaschka 已提交
150 151
{
	int rc = 0;
152
	struct qeth_ipaddr *addr;
F
Frank Blaschka 已提交
153

154 155 156 157 158 159
	if (tmp_addr->type == QETH_IP_TYPE_RXIP)
		QETH_CARD_TEXT(card, 2, "delrxip");
	else if (tmp_addr->type == QETH_IP_TYPE_VIPA)
		QETH_CARD_TEXT(card, 2, "delvipa");
	else
		QETH_CARD_TEXT(card, 2, "delip");
F
Frank Blaschka 已提交
160

161 162
	if (tmp_addr->proto == QETH_PROT_IPV4)
		QETH_CARD_HEX(card, 4, &tmp_addr->u.a4.addr, 4);
F
Frank Blaschka 已提交
163
	else {
164 165
		QETH_CARD_HEX(card, 4, &tmp_addr->u.a6.addr, 8);
		QETH_CARD_HEX(card, 4, ((char *)&tmp_addr->u.a6.addr) + 8, 8);
F
Frank Blaschka 已提交
166
	}
167

168 169
	addr = qeth_l3_find_addr_by_ip(card, tmp_addr);
	if (!addr || !qeth_l3_addr_match_all(addr, tmp_addr))
170 171 172
		return -ENOENT;

	addr->ref_counter--;
173
	if (addr->type == QETH_IP_TYPE_NORMAL && addr->ref_counter > 0)
174 175 176 177
		return rc;
	if (addr->in_progress)
		return -EINPROGRESS;

178 179
	if (qeth_card_hw_is_reachable(card))
		rc = qeth_l3_deregister_addr_entry(card, addr);
180 181 182 183

	hash_del(&addr->hnode);
	kfree(addr);

F
Frank Blaschka 已提交
184 185 186
	return rc;
}

187
static int qeth_l3_add_ip(struct qeth_card *card, struct qeth_ipaddr *tmp_addr)
F
Frank Blaschka 已提交
188 189
{
	int rc = 0;
190
	struct qeth_ipaddr *addr;
191
	char buf[40];
F
Frank Blaschka 已提交
192

193 194 195 196 197 198
	if (tmp_addr->type == QETH_IP_TYPE_RXIP)
		QETH_CARD_TEXT(card, 2, "addrxip");
	else if (tmp_addr->type == QETH_IP_TYPE_VIPA)
		QETH_CARD_TEXT(card, 2, "addvipa");
	else
		QETH_CARD_TEXT(card, 2, "addip");
199 200 201

	if (tmp_addr->proto == QETH_PROT_IPV4)
		QETH_CARD_HEX(card, 4, &tmp_addr->u.a4.addr, 4);
F
Frank Blaschka 已提交
202
	else {
203 204 205 206
		QETH_CARD_HEX(card, 4, &tmp_addr->u.a6.addr, 8);
		QETH_CARD_HEX(card, 4, ((char *)&tmp_addr->u.a6.addr) + 8, 8);
	}

207 208 209 210 211 212 213 214 215 216 217 218 219 220
	addr = qeth_l3_find_addr_by_ip(card, tmp_addr);
	if (addr) {
		if (tmp_addr->type != QETH_IP_TYPE_NORMAL)
			return -EADDRINUSE;
		if (qeth_l3_addr_match_all(addr, tmp_addr)) {
			addr->ref_counter++;
			return 0;
		}
		qeth_l3_ipaddr_to_string(tmp_addr->proto, (u8 *)&tmp_addr->u,
					 buf);
		dev_warn(&card->gdev->dev,
			 "Registering IP address %s failed\n", buf);
		return -EADDRINUSE;
	} else {
221 222 223 224 225 226 227
		addr = qeth_l3_get_addr_buffer(tmp_addr->proto);
		if (!addr)
			return -ENOMEM;

		memcpy(addr, tmp_addr, sizeof(struct qeth_ipaddr));
		addr->ref_counter = 1;

228
		if (qeth_l3_is_addr_covered_by_ipato(card, addr)) {
229
			QETH_CARD_TEXT(card, 2, "tkovaddr");
230
			addr->ipato = 1;
231 232 233 234
		}
		hash_add(card->ip_htable, &addr->hnode,
				qeth_l3_ipaddr_hash(addr));

235 236 237 238 239
		if (!qeth_card_hw_is_reachable(card)) {
			addr->disp_flag = QETH_DISP_ADDR_ADD;
			return 0;
		}

240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255
		/* qeth_l3_register_addr_entry can go to sleep
		 * if we add a IPV4 addr. It is caused by the reason
		 * that SETIP ipa cmd starts ARP staff for IPV4 addr.
		 * Thus we should unlock spinlock, and make a protection
		 * using in_progress variable to indicate that there is
		 * an hardware operation with this IPV4 address
		 */
		if (addr->proto == QETH_PROT_IPV4) {
			addr->in_progress = 1;
			spin_unlock_bh(&card->ip_lock);
			rc = qeth_l3_register_addr_entry(card, addr);
			spin_lock_bh(&card->ip_lock);
			addr->in_progress = 0;
		} else
			rc = qeth_l3_register_addr_entry(card, addr);

256
		if (!rc || rc == -EADDRINUSE || rc == -ENETDOWN) {
257 258
			addr->disp_flag = QETH_DISP_ADDR_DO_NOTHING;
			if (addr->ref_counter < 1) {
259 260
				qeth_l3_deregister_addr_entry(card, addr);
				hash_del(&addr->hnode);
261 262 263 264 265 266
				kfree(addr);
			}
		} else {
			hash_del(&addr->hnode);
			kfree(addr);
		}
F
Frank Blaschka 已提交
267 268 269 270
	}
	return rc;
}

271
static void qeth_l3_clear_ip_htable(struct qeth_card *card, int recover)
F
Frank Blaschka 已提交
272 273
{
	struct qeth_ipaddr *addr;
274 275
	struct hlist_node *tmp;
	int i;
F
Frank Blaschka 已提交
276

277
	QETH_CARD_TEXT(card, 4, "clearip");
F
Frank Blaschka 已提交
278

279 280 281 282 283 284
	spin_lock_bh(&card->ip_lock);

	hash_for_each_safe(card->ip_htable, i, tmp, addr, hnode) {
		if (!recover) {
			hash_del(&addr->hnode);
			kfree(addr);
F
Frank Blaschka 已提交
285 286
			continue;
		}
287
		addr->disp_flag = QETH_DISP_ADDR_ADD;
F
Frank Blaschka 已提交
288 289
	}

290
	spin_unlock_bh(&card->ip_lock);
F
Frank Blaschka 已提交
291

292 293 294 295
	spin_lock_bh(&card->mclock);

	hash_for_each_safe(card->ip_mc_htable, i, tmp, addr, hnode) {
		hash_del(&addr->hnode);
F
Frank Blaschka 已提交
296 297 298
		kfree(addr);
	}

299 300
	spin_unlock_bh(&card->mclock);

F
Frank Blaschka 已提交
301

302 303
}
static void qeth_l3_recover_ip(struct qeth_card *card)
F
Frank Blaschka 已提交
304
{
305 306 307 308
	struct qeth_ipaddr *addr;
	struct hlist_node *tmp;
	int i;
	int rc;
F
Frank Blaschka 已提交
309

310
	QETH_CARD_TEXT(card, 4, "recovrip");
311 312 313 314

	spin_lock_bh(&card->ip_lock);

	hash_for_each_safe(card->ip_htable, i, tmp, addr, hnode) {
315
		if (addr->disp_flag == QETH_DISP_ADDR_ADD) {
316 317 318 319 320 321 322 323 324 325 326
			if (addr->proto == QETH_PROT_IPV4) {
				addr->in_progress = 1;
				spin_unlock_bh(&card->ip_lock);
				rc = qeth_l3_register_addr_entry(card, addr);
				spin_lock_bh(&card->ip_lock);
				addr->in_progress = 0;
			} else
				rc = qeth_l3_register_addr_entry(card, addr);

			if (!rc) {
				addr->disp_flag = QETH_DISP_ADDR_DO_NOTHING;
327
				if (addr->ref_counter < 1)
328 329 330 331 332 333 334
					qeth_l3_delete_ip(card, addr);
			} else {
				hash_del(&addr->hnode);
				kfree(addr);
			}
		}
	}
F
Frank Blaschka 已提交
335

336
	spin_unlock_bh(&card->ip_lock);
F
Frank Blaschka 已提交
337 338 339

}

340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358
static int qeth_l3_setdelip_cb(struct qeth_card *card, struct qeth_reply *reply,
			       unsigned long data)
{
	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;

	switch (cmd->hdr.return_code) {
	case IPA_RC_SUCCESS:
		return 0;
	case IPA_RC_DUPLICATE_IP_ADDRESS:
		return -EADDRINUSE;
	case IPA_RC_MC_ADDR_NOT_FOUND:
		return -ENOENT;
	case IPA_RC_LAN_OFFLINE:
		return -ENETDOWN;
	default:
		return -EIO;
	}
}

F
Frank Blaschka 已提交
359 360 361 362 363 364
static int qeth_l3_send_setdelmc(struct qeth_card *card,
			struct qeth_ipaddr *addr, int ipacmd)
{
	struct qeth_cmd_buffer *iob;
	struct qeth_ipa_cmd *cmd;

C
Carsten Otte 已提交
365
	QETH_CARD_TEXT(card, 4, "setdelmc");
F
Frank Blaschka 已提交
366 367

	iob = qeth_get_ipacmd_buffer(card, ipacmd, addr->proto);
368 369
	if (!iob)
		return -ENOMEM;
370
	cmd = __ipa_cmd(iob);
371
	ether_addr_copy(cmd->data.setdelipm.mac, addr->mac);
F
Frank Blaschka 已提交
372 373 374 375 376 377
	if (addr->proto == QETH_PROT_IPV6)
		memcpy(cmd->data.setdelipm.ip6, &addr->u.a6.addr,
		       sizeof(struct in6_addr));
	else
		memcpy(&cmd->data.setdelipm.ip4, &addr->u.a4.addr, 4);

378
	return qeth_send_ipa_cmd(card, iob, qeth_l3_setdelip_cb, NULL);
F
Frank Blaschka 已提交
379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394
}

static void qeth_l3_fill_netmask(u8 *netmask, unsigned int len)
{
	int i, j;
	for (i = 0; i < 16; i++) {
		j = (len) - (i * 8);
		if (j >= 8)
			netmask[i] = 0xff;
		else if (j > 0)
			netmask[i] = (u8)(0xFF00 >> j);
		else
			netmask[i] = 0;
	}
}

395 396 397 398 399 400 401 402 403 404 405 406 407
static u32 qeth_l3_get_setdelip_flags(struct qeth_ipaddr *addr, bool set)
{
	switch (addr->type) {
	case QETH_IP_TYPE_RXIP:
		return (set) ? QETH_IPA_SETIP_TAKEOVER_FLAG : 0;
	case QETH_IP_TYPE_VIPA:
		return (set) ? QETH_IPA_SETIP_VIPA_FLAG :
			       QETH_IPA_DELIP_VIPA_FLAG;
	default:
		return (set && addr->ipato) ? QETH_IPA_SETIP_TAKEOVER_FLAG : 0;
	}
}

F
Frank Blaschka 已提交
408
static int qeth_l3_send_setdelip(struct qeth_card *card,
409 410
				 struct qeth_ipaddr *addr,
				 enum qeth_ipa_cmds ipacmd)
F
Frank Blaschka 已提交
411 412 413 414
{
	struct qeth_cmd_buffer *iob;
	struct qeth_ipa_cmd *cmd;
	__u8 netmask[16];
415
	u32 flags;
F
Frank Blaschka 已提交
416

C
Carsten Otte 已提交
417
	QETH_CARD_TEXT(card, 4, "setdelip");
F
Frank Blaschka 已提交
418 419

	iob = qeth_get_ipacmd_buffer(card, ipacmd, addr->proto);
420 421
	if (!iob)
		return -ENOMEM;
422
	cmd = __ipa_cmd(iob);
423 424 425 426

	flags = qeth_l3_get_setdelip_flags(addr, ipacmd == IPA_CMD_SETIP);
	QETH_CARD_TEXT_(card, 4, "flags%02X", flags);

F
Frank Blaschka 已提交
427 428 429 430 431 432 433 434 435 436 437 438 439
	if (addr->proto == QETH_PROT_IPV6) {
		memcpy(cmd->data.setdelip6.ip_addr, &addr->u.a6.addr,
		       sizeof(struct in6_addr));
		qeth_l3_fill_netmask(netmask, addr->u.a6.pfxlen);
		memcpy(cmd->data.setdelip6.mask, netmask,
		       sizeof(struct in6_addr));
		cmd->data.setdelip6.flags = flags;
	} else {
		memcpy(cmd->data.setdelip4.ip_addr, &addr->u.a4.addr, 4);
		memcpy(cmd->data.setdelip4.mask, &addr->u.a4.mask, 4);
		cmd->data.setdelip4.flags = flags;
	}

440
	return qeth_send_ipa_cmd(card, iob, qeth_l3_setdelip_cb, NULL);
F
Frank Blaschka 已提交
441 442 443 444 445 446 447 448 449
}

static int qeth_l3_send_setrouting(struct qeth_card *card,
	enum qeth_routing_types type, enum qeth_prot_versions prot)
{
	int rc;
	struct qeth_ipa_cmd *cmd;
	struct qeth_cmd_buffer *iob;

C
Carsten Otte 已提交
450
	QETH_CARD_TEXT(card, 4, "setroutg");
F
Frank Blaschka 已提交
451
	iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SETRTG, prot);
452 453
	if (!iob)
		return -ENOMEM;
454
	cmd = __ipa_cmd(iob);
F
Frank Blaschka 已提交
455 456 457 458 459 460
	cmd->data.setrtg.type = (type);
	rc = qeth_send_ipa_cmd(card, iob, NULL, NULL);

	return rc;
}

461
static int qeth_l3_correct_routing_type(struct qeth_card *card,
F
Frank Blaschka 已提交
462 463 464 465 466 467 468 469
		enum qeth_routing_types *type, enum qeth_prot_versions prot)
{
	if (card->info.type == QETH_CARD_TYPE_IQD) {
		switch (*type) {
		case NO_ROUTER:
		case PRIMARY_CONNECTOR:
		case SECONDARY_CONNECTOR:
		case MULTICAST_ROUTER:
470
			return 0;
F
Frank Blaschka 已提交
471 472 473 474 475 476 477 478
		default:
			goto out_inval;
		}
	} else {
		switch (*type) {
		case NO_ROUTER:
		case PRIMARY_ROUTER:
		case SECONDARY_ROUTER:
479
			return 0;
F
Frank Blaschka 已提交
480 481 482
		case MULTICAST_ROUTER:
			if (qeth_is_ipafunc_supported(card, prot,
						      IPA_OSA_MC_ROUTER))
483
				return 0;
F
Frank Blaschka 已提交
484 485 486 487 488 489
		default:
			goto out_inval;
		}
	}
out_inval:
	*type = NO_ROUTER;
490
	return -EINVAL;
F
Frank Blaschka 已提交
491 492 493 494 495 496
}

int qeth_l3_setrouting_v4(struct qeth_card *card)
{
	int rc;

C
Carsten Otte 已提交
497
	QETH_CARD_TEXT(card, 3, "setrtg4");
F
Frank Blaschka 已提交
498

499
	rc = qeth_l3_correct_routing_type(card, &card->options.route4.type,
F
Frank Blaschka 已提交
500
				  QETH_PROT_IPV4);
501 502
	if (rc)
		return rc;
F
Frank Blaschka 已提交
503 504 505 506 507

	rc = qeth_l3_send_setrouting(card, card->options.route4.type,
				  QETH_PROT_IPV4);
	if (rc) {
		card->options.route4.type = NO_ROUTER;
508 509
		QETH_DBF_MESSAGE(2, "Error (%#06x) while setting routing type on device %x. Type set to 'no router'.\n",
				 rc, CARD_DEVID(card));
F
Frank Blaschka 已提交
510 511 512 513 514 515 516 517
	}
	return rc;
}

int qeth_l3_setrouting_v6(struct qeth_card *card)
{
	int rc = 0;

C
Carsten Otte 已提交
518
	QETH_CARD_TEXT(card, 3, "setrtg6");
F
Frank Blaschka 已提交
519 520 521

	if (!qeth_is_supported(card, IPA_IPV6))
		return 0;
522
	rc = qeth_l3_correct_routing_type(card, &card->options.route6.type,
F
Frank Blaschka 已提交
523
				  QETH_PROT_IPV6);
524 525
	if (rc)
		return rc;
F
Frank Blaschka 已提交
526 527 528 529 530

	rc = qeth_l3_send_setrouting(card, card->options.route6.type,
				  QETH_PROT_IPV6);
	if (rc) {
		card->options.route6.type = NO_ROUTER;
531 532
		QETH_DBF_MESSAGE(2, "Error (%#06x) while setting routing type on device %x. Type set to 'no router'.\n",
				 rc, CARD_DEVID(card));
F
Frank Blaschka 已提交
533 534 535 536 537 538 539
	}
	return rc;
}

/*
 * IP address takeover related functions
 */
540 541 542 543 544 545 546 547 548 549 550 551 552 553

/**
 * qeth_l3_update_ipato() - Update 'takeover' property, for all NORMAL IPs.
 *
 * Caller must hold ip_lock.
 */
void qeth_l3_update_ipato(struct qeth_card *card)
{
	struct qeth_ipaddr *addr;
	unsigned int i;

	hash_for_each(card->ip_htable, i, addr, hnode) {
		if (addr->type != QETH_IP_TYPE_NORMAL)
			continue;
554
		addr->ipato = qeth_l3_is_addr_covered_by_ipato(card, addr);
555 556 557
	}
}

F
Frank Blaschka 已提交
558 559 560 561
static void qeth_l3_clear_ipato_list(struct qeth_card *card)
{
	struct qeth_ipato_entry *ipatoe, *tmp;

562 563
	spin_lock_bh(&card->ip_lock);

F
Frank Blaschka 已提交
564 565 566 567
	list_for_each_entry_safe(ipatoe, tmp, &card->ipato.entries, entry) {
		list_del(&ipatoe->entry);
		kfree(ipatoe);
	}
568

569
	qeth_l3_update_ipato(card);
570
	spin_unlock_bh(&card->ip_lock);
F
Frank Blaschka 已提交
571 572 573 574 575 576 577 578
}

int qeth_l3_add_ipato_entry(struct qeth_card *card,
				struct qeth_ipato_entry *new)
{
	struct qeth_ipato_entry *ipatoe;
	int rc = 0;

C
Carsten Otte 已提交
579
	QETH_CARD_TEXT(card, 2, "addipato");
580 581 582

	spin_lock_bh(&card->ip_lock);

F
Frank Blaschka 已提交
583 584 585 586 587 588 589 590 591 592
	list_for_each_entry(ipatoe, &card->ipato.entries, entry) {
		if (ipatoe->proto != new->proto)
			continue;
		if (!memcmp(ipatoe->addr, new->addr,
			    (ipatoe->proto == QETH_PROT_IPV4)? 4:16) &&
		    (ipatoe->mask_bits == new->mask_bits)) {
			rc = -EEXIST;
			break;
		}
	}
593

594
	if (!rc) {
F
Frank Blaschka 已提交
595
		list_add_tail(&new->entry, &card->ipato.entries);
596 597
		qeth_l3_update_ipato(card);
	}
F
Frank Blaschka 已提交
598

599 600
	spin_unlock_bh(&card->ip_lock);

F
Frank Blaschka 已提交
601 602 603
	return rc;
}

604 605 606
int qeth_l3_del_ipato_entry(struct qeth_card *card,
			    enum qeth_prot_versions proto, u8 *addr,
			    int mask_bits)
F
Frank Blaschka 已提交
607 608
{
	struct qeth_ipato_entry *ipatoe, *tmp;
609
	int rc = -ENOENT;
F
Frank Blaschka 已提交
610

C
Carsten Otte 已提交
611
	QETH_CARD_TEXT(card, 2, "delipato");
612 613 614

	spin_lock_bh(&card->ip_lock);

F
Frank Blaschka 已提交
615 616 617 618 619 620 621
	list_for_each_entry_safe(ipatoe, tmp, &card->ipato.entries, entry) {
		if (ipatoe->proto != proto)
			continue;
		if (!memcmp(ipatoe->addr, addr,
			    (proto == QETH_PROT_IPV4)? 4:16) &&
		    (ipatoe->mask_bits == mask_bits)) {
			list_del(&ipatoe->entry);
622
			qeth_l3_update_ipato(card);
F
Frank Blaschka 已提交
623
			kfree(ipatoe);
624
			rc = 0;
F
Frank Blaschka 已提交
625 626
		}
	}
627 628

	spin_unlock_bh(&card->ip_lock);
629
	return rc;
F
Frank Blaschka 已提交
630 631
}

632 633 634
int qeth_l3_modify_rxip_vipa(struct qeth_card *card, bool add, const u8 *ip,
			     enum qeth_ip_types type,
			     enum qeth_prot_versions proto)
F
Frank Blaschka 已提交
635
{
636
	struct qeth_ipaddr addr;
637
	int rc;
F
Frank Blaschka 已提交
638

639 640 641 642 643
	qeth_l3_init_ipaddr(&addr, type, proto);
	if (proto == QETH_PROT_IPV4)
		memcpy(&addr.u.a4.addr, ip, 4);
	else
		memcpy(&addr.u.a6.addr, ip, 16);
644 645

	spin_lock_bh(&card->ip_lock);
646
	rc = add ? qeth_l3_add_ip(card, &addr) : qeth_l3_delete_ip(card, &addr);
647 648
	spin_unlock_bh(&card->ip_lock);
	return rc;
F
Frank Blaschka 已提交
649 650
}

651
int qeth_l3_modify_hsuid(struct qeth_card *card, bool add)
F
Frank Blaschka 已提交
652
{
653 654
	struct qeth_ipaddr addr;
	int rc, i;
F
Frank Blaschka 已提交
655

656 657 658 659 660
	qeth_l3_init_ipaddr(&addr, QETH_IP_TYPE_NORMAL, QETH_PROT_IPV6);
	addr.u.a6.addr.s6_addr[0] = 0xfe;
	addr.u.a6.addr.s6_addr[1] = 0x80;
	for (i = 0; i < 8; i++)
		addr.u.a6.addr.s6_addr[8+i] = card->options.hsuid[i];
661 662

	spin_lock_bh(&card->ip_lock);
663
	rc = add ? qeth_l3_add_ip(card, &addr) : qeth_l3_delete_ip(card, &addr);
664
	spin_unlock_bh(&card->ip_lock);
665
	return rc;
F
Frank Blaschka 已提交
666 667 668 669 670 671 672 673 674
}

static int qeth_l3_register_addr_entry(struct qeth_card *card,
				struct qeth_ipaddr *addr)
{
	char buf[50];
	int rc = 0;
	int cnt = 3;

675 676
	if (card->options.sniffer)
		return 0;
677

F
Frank Blaschka 已提交
678
	if (addr->proto == QETH_PROT_IPV4) {
C
Carsten Otte 已提交
679 680
		QETH_CARD_TEXT(card, 2, "setaddr4");
		QETH_CARD_HEX(card, 3, &addr->u.a4.addr, sizeof(int));
F
Frank Blaschka 已提交
681
	} else if (addr->proto == QETH_PROT_IPV6) {
C
Carsten Otte 已提交
682 683 684
		QETH_CARD_TEXT(card, 2, "setaddr6");
		QETH_CARD_HEX(card, 3, &addr->u.a6.addr, 8);
		QETH_CARD_HEX(card, 3, ((char *)&addr->u.a6.addr) + 8, 8);
F
Frank Blaschka 已提交
685
	} else {
C
Carsten Otte 已提交
686 687
		QETH_CARD_TEXT(card, 2, "setaddr?");
		QETH_CARD_HEX(card, 3, addr, sizeof(struct qeth_ipaddr));
F
Frank Blaschka 已提交
688 689 690 691 692
	}
	do {
		if (addr->is_multicast)
			rc =  qeth_l3_send_setdelmc(card, addr, IPA_CMD_SETIPM);
		else
693
			rc = qeth_l3_send_setdelip(card, addr, IPA_CMD_SETIP);
F
Frank Blaschka 已提交
694
		if (rc)
C
Carsten Otte 已提交
695
			QETH_CARD_TEXT(card, 2, "failed");
F
Frank Blaschka 已提交
696 697
	} while ((--cnt > 0) && rc);
	if (rc) {
C
Carsten Otte 已提交
698
		QETH_CARD_TEXT(card, 2, "FAILED");
F
Frank Blaschka 已提交
699
		qeth_l3_ipaddr_to_string(addr->proto, (u8 *)&addr->u, buf);
700 701
		dev_warn(&card->gdev->dev,
			"Registering IP address %s failed\n", buf);
F
Frank Blaschka 已提交
702 703 704 705 706 707 708 709 710
	}
	return rc;
}

static int qeth_l3_deregister_addr_entry(struct qeth_card *card,
						struct qeth_ipaddr *addr)
{
	int rc = 0;

711 712 713
	if (card->options.sniffer)
		return 0;

F
Frank Blaschka 已提交
714
	if (addr->proto == QETH_PROT_IPV4) {
C
Carsten Otte 已提交
715 716
		QETH_CARD_TEXT(card, 2, "deladdr4");
		QETH_CARD_HEX(card, 3, &addr->u.a4.addr, sizeof(int));
F
Frank Blaschka 已提交
717
	} else if (addr->proto == QETH_PROT_IPV6) {
C
Carsten Otte 已提交
718 719 720
		QETH_CARD_TEXT(card, 2, "deladdr6");
		QETH_CARD_HEX(card, 3, &addr->u.a6.addr, 8);
		QETH_CARD_HEX(card, 3, ((char *)&addr->u.a6.addr) + 8, 8);
F
Frank Blaschka 已提交
721
	} else {
C
Carsten Otte 已提交
722 723
		QETH_CARD_TEXT(card, 2, "deladdr?");
		QETH_CARD_HEX(card, 3, addr, sizeof(struct qeth_ipaddr));
F
Frank Blaschka 已提交
724 725 726 727
	}
	if (addr->is_multicast)
		rc = qeth_l3_send_setdelmc(card, addr, IPA_CMD_DELIPM);
	else
728
		rc = qeth_l3_send_setdelip(card, addr, IPA_CMD_DELIP);
729
	if (rc)
C
Carsten Otte 已提交
730
		QETH_CARD_TEXT(card, 2, "failed");
F
Frank Blaschka 已提交
731 732 733 734 735 736

	return rc;
}

static int qeth_l3_setadapter_parms(struct qeth_card *card)
{
737
	int rc = 0;
F
Frank Blaschka 已提交
738

739
	QETH_DBF_TEXT(SETUP, 2, "setadprm");
F
Frank Blaschka 已提交
740 741 742 743

	if (qeth_adp_supported(card, IPA_SETADP_ALTER_MAC_ADDRESS)) {
		rc = qeth_setadpparms_change_macaddr(card);
		if (rc)
744
			dev_warn(&card->gdev->dev, "Reading the adapter MAC"
745
				" address failed\n");
F
Frank Blaschka 已提交
746 747 748 749 750 751 752 753 754
	}

	return rc;
}

static int qeth_l3_start_ipa_arp_processing(struct qeth_card *card)
{
	int rc;

C
Carsten Otte 已提交
755
	QETH_CARD_TEXT(card, 3, "ipaarp");
F
Frank Blaschka 已提交
756 757

	if (!qeth_is_supported(card, IPA_ARP_PROCESSING)) {
758 759 760
		dev_info(&card->gdev->dev,
			"ARP processing not supported on %s!\n",
			QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
761 762
		return 0;
	}
763 764
	rc = qeth_send_simple_setassparms(card, IPA_ARP_PROCESSING,
					  IPA_CMD_ASS_START, 0);
F
Frank Blaschka 已提交
765
	if (rc) {
766 767 768
		dev_warn(&card->gdev->dev,
			"Starting ARP processing support for %s failed\n",
			QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
769 770 771 772 773 774 775 776
	}
	return rc;
}

static int qeth_l3_start_ipa_source_mac(struct qeth_card *card)
{
	int rc;

C
Carsten Otte 已提交
777
	QETH_CARD_TEXT(card, 3, "stsrcmac");
F
Frank Blaschka 已提交
778 779

	if (!qeth_is_supported(card, IPA_SOURCE_MAC)) {
780
		dev_info(&card->gdev->dev,
781
			"Inbound source MAC-address not supported on %s\n",
782
			QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
783 784 785
		return -EOPNOTSUPP;
	}

786
	rc = qeth_send_simple_setassparms(card, IPA_SOURCE_MAC,
F
Frank Blaschka 已提交
787 788
					  IPA_CMD_ASS_START, 0);
	if (rc)
789
		dev_warn(&card->gdev->dev,
790
			"Starting source MAC-address support for %s failed\n",
791
			QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
792 793 794 795 796 797 798
	return rc;
}

static int qeth_l3_start_ipa_vlan(struct qeth_card *card)
{
	int rc = 0;

C
Carsten Otte 已提交
799
	QETH_CARD_TEXT(card, 3, "strtvlan");
F
Frank Blaschka 已提交
800 801

	if (!qeth_is_supported(card, IPA_FULL_VLAN)) {
802 803
		dev_info(&card->gdev->dev,
			"VLAN not supported on %s\n", QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
804 805 806
		return -EOPNOTSUPP;
	}

807
	rc = qeth_send_simple_setassparms(card, IPA_VLAN_PRIO,
F
Frank Blaschka 已提交
808 809
					  IPA_CMD_ASS_START, 0);
	if (rc) {
810 811 812
		dev_warn(&card->gdev->dev,
			"Starting VLAN support for %s failed\n",
			QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
813
	} else {
814
		dev_info(&card->gdev->dev, "VLAN enabled\n");
F
Frank Blaschka 已提交
815 816 817 818 819 820 821 822
	}
	return rc;
}

static int qeth_l3_start_ipa_multicast(struct qeth_card *card)
{
	int rc;

C
Carsten Otte 已提交
823
	QETH_CARD_TEXT(card, 3, "stmcast");
F
Frank Blaschka 已提交
824 825

	if (!qeth_is_supported(card, IPA_MULTICASTING)) {
826 827 828
		dev_info(&card->gdev->dev,
			"Multicast not supported on %s\n",
			QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
829 830 831
		return -EOPNOTSUPP;
	}

832
	rc = qeth_send_simple_setassparms(card, IPA_MULTICASTING,
F
Frank Blaschka 已提交
833 834
					  IPA_CMD_ASS_START, 0);
	if (rc) {
835 836 837
		dev_warn(&card->gdev->dev,
			"Starting multicast support for %s failed\n",
			QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
838
	} else {
839
		dev_info(&card->gdev->dev, "Multicast enabled\n");
F
Frank Blaschka 已提交
840 841 842 843 844 845 846 847 848
		card->dev->flags |= IFF_MULTICAST;
	}
	return rc;
}

static int qeth_l3_softsetup_ipv6(struct qeth_card *card)
{
	int rc;

C
Carsten Otte 已提交
849
	QETH_CARD_TEXT(card, 3, "softipv6");
F
Frank Blaschka 已提交
850

851 852 853
	if (card->info.type == QETH_CARD_TYPE_IQD)
		goto out;

854
	rc = qeth_send_simple_setassparms(card, IPA_IPV6,
F
Frank Blaschka 已提交
855 856
					  IPA_CMD_ASS_START, 3);
	if (rc) {
857 858 859
		dev_err(&card->gdev->dev,
			"Activating IPv6 support for %s failed\n",
			QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
860 861
		return rc;
	}
862 863
	rc = qeth_send_simple_setassparms_v6(card, IPA_IPV6,
					     IPA_CMD_ASS_START, 0);
F
Frank Blaschka 已提交
864
	if (rc) {
865 866 867
		dev_err(&card->gdev->dev,
			"Activating IPv6 support for %s failed\n",
			 QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
868 869
		return rc;
	}
870 871
	rc = qeth_send_simple_setassparms_v6(card, IPA_PASSTHRU,
					     IPA_CMD_ASS_START, 0);
F
Frank Blaschka 已提交
872
	if (rc) {
873 874 875
		dev_warn(&card->gdev->dev,
			"Enabling the passthrough mode for %s failed\n",
			QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
876 877 878
		return rc;
	}
out:
879
	dev_info(&card->gdev->dev, "IPV6 enabled\n");
F
Frank Blaschka 已提交
880 881 882 883 884
	return 0;
}

static int qeth_l3_start_ipa_ipv6(struct qeth_card *card)
{
C
Carsten Otte 已提交
885
	QETH_CARD_TEXT(card, 3, "strtipv6");
F
Frank Blaschka 已提交
886 887

	if (!qeth_is_supported(card, IPA_IPV6)) {
888 889
		dev_info(&card->gdev->dev,
			"IPv6 not supported on %s\n", QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
890 891
		return 0;
	}
J
Julian Wiedmann 已提交
892
	return qeth_l3_softsetup_ipv6(card);
F
Frank Blaschka 已提交
893 894 895 896 897 898
}

static int qeth_l3_start_ipa_broadcast(struct qeth_card *card)
{
	int rc;

C
Carsten Otte 已提交
899
	QETH_CARD_TEXT(card, 3, "stbrdcst");
F
Frank Blaschka 已提交
900 901
	card->info.broadcast_capable = 0;
	if (!qeth_is_supported(card, IPA_FILTERING)) {
902 903 904
		dev_info(&card->gdev->dev,
			"Broadcast not supported on %s\n",
			QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
905 906 907
		rc = -EOPNOTSUPP;
		goto out;
	}
908
	rc = qeth_send_simple_setassparms(card, IPA_FILTERING,
F
Frank Blaschka 已提交
909 910
					  IPA_CMD_ASS_START, 0);
	if (rc) {
911 912
		dev_warn(&card->gdev->dev, "Enabling broadcast filtering for "
			"%s failed\n", QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
913 914 915
		goto out;
	}

916
	rc = qeth_send_simple_setassparms(card, IPA_FILTERING,
F
Frank Blaschka 已提交
917 918
					  IPA_CMD_ASS_CONFIGURE, 1);
	if (rc) {
919 920 921
		dev_warn(&card->gdev->dev,
			"Setting up broadcast filtering for %s failed\n",
			QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
922 923 924
		goto out;
	}
	card->info.broadcast_capable = QETH_BROADCAST_WITH_ECHO;
925
	dev_info(&card->gdev->dev, "Broadcast enabled\n");
926
	rc = qeth_send_simple_setassparms(card, IPA_FILTERING,
F
Frank Blaschka 已提交
927 928
					  IPA_CMD_ASS_ENABLE, 1);
	if (rc) {
929 930
		dev_warn(&card->gdev->dev, "Setting up broadcast echo "
			"filtering for %s failed\n", QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
931 932 933 934 935 936 937 938 939 940 941 942 943
		goto out;
	}
	card->info.broadcast_capable = QETH_BROADCAST_WITHOUT_ECHO;
out:
	if (card->info.broadcast_capable)
		card->dev->flags |= IFF_BROADCAST;
	else
		card->dev->flags &= ~IFF_BROADCAST;
	return rc;
}

static int qeth_l3_start_ipassists(struct qeth_card *card)
{
C
Carsten Otte 已提交
944
	QETH_CARD_TEXT(card, 3, "strtipas");
E
Einar Lueck 已提交
945

S
Stefan Raspl 已提交
946 947
	if (qeth_set_access_ctrl_online(card, 0))
		return -EIO;
F
Frank Blaschka 已提交
948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963
	qeth_l3_start_ipa_arp_processing(card);	/* go on*/
	qeth_l3_start_ipa_source_mac(card);	/* go on*/
	qeth_l3_start_ipa_vlan(card);		/* go on*/
	qeth_l3_start_ipa_multicast(card);		/* go on*/
	qeth_l3_start_ipa_ipv6(card);		/* go on*/
	qeth_l3_start_ipa_broadcast(card);		/* go on*/
	return 0;
}

static int qeth_l3_iqd_read_initial_mac_cb(struct qeth_card *card,
		struct qeth_reply *reply, unsigned long data)
{
	struct qeth_ipa_cmd *cmd;

	cmd = (struct qeth_ipa_cmd *) data;
	if (cmd->hdr.return_code == 0)
964 965
		ether_addr_copy(card->dev->dev_addr,
				cmd->data.create_destroy_addr.unique_id);
F
Frank Blaschka 已提交
966 967 968 969 970 971 972 973 974
	return 0;
}

static int qeth_l3_iqd_read_initial_mac(struct qeth_card *card)
{
	int rc = 0;
	struct qeth_cmd_buffer *iob;
	struct qeth_ipa_cmd *cmd;

975
	QETH_DBF_TEXT(SETUP, 2, "hsrmac");
F
Frank Blaschka 已提交
976 977 978

	iob = qeth_get_ipacmd_buffer(card, IPA_CMD_CREATE_ADDR,
				     QETH_PROT_IPV6);
979 980
	if (!iob)
		return -ENOMEM;
981
	cmd = __ipa_cmd(iob);
F
Frank Blaschka 已提交
982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001
	*((__u16 *) &cmd->data.create_destroy_addr.unique_id[6]) =
			card->info.unique_id;

	rc = qeth_send_ipa_cmd(card, iob, qeth_l3_iqd_read_initial_mac_cb,
				NULL);
	return rc;
}

static int qeth_l3_get_unique_id_cb(struct qeth_card *card,
		struct qeth_reply *reply, unsigned long data)
{
	struct qeth_ipa_cmd *cmd;

	cmd = (struct qeth_ipa_cmd *) data;
	if (cmd->hdr.return_code == 0)
		card->info.unique_id = *((__u16 *)
				&cmd->data.create_destroy_addr.unique_id[6]);
	else {
		card->info.unique_id =  UNIQUE_ID_IF_CREATE_ADDR_FAILED |
					UNIQUE_ID_NOT_BY_CARD;
1002 1003
		dev_warn(&card->gdev->dev, "The network adapter failed to "
			"generate a unique ID\n");
F
Frank Blaschka 已提交
1004 1005 1006 1007 1008 1009 1010 1011 1012 1013
	}
	return 0;
}

static int qeth_l3_get_unique_id(struct qeth_card *card)
{
	int rc = 0;
	struct qeth_cmd_buffer *iob;
	struct qeth_ipa_cmd *cmd;

1014
	QETH_DBF_TEXT(SETUP, 2, "guniqeid");
F
Frank Blaschka 已提交
1015 1016 1017 1018 1019 1020 1021 1022 1023

	if (!qeth_is_supported(card, IPA_IPV6)) {
		card->info.unique_id =  UNIQUE_ID_IF_CREATE_ADDR_FAILED |
					UNIQUE_ID_NOT_BY_CARD;
		return 0;
	}

	iob = qeth_get_ipacmd_buffer(card, IPA_CMD_CREATE_ADDR,
				     QETH_PROT_IPV6);
1024 1025
	if (!iob)
		return -ENOMEM;
1026
	cmd = __ipa_cmd(iob);
F
Frank Blaschka 已提交
1027 1028 1029 1030 1031 1032 1033
	*((__u16 *) &cmd->data.create_destroy_addr.unique_id[6]) =
			card->info.unique_id;

	rc = qeth_send_ipa_cmd(card, iob, qeth_l3_get_unique_id_cb, NULL);
	return rc;
}

1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044
static int
qeth_diags_trace_cb(struct qeth_card *card, struct qeth_reply *reply,
			    unsigned long data)
{
	struct qeth_ipa_cmd	   *cmd;
	__u16 rc;

	QETH_DBF_TEXT(SETUP, 2, "diastrcb");

	cmd = (struct qeth_ipa_cmd *)data;
	rc = cmd->hdr.return_code;
1045
	if (rc)
C
Carsten Otte 已提交
1046
		QETH_CARD_TEXT_(card, 2, "dxter%x", rc);
1047 1048 1049 1050
	switch (cmd->data.diagass.action) {
	case QETH_DIAGS_CMD_TRACE_QUERY:
		break;
	case QETH_DIAGS_CMD_TRACE_DISABLE:
1051 1052 1053 1054 1055 1056 1057 1058 1059 1060
		switch (rc) {
		case 0:
		case IPA_RC_INVALID_SUBCMD:
			card->info.promisc_mode = SET_PROMISC_MODE_OFF;
			dev_info(&card->gdev->dev, "The HiperSockets network "
				"traffic analyzer is deactivated\n");
			break;
		default:
			break;
		}
1061 1062
		break;
	case QETH_DIAGS_CMD_TRACE_ENABLE:
1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081
		switch (rc) {
		case 0:
			card->info.promisc_mode = SET_PROMISC_MODE_ON;
			dev_info(&card->gdev->dev, "The HiperSockets network "
				"traffic analyzer is activated\n");
			break;
		case IPA_RC_HARDWARE_AUTH_ERROR:
			dev_warn(&card->gdev->dev, "The device is not "
				"authorized to run as a HiperSockets network "
				"traffic analyzer\n");
			break;
		case IPA_RC_TRACE_ALREADY_ACTIVE:
			dev_warn(&card->gdev->dev, "A HiperSockets "
				"network traffic analyzer is already "
				"active in the HiperSockets LAN\n");
			break;
		default:
			break;
		}
1082 1083
		break;
	default:
1084 1085
		QETH_DBF_MESSAGE(2, "Unknown sniffer action (%#06x) on device %x\n",
				 cmd->data.diagass.action, CARD_DEVID(card));
1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099
	}

	return 0;
}

static int
qeth_diags_trace(struct qeth_card *card, enum qeth_diags_trace_cmds diags_cmd)
{
	struct qeth_cmd_buffer *iob;
	struct qeth_ipa_cmd    *cmd;

	QETH_DBF_TEXT(SETUP, 2, "diagtrac");

	iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SET_DIAG_ASS, 0);
1100 1101
	if (!iob)
		return -ENOMEM;
1102
	cmd = __ipa_cmd(iob);
1103 1104 1105 1106 1107 1108 1109
	cmd->data.diagass.subcmd_len = 16;
	cmd->data.diagass.subcmd = QETH_DIAGS_CMD_TRACE;
	cmd->data.diagass.type = QETH_DIAGS_TYPE_HIPERSOCKET;
	cmd->data.diagass.action = diags_cmd;
	return qeth_send_ipa_cmd(card, iob, qeth_diags_trace_cb, NULL);
}

1110 1111
static void
qeth_l3_add_mc_to_hash(struct qeth_card *card, struct in_device *in4_dev)
F
Frank Blaschka 已提交
1112 1113
{
	struct ip_mc_list *im4;
1114
	struct qeth_ipaddr *tmp, *ipm;
F
Frank Blaschka 已提交
1115

C
Carsten Otte 已提交
1116
	QETH_CARD_TEXT(card, 4, "addmc");
1117 1118

	tmp = qeth_l3_get_addr_buffer(QETH_PROT_IPV4);
1119 1120
	if (!tmp)
		return;
1121

S
Sachin Sant 已提交
1122 1123
	for (im4 = rcu_dereference(in4_dev->mc_list); im4 != NULL;
	     im4 = rcu_dereference(im4->next_rcu)) {
1124
		ip_eth_mc_map(im4->multiaddr, tmp->mac);
1125
		tmp->u.a4.addr = be32_to_cpu(im4->multiaddr);
1126
		tmp->is_multicast = 1;
1127

1128
		ipm = qeth_l3_find_addr_by_ip(card, tmp);
1129
		if (ipm) {
1130
			/* for mcast, by-IP match means full match */
1131 1132 1133 1134 1135
			ipm->disp_flag = QETH_DISP_ADDR_DO_NOTHING;
		} else {
			ipm = qeth_l3_get_addr_buffer(QETH_PROT_IPV4);
			if (!ipm)
				continue;
1136
			ether_addr_copy(ipm->mac, tmp->mac);
1137
			ipm->u.a4.addr = be32_to_cpu(im4->multiaddr);
1138 1139 1140 1141 1142
			ipm->is_multicast = 1;
			ipm->disp_flag = QETH_DISP_ADDR_ADD;
			hash_add(card->ip_mc_htable,
					&ipm->hnode, qeth_l3_ipaddr_hash(ipm));
		}
F
Frank Blaschka 已提交
1143
	}
1144 1145

	kfree(tmp);
F
Frank Blaschka 已提交
1146 1147
}

1148
/* called with rcu_read_lock */
F
Frank Blaschka 已提交
1149 1150 1151
static void qeth_l3_add_vlan_mc(struct qeth_card *card)
{
	struct in_device *in_dev;
J
Jiri Pirko 已提交
1152
	u16 vid;
F
Frank Blaschka 已提交
1153

C
Carsten Otte 已提交
1154
	QETH_CARD_TEXT(card, 4, "addmcvl");
1155

J
Jiri Pirko 已提交
1156
	if (!qeth_is_supported(card, IPA_FULL_VLAN))
F
Frank Blaschka 已提交
1157 1158
		return;

J
Jiri Pirko 已提交
1159 1160 1161
	for_each_set_bit(vid, card->active_vlans, VLAN_N_VID) {
		struct net_device *netdev;

1162
		netdev = __vlan_find_dev_deep_rcu(card->dev, htons(ETH_P_8021Q),
1163
					      vid);
F
Frank Blaschka 已提交
1164 1165 1166
		if (netdev == NULL ||
		    !(netdev->flags & IFF_UP))
			continue;
1167
		in_dev = __in_dev_get_rcu(netdev);
F
Frank Blaschka 已提交
1168 1169
		if (!in_dev)
			continue;
1170
		qeth_l3_add_mc_to_hash(card, in_dev);
F
Frank Blaschka 已提交
1171 1172 1173 1174 1175 1176 1177
	}
}

static void qeth_l3_add_multicast_ipv4(struct qeth_card *card)
{
	struct in_device *in4_dev;

C
Carsten Otte 已提交
1178
	QETH_CARD_TEXT(card, 4, "chkmcv4");
1179

S
Sachin Sant 已提交
1180
	rcu_read_lock();
1181 1182 1183
	in4_dev = __in_dev_get_rcu(card->dev);
	if (in4_dev == NULL)
		goto unlock;
1184
	qeth_l3_add_mc_to_hash(card, in4_dev);
F
Frank Blaschka 已提交
1185
	qeth_l3_add_vlan_mc(card);
1186
unlock:
S
Sachin Sant 已提交
1187
	rcu_read_unlock();
F
Frank Blaschka 已提交
1188 1189
}

J
Julian Wiedmann 已提交
1190 1191
static void qeth_l3_add_mc6_to_hash(struct qeth_card *card,
				    struct inet6_dev *in6_dev)
F
Frank Blaschka 已提交
1192 1193 1194
{
	struct qeth_ipaddr *ipm;
	struct ifmcaddr6 *im6;
1195
	struct qeth_ipaddr *tmp;
F
Frank Blaschka 已提交
1196

C
Carsten Otte 已提交
1197
	QETH_CARD_TEXT(card, 4, "addmc6");
1198 1199

	tmp = qeth_l3_get_addr_buffer(QETH_PROT_IPV6);
1200 1201
	if (!tmp)
		return;
1202

F
Frank Blaschka 已提交
1203
	for (im6 = in6_dev->mc_list; im6 != NULL; im6 = im6->next) {
1204
		ipv6_eth_mc_map(&im6->mca_addr, tmp->mac);
1205 1206 1207 1208
		memcpy(&tmp->u.a6.addr, &im6->mca_addr.s6_addr,
		       sizeof(struct in6_addr));
		tmp->is_multicast = 1;

1209
		ipm = qeth_l3_find_addr_by_ip(card, tmp);
1210
		if (ipm) {
1211
			/* for mcast, by-IP match means full match */
1212 1213 1214 1215
			ipm->disp_flag = QETH_DISP_ADDR_DO_NOTHING;
			continue;
		}

F
Frank Blaschka 已提交
1216 1217 1218
		ipm = qeth_l3_get_addr_buffer(QETH_PROT_IPV6);
		if (!ipm)
			continue;
1219

1220
		ether_addr_copy(ipm->mac, tmp->mac);
F
Frank Blaschka 已提交
1221 1222
		memcpy(&ipm->u.a6.addr, &im6->mca_addr.s6_addr,
		       sizeof(struct in6_addr));
1223 1224 1225 1226 1227
		ipm->is_multicast = 1;
		ipm->disp_flag = QETH_DISP_ADDR_ADD;
		hash_add(card->ip_mc_htable,
				&ipm->hnode, qeth_l3_ipaddr_hash(ipm));

F
Frank Blaschka 已提交
1228
	}
1229
	kfree(tmp);
F
Frank Blaschka 已提交
1230 1231
}

1232
/* called with rcu_read_lock */
F
Frank Blaschka 已提交
1233 1234 1235
static void qeth_l3_add_vlan_mc6(struct qeth_card *card)
{
	struct inet6_dev *in_dev;
J
Jiri Pirko 已提交
1236
	u16 vid;
F
Frank Blaschka 已提交
1237

C
Carsten Otte 已提交
1238
	QETH_CARD_TEXT(card, 4, "admc6vl");
1239

J
Jiri Pirko 已提交
1240
	if (!qeth_is_supported(card, IPA_FULL_VLAN))
F
Frank Blaschka 已提交
1241 1242
		return;

J
Jiri Pirko 已提交
1243 1244 1245
	for_each_set_bit(vid, card->active_vlans, VLAN_N_VID) {
		struct net_device *netdev;

1246
		netdev = __vlan_find_dev_deep_rcu(card->dev, htons(ETH_P_8021Q),
1247
					      vid);
F
Frank Blaschka 已提交
1248 1249 1250 1251 1252 1253 1254
		if (netdev == NULL ||
		    !(netdev->flags & IFF_UP))
			continue;
		in_dev = in6_dev_get(netdev);
		if (!in_dev)
			continue;
		read_lock_bh(&in_dev->lock);
1255
		qeth_l3_add_mc6_to_hash(card, in_dev);
F
Frank Blaschka 已提交
1256 1257 1258 1259 1260 1261 1262 1263 1264
		read_unlock_bh(&in_dev->lock);
		in6_dev_put(in_dev);
	}
}

static void qeth_l3_add_multicast_ipv6(struct qeth_card *card)
{
	struct inet6_dev *in6_dev;

C
Carsten Otte 已提交
1265
	QETH_CARD_TEXT(card, 4, "chkmcv6");
1266

F
Frank Blaschka 已提交
1267 1268 1269
	if (!qeth_is_supported(card, IPA_IPV6))
		return ;
	in6_dev = in6_dev_get(card->dev);
1270
	if (!in6_dev)
F
Frank Blaschka 已提交
1271
		return;
1272

1273
	rcu_read_lock();
F
Frank Blaschka 已提交
1274
	read_lock_bh(&in6_dev->lock);
1275
	qeth_l3_add_mc6_to_hash(card, in6_dev);
F
Frank Blaschka 已提交
1276 1277
	qeth_l3_add_vlan_mc6(card);
	read_unlock_bh(&in6_dev->lock);
1278
	rcu_read_unlock();
F
Frank Blaschka 已提交
1279 1280 1281
	in6_dev_put(in6_dev);
}

1282 1283
static int qeth_l3_vlan_rx_add_vid(struct net_device *dev,
				   __be16 proto, u16 vid)
F
Frank Blaschka 已提交
1284
{
1285
	struct qeth_card *card = dev->ml_priv;
F
Frank Blaschka 已提交
1286

J
Jiri Pirko 已提交
1287
	set_bit(vid, card->active_vlans);
1288
	return 0;
F
Frank Blaschka 已提交
1289 1290
}

1291 1292
static int qeth_l3_vlan_rx_kill_vid(struct net_device *dev,
				    __be16 proto, u16 vid)
F
Frank Blaschka 已提交
1293
{
1294
	struct qeth_card *card = dev->ml_priv;
F
Frank Blaschka 已提交
1295

C
Carsten Otte 已提交
1296
	QETH_CARD_TEXT_(card, 4, "kid:%d", vid);
1297

J
Jiri Pirko 已提交
1298
	clear_bit(vid, card->active_vlans);
1299
	qeth_l3_set_rx_mode(dev);
1300
	return 0;
F
Frank Blaschka 已提交
1301 1302
}

1303 1304
static void qeth_l3_rebuild_skb(struct qeth_card *card, struct sk_buff *skb,
				struct qeth_hdr *hdr)
F
Frank Blaschka 已提交
1305 1306
{
	if (!(hdr->hdr.l3.flags & QETH_HDR_PASSTHRU)) {
1307 1308
		u16 prot = (hdr->hdr.l3.flags & QETH_HDR_IPV6) ? ETH_P_IPV6 :
								 ETH_P_IP;
1309
		unsigned char tg_addr[ETH_ALEN];
1310 1311

		skb_reset_network_header(skb);
F
Frank Blaschka 已提交
1312 1313
		switch (hdr->hdr.l3.flags & QETH_HDR_CAST_MASK) {
		case QETH_CAST_MULTICAST:
J
Julian Wiedmann 已提交
1314
			if (prot == ETH_P_IP)
1315
				ip_eth_mc_map(ip_hdr(skb)->daddr, tg_addr);
J
Julian Wiedmann 已提交
1316 1317 1318
			else
				ipv6_eth_mc_map(&ipv6_hdr(skb)->daddr, tg_addr);

F
Frank Blaschka 已提交
1319 1320 1321
			card->stats.multicast++;
			break;
		case QETH_CAST_BROADCAST:
1322
			ether_addr_copy(tg_addr, card->dev->broadcast);
F
Frank Blaschka 已提交
1323 1324 1325
			card->stats.multicast++;
			break;
		default:
1326 1327
			if (card->options.sniffer)
				skb->pkt_type = PACKET_OTHERHOST;
1328
			ether_addr_copy(tg_addr, card->dev->dev_addr);
F
Frank Blaschka 已提交
1329
		}
J
Julian Wiedmann 已提交
1330

1331 1332
		if (hdr->hdr.l3.ext_flags & QETH_HDR_EXT_SRC_MAC_ADDR)
			card->dev->header_ops->create(skb, card->dev, prot,
1333
				tg_addr, &hdr->hdr.l3.next_hop.rx.src_mac,
1334
				skb->len);
1335 1336
		else
			card->dev->header_ops->create(skb, card->dev, prot,
1337
				tg_addr, "FAKELL", skb->len);
F
Frank Blaschka 已提交
1338 1339
	}

1340
	skb->protocol = eth_type_trans(skb, card->dev);
F
Frank Blaschka 已提交
1341

1342 1343 1344 1345 1346 1347
	/* copy VLAN tag from hdr into skb */
	if (!card->options.sniffer &&
	    (hdr->hdr.l3.ext_flags & (QETH_HDR_EXT_VLAN_FRAME |
				      QETH_HDR_EXT_INCLUDE_VLAN_TAG))) {
		u16 tag = (hdr->hdr.l3.ext_flags & QETH_HDR_EXT_VLAN_FRAME) ?
				hdr->hdr.l3.vlan_id :
1348
				hdr->hdr.l3.next_hop.rx.vlan_id;
1349
		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), tag);
F
Frank Blaschka 已提交
1350 1351
	}

1352
	qeth_rx_csum(card, skb, hdr->hdr.l3.ext_flags);
F
Frank Blaschka 已提交
1353 1354
}

1355 1356
static int qeth_l3_process_inbound_buffer(struct qeth_card *card,
				int budget, int *done)
F
Frank Blaschka 已提交
1357
{
1358
	struct net_device *dev = card->dev;
1359
	int work_done = 0;
F
Frank Blaschka 已提交
1360 1361 1362
	struct sk_buff *skb;
	struct qeth_hdr *hdr;
	unsigned int len;
1363
	__u16 magic;
F
Frank Blaschka 已提交
1364

1365
	*done = 0;
S
Stefan Raspl 已提交
1366
	WARN_ON_ONCE(!budget);
1367 1368
	while (budget) {
		skb = qeth_core_get_next_skb(card,
1369
			&card->qdio.in_q->bufs[card->rx.b_index],
1370 1371 1372 1373 1374
			&card->rx.b_element, &card->rx.e_offset, &hdr);
		if (!skb) {
			*done = 1;
			break;
		}
F
Frank Blaschka 已提交
1375 1376
		switch (hdr->hdr.l3.id) {
		case QETH_HEADER_TYPE_LAYER3:
1377 1378 1379 1380
			magic = *(__u16 *)skb->data;
			if ((card->info.type == QETH_CARD_TYPE_IQD) &&
			    (magic == ETH_P_AF_IUCV)) {
				len = skb->len;
1381 1382 1383
				dev_hard_header(skb, dev, ETH_P_AF_IUCV,
						dev->dev_addr, "FAKELL", len);
				skb->protocol = eth_type_trans(skb, dev);
1384 1385
				netif_receive_skb(skb);
			} else {
1386
				qeth_l3_rebuild_skb(card, skb, hdr);
1387 1388 1389
				len = skb->len;
				napi_gro_receive(&card->napi, skb);
			}
F
Frank Blaschka 已提交
1390
			break;
1391 1392 1393 1394 1395
		case QETH_HEADER_TYPE_LAYER2: /* for HiperSockets sniffer */
			skb->protocol = eth_type_trans(skb, skb->dev);
			len = skb->len;
			netif_receive_skb(skb);
			break;
F
Frank Blaschka 已提交
1396 1397
		default:
			dev_kfree_skb_any(skb);
C
Carsten Otte 已提交
1398
			QETH_CARD_TEXT(card, 3, "inbunkno");
1399
			QETH_DBF_HEX(CTRL, 3, hdr, sizeof(*hdr));
F
Frank Blaschka 已提交
1400 1401
			continue;
		}
1402 1403
		work_done++;
		budget--;
F
Frank Blaschka 已提交
1404 1405 1406
		card->stats.rx_packets++;
		card->stats.rx_bytes += len;
	}
1407 1408 1409
	return work_done;
}

1410
static void qeth_l3_stop_card(struct qeth_card *card, int recovery_mode)
F
Frank Blaschka 已提交
1411
{
1412 1413
	QETH_DBF_TEXT(SETUP, 2, "stopcard");
	QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
F
Frank Blaschka 已提交
1414 1415

	qeth_set_allowed_threads(card, 0, 1);
1416 1417 1418
	if (card->options.sniffer &&
	    (card->info.promisc_mode == SET_PROMISC_MODE_ON))
		qeth_diags_trace(card, QETH_DIAGS_CMD_TRACE_DISABLE);
F
Frank Blaschka 已提交
1419 1420 1421 1422
	if (card->read.state == CH_STATE_UP &&
	    card->write.state == CH_STATE_UP &&
	    (card->state == CARD_STATE_UP)) {
		if (recovery_mode)
1423
			qeth_stop(card->dev);
1424
		else {
1425 1426 1427
			rtnl_lock();
			dev_close(card->dev);
			rtnl_unlock();
1428
		}
F
Frank Blaschka 已提交
1429 1430 1431
		card->state = CARD_STATE_SOFTSETUP;
	}
	if (card->state == CARD_STATE_SOFTSETUP) {
1432
		qeth_l3_clear_ip_htable(card, 1);
F
Frank Blaschka 已提交
1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445
		qeth_clear_ipacmd_list(card);
		card->state = CARD_STATE_HARDSETUP;
	}
	if (card->state == CARD_STATE_HARDSETUP) {
		qeth_qdio_clear_card(card, 0);
		qeth_clear_qdio_buffers(card);
		qeth_clear_working_pool_list(card);
		card->state = CARD_STATE_DOWN;
	}
	if (card->state == CARD_STATE_DOWN) {
		qeth_clear_cmd_buffers(&card->read);
		qeth_clear_cmd_buffers(&card->write);
	}
1446 1447

	flush_workqueue(card->event_wq);
F
Frank Blaschka 已提交
1448 1449
}

1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470
/*
 * test for and Switch promiscuous mode (on or off)
 *  either for guestlan or HiperSocket Sniffer
 */
static void
qeth_l3_handle_promisc_mode(struct qeth_card *card)
{
	struct net_device *dev = card->dev;

	if (((dev->flags & IFF_PROMISC) &&
	     (card->info.promisc_mode == SET_PROMISC_MODE_ON)) ||
	    (!(dev->flags & IFF_PROMISC) &&
	     (card->info.promisc_mode == SET_PROMISC_MODE_OFF)))
		return;

	if (card->info.guestlan) {		/* Guestlan trace */
		if (qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE))
			qeth_setadp_promisc_mode(card);
	} else if (card->options.sniffer &&	/* HiperSockets trace */
		   qeth_adp_supported(card, IPA_SETADP_SET_DIAG_ASSIST)) {
		if (dev->flags & IFF_PROMISC) {
C
Carsten Otte 已提交
1471
			QETH_CARD_TEXT(card, 3, "+promisc");
1472 1473
			qeth_diags_trace(card, QETH_DIAGS_CMD_TRACE_ENABLE);
		} else {
C
Carsten Otte 已提交
1474
			QETH_CARD_TEXT(card, 3, "-promisc");
1475 1476 1477 1478 1479
			qeth_diags_trace(card, QETH_DIAGS_CMD_TRACE_DISABLE);
		}
	}
}

1480
static void qeth_l3_set_rx_mode(struct net_device *dev)
F
Frank Blaschka 已提交
1481
{
1482
	struct qeth_card *card = dev->ml_priv;
1483 1484 1485
	struct qeth_ipaddr *addr;
	struct hlist_node *tmp;
	int i, rc;
F
Frank Blaschka 已提交
1486

C
Carsten Otte 已提交
1487
	QETH_CARD_TEXT(card, 3, "setmulti");
1488

1489
	if (!card->options.sniffer) {
1490 1491
		spin_lock_bh(&card->mclock);

1492 1493
		qeth_l3_add_multicast_ipv4(card);
		qeth_l3_add_multicast_ipv6(card);
1494 1495 1496 1497 1498

		hash_for_each_safe(card->ip_mc_htable, i, tmp, addr, hnode) {
			switch (addr->disp_flag) {
			case QETH_DISP_ADDR_DELETE:
				rc = qeth_l3_deregister_addr_entry(card, addr);
1499
				if (!rc || rc == -ENOENT) {
1500 1501 1502 1503 1504 1505
					hash_del(&addr->hnode);
					kfree(addr);
				}
				break;
			case QETH_DISP_ADDR_ADD:
				rc = qeth_l3_register_addr_entry(card, addr);
1506
				if (rc && rc != -ENETDOWN) {
1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517
					hash_del(&addr->hnode);
					kfree(addr);
					break;
				}
				addr->ref_counter = 1;
				/* fall through */
			default:
				/* for next call to set_rx_mode(): */
				addr->disp_flag = QETH_DISP_ADDR_DELETE;
			}
		}
1518 1519 1520

		spin_unlock_bh(&card->mclock);

1521 1522 1523 1524
		if (!qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE))
			return;
	}
	qeth_l3_handle_promisc_mode(card);
F
Frank Blaschka 已提交
1525 1526
}

1527
static int qeth_l3_arp_makerc(int rc)
F
Frank Blaschka 已提交
1528
{
1529 1530 1531
	switch (rc) {
	case IPA_RC_SUCCESS:
		return 0;
F
Frank Blaschka 已提交
1532 1533
	case QETH_IPA_ARP_RC_NOTSUPP:
	case QETH_IPA_ARP_RC_Q_NOTSUPP:
1534 1535 1536
		return -EOPNOTSUPP;
	case QETH_IPA_ARP_RC_OUT_OF_RANGE:
		return -EINVAL;
F
Frank Blaschka 已提交
1537
	case QETH_IPA_ARP_RC_Q_NO_DATA:
1538
		return -ENOENT;
F
Frank Blaschka 已提交
1539
	default:
1540
		return -EIO;
F
Frank Blaschka 已提交
1541 1542 1543 1544 1545 1546 1547
	}
}

static int qeth_l3_arp_set_no_entries(struct qeth_card *card, int no_entries)
{
	int rc;

C
Carsten Otte 已提交
1548
	QETH_CARD_TEXT(card, 3, "arpstnoe");
F
Frank Blaschka 已提交
1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559

	/*
	 * currently GuestLAN only supports the ARP assist function
	 * IPA_CMD_ASS_ARP_QUERY_INFO, but not IPA_CMD_ASS_ARP_SET_NO_ENTRIES;
	 * thus we say EOPNOTSUPP for this ARP function
	 */
	if (card->info.guestlan)
		return -EOPNOTSUPP;
	if (!qeth_is_supported(card, IPA_ARP_PROCESSING)) {
		return -EOPNOTSUPP;
	}
1560
	rc = qeth_send_simple_setassparms(card, IPA_ARP_PROCESSING,
F
Frank Blaschka 已提交
1561 1562
					  IPA_CMD_ASS_ARP_SET_NO_ENTRIES,
					  no_entries);
1563 1564 1565 1566
	if (rc)
		QETH_DBF_MESSAGE(2, "Could not set number of ARP entries on device %x: %#x\n",
				 CARD_DEVID(card), rc);
	return qeth_l3_arp_makerc(rc);
F
Frank Blaschka 已提交
1567 1568
}

1569 1570 1571
static __u32 get_arp_entry_size(struct qeth_card *card,
			struct qeth_arp_query_data *qdata,
			struct qeth_arp_entrytype *type, __u8 strip_entries)
F
Frank Blaschka 已提交
1572
{
1573 1574
	__u32 rc;
	__u8 is_hsi;
F
Frank Blaschka 已提交
1575

1576 1577 1578 1579 1580 1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599
	is_hsi = qdata->reply_bits == 5;
	if (type->ip == QETHARP_IP_ADDR_V4) {
		QETH_CARD_TEXT(card, 4, "arpev4");
		if (strip_entries) {
			rc = is_hsi ? sizeof(struct qeth_arp_qi_entry5_short) :
				sizeof(struct qeth_arp_qi_entry7_short);
		} else {
			rc = is_hsi ? sizeof(struct qeth_arp_qi_entry5) :
				sizeof(struct qeth_arp_qi_entry7);
		}
	} else if (type->ip == QETHARP_IP_ADDR_V6) {
		QETH_CARD_TEXT(card, 4, "arpev6");
		if (strip_entries) {
			rc = is_hsi ?
				sizeof(struct qeth_arp_qi_entry5_short_ipv6) :
				sizeof(struct qeth_arp_qi_entry7_short_ipv6);
		} else {
			rc = is_hsi ?
				sizeof(struct qeth_arp_qi_entry5_ipv6) :
				sizeof(struct qeth_arp_qi_entry7_ipv6);
		}
	} else {
		QETH_CARD_TEXT(card, 4, "arpinv");
		rc = 0;
F
Frank Blaschka 已提交
1600
	}
1601 1602 1603 1604 1605 1606 1607 1608

	return rc;
}

static int arpentry_matches_prot(struct qeth_arp_entrytype *type, __u16 prot)
{
	return (type->ip == QETHARP_IP_ADDR_V4 && prot == QETH_PROT_IPV4) ||
		(type->ip == QETHARP_IP_ADDR_V6 && prot == QETH_PROT_IPV6);
F
Frank Blaschka 已提交
1609 1610 1611 1612 1613 1614 1615 1616
}

static int qeth_l3_arp_query_cb(struct qeth_card *card,
		struct qeth_reply *reply, unsigned long data)
{
	struct qeth_ipa_cmd *cmd;
	struct qeth_arp_query_data *qdata;
	struct qeth_arp_query_info *qinfo;
1617 1618 1619 1620
	int e;
	int entrybytes_done;
	int stripped_bytes;
	__u8 do_strip_entries;
F
Frank Blaschka 已提交
1621

1622
	QETH_CARD_TEXT(card, 3, "arpquecb");
F
Frank Blaschka 已提交
1623 1624 1625

	qinfo = (struct qeth_arp_query_info *) reply->param;
	cmd = (struct qeth_ipa_cmd *) data;
1626
	QETH_CARD_TEXT_(card, 4, "%i", cmd->hdr.prot_version);
F
Frank Blaschka 已提交
1627
	if (cmd->hdr.return_code) {
1628 1629
		QETH_CARD_TEXT(card, 4, "arpcberr");
		QETH_CARD_TEXT_(card, 4, "%i", cmd->hdr.return_code);
1630
		return qeth_l3_arp_makerc(cmd->hdr.return_code);
F
Frank Blaschka 已提交
1631 1632 1633
	}
	if (cmd->data.setassparms.hdr.return_code) {
		cmd->hdr.return_code = cmd->data.setassparms.hdr.return_code;
1634 1635
		QETH_CARD_TEXT(card, 4, "setaperr");
		QETH_CARD_TEXT_(card, 4, "%i", cmd->hdr.return_code);
1636
		return qeth_l3_arp_makerc(cmd->hdr.return_code);
F
Frank Blaschka 已提交
1637 1638
	}
	qdata = &cmd->data.setassparms.data.query_arp;
C
Carsten Otte 已提交
1639
	QETH_CARD_TEXT_(card, 4, "anoen%i", qdata->no_entries);
F
Frank Blaschka 已提交
1640

1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662
	do_strip_entries = (qinfo->mask_bits & QETH_QARP_STRIP_ENTRIES) > 0;
	stripped_bytes = do_strip_entries ? QETH_QARP_MEDIASPECIFIC_BYTES : 0;
	entrybytes_done = 0;
	for (e = 0; e < qdata->no_entries; ++e) {
		char *cur_entry;
		__u32 esize;
		struct qeth_arp_entrytype *etype;

		cur_entry = &qdata->data + entrybytes_done;
		etype = &((struct qeth_arp_qi_entry5 *) cur_entry)->type;
		if (!arpentry_matches_prot(etype, cmd->hdr.prot_version)) {
			QETH_CARD_TEXT(card, 4, "pmis");
			QETH_CARD_TEXT_(card, 4, "%i", etype->ip);
			break;
		}
		esize = get_arp_entry_size(card, qdata, etype,
			do_strip_entries);
		QETH_CARD_TEXT_(card, 5, "esz%i", esize);
		if (!esize)
			break;

		if ((qinfo->udata_len - qinfo->udata_offset) < esize) {
1663 1664 1665
			QETH_CARD_TEXT_(card, 4, "qaer3%i", -ENOSPC);
			memset(qinfo->udata, 0, 4);
			return -ENOSPC;
1666
		}
F
Frank Blaschka 已提交
1667

1668 1669 1670 1671 1672 1673 1674
		memcpy(qinfo->udata + qinfo->udata_offset,
			&qdata->data + entrybytes_done + stripped_bytes,
			esize);
		entrybytes_done += esize + stripped_bytes;
		qinfo->udata_offset += esize;
		++qinfo->no_entries;
	}
F
Frank Blaschka 已提交
1675 1676 1677 1678
	/* check if all replies received ... */
	if (cmd->data.setassparms.hdr.seq_no <
	    cmd->data.setassparms.hdr.number_of_replies)
		return 1;
1679
	QETH_CARD_TEXT_(card, 4, "nove%i", qinfo->no_entries);
F
Frank Blaschka 已提交
1680 1681 1682 1683 1684 1685
	memcpy(qinfo->udata, &qinfo->no_entries, 4);
	/* keep STRIP_ENTRIES flag so the user program can distinguish
	 * stripped entries from normal ones */
	if (qinfo->mask_bits & QETH_QARP_STRIP_ENTRIES)
		qdata->reply_bits |= QETH_QARP_STRIP_ENTRIES;
	memcpy(qinfo->udata + QETH_QARP_MASK_OFFSET, &qdata->reply_bits, 2);
1686
	QETH_CARD_TEXT_(card, 4, "rc%i", 0);
F
Frank Blaschka 已提交
1687 1688 1689
	return 0;
}

1690 1691 1692
static int qeth_l3_query_arp_cache_info(struct qeth_card *card,
	enum qeth_prot_versions prot,
	struct qeth_arp_query_info *qinfo)
F
Frank Blaschka 已提交
1693 1694
{
	struct qeth_cmd_buffer *iob;
1695
	struct qeth_ipa_cmd *cmd;
F
Frank Blaschka 已提交
1696 1697
	int rc;

1698 1699
	QETH_CARD_TEXT_(card, 3, "qarpipv%i", prot);

1700 1701 1702 1703 1704
	iob = qeth_get_setassparms_cmd(card, IPA_ARP_PROCESSING,
				       IPA_CMD_ASS_ARP_QUERY_INFO,
				       sizeof(struct qeth_arp_query_data)
						- sizeof(char),
				       prot);
1705 1706
	if (!iob)
		return -ENOMEM;
1707
	cmd = __ipa_cmd(iob);
1708
	cmd->data.setassparms.data.query_arp.request_bits = 0x000F;
1709
	rc = qeth_send_ipa_cmd(card, iob, qeth_l3_arp_query_cb, qinfo);
1710 1711 1712
	if (rc)
		QETH_DBF_MESSAGE(2, "Error while querying ARP cache on device %x: %#x\n",
				 CARD_DEVID(card), rc);
1713
	return rc;
1714 1715 1716 1717 1718 1719 1720
}

static int qeth_l3_arp_query(struct qeth_card *card, char __user *udata)
{
	struct qeth_arp_query_info qinfo = {0, };
	int rc;

C
Carsten Otte 已提交
1721
	QETH_CARD_TEXT(card, 3, "arpquery");
F
Frank Blaschka 已提交
1722 1723 1724

	if (!qeth_is_supported(card,/*IPA_QUERY_ARP_ADDR_INFO*/
			       IPA_ARP_PROCESSING)) {
1725 1726 1727
		QETH_CARD_TEXT(card, 3, "arpqnsup");
		rc = -EOPNOTSUPP;
		goto out;
F
Frank Blaschka 已提交
1728 1729
	}
	/* get size of userspace buffer and mask_bits -> 6 bytes */
1730 1731 1732 1733
	if (copy_from_user(&qinfo, udata, 6)) {
		rc = -EFAULT;
		goto out;
	}
F
Frank Blaschka 已提交
1734
	qinfo.udata = kzalloc(qinfo.udata_len, GFP_KERNEL);
1735 1736 1737 1738
	if (!qinfo.udata) {
		rc = -ENOMEM;
		goto out;
	}
F
Frank Blaschka 已提交
1739
	qinfo.udata_offset = QETH_QARP_ENTRIES_OFFSET;
1740
	rc = qeth_l3_query_arp_cache_info(card, QETH_PROT_IPV4, &qinfo);
F
Frank Blaschka 已提交
1741 1742 1743
	if (rc) {
		if (copy_to_user(udata, qinfo.udata, 4))
			rc = -EFAULT;
1744 1745 1746 1747 1748 1749 1750 1751 1752 1753
		goto free_and_out;
	}
	if (qinfo.mask_bits & QETH_QARP_WITH_IPV6) {
		/* fails in case of GuestLAN QDIO mode */
		qeth_l3_query_arp_cache_info(card, QETH_PROT_IPV6, &qinfo);
	}
	if (copy_to_user(udata, qinfo.udata, qinfo.udata_len)) {
		QETH_CARD_TEXT(card, 4, "qactf");
		rc = -EFAULT;
		goto free_and_out;
F
Frank Blaschka 已提交
1754
	}
1755 1756
	QETH_CARD_TEXT(card, 4, "qacts");

1757
free_and_out:
F
Frank Blaschka 已提交
1758
	kfree(qinfo.udata);
1759
out:
F
Frank Blaschka 已提交
1760 1761 1762
	return rc;
}

J
Julian Wiedmann 已提交
1763 1764 1765
static int qeth_l3_arp_modify_entry(struct qeth_card *card,
				    struct qeth_arp_cache_entry *entry,
				    enum qeth_arp_process_subcmds arp_cmd)
F
Frank Blaschka 已提交
1766
{
J
Julian Wiedmann 已提交
1767
	struct qeth_arp_cache_entry *cmd_entry;
F
Frank Blaschka 已提交
1768 1769 1770
	struct qeth_cmd_buffer *iob;
	int rc;

J
Julian Wiedmann 已提交
1771 1772 1773 1774
	if (arp_cmd == IPA_CMD_ASS_ARP_ADD_ENTRY)
		QETH_CARD_TEXT(card, 3, "arpadd");
	else
		QETH_CARD_TEXT(card, 3, "arpdel");
F
Frank Blaschka 已提交
1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786

	/*
	 * currently GuestLAN only supports the ARP assist function
	 * IPA_CMD_ASS_ARP_QUERY_INFO, but not IPA_CMD_ASS_ARP_ADD_ENTRY;
	 * thus we say EOPNOTSUPP for this ARP function
	 */
	if (card->info.guestlan)
		return -EOPNOTSUPP;
	if (!qeth_is_supported(card, IPA_ARP_PROCESSING)) {
		return -EOPNOTSUPP;
	}

J
Julian Wiedmann 已提交
1787 1788
	iob = qeth_get_setassparms_cmd(card, IPA_ARP_PROCESSING, arp_cmd,
				       sizeof(*cmd_entry), QETH_PROT_IPV4);
1789 1790
	if (!iob)
		return -ENOMEM;
F
Frank Blaschka 已提交
1791

J
Julian Wiedmann 已提交
1792 1793 1794 1795
	cmd_entry = &__ipa_cmd(iob)->data.setassparms.data.arp_entry;
	ether_addr_copy(cmd_entry->macaddr, entry->macaddr);
	memcpy(cmd_entry->ipaddr, entry->ipaddr, 4);
	rc = qeth_send_ipa_cmd(card, iob, qeth_setassparms_cb, NULL);
1796
	if (rc)
J
Julian Wiedmann 已提交
1797 1798 1799
		QETH_DBF_MESSAGE(2, "Could not modify (cmd: %#x) ARP entry on device %x: %#x\n",
				 arp_cmd, CARD_DEVID(card), rc);

1800
	return qeth_l3_arp_makerc(rc);
F
Frank Blaschka 已提交
1801 1802 1803 1804 1805 1806
}

static int qeth_l3_arp_flush_cache(struct qeth_card *card)
{
	int rc;

C
Carsten Otte 已提交
1807
	QETH_CARD_TEXT(card, 3, "arpflush");
F
Frank Blaschka 已提交
1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818

	/*
	 * currently GuestLAN only supports the ARP assist function
	 * IPA_CMD_ASS_ARP_QUERY_INFO, but not IPA_CMD_ASS_ARP_FLUSH_CACHE;
	 * thus we say EOPNOTSUPP for this ARP function
	*/
	if (card->info.guestlan || (card->info.type == QETH_CARD_TYPE_IQD))
		return -EOPNOTSUPP;
	if (!qeth_is_supported(card, IPA_ARP_PROCESSING)) {
		return -EOPNOTSUPP;
	}
1819
	rc = qeth_send_simple_setassparms(card, IPA_ARP_PROCESSING,
F
Frank Blaschka 已提交
1820
					  IPA_CMD_ASS_ARP_FLUSH_CACHE, 0);
1821 1822 1823 1824
	if (rc)
		QETH_DBF_MESSAGE(2, "Could not flush ARP cache on device %x: %#x\n",
				 CARD_DEVID(card), rc);
	return qeth_l3_arp_makerc(rc);
F
Frank Blaschka 已提交
1825 1826 1827 1828
}

static int qeth_l3_do_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
{
1829
	struct qeth_card *card = dev->ml_priv;
F
Frank Blaschka 已提交
1830
	struct qeth_arp_cache_entry arp_entry;
J
Julian Wiedmann 已提交
1831
	enum qeth_arp_process_subcmds arp_cmd;
F
Frank Blaschka 已提交
1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850
	int rc = 0;

	switch (cmd) {
	case SIOC_QETH_ARP_SET_NO_ENTRIES:
		if (!capable(CAP_NET_ADMIN)) {
			rc = -EPERM;
			break;
		}
		rc = qeth_l3_arp_set_no_entries(card, rq->ifr_ifru.ifru_ivalue);
		break;
	case SIOC_QETH_ARP_QUERY_INFO:
		if (!capable(CAP_NET_ADMIN)) {
			rc = -EPERM;
			break;
		}
		rc = qeth_l3_arp_query(card, rq->ifr_ifru.ifru_data);
		break;
	case SIOC_QETH_ARP_ADD_ENTRY:
	case SIOC_QETH_ARP_REMOVE_ENTRY:
J
Julian Wiedmann 已提交
1851 1852 1853 1854 1855 1856 1857 1858 1859
		if (!capable(CAP_NET_ADMIN))
			return -EPERM;
		if (copy_from_user(&arp_entry, rq->ifr_data, sizeof(arp_entry)))
			return -EFAULT;

		arp_cmd = (cmd == SIOC_QETH_ARP_ADD_ENTRY) ?
				IPA_CMD_ASS_ARP_ADD_ENTRY :
				IPA_CMD_ASS_ARP_REMOVE_ENTRY;
		return qeth_l3_arp_modify_entry(card, &arp_entry, arp_cmd);
F
Frank Blaschka 已提交
1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872
	case SIOC_QETH_ARP_FLUSH_CACHE:
		if (!capable(CAP_NET_ADMIN)) {
			rc = -EPERM;
			break;
		}
		rc = qeth_l3_arp_flush_cache(card);
		break;
	default:
		rc = -EOPNOTSUPP;
	}
	return rc;
}

1873
static int qeth_l3_get_cast_type(struct sk_buff *skb)
1874
{
1875 1876 1877
	struct neighbour *n = NULL;
	struct dst_entry *dst;

F
Frank Blaschka 已提交
1878
	rcu_read_lock();
1879 1880
	dst = skb_dst(skb);
	if (dst)
1881
		n = dst_neigh_lookup_skb(dst, skb);
1882
	if (n) {
1883 1884
		int cast_type = n->type;

F
Frank Blaschka 已提交
1885
		rcu_read_unlock();
1886
		neigh_release(n);
1887 1888 1889 1890
		if ((cast_type == RTN_BROADCAST) ||
		    (cast_type == RTN_MULTICAST) ||
		    (cast_type == RTN_ANYCAST))
			return cast_type;
1891
		return RTN_UNICAST;
1892
	}
F
Frank Blaschka 已提交
1893 1894
	rcu_read_unlock();

1895
	/* no neighbour (eg AF_PACKET), fall back to target's IP address ... */
1896 1897
	switch (qeth_get_ip_version(skb)) {
	case 4:
1898
		return ipv4_is_multicast(ip_hdr(skb)->daddr) ?
1899
				RTN_MULTICAST : RTN_UNICAST;
1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912
	case 6:
		return ipv6_addr_is_multicast(&ipv6_hdr(skb)->daddr) ?
				RTN_MULTICAST : RTN_UNICAST;
	default:
		/* ... and MAC address */
		if (ether_addr_equal_64bits(eth_hdr(skb)->h_dest,
					    skb->dev->broadcast))
			return RTN_BROADCAST;
		if (is_multicast_ether_addr(eth_hdr(skb)->h_dest))
			return RTN_MULTICAST;
		/* default to unicast */
		return RTN_UNICAST;
	}
1913 1914
}

1915
static u8 qeth_l3_cast_type_to_flag(int cast_type)
F
Frank Blaschka 已提交
1916
{
1917 1918 1919 1920 1921 1922 1923 1924
	if (cast_type == RTN_MULTICAST)
		return QETH_CAST_MULTICAST;
	if (cast_type == RTN_ANYCAST)
		return QETH_CAST_ANYCAST;
	if (cast_type == RTN_BROADCAST)
		return QETH_CAST_BROADCAST;
	return QETH_CAST_UNICAST;
}
1925

1926
static void qeth_l3_fill_header(struct qeth_card *card, struct qeth_hdr *hdr,
1927 1928
				struct sk_buff *skb, int ipv, int cast_type,
				unsigned int data_len)
1929
{
1930
	struct qeth_hdr_layer3 *l3_hdr = &hdr->hdr.l3;
1931 1932
	struct vlan_ethhdr *veth = vlan_eth_hdr(skb);

1933
	hdr->hdr.l3.length = data_len;
F
Frank Blaschka 已提交
1934

1935
	if (skb_is_gso(skb)) {
1936
		hdr->hdr.l3.id = QETH_HEADER_TYPE_L3_TSO;
1937 1938
	} else {
		hdr->hdr.l3.id = QETH_HEADER_TYPE_LAYER3;
1939 1940 1941 1942 1943 1944 1945 1946 1947

		if (skb->protocol == htons(ETH_P_AF_IUCV)) {
			l3_hdr->flags = QETH_HDR_IPV6 | QETH_CAST_UNICAST;
			l3_hdr->next_hop.ipv6_addr.s6_addr16[0] = htons(0xfe80);
			memcpy(&l3_hdr->next_hop.ipv6_addr.s6_addr32[2],
			       iucv_trans_hdr(skb)->destUserID, 8);
			return;
		}

1948 1949 1950 1951 1952 1953 1954 1955 1956 1957
		if (skb->ip_summed == CHECKSUM_PARTIAL) {
			qeth_tx_csum(skb, &hdr->hdr.l3.ext_flags, ipv);
			/* some HW requires combined L3+L4 csum offload: */
			if (ipv == 4)
				hdr->hdr.l3.ext_flags |= QETH_HDR_EXT_CSUM_HDR_REQ;
			if (card->options.performance_stats)
				card->perf_stats.tx_csum++;
		}
	}

1958 1959 1960 1961 1962 1963 1964 1965 1966
	if (ipv == 4 || IS_IQD(card)) {
		/* NETIF_F_HW_VLAN_CTAG_TX */
		if (skb_vlan_tag_present(skb)) {
			hdr->hdr.l3.ext_flags |= QETH_HDR_EXT_VLAN_FRAME;
			hdr->hdr.l3.vlan_id = skb_vlan_tag_get(skb);
		}
	} else if (veth->h_vlan_proto == htons(ETH_P_8021Q)) {
		hdr->hdr.l3.ext_flags |= QETH_HDR_EXT_INCLUDE_VLAN_TAG;
		hdr->hdr.l3.vlan_id = ntohs(veth->h_vlan_TCI);
F
Frank Blaschka 已提交
1967 1968
	}

1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979
	/* OSA only: */
	if (!ipv) {
		hdr->hdr.l3.flags = QETH_HDR_PASSTHRU;
		if (ether_addr_equal_64bits(eth_hdr(skb)->h_dest,
					    skb->dev->broadcast))
			hdr->hdr.l3.flags |= QETH_CAST_BROADCAST;
		else
			hdr->hdr.l3.flags |= (cast_type == RTN_MULTICAST) ?
				QETH_CAST_MULTICAST : QETH_CAST_UNICAST;
		return;
	}
F
Frank Blaschka 已提交
1980

1981
	hdr->hdr.l3.flags = qeth_l3_cast_type_to_flag(cast_type);
F
Frank Blaschka 已提交
1982
	rcu_read_lock();
F
Frank Blaschka 已提交
1983
	if (ipv == 4) {
1984
		struct rtable *rt = skb_rtable(skb);
1985

1986 1987 1988 1989 1990 1991
		*((__be32 *) &hdr->hdr.l3.next_hop.ipv4.addr) = (rt) ?
				rt_nexthop(rt, ip_hdr(skb)->daddr) :
				ip_hdr(skb)->daddr;
	} else {
		/* IPv6 */
		const struct rt6_info *rt = skb_rt6_info(skb);
1992

1993
		if (rt && !ipv6_addr_any(&rt->rt6i_gateway))
1994
			l3_hdr->next_hop.ipv6_addr = rt->rt6i_gateway;
1995
		else
1996
			l3_hdr->next_hop.ipv6_addr = ipv6_hdr(skb)->daddr;
1997

1998 1999 2000
		hdr->hdr.l3.flags |= QETH_HDR_IPV6;
		if (card->info.type != QETH_CARD_TYPE_IQD)
			hdr->hdr.l3.flags |= QETH_HDR_PASSTHRU;
F
Frank Blaschka 已提交
2001
	}
F
Frank Blaschka 已提交
2002
	rcu_read_unlock();
F
Frank Blaschka 已提交
2003 2004
}

2005 2006 2007 2008 2009 2010 2011
static void qeth_l3_fixup_headers(struct sk_buff *skb)
{
	struct iphdr *iph = ip_hdr(skb);

	/* this is safe, IPv6 traffic takes a different path */
	if (skb->ip_summed == CHECKSUM_PARTIAL)
		iph->check = 0;
2012 2013 2014 2015 2016
	if (skb_is_gso(skb)) {
		iph->tot_len = 0;
		tcp_hdr(skb)->check = ~tcp_v4_check(0, iph->saddr,
						    iph->daddr, 0);
	}
2017 2018
}

2019 2020
static int qeth_l3_xmit(struct qeth_card *card, struct sk_buff *skb,
			struct qeth_qdio_out_q *queue, int ipv, int cast_type)
2021 2022
{
	unsigned char eth_hdr[ETH_HLEN];
J
Julian Wiedmann 已提交
2023 2024
	unsigned int hw_hdr_len;
	int rc;
2025

2026
	/* re-use the L2 header area for the HW header: */
J
Julian Wiedmann 已提交
2027 2028
	hw_hdr_len = skb_is_gso(skb) ? sizeof(struct qeth_hdr_tso) :
				       sizeof(struct qeth_hdr);
2029 2030 2031 2032 2033 2034
	rc = skb_cow_head(skb, hw_hdr_len - ETH_HLEN);
	if (rc)
		return rc;
	skb_copy_from_linear_data(skb, eth_hdr, ETH_HLEN);
	skb_pull(skb, ETH_HLEN);

2035
	qeth_l3_fixup_headers(skb);
J
Julian Wiedmann 已提交
2036 2037 2038 2039 2040
	rc = qeth_xmit(card, skb, queue, ipv, cast_type, qeth_l3_fill_header);
	if (rc == -EBUSY) {
		/* roll back to ETH header */
		skb_push(skb, ETH_HLEN);
		skb_copy_to_linear_data(skb, eth_hdr, ETH_HLEN);
2041 2042 2043 2044
	}
	return rc;
}

2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060
static netdev_tx_t qeth_l3_hard_start_xmit(struct sk_buff *skb,
					   struct net_device *dev)
{
	int cast_type = qeth_l3_get_cast_type(skb);
	struct qeth_card *card = dev->ml_priv;
	int ipv = qeth_get_ip_version(skb);
	struct qeth_qdio_out_q *queue;
	int tx_bytes = skb->len;
	int rc;

	if (IS_IQD(card)) {
		if (card->options.sniffer)
			goto tx_drop;
		if ((card->options.cq != QETH_CQ_ENABLED && !ipv) ||
		    (card->options.cq == QETH_CQ_ENABLED &&
		     skb->protocol != htons(ETH_P_AF_IUCV)))
F
Frank Blaschka 已提交
2061 2062 2063
			goto tx_drop;
	}

2064
	if (card->state != CARD_STATE_UP) {
2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079
		card->stats.tx_carrier_errors++;
		goto tx_drop;
	}

	if (cast_type == RTN_BROADCAST && !card->info.broadcast_capable)
		goto tx_drop;

	queue = qeth_get_tx_queue(card, skb, ipv, cast_type);

	if (card->options.performance_stats) {
		card->perf_stats.outbound_cnt++;
		card->perf_stats.outbound_start_time = qeth_get_micros();
	}
	netif_stop_queue(dev);

2080
	if (ipv == 4 || IS_IQD(card))
2081
		rc = qeth_l3_xmit(card, skb, queue, ipv, cast_type);
2082 2083 2084
	else
		rc = qeth_xmit(card, skb, queue, ipv, cast_type,
			       qeth_l3_fill_header);
2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096

	if (!rc) {
		card->stats.tx_packets++;
		card->stats.tx_bytes += tx_bytes;
		if (card->options.performance_stats)
			card->perf_stats.outbound_time += qeth_get_micros() -
				card->perf_stats.outbound_start_time;
		netif_wake_queue(dev);
		return NETDEV_TX_OK;
	} else if (rc == -EBUSY) {
		return NETDEV_TX_BUSY;
	} /* else fall through */
F
Frank Blaschka 已提交
2097 2098 2099 2100 2101

tx_drop:
	card->stats.tx_dropped++;
	card->stats.tx_errors++;
	dev_kfree_skb_any(skb);
2102
	netif_wake_queue(dev);
F
Frank Blaschka 已提交
2103 2104 2105
	return NETDEV_TX_OK;
}

2106
static const struct ethtool_ops qeth_l3_ethtool_ops = {
F
Frank Blaschka 已提交
2107 2108 2109
	.get_link = ethtool_op_get_link,
	.get_strings = qeth_core_get_strings,
	.get_ethtool_stats = qeth_core_get_ethtool_stats,
2110
	.get_sset_count = qeth_core_get_sset_count,
F
Frank Blaschka 已提交
2111
	.get_drvinfo = qeth_core_get_drvinfo,
2112
	.get_link_ksettings = qeth_core_ethtool_get_link_ksettings,
F
Frank Blaschka 已提交
2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138
};

/*
 * we need NOARP for IPv4 but we want neighbor solicitation for IPv6. Setting
 * NOARP on the netdevice is no option because it also turns off neighbor
 * solicitation. For IPv4 we install a neighbor_setup function. We don't want
 * arp resolution but we want the hard header (packet socket will work
 * e.g. tcpdump)
 */
static int qeth_l3_neigh_setup_noarp(struct neighbour *n)
{
	n->nud_state = NUD_NOARP;
	memcpy(n->ha, "FAKELL", 6);
	n->output = n->ops->connected_output;
	return 0;
}

static int
qeth_l3_neigh_setup(struct net_device *dev, struct neigh_parms *np)
{
	if (np->tbl->family == AF_INET)
		np->neigh_setup = qeth_l3_neigh_setup_noarp;

	return 0;
}

2139 2140 2141 2142 2143 2144 2145 2146 2147
static netdev_features_t qeth_l3_osa_features_check(struct sk_buff *skb,
						    struct net_device *dev,
						    netdev_features_t features)
{
	if (qeth_get_ip_version(skb) != 4)
		features &= ~NETIF_F_HW_VLAN_CTAG_TX;
	return qeth_features_check(skb, dev, features);
}

F
Frank Blaschka 已提交
2148
static const struct net_device_ops qeth_l3_netdev_ops = {
2149 2150
	.ndo_open		= qeth_open,
	.ndo_stop		= qeth_stop,
F
Frank Blaschka 已提交
2151 2152 2153
	.ndo_get_stats		= qeth_get_stats,
	.ndo_start_xmit		= qeth_l3_hard_start_xmit,
	.ndo_validate_addr	= eth_validate_addr,
2154
	.ndo_set_rx_mode	= qeth_l3_set_rx_mode,
2155
	.ndo_do_ioctl		= qeth_do_ioctl,
2156 2157
	.ndo_fix_features	= qeth_fix_features,
	.ndo_set_features	= qeth_set_features,
F
Frank Blaschka 已提交
2158 2159
	.ndo_vlan_rx_add_vid	= qeth_l3_vlan_rx_add_vid,
	.ndo_vlan_rx_kill_vid   = qeth_l3_vlan_rx_kill_vid,
J
Jiri Pirko 已提交
2160
	.ndo_tx_timeout		= qeth_tx_timeout,
F
Frank Blaschka 已提交
2161 2162
};

F
Frank Blaschka 已提交
2163
static const struct net_device_ops qeth_l3_osa_netdev_ops = {
2164 2165
	.ndo_open		= qeth_open,
	.ndo_stop		= qeth_stop,
F
Frank Blaschka 已提交
2166 2167
	.ndo_get_stats		= qeth_get_stats,
	.ndo_start_xmit		= qeth_l3_hard_start_xmit,
2168
	.ndo_features_check	= qeth_l3_osa_features_check,
F
Frank Blaschka 已提交
2169
	.ndo_validate_addr	= eth_validate_addr,
2170
	.ndo_set_rx_mode	= qeth_l3_set_rx_mode,
2171
	.ndo_do_ioctl		= qeth_do_ioctl,
2172 2173
	.ndo_fix_features	= qeth_fix_features,
	.ndo_set_features	= qeth_set_features,
F
Frank Blaschka 已提交
2174 2175
	.ndo_vlan_rx_add_vid	= qeth_l3_vlan_rx_add_vid,
	.ndo_vlan_rx_kill_vid   = qeth_l3_vlan_rx_kill_vid,
J
Jiri Pirko 已提交
2176
	.ndo_tx_timeout		= qeth_tx_timeout,
F
Frank Blaschka 已提交
2177 2178 2179
	.ndo_neigh_setup	= qeth_l3_neigh_setup,
};

J
Julian Wiedmann 已提交
2180
static int qeth_l3_setup_netdev(struct qeth_card *card, bool carrier_ok)
F
Frank Blaschka 已提交
2181
{
2182
	unsigned int headroom;
2183 2184
	int rc;

2185 2186
	if (card->info.type == QETH_CARD_TYPE_OSD ||
	    card->info.type == QETH_CARD_TYPE_OSX) {
F
Frank Blaschka 已提交
2187 2188
		if ((card->info.link_type == QETH_LINK_TYPE_LANE_TR) ||
		    (card->info.link_type == QETH_LINK_TYPE_HSTR)) {
2189 2190
			pr_info("qeth_l3: ignoring TR device\n");
			return -ENODEV;
2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205
		}

		card->dev->netdev_ops = &qeth_l3_osa_netdev_ops;

		/*IPv6 address autoconfiguration stuff*/
		qeth_l3_get_unique_id(card);
		if (!(card->info.unique_id & UNIQUE_ID_NOT_BY_CARD))
			card->dev->dev_id = card->info.unique_id & 0xffff;

		if (!card->info.guestlan) {
			card->dev->features |= NETIF_F_SG;
			card->dev->hw_features |= NETIF_F_TSO |
				NETIF_F_RXCSUM | NETIF_F_IP_CSUM;
			card->dev->vlan_features |= NETIF_F_TSO |
				NETIF_F_RXCSUM | NETIF_F_IP_CSUM;
F
Frank Blaschka 已提交
2206
		}
2207 2208 2209 2210 2211

		if (qeth_is_supported6(card, IPA_OUTBOUND_CHECKSUM_V6)) {
			card->dev->hw_features |= NETIF_F_IPV6_CSUM;
			card->dev->vlan_features |= NETIF_F_IPV6_CSUM;
		}
2212 2213 2214 2215 2216 2217 2218 2219 2220 2221 2222 2223
		if (qeth_is_supported6(card, IPA_OUTBOUND_TSO)) {
			card->dev->hw_features |= NETIF_F_TSO6;
			card->dev->vlan_features |= NETIF_F_TSO6;
		}

		/* allow for de-acceleration of NETIF_F_HW_VLAN_CTAG_TX: */
		if (card->dev->hw_features & NETIF_F_TSO6)
			headroom = sizeof(struct qeth_hdr_tso) + VLAN_HLEN;
		else if (card->dev->hw_features & NETIF_F_TSO)
			headroom = sizeof(struct qeth_hdr_tso);
		else
			headroom = sizeof(struct qeth_hdr) + VLAN_HLEN;
F
Frank Blaschka 已提交
2224 2225
	} else if (card->info.type == QETH_CARD_TYPE_IQD) {
		card->dev->flags |= IFF_NOARP;
F
Frank Blaschka 已提交
2226
		card->dev->netdev_ops = &qeth_l3_netdev_ops;
2227
		headroom = sizeof(struct qeth_hdr) - ETH_HLEN;
2228

2229 2230
		rc = qeth_l3_iqd_read_initial_mac(card);
		if (rc)
2231
			goto out;
F
Frank Blaschka 已提交
2232 2233 2234
	} else
		return -ENODEV;

2235
	card->dev->needed_headroom = headroom;
2236
	card->dev->ethtool_ops = &qeth_l3_ethtool_ops;
2237 2238 2239
	card->dev->features |=	NETIF_F_HW_VLAN_CTAG_TX |
				NETIF_F_HW_VLAN_CTAG_RX |
				NETIF_F_HW_VLAN_CTAG_FILTER;
2240

2241
	netif_keep_dst(card->dev);
2242
	if (card->dev->hw_features & (NETIF_F_TSO | NETIF_F_TSO6))
2243 2244
		netif_set_gso_max_size(card->dev,
				       PAGE_SIZE * (QETH_MAX_BUFFER_ELEMENTS(card) - 1));
F
Frank Blaschka 已提交
2245

2246
	netif_napi_add(card->dev, &card->napi, qeth_poll, QETH_NAPI_WEIGHT);
2247
	rc = register_netdev(card->dev);
J
Julian Wiedmann 已提交
2248 2249 2250
	if (!rc && carrier_ok)
		netif_carrier_on(card->dev);

2251 2252 2253 2254
out:
	if (rc)
		card->dev->netdev_ops = NULL;
	return rc;
F
Frank Blaschka 已提交
2255 2256
}

2257 2258 2259 2260 2261
static const struct device_type qeth_l3_devtype = {
	.name = "qeth_layer3",
	.groups = qeth_l3_attr_groups,
};

F
Frank Blaschka 已提交
2262 2263 2264
static int qeth_l3_probe_device(struct ccwgroup_device *gdev)
{
	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
2265
	int rc;
F
Frank Blaschka 已提交
2266

2267 2268 2269 2270 2271
	if (gdev->dev.type == &qeth_generic_devtype) {
		rc = qeth_l3_create_device_attributes(&gdev->dev);
		if (rc)
			return rc;
	}
2272 2273
	hash_init(card->ip_htable);
	hash_init(card->ip_mc_htable);
2274
	card->info.hwtrap = 0;
F
Frank Blaschka 已提交
2275 2276 2277 2278 2279 2280 2281
	return 0;
}

static void qeth_l3_remove_device(struct ccwgroup_device *cgdev)
{
	struct qeth_card *card = dev_get_drvdata(&cgdev->dev);

2282 2283
	if (cgdev->dev.type == &qeth_generic_devtype)
		qeth_l3_remove_device_attributes(&cgdev->dev);
2284

2285
	qeth_set_allowed_threads(card, 0, 1);
F
Frank Blaschka 已提交
2286 2287
	wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0);

2288
	if (cgdev->state == CCWGROUP_ONLINE)
F
Frank Blaschka 已提交
2289 2290
		qeth_l3_set_offline(cgdev);

2291
	cancel_work_sync(&card->close_dev_work);
2292 2293
	if (qeth_netdev_is_registered(card->dev))
		unregister_netdev(card->dev);
2294
	qeth_l3_clear_ip_htable(card, 0);
F
Frank Blaschka 已提交
2295 2296 2297 2298 2299 2300
	qeth_l3_clear_ipato_list(card);
}

static int __qeth_l3_set_online(struct ccwgroup_device *gdev, int recovery_mode)
{
	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
2301
	struct net_device *dev = card->dev;
F
Frank Blaschka 已提交
2302 2303
	int rc = 0;
	enum qeth_card_states recover_flag;
J
Julian Wiedmann 已提交
2304
	bool carrier_ok;
F
Frank Blaschka 已提交
2305

2306
	mutex_lock(&card->discipline_mutex);
2307
	mutex_lock(&card->conf_mutex);
2308 2309
	QETH_DBF_TEXT(SETUP, 2, "setonlin");
	QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
F
Frank Blaschka 已提交
2310 2311

	recover_flag = card->state;
J
Julian Wiedmann 已提交
2312
	rc = qeth_core_hardsetup_card(card, &carrier_ok);
F
Frank Blaschka 已提交
2313
	if (rc) {
2314
		QETH_DBF_TEXT_(SETUP, 2, "2err%04x", rc);
2315
		rc = -ENODEV;
F
Frank Blaschka 已提交
2316 2317 2318
		goto out_remove;
	}

2319 2320 2321 2322 2323 2324 2325
	if (qeth_is_diagass_supported(card, QETH_DIAGS_CMD_TRAP)) {
		if (card->info.hwtrap &&
		    qeth_hw_trap(card, QETH_DIAGS_TRAP_ARM))
			card->info.hwtrap = 0;
	} else
		card->info.hwtrap = 0;

F
Frank Blaschka 已提交
2326 2327 2328 2329
	card->state = CARD_STATE_HARDSETUP;
	qeth_print_status_message(card);

	/* softsetup */
2330
	QETH_DBF_TEXT(SETUP, 2, "softsetp");
F
Frank Blaschka 已提交
2331 2332 2333

	rc = qeth_l3_setadapter_parms(card);
	if (rc)
2334
		QETH_DBF_TEXT_(SETUP, 2, "2err%04x", rc);
2335 2336
	if (!card->options.sniffer) {
		rc = qeth_l3_start_ipassists(card);
S
Stefan Raspl 已提交
2337
		if (rc) {
2338
			QETH_DBF_TEXT_(SETUP, 2, "3err%d", rc);
S
Stefan Raspl 已提交
2339 2340
			goto out_remove;
		}
2341 2342
		rc = qeth_l3_setrouting_v4(card);
		if (rc)
2343
			QETH_DBF_TEXT_(SETUP, 2, "4err%04x", rc);
2344 2345
		rc = qeth_l3_setrouting_v6(card);
		if (rc)
2346
			QETH_DBF_TEXT_(SETUP, 2, "5err%04x", rc);
2347
	}
F
Frank Blaschka 已提交
2348 2349 2350

	rc = qeth_init_qdio_queues(card);
	if (rc) {
2351
		QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc);
2352
		rc = -ENODEV;
F
Frank Blaschka 已提交
2353 2354 2355 2356 2357
		goto out_remove;
	}
	card->state = CARD_STATE_SOFTSETUP;

	qeth_set_allowed_threads(card, 0xffffffff, 0);
2358
	qeth_l3_recover_ip(card);
2359

2360 2361 2362 2363 2364
	if (!qeth_netdev_is_registered(dev)) {
		rc = qeth_l3_setup_netdev(card, carrier_ok);
		if (rc)
			goto out_remove;
	} else {
2365
		rtnl_lock();
2366 2367 2368 2369 2370
		if (carrier_ok)
			netif_carrier_on(dev);
		else
			netif_carrier_off(dev);

2371
		netif_device_attach(dev);
2372 2373 2374 2375
		qeth_enable_hw_features(dev);

		if (recover_flag == CARD_STATE_RECOVER) {
			if (recovery_mode) {
2376
				qeth_open(dev);
2377 2378 2379 2380
				qeth_l3_set_rx_mode(dev);
			} else {
				dev_open(dev, NULL);
			}
2381
		}
2382
		rtnl_unlock();
F
Frank Blaschka 已提交
2383
	}
S
Stefan Raspl 已提交
2384
	qeth_trace_features(card);
F
Frank Blaschka 已提交
2385 2386
	/* let user_space know that device is online */
	kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE);
2387
	mutex_unlock(&card->conf_mutex);
2388
	mutex_unlock(&card->discipline_mutex);
F
Frank Blaschka 已提交
2389 2390 2391 2392 2393 2394
	return 0;
out_remove:
	qeth_l3_stop_card(card, 0);
	ccw_device_set_offline(CARD_DDEV(card));
	ccw_device_set_offline(CARD_WDEV(card));
	ccw_device_set_offline(CARD_RDEV(card));
2395
	qdio_free(CARD_DDEV(card));
F
Frank Blaschka 已提交
2396 2397 2398 2399
	if (recover_flag == CARD_STATE_RECOVER)
		card->state = CARD_STATE_RECOVER;
	else
		card->state = CARD_STATE_DOWN;
2400
	mutex_unlock(&card->conf_mutex);
2401
	mutex_unlock(&card->discipline_mutex);
2402
	return rc;
F
Frank Blaschka 已提交
2403 2404 2405 2406 2407 2408 2409 2410 2411 2412 2413 2414 2415 2416
}

static int qeth_l3_set_online(struct ccwgroup_device *gdev)
{
	return __qeth_l3_set_online(gdev, 0);
}

static int __qeth_l3_set_offline(struct ccwgroup_device *cgdev,
			int recovery_mode)
{
	struct qeth_card *card = dev_get_drvdata(&cgdev->dev);
	int rc = 0, rc2 = 0, rc3 = 0;
	enum qeth_card_states recover_flag;

2417
	mutex_lock(&card->discipline_mutex);
2418
	mutex_lock(&card->conf_mutex);
2419 2420
	QETH_DBF_TEXT(SETUP, 3, "setoffl");
	QETH_DBF_HEX(SETUP, 3, &card, sizeof(void *));
F
Frank Blaschka 已提交
2421

2422 2423
	rtnl_lock();
	netif_device_detach(card->dev);
2424
	netif_carrier_off(card->dev);
2425 2426
	rtnl_unlock();

F
Frank Blaschka 已提交
2427
	recover_flag = card->state;
2428 2429 2430 2431
	if ((!recovery_mode && card->info.hwtrap) || card->info.hwtrap == 2) {
		qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM);
		card->info.hwtrap = 1;
	}
2432
	qeth_l3_stop_card(card, recovery_mode);
2433 2434 2435 2436 2437
	if ((card->options.cq == QETH_CQ_ENABLED) && card->dev) {
		rtnl_lock();
		call_netdevice_notifiers(NETDEV_REBOOT, card->dev);
		rtnl_unlock();
	}
F
Frank Blaschka 已提交
2438 2439 2440 2441 2442 2443
	rc  = ccw_device_set_offline(CARD_DDEV(card));
	rc2 = ccw_device_set_offline(CARD_WDEV(card));
	rc3 = ccw_device_set_offline(CARD_RDEV(card));
	if (!rc)
		rc = (rc2) ? rc2 : rc3;
	if (rc)
2444
		QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
2445
	qdio_free(CARD_DDEV(card));
F
Frank Blaschka 已提交
2446 2447 2448 2449
	if (recover_flag == CARD_STATE_UP)
		card->state = CARD_STATE_RECOVER;
	/* let user_space know that device is offline */
	kobject_uevent(&cgdev->dev.kobj, KOBJ_CHANGE);
2450
	mutex_unlock(&card->conf_mutex);
2451
	mutex_unlock(&card->discipline_mutex);
F
Frank Blaschka 已提交
2452 2453 2454 2455 2456 2457 2458 2459 2460 2461 2462 2463 2464 2465
	return 0;
}

static int qeth_l3_set_offline(struct ccwgroup_device *cgdev)
{
	return __qeth_l3_set_offline(cgdev, 0);
}

static int qeth_l3_recover(void *ptr)
{
	struct qeth_card *card;
	int rc = 0;

	card = (struct qeth_card *) ptr;
C
Carsten Otte 已提交
2466 2467
	QETH_CARD_TEXT(card, 2, "recover1");
	QETH_CARD_HEX(card, 2, &card, sizeof(void *));
F
Frank Blaschka 已提交
2468 2469
	if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD))
		return 0;
C
Carsten Otte 已提交
2470
	QETH_CARD_TEXT(card, 2, "recover2");
2471 2472
	dev_warn(&card->gdev->dev,
		"A recovery process has been started for the device\n");
F
Frank Blaschka 已提交
2473 2474 2475
	__qeth_l3_set_offline(card->gdev, 1);
	rc = __qeth_l3_set_online(card->gdev, 1);
	if (!rc)
2476 2477
		dev_info(&card->gdev->dev,
			"Device successfully recovered!\n");
2478
	else {
S
Stefan Raspl 已提交
2479 2480
		qeth_close_dev(card);
		dev_warn(&card->gdev->dev, "The qeth device driver "
2481
				"failed to recover an error on the device\n");
2482
	}
2483 2484
	qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD);
	qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD);
F
Frank Blaschka 已提交
2485 2486 2487
	return 0;
}

2488 2489 2490 2491 2492 2493 2494 2495 2496
static int qeth_l3_pm_suspend(struct ccwgroup_device *gdev)
{
	struct qeth_card *card = dev_get_drvdata(&gdev->dev);

	qeth_set_allowed_threads(card, 0, 1);
	wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0);
	if (gdev->state == CCWGROUP_OFFLINE)
		return 0;
	if (card->state == CARD_STATE_UP) {
2497 2498
		if (card->info.hwtrap)
			qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM);
2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509 2510 2511 2512
		__qeth_l3_set_offline(card->gdev, 1);
	} else
		__qeth_l3_set_offline(card->gdev, 0);
	return 0;
}

static int qeth_l3_pm_resume(struct ccwgroup_device *gdev)
{
	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
	int rc = 0;

	if (card->state == CARD_STATE_RECOVER) {
		rc = __qeth_l3_set_online(card->gdev, 1);
		if (rc) {
2513 2514 2515
			rtnl_lock();
			dev_close(card->dev);
			rtnl_unlock();
2516 2517 2518
		}
	} else
		rc = __qeth_l3_set_online(card->gdev, 0);
2519

2520 2521 2522 2523 2524 2525 2526
	qeth_set_allowed_threads(card, 0xffffffff, 0);
	if (rc)
		dev_warn(&card->gdev->dev, "The qeth device driver "
			"failed to recover an error on the device\n");
	return rc;
}

2527 2528 2529 2530 2531 2532 2533
/* Returns zero if the command is successfully "consumed" */
static int qeth_l3_control_event(struct qeth_card *card,
					struct qeth_ipa_cmd *cmd)
{
	return 1;
}

2534
struct qeth_discipline qeth_l3_discipline = {
2535
	.devtype = &qeth_l3_devtype,
2536
	.process_rx_buffer = qeth_l3_process_inbound_buffer,
2537 2538
	.recover = qeth_l3_recover,
	.setup = qeth_l3_probe_device,
F
Frank Blaschka 已提交
2539 2540 2541
	.remove = qeth_l3_remove_device,
	.set_online = qeth_l3_set_online,
	.set_offline = qeth_l3_set_offline,
2542 2543 2544
	.freeze = qeth_l3_pm_suspend,
	.thaw = qeth_l3_pm_resume,
	.restore = qeth_l3_pm_resume,
2545
	.do_ioctl = qeth_l3_do_ioctl,
2546
	.control_event_handler = qeth_l3_control_event,
F
Frank Blaschka 已提交
2547
};
2548
EXPORT_SYMBOL_GPL(qeth_l3_discipline);
F
Frank Blaschka 已提交
2549

2550 2551 2552 2553 2554 2555 2556 2557 2558 2559 2560 2561 2562 2563 2564 2565 2566 2567 2568 2569
static int qeth_l3_handle_ip_event(struct qeth_card *card,
				   struct qeth_ipaddr *addr,
				   unsigned long event)
{
	switch (event) {
	case NETDEV_UP:
		spin_lock_bh(&card->ip_lock);
		qeth_l3_add_ip(card, addr);
		spin_unlock_bh(&card->ip_lock);
		return NOTIFY_OK;
	case NETDEV_DOWN:
		spin_lock_bh(&card->ip_lock);
		qeth_l3_delete_ip(card, addr);
		spin_unlock_bh(&card->ip_lock);
		return NOTIFY_OK;
	default:
		return NOTIFY_DONE;
	}
}

2570 2571 2572 2573 2574 2575 2576 2577 2578 2579
static struct qeth_card *qeth_l3_get_card_from_dev(struct net_device *dev)
{
	if (is_vlan_dev(dev))
		dev = vlan_dev_real_dev(dev);
	if (dev->netdev_ops == &qeth_l3_osa_netdev_ops ||
	    dev->netdev_ops == &qeth_l3_netdev_ops)
		return (struct qeth_card *) dev->ml_priv;
	return NULL;
}

F
Frank Blaschka 已提交
2580
static int qeth_l3_ip_event(struct notifier_block *this,
2581
			    unsigned long event, void *ptr)
F
Frank Blaschka 已提交
2582
{
2583

F
Frank Blaschka 已提交
2584
	struct in_ifaddr *ifa = (struct in_ifaddr *)ptr;
2585
	struct net_device *dev = ifa->ifa_dev->dev;
2586
	struct qeth_ipaddr addr;
F
Frank Blaschka 已提交
2587 2588
	struct qeth_card *card;

2589
	if (dev_net(dev) != &init_net)
2590 2591
		return NOTIFY_DONE;

F
Frank Blaschka 已提交
2592 2593 2594
	card = qeth_l3_get_card_from_dev(dev);
	if (!card)
		return NOTIFY_DONE;
2595
	QETH_CARD_TEXT(card, 3, "ipevent");
F
Frank Blaschka 已提交
2596

2597 2598 2599
	qeth_l3_init_ipaddr(&addr, QETH_IP_TYPE_NORMAL, QETH_PROT_IPV4);
	addr.u.a4.addr = be32_to_cpu(ifa->ifa_address);
	addr.u.a4.mask = be32_to_cpu(ifa->ifa_mask);
2600

2601
	return qeth_l3_handle_ip_event(card, &addr, event);
F
Frank Blaschka 已提交
2602 2603 2604 2605 2606 2607 2608 2609
}

static struct notifier_block qeth_l3_ip_notifier = {
	qeth_l3_ip_event,
	NULL,
};

static int qeth_l3_ip6_event(struct notifier_block *this,
2610
			     unsigned long event, void *ptr)
F
Frank Blaschka 已提交
2611 2612
{
	struct inet6_ifaddr *ifa = (struct inet6_ifaddr *)ptr;
2613
	struct net_device *dev = ifa->idev->dev;
2614
	struct qeth_ipaddr addr;
F
Frank Blaschka 已提交
2615 2616 2617 2618 2619
	struct qeth_card *card;

	card = qeth_l3_get_card_from_dev(dev);
	if (!card)
		return NOTIFY_DONE;
C
Carsten Otte 已提交
2620
	QETH_CARD_TEXT(card, 3, "ip6event");
F
Frank Blaschka 已提交
2621 2622 2623
	if (!qeth_is_supported(card, IPA_IPV6))
		return NOTIFY_DONE;

2624 2625 2626
	qeth_l3_init_ipaddr(&addr, QETH_IP_TYPE_NORMAL, QETH_PROT_IPV6);
	addr.u.a6.addr = ifa->addr;
	addr.u.a6.pfxlen = ifa->prefix_len;
2627

2628
	return qeth_l3_handle_ip_event(card, &addr, event);
F
Frank Blaschka 已提交
2629 2630 2631 2632 2633 2634 2635 2636 2637 2638 2639
}

static struct notifier_block qeth_l3_ip6_notifier = {
	qeth_l3_ip6_event,
	NULL,
};

static int qeth_l3_register_notifiers(void)
{
	int rc;

C
Carsten Otte 已提交
2640
	QETH_DBF_TEXT(SETUP, 5, "regnotif");
F
Frank Blaschka 已提交
2641 2642 2643 2644 2645 2646 2647 2648 2649 2650 2651 2652 2653
	rc = register_inetaddr_notifier(&qeth_l3_ip_notifier);
	if (rc)
		return rc;
	rc = register_inet6addr_notifier(&qeth_l3_ip6_notifier);
	if (rc) {
		unregister_inetaddr_notifier(&qeth_l3_ip_notifier);
		return rc;
	}
	return 0;
}

static void qeth_l3_unregister_notifiers(void)
{
C
Carsten Otte 已提交
2654
	QETH_DBF_TEXT(SETUP, 5, "unregnot");
S
Stefan Raspl 已提交
2655 2656
	WARN_ON(unregister_inetaddr_notifier(&qeth_l3_ip_notifier));
	WARN_ON(unregister_inet6addr_notifier(&qeth_l3_ip6_notifier));
F
Frank Blaschka 已提交
2657 2658 2659 2660
}

static int __init qeth_l3_init(void)
{
2661
	pr_info("register layer 3 discipline\n");
J
Julian Wiedmann 已提交
2662
	return qeth_l3_register_notifiers();
F
Frank Blaschka 已提交
2663 2664 2665 2666 2667
}

static void __exit qeth_l3_exit(void)
{
	qeth_l3_unregister_notifiers();
2668
	pr_info("unregister layer 3 discipline\n");
F
Frank Blaschka 已提交
2669 2670 2671 2672 2673 2674 2675
}

module_init(qeth_l3_init);
module_exit(qeth_l3_exit);
MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>");
MODULE_DESCRIPTION("qeth layer 3 discipline");
MODULE_LICENSE("GPL");