qeth_l2_main.c 34.7 KB
Newer Older
F
Frank Blaschka 已提交
1 2 3
/*
 *  drivers/s390/net/qeth_l2_main.c
 *
4
 *    Copyright IBM Corp. 2007, 2009
F
Frank Blaschka 已提交
5 6 7 8 9 10
 *    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>
 */

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

F
Frank Blaschka 已提交
14 15 16 17 18
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/string.h>
#include <linux/errno.h>
#include <linux/kernel.h>
19
#include <linux/slab.h>
F
Frank Blaschka 已提交
20 21 22
#include <linux/etherdevice.h>
#include <linux/mii.h>
#include <linux/ip.h>
J
Jiri Pirko 已提交
23
#include <linux/list.h>
F
Frank Blaschka 已提交
24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39

#include "qeth_core.h"

static int qeth_l2_set_offline(struct ccwgroup_device *);
static int qeth_l2_stop(struct net_device *);
static int qeth_l2_send_delmac(struct qeth_card *, __u8 *);
static int qeth_l2_send_setdelmac(struct qeth_card *, __u8 *,
			   enum qeth_ipa_cmds,
			   int (*reply_cb) (struct qeth_card *,
					    struct qeth_reply*,
					    unsigned long));
static void qeth_l2_set_multicast_list(struct net_device *);
static int qeth_l2_recover(void *);

static int qeth_l2_do_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
{
40
	struct qeth_card *card = dev->ml_priv;
F
Frank Blaschka 已提交
41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58
	struct mii_ioctl_data *mii_data;
	int rc = 0;

	if (!card)
		return -ENODEV;

	if ((card->state != CARD_STATE_UP) &&
		(card->state != CARD_STATE_SOFTSETUP))
		return -ENODEV;

	if (card->info.type == QETH_CARD_TYPE_OSN)
		return -EPERM;

	switch (cmd) {
	case SIOC_QETH_ADP_SET_SNMP_CONTROL:
		rc = qeth_snmp_command(card, rq->ifr_ifru.ifru_data);
		break;
	case SIOC_QETH_GET_CARD_TYPE:
59 60 61
		if ((card->info.type == QETH_CARD_TYPE_OSD ||
		     card->info.type == QETH_CARD_TYPE_OSM ||
		     card->info.type == QETH_CARD_TYPE_OSX) &&
F
Frank Blaschka 已提交
62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81
		    !card->info.guestlan)
			return 1;
		return 0;
		break;
	case SIOCGMIIPHY:
		mii_data = if_mii(rq);
		mii_data->phy_id = 0;
		break;
	case SIOCGMIIREG:
		mii_data = if_mii(rq);
		if (mii_data->phy_id != 0)
			rc = -EINVAL;
		else
			mii_data->val_out = qeth_mdio_read(dev,
				mii_data->phy_id, mii_data->reg_num);
		break;
	default:
		rc = -EOPNOTSUPP;
	}
	if (rc)
C
Carsten Otte 已提交
82
		QETH_CARD_TEXT_(card, 2, "ioce%d", rc);
F
Frank Blaschka 已提交
83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107
	return rc;
}

static int qeth_l2_verify_dev(struct net_device *dev)
{
	struct qeth_card *card;
	unsigned long flags;
	int rc = 0;

	read_lock_irqsave(&qeth_core_card_list.rwlock, flags);
	list_for_each_entry(card, &qeth_core_card_list.list, list) {
		if (card->dev == dev) {
			rc = QETH_REAL_CARD;
			break;
		}
	}
	read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags);

	return rc;
}

static struct net_device *qeth_l2_netdev_by_devno(unsigned char *read_dev_no)
{
	struct qeth_card *card;
	struct net_device *ndev;
C
Cornelia Huck 已提交
108
	__u16 temp_dev_no;
F
Frank Blaschka 已提交
109
	unsigned long flags;
C
Cornelia Huck 已提交
110
	struct ccw_dev_id read_devid;
F
Frank Blaschka 已提交
111 112 113 114 115

	ndev = NULL;
	memcpy(&temp_dev_no, read_dev_no, 2);
	read_lock_irqsave(&qeth_core_card_list.rwlock, flags);
	list_for_each_entry(card, &qeth_core_card_list.list, list) {
C
Cornelia Huck 已提交
116 117
		ccw_device_get_id(CARD_RDEV(card), &read_devid);
		if (read_devid.devno == temp_dev_no) {
F
Frank Blaschka 已提交
118 119 120 121 122 123 124 125 126 127 128 129 130 131 132
			ndev = card->dev;
			break;
		}
	}
	read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags);
	return ndev;
}

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

C
Carsten Otte 已提交
133
	QETH_CARD_TEXT(card, 2, "L2Sgmacb");
F
Frank Blaschka 已提交
134 135 136
	cmd = (struct qeth_ipa_cmd *) data;
	mac = &cmd->data.setdelmac.mac[0];
	/* MAC already registered, needed in couple/uncouple case */
137
	if (cmd->hdr.return_code ==  IPA_RC_L2_DUP_MAC) {
J
Johannes Berg 已提交
138 139
		QETH_DBF_MESSAGE(2, "Group MAC %pM already existing on %s \n",
			  mac, QETH_CARD_IFNAME(card));
F
Frank Blaschka 已提交
140 141 142
		cmd->hdr.return_code = 0;
	}
	if (cmd->hdr.return_code)
J
Johannes Berg 已提交
143 144
		QETH_DBF_MESSAGE(2, "Could not set group MAC %pM on %s: %x\n",
			  mac, QETH_CARD_IFNAME(card), cmd->hdr.return_code);
F
Frank Blaschka 已提交
145 146 147 148 149
	return 0;
}

static int qeth_l2_send_setgroupmac(struct qeth_card *card, __u8 *mac)
{
C
Carsten Otte 已提交
150
	QETH_CARD_TEXT(card, 2, "L2Sgmac");
F
Frank Blaschka 已提交
151 152 153 154 155 156 157 158 159 160 161
	return qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETGMAC,
					  qeth_l2_send_setgroupmac_cb);
}

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

C
Carsten Otte 已提交
162
	QETH_CARD_TEXT(card, 2, "L2Dgmacb");
F
Frank Blaschka 已提交
163 164 165
	cmd = (struct qeth_ipa_cmd *) data;
	mac = &cmd->data.setdelmac.mac[0];
	if (cmd->hdr.return_code)
J
Johannes Berg 已提交
166 167
		QETH_DBF_MESSAGE(2, "Could not delete group MAC %pM on %s: %x\n",
			  mac, QETH_CARD_IFNAME(card), cmd->hdr.return_code);
F
Frank Blaschka 已提交
168 169 170 171 172
	return 0;
}

static int qeth_l2_send_delgroupmac(struct qeth_card *card, __u8 *mac)
{
C
Carsten Otte 已提交
173
	QETH_CARD_TEXT(card, 2, "L2Dgmac");
F
Frank Blaschka 已提交
174 175 176 177
	return qeth_l2_send_setdelmac(card, mac, IPA_CMD_DELGMAC,
					  qeth_l2_send_delgroupmac_cb);
}

178
static void qeth_l2_add_mc(struct qeth_card *card, __u8 *mac, int vmac)
F
Frank Blaschka 已提交
179 180
{
	struct qeth_mc_mac *mc;
181
	int rc;
F
Frank Blaschka 已提交
182 183 184

	mc = kmalloc(sizeof(struct qeth_mc_mac), GFP_ATOMIC);

185
	if (!mc)
F
Frank Blaschka 已提交
186 187 188 189
		return;

	memcpy(mc->mc_addr, mac, OSA_ADDR_LEN);
	mc->mc_addrlen = OSA_ADDR_LEN;
190 191 192 193 194 195 196 197
	mc->is_vmac = vmac;

	if (vmac) {
		rc = qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC,
					NULL);
	} else {
		rc = qeth_l2_send_setgroupmac(card, mac);
	}
F
Frank Blaschka 已提交
198

199
	if (!rc)
F
Frank Blaschka 已提交
200 201 202 203 204
		list_add_tail(&mc->list, &card->mc_list);
	else
		kfree(mc);
}

205
static void qeth_l2_del_all_mc(struct qeth_card *card, int del)
F
Frank Blaschka 已提交
206 207 208 209 210
{
	struct qeth_mc_mac *mc, *tmp;

	spin_lock_bh(&card->mclock);
	list_for_each_entry_safe(mc, tmp, &card->mc_list, list) {
211 212 213
		if (del) {
			if (mc->is_vmac)
				qeth_l2_send_setdelmac(card, mc->mc_addr,
214
					IPA_CMD_DELVMAC, NULL);
215 216 217
			else
				qeth_l2_send_delgroupmac(card, mc->mc_addr);
		}
F
Frank Blaschka 已提交
218 219 220 221 222 223
		list_del(&mc->list);
		kfree(mc);
	}
	spin_unlock_bh(&card->mclock);
}

224 225
static inline int qeth_l2_get_cast_type(struct qeth_card *card,
			struct sk_buff *skb)
F
Frank Blaschka 已提交
226
{
227 228 229 230 231 232 233
	if (card->info.type == QETH_CARD_TYPE_OSN)
		return RTN_UNSPEC;
	if (is_broadcast_ether_addr(skb->data))
		return RTN_BROADCAST;
	if (is_multicast_ether_addr(skb->data))
		return RTN_MULTICAST;
	return RTN_UNSPEC;
F
Frank Blaschka 已提交
234 235 236 237 238
}

static void qeth_l2_fill_header(struct qeth_card *card, struct qeth_hdr *hdr,
			struct sk_buff *skb, int ipv, int cast_type)
{
239
	struct vlan_ethhdr *veth = (struct vlan_ethhdr *)skb_mac_header(skb);
F
Frank Blaschka 已提交
240 241 242 243 244 245 246 247 248 249

	memset(hdr, 0, sizeof(struct qeth_hdr));
	hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2;

	/* set byte byte 3 to casting flags */
	if (cast_type == RTN_MULTICAST)
		hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST;
	else if (cast_type == RTN_BROADCAST)
		hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST;
	else
250
		hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST;
F
Frank Blaschka 已提交
251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266

	hdr->hdr.l2.pkt_length = skb->len-QETH_HEADER_SIZE;
	/* VSWITCH relies on the VLAN
	 * information to be present in
	 * the QDIO header */
	if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) {
		hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN;
		hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI);
	}
}

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

C
Carsten Otte 已提交
267
	QETH_CARD_TEXT(card, 2, "L2sdvcb");
F
Frank Blaschka 已提交
268 269
	cmd = (struct qeth_ipa_cmd *) data;
	if (cmd->hdr.return_code) {
270
		QETH_DBF_MESSAGE(2, "Error in processing VLAN %i on %s: 0x%x. "
F
Frank Blaschka 已提交
271 272
			  "Continuing\n", cmd->data.setdelvlan.vlan_id,
			  QETH_CARD_IFNAME(card), cmd->hdr.return_code);
C
Carsten Otte 已提交
273 274
		QETH_CARD_TEXT_(card, 2, "L2VL%4x", cmd->hdr.command);
		QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code);
F
Frank Blaschka 已提交
275 276 277 278 279 280 281 282 283 284
	}
	return 0;
}

static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i,
				enum qeth_ipa_cmds ipacmd)
{
	struct qeth_ipa_cmd *cmd;
	struct qeth_cmd_buffer *iob;

C
Carsten Otte 已提交
285
	QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd);
F
Frank Blaschka 已提交
286 287 288 289 290 291 292
	iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4);
	cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
	cmd->data.setdelvlan.vlan_id = i;
	return qeth_send_ipa_cmd(card, iob,
				 qeth_l2_send_setdelvlan_cb, NULL);
}

293
static void qeth_l2_process_vlans(struct qeth_card *card)
F
Frank Blaschka 已提交
294 295
{
	struct qeth_vlan_vid *id;
C
Carsten Otte 已提交
296
	QETH_CARD_TEXT(card, 3, "L2prcvln");
F
Frank Blaschka 已提交
297 298
	spin_lock_bh(&card->vlanlock);
	list_for_each_entry(id, &card->vid_list, list) {
299
		qeth_l2_send_setdelvlan(card, id->vid, IPA_CMD_SETVLAN);
F
Frank Blaschka 已提交
300 301 302 303 304 305
	}
	spin_unlock_bh(&card->vlanlock);
}

static void qeth_l2_vlan_rx_add_vid(struct net_device *dev, unsigned short vid)
{
306
	struct qeth_card *card = dev->ml_priv;
F
Frank Blaschka 已提交
307 308
	struct qeth_vlan_vid *id;

C
Carsten Otte 已提交
309
	QETH_CARD_TEXT_(card, 4, "aid:%d", vid);
U
Ursula Braun 已提交
310 311
	if (!vid)
		return;
312
	if (card->info.type == QETH_CARD_TYPE_OSM) {
C
Carsten Otte 已提交
313
		QETH_CARD_TEXT(card, 3, "aidOSM");
314 315
		return;
	}
316
	if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
C
Carsten Otte 已提交
317
		QETH_CARD_TEXT(card, 3, "aidREC");
318 319
		return;
	}
F
Frank Blaschka 已提交
320 321 322 323 324 325 326 327 328 329 330 331 332
	id = kmalloc(sizeof(struct qeth_vlan_vid), GFP_ATOMIC);
	if (id) {
		id->vid = vid;
		qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN);
		spin_lock_bh(&card->vlanlock);
		list_add_tail(&id->list, &card->vid_list);
		spin_unlock_bh(&card->vlanlock);
	}
}

static void qeth_l2_vlan_rx_kill_vid(struct net_device *dev, unsigned short vid)
{
	struct qeth_vlan_vid *id, *tmpid = NULL;
333
	struct qeth_card *card = dev->ml_priv;
F
Frank Blaschka 已提交
334

C
Carsten Otte 已提交
335
	QETH_CARD_TEXT_(card, 4, "kid:%d", vid);
336
	if (card->info.type == QETH_CARD_TYPE_OSM) {
C
Carsten Otte 已提交
337
		QETH_CARD_TEXT(card, 3, "kidOSM");
338 339
		return;
	}
340
	if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
C
Carsten Otte 已提交
341
		QETH_CARD_TEXT(card, 3, "kidREC");
342 343
		return;
	}
F
Frank Blaschka 已提交
344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363
	spin_lock_bh(&card->vlanlock);
	list_for_each_entry(id, &card->vid_list, list) {
		if (id->vid == vid) {
			list_del(&id->list);
			tmpid = id;
			break;
		}
	}
	spin_unlock_bh(&card->vlanlock);
	if (tmpid) {
		qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN);
		kfree(tmpid);
	}
	qeth_l2_set_multicast_list(card->dev);
}

static int qeth_l2_stop_card(struct qeth_card *card, int recovery_mode)
{
	int rc = 0;

364 365
	QETH_DBF_TEXT(SETUP , 2, "stopcard");
	QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
F
Frank Blaschka 已提交
366 367 368 369 370 371 372 373 374 375 376 377 378

	qeth_set_allowed_threads(card, 0, 1);
	if (card->read.state == CH_STATE_UP &&
	    card->write.state == CH_STATE_UP &&
	    (card->state == CARD_STATE_UP)) {
		if (recovery_mode &&
		    card->info.type != QETH_CARD_TYPE_OSN) {
			qeth_l2_stop(card->dev);
		} else {
			rtnl_lock();
			dev_close(card->dev);
			rtnl_unlock();
		}
379
		card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
F
Frank Blaschka 已提交
380 381 382
		card->state = CARD_STATE_SOFTSETUP;
	}
	if (card->state == CARD_STATE_SOFTSETUP) {
383
		qeth_l2_del_all_mc(card, 0);
F
Frank Blaschka 已提交
384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399
		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);
	}
	return rc;
}

400 401
static int qeth_l2_process_inbound_buffer(struct qeth_card *card,
				int budget, int *done)
F
Frank Blaschka 已提交
402
{
403
	int work_done = 0;
F
Frank Blaschka 已提交
404 405 406 407
	struct sk_buff *skb;
	struct qeth_hdr *hdr;
	unsigned int len;

408 409 410 411 412 413 414 415 416
	*done = 0;
	BUG_ON(!budget);
	while (budget) {
		skb = qeth_core_get_next_skb(card,
			card->qdio.in_q->bufs[card->rx.b_index].buffer,
			&card->rx.b_element, &card->rx.e_offset, &hdr);
		if (!skb) {
			*done = 1;
			break;
F
Frank Blaschka 已提交
417
		}
418
		skb->dev = card->dev;
F
Frank Blaschka 已提交
419 420 421 422 423 424 425 426
		switch (hdr->hdr.l2.id) {
		case QETH_HEADER_TYPE_LAYER2:
			skb->pkt_type = PACKET_HOST;
			skb->protocol = eth_type_trans(skb, skb->dev);
			if (card->options.checksum_type == NO_CHECKSUMMING)
				skb->ip_summed = CHECKSUM_UNNECESSARY;
			else
				skb->ip_summed = CHECKSUM_NONE;
427 428
			if (skb->protocol == htons(ETH_P_802_2))
				*((__u32 *)skb->cb) = ++card->seqno.pkt_seqno;
F
Frank Blaschka 已提交
429
			len = skb->len;
430
			netif_receive_skb(skb);
F
Frank Blaschka 已提交
431 432
			break;
		case QETH_HEADER_TYPE_OSN:
433 434 435
			if (card->info.type == QETH_CARD_TYPE_OSN) {
				skb_push(skb, sizeof(struct qeth_hdr));
				skb_copy_to_linear_data(skb, hdr,
F
Frank Blaschka 已提交
436
						sizeof(struct qeth_hdr));
437 438 439 440 441
				len = skb->len;
				card->osn_info.data_cb(skb);
				break;
			}
			/* else unknown */
F
Frank Blaschka 已提交
442 443
		default:
			dev_kfree_skb_any(skb);
C
Carsten Otte 已提交
444
			QETH_CARD_TEXT(card, 3, "inbunkno");
445
			QETH_DBF_HEX(CTRL, 3, hdr, QETH_DBF_CTRL_LEN);
F
Frank Blaschka 已提交
446 447
			continue;
		}
448 449
		work_done++;
		budget--;
F
Frank Blaschka 已提交
450 451 452
		card->stats.rx_packets++;
		card->stats.rx_bytes += len;
	}
453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528
	return work_done;
}

static int qeth_l2_poll(struct napi_struct *napi, int budget)
{
	struct qeth_card *card = container_of(napi, struct qeth_card, napi);
	int work_done = 0;
	struct qeth_qdio_buffer *buffer;
	int done;
	int new_budget = budget;

	if (card->options.performance_stats) {
		card->perf_stats.inbound_cnt++;
		card->perf_stats.inbound_start_time = qeth_get_micros();
	}

	while (1) {
		if (!card->rx.b_count) {
			card->rx.qdio_err = 0;
			card->rx.b_count = qdio_get_next_buffers(
				card->data.ccwdev, 0, &card->rx.b_index,
				&card->rx.qdio_err);
			if (card->rx.b_count <= 0) {
				card->rx.b_count = 0;
				break;
			}
			card->rx.b_element =
				&card->qdio.in_q->bufs[card->rx.b_index]
				.buffer->element[0];
			card->rx.e_offset = 0;
		}

		while (card->rx.b_count) {
			buffer = &card->qdio.in_q->bufs[card->rx.b_index];
			if (!(card->rx.qdio_err &&
			    qeth_check_qdio_errors(card, buffer->buffer,
			    card->rx.qdio_err, "qinerr")))
				work_done += qeth_l2_process_inbound_buffer(
					card, new_budget, &done);
			else
				done = 1;

			if (done) {
				if (card->options.performance_stats)
					card->perf_stats.bufs_rec++;
				qeth_put_buffer_pool_entry(card,
					buffer->pool_entry);
				qeth_queue_input_buffer(card, card->rx.b_index);
				card->rx.b_count--;
				if (card->rx.b_count) {
					card->rx.b_index =
						(card->rx.b_index + 1) %
						QDIO_MAX_BUFFERS_PER_Q;
					card->rx.b_element =
						&card->qdio.in_q
						->bufs[card->rx.b_index]
						.buffer->element[0];
					card->rx.e_offset = 0;
				}
			}

			if (work_done >= budget)
				goto out;
			else
				new_budget = budget - work_done;
		}
	}

	napi_complete(napi);
	if (qdio_start_irq(card->data.ccwdev, 0))
		napi_schedule(&card->napi);
out:
	if (card->options.performance_stats)
		card->perf_stats.inbound_time += qeth_get_micros() -
			card->perf_stats.inbound_start_time;
	return work_done;
F
Frank Blaschka 已提交
529 530 531 532 533 534 535 536 537 538 539
}

static int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac,
			   enum qeth_ipa_cmds ipacmd,
			   int (*reply_cb) (struct qeth_card *,
					    struct qeth_reply*,
					    unsigned long))
{
	struct qeth_ipa_cmd *cmd;
	struct qeth_cmd_buffer *iob;

C
Carsten Otte 已提交
540
	QETH_CARD_TEXT(card, 2, "L2sdmac");
F
Frank Blaschka 已提交
541 542 543 544 545 546 547 548 549 550 551 552 553
	iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4);
	cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
	cmd->data.setdelmac.mac_length = OSA_ADDR_LEN;
	memcpy(&cmd->data.setdelmac.mac, mac, OSA_ADDR_LEN);
	return qeth_send_ipa_cmd(card, iob, reply_cb, NULL);
}

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

C
Carsten Otte 已提交
554
	QETH_CARD_TEXT(card, 2, "L2Smaccb");
F
Frank Blaschka 已提交
555 556
	cmd = (struct qeth_ipa_cmd *) data;
	if (cmd->hdr.return_code) {
C
Carsten Otte 已提交
557
		QETH_CARD_TEXT_(card, 2, "L2er%x", cmd->hdr.return_code);
F
Frank Blaschka 已提交
558
		card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
559 560 561 562
		switch (cmd->hdr.return_code) {
		case IPA_RC_L2_DUP_MAC:
		case IPA_RC_L2_DUP_LAYER3_MAC:
			dev_warn(&card->gdev->dev,
563
				"MAC address %pM already exists\n",
564
				cmd->data.setdelmac.mac);
565 566 567 568
			break;
		case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP:
		case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP:
			dev_warn(&card->gdev->dev,
569
				"MAC address %pM is not authorized\n",
570
				cmd->data.setdelmac.mac);
571 572 573 574
			break;
		default:
			break;
		}
F
Frank Blaschka 已提交
575 576 577 578 579
		cmd->hdr.return_code = -EIO;
	} else {
		card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED;
		memcpy(card->dev->dev_addr, cmd->data.setdelmac.mac,
		       OSA_ADDR_LEN);
580
		dev_info(&card->gdev->dev,
581 582
			"MAC address %pM successfully registered on device %s\n",
			card->dev->dev_addr, card->dev->name);
F
Frank Blaschka 已提交
583 584 585 586 587 588
	}
	return 0;
}

static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac)
{
C
Carsten Otte 已提交
589
	QETH_CARD_TEXT(card, 2, "L2Setmac");
F
Frank Blaschka 已提交
590 591 592 593 594 595 596 597 598 599
	return qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC,
					  qeth_l2_send_setmac_cb);
}

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

C
Carsten Otte 已提交
600
	QETH_CARD_TEXT(card, 2, "L2Dmaccb");
F
Frank Blaschka 已提交
601 602
	cmd = (struct qeth_ipa_cmd *) data;
	if (cmd->hdr.return_code) {
C
Carsten Otte 已提交
603
		QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code);
F
Frank Blaschka 已提交
604 605 606 607 608 609 610 611 612 613
		cmd->hdr.return_code = -EIO;
		return 0;
	}
	card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;

	return 0;
}

static int qeth_l2_send_delmac(struct qeth_card *card, __u8 *mac)
{
C
Carsten Otte 已提交
614
	QETH_CARD_TEXT(card, 2, "L2Delmac");
F
Frank Blaschka 已提交
615 616 617 618 619 620 621 622 623 624 625
	if (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))
		return 0;
	return qeth_l2_send_setdelmac(card, mac, IPA_CMD_DELVMAC,
					  qeth_l2_send_delmac_cb);
}

static int qeth_l2_request_initial_mac(struct qeth_card *card)
{
	int rc = 0;
	char vendor_pre[] = {0x02, 0x00, 0x00};

626 627
	QETH_DBF_TEXT(SETUP, 2, "doL2init");
	QETH_DBF_TEXT_(SETUP, 2, "doL2%s", CARD_BUS_ID(card));
F
Frank Blaschka 已提交
628 629 630

	rc = qeth_query_setadapterparms(card);
	if (rc) {
631 632
		QETH_DBF_MESSAGE(2, "could not query adapter parameters on "
			"device %s: x%x\n", CARD_BUS_ID(card), rc);
F
Frank Blaschka 已提交
633 634
	}

635 636 637 638
	if (card->info.type == QETH_CARD_TYPE_IQD ||
	    card->info.type == QETH_CARD_TYPE_OSM ||
	    card->info.type == QETH_CARD_TYPE_OSX ||
	    card->info.guestlan) {
F
Frank Blaschka 已提交
639 640
		rc = qeth_setadpparms_change_macaddr(card);
		if (rc) {
641 642
			QETH_DBF_MESSAGE(2, "couldn't get MAC address on "
				"device %s: x%x\n", CARD_BUS_ID(card), rc);
643
			QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
F
Frank Blaschka 已提交
644 645
			return rc;
		}
646
		QETH_DBF_HEX(SETUP, 2, card->dev->dev_addr, OSA_ADDR_LEN);
F
Frank Blaschka 已提交
647 648 649 650 651 652 653 654 655 656
	} else {
		random_ether_addr(card->dev->dev_addr);
		memcpy(card->dev->dev_addr, vendor_pre, 3);
	}
	return 0;
}

static int qeth_l2_set_mac_address(struct net_device *dev, void *p)
{
	struct sockaddr *addr = p;
657
	struct qeth_card *card = dev->ml_priv;
F
Frank Blaschka 已提交
658 659
	int rc = 0;

C
Carsten Otte 已提交
660
	QETH_CARD_TEXT(card, 3, "setmac");
F
Frank Blaschka 已提交
661 662

	if (qeth_l2_verify_dev(dev) != QETH_REAL_CARD) {
C
Carsten Otte 已提交
663
		QETH_CARD_TEXT(card, 3, "setmcINV");
F
Frank Blaschka 已提交
664 665 666
		return -EOPNOTSUPP;
	}

667 668 669
	if (card->info.type == QETH_CARD_TYPE_OSN ||
	    card->info.type == QETH_CARD_TYPE_OSM ||
	    card->info.type == QETH_CARD_TYPE_OSX) {
C
Carsten Otte 已提交
670
		QETH_CARD_TEXT(card, 3, "setmcTYP");
F
Frank Blaschka 已提交
671 672
		return -EOPNOTSUPP;
	}
C
Carsten Otte 已提交
673
	QETH_CARD_HEX(card, 3, addr->sa_data, OSA_ADDR_LEN);
674
	if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
C
Carsten Otte 已提交
675
		QETH_CARD_TEXT(card, 3, "setmcREC");
676 677
		return -ERESTARTSYS;
	}
F
Frank Blaschka 已提交
678 679 680 681 682 683 684 685
	rc = qeth_l2_send_delmac(card, &card->dev->dev_addr[0]);
	if (!rc)
		rc = qeth_l2_send_setmac(card, addr->sa_data);
	return rc;
}

static void qeth_l2_set_multicast_list(struct net_device *dev)
{
686
	struct qeth_card *card = dev->ml_priv;
J
Jiri Pirko 已提交
687
	struct netdev_hw_addr *ha;
F
Frank Blaschka 已提交
688 689 690 691

	if (card->info.type == QETH_CARD_TYPE_OSN)
		return ;

C
Carsten Otte 已提交
692
	QETH_CARD_TEXT(card, 3, "setmulti");
693 694 695
	if (qeth_threads_running(card, QETH_RECOVER_THREAD) &&
	    (card->state != CARD_STATE_UP))
		return;
696
	qeth_l2_del_all_mc(card, 1);
F
Frank Blaschka 已提交
697
	spin_lock_bh(&card->mclock);
698 699
	netdev_for_each_mc_addr(ha, dev)
		qeth_l2_add_mc(card, ha->addr, 0);
700

701
	netdev_for_each_uc_addr(ha, dev)
J
Jiri Pirko 已提交
702
		qeth_l2_add_mc(card, ha->addr, 1);
703

F
Frank Blaschka 已提交
704 705 706 707 708 709 710 711 712 713 714
	spin_unlock_bh(&card->mclock);
	if (!qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE))
		return;
	qeth_setadp_promisc_mode(card);
}

static int qeth_l2_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
{
	int rc;
	struct qeth_hdr *hdr = NULL;
	int elements = 0;
715
	struct qeth_card *card = dev->ml_priv;
F
Frank Blaschka 已提交
716 717
	struct sk_buff *new_skb = skb;
	int ipv = qeth_get_ip_version(skb);
718
	int cast_type = qeth_l2_get_cast_type(card, skb);
F
Frank Blaschka 已提交
719 720 721
	struct qeth_qdio_out_q *queue = card->qdio.out_qs
		[qeth_get_priority_queue(card, skb, ipv, cast_type)];
	int tx_bytes = skb->len;
722 723 724
	int data_offset = -1;
	int elements_needed = 0;
	int hd_len = 0;
F
Frank Blaschka 已提交
725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743

	if ((card->state != CARD_STATE_UP) || !card->lan_online) {
		card->stats.tx_carrier_errors++;
		goto tx_drop;
	}

	if ((card->info.type == QETH_CARD_TYPE_OSN) &&
	    (skb->protocol == htons(ETH_P_IPV6)))
		goto tx_drop;

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

	if (card->info.type == QETH_CARD_TYPE_OSN)
		hdr = (struct qeth_hdr *)skb->data;
	else {
F
Frank Blaschka 已提交
744
		if (card->info.type == QETH_CARD_TYPE_IQD) {
745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764
			new_skb = skb;
			data_offset = ETH_HLEN;
			hd_len = ETH_HLEN;
			hdr = kmem_cache_alloc(qeth_core_header_cache,
						GFP_ATOMIC);
			if (!hdr)
				goto tx_drop;
			elements_needed++;
			skb_reset_mac_header(new_skb);
			qeth_l2_fill_header(card, hdr, new_skb, ipv, cast_type);
			hdr->hdr.l2.pkt_length = new_skb->len;
			memcpy(((char *)hdr) + sizeof(struct qeth_hdr),
				skb_mac_header(new_skb), ETH_HLEN);
		} else {
			/* create a clone with writeable headroom */
			new_skb = skb_realloc_headroom(skb,
						sizeof(struct qeth_hdr));
			if (!new_skb)
				goto tx_drop;
			hdr = (struct qeth_hdr *)skb_push(new_skb,
F
Frank Blaschka 已提交
765
						sizeof(struct qeth_hdr));
766 767 768
			skb_set_mac_header(new_skb, sizeof(struct qeth_hdr));
			qeth_l2_fill_header(card, hdr, new_skb, ipv, cast_type);
		}
F
Frank Blaschka 已提交
769 770
	}

F
Frank Blaschka 已提交
771
	elements = qeth_get_elements_no(card, (void *)hdr, new_skb,
772
						elements_needed);
F
Frank Blaschka 已提交
773 774 775 776
	if (!elements) {
		if (data_offset >= 0)
			kmem_cache_free(qeth_core_header_cache, hdr);
		goto tx_drop;
777
	}
F
Frank Blaschka 已提交
778

779 780 781 782
	if (card->info.type != QETH_CARD_TYPE_IQD) {
		if (qeth_hdr_chk_and_bounce(new_skb,
		    sizeof(struct qeth_hdr_layer2)))
			goto tx_drop;
F
Frank Blaschka 已提交
783
		rc = qeth_do_send_packet(card, queue, new_skb, hdr,
F
Frank Blaschka 已提交
784
					 elements);
785
	} else
F
Frank Blaschka 已提交
786
		rc = qeth_do_send_packet_fast(card, queue, new_skb, hdr,
F
Frank Blaschka 已提交
787
					elements, data_offset, hd_len);
F
Frank Blaschka 已提交
788 789 790 791 792
	if (!rc) {
		card->stats.tx_packets++;
		card->stats.tx_bytes += tx_bytes;
		if (new_skb != skb)
			dev_kfree_skb_any(skb);
793
		rc = NETDEV_TX_OK;
F
Frank Blaschka 已提交
794
	} else {
795 796 797
		if (data_offset >= 0)
			kmem_cache_free(qeth_core_header_cache, hdr);

F
Frank Blaschka 已提交
798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817
		if (rc == -EBUSY) {
			if (new_skb != skb)
				dev_kfree_skb_any(new_skb);
			return NETDEV_TX_BUSY;
		} else
			goto tx_drop;
	}

	netif_wake_queue(dev);
	if (card->options.performance_stats)
		card->perf_stats.outbound_time += qeth_get_micros() -
			card->perf_stats.outbound_start_time;
	return rc;

tx_drop:
	card->stats.tx_dropped++;
	card->stats.tx_errors++;
	if ((new_skb != skb) && new_skb)
		dev_kfree_skb_any(new_skb);
	dev_kfree_skb_any(skb);
818
	netif_wake_queue(dev);
F
Frank Blaschka 已提交
819 820 821
	return NETDEV_TX_OK;
}

822
static int __qeth_l2_open(struct net_device *dev)
F
Frank Blaschka 已提交
823
{
824
	struct qeth_card *card = dev->ml_priv;
825
	int rc = 0;
F
Frank Blaschka 已提交
826

C
Carsten Otte 已提交
827
	QETH_CARD_TEXT(card, 4, "qethopen");
828 829
	if (card->state == CARD_STATE_UP)
		return rc;
F
Frank Blaschka 已提交
830 831 832 833 834
	if (card->state != CARD_STATE_SOFTSETUP)
		return -ENODEV;

	if ((card->info.type != QETH_CARD_TYPE_OSN) &&
	     (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))) {
C
Carsten Otte 已提交
835
		QETH_CARD_TEXT(card, 4, "nomacadr");
F
Frank Blaschka 已提交
836 837 838 839 840 841
		return -EPERM;
	}
	card->data.state = CH_STATE_UP;
	card->state = CARD_STATE_UP;
	netif_start_queue(dev);

842 843 844 845 846 847
	if (qdio_stop_irq(card->data.ccwdev, 0) >= 0) {
		napi_enable(&card->napi);
		napi_schedule(&card->napi);
	} else
		rc = -EIO;
	return rc;
F
Frank Blaschka 已提交
848 849
}

850 851 852 853 854 855 856 857 858 859 860 861
static int qeth_l2_open(struct net_device *dev)
{
	struct qeth_card *card = dev->ml_priv;

	QETH_CARD_TEXT(card, 5, "qethope_");
	if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
		QETH_CARD_TEXT(card, 3, "openREC");
		return -ERESTARTSYS;
	}
	return __qeth_l2_open(dev);
}

F
Frank Blaschka 已提交
862 863
static int qeth_l2_stop(struct net_device *dev)
{
864
	struct qeth_card *card = dev->ml_priv;
F
Frank Blaschka 已提交
865

C
Carsten Otte 已提交
866
	QETH_CARD_TEXT(card, 4, "qethstop");
F
Frank Blaschka 已提交
867
	netif_tx_disable(dev);
868
	if (card->state == CARD_STATE_UP) {
F
Frank Blaschka 已提交
869
		card->state = CARD_STATE_SOFTSETUP;
870 871
		napi_disable(&card->napi);
	}
F
Frank Blaschka 已提交
872 873 874 875 876 877 878 879 880 881
	return 0;
}

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

	INIT_LIST_HEAD(&card->vid_list);
	INIT_LIST_HEAD(&card->mc_list);
	card->options.layer2 = 1;
882
	card->discipline.start_poll = qeth_qdio_start_poll;
F
Frank Blaschka 已提交
883
	card->discipline.input_handler = (qdio_handler_t *)
884
		qeth_qdio_input_handler;
F
Frank Blaschka 已提交
885 886 887 888 889 890 891 892 893 894
	card->discipline.output_handler = (qdio_handler_t *)
		qeth_qdio_output_handler;
	card->discipline.recover = qeth_l2_recover;
	return 0;
}

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

895
	qeth_set_allowed_threads(card, 0, 1);
F
Frank Blaschka 已提交
896 897
	wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0);

898
	if (cgdev->state == CCWGROUP_ONLINE)
F
Frank Blaschka 已提交
899 900 901 902 903 904 905 906 907
		qeth_l2_set_offline(cgdev);

	if (card->dev) {
		unregister_netdev(card->dev);
		card->dev = NULL;
	}
	return;
}

908
static const struct ethtool_ops qeth_l2_ethtool_ops = {
F
Frank Blaschka 已提交
909 910 911
	.get_link = ethtool_op_get_link,
	.get_strings = qeth_core_get_strings,
	.get_ethtool_stats = qeth_core_get_ethtool_stats,
912
	.get_sset_count = qeth_core_get_sset_count,
F
Frank Blaschka 已提交
913
	.get_drvinfo = qeth_core_get_drvinfo,
914
	.get_settings = qeth_core_ethtool_get_settings,
F
Frank Blaschka 已提交
915 916
};

917
static const struct ethtool_ops qeth_l2_osn_ops = {
F
Frank Blaschka 已提交
918 919
	.get_strings = qeth_core_get_strings,
	.get_ethtool_stats = qeth_core_get_ethtool_stats,
920
	.get_sset_count = qeth_core_get_sset_count,
F
Frank Blaschka 已提交
921 922 923
	.get_drvinfo = qeth_core_get_drvinfo,
};

F
Frank Blaschka 已提交
924
static const struct net_device_ops qeth_l2_netdev_ops = {
F
Frank Blaschka 已提交
925 926 927 928 929 930 931 932 933 934 935 936 937 938
	.ndo_open		= qeth_l2_open,
	.ndo_stop		= qeth_l2_stop,
	.ndo_get_stats		= qeth_get_stats,
	.ndo_start_xmit		= qeth_l2_hard_start_xmit,
	.ndo_validate_addr	= eth_validate_addr,
	.ndo_set_multicast_list = qeth_l2_set_multicast_list,
	.ndo_do_ioctl	   	= qeth_l2_do_ioctl,
	.ndo_set_mac_address    = qeth_l2_set_mac_address,
	.ndo_change_mtu	   	= qeth_change_mtu,
	.ndo_vlan_rx_add_vid	= qeth_l2_vlan_rx_add_vid,
	.ndo_vlan_rx_kill_vid   = qeth_l2_vlan_rx_kill_vid,
	.ndo_tx_timeout	   	= qeth_tx_timeout,
};

F
Frank Blaschka 已提交
939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955
static int qeth_l2_setup_netdev(struct qeth_card *card)
{
	switch (card->info.type) {
	case QETH_CARD_TYPE_IQD:
		card->dev = alloc_netdev(0, "hsi%d", ether_setup);
		break;
	case QETH_CARD_TYPE_OSN:
		card->dev = alloc_netdev(0, "osn%d", ether_setup);
		card->dev->flags |= IFF_NOARP;
		break;
	default:
		card->dev = alloc_etherdev(0);
	}

	if (!card->dev)
		return -ENODEV;

956
	card->dev->ml_priv = card;
F
Frank Blaschka 已提交
957 958
	card->dev->watchdog_timeo = QETH_TX_TIMEOUT;
	card->dev->mtu = card->info.initial_mtu;
F
Frank Blaschka 已提交
959
	card->dev->netdev_ops = &qeth_l2_netdev_ops;
F
Frank Blaschka 已提交
960 961 962 963 964 965 966 967
	if (card->info.type != QETH_CARD_TYPE_OSN)
		SET_ETHTOOL_OPS(card->dev, &qeth_l2_ethtool_ops);
	else
		SET_ETHTOOL_OPS(card->dev, &qeth_l2_osn_ops);
	card->dev->features |= NETIF_F_HW_VLAN_FILTER;
	card->info.broadcast_capable = 1;
	qeth_l2_request_initial_mac(card);
	SET_NETDEV_DEV(card->dev, &card->gdev->dev);
968
	netif_napi_add(card->dev, &card->napi, qeth_l2_poll, QETH_NAPI_WEIGHT);
F
Frank Blaschka 已提交
969 970 971 972 973 974 975 976 977 978
	return register_netdev(card->dev);
}

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

	BUG_ON(!card);
979
	mutex_lock(&card->discipline_mutex);
980
	mutex_lock(&card->conf_mutex);
981 982
	QETH_DBF_TEXT(SETUP, 2, "setonlin");
	QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
F
Frank Blaschka 已提交
983 984 985 986

	recover_flag = card->state;
	rc = qeth_core_hardsetup_card(card);
	if (rc) {
987
		QETH_DBF_TEXT_(SETUP, 2, "2err%d", rc);
988
		rc = -ENODEV;
F
Frank Blaschka 已提交
989 990 991
		goto out_remove;
	}

992 993
	if (!card->dev && qeth_l2_setup_netdev(card)) {
		rc = -ENODEV;
F
Frank Blaschka 已提交
994
		goto out_remove;
995
	}
F
Frank Blaschka 已提交
996 997 998 999 1000

	if (card->info.type != QETH_CARD_TYPE_OSN)
		qeth_l2_send_setmac(card, &card->dev->dev_addr[0]);

	card->state = CARD_STATE_HARDSETUP;
1001
	memset(&card->rx, 0, sizeof(struct qeth_rx));
F
Frank Blaschka 已提交
1002 1003 1004
	qeth_print_status_message(card);

	/* softsetup */
1005
	QETH_DBF_TEXT(SETUP, 2, "softsetp");
F
Frank Blaschka 已提交
1006 1007 1008

	rc = qeth_send_startlan(card);
	if (rc) {
1009
		QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
F
Frank Blaschka 已提交
1010
		if (rc == 0xe080) {
1011 1012
			dev_warn(&card->gdev->dev,
				"The LAN is offline\n");
F
Frank Blaschka 已提交
1013
			card->lan_online = 0;
1014
			goto contin;
F
Frank Blaschka 已提交
1015
		}
1016
		rc = -ENODEV;
1017
		goto out_remove;
F
Frank Blaschka 已提交
1018 1019 1020
	} else
		card->lan_online = 1;

1021
contin:
1022 1023
	if ((card->info.type == QETH_CARD_TYPE_OSD) ||
	    (card->info.type == QETH_CARD_TYPE_OSX))
E
Einar Lueck 已提交
1024 1025
		/* configure isolation level */
		qeth_set_access_ctrl_online(card);
1026 1027 1028

	if (card->info.type != QETH_CARD_TYPE_OSN &&
	    card->info.type != QETH_CARD_TYPE_OSM)
1029
		qeth_l2_process_vlans(card);
F
Frank Blaschka 已提交
1030 1031 1032 1033 1034

	netif_tx_disable(card->dev);

	rc = qeth_init_qdio_queues(card);
	if (rc) {
1035
		QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc);
1036
		rc = -ENODEV;
F
Frank Blaschka 已提交
1037 1038 1039
		goto out_remove;
	}
	card->state = CARD_STATE_SOFTSETUP;
1040 1041 1042 1043
	if (card->lan_online)
		netif_carrier_on(card->dev);
	else
		netif_carrier_off(card->dev);
F
Frank Blaschka 已提交
1044 1045 1046 1047 1048

	qeth_set_allowed_threads(card, 0xffffffff, 0);
	if (recover_flag == CARD_STATE_RECOVER) {
		if (recovery_mode &&
		    card->info.type != QETH_CARD_TYPE_OSN) {
1049
			__qeth_l2_open(card->dev);
F
Frank Blaschka 已提交
1050 1051 1052 1053 1054 1055 1056 1057 1058 1059
		} else {
			rtnl_lock();
			dev_open(card->dev);
			rtnl_unlock();
		}
		/* this also sets saved unicast addresses */
		qeth_l2_set_multicast_list(card->dev);
	}
	/* let user_space know that device is online */
	kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE);
1060
	mutex_unlock(&card->conf_mutex);
1061
	mutex_unlock(&card->discipline_mutex);
F
Frank Blaschka 已提交
1062
	return 0;
1063

F
Frank Blaschka 已提交
1064 1065 1066 1067 1068 1069 1070 1071 1072
out_remove:
	qeth_l2_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));
	if (recover_flag == CARD_STATE_RECOVER)
		card->state = CARD_STATE_RECOVER;
	else
		card->state = CARD_STATE_DOWN;
1073
	mutex_unlock(&card->conf_mutex);
1074
	mutex_unlock(&card->discipline_mutex);
1075
	return rc;
F
Frank Blaschka 已提交
1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089
}

static int qeth_l2_set_online(struct ccwgroup_device *gdev)
{
	return __qeth_l2_set_online(gdev, 0);
}

static int __qeth_l2_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;

1090
	mutex_lock(&card->discipline_mutex);
1091
	mutex_lock(&card->conf_mutex);
1092 1093
	QETH_DBF_TEXT(SETUP, 3, "setoffl");
	QETH_DBF_HEX(SETUP, 3, &card, sizeof(void *));
F
Frank Blaschka 已提交
1094 1095 1096 1097

	if (card->dev && netif_carrier_ok(card->dev))
		netif_carrier_off(card->dev);
	recover_flag = card->state;
1098
	qeth_l2_stop_card(card, recovery_mode);
F
Frank Blaschka 已提交
1099 1100 1101 1102 1103 1104
	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)
1105
		QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
F
Frank Blaschka 已提交
1106 1107 1108 1109
	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);
1110
	mutex_unlock(&card->conf_mutex);
1111
	mutex_unlock(&card->discipline_mutex);
F
Frank Blaschka 已提交
1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125
	return 0;
}

static int qeth_l2_set_offline(struct ccwgroup_device *cgdev)
{
	return __qeth_l2_set_offline(cgdev, 0);
}

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

	card = (struct qeth_card *) ptr;
C
Carsten Otte 已提交
1126
	QETH_CARD_TEXT(card, 2, "recover1");
F
Frank Blaschka 已提交
1127 1128
	if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD))
		return 0;
C
Carsten Otte 已提交
1129
	QETH_CARD_TEXT(card, 2, "recover2");
1130 1131
	dev_warn(&card->gdev->dev,
		"A recovery process has been started for the device\n");
F
Frank Blaschka 已提交
1132 1133 1134
	__qeth_l2_set_offline(card->gdev, 1);
	rc = __qeth_l2_set_online(card->gdev, 1);
	if (!rc)
1135 1136
		dev_info(&card->gdev->dev,
			"Device successfully recovered!\n");
1137
	else {
1138 1139 1140
		rtnl_lock();
		dev_close(card->dev);
		rtnl_unlock();
1141 1142
		dev_warn(&card->gdev->dev, "The qeth device driver "
			"failed to recover an error on the device\n");
1143
	}
1144 1145
	qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD);
	qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD);
F
Frank Blaschka 已提交
1146 1147 1148 1149 1150
	return 0;
}

static int __init qeth_l2_init(void)
{
1151
	pr_info("register layer 2 discipline\n");
F
Frank Blaschka 已提交
1152 1153 1154 1155 1156
	return 0;
}

static void __exit qeth_l2_exit(void)
{
1157
	pr_info("unregister layer 2 discipline\n");
F
Frank Blaschka 已提交
1158 1159 1160 1161 1162 1163 1164 1165 1166
}

static void qeth_l2_shutdown(struct ccwgroup_device *gdev)
{
	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
	qeth_qdio_clear_card(card, 0);
	qeth_clear_qdio_buffers(card);
}

1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194
static int qeth_l2_pm_suspend(struct ccwgroup_device *gdev)
{
	struct qeth_card *card = dev_get_drvdata(&gdev->dev);

	if (card->dev)
		netif_device_detach(card->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) {
		__qeth_l2_set_offline(card->gdev, 1);
	} else
		__qeth_l2_set_offline(card->gdev, 0);
	return 0;
}

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

	if (gdev->state == CCWGROUP_OFFLINE)
		goto out;

	if (card->state == CARD_STATE_RECOVER) {
		rc = __qeth_l2_set_online(card->gdev, 1);
		if (rc) {
1195 1196 1197
			rtnl_lock();
			dev_close(card->dev);
			rtnl_unlock();
1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210
		}
	} else
		rc = __qeth_l2_set_online(card->gdev, 0);
out:
	qeth_set_allowed_threads(card, 0xffffffff, 0);
	if (card->dev)
		netif_device_attach(card->dev);
	if (rc)
		dev_warn(&card->gdev->dev, "The qeth device driver "
			"failed to recover an error on the device\n");
	return rc;
}

F
Frank Blaschka 已提交
1211 1212 1213 1214 1215 1216
struct ccwgroup_driver qeth_l2_ccwgroup_driver = {
	.probe = qeth_l2_probe_device,
	.remove = qeth_l2_remove_device,
	.set_online = qeth_l2_set_online,
	.set_offline = qeth_l2_set_offline,
	.shutdown = qeth_l2_shutdown,
1217 1218 1219
	.freeze = qeth_l2_pm_suspend,
	.thaw = qeth_l2_pm_resume,
	.restore = qeth_l2_pm_resume,
F
Frank Blaschka 已提交
1220 1221 1222 1223 1224 1225 1226 1227 1228
};
EXPORT_SYMBOL_GPL(qeth_l2_ccwgroup_driver);

static int qeth_osn_send_control_data(struct qeth_card *card, int len,
			   struct qeth_cmd_buffer *iob)
{
	unsigned long flags;
	int rc = 0;

C
Carsten Otte 已提交
1229
	QETH_CARD_TEXT(card, 5, "osndctrd");
F
Frank Blaschka 已提交
1230 1231 1232 1233

	wait_event(card->wait_q,
		   atomic_cmpxchg(&card->write.irq_pending, 0, 1) == 0);
	qeth_prepare_control_data(card, len, iob);
C
Carsten Otte 已提交
1234
	QETH_CARD_TEXT(card, 6, "osnoirqp");
F
Frank Blaschka 已提交
1235 1236 1237 1238 1239
	spin_lock_irqsave(get_ccwdev_lock(card->write.ccwdev), flags);
	rc = ccw_device_start(card->write.ccwdev, &card->write.ccw,
			      (addr_t) iob, 0, 0);
	spin_unlock_irqrestore(get_ccwdev_lock(card->write.ccwdev), flags);
	if (rc) {
1240
		QETH_DBF_MESSAGE(2, "qeth_osn_send_control_data: "
F
Frank Blaschka 已提交
1241
			   "ccw_device_start rc = %i\n", rc);
C
Carsten Otte 已提交
1242
		QETH_CARD_TEXT_(card, 2, " err%d", rc);
F
Frank Blaschka 已提交
1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254
		qeth_release_buffer(iob->channel, iob);
		atomic_set(&card->write.irq_pending, 0);
		wake_up(&card->wait_q);
	}
	return rc;
}

static int qeth_osn_send_ipa_cmd(struct qeth_card *card,
			struct qeth_cmd_buffer *iob, int data_len)
{
	u16 s1, s2;

C
Carsten Otte 已提交
1255
	QETH_CARD_TEXT(card, 4, "osndipa");
F
Frank Blaschka 已提交
1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274

	qeth_prepare_ipa_cmd(card, iob, QETH_PROT_OSN2);
	s1 = (u16)(IPA_PDU_HEADER_SIZE + data_len);
	s2 = (u16)data_len;
	memcpy(QETH_IPA_PDU_LEN_TOTAL(iob->data), &s1, 2);
	memcpy(QETH_IPA_PDU_LEN_PDU1(iob->data), &s2, 2);
	memcpy(QETH_IPA_PDU_LEN_PDU2(iob->data), &s2, 2);
	memcpy(QETH_IPA_PDU_LEN_PDU3(iob->data), &s2, 2);
	return qeth_osn_send_control_data(card, s1, iob);
}

int qeth_osn_assist(struct net_device *dev, void *data, int data_len)
{
	struct qeth_cmd_buffer *iob;
	struct qeth_card *card;
	int rc;

	if (!dev)
		return -ENODEV;
1275
	card = dev->ml_priv;
F
Frank Blaschka 已提交
1276 1277
	if (!card)
		return -ENODEV;
C
Carsten Otte 已提交
1278
	QETH_CARD_TEXT(card, 2, "osnsdmc");
F
Frank Blaschka 已提交
1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297
	if ((card->state != CARD_STATE_UP) &&
	    (card->state != CARD_STATE_SOFTSETUP))
		return -ENODEV;
	iob = qeth_wait_for_buffer(&card->write);
	memcpy(iob->data+IPA_PDU_HEADER_SIZE, data, data_len);
	rc = qeth_osn_send_ipa_cmd(card, iob, data_len);
	return rc;
}
EXPORT_SYMBOL(qeth_osn_assist);

int qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev,
		  int (*assist_cb)(struct net_device *, void *),
		  int (*data_cb)(struct sk_buff *))
{
	struct qeth_card *card;

	*dev = qeth_l2_netdev_by_devno(read_dev_no);
	if (*dev == NULL)
		return -ENODEV;
1298
	card = (*dev)->ml_priv;
F
Frank Blaschka 已提交
1299 1300
	if (!card)
		return -ENODEV;
C
Carsten Otte 已提交
1301
	QETH_CARD_TEXT(card, 2, "osnreg");
F
Frank Blaschka 已提交
1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315
	if ((assist_cb == NULL) || (data_cb == NULL))
		return -EINVAL;
	card->osn_info.assist_cb = assist_cb;
	card->osn_info.data_cb = data_cb;
	return 0;
}
EXPORT_SYMBOL(qeth_osn_register);

void qeth_osn_deregister(struct net_device *dev)
{
	struct qeth_card *card;

	if (!dev)
		return;
1316
	card = dev->ml_priv;
F
Frank Blaschka 已提交
1317 1318
	if (!card)
		return;
C
Carsten Otte 已提交
1319
	QETH_CARD_TEXT(card, 2, "osndereg");
F
Frank Blaschka 已提交
1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330
	card->osn_info.assist_cb = NULL;
	card->osn_info.data_cb = NULL;
	return;
}
EXPORT_SYMBOL(qeth_osn_deregister);

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