qeth_core_main.c 167.9 KB
Newer Older
1
// SPDX-License-Identifier: GPL-2.0
2
/*
3
 *    Copyright IBM Corp. 2007, 2009
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

13
#include <linux/compat.h>
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/log2.h>
20 21 22
#include <linux/ip.h>
#include <linux/tcp.h>
#include <linux/mii.h>
23
#include <linux/mm.h>
24
#include <linux/kthread.h>
25
#include <linux/slab.h>
26 27 28 29
#include <linux/if_vlan.h>
#include <linux/netdevice.h>
#include <linux/netdev_features.h>
#include <linux/skbuff.h>
30
#include <linux/vmalloc.h>
31

32
#include <net/iucv/af_iucv.h>
33
#include <net/dsfield.h>
34

35
#include <asm/ebcdic.h>
36
#include <asm/chpid.h>
37
#include <asm/io.h>
38
#include <asm/sysinfo.h>
39 40 41
#include <asm/diag.h>
#include <asm/cio.h>
#include <asm/ccwdev.h>
42
#include <asm/cpcmd.h>
43 44 45

#include "qeth_core.h"

46 47 48 49 50
struct qeth_dbf_info qeth_dbf[QETH_DBF_INFOS] = {
	/* define dbf - Name, Pages, Areas, Maxlen, Level, View, Handle */
	/*                   N  P  A    M  L  V                      H  */
	[QETH_DBF_SETUP] = {"qeth_setup",
				8, 1,   8, 5, &debug_hex_ascii_view, NULL},
51 52
	[QETH_DBF_MSG]	 = {"qeth_msg", 8, 1, 11 * sizeof(long), 3,
			    &debug_sprintf_view, NULL},
53 54 55 56
	[QETH_DBF_CTRL]  = {"qeth_control",
		8, 1, QETH_DBF_CTRL_LEN, 5, &debug_hex_ascii_view, NULL},
};
EXPORT_SYMBOL_GPL(qeth_dbf);
57

58 59
struct kmem_cache *qeth_core_header_cache;
EXPORT_SYMBOL_GPL(qeth_core_header_cache);
60
static struct kmem_cache *qeth_qdio_outbuf_cache;
61 62 63 64

static struct device *qeth_core_root_dev;
static struct lock_class_key qdio_out_skb_queue_key;

65 66 67
static void qeth_issue_next_read_cb(struct qeth_card *card,
				    struct qeth_channel *channel,
				    struct qeth_cmd_buffer *iob);
68 69 70
static struct qeth_cmd_buffer *qeth_get_buffer(struct qeth_channel *);
static void qeth_free_buffer_pool(struct qeth_card *);
static int qeth_qdio_establish(struct qeth_card *);
71
static void qeth_free_qdio_queues(struct qeth_card *card);
72 73 74 75
static void qeth_notify_skbs(struct qeth_qdio_out_q *queue,
		struct qeth_qdio_out_buffer *buf,
		enum iucv_tx_notify notification);
static void qeth_release_skbs(struct qeth_qdio_out_buffer *buf);
76
static int qeth_init_qdio_out_buf(struct qeth_qdio_out_q *, int);
77

S
Stefan Raspl 已提交
78 79 80 81 82 83 84 85 86
static void qeth_close_dev_handler(struct work_struct *work)
{
	struct qeth_card *card;

	card = container_of(work, struct qeth_card, close_dev_work);
	QETH_CARD_TEXT(card, 2, "cldevhdl");
	ccwgroup_set_offline(card->gdev);
}

87
static const char *qeth_get_cardname(struct qeth_card *card)
88
{
89
	if (IS_VM_NIC(card)) {
90
		switch (card->info.type) {
91
		case QETH_CARD_TYPE_OSD:
92
			return " Virtual NIC QDIO";
93
		case QETH_CARD_TYPE_IQD:
94
			return " Virtual NIC Hiper";
95
		case QETH_CARD_TYPE_OSM:
96
			return " Virtual NIC QDIO - OSM";
97
		case QETH_CARD_TYPE_OSX:
98
			return " Virtual NIC QDIO - OSX";
99 100 101 102 103
		default:
			return " unknown";
		}
	} else {
		switch (card->info.type) {
104
		case QETH_CARD_TYPE_OSD:
105 106 107 108 109
			return " OSD Express";
		case QETH_CARD_TYPE_IQD:
			return " HiperSockets";
		case QETH_CARD_TYPE_OSN:
			return " OSN QDIO";
110 111 112 113
		case QETH_CARD_TYPE_OSM:
			return " OSM QDIO";
		case QETH_CARD_TYPE_OSX:
			return " OSX QDIO";
114 115 116 117 118 119 120 121 122 123
		default:
			return " unknown";
		}
	}
	return " n/a";
}

/* max length to be returned: 14 */
const char *qeth_get_cardname_short(struct qeth_card *card)
{
124
	if (IS_VM_NIC(card)) {
125
		switch (card->info.type) {
126
		case QETH_CARD_TYPE_OSD:
127
			return "Virt.NIC QDIO";
128
		case QETH_CARD_TYPE_IQD:
129
			return "Virt.NIC Hiper";
130
		case QETH_CARD_TYPE_OSM:
131
			return "Virt.NIC OSM";
132
		case QETH_CARD_TYPE_OSX:
133
			return "Virt.NIC OSX";
134 135 136 137 138
		default:
			return "unknown";
		}
	} else {
		switch (card->info.type) {
139
		case QETH_CARD_TYPE_OSD:
140 141 142 143 144 145 146 147 148
			switch (card->info.link_type) {
			case QETH_LINK_TYPE_FAST_ETH:
				return "OSD_100";
			case QETH_LINK_TYPE_HSTR:
				return "HSTR";
			case QETH_LINK_TYPE_GBIT_ETH:
				return "OSD_1000";
			case QETH_LINK_TYPE_10GBIT_ETH:
				return "OSD_10GIG";
149 150
			case QETH_LINK_TYPE_25GBIT_ETH:
				return "OSD_25GIG";
151 152 153 154 155 156 157 158 159 160 161 162 163 164 165
			case QETH_LINK_TYPE_LANE_ETH100:
				return "OSD_FE_LANE";
			case QETH_LINK_TYPE_LANE_TR:
				return "OSD_TR_LANE";
			case QETH_LINK_TYPE_LANE_ETH1000:
				return "OSD_GbE_LANE";
			case QETH_LINK_TYPE_LANE:
				return "OSD_ATM_LANE";
			default:
				return "OSD_Express";
			}
		case QETH_CARD_TYPE_IQD:
			return "HiperSockets";
		case QETH_CARD_TYPE_OSN:
			return "OSN";
166 167 168 169
		case QETH_CARD_TYPE_OSM:
			return "OSM_1000";
		case QETH_CARD_TYPE_OSX:
			return "OSX_10GIG";
170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206
		default:
			return "unknown";
		}
	}
	return "n/a";
}

void qeth_set_allowed_threads(struct qeth_card *card, unsigned long threads,
			 int clear_start_mask)
{
	unsigned long flags;

	spin_lock_irqsave(&card->thread_mask_lock, flags);
	card->thread_allowed_mask = threads;
	if (clear_start_mask)
		card->thread_start_mask &= threads;
	spin_unlock_irqrestore(&card->thread_mask_lock, flags);
	wake_up(&card->wait_q);
}
EXPORT_SYMBOL_GPL(qeth_set_allowed_threads);

int qeth_threads_running(struct qeth_card *card, unsigned long threads)
{
	unsigned long flags;
	int rc = 0;

	spin_lock_irqsave(&card->thread_mask_lock, flags);
	rc = (card->thread_running_mask & threads);
	spin_unlock_irqrestore(&card->thread_mask_lock, flags);
	return rc;
}
EXPORT_SYMBOL_GPL(qeth_threads_running);

void qeth_clear_working_pool_list(struct qeth_card *card)
{
	struct qeth_buffer_pool_entry *pool_entry, *tmp;

207
	QETH_CARD_TEXT(card, 5, "clwrklst");
208 209 210 211 212 213 214 215 216 217 218 219 220
	list_for_each_entry_safe(pool_entry, tmp,
			    &card->qdio.in_buf_pool.entry_list, list){
			list_del(&pool_entry->list);
	}
}
EXPORT_SYMBOL_GPL(qeth_clear_working_pool_list);

static int qeth_alloc_buffer_pool(struct qeth_card *card)
{
	struct qeth_buffer_pool_entry *pool_entry;
	void *ptr;
	int i, j;

221
	QETH_CARD_TEXT(card, 5, "alocpool");
222
	for (i = 0; i < card->qdio.init_pool.buf_count; ++i) {
223
		pool_entry = kzalloc(sizeof(*pool_entry), GFP_KERNEL);
224 225 226 227 228
		if (!pool_entry) {
			qeth_free_buffer_pool(card);
			return -ENOMEM;
		}
		for (j = 0; j < QETH_MAX_BUFFER_ELEMENTS(card); ++j) {
229
			ptr = (void *) __get_free_page(GFP_KERNEL);
230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247
			if (!ptr) {
				while (j > 0)
					free_page((unsigned long)
						  pool_entry->elements[--j]);
				kfree(pool_entry);
				qeth_free_buffer_pool(card);
				return -ENOMEM;
			}
			pool_entry->elements[j] = ptr;
		}
		list_add(&pool_entry->init_list,
			 &card->qdio.init_pool.entry_list);
	}
	return 0;
}

int qeth_realloc_buffer_pool(struct qeth_card *card, int bufcnt)
{
248
	QETH_CARD_TEXT(card, 2, "realcbp");
249

250
	if (card->state != CARD_STATE_DOWN)
251 252 253 254 255 256 257 258 259
		return -EPERM;

	/* TODO: steel/add buffers from/to a running card's buffer pool (?) */
	qeth_clear_working_pool_list(card);
	qeth_free_buffer_pool(card);
	card->qdio.in_buf_pool.buf_count = bufcnt;
	card->qdio.init_pool.buf_count = bufcnt;
	return qeth_alloc_buffer_pool(card);
}
260
EXPORT_SYMBOL_GPL(qeth_realloc_buffer_pool);
261

262 263
static void qeth_free_qdio_queue(struct qeth_qdio_q *q)
{
264 265 266 267
	if (!q)
		return;

	qdio_free_buffers(q->qdio_bufs, QDIO_MAX_BUFFERS_PER_Q);
268 269 270 271 272 273 274 275 276 277 278
	kfree(q);
}

static struct qeth_qdio_q *qeth_alloc_qdio_queue(void)
{
	struct qeth_qdio_q *q = kzalloc(sizeof(*q), GFP_KERNEL);
	int i;

	if (!q)
		return NULL;

279 280 281 282 283
	if (qdio_alloc_buffers(q->qdio_bufs, QDIO_MAX_BUFFERS_PER_Q)) {
		kfree(q);
		return NULL;
	}

284
	for (i = 0; i < QDIO_MAX_BUFFERS_PER_Q; ++i)
285
		q->bufs[i].buffer = q->qdio_bufs[i];
286 287 288 289 290

	QETH_DBF_HEX(SETUP, 2, &q, sizeof(void *));
	return q;
}

291
static int qeth_cq_init(struct qeth_card *card)
292 293 294 295 296
{
	int rc;

	if (card->options.cq == QETH_CQ_ENABLED) {
		QETH_DBF_TEXT(SETUP, 2, "cqinit");
297 298
		qdio_reset_buffers(card->qdio.c_q->qdio_bufs,
				   QDIO_MAX_BUFFERS_PER_Q);
299 300 301 302 303 304 305 306 307 308 309 310 311 312
		card->qdio.c_q->next_buf_to_init = 127;
		rc = do_QDIO(CARD_DDEV(card), QDIO_FLAG_SYNC_INPUT,
			     card->qdio.no_in_queues - 1, 0,
			     127);
		if (rc) {
			QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
			goto out;
		}
	}
	rc = 0;
out:
	return rc;
}

313
static int qeth_alloc_cq(struct qeth_card *card)
314 315 316 317 318 319 320 321
{
	int rc;

	if (card->options.cq == QETH_CQ_ENABLED) {
		int i;
		struct qdio_outbuf_state *outbuf_states;

		QETH_DBF_TEXT(SETUP, 2, "cqon");
322
		card->qdio.c_q = qeth_alloc_qdio_queue();
323 324 325 326 327
		if (!card->qdio.c_q) {
			rc = -1;
			goto kmsg_out;
		}
		card->qdio.no_in_queues = 2;
328
		card->qdio.out_bufstates =
329 330 331 332
			kcalloc(card->qdio.no_out_queues *
					QDIO_MAX_BUFFERS_PER_Q,
				sizeof(struct qdio_outbuf_state),
				GFP_KERNEL);
333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351
		outbuf_states = card->qdio.out_bufstates;
		if (outbuf_states == NULL) {
			rc = -1;
			goto free_cq_out;
		}
		for (i = 0; i < card->qdio.no_out_queues; ++i) {
			card->qdio.out_qs[i]->bufstates = outbuf_states;
			outbuf_states += QDIO_MAX_BUFFERS_PER_Q;
		}
	} else {
		QETH_DBF_TEXT(SETUP, 2, "nocq");
		card->qdio.c_q = NULL;
		card->qdio.no_in_queues = 1;
	}
	QETH_DBF_TEXT_(SETUP, 2, "iqc%d", card->qdio.no_in_queues);
	rc = 0;
out:
	return rc;
free_cq_out:
352
	qeth_free_qdio_queue(card->qdio.c_q);
353 354 355 356 357 358
	card->qdio.c_q = NULL;
kmsg_out:
	dev_err(&card->gdev->dev, "Failed to create completion queue\n");
	goto out;
}

359
static void qeth_free_cq(struct qeth_card *card)
360 361 362
{
	if (card->qdio.c_q) {
		--card->qdio.no_in_queues;
363
		qeth_free_qdio_queue(card->qdio.c_q);
364 365 366 367 368 369
		card->qdio.c_q = NULL;
	}
	kfree(card->qdio.out_bufstates);
	card->qdio.out_bufstates = NULL;
}

370 371 372
static enum iucv_tx_notify qeth_compute_cq_notification(int sbalf15,
							int delayed)
{
373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394
	enum iucv_tx_notify n;

	switch (sbalf15) {
	case 0:
		n = delayed ? TX_NOTIFY_DELAYED_OK : TX_NOTIFY_OK;
		break;
	case 4:
	case 16:
	case 17:
	case 18:
		n = delayed ? TX_NOTIFY_DELAYED_UNREACHABLE :
			TX_NOTIFY_UNREACHABLE;
		break;
	default:
		n = delayed ? TX_NOTIFY_DELAYED_GENERALERROR :
			TX_NOTIFY_GENERALERROR;
		break;
	}

	return n;
}

395 396
static void qeth_cleanup_handled_pending(struct qeth_qdio_out_q *q, int bidx,
					 int forced_cleanup)
397
{
398 399 400
	if (q->card->options.cq != QETH_CQ_ENABLED)
		return;

401 402 403 404 405 406 407 408 409 410 411
	if (q->bufs[bidx]->next_pending != NULL) {
		struct qeth_qdio_out_buffer *head = q->bufs[bidx];
		struct qeth_qdio_out_buffer *c = q->bufs[bidx]->next_pending;

		while (c) {
			if (forced_cleanup ||
			    atomic_read(&c->state) ==
			      QETH_QDIO_BUF_HANDLED_DELAYED) {
				struct qeth_qdio_out_buffer *f = c;
				QETH_CARD_TEXT(f->q->card, 5, "fp");
				QETH_CARD_TEXT_(f->q->card, 5, "%lx", (long) f);
412 413 414 415 416
				/* release here to avoid interleaving between
				   outbound tasklet and inbound tasklet
				   regarding notifications and lifecycle */
				qeth_release_skbs(c);

417
				c = f->next_pending;
S
Stefan Raspl 已提交
418
				WARN_ON_ONCE(head->next_pending != f);
419 420 421 422 423 424 425 426 427
				head->next_pending = c;
				kmem_cache_free(qeth_qdio_outbuf_cache, f);
			} else {
				head = c;
				c = c->next_pending;
			}

		}
	}
428 429 430 431 432 433
	if (forced_cleanup && (atomic_read(&(q->bufs[bidx]->state)) ==
					QETH_QDIO_BUF_HANDLED_DELAYED)) {
		/* for recovery situations */
		qeth_init_qdio_out_buf(q, bidx);
		QETH_CARD_TEXT(q->card, 2, "clprecov");
	}
434 435 436
}


437 438 439
static void qeth_qdio_handle_aob(struct qeth_card *card,
				 unsigned long phys_aob_addr)
{
440 441
	struct qaob *aob;
	struct qeth_qdio_out_buffer *buffer;
442
	enum iucv_tx_notify notification;
443
	unsigned int i;
444 445 446 447 448 449 450

	aob = (struct qaob *) phys_to_virt(phys_aob_addr);
	QETH_CARD_TEXT(card, 5, "haob");
	QETH_CARD_TEXT_(card, 5, "%lx", phys_aob_addr);
	buffer = (struct qeth_qdio_out_buffer *) aob->user1;
	QETH_CARD_TEXT_(card, 5, "%lx", aob->user1);

451 452 453 454
	if (atomic_cmpxchg(&buffer->state, QETH_QDIO_BUF_PRIMED,
			   QETH_QDIO_BUF_IN_CQ) == QETH_QDIO_BUF_PRIMED) {
		notification = TX_NOTIFY_OK;
	} else {
S
Stefan Raspl 已提交
455 456
		WARN_ON_ONCE(atomic_read(&buffer->state) !=
							QETH_QDIO_BUF_PENDING);
457 458 459 460 461 462 463 464 465 466
		atomic_set(&buffer->state, QETH_QDIO_BUF_IN_CQ);
		notification = TX_NOTIFY_DELAYED_OK;
	}

	if (aob->aorc != 0)  {
		QETH_CARD_TEXT_(card, 2, "aorc%02X", aob->aorc);
		notification = qeth_compute_cq_notification(aob->aorc, 1);
	}
	qeth_notify_skbs(buffer->q, buffer, notification);

467 468 469 470 471 472 473 474 475 476 477
	/* Free dangling allocations. The attached skbs are handled by
	 * qeth_cleanup_handled_pending().
	 */
	for (i = 0;
	     i < aob->sb_count && i < QETH_MAX_BUFFER_ELEMENTS(card);
	     i++) {
		if (aob->sba[i] && buffer->is_header[i])
			kmem_cache_free(qeth_core_header_cache,
					(void *) aob->sba[i]);
	}
	atomic_set(&buffer->state, QETH_QDIO_BUF_HANDLED_DELAYED);
478

479 480 481 482 483 484 485 486 487 488 489
	qdio_release_aob(aob);
}

static inline int qeth_is_cq(struct qeth_card *card, unsigned int queue)
{
	return card->options.cq == QETH_CQ_ENABLED &&
	    card->qdio.c_q != NULL &&
	    queue != 0 &&
	    queue == card->qdio.no_in_queues - 1;
}

490 491 492 493 494 495 496 497
static void qeth_setup_ccw(struct ccw1 *ccw, u8 cmd_code, u32 len, void *data)
{
	ccw->cmd_code = cmd_code;
	ccw->flags = CCW_FLAG_SLI;
	ccw->count = len;
	ccw->cda = (__u32) __pa(data);
}

498
static int __qeth_issue_next_read(struct qeth_card *card)
499
{
500
	struct qeth_channel *channel = &card->read;
501
	struct qeth_cmd_buffer *iob;
502
	int rc;
503

504
	QETH_CARD_TEXT(card, 5, "issnxrd");
505
	if (channel->state != CH_STATE_UP)
506
		return -EIO;
507
	iob = qeth_get_buffer(channel);
508
	if (!iob) {
509 510
		dev_warn(&card->gdev->dev, "The qeth device driver "
			"failed to recover an error on the device\n");
511 512
		QETH_DBF_MESSAGE(2, "issue_next_read on device %x failed: no iob available\n",
				 CARD_DEVID(card));
513 514
		return -ENOMEM;
	}
515

516
	qeth_setup_ccw(channel->ccw, CCW_CMD_READ, QETH_BUFSIZE, iob->data);
517
	iob->callback = qeth_issue_next_read_cb;
518
	QETH_CARD_TEXT(card, 6, "noirqpnd");
519
	rc = ccw_device_start(channel->ccwdev, channel->ccw,
520 521
			      (addr_t) iob, 0, 0);
	if (rc) {
522 523
		QETH_DBF_MESSAGE(2, "error %i on device %x when starting next read ccw!\n",
				 rc, CARD_DEVID(card));
524
		atomic_set(&channel->irq_pending, 0);
525
		qeth_release_buffer(channel, iob);
526
		card->read_or_write_problem = 1;
527 528 529 530 531 532
		qeth_schedule_recovery(card);
		wake_up(&card->wait_q);
	}
	return rc;
}

533 534 535 536 537 538 539 540 541 542 543
static int qeth_issue_next_read(struct qeth_card *card)
{
	int ret;

	spin_lock_irq(get_ccwdev_lock(CARD_RDEV(card)));
	ret = __qeth_issue_next_read(card);
	spin_unlock_irq(get_ccwdev_lock(CARD_RDEV(card)));

	return ret;
}

544 545 546 547
static struct qeth_reply *qeth_alloc_reply(struct qeth_card *card)
{
	struct qeth_reply *reply;

548
	reply = kzalloc(sizeof(*reply), GFP_KERNEL);
549
	if (reply) {
550
		refcount_set(&reply->refcnt, 1);
551
		init_completion(&reply->received);
552
	}
553 554 555 556 557
	return reply;
}

static void qeth_get_reply(struct qeth_reply *reply)
{
558
	refcount_inc(&reply->refcnt);
559 560 561 562
}

static void qeth_put_reply(struct qeth_reply *reply)
{
563
	if (refcount_dec_and_test(&reply->refcnt))
564 565 566
		kfree(reply);
}

567 568 569 570 571 572 573 574 575 576 577 578 579 580
static void qeth_enqueue_reply(struct qeth_card *card, struct qeth_reply *reply)
{
	spin_lock_irq(&card->lock);
	list_add_tail(&reply->list, &card->cmd_waiter_list);
	spin_unlock_irq(&card->lock);
}

static void qeth_dequeue_reply(struct qeth_card *card, struct qeth_reply *reply)
{
	spin_lock_irq(&card->lock);
	list_del(&reply->list);
	spin_unlock_irq(&card->lock);
}

581
static void qeth_notify_reply(struct qeth_reply *reply, int reason)
582
{
583
	reply->rc = reason;
584
	complete(&reply->received);
585 586
}

587
static void qeth_issue_ipa_msg(struct qeth_ipa_cmd *cmd, int rc,
588 589
		struct qeth_card *card)
{
590
	const char *ipa_name;
591
	int com = cmd->hdr.command;
592
	ipa_name = qeth_get_ipa_cmd_name(com);
593

594
	if (rc)
595 596 597
		QETH_DBF_MESSAGE(2, "IPA: %s(%#x) for device %x returned %#x \"%s\"\n",
				 ipa_name, com, CARD_DEVID(card), rc,
				 qeth_get_ipa_msg(rc));
598
	else
599 600
		QETH_DBF_MESSAGE(5, "IPA: %s(%#x) for device %x succeeded\n",
				 ipa_name, com, CARD_DEVID(card));
601 602 603
}

static struct qeth_ipa_cmd *qeth_check_ipa_data(struct qeth_card *card,
604
						struct qeth_ipa_cmd *cmd)
605
{
606
	QETH_CARD_TEXT(card, 5, "chkipad");
607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623

	if (IS_IPA_REPLY(cmd)) {
		if (cmd->hdr.command != IPA_CMD_SETCCID &&
		    cmd->hdr.command != IPA_CMD_DELCCID &&
		    cmd->hdr.command != IPA_CMD_MODCCID &&
		    cmd->hdr.command != IPA_CMD_SET_DIAG_ASS)
			qeth_issue_ipa_msg(cmd, cmd->hdr.return_code, card);
		return cmd;
	}

	/* handle unsolicited event: */
	switch (cmd->hdr.command) {
	case IPA_CMD_STOPLAN:
		if (cmd->hdr.return_code == IPA_RC_VEPA_TO_VEB_TRANSITION) {
			dev_err(&card->gdev->dev,
				"Interface %s is down because the adjacent port is no longer in reflective relay mode\n",
				QETH_CARD_IFNAME(card));
624
			schedule_work(&card->close_dev_work);
625
		} else {
626 627 628 629
			dev_warn(&card->gdev->dev,
				 "The link for interface %s on CHPID 0x%X failed\n",
				 QETH_CARD_IFNAME(card), card->info.chpid);
			qeth_issue_ipa_msg(cmd, cmd->hdr.return_code, card);
630
			netif_carrier_off(card->dev);
631
		}
632 633 634 635 636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657
		return NULL;
	case IPA_CMD_STARTLAN:
		dev_info(&card->gdev->dev,
			 "The link for %s on CHPID 0x%X has been restored\n",
			 QETH_CARD_IFNAME(card), card->info.chpid);
		if (card->info.hwtrap)
			card->info.hwtrap = 2;
		qeth_schedule_recovery(card);
		return NULL;
	case IPA_CMD_SETBRIDGEPORT_IQD:
	case IPA_CMD_SETBRIDGEPORT_OSA:
	case IPA_CMD_ADDRESS_CHANGE_NOTIF:
		if (card->discipline->control_event_handler(card, cmd))
			return cmd;
		return NULL;
	case IPA_CMD_MODCCID:
		return cmd;
	case IPA_CMD_REGISTER_LOCAL_ADDR:
		QETH_CARD_TEXT(card, 3, "irla");
		return NULL;
	case IPA_CMD_UNREGISTER_LOCAL_ADDR:
		QETH_CARD_TEXT(card, 3, "urla");
		return NULL;
	default:
		QETH_DBF_MESSAGE(2, "Received data is IPA but not a reply!\n");
		return cmd;
658 659 660 661 662
	}
}

void qeth_clear_ipacmd_list(struct qeth_card *card)
{
663
	struct qeth_reply *reply;
664 665
	unsigned long flags;

666
	QETH_CARD_TEXT(card, 4, "clipalst");
667 668

	spin_lock_irqsave(&card->lock, flags);
669 670
	list_for_each_entry(reply, &card->cmd_waiter_list, list)
		qeth_notify_reply(reply, -EIO);
671 672 673 674
	spin_unlock_irqrestore(&card->lock, flags);
}
EXPORT_SYMBOL_GPL(qeth_clear_ipacmd_list);

675 676
static int qeth_check_idx_response(struct qeth_card *card,
	unsigned char *buffer)
677
{
678
	QETH_DBF_HEX(CTRL, 2, buffer, QETH_DBF_CTRL_LEN);
679
	if ((buffer[2] & 0xc0) == 0xc0) {
680
		QETH_DBF_MESSAGE(2, "received an IDX TERMINATE with cause code %#04x\n",
681
				 buffer[4]);
682 683 684
		QETH_CARD_TEXT(card, 2, "ckidxres");
		QETH_CARD_TEXT(card, 2, " idxterm");
		QETH_CARD_TEXT_(card, 2, "  rc%d", -EIO);
685 686 687 688 689 690
		if (buffer[4] == 0xf6) {
			dev_err(&card->gdev->dev,
			"The qeth device is not configured "
			"for the OSI layer required by z/VM\n");
			return -EPERM;
		}
691 692 693 694 695 696 697 698 699 700 701 702 703
		return -EIO;
	}
	return 0;
}

static struct qeth_cmd_buffer *__qeth_get_buffer(struct qeth_channel *channel)
{
	__u8 index;

	index = channel->io_buf_no;
	do {
		if (channel->iob[index].state == BUF_STATE_FREE) {
			channel->iob[index].state = BUF_STATE_LOCKED;
704
			channel->iob[index].timeout = QETH_TIMEOUT;
705 706 707 708 709 710 711 712 713 714 715 716 717 718 719 720 721 722
			channel->io_buf_no = (channel->io_buf_no + 1) %
				QETH_CMD_BUFFER_NO;
			memset(channel->iob[index].data, 0, QETH_BUFSIZE);
			return channel->iob + index;
		}
		index = (index + 1) % QETH_CMD_BUFFER_NO;
	} while (index != channel->io_buf_no);

	return NULL;
}

void qeth_release_buffer(struct qeth_channel *channel,
		struct qeth_cmd_buffer *iob)
{
	unsigned long flags;

	spin_lock_irqsave(&channel->iob_lock, flags);
	iob->state = BUF_STATE_FREE;
723
	iob->callback = NULL;
724 725 726 727
	if (iob->reply) {
		qeth_put_reply(iob->reply);
		iob->reply = NULL;
	}
728
	spin_unlock_irqrestore(&channel->iob_lock, flags);
729
	wake_up(&channel->wait_q);
730 731 732
}
EXPORT_SYMBOL_GPL(qeth_release_buffer);

733 734 735 736 737 738 739
static void qeth_release_buffer_cb(struct qeth_card *card,
				   struct qeth_channel *channel,
				   struct qeth_cmd_buffer *iob)
{
	qeth_release_buffer(channel, iob);
}

740 741 742 743
static void qeth_cancel_cmd(struct qeth_cmd_buffer *iob, int rc)
{
	struct qeth_reply *reply = iob->reply;

744 745
	if (reply)
		qeth_notify_reply(reply, rc);
746 747 748
	qeth_release_buffer(iob->channel, iob);
}

749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778
static struct qeth_cmd_buffer *qeth_get_buffer(struct qeth_channel *channel)
{
	struct qeth_cmd_buffer *buffer = NULL;
	unsigned long flags;

	spin_lock_irqsave(&channel->iob_lock, flags);
	buffer = __qeth_get_buffer(channel);
	spin_unlock_irqrestore(&channel->iob_lock, flags);
	return buffer;
}

struct qeth_cmd_buffer *qeth_wait_for_buffer(struct qeth_channel *channel)
{
	struct qeth_cmd_buffer *buffer;
	wait_event(channel->wait_q,
		   ((buffer = qeth_get_buffer(channel)) != NULL));
	return buffer;
}
EXPORT_SYMBOL_GPL(qeth_wait_for_buffer);

void qeth_clear_cmd_buffers(struct qeth_channel *channel)
{
	int cnt;

	for (cnt = 0; cnt < QETH_CMD_BUFFER_NO; cnt++)
		qeth_release_buffer(channel, &channel->iob[cnt]);
	channel->io_buf_no = 0;
}
EXPORT_SYMBOL_GPL(qeth_clear_cmd_buffers);

779 780 781
static void qeth_issue_next_read_cb(struct qeth_card *card,
				    struct qeth_channel *channel,
				    struct qeth_cmd_buffer *iob)
782
{
783
	struct qeth_ipa_cmd *cmd = NULL;
784 785
	struct qeth_reply *reply = NULL;
	struct qeth_reply *r;
786
	unsigned long flags;
787
	int rc = 0;
788

789
	QETH_CARD_TEXT(card, 4, "sndctlcb");
790 791 792 793 794
	rc = qeth_check_idx_response(card, iob->data);
	switch (rc) {
	case 0:
		break;
	case -EIO:
795
		qeth_clear_ipacmd_list(card);
796
		qeth_schedule_recovery(card);
797
		/* fall through */
798
	default:
799 800 801
		goto out;
	}

802 803 804
	if (IS_IPA(iob->data)) {
		cmd = (struct qeth_ipa_cmd *) PDU_ENCAPSULATION(iob->data);
		cmd = qeth_check_ipa_data(card, cmd);
805 806 807 808 809 810 811 812 813 814 815
		if (!cmd)
			goto out;
		if (IS_OSN(card) && card->osn_info.assist_cb &&
		    cmd->hdr.command != IPA_CMD_STARTLAN) {
			card->osn_info.assist_cb(card->dev, cmd);
			goto out;
		}
	} else {
		/* non-IPA commands should only flow during initialization */
		if (card->state != CARD_STATE_DOWN)
			goto out;
816 817
	}

818
	/* match against pending cmd requests */
819
	spin_lock_irqsave(&card->lock, flags);
820 821 822 823 824
	list_for_each_entry(r, &card->cmd_waiter_list, list) {
		if ((r->seqno == QETH_IDX_COMMAND_SEQNO) ||
		    (cmd && (r->seqno == cmd->hdr.seqno))) {
			reply = r;
			/* take the object outside the lock */
825
			qeth_get_reply(reply);
826
			break;
827 828 829
		}
	}
	spin_unlock_irqrestore(&card->lock, flags);
830 831 832 833

	if (!reply)
		goto out;

834 835 836
	if (!reply->callback) {
		rc = 0;
	} else {
837 838
		if (cmd) {
			reply->offset = (u16)((char *)cmd - (char *)iob->data);
839 840 841 842
			rc = reply->callback(card, reply, (unsigned long)cmd);
		} else {
			rc = reply->callback(card, reply, (unsigned long)iob);
		}
843 844
	}

845 846
	if (rc <= 0)
		qeth_notify_reply(reply, rc);
847 848
	qeth_put_reply(reply);

849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889
out:
	memcpy(&card->seqno.pdu_hdr_ack,
		QETH_PDU_HEADER_SEQ_NO(iob->data),
		QETH_SEQ_NO_LENGTH);
	qeth_release_buffer(channel, iob);
}

static int qeth_set_thread_start_bit(struct qeth_card *card,
		unsigned long thread)
{
	unsigned long flags;

	spin_lock_irqsave(&card->thread_mask_lock, flags);
	if (!(card->thread_allowed_mask & thread) ||
	      (card->thread_start_mask & thread)) {
		spin_unlock_irqrestore(&card->thread_mask_lock, flags);
		return -EPERM;
	}
	card->thread_start_mask |= thread;
	spin_unlock_irqrestore(&card->thread_mask_lock, flags);
	return 0;
}

void qeth_clear_thread_start_bit(struct qeth_card *card, unsigned long thread)
{
	unsigned long flags;

	spin_lock_irqsave(&card->thread_mask_lock, flags);
	card->thread_start_mask &= ~thread;
	spin_unlock_irqrestore(&card->thread_mask_lock, flags);
	wake_up(&card->wait_q);
}
EXPORT_SYMBOL_GPL(qeth_clear_thread_start_bit);

void qeth_clear_thread_running_bit(struct qeth_card *card, unsigned long thread)
{
	unsigned long flags;

	spin_lock_irqsave(&card->thread_mask_lock, flags);
	card->thread_running_mask &= ~thread;
	spin_unlock_irqrestore(&card->thread_mask_lock, flags);
890
	wake_up_all(&card->wait_q);
891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924
}
EXPORT_SYMBOL_GPL(qeth_clear_thread_running_bit);

static int __qeth_do_run_thread(struct qeth_card *card, unsigned long thread)
{
	unsigned long flags;
	int rc = 0;

	spin_lock_irqsave(&card->thread_mask_lock, flags);
	if (card->thread_start_mask & thread) {
		if ((card->thread_allowed_mask & thread) &&
		    !(card->thread_running_mask & thread)) {
			rc = 1;
			card->thread_start_mask &= ~thread;
			card->thread_running_mask |= thread;
		} else
			rc = -EPERM;
	}
	spin_unlock_irqrestore(&card->thread_mask_lock, flags);
	return rc;
}

int qeth_do_run_thread(struct qeth_card *card, unsigned long thread)
{
	int rc = 0;

	wait_event(card->wait_q,
		   (rc = __qeth_do_run_thread(card, thread)) >= 0);
	return rc;
}
EXPORT_SYMBOL_GPL(qeth_do_run_thread);

void qeth_schedule_recovery(struct qeth_card *card)
{
925
	QETH_CARD_TEXT(card, 2, "startrec");
926 927 928 929 930
	if (qeth_set_thread_start_bit(card, QETH_RECOVER_THREAD) == 0)
		schedule_work(&card->kernel_thread_starter);
}
EXPORT_SYMBOL_GPL(qeth_schedule_recovery);

931 932
static int qeth_get_problem(struct qeth_card *card, struct ccw_device *cdev,
			    struct irb *irb)
933 934 935 936 937
{
	int dstat, cstat;
	char *sense;

	sense = (char *) irb->ecw;
938 939
	cstat = irb->scsw.cmd.cstat;
	dstat = irb->scsw.cmd.dstat;
940 941 942 943

	if (cstat & (SCHN_STAT_CHN_CTRL_CHK | SCHN_STAT_INTF_CTRL_CHK |
		     SCHN_STAT_CHN_DATA_CHK | SCHN_STAT_CHAIN_CHECK |
		     SCHN_STAT_PROT_CHECK | SCHN_STAT_PROG_CHECK)) {
944
		QETH_CARD_TEXT(card, 2, "CGENCHK");
945 946
		dev_warn(&cdev->dev, "The qeth device driver "
			"failed to recover an error on the device\n");
947 948
		QETH_DBF_MESSAGE(2, "check on channel %x with dstat=%#x, cstat=%#x\n",
				 CCW_DEVID(cdev), dstat, cstat);
949 950 951 952 953 954 955 956
		print_hex_dump(KERN_WARNING, "qeth: irb ", DUMP_PREFIX_OFFSET,
				16, 1, irb, 64, 1);
		return 1;
	}

	if (dstat & DEV_STAT_UNIT_CHECK) {
		if (sense[SENSE_RESETTING_EVENT_BYTE] &
		    SENSE_RESETTING_EVENT_FLAG) {
957
			QETH_CARD_TEXT(card, 2, "REVIND");
958 959 960 961
			return 1;
		}
		if (sense[SENSE_COMMAND_REJECT_BYTE] &
		    SENSE_COMMAND_REJECT_FLAG) {
962
			QETH_CARD_TEXT(card, 2, "CMDREJi");
963
			return 1;
964 965
		}
		if ((sense[2] == 0xaf) && (sense[3] == 0xfe)) {
966
			QETH_CARD_TEXT(card, 2, "AFFE");
967 968 969
			return 1;
		}
		if ((!sense[0]) && (!sense[1]) && (!sense[2]) && (!sense[3])) {
970
			QETH_CARD_TEXT(card, 2, "ZEROSEN");
971 972
			return 0;
		}
973
		QETH_CARD_TEXT(card, 2, "DGENCHK");
974 975 976 977 978
			return 1;
	}
	return 0;
}

979 980
static int qeth_check_irb_error(struct qeth_card *card, struct ccw_device *cdev,
				unsigned long intparm, struct irb *irb)
981
{
982
	if (!IS_ERR(irb))
983 984 985 986
		return 0;

	switch (PTR_ERR(irb)) {
	case -EIO:
987 988
		QETH_DBF_MESSAGE(2, "i/o-error on channel %x\n",
				 CCW_DEVID(cdev));
989 990
		QETH_CARD_TEXT(card, 2, "ckirberr");
		QETH_CARD_TEXT_(card, 2, "  rc%d", -EIO);
991
		return -EIO;
992
	case -ETIMEDOUT:
993 994
		dev_warn(&cdev->dev, "A hardware operation timed out"
			" on the device\n");
995 996
		QETH_CARD_TEXT(card, 2, "ckirberr");
		QETH_CARD_TEXT_(card, 2, "  rc%d", -ETIMEDOUT);
997
		if (intparm == QETH_RCD_PARM) {
998
			if (card->data.ccwdev == cdev) {
999 1000 1001 1002
				card->data.state = CH_STATE_DOWN;
				wake_up(&card->wait_q);
			}
		}
1003
		return -ETIMEDOUT;
1004
	default:
1005 1006
		QETH_DBF_MESSAGE(2, "unknown error %ld on channel %x\n",
				 PTR_ERR(irb), CCW_DEVID(cdev));
1007 1008
		QETH_CARD_TEXT(card, 2, "ckirberr");
		QETH_CARD_TEXT(card, 2, "  rc???");
1009
		return PTR_ERR(irb);
1010 1011 1012 1013 1014 1015 1016 1017
	}
}

static void qeth_irq(struct ccw_device *cdev, unsigned long intparm,
		struct irb *irb)
{
	int rc;
	int cstat, dstat;
1018
	struct qeth_cmd_buffer *iob = NULL;
1019
	struct ccwgroup_device *gdev;
1020 1021 1022
	struct qeth_channel *channel;
	struct qeth_card *card;

1023 1024 1025
	/* while we hold the ccwdev lock, this stays valid: */
	gdev = dev_get_drvdata(&cdev->dev);
	card = dev_get_drvdata(&gdev->dev);
1026 1027 1028
	if (!card)
		return;

1029 1030
	QETH_CARD_TEXT(card, 5, "irq");

1031 1032
	if (card->read.ccwdev == cdev) {
		channel = &card->read;
1033
		QETH_CARD_TEXT(card, 5, "read");
1034 1035
	} else if (card->write.ccwdev == cdev) {
		channel = &card->write;
1036
		QETH_CARD_TEXT(card, 5, "write");
1037 1038
	} else {
		channel = &card->data;
1039
		QETH_CARD_TEXT(card, 5, "data");
1040
	}
1041 1042 1043 1044

	if (qeth_intparm_is_iob(intparm))
		iob = (struct qeth_cmd_buffer *) __va((addr_t)intparm);

1045 1046
	rc = qeth_check_irb_error(card, cdev, intparm, irb);
	if (rc) {
1047 1048
		/* IO was terminated, free its resources. */
		if (iob)
1049
			qeth_cancel_cmd(iob, rc);
1050 1051 1052 1053 1054
		atomic_set(&channel->irq_pending, 0);
		wake_up(&card->wait_q);
		return;
	}

1055 1056
	atomic_set(&channel->irq_pending, 0);

1057
	if (irb->scsw.cmd.fctl & (SCSW_FCTL_CLEAR_FUNC))
1058 1059
		channel->state = CH_STATE_STOPPED;

1060
	if (irb->scsw.cmd.fctl & (SCSW_FCTL_HALT_FUNC))
1061 1062 1063 1064 1065 1066 1067 1068
		channel->state = CH_STATE_HALTED;

	/*let's wake up immediately on data channel*/
	if ((channel == &card->data) && (intparm != 0) &&
	    (intparm != QETH_RCD_PARM))
		goto out;

	if (intparm == QETH_CLEAR_CHANNEL_PARM) {
1069
		QETH_CARD_TEXT(card, 6, "clrchpar");
1070 1071 1072 1073
		/* we don't have to handle this further */
		intparm = 0;
	}
	if (intparm == QETH_HALT_CHANNEL_PARM) {
1074
		QETH_CARD_TEXT(card, 6, "hltchpar");
1075 1076 1077
		/* we don't have to handle this further */
		intparm = 0;
	}
1078 1079 1080 1081

	cstat = irb->scsw.cmd.cstat;
	dstat = irb->scsw.cmd.dstat;

1082 1083 1084 1085
	if ((dstat & DEV_STAT_UNIT_EXCEP) ||
	    (dstat & DEV_STAT_UNIT_CHECK) ||
	    (cstat)) {
		if (irb->esw.esw0.erw.cons) {
1086 1087 1088
			dev_warn(&channel->ccwdev->dev,
				"The qeth device driver failed to recover "
				"an error on the device\n");
1089 1090 1091
			QETH_DBF_MESSAGE(2, "sense data available on channel %x: cstat %#X dstat %#X\n",
					 CCW_DEVID(channel->ccwdev), cstat,
					 dstat);
1092 1093 1094 1095 1096 1097 1098 1099 1100
			print_hex_dump(KERN_WARNING, "qeth: irb ",
				DUMP_PREFIX_OFFSET, 16, 1, irb, 32, 1);
			print_hex_dump(KERN_WARNING, "qeth: sense data ",
				DUMP_PREFIX_OFFSET, 16, 1, irb->ecw, 32, 1);
		}
		if (intparm == QETH_RCD_PARM) {
			channel->state = CH_STATE_DOWN;
			goto out;
		}
1101
		rc = qeth_get_problem(card, cdev, irb);
1102
		if (rc) {
1103
			card->read_or_write_problem = 1;
1104
			if (iob)
1105
				qeth_cancel_cmd(iob, rc);
1106
			qeth_clear_ipacmd_list(card);
1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119
			qeth_schedule_recovery(card);
			goto out;
		}
	}

	if (intparm == QETH_RCD_PARM) {
		channel->state = CH_STATE_RCD_DONE;
		goto out;
	}
	if (channel == &card->data)
		return;
	if (channel == &card->read &&
	    channel->state == CH_STATE_UP)
1120
		__qeth_issue_next_read(card);
1121

1122
	if (iob && iob->callback)
1123
		iob->callback(card, iob->channel, iob);
1124 1125 1126 1127 1128 1129

out:
	wake_up(&card->wait_q);
	return;
}

1130
static void qeth_notify_skbs(struct qeth_qdio_out_q *q,
1131
		struct qeth_qdio_out_buffer *buf,
1132
		enum iucv_tx_notify notification)
1133 1134 1135
{
	struct sk_buff *skb;

1136
	skb_queue_walk(&buf->skb_list, skb) {
1137 1138
		QETH_CARD_TEXT_(q->card, 5, "skbn%d", notification);
		QETH_CARD_TEXT_(q->card, 5, "%lx", (long) skb);
1139 1140
		if (skb->protocol == htons(ETH_P_AF_IUCV) && skb->sk)
			iucv_sk(skb->sk)->sk_txnotify(skb, notification);
1141 1142 1143 1144 1145
	}
}

static void qeth_release_skbs(struct qeth_qdio_out_buffer *buf)
{
1146 1147
	struct sk_buff *skb;

1148
	/* release may never happen from within CQ tasklet scope */
S
Stefan Raspl 已提交
1149
	WARN_ON_ONCE(atomic_read(&buf->state) == QETH_QDIO_BUF_IN_CQ);
1150

1151 1152 1153
	if (atomic_read(&buf->state) == QETH_QDIO_BUF_PENDING)
		qeth_notify_skbs(buf->q, buf, TX_NOTIFY_GENERALERROR);

1154 1155
	while ((skb = __skb_dequeue(&buf->skb_list)) != NULL)
		consume_skb(skb);
1156 1157 1158
}

static void qeth_clear_output_buffer(struct qeth_qdio_out_q *queue,
1159
				     struct qeth_qdio_out_buffer *buf)
1160 1161 1162 1163 1164 1165 1166
{
	int i;

	/* is PCI flag set on buffer? */
	if (buf->buffer->element[0].sflags & SBAL_SFLAGS0_PCI_REQ)
		atomic_dec(&queue->set_pci_flags_count);

1167 1168
	qeth_release_skbs(buf);

1169
	for (i = 0; i < queue->max_elements; ++i) {
1170 1171 1172 1173
		if (buf->buffer->element[i].addr && buf->is_header[i])
			kmem_cache_free(qeth_core_header_cache,
				buf->buffer->element[i].addr);
		buf->is_header[i] = 0;
1174
	}
1175

1176
	qeth_scrub_qdio_buffer(buf->buffer, queue->max_elements);
1177
	buf->next_element_to_fill = 0;
1178
	atomic_set(&buf->state, QETH_QDIO_BUF_EMPTY);
1179 1180
}

1181
static void qeth_drain_output_queue(struct qeth_qdio_out_q *q, bool free)
1182 1183 1184 1185 1186 1187
{
	int j;

	for (j = 0; j < QDIO_MAX_BUFFERS_PER_Q; ++j) {
		if (!q->bufs[j])
			continue;
1188
		qeth_cleanup_handled_pending(q, j, 1);
1189
		qeth_clear_output_buffer(q, q->bufs[j]);
1190 1191 1192 1193 1194
		if (free) {
			kmem_cache_free(qeth_qdio_outbuf_cache, q->bufs[j]);
			q->bufs[j] = NULL;
		}
	}
1195 1196
}

1197
void qeth_drain_output_queues(struct qeth_card *card)
1198
{
1199
	int i;
1200

1201
	QETH_CARD_TEXT(card, 2, "clearqdbf");
1202
	/* clear outbound buffers to free skbs */
1203
	for (i = 0; i < card->qdio.no_out_queues; ++i) {
1204 1205
		if (card->qdio.out_qs[i])
			qeth_drain_output_queue(card->qdio.out_qs[i], false);
1206
	}
1207
}
1208
EXPORT_SYMBOL_GPL(qeth_drain_output_queues);
1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224

static void qeth_free_buffer_pool(struct qeth_card *card)
{
	struct qeth_buffer_pool_entry *pool_entry, *tmp;
	int i = 0;
	list_for_each_entry_safe(pool_entry, tmp,
				 &card->qdio.init_pool.entry_list, init_list){
		for (i = 0; i < QETH_MAX_BUFFER_ELEMENTS(card); ++i)
			free_page((unsigned long)pool_entry->elements[i]);
		list_del(&pool_entry->init_list);
		kfree(pool_entry);
	}
}

static void qeth_clean_channel(struct qeth_channel *channel)
{
1225
	struct ccw_device *cdev = channel->ccwdev;
1226 1227
	int cnt;

1228
	QETH_DBF_TEXT(SETUP, 2, "freech");
1229 1230 1231 1232 1233

	spin_lock_irq(get_ccwdev_lock(cdev));
	cdev->handler = NULL;
	spin_unlock_irq(get_ccwdev_lock(cdev));

1234 1235
	for (cnt = 0; cnt < QETH_CMD_BUFFER_NO; cnt++)
		kfree(channel->iob[cnt].data);
1236
	kfree(channel->ccw);
1237 1238
}

1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260
static int qeth_setup_channel(struct qeth_channel *channel, bool alloc_buffers)
{
	struct ccw_device *cdev = channel->ccwdev;
	int cnt;

	QETH_DBF_TEXT(SETUP, 2, "setupch");

	channel->ccw = kmalloc(sizeof(struct ccw1), GFP_KERNEL | GFP_DMA);
	if (!channel->ccw)
		return -ENOMEM;
	channel->state = CH_STATE_DOWN;
	atomic_set(&channel->irq_pending, 0);
	init_waitqueue_head(&channel->wait_q);

	spin_lock_irq(get_ccwdev_lock(cdev));
	cdev->handler = qeth_irq;
	spin_unlock_irq(get_ccwdev_lock(cdev));

	if (!alloc_buffers)
		return 0;

	for (cnt = 0; cnt < QETH_CMD_BUFFER_NO; cnt++) {
1261 1262
		channel->iob[cnt].data = kmalloc(QETH_BUFSIZE,
						 GFP_KERNEL | GFP_DMA);
1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277
		if (channel->iob[cnt].data == NULL)
			break;
		channel->iob[cnt].state = BUF_STATE_FREE;
		channel->iob[cnt].channel = channel;
	}
	if (cnt < QETH_CMD_BUFFER_NO) {
		qeth_clean_channel(channel);
		return -ENOMEM;
	}
	channel->io_buf_no = 0;
	spin_lock_init(&channel->iob_lock);

	return 0;
}

1278
static int qeth_osa_set_output_queues(struct qeth_card *card, bool single)
1279
{
1280
	unsigned int count = single ? 1 : card->dev->num_tx_queues;
1281
	int rc;
1282

1283
	rtnl_lock();
1284
	rc = netif_set_real_num_tx_queues(card->dev, count);
1285
	rtnl_unlock();
1286

1287 1288 1289
	if (rc)
		return rc;

1290
	if (card->qdio.no_out_queues == count)
1291
		return 0;
1292

1293
	if (atomic_read(&card->qdio.state) != QETH_QDIO_UNINITIALIZED)
1294
		qeth_free_qdio_queues(card);
1295 1296 1297 1298 1299 1300

	if (count == 1)
		dev_info(&card->gdev->dev, "Priority Queueing not supported\n");

	card->qdio.default_out_queue = single ? 0 : QETH_DEFAULT_QUEUE;
	card->qdio.no_out_queues = count;
1301
	return 0;
1302 1303
}

1304
static int qeth_update_from_chp_desc(struct qeth_card *card)
1305 1306
{
	struct ccw_device *ccwdev;
1307
	struct channel_path_desc_fmt0 *chp_dsc;
1308
	int rc = 0;
1309

1310
	QETH_DBF_TEXT(SETUP, 2, "chp_desc");
1311 1312

	ccwdev = card->data.ccwdev;
1313 1314
	chp_dsc = ccw_device_get_chp_desc(ccwdev, 0);
	if (!chp_dsc)
1315
		return -ENOMEM;
1316 1317 1318

	card->info.func_level = 0x4100 + chp_dsc->desc;

1319 1320
	if (IS_OSD(card) || IS_OSX(card))
		/* CHPP field bit 6 == 1 -> single queue */
1321
		rc = qeth_osa_set_output_queues(card, chp_dsc->chpp & 0x02);
1322

1323
	kfree(chp_dsc);
1324 1325
	QETH_DBF_TEXT_(SETUP, 2, "nr:%x", card->qdio.no_out_queues);
	QETH_DBF_TEXT_(SETUP, 2, "lvl:%02x", card->info.func_level);
1326
	return rc;
1327 1328 1329 1330
}

static void qeth_init_qdio_info(struct qeth_card *card)
{
1331
	QETH_DBF_TEXT(SETUP, 4, "intqdinf");
1332
	atomic_set(&card->qdio.state, QETH_QDIO_UNINITIALIZED);
1333 1334 1335
	card->qdio.do_prio_queueing = QETH_PRIOQ_DEFAULT;
	card->qdio.default_out_queue = QETH_DEFAULT_QUEUE;

1336
	/* inbound */
1337
	card->qdio.no_in_queues = 1;
1338
	card->qdio.in_buf_size = QETH_IN_BUF_SIZE_DEFAULT;
1339
	if (IS_IQD(card))
1340 1341 1342
		card->qdio.init_pool.buf_count = QETH_IN_BUF_COUNT_HSDEFAULT;
	else
		card->qdio.init_pool.buf_count = QETH_IN_BUF_COUNT_DEFAULT;
1343 1344 1345 1346 1347
	card->qdio.in_buf_pool.buf_count = card->qdio.init_pool.buf_count;
	INIT_LIST_HEAD(&card->qdio.in_buf_pool.entry_list);
	INIT_LIST_HEAD(&card->qdio.init_pool.entry_list);
}

1348
static void qeth_set_initial_options(struct qeth_card *card)
1349 1350 1351 1352
{
	card->options.route4.type = NO_ROUTER;
	card->options.route6.type = NO_ROUTER;
	card->options.rx_sg_cb = QETH_RX_SG_CB;
1353
	card->options.isolation = ISOLATION_MODE_NONE;
1354
	card->options.cq = QETH_CQ_DISABLED;
1355
	card->options.layer = QETH_DISCIPLINE_UNDETERMINED;
1356 1357 1358 1359 1360 1361 1362 1363
}

static int qeth_do_start_thread(struct qeth_card *card, unsigned long thread)
{
	unsigned long flags;
	int rc = 0;

	spin_lock_irqsave(&card->thread_mask_lock, flags);
1364
	QETH_CARD_TEXT_(card, 4, "  %02x%02x%02x",
1365 1366 1367 1368 1369 1370 1371 1372 1373 1374
			(u8) card->thread_start_mask,
			(u8) card->thread_allowed_mask,
			(u8) card->thread_running_mask);
	rc = (card->thread_start_mask & thread);
	spin_unlock_irqrestore(&card->thread_mask_lock, flags);
	return rc;
}

static void qeth_start_kernel_thread(struct work_struct *work)
{
1375
	struct task_struct *ts;
1376 1377
	struct qeth_card *card = container_of(work, struct qeth_card,
					kernel_thread_starter);
1378
	QETH_CARD_TEXT(card , 2, "strthrd");
1379 1380 1381 1382

	if (card->read.state != CH_STATE_UP &&
	    card->write.state != CH_STATE_UP)
		return;
1383
	if (qeth_do_start_thread(card, QETH_RECOVER_THREAD)) {
1384
		ts = kthread_run(card->discipline->recover, (void *)card,
1385
				"qeth_recover");
1386 1387 1388 1389 1390 1391
		if (IS_ERR(ts)) {
			qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD);
			qeth_clear_thread_running_bit(card,
				QETH_RECOVER_THREAD);
		}
	}
1392 1393
}

1394
static void qeth_buffer_reclaim_work(struct work_struct *);
1395
static void qeth_setup_card(struct qeth_card *card)
1396
{
1397 1398
	QETH_DBF_TEXT(SETUP, 2, "setupcrd");
	QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
1399

1400
	card->info.type = CARD_RDEV(card)->id.driver_info;
1401 1402 1403
	card->state = CARD_STATE_DOWN;
	spin_lock_init(&card->lock);
	spin_lock_init(&card->thread_mask_lock);
1404
	mutex_init(&card->conf_mutex);
1405
	mutex_init(&card->discipline_mutex);
1406 1407 1408
	INIT_WORK(&card->kernel_thread_starter, qeth_start_kernel_thread);
	INIT_LIST_HEAD(&card->cmd_waiter_list);
	init_waitqueue_head(&card->wait_q);
1409
	qeth_set_initial_options(card);
1410 1411 1412
	/* IP address takeover */
	INIT_LIST_HEAD(&card->ipato.entries);
	qeth_init_qdio_info(card);
1413
	INIT_DELAYED_WORK(&card->buffer_reclaim_work, qeth_buffer_reclaim_work);
S
Stefan Raspl 已提交
1414
	INIT_WORK(&card->close_dev_work, qeth_close_dev_handler);
1415 1416
}

1417 1418 1419 1420
static void qeth_core_sl_print(struct seq_file *m, struct service_level *slr)
{
	struct qeth_card *card = container_of(slr, struct qeth_card,
					qeth_service_level);
1421 1422 1423
	if (card->info.mcl_level[0])
		seq_printf(m, "qeth: %s firmware level %s\n",
			CARD_BUS_ID(card), card->info.mcl_level);
1424 1425
}

1426
static struct qeth_card *qeth_alloc_card(struct ccwgroup_device *gdev)
1427 1428 1429
{
	struct qeth_card *card;

1430
	QETH_DBF_TEXT(SETUP, 2, "alloccrd");
1431
	card = kzalloc(sizeof(*card), GFP_KERNEL);
1432
	if (!card)
1433
		goto out;
1434
	QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
1435 1436

	card->gdev = gdev;
1437
	dev_set_drvdata(&gdev->dev, card);
1438 1439 1440
	CARD_RDEV(card) = gdev->cdev[0];
	CARD_WDEV(card) = gdev->cdev[1];
	CARD_DDEV(card) = gdev->cdev[2];
1441

1442 1443
	card->event_wq = alloc_ordered_workqueue("%s_event", 0,
						 dev_name(&gdev->dev));
1444 1445
	if (!card->event_wq)
		goto out_wq;
1446
	if (qeth_setup_channel(&card->read, true))
1447
		goto out_ip;
1448
	if (qeth_setup_channel(&card->write, true))
1449
		goto out_channel;
1450 1451
	if (qeth_setup_channel(&card->data, false))
		goto out_data;
1452 1453
	card->qeth_service_level.seq_print = qeth_core_sl_print;
	register_service_level(&card->qeth_service_level);
1454
	return card;
1455

1456 1457
out_data:
	qeth_clean_channel(&card->write);
1458 1459 1460
out_channel:
	qeth_clean_channel(&card->read);
out_ip:
1461 1462
	destroy_workqueue(card->event_wq);
out_wq:
1463
	dev_set_drvdata(&gdev->dev, NULL);
1464 1465 1466
	kfree(card);
out:
	return NULL;
1467 1468
}

1469 1470
static int qeth_clear_channel(struct qeth_card *card,
			      struct qeth_channel *channel)
1471 1472 1473
{
	int rc;

1474
	QETH_CARD_TEXT(card, 3, "clearch");
1475
	spin_lock_irq(get_ccwdev_lock(channel->ccwdev));
1476
	rc = ccw_device_clear(channel->ccwdev, QETH_CLEAR_CHANNEL_PARM);
1477
	spin_unlock_irq(get_ccwdev_lock(channel->ccwdev));
1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490

	if (rc)
		return rc;
	rc = wait_event_interruptible_timeout(card->wait_q,
			channel->state == CH_STATE_STOPPED, QETH_TIMEOUT);
	if (rc == -ERESTARTSYS)
		return rc;
	if (channel->state != CH_STATE_STOPPED)
		return -ETIME;
	channel->state = CH_STATE_DOWN;
	return 0;
}

1491 1492
static int qeth_halt_channel(struct qeth_card *card,
			     struct qeth_channel *channel)
1493 1494 1495
{
	int rc;

1496
	QETH_CARD_TEXT(card, 3, "haltch");
1497
	spin_lock_irq(get_ccwdev_lock(channel->ccwdev));
1498
	rc = ccw_device_halt(channel->ccwdev, QETH_HALT_CHANNEL_PARM);
1499
	spin_unlock_irq(get_ccwdev_lock(channel->ccwdev));
1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515

	if (rc)
		return rc;
	rc = wait_event_interruptible_timeout(card->wait_q,
			channel->state == CH_STATE_HALTED, QETH_TIMEOUT);
	if (rc == -ERESTARTSYS)
		return rc;
	if (channel->state != CH_STATE_HALTED)
		return -ETIME;
	return 0;
}

static int qeth_halt_channels(struct qeth_card *card)
{
	int rc1 = 0, rc2 = 0, rc3 = 0;

1516
	QETH_CARD_TEXT(card, 3, "haltchs");
1517 1518 1519
	rc1 = qeth_halt_channel(card, &card->read);
	rc2 = qeth_halt_channel(card, &card->write);
	rc3 = qeth_halt_channel(card, &card->data);
1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530
	if (rc1)
		return rc1;
	if (rc2)
		return rc2;
	return rc3;
}

static int qeth_clear_channels(struct qeth_card *card)
{
	int rc1 = 0, rc2 = 0, rc3 = 0;

1531
	QETH_CARD_TEXT(card, 3, "clearchs");
1532 1533 1534
	rc1 = qeth_clear_channel(card, &card->read);
	rc2 = qeth_clear_channel(card, &card->write);
	rc3 = qeth_clear_channel(card, &card->data);
1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545
	if (rc1)
		return rc1;
	if (rc2)
		return rc2;
	return rc3;
}

static int qeth_clear_halt_card(struct qeth_card *card, int halt)
{
	int rc = 0;

1546
	QETH_CARD_TEXT(card, 3, "clhacrd");
1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558

	if (halt)
		rc = qeth_halt_channels(card);
	if (rc)
		return rc;
	return qeth_clear_channels(card);
}

int qeth_qdio_clear_card(struct qeth_card *card, int use_halt)
{
	int rc = 0;

1559
	QETH_CARD_TEXT(card, 3, "qdioclr");
1560 1561 1562
	switch (atomic_cmpxchg(&card->qdio.state, QETH_QDIO_ESTABLISHED,
		QETH_QDIO_CLEANING)) {
	case QETH_QDIO_ESTABLISHED:
1563
		if (IS_IQD(card))
1564
			rc = qdio_shutdown(CARD_DDEV(card),
1565 1566
				QDIO_FLAG_CLEANUP_USING_HALT);
		else
1567
			rc = qdio_shutdown(CARD_DDEV(card),
1568 1569
				QDIO_FLAG_CLEANUP_USING_CLEAR);
		if (rc)
1570
			QETH_CARD_TEXT_(card, 3, "1err%d", rc);
1571 1572 1573 1574 1575 1576 1577 1578 1579
		atomic_set(&card->qdio.state, QETH_QDIO_ALLOCATED);
		break;
	case QETH_QDIO_CLEANING:
		return rc;
	default:
		break;
	}
	rc = qeth_clear_halt_card(card, use_halt);
	if (rc)
1580
		QETH_CARD_TEXT_(card, 3, "2err%d", rc);
1581 1582 1583 1584 1585 1586 1587 1588 1589 1590 1591 1592 1593 1594 1595 1596 1597 1598 1599 1600 1601 1602 1603
	card->state = CARD_STATE_DOWN;
	return rc;
}
EXPORT_SYMBOL_GPL(qeth_qdio_clear_card);

static int qeth_read_conf_data(struct qeth_card *card, void **buffer,
			       int *length)
{
	struct ciw *ciw;
	char *rcd_buf;
	int ret;
	struct qeth_channel *channel = &card->data;

	/*
	 * scan for RCD command in extended SenseID data
	 */
	ciw = ccw_device_get_ciw(channel->ccwdev, CIW_TYPE_RCD);
	if (!ciw || ciw->cmd == 0)
		return -EOPNOTSUPP;
	rcd_buf = kzalloc(ciw->count, GFP_KERNEL | GFP_DMA);
	if (!rcd_buf)
		return -ENOMEM;

1604
	qeth_setup_ccw(channel->ccw, ciw->cmd, ciw->count, rcd_buf);
1605
	channel->state = CH_STATE_RCD;
1606
	spin_lock_irq(get_ccwdev_lock(channel->ccwdev));
1607
	ret = ccw_device_start_timeout(channel->ccwdev, channel->ccw,
1608 1609
				       QETH_RCD_PARM, LPM_ANYPATH, 0,
				       QETH_RCD_TIMEOUT);
1610
	spin_unlock_irq(get_ccwdev_lock(channel->ccwdev));
1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625 1626 1627 1628 1629
	if (!ret)
		wait_event(card->wait_q,
			   (channel->state == CH_STATE_RCD_DONE ||
			    channel->state == CH_STATE_DOWN));
	if (channel->state == CH_STATE_DOWN)
		ret = -EIO;
	else
		channel->state = CH_STATE_DOWN;
	if (ret) {
		kfree(rcd_buf);
		*buffer = NULL;
		*length = 0;
	} else {
		*length = ciw->count;
		*buffer = rcd_buf;
	}
	return ret;
}

1630
static void qeth_configure_unitaddr(struct qeth_card *card, char *prcd)
1631
{
1632
	QETH_DBF_TEXT(SETUP, 2, "cfgunit");
1633 1634 1635
	card->info.chpid = prcd[30];
	card->info.unit_addr2 = prcd[31];
	card->info.cula = prcd[63];
1636 1637
	card->info.is_vm_nic = ((prcd[0x10] == _ascebc['V']) &&
				(prcd[0x11] == _ascebc['M']));
1638 1639
}

1640 1641 1642 1643 1644 1645 1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677 1678 1679 1680 1681 1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694 1695
static enum qeth_discipline_id qeth_vm_detect_layer(struct qeth_card *card)
{
	enum qeth_discipline_id disc = QETH_DISCIPLINE_UNDETERMINED;
	struct diag26c_vnic_resp *response = NULL;
	struct diag26c_vnic_req *request = NULL;
	struct ccw_dev_id id;
	char userid[80];
	int rc = 0;

	QETH_DBF_TEXT(SETUP, 2, "vmlayer");

	cpcmd("QUERY USERID", userid, sizeof(userid), &rc);
	if (rc)
		goto out;

	request = kzalloc(sizeof(*request), GFP_KERNEL | GFP_DMA);
	response = kzalloc(sizeof(*response), GFP_KERNEL | GFP_DMA);
	if (!request || !response) {
		rc = -ENOMEM;
		goto out;
	}

	ccw_device_get_id(CARD_RDEV(card), &id);
	request->resp_buf_len = sizeof(*response);
	request->resp_version = DIAG26C_VERSION6_VM65918;
	request->req_format = DIAG26C_VNIC_INFO;
	ASCEBC(userid, 8);
	memcpy(&request->sys_name, userid, 8);
	request->devno = id.devno;

	QETH_DBF_HEX(CTRL, 2, request, sizeof(*request));
	rc = diag26c(request, response, DIAG26C_PORT_VNIC);
	QETH_DBF_HEX(CTRL, 2, request, sizeof(*request));
	if (rc)
		goto out;
	QETH_DBF_HEX(CTRL, 2, response, sizeof(*response));

	if (request->resp_buf_len < sizeof(*response) ||
	    response->version != request->resp_version) {
		rc = -EIO;
		goto out;
	}

	if (response->protocol == VNIC_INFO_PROT_L2)
		disc = QETH_DISCIPLINE_LAYER2;
	else if (response->protocol == VNIC_INFO_PROT_L3)
		disc = QETH_DISCIPLINE_LAYER3;

out:
	kfree(response);
	kfree(request);
	if (rc)
		QETH_DBF_TEXT_(SETUP, 2, "err%x", rc);
	return disc;
}

1696 1697 1698
/* Determine whether the device requires a specific layer discipline */
static enum qeth_discipline_id qeth_enforce_discipline(struct qeth_card *card)
{
1699 1700
	enum qeth_discipline_id disc = QETH_DISCIPLINE_UNDETERMINED;

1701
	if (IS_OSM(card) || IS_OSN(card))
1702
		disc = QETH_DISCIPLINE_LAYER2;
1703 1704 1705
	else if (IS_VM_NIC(card))
		disc = IS_IQD(card) ? QETH_DISCIPLINE_LAYER3 :
				      qeth_vm_detect_layer(card);
1706 1707 1708

	switch (disc) {
	case QETH_DISCIPLINE_LAYER2:
1709
		QETH_DBF_TEXT(SETUP, 3, "force l2");
1710 1711
		break;
	case QETH_DISCIPLINE_LAYER3:
1712
		QETH_DBF_TEXT(SETUP, 3, "force l3");
1713 1714 1715
		break;
	default:
		QETH_DBF_TEXT(SETUP, 3, "force no");
1716 1717
	}

1718
	return disc;
1719 1720
}

1721 1722 1723 1724
static void qeth_configure_blkt_default(struct qeth_card *card, char *prcd)
{
	QETH_DBF_TEXT(SETUP, 2, "cfgblkt");

1725
	if (prcd[74] == 0xF0 && prcd[75] == 0xF0 &&
1726
	    prcd[76] >= 0xF1 && prcd[76] <= 0xF4) {
1727 1728 1729
		card->info.blkt.time_total = 0;
		card->info.blkt.inter_packet = 0;
		card->info.blkt.inter_packet_jumbo = 0;
1730 1731 1732 1733
	} else {
		card->info.blkt.time_total = 250;
		card->info.blkt.inter_packet = 5;
		card->info.blkt.inter_packet_jumbo = 15;
1734
	}
1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747
}

static void qeth_init_tokens(struct qeth_card *card)
{
	card->token.issuer_rm_w = 0x00010103UL;
	card->token.cm_filter_w = 0x00010108UL;
	card->token.cm_connection_w = 0x0001010aUL;
	card->token.ulp_filter_w = 0x0001010bUL;
	card->token.ulp_connection_w = 0x0001010dUL;
}

static void qeth_init_func_level(struct qeth_card *card)
{
1748 1749
	switch (card->info.type) {
	case QETH_CARD_TYPE_IQD:
1750
		card->info.func_level =	QETH_IDX_FUNC_LEVEL_IQD;
1751 1752
		break;
	case QETH_CARD_TYPE_OSD:
1753
	case QETH_CARD_TYPE_OSN:
1754 1755 1756 1757
		card->info.func_level = QETH_IDX_FUNC_LEVEL_OSD;
		break;
	default:
		break;
1758 1759 1760
	}
}

1761 1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772
static void qeth_idx_finalize_cmd(struct qeth_card *card,
				  struct qeth_cmd_buffer *iob,
				  unsigned int length)
{
	qeth_setup_ccw(iob->channel->ccw, CCW_CMD_WRITE, length, iob->data);

	memcpy(QETH_TRANSPORT_HEADER_SEQ_NO(iob->data), &card->seqno.trans_hdr,
	       QETH_SEQ_NO_LENGTH);
	if (iob->channel == &card->write)
		card->seqno.trans_hdr++;
}

1773 1774 1775 1776 1777 1778 1779 1780 1781
static int qeth_peer_func_level(int level)
{
	if ((level & 0xff) == 8)
		return (level & 0xff) + 0x400;
	if (((level >> 8) & 3) == 1)
		return (level & 0xff) + 0x200;
	return level;
}

1782 1783 1784
static void qeth_mpc_finalize_cmd(struct qeth_card *card,
				  struct qeth_cmd_buffer *iob,
				  unsigned int length)
1785
{
1786
	qeth_idx_finalize_cmd(card, iob, length);
1787 1788 1789 1790 1791 1792

	memcpy(QETH_PDU_HEADER_SEQ_NO(iob->data),
	       &card->seqno.pdu_hdr, QETH_SEQ_NO_LENGTH);
	card->seqno.pdu_hdr++;
	memcpy(QETH_PDU_HEADER_ACK_SEQ_NO(iob->data),
	       &card->seqno.pdu_hdr_ack, QETH_SEQ_NO_LENGTH);
1793 1794 1795

	iob->reply->seqno = QETH_IDX_COMMAND_SEQNO;
	iob->callback = qeth_release_buffer_cb;
1796 1797
}

1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812
/**
 * qeth_send_control_data() -	send control command to the card
 * @card:			qeth_card structure pointer
 * @len:			size of the command buffer
 * @iob:			qeth_cmd_buffer pointer
 * @reply_cb:			callback function pointer
 * @cb_card:			pointer to the qeth_card structure
 * @cb_reply:			pointer to the qeth_reply structure
 * @cb_cmd:			pointer to the original iob for non-IPA
 *				commands, or to the qeth_ipa_cmd structure
 *				for the IPA commands.
 * @reply_param:		private pointer passed to the callback
 *
 * Callback function gets called one or more times, with cb_cmd
 * pointing to the response returned by the hardware. Callback
1813 1814 1815 1816 1817
 * function must return
 *   > 0 if more reply blocks are expected,
 *     0 if the last or only reply block is received, and
 *   < 0 on error.
 * Callback function can get the value of the reply_param pointer from the
1818 1819 1820
 * field 'param' of the structure qeth_reply.
 */

1821 1822 1823 1824 1825 1826
static int qeth_send_control_data(struct qeth_card *card, int len,
				  struct qeth_cmd_buffer *iob,
				  int (*reply_cb)(struct qeth_card *cb_card,
						  struct qeth_reply *cb_reply,
						  unsigned long cb_cmd),
				  void *reply_param)
1827
{
1828
	struct qeth_channel *channel = iob->channel;
1829
	long timeout = iob->timeout;
1830 1831 1832
	int rc;
	struct qeth_reply *reply = NULL;

1833
	QETH_CARD_TEXT(card, 2, "sendctl");
1834 1835 1836

	reply = qeth_alloc_reply(card);
	if (!reply) {
1837
		qeth_release_buffer(channel, iob);
1838 1839 1840 1841
		return -ENOMEM;
	}
	reply->callback = reply_cb;
	reply->param = reply_param;
1842

1843 1844 1845 1846
	/* pairs with qeth_release_buffer(): */
	qeth_get_reply(reply);
	iob->reply = reply;

1847 1848 1849 1850 1851 1852 1853 1854
	timeout = wait_event_interruptible_timeout(card->wait_q,
						   qeth_trylock_channel(channel),
						   timeout);
	if (timeout <= 0) {
		qeth_put_reply(reply);
		qeth_release_buffer(channel, iob);
		return (timeout == -ERESTARTSYS) ? -EINTR : -ETIME;
	}
1855

1856 1857
	iob->finalize(card, iob, len);
	QETH_DBF_HEX(CTRL, 2, iob->data, min(len, QETH_DBF_CTRL_LEN));
1858

1859
	qeth_enqueue_reply(card, reply);
1860

1861
	QETH_CARD_TEXT(card, 6, "noirqpnd");
1862
	spin_lock_irq(get_ccwdev_lock(channel->ccwdev));
1863
	rc = ccw_device_start_timeout(channel->ccwdev, channel->ccw,
1864
				      (addr_t) iob, 0, 0, timeout);
1865
	spin_unlock_irq(get_ccwdev_lock(channel->ccwdev));
1866
	if (rc) {
1867 1868
		QETH_DBF_MESSAGE(2, "qeth_send_control_data on device %x: ccw_device_start rc = %i\n",
				 CARD_DEVID(card), rc);
1869
		QETH_CARD_TEXT_(card, 2, " err%d", rc);
1870
		qeth_dequeue_reply(card, reply);
1871
		qeth_put_reply(reply);
1872 1873
		qeth_release_buffer(channel, iob);
		atomic_set(&channel->irq_pending, 0);
1874 1875 1876
		wake_up(&card->wait_q);
		return rc;
	}
1877

1878 1879 1880 1881
	timeout = wait_for_completion_interruptible_timeout(&reply->received,
							    timeout);
	if (timeout <= 0)
		rc = (timeout == -ERESTARTSYS) ? -EINTR : -ETIME;
1882

1883
	qeth_dequeue_reply(card, reply);
1884 1885
	if (!rc)
		rc = reply->rc;
1886 1887
	qeth_put_reply(reply);
	return rc;
1888 1889
}

1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987 1988 1989 1990 1991 1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060 2061 2062 2063 2064 2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077 2078 2079 2080 2081 2082 2083 2084
static int qeth_idx_check_activate_response(struct qeth_card *card,
					    struct qeth_channel *channel,
					    struct qeth_cmd_buffer *iob)
{
	int rc;

	rc = qeth_check_idx_response(card, iob->data);
	if (rc)
		return rc;

	if (QETH_IS_IDX_ACT_POS_REPLY(iob->data))
		return 0;

	/* negative reply: */
	QETH_DBF_TEXT_(SETUP, 2, "idxneg%c",
		       QETH_IDX_ACT_CAUSE_CODE(iob->data));

	switch (QETH_IDX_ACT_CAUSE_CODE(iob->data)) {
	case QETH_IDX_ACT_ERR_EXCL:
		dev_err(&channel->ccwdev->dev,
			"The adapter is used exclusively by another host\n");
		return -EBUSY;
	case QETH_IDX_ACT_ERR_AUTH:
	case QETH_IDX_ACT_ERR_AUTH_USER:
		dev_err(&channel->ccwdev->dev,
			"Setting the device online failed because of insufficient authorization\n");
		return -EPERM;
	default:
		QETH_DBF_MESSAGE(2, "IDX_ACTIVATE on channel %x: negative reply\n",
				 CCW_DEVID(channel->ccwdev));
		return -EIO;
	}
}

static void qeth_idx_query_read_cb(struct qeth_card *card,
				   struct qeth_channel *channel,
				   struct qeth_cmd_buffer *iob)
{
	u16 peer_level;
	int rc;

	QETH_DBF_TEXT(SETUP, 2, "idxrdcb");

	rc = qeth_idx_check_activate_response(card, channel, iob);
	if (rc)
		goto out;

	memcpy(&peer_level, QETH_IDX_ACT_FUNC_LEVEL(iob->data), 2);
	if (peer_level != qeth_peer_func_level(card->info.func_level)) {
		QETH_DBF_MESSAGE(2, "IDX_ACTIVATE on channel %x: function level mismatch (sent: %#x, received: %#x)\n",
				 CCW_DEVID(channel->ccwdev),
				 card->info.func_level, peer_level);
		rc = -EINVAL;
		goto out;
	}

	memcpy(&card->token.issuer_rm_r,
	       QETH_IDX_ACT_ISSUER_RM_TOKEN(iob->data),
	       QETH_MPC_TOKEN_LENGTH);
	memcpy(&card->info.mcl_level[0],
	       QETH_IDX_REPLY_LEVEL(iob->data), QETH_MCL_LENGTH);

out:
	qeth_notify_reply(iob->reply, rc);
	qeth_release_buffer(channel, iob);
}

static void qeth_idx_query_write_cb(struct qeth_card *card,
				    struct qeth_channel *channel,
				    struct qeth_cmd_buffer *iob)
{
	u16 peer_level;
	int rc;

	QETH_DBF_TEXT(SETUP, 2, "idxwrcb");

	rc = qeth_idx_check_activate_response(card, channel, iob);
	if (rc)
		goto out;

	memcpy(&peer_level, QETH_IDX_ACT_FUNC_LEVEL(iob->data), 2);
	if ((peer_level & ~0x0100) !=
	    qeth_peer_func_level(card->info.func_level)) {
		QETH_DBF_MESSAGE(2, "IDX_ACTIVATE on channel %x: function level mismatch (sent: %#x, received: %#x)\n",
				 CCW_DEVID(channel->ccwdev),
				 card->info.func_level, peer_level);
		rc = -EINVAL;
	}

out:
	qeth_notify_reply(iob->reply, rc);
	qeth_release_buffer(channel, iob);
}

static void qeth_idx_finalize_query_cmd(struct qeth_card *card,
					struct qeth_cmd_buffer *iob,
					unsigned int length)
{
	qeth_setup_ccw(iob->channel->ccw, CCW_CMD_READ, length, iob->data);
}

static void qeth_idx_activate_cb(struct qeth_card *card,
				 struct qeth_channel *channel,
				 struct qeth_cmd_buffer *iob)
{
	qeth_notify_reply(iob->reply, 0);
	qeth_release_buffer(channel, iob);
}

static void qeth_idx_setup_activate_cmd(struct qeth_card *card,
					struct qeth_cmd_buffer *iob)
{
	u16 addr = (card->info.cula << 8) + card->info.unit_addr2;
	u8 port = ((u8)card->dev->dev_port) | 0x80;
	struct ccw_dev_id dev_id;

	ccw_device_get_id(CARD_DDEV(card), &dev_id);
	iob->finalize = qeth_idx_finalize_cmd;
	iob->callback = qeth_idx_activate_cb;

	memcpy(QETH_IDX_ACT_PNO(iob->data), &port, 1);
	memcpy(QETH_IDX_ACT_ISSUER_RM_TOKEN(iob->data),
	       &card->token.issuer_rm_w, QETH_MPC_TOKEN_LENGTH);
	memcpy(QETH_IDX_ACT_FUNC_LEVEL(iob->data),
	       &card->info.func_level, 2);
	memcpy(QETH_IDX_ACT_QDIO_DEV_CUA(iob->data), &dev_id.devno, 2);
	memcpy(QETH_IDX_ACT_QDIO_DEV_REALADDR(iob->data), &addr, 2);
}

static int qeth_idx_activate_read_channel(struct qeth_card *card)
{
	struct qeth_channel *channel = &card->read;
	struct qeth_cmd_buffer *iob;
	int rc;

	QETH_DBF_TEXT(SETUP, 2, "idxread");

	iob = qeth_get_buffer(channel);
	if (!iob)
		return -ENOMEM;

	memcpy(iob->data, IDX_ACTIVATE_READ, IDX_ACTIVATE_SIZE);
	qeth_idx_setup_activate_cmd(card, iob);

	rc = qeth_send_control_data(card, IDX_ACTIVATE_SIZE, iob, NULL, NULL);
	if (rc)
		return rc;

	iob = qeth_get_buffer(channel);
	if (!iob)
		return -ENOMEM;

	iob->finalize = qeth_idx_finalize_query_cmd;
	iob->callback = qeth_idx_query_read_cb;
	rc = qeth_send_control_data(card, QETH_BUFSIZE, iob, NULL, NULL);
	if (rc)
		return rc;

	channel->state = CH_STATE_UP;
	return 0;
}

static int qeth_idx_activate_write_channel(struct qeth_card *card)
{
	struct qeth_channel *channel = &card->write;
	struct qeth_cmd_buffer *iob;
	int rc;

	QETH_DBF_TEXT(SETUP, 2, "idxwrite");

	iob = qeth_get_buffer(channel);
	if (!iob)
		return -ENOMEM;

	memcpy(iob->data, IDX_ACTIVATE_WRITE, IDX_ACTIVATE_SIZE);
	qeth_idx_setup_activate_cmd(card, iob);

	rc = qeth_send_control_data(card, IDX_ACTIVATE_SIZE, iob, NULL, NULL);
	if (rc)
		return rc;

	iob = qeth_get_buffer(channel);
	if (!iob)
		return -ENOMEM;

	iob->finalize = qeth_idx_finalize_query_cmd;
	iob->callback = qeth_idx_query_write_cb;
	rc = qeth_send_control_data(card, QETH_BUFSIZE, iob, NULL, NULL);
	if (rc)
		return rc;

	channel->state = CH_STATE_UP;
	return 0;
}

2085 2086 2087 2088 2089
static int qeth_cm_enable_cb(struct qeth_card *card, struct qeth_reply *reply,
		unsigned long data)
{
	struct qeth_cmd_buffer *iob;

2090
	QETH_DBF_TEXT(SETUP, 2, "cmenblcb");
2091 2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102 2103

	iob = (struct qeth_cmd_buffer *) data;
	memcpy(&card->token.cm_filter_r,
	       QETH_CM_ENABLE_RESP_FILTER_TOKEN(iob->data),
	       QETH_MPC_TOKEN_LENGTH);
	return 0;
}

static int qeth_cm_enable(struct qeth_card *card)
{
	int rc;
	struct qeth_cmd_buffer *iob;

2104
	QETH_DBF_TEXT(SETUP, 2, "cmenable");
2105 2106

	iob = qeth_wait_for_buffer(&card->write);
2107
	iob->finalize = qeth_mpc_finalize_cmd;
2108
	memcpy(iob->data, CM_ENABLE, CM_ENABLE_SIZE);
2109

2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124
	memcpy(QETH_CM_ENABLE_ISSUER_RM_TOKEN(iob->data),
	       &card->token.issuer_rm_r, QETH_MPC_TOKEN_LENGTH);
	memcpy(QETH_CM_ENABLE_FILTER_TOKEN(iob->data),
	       &card->token.cm_filter_w, QETH_MPC_TOKEN_LENGTH);

	rc = qeth_send_control_data(card, CM_ENABLE_SIZE, iob,
				    qeth_cm_enable_cb, NULL);
	return rc;
}

static int qeth_cm_setup_cb(struct qeth_card *card, struct qeth_reply *reply,
		unsigned long data)
{
	struct qeth_cmd_buffer *iob;

2125
	QETH_DBF_TEXT(SETUP, 2, "cmsetpcb");
2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138

	iob = (struct qeth_cmd_buffer *) data;
	memcpy(&card->token.cm_connection_r,
	       QETH_CM_SETUP_RESP_DEST_ADDR(iob->data),
	       QETH_MPC_TOKEN_LENGTH);
	return 0;
}

static int qeth_cm_setup(struct qeth_card *card)
{
	int rc;
	struct qeth_cmd_buffer *iob;

2139
	QETH_DBF_TEXT(SETUP, 2, "cmsetup");
2140 2141

	iob = qeth_wait_for_buffer(&card->write);
2142
	iob->finalize = qeth_mpc_finalize_cmd;
2143
	memcpy(iob->data, CM_SETUP, CM_SETUP_SIZE);
2144

2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155
	memcpy(QETH_CM_SETUP_DEST_ADDR(iob->data),
	       &card->token.issuer_rm_r, QETH_MPC_TOKEN_LENGTH);
	memcpy(QETH_CM_SETUP_CONNECTION_TOKEN(iob->data),
	       &card->token.cm_connection_w, QETH_MPC_TOKEN_LENGTH);
	memcpy(QETH_CM_SETUP_FILTER_TOKEN(iob->data),
	       &card->token.cm_filter_r, QETH_MPC_TOKEN_LENGTH);
	rc = qeth_send_control_data(card, CM_SETUP_SIZE, iob,
				    qeth_cm_setup_cb, NULL);
	return rc;
}

2156
static int qeth_update_max_mtu(struct qeth_card *card, unsigned int max_mtu)
2157
{
2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172 2173 2174 2175 2176
	struct net_device *dev = card->dev;
	unsigned int new_mtu;

	if (!max_mtu) {
		/* IQD needs accurate max MTU to set up its RX buffers: */
		if (IS_IQD(card))
			return -EINVAL;
		/* tolerate quirky HW: */
		max_mtu = ETH_MAX_MTU;
	}

	rtnl_lock();
	if (IS_IQD(card)) {
		/* move any device with default MTU to new max MTU: */
		new_mtu = (dev->mtu == dev->max_mtu) ? max_mtu : dev->mtu;

		/* adjust RX buffer size to new max MTU: */
		card->qdio.in_buf_size = max_mtu + 2 * PAGE_SIZE;
		if (dev->max_mtu && dev->max_mtu != max_mtu)
2177
			qeth_free_qdio_queues(card);
2178 2179 2180 2181
	} else {
		if (dev->mtu)
			new_mtu = dev->mtu;
		/* default MTUs for first setup: */
2182
		else if (IS_LAYER2(card))
2183 2184 2185
			new_mtu = ETH_DATA_LEN;
		else
			new_mtu = ETH_DATA_LEN - 8; /* allow for LLC + SNAP */
2186
	}
2187 2188 2189 2190 2191

	dev->max_mtu = max_mtu;
	dev->mtu = min(new_mtu, max_mtu);
	rtnl_unlock();
	return 0;
2192 2193
}

2194
static int qeth_get_mtu_outof_framesize(int framesize)
2195 2196 2197 2198 2199 2200 2201 2202 2203 2204 2205 2206 2207 2208 2209 2210 2211 2212 2213 2214 2215 2216 2217
{
	switch (framesize) {
	case 0x4000:
		return 8192;
	case 0x6000:
		return 16384;
	case 0xa000:
		return 32768;
	case 0xffff:
		return 57344;
	default:
		return 0;
	}
}

static int qeth_ulp_enable_cb(struct qeth_card *card, struct qeth_reply *reply,
		unsigned long data)
{
	__u16 mtu, framesize;
	__u16 len;
	__u8 link_type;
	struct qeth_cmd_buffer *iob;

2218
	QETH_DBF_TEXT(SETUP, 2, "ulpenacb");
2219 2220 2221 2222 2223

	iob = (struct qeth_cmd_buffer *) data;
	memcpy(&card->token.ulp_filter_r,
	       QETH_ULP_ENABLE_RESP_FILTER_TOKEN(iob->data),
	       QETH_MPC_TOKEN_LENGTH);
2224
	if (IS_IQD(card)) {
2225 2226 2227
		memcpy(&framesize, QETH_ULP_ENABLE_RESP_MAX_MTU(iob->data), 2);
		mtu = qeth_get_mtu_outof_framesize(framesize);
	} else {
2228
		mtu = *(__u16 *)QETH_ULP_ENABLE_RESP_MAX_MTU(iob->data);
2229
	}
2230
	*(u16 *)reply->param = mtu;
2231 2232 2233 2234 2235 2236 2237 2238

	memcpy(&len, QETH_ULP_ENABLE_RESP_DIFINFO_LEN(iob->data), 2);
	if (len >= QETH_MPC_DIFINFO_LEN_INDICATES_LINK_TYPE) {
		memcpy(&link_type,
		       QETH_ULP_ENABLE_RESP_LINK_TYPE(iob->data), 1);
		card->info.link_type = link_type;
	} else
		card->info.link_type = 0;
2239
	QETH_DBF_TEXT_(SETUP, 2, "link%d", card->info.link_type);
2240 2241 2242
	return 0;
}

2243 2244 2245 2246
static u8 qeth_mpc_select_prot_type(struct qeth_card *card)
{
	if (IS_OSN(card))
		return QETH_PROT_OSN2;
2247
	return IS_LAYER2(card) ? QETH_PROT_LAYER2 : QETH_PROT_TCPIP;
2248 2249
}

2250 2251
static int qeth_ulp_enable(struct qeth_card *card)
{
2252
	u8 prot_type = qeth_mpc_select_prot_type(card);
2253
	struct qeth_cmd_buffer *iob;
2254
	u16 max_mtu;
2255
	int rc;
2256 2257

	/*FIXME: trace view callbacks*/
2258
	QETH_DBF_TEXT(SETUP, 2, "ulpenabl");
2259 2260

	iob = qeth_wait_for_buffer(&card->write);
2261
	iob->finalize = qeth_mpc_finalize_cmd;
2262 2263
	memcpy(iob->data, ULP_ENABLE, ULP_ENABLE_SIZE);

2264
	*(QETH_ULP_ENABLE_LINKNUM(iob->data)) = (u8) card->dev->dev_port;
2265 2266 2267 2268 2269 2270
	memcpy(QETH_ULP_ENABLE_PROT_TYPE(iob->data), &prot_type, 1);
	memcpy(QETH_ULP_ENABLE_DEST_ADDR(iob->data),
	       &card->token.cm_connection_r, QETH_MPC_TOKEN_LENGTH);
	memcpy(QETH_ULP_ENABLE_FILTER_TOKEN(iob->data),
	       &card->token.ulp_filter_w, QETH_MPC_TOKEN_LENGTH);
	rc = qeth_send_control_data(card, ULP_ENABLE_SIZE, iob,
2271 2272 2273 2274
				    qeth_ulp_enable_cb, &max_mtu);
	if (rc)
		return rc;
	return qeth_update_max_mtu(card, max_mtu);
2275 2276 2277 2278 2279 2280 2281
}

static int qeth_ulp_setup_cb(struct qeth_card *card, struct qeth_reply *reply,
		unsigned long data)
{
	struct qeth_cmd_buffer *iob;

2282
	QETH_DBF_TEXT(SETUP, 2, "ulpstpcb");
2283 2284 2285 2286 2287

	iob = (struct qeth_cmd_buffer *) data;
	memcpy(&card->token.ulp_connection_r,
	       QETH_ULP_SETUP_RESP_CONNECTION_TOKEN(iob->data),
	       QETH_MPC_TOKEN_LENGTH);
2288 2289 2290 2291 2292
	if (!strncmp("00S", QETH_ULP_SETUP_RESP_CONNECTION_TOKEN(iob->data),
		     3)) {
		QETH_DBF_TEXT(SETUP, 2, "olmlimit");
		dev_err(&card->gdev->dev, "A connection could not be "
			"established because of an OLM limit\n");
2293
		return -EMLINK;
2294
	}
2295
	return 0;
2296 2297 2298 2299 2300 2301 2302 2303 2304
}

static int qeth_ulp_setup(struct qeth_card *card)
{
	int rc;
	__u16 temp;
	struct qeth_cmd_buffer *iob;
	struct ccw_dev_id dev_id;

2305
	QETH_DBF_TEXT(SETUP, 2, "ulpsetup");
2306 2307

	iob = qeth_wait_for_buffer(&card->write);
2308
	iob->finalize = qeth_mpc_finalize_cmd;
2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325 2326
	memcpy(iob->data, ULP_SETUP, ULP_SETUP_SIZE);

	memcpy(QETH_ULP_SETUP_DEST_ADDR(iob->data),
	       &card->token.cm_connection_r, QETH_MPC_TOKEN_LENGTH);
	memcpy(QETH_ULP_SETUP_CONNECTION_TOKEN(iob->data),
	       &card->token.ulp_connection_w, QETH_MPC_TOKEN_LENGTH);
	memcpy(QETH_ULP_SETUP_FILTER_TOKEN(iob->data),
	       &card->token.ulp_filter_r, QETH_MPC_TOKEN_LENGTH);

	ccw_device_get_id(CARD_DDEV(card), &dev_id);
	memcpy(QETH_ULP_SETUP_CUA(iob->data), &dev_id.devno, 2);
	temp = (card->info.cula << 8) + card->info.unit_addr2;
	memcpy(QETH_ULP_SETUP_REAL_DEVADDR(iob->data), &temp, 2);
	rc = qeth_send_control_data(card, ULP_SETUP_SIZE, iob,
				    qeth_ulp_setup_cb, NULL);
	return rc;
}

2327 2328 2329 2330 2331
static int qeth_init_qdio_out_buf(struct qeth_qdio_out_q *q, int bidx)
{
	struct qeth_qdio_out_buffer *newbuf;

	newbuf = kmem_cache_zalloc(qeth_qdio_outbuf_cache, GFP_ATOMIC);
2332 2333 2334
	if (!newbuf)
		return -ENOMEM;

2335
	newbuf->buffer = q->qdio_bufs[bidx];
2336 2337 2338 2339 2340 2341
	skb_queue_head_init(&newbuf->skb_list);
	lockdep_set_class(&newbuf->skb_list.lock, &qdio_out_skb_queue_key);
	newbuf->q = q;
	newbuf->next_pending = q->bufs[bidx];
	atomic_set(&newbuf->state, QETH_QDIO_BUF_EMPTY);
	q->bufs[bidx] = newbuf;
2342
	return 0;
2343 2344
}

2345
static void qeth_free_output_queue(struct qeth_qdio_out_q *q)
2346 2347 2348 2349
{
	if (!q)
		return;

2350
	qeth_drain_output_queue(q, true);
2351 2352 2353 2354
	qdio_free_buffers(q->qdio_bufs, QDIO_MAX_BUFFERS_PER_Q);
	kfree(q);
}

2355
static struct qeth_qdio_out_q *qeth_alloc_output_queue(void)
2356 2357 2358 2359 2360 2361 2362 2363 2364 2365 2366 2367
{
	struct qeth_qdio_out_q *q = kzalloc(sizeof(*q), GFP_KERNEL);

	if (!q)
		return NULL;

	if (qdio_alloc_buffers(q->qdio_bufs, QDIO_MAX_BUFFERS_PER_Q)) {
		kfree(q);
		return NULL;
	}
	return q;
}
2368

2369
static int qeth_alloc_qdio_queues(struct qeth_card *card)
2370 2371 2372
{
	int i, j;

2373
	QETH_DBF_TEXT(SETUP, 2, "allcqdbf");
2374 2375 2376 2377 2378

	if (atomic_cmpxchg(&card->qdio.state, QETH_QDIO_UNINITIALIZED,
		QETH_QDIO_ALLOCATED) != QETH_QDIO_UNINITIALIZED)
		return 0;

2379 2380
	QETH_DBF_TEXT(SETUP, 2, "inq");
	card->qdio.in_q = qeth_alloc_qdio_queue();
2381 2382
	if (!card->qdio.in_q)
		goto out_nomem;
2383

2384 2385 2386
	/* inbound buffer pool */
	if (qeth_alloc_buffer_pool(card))
		goto out_freeinq;
2387

2388 2389
	/* outbound */
	for (i = 0; i < card->qdio.no_out_queues; ++i) {
2390
		card->qdio.out_qs[i] = qeth_alloc_output_queue();
2391 2392
		if (!card->qdio.out_qs[i])
			goto out_freeoutq;
2393 2394
		QETH_DBF_TEXT_(SETUP, 2, "outq %i", i);
		QETH_DBF_HEX(SETUP, 2, &card->qdio.out_qs[i], sizeof(void *));
2395
		card->qdio.out_qs[i]->card = card;
2396 2397 2398
		card->qdio.out_qs[i]->queue_no = i;
		/* give outbound qeth_qdio_buffers their qdio_buffers */
		for (j = 0; j < QDIO_MAX_BUFFERS_PER_Q; ++j) {
S
Stefan Raspl 已提交
2399
			WARN_ON(card->qdio.out_qs[i]->bufs[j] != NULL);
2400 2401
			if (qeth_init_qdio_out_buf(card->qdio.out_qs[i], j))
				goto out_freeoutqbufs;
2402 2403
		}
	}
2404 2405 2406 2407 2408

	/* completion */
	if (qeth_alloc_cq(card))
		goto out_freeoutq;

2409 2410
	return 0;

2411 2412 2413 2414 2415 2416 2417
out_freeoutqbufs:
	while (j > 0) {
		--j;
		kmem_cache_free(qeth_qdio_outbuf_cache,
				card->qdio.out_qs[i]->bufs[j]);
		card->qdio.out_qs[i]->bufs[j] = NULL;
	}
2418
out_freeoutq:
2419
	while (i > 0) {
2420
		qeth_free_output_queue(card->qdio.out_qs[--i]);
2421 2422
		card->qdio.out_qs[i] = NULL;
	}
2423 2424
	qeth_free_buffer_pool(card);
out_freeinq:
2425
	qeth_free_qdio_queue(card->qdio.in_q);
2426 2427 2428 2429 2430 2431
	card->qdio.in_q = NULL;
out_nomem:
	atomic_set(&card->qdio.state, QETH_QDIO_UNINITIALIZED);
	return -ENOMEM;
}

2432
static void qeth_free_qdio_queues(struct qeth_card *card)
2433 2434 2435 2436 2437 2438 2439 2440 2441 2442 2443 2444 2445 2446 2447 2448 2449 2450
{
	int i, j;

	if (atomic_xchg(&card->qdio.state, QETH_QDIO_UNINITIALIZED) ==
		QETH_QDIO_UNINITIALIZED)
		return;

	qeth_free_cq(card);
	cancel_delayed_work_sync(&card->buffer_reclaim_work);
	for (j = 0; j < QDIO_MAX_BUFFERS_PER_Q; ++j) {
		if (card->qdio.in_q->bufs[j].rx_skb)
			dev_kfree_skb_any(card->qdio.in_q->bufs[j].rx_skb);
	}
	qeth_free_qdio_queue(card->qdio.in_q);
	card->qdio.in_q = NULL;
	/* inbound buffer pool */
	qeth_free_buffer_pool(card);
	/* free outbound qdio_qs */
2451 2452 2453
	for (i = 0; i < card->qdio.no_out_queues; i++) {
		qeth_free_output_queue(card->qdio.out_qs[i]);
		card->qdio.out_qs[i] = NULL;
2454 2455 2456
	}
}

2457 2458 2459 2460 2461 2462 2463 2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474 2475 2476 2477 2478 2479 2480 2481 2482 2483 2484
static void qeth_create_qib_param_field(struct qeth_card *card,
		char *param_field)
{

	param_field[0] = _ascebc['P'];
	param_field[1] = _ascebc['C'];
	param_field[2] = _ascebc['I'];
	param_field[3] = _ascebc['T'];
	*((unsigned int *) (&param_field[4])) = QETH_PCI_THRESHOLD_A(card);
	*((unsigned int *) (&param_field[8])) = QETH_PCI_THRESHOLD_B(card);
	*((unsigned int *) (&param_field[12])) = QETH_PCI_TIMER_VALUE(card);
}

static void qeth_create_qib_param_field_blkt(struct qeth_card *card,
		char *param_field)
{
	param_field[16] = _ascebc['B'];
	param_field[17] = _ascebc['L'];
	param_field[18] = _ascebc['K'];
	param_field[19] = _ascebc['T'];
	*((unsigned int *) (&param_field[20])) = card->info.blkt.time_total;
	*((unsigned int *) (&param_field[24])) = card->info.blkt.inter_packet;
	*((unsigned int *) (&param_field[28])) =
		card->info.blkt.inter_packet_jumbo;
}

static int qeth_qdio_activate(struct qeth_card *card)
{
2485
	QETH_DBF_TEXT(SETUP, 3, "qdioact");
2486
	return qdio_activate(CARD_DDEV(card));
2487 2488 2489 2490 2491 2492 2493
}

static int qeth_dm_act(struct qeth_card *card)
{
	int rc;
	struct qeth_cmd_buffer *iob;

2494
	QETH_DBF_TEXT(SETUP, 2, "dmact");
2495 2496

	iob = qeth_wait_for_buffer(&card->write);
2497
	iob->finalize = qeth_mpc_finalize_cmd;
2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509 2510 2511
	memcpy(iob->data, DM_ACT, DM_ACT_SIZE);

	memcpy(QETH_DM_ACT_DEST_ADDR(iob->data),
	       &card->token.cm_connection_r, QETH_MPC_TOKEN_LENGTH);
	memcpy(QETH_DM_ACT_CONNECTION_TOKEN(iob->data),
	       &card->token.ulp_connection_r, QETH_MPC_TOKEN_LENGTH);
	rc = qeth_send_control_data(card, DM_ACT_SIZE, iob, NULL, NULL);
	return rc;
}

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

2512
	QETH_DBF_TEXT(SETUP, 2, "mpcinit");
2513 2514 2515

	rc = qeth_issue_next_read(card);
	if (rc) {
2516
		QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
2517 2518 2519 2520
		return rc;
	}
	rc = qeth_cm_enable(card);
	if (rc) {
2521
		QETH_DBF_TEXT_(SETUP, 2, "2err%d", rc);
2522 2523 2524 2525
		goto out_qdio;
	}
	rc = qeth_cm_setup(card);
	if (rc) {
2526
		QETH_DBF_TEXT_(SETUP, 2, "3err%d", rc);
2527 2528 2529 2530
		goto out_qdio;
	}
	rc = qeth_ulp_enable(card);
	if (rc) {
2531
		QETH_DBF_TEXT_(SETUP, 2, "4err%d", rc);
2532 2533 2534 2535
		goto out_qdio;
	}
	rc = qeth_ulp_setup(card);
	if (rc) {
2536
		QETH_DBF_TEXT_(SETUP, 2, "5err%d", rc);
2537 2538
		goto out_qdio;
	}
2539
	rc = qeth_alloc_qdio_queues(card);
2540
	if (rc) {
2541
		QETH_DBF_TEXT_(SETUP, 2, "5err%d", rc);
2542 2543 2544 2545
		goto out_qdio;
	}
	rc = qeth_qdio_establish(card);
	if (rc) {
2546
		QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc);
2547
		qeth_free_qdio_queues(card);
2548 2549 2550 2551
		goto out_qdio;
	}
	rc = qeth_qdio_activate(card);
	if (rc) {
2552
		QETH_DBF_TEXT_(SETUP, 2, "7err%d", rc);
2553 2554 2555 2556
		goto out_qdio;
	}
	rc = qeth_dm_act(card);
	if (rc) {
2557
		QETH_DBF_TEXT_(SETUP, 2, "8err%d", rc);
2558 2559 2560 2561 2562
		goto out_qdio;
	}

	return 0;
out_qdio:
2563
	qeth_qdio_clear_card(card, !IS_IQD(card));
2564
	qdio_free(CARD_DDEV(card));
2565 2566 2567 2568 2569 2570
	return rc;
}

void qeth_print_status_message(struct qeth_card *card)
{
	switch (card->info.type) {
2571 2572 2573
	case QETH_CARD_TYPE_OSD:
	case QETH_CARD_TYPE_OSM:
	case QETH_CARD_TYPE_OSX:
2574 2575 2576 2577 2578 2579 2580 2581 2582 2583 2584 2585
		/* VM will use a non-zero first character
		 * to indicate a HiperSockets like reporting
		 * of the level OSA sets the first character to zero
		 * */
		if (!card->info.mcl_level[0]) {
			sprintf(card->info.mcl_level, "%02x%02x",
				card->info.mcl_level[2],
				card->info.mcl_level[3]);
			break;
		}
		/* fallthrough */
	case QETH_CARD_TYPE_IQD:
2586
		if (IS_VM_NIC(card) || (card->info.mcl_level[0] & 0x80)) {
2587 2588 2589 2590 2591 2592 2593 2594 2595 2596 2597 2598 2599 2600
			card->info.mcl_level[0] = (char) _ebcasc[(__u8)
				card->info.mcl_level[0]];
			card->info.mcl_level[1] = (char) _ebcasc[(__u8)
				card->info.mcl_level[1]];
			card->info.mcl_level[2] = (char) _ebcasc[(__u8)
				card->info.mcl_level[2]];
			card->info.mcl_level[3] = (char) _ebcasc[(__u8)
				card->info.mcl_level[3]];
			card->info.mcl_level[QETH_MCL_LENGTH] = 0;
		}
		break;
	default:
		memset(&card->info.mcl_level[0], 0, QETH_MCL_LENGTH + 1);
	}
2601 2602 2603 2604 2605 2606 2607
	dev_info(&card->gdev->dev,
		 "Device is a%s card%s%s%s\nwith link type %s.\n",
		 qeth_get_cardname(card),
		 (card->info.mcl_level[0]) ? " (level: " : "",
		 (card->info.mcl_level[0]) ? card->info.mcl_level : "",
		 (card->info.mcl_level[0]) ? ")" : "",
		 qeth_get_cardname_short(card));
2608 2609 2610 2611 2612 2613 2614
}
EXPORT_SYMBOL_GPL(qeth_print_status_message);

static void qeth_initialize_working_pool_list(struct qeth_card *card)
{
	struct qeth_buffer_pool_entry *entry;

2615
	QETH_CARD_TEXT(card, 5, "inwrklst");
2616 2617 2618 2619 2620 2621 2622

	list_for_each_entry(entry,
			    &card->qdio.init_pool.entry_list, init_list) {
		qeth_put_buffer_pool_entry(card, entry);
	}
}

2623 2624
static struct qeth_buffer_pool_entry *qeth_find_free_buffer_pool_entry(
					struct qeth_card *card)
2625 2626 2627 2628 2629 2630 2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643 2644 2645 2646 2647 2648 2649 2650 2651 2652 2653
{
	struct list_head *plh;
	struct qeth_buffer_pool_entry *entry;
	int i, free;
	struct page *page;

	if (list_empty(&card->qdio.in_buf_pool.entry_list))
		return NULL;

	list_for_each(plh, &card->qdio.in_buf_pool.entry_list) {
		entry = list_entry(plh, struct qeth_buffer_pool_entry, list);
		free = 1;
		for (i = 0; i < QETH_MAX_BUFFER_ELEMENTS(card); ++i) {
			if (page_count(virt_to_page(entry->elements[i])) > 1) {
				free = 0;
				break;
			}
		}
		if (free) {
			list_del_init(&entry->list);
			return entry;
		}
	}

	/* no free buffer in pool so take first one and swap pages */
	entry = list_entry(card->qdio.in_buf_pool.entry_list.next,
			struct qeth_buffer_pool_entry, list);
	for (i = 0; i < QETH_MAX_BUFFER_ELEMENTS(card); ++i) {
		if (page_count(virt_to_page(entry->elements[i])) > 1) {
2654
			page = alloc_page(GFP_ATOMIC);
2655 2656 2657 2658 2659
			if (!page) {
				return NULL;
			} else {
				free_page((unsigned long)entry->elements[i]);
				entry->elements[i] = page_address(page);
2660
				QETH_CARD_STAT_INC(card, rx_sg_alloc_page);
2661 2662 2663 2664 2665 2666 2667 2668 2669 2670 2671 2672 2673
			}
		}
	}
	list_del_init(&entry->list);
	return entry;
}

static int qeth_init_input_buffer(struct qeth_card *card,
		struct qeth_qdio_buffer *buf)
{
	struct qeth_buffer_pool_entry *pool_entry;
	int i;

2674
	if ((card->options.cq == QETH_CQ_ENABLED) && (!buf->rx_skb)) {
2675 2676
		buf->rx_skb = netdev_alloc_skb(card->dev,
					       QETH_RX_PULL_LEN + ETH_HLEN);
2677 2678 2679 2680
		if (!buf->rx_skb)
			return 1;
	}

2681 2682 2683 2684 2685 2686 2687 2688 2689 2690 2691 2692 2693 2694 2695 2696
	pool_entry = qeth_find_free_buffer_pool_entry(card);
	if (!pool_entry)
		return 1;

	/*
	 * since the buffer is accessed only from the input_tasklet
	 * there shouldn't be a need to synchronize; also, since we use
	 * the QETH_IN_BUF_REQUEUE_THRESHOLD we should never run  out off
	 * buffers
	 */

	buf->pool_entry = pool_entry;
	for (i = 0; i < QETH_MAX_BUFFER_ELEMENTS(card); ++i) {
		buf->buffer->element[i].length = PAGE_SIZE;
		buf->buffer->element[i].addr =  pool_entry->elements[i];
		if (i == QETH_MAX_BUFFER_ELEMENTS(card) - 1)
2697
			buf->buffer->element[i].eflags = SBAL_EFLAGS_LAST_ENTRY;
2698
		else
2699 2700
			buf->buffer->element[i].eflags = 0;
		buf->buffer->element[i].sflags = 0;
2701 2702 2703 2704 2705 2706
	}
	return 0;
}

int qeth_init_qdio_queues(struct qeth_card *card)
{
2707
	unsigned int i;
2708 2709
	int rc;

2710
	QETH_DBF_TEXT(SETUP, 2, "initqdqs");
2711 2712

	/* inbound queue */
2713 2714
	qdio_reset_buffers(card->qdio.in_q->qdio_bufs, QDIO_MAX_BUFFERS_PER_Q);
	memset(&card->rx, 0, sizeof(struct qeth_rx));
2715 2716 2717 2718 2719 2720 2721
	qeth_initialize_working_pool_list(card);
	/*give only as many buffers to hardware as we have buffer pool entries*/
	for (i = 0; i < card->qdio.in_buf_pool.buf_count - 1; ++i)
		qeth_init_input_buffer(card, &card->qdio.in_q->bufs[i]);
	card->qdio.in_q->next_buf_to_init =
		card->qdio.in_buf_pool.buf_count - 1;
	rc = do_QDIO(CARD_DDEV(card), QDIO_FLAG_SYNC_INPUT, 0, 0,
2722
		     card->qdio.in_buf_pool.buf_count - 1);
2723
	if (rc) {
2724
		QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
2725 2726
		return rc;
	}
2727 2728 2729 2730 2731 2732 2733

	/* completion */
	rc = qeth_cq_init(card);
	if (rc) {
		return rc;
	}

2734 2735
	/* outbound queue */
	for (i = 0; i < card->qdio.no_out_queues; ++i) {
2736 2737 2738 2739 2740 2741 2742 2743 2744
		struct qeth_qdio_out_q *queue = card->qdio.out_qs[i];

		qdio_reset_buffers(queue->qdio_bufs, QDIO_MAX_BUFFERS_PER_Q);
		queue->max_elements = QETH_MAX_BUFFER_ELEMENTS(card);
		queue->next_buf_to_fill = 0;
		queue->do_pack = 0;
		atomic_set(&queue->used_buffers, 0);
		atomic_set(&queue->set_pci_flags_count, 0);
		atomic_set(&queue->state, QETH_OUT_Q_UNLOCKED);
2745 2746 2747 2748 2749
	}
	return 0;
}
EXPORT_SYMBOL_GPL(qeth_init_qdio_queues);

2750
static __u8 qeth_get_ipa_adp_type(enum qeth_link_types link_type)
2751 2752 2753 2754 2755 2756 2757 2758 2759 2760
{
	switch (link_type) {
	case QETH_LINK_TYPE_HSTR:
		return 2;
	default:
		return 1;
	}
}

static void qeth_fill_ipacmd_header(struct qeth_card *card,
2761 2762 2763
				    struct qeth_ipa_cmd *cmd,
				    enum qeth_ipa_cmds command,
				    enum qeth_prot_versions prot)
2764 2765 2766
{
	cmd->hdr.command = command;
	cmd->hdr.initiator = IPA_CMD_INITIATOR_HOST;
2767
	/* cmd->hdr.seqno is set by qeth_send_control_data() */
2768
	cmd->hdr.adapter_type = qeth_get_ipa_adp_type(card->info.link_type);
2769
	cmd->hdr.rel_adapter_no = (u8) card->dev->dev_port;
2770
	cmd->hdr.prim_version_no = IS_LAYER2(card) ? 2 : 1;
2771 2772 2773 2774
	cmd->hdr.param_count = 1;
	cmd->hdr.prot_version = prot;
}

2775 2776 2777 2778 2779 2780 2781 2782 2783 2784 2785
static void qeth_ipa_finalize_cmd(struct qeth_card *card,
				  struct qeth_cmd_buffer *iob,
				  unsigned int length)
{
	qeth_mpc_finalize_cmd(card, iob, length);

	/* override with IPA-specific values: */
	__ipa_cmd(iob)->hdr.seqno = card->seqno.ipa;
	iob->reply->seqno = card->seqno.ipa++;
}

2786 2787
void qeth_prepare_ipa_cmd(struct qeth_card *card, struct qeth_cmd_buffer *iob,
			  u16 cmd_length)
2788
{
2789
	u16 total_length = IPA_PDU_HEADER_SIZE + cmd_length;
2790 2791
	u8 prot_type = qeth_mpc_select_prot_type(card);

2792
	iob->finalize = qeth_ipa_finalize_cmd;
2793 2794
	iob->timeout = QETH_IPA_TIMEOUT;

2795
	memcpy(iob->data, IPA_PDU_HEADER, IPA_PDU_HEADER_SIZE);
2796
	memcpy(QETH_IPA_PDU_LEN_TOTAL(iob->data), &total_length, 2);
2797
	memcpy(QETH_IPA_CMD_PROT_TYPE(iob->data), &prot_type, 1);
2798 2799
	memcpy(QETH_IPA_PDU_LEN_PDU1(iob->data), &cmd_length, 2);
	memcpy(QETH_IPA_PDU_LEN_PDU2(iob->data), &cmd_length, 2);
2800 2801
	memcpy(QETH_IPA_CMD_DEST_ADDR(iob->data),
	       &card->token.ulp_connection_r, QETH_MPC_TOKEN_LENGTH);
2802
	memcpy(QETH_IPA_PDU_LEN_PDU3(iob->data), &cmd_length, 2);
2803 2804 2805
}
EXPORT_SYMBOL_GPL(qeth_prepare_ipa_cmd);

2806 2807 2808 2809 2810
struct qeth_cmd_buffer *qeth_get_ipacmd_buffer(struct qeth_card *card,
		enum qeth_ipa_cmds ipacmd, enum qeth_prot_versions prot)
{
	struct qeth_cmd_buffer *iob;

2811 2812
	iob = qeth_get_buffer(&card->write);
	if (iob) {
2813
		qeth_prepare_ipa_cmd(card, iob, sizeof(struct qeth_ipa_cmd));
2814
		qeth_fill_ipacmd_header(card, __ipa_cmd(iob), ipacmd, prot);
2815 2816 2817
	} else {
		dev_warn(&card->gdev->dev,
			 "The qeth driver ran out of channel command buffers\n");
2818 2819
		QETH_DBF_MESSAGE(1, "device %x ran out of channel command buffers",
				 CARD_DEVID(card));
2820
	}
2821 2822 2823 2824 2825

	return iob;
}
EXPORT_SYMBOL_GPL(qeth_get_ipacmd_buffer);

2826 2827 2828 2829 2830 2831 2832 2833
static int qeth_send_ipa_cmd_cb(struct qeth_card *card,
				struct qeth_reply *reply, unsigned long data)
{
	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;

	return (cmd->hdr.return_code) ? -EIO : 0;
}

2834 2835 2836 2837 2838 2839
/**
 * qeth_send_ipa_cmd() - send an IPA command
 *
 * See qeth_send_control_data() for explanation of the arguments.
 */

2840 2841 2842 2843 2844
int qeth_send_ipa_cmd(struct qeth_card *card, struct qeth_cmd_buffer *iob,
		int (*reply_cb)(struct qeth_card *, struct qeth_reply*,
			unsigned long),
		void *reply_param)
{
2845
	u16 length;
2846 2847
	int rc;

2848
	QETH_CARD_TEXT(card, 4, "sendipa");
2849

2850 2851 2852 2853 2854
	if (card->read_or_write_problem) {
		qeth_release_buffer(iob->channel, iob);
		return -EIO;
	}

2855 2856
	if (reply_cb == NULL)
		reply_cb = qeth_send_ipa_cmd_cb;
2857 2858
	memcpy(&length, QETH_IPA_PDU_LEN_TOTAL(iob->data), 2);
	rc = qeth_send_control_data(card, length, iob, reply_cb, reply_param);
2859 2860 2861 2862
	if (rc == -ETIME) {
		qeth_clear_ipacmd_list(card);
		qeth_schedule_recovery(card);
	}
2863 2864 2865 2866
	return rc;
}
EXPORT_SYMBOL_GPL(qeth_send_ipa_cmd);

2867 2868 2869 2870 2871 2872 2873 2874 2875 2876 2877
static int qeth_send_startlan_cb(struct qeth_card *card,
				 struct qeth_reply *reply, unsigned long data)
{
	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;

	if (cmd->hdr.return_code == IPA_RC_LAN_OFFLINE)
		return -ENETDOWN;

	return (cmd->hdr.return_code) ? -EIO : 0;
}

2878
static int qeth_send_startlan(struct qeth_card *card)
2879
{
2880
	struct qeth_cmd_buffer *iob;
2881

2882
	QETH_DBF_TEXT(SETUP, 2, "strtlan");
2883

2884
	iob = qeth_get_ipacmd_buffer(card, IPA_CMD_STARTLAN, 0);
2885 2886
	if (!iob)
		return -ENOMEM;
2887
	return qeth_send_ipa_cmd(card, iob, qeth_send_startlan_cb, NULL);
2888 2889
}

2890
static int qeth_setadpparms_inspect_rc(struct qeth_ipa_cmd *cmd)
2891
{
2892
	if (!cmd->hdr.return_code)
2893 2894
		cmd->hdr.return_code =
			cmd->data.setadapterparms.hdr.return_code;
2895
	return cmd->hdr.return_code;
2896 2897 2898 2899 2900
}

static int qeth_query_setadapterparms_cb(struct qeth_card *card,
		struct qeth_reply *reply, unsigned long data)
{
2901
	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
2902

2903
	QETH_CARD_TEXT(card, 3, "quyadpcb");
2904
	if (qeth_setadpparms_inspect_rc(cmd))
2905
		return -EIO;
2906

2907
	if (cmd->data.setadapterparms.data.query_cmds_supp.lan_type & 0x7f) {
2908 2909
		card->info.link_type =
		      cmd->data.setadapterparms.data.query_cmds_supp.lan_type;
2910 2911
		QETH_DBF_TEXT_(SETUP, 2, "lnk %d", card->info.link_type);
	}
2912 2913
	card->options.adp.supported_funcs =
		cmd->data.setadapterparms.data.query_cmds_supp.supported_cmds;
2914
	return 0;
2915 2916
}

2917
static struct qeth_cmd_buffer *qeth_get_adapter_cmd(struct qeth_card *card,
2918 2919 2920 2921 2922 2923 2924
		__u32 command, __u32 cmdlen)
{
	struct qeth_cmd_buffer *iob;
	struct qeth_ipa_cmd *cmd;

	iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SETADAPTERPARMS,
				     QETH_PROT_IPV4);
2925
	if (iob) {
2926
		cmd = __ipa_cmd(iob);
2927 2928 2929 2930 2931
		cmd->data.setadapterparms.hdr.cmdlength = cmdlen;
		cmd->data.setadapterparms.hdr.command_code = command;
		cmd->data.setadapterparms.hdr.used_total = 1;
		cmd->data.setadapterparms.hdr.seq_no = 1;
	}
2932 2933 2934 2935

	return iob;
}

2936
static int qeth_query_setadapterparms(struct qeth_card *card)
2937 2938 2939 2940
{
	int rc;
	struct qeth_cmd_buffer *iob;

2941
	QETH_CARD_TEXT(card, 3, "queryadp");
2942 2943
	iob = qeth_get_adapter_cmd(card, IPA_SETADP_QUERY_COMMANDS_SUPPORTED,
				   sizeof(struct qeth_ipacmd_setadpparms));
2944 2945
	if (!iob)
		return -ENOMEM;
2946 2947 2948 2949
	rc = qeth_send_ipa_cmd(card, iob, qeth_query_setadapterparms_cb, NULL);
	return rc;
}

2950 2951 2952 2953 2954 2955 2956 2957
static int qeth_query_ipassists_cb(struct qeth_card *card,
		struct qeth_reply *reply, unsigned long data)
{
	struct qeth_ipa_cmd *cmd;

	QETH_DBF_TEXT(SETUP, 2, "qipasscb");

	cmd = (struct qeth_ipa_cmd *) data;
2958 2959

	switch (cmd->hdr.return_code) {
2960 2961
	case IPA_RC_SUCCESS:
		break;
2962 2963 2964 2965 2966
	case IPA_RC_NOTSUPP:
	case IPA_RC_L2_UNSUPPORTED_CMD:
		QETH_DBF_TEXT(SETUP, 2, "ipaunsup");
		card->options.ipa4.supported_funcs |= IPA_SETADAPTERPARMS;
		card->options.ipa6.supported_funcs |= IPA_SETADAPTERPARMS;
2967
		return -EOPNOTSUPP;
2968
	default:
2969 2970 2971
		QETH_DBF_MESSAGE(1, "IPA_CMD_QIPASSIST on device %x: Unhandled rc=%#x\n",
				 CARD_DEVID(card), cmd->hdr.return_code);
		return -EIO;
2972 2973
	}

2974 2975 2976
	if (cmd->hdr.prot_version == QETH_PROT_IPV4) {
		card->options.ipa4.supported_funcs = cmd->hdr.ipa_supported;
		card->options.ipa4.enabled_funcs = cmd->hdr.ipa_enabled;
2977
	} else if (cmd->hdr.prot_version == QETH_PROT_IPV6) {
2978 2979
		card->options.ipa6.supported_funcs = cmd->hdr.ipa_supported;
		card->options.ipa6.enabled_funcs = cmd->hdr.ipa_enabled;
2980
	} else
2981 2982
		QETH_DBF_MESSAGE(1, "IPA_CMD_QIPASSIST on device %x: Flawed LIC detected\n",
				 CARD_DEVID(card));
2983 2984 2985
	return 0;
}

2986 2987
static int qeth_query_ipassists(struct qeth_card *card,
				enum qeth_prot_versions prot)
2988 2989 2990 2991 2992 2993
{
	int rc;
	struct qeth_cmd_buffer *iob;

	QETH_DBF_TEXT_(SETUP, 2, "qipassi%i", prot);
	iob = qeth_get_ipacmd_buffer(card, IPA_CMD_QIPASSIST, prot);
2994 2995
	if (!iob)
		return -ENOMEM;
2996 2997 2998 2999
	rc = qeth_send_ipa_cmd(card, iob, qeth_query_ipassists_cb, NULL);
	return rc;
}

3000 3001 3002
static int qeth_query_switch_attributes_cb(struct qeth_card *card,
				struct qeth_reply *reply, unsigned long data)
{
3003
	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
3004
	struct qeth_query_switch_attributes *attrs;
3005
	struct qeth_switch_info *sw_info;
3006 3007

	QETH_CARD_TEXT(card, 2, "qswiatcb");
3008
	if (qeth_setadpparms_inspect_rc(cmd))
3009
		return -EIO;
3010

3011 3012 3013 3014 3015 3016
	sw_info = (struct qeth_switch_info *)reply->param;
	attrs = &cmd->data.setadapterparms.data.query_switch_attributes;
	sw_info->capabilities = attrs->capabilities;
	sw_info->settings = attrs->settings;
	QETH_CARD_TEXT_(card, 2, "%04x%04x", sw_info->capabilities,
			sw_info->settings);
3017 3018 3019 3020 3021 3022 3023 3024 3025 3026 3027 3028 3029 3030 3031
	return 0;
}

int qeth_query_switch_attributes(struct qeth_card *card,
				 struct qeth_switch_info *sw_info)
{
	struct qeth_cmd_buffer *iob;

	QETH_CARD_TEXT(card, 2, "qswiattr");
	if (!qeth_adp_supported(card, IPA_SETADP_QUERY_SWITCH_ATTRIBUTES))
		return -EOPNOTSUPP;
	if (!netif_carrier_ok(card->dev))
		return -ENOMEDIUM;
	iob = qeth_get_adapter_cmd(card, IPA_SETADP_QUERY_SWITCH_ATTRIBUTES,
				sizeof(struct qeth_ipacmd_setadpparms_hdr));
3032 3033
	if (!iob)
		return -ENOMEM;
3034 3035 3036 3037
	return qeth_send_ipa_cmd(card, iob,
				qeth_query_switch_attributes_cb, sw_info);
}

3038 3039 3040
static int qeth_query_setdiagass_cb(struct qeth_card *card,
		struct qeth_reply *reply, unsigned long data)
{
3041 3042
	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
	u16 rc = cmd->hdr.return_code;
3043

3044
	if (rc) {
3045
		QETH_CARD_TEXT_(card, 2, "diagq:%x", rc);
3046 3047 3048 3049
		return -EIO;
	}

	card->info.diagass_support = cmd->data.diagass.ext;
3050 3051 3052 3053 3054 3055 3056 3057 3058 3059
	return 0;
}

static int qeth_query_setdiagass(struct qeth_card *card)
{
	struct qeth_cmd_buffer *iob;
	struct qeth_ipa_cmd    *cmd;

	QETH_DBF_TEXT(SETUP, 2, "qdiagass");
	iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SET_DIAG_ASS, 0);
3060 3061
	if (!iob)
		return -ENOMEM;
3062
	cmd = __ipa_cmd(iob);
3063 3064 3065 3066 3067 3068 3069 3070 3071 3072 3073
	cmd->data.diagass.subcmd_len = 16;
	cmd->data.diagass.subcmd = QETH_DIAGS_CMD_QUERY;
	return qeth_send_ipa_cmd(card, iob, qeth_query_setdiagass_cb, NULL);
}

static void qeth_get_trap_id(struct qeth_card *card, struct qeth_trap_id *tid)
{
	unsigned long info = get_zeroed_page(GFP_KERNEL);
	struct sysinfo_2_2_2 *info222 = (struct sysinfo_2_2_2 *)info;
	struct sysinfo_3_2_2 *info322 = (struct sysinfo_3_2_2 *)info;
	struct ccw_dev_id ccwid;
3074
	int level;
3075 3076 3077 3078 3079 3080 3081

	tid->chpid = card->info.chpid;
	ccw_device_get_id(CARD_RDEV(card), &ccwid);
	tid->ssid = ccwid.ssid;
	tid->devno = ccwid.devno;
	if (!info)
		return;
3082 3083
	level = stsi(NULL, 0, 0, 0);
	if ((level >= 2) && (stsi(info222, 2, 2, 2) == 0))
3084
		tid->lparnr = info222->lpar_number;
3085
	if ((level >= 3) && (stsi(info322, 3, 2, 2) == 0)) {
3086 3087 3088 3089 3090 3091 3092 3093 3094 3095
		EBCASC(info322->vm[0].name, sizeof(info322->vm[0].name));
		memcpy(tid->vmname, info322->vm[0].name, sizeof(tid->vmname));
	}
	free_page(info);
	return;
}

static int qeth_hw_trap_cb(struct qeth_card *card,
		struct qeth_reply *reply, unsigned long data)
{
3096 3097
	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
	u16 rc = cmd->hdr.return_code;
3098

3099
	if (rc) {
3100
		QETH_CARD_TEXT_(card, 2, "trapc:%x", rc);
3101 3102
		return -EIO;
	}
3103 3104 3105 3106 3107 3108 3109 3110 3111 3112
	return 0;
}

int qeth_hw_trap(struct qeth_card *card, enum qeth_diags_trap_action action)
{
	struct qeth_cmd_buffer *iob;
	struct qeth_ipa_cmd *cmd;

	QETH_DBF_TEXT(SETUP, 2, "diagtrap");
	iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SET_DIAG_ASS, 0);
3113 3114
	if (!iob)
		return -ENOMEM;
3115
	cmd = __ipa_cmd(iob);
3116 3117 3118 3119 3120 3121 3122 3123 3124 3125 3126 3127 3128 3129 3130 3131 3132 3133 3134 3135 3136 3137
	cmd->data.diagass.subcmd_len = 80;
	cmd->data.diagass.subcmd = QETH_DIAGS_CMD_TRAP;
	cmd->data.diagass.type = 1;
	cmd->data.diagass.action = action;
	switch (action) {
	case QETH_DIAGS_TRAP_ARM:
		cmd->data.diagass.options = 0x0003;
		cmd->data.diagass.ext = 0x00010000 +
			sizeof(struct qeth_trap_id);
		qeth_get_trap_id(card,
			(struct qeth_trap_id *)cmd->data.diagass.cdata);
		break;
	case QETH_DIAGS_TRAP_DISARM:
		cmd->data.diagass.options = 0x0001;
		break;
	case QETH_DIAGS_TRAP_CAPTURE:
		break;
	}
	return qeth_send_ipa_cmd(card, iob, qeth_hw_trap_cb, NULL);
}
EXPORT_SYMBOL_GPL(qeth_hw_trap);

3138 3139 3140 3141
static int qeth_check_qdio_errors(struct qeth_card *card,
				  struct qdio_buffer *buf,
				  unsigned int qdio_error,
				  const char *dbftext)
3142
{
3143
	if (qdio_error) {
3144
		QETH_CARD_TEXT(card, 2, dbftext);
3145
		QETH_CARD_TEXT_(card, 2, " F15=%02X",
3146
			       buf->element[15].sflags);
3147
		QETH_CARD_TEXT_(card, 2, " F14=%02X",
3148
			       buf->element[14].sflags);
3149
		QETH_CARD_TEXT_(card, 2, " qerr=%X", qdio_error);
3150
		if ((buf->element[15].sflags) == 0x12) {
3151
			QETH_CARD_STAT_INC(card, rx_dropped);
3152 3153 3154
			return 0;
		} else
			return 1;
3155 3156 3157 3158
	}
	return 0;
}

3159
static void qeth_queue_input_buffer(struct qeth_card *card, int index)
3160 3161
{
	struct qeth_qdio_q *queue = card->qdio.in_q;
3162
	struct list_head *lh;
3163 3164 3165 3166 3167 3168 3169 3170 3171 3172 3173 3174 3175 3176 3177 3178 3179 3180 3181 3182 3183 3184 3185 3186 3187 3188 3189 3190 3191 3192 3193
	int count;
	int i;
	int rc;
	int newcount = 0;

	count = (index < queue->next_buf_to_init)?
		card->qdio.in_buf_pool.buf_count -
		(queue->next_buf_to_init - index) :
		card->qdio.in_buf_pool.buf_count -
		(queue->next_buf_to_init + QDIO_MAX_BUFFERS_PER_Q - index);
	/* only requeue at a certain threshold to avoid SIGAs */
	if (count >= QETH_IN_BUF_REQUEUE_THRESHOLD(card)) {
		for (i = queue->next_buf_to_init;
		     i < queue->next_buf_to_init + count; ++i) {
			if (qeth_init_input_buffer(card,
				&queue->bufs[i % QDIO_MAX_BUFFERS_PER_Q])) {
				break;
			} else {
				newcount++;
			}
		}

		if (newcount < count) {
			/* we are in memory shortage so we switch back to
			   traditional skb allocation and drop packages */
			atomic_set(&card->force_alloc_skb, 3);
			count = newcount;
		} else {
			atomic_add_unless(&card->force_alloc_skb, -1, 0);
		}

3194 3195 3196 3197 3198 3199 3200 3201 3202 3203 3204 3205 3206 3207
		if (!count) {
			i = 0;
			list_for_each(lh, &card->qdio.in_buf_pool.entry_list)
				i++;
			if (i == card->qdio.in_buf_pool.buf_count) {
				QETH_CARD_TEXT(card, 2, "qsarbw");
				card->reclaim_index = index;
				schedule_delayed_work(
					&card->buffer_reclaim_work,
					QETH_RECLAIM_WORK_TIME);
			}
			return;
		}

3208 3209 3210 3211 3212 3213 3214
		/*
		 * according to old code it should be avoided to requeue all
		 * 128 buffers in order to benefit from PCI avoidance.
		 * this function keeps at least one buffer (the buffer at
		 * 'index') un-requeued -> this buffer is the first buffer that
		 * will be requeued the next time
		 */
3215 3216
		rc = do_QDIO(CARD_DDEV(card), QDIO_FLAG_SYNC_INPUT, 0,
			     queue->next_buf_to_init, count);
3217
		if (rc) {
3218
			QETH_CARD_TEXT(card, 2, "qinberr");
3219 3220 3221 3222 3223
		}
		queue->next_buf_to_init = (queue->next_buf_to_init + count) %
					  QDIO_MAX_BUFFERS_PER_Q;
	}
}
3224 3225 3226 3227 3228 3229 3230 3231 3232

static void qeth_buffer_reclaim_work(struct work_struct *work)
{
	struct qeth_card *card = container_of(work, struct qeth_card,
		buffer_reclaim_work.work);

	QETH_CARD_TEXT_(card, 2, "brw:%x", card->reclaim_index);
	qeth_queue_input_buffer(card, card->reclaim_index);
}
3233

3234
static void qeth_handle_send_error(struct qeth_card *card,
3235
		struct qeth_qdio_out_buffer *buffer, unsigned int qdio_err)
3236
{
3237
	int sbalf15 = buffer->buffer->element[15].sflags;
3238

3239
	QETH_CARD_TEXT(card, 6, "hdsnderr");
3240
	qeth_check_qdio_errors(card, buffer->buffer, qdio_err, "qouterr");
3241 3242

	if (!qdio_err)
3243
		return;
3244 3245

	if ((sbalf15 >= 15) && (sbalf15 <= 31))
3246
		return;
3247

3248 3249
	QETH_CARD_TEXT(card, 1, "lnkfail");
	QETH_CARD_TEXT_(card, 1, "%04x %02x",
3250
		       (u16)qdio_err, (u8)sbalf15);
3251 3252
}

3253 3254 3255 3256 3257 3258 3259 3260 3261 3262 3263 3264 3265 3266 3267 3268 3269 3270 3271 3272 3273 3274
/**
 * qeth_prep_flush_pack_buffer - Prepares flushing of a packing buffer.
 * @queue: queue to check for packing buffer
 *
 * Returns number of buffers that were prepared for flush.
 */
static int qeth_prep_flush_pack_buffer(struct qeth_qdio_out_q *queue)
{
	struct qeth_qdio_out_buffer *buffer;

	buffer = queue->bufs[queue->next_buf_to_fill];
	if ((atomic_read(&buffer->state) == QETH_QDIO_BUF_EMPTY) &&
	    (buffer->next_element_to_fill > 0)) {
		/* it's a packing buffer */
		atomic_set(&buffer->state, QETH_QDIO_BUF_PRIMED);
		queue->next_buf_to_fill =
			(queue->next_buf_to_fill + 1) % QDIO_MAX_BUFFERS_PER_Q;
		return 1;
	}
	return 0;
}

3275 3276 3277 3278 3279 3280 3281 3282 3283 3284
/*
 * Switched to packing state if the number of used buffers on a queue
 * reaches a certain limit.
 */
static void qeth_switch_to_packing_if_needed(struct qeth_qdio_out_q *queue)
{
	if (!queue->do_pack) {
		if (atomic_read(&queue->used_buffers)
		    >= QETH_HIGH_WATERMARK_PACK){
			/* switch non-PACKING -> PACKING */
3285
			QETH_CARD_TEXT(queue->card, 6, "np->pack");
3286
			QETH_TXQ_STAT_INC(queue, packing_mode_switch);
3287 3288 3289 3290 3291 3292 3293 3294 3295 3296 3297 3298 3299 3300 3301 3302 3303
			queue->do_pack = 1;
		}
	}
}

/*
 * Switches from packing to non-packing mode. If there is a packing
 * buffer on the queue this buffer will be prepared to be flushed.
 * In that case 1 is returned to inform the caller. If no buffer
 * has to be flushed, zero is returned.
 */
static int qeth_switch_to_nonpacking_if_needed(struct qeth_qdio_out_q *queue)
{
	if (queue->do_pack) {
		if (atomic_read(&queue->used_buffers)
		    <= QETH_LOW_WATERMARK_PACK) {
			/* switch PACKING -> non-PACKING */
3304
			QETH_CARD_TEXT(queue->card, 6, "pack->np");
3305
			QETH_TXQ_STAT_INC(queue, packing_mode_switch);
3306
			queue->do_pack = 0;
3307
			return qeth_prep_flush_pack_buffer(queue);
3308 3309 3310 3311 3312
		}
	}
	return 0;
}

3313 3314
static void qeth_flush_buffers(struct qeth_qdio_out_q *queue, int index,
			       int count)
3315 3316 3317 3318 3319 3320 3321
{
	struct qeth_qdio_out_buffer *buf;
	int rc;
	int i;
	unsigned int qdio_flags;

	for (i = index; i < index + count; ++i) {
3322 3323
		int bidx = i % QDIO_MAX_BUFFERS_PER_Q;
		buf = queue->bufs[bidx];
3324 3325
		buf->buffer->element[buf->next_element_to_fill - 1].eflags |=
				SBAL_EFLAGS_LAST_ENTRY;
3326

3327 3328 3329
		if (queue->bufstates)
			queue->bufstates[bidx].user = buf;

3330
		if (IS_IQD(queue->card))
3331 3332 3333 3334 3335 3336 3337 3338 3339 3340
			continue;

		if (!queue->do_pack) {
			if ((atomic_read(&queue->used_buffers) >=
				(QETH_HIGH_WATERMARK_PACK -
				 QETH_WATERMARK_PACK_FUZZ)) &&
			    !atomic_read(&queue->set_pci_flags_count)) {
				/* it's likely that we'll go to packing
				 * mode soon */
				atomic_inc(&queue->set_pci_flags_count);
3341
				buf->buffer->element[0].sflags |= SBAL_SFLAGS0_PCI_REQ;
3342 3343 3344 3345 3346 3347 3348 3349 3350 3351 3352 3353
			}
		} else {
			if (!atomic_read(&queue->set_pci_flags_count)) {
				/*
				 * there's no outstanding PCI any more, so we
				 * have to request a PCI to be sure the the PCI
				 * will wake at some time in the future then we
				 * can flush packed buffers that might still be
				 * hanging around, which can happen if no
				 * further send was requested by the stack
				 */
				atomic_inc(&queue->set_pci_flags_count);
3354
				buf->buffer->element[0].sflags |= SBAL_SFLAGS0_PCI_REQ;
3355 3356 3357 3358
			}
		}
	}

3359
	QETH_TXQ_STAT_ADD(queue, bufs, count);
3360 3361 3362 3363
	qdio_flags = QDIO_FLAG_SYNC_OUTPUT;
	if (atomic_read(&queue->set_pci_flags_count))
		qdio_flags |= QDIO_FLAG_PCI_OUT;
	rc = do_QDIO(CARD_DDEV(queue->card), qdio_flags,
3364
		     queue->queue_no, index, count);
3365
	if (rc) {
3366
		QETH_TXQ_STAT_ADD(queue, tx_errors, count);
3367
		/* ignore temporary SIGA errors without busy condition */
3368
		if (rc == -ENOBUFS)
3369
			return;
3370
		QETH_CARD_TEXT(queue->card, 2, "flushbuf");
3371 3372 3373
		QETH_CARD_TEXT_(queue->card, 2, " q%d", queue->queue_no);
		QETH_CARD_TEXT_(queue->card, 2, " idx%d", index);
		QETH_CARD_TEXT_(queue->card, 2, " c%d", count);
3374
		QETH_CARD_TEXT_(queue->card, 2, " err%d", rc);
3375

3376 3377 3378 3379 3380 3381 3382 3383 3384 3385 3386 3387 3388 3389 3390 3391 3392 3393 3394 3395 3396 3397 3398 3399 3400 3401 3402 3403 3404 3405 3406 3407 3408
		/* this must not happen under normal circumstances. if it
		 * happens something is really wrong -> recover */
		qeth_schedule_recovery(queue->card);
		return;
	}
}

static void qeth_check_outbound_queue(struct qeth_qdio_out_q *queue)
{
	int index;
	int flush_cnt = 0;
	int q_was_packing = 0;

	/*
	 * check if weed have to switch to non-packing mode or if
	 * we have to get a pci flag out on the queue
	 */
	if ((atomic_read(&queue->used_buffers) <= QETH_LOW_WATERMARK_PACK) ||
	    !atomic_read(&queue->set_pci_flags_count)) {
		if (atomic_xchg(&queue->state, QETH_OUT_Q_LOCKED_FLUSH) ==
				QETH_OUT_Q_UNLOCKED) {
			/*
			 * If we get in here, there was no action in
			 * do_send_packet. So, we check if there is a
			 * packing buffer to be flushed here.
			 */
			index = queue->next_buf_to_fill;
			q_was_packing = queue->do_pack;
			/* queue->do_pack may change */
			barrier();
			flush_cnt += qeth_switch_to_nonpacking_if_needed(queue);
			if (!flush_cnt &&
			    !atomic_read(&queue->set_pci_flags_count))
3409
				flush_cnt += qeth_prep_flush_pack_buffer(queue);
3410 3411
			if (q_was_packing)
				QETH_TXQ_STAT_ADD(queue, bufs_pack, flush_cnt);
3412
			if (flush_cnt)
3413
				qeth_flush_buffers(queue, index, flush_cnt);
3414 3415 3416 3417 3418
			atomic_set(&queue->state, QETH_OUT_Q_UNLOCKED);
		}
	}
}

3419 3420
static void qeth_qdio_start_poll(struct ccw_device *ccwdev, int queue,
				 unsigned long card_ptr)
3421 3422 3423
{
	struct qeth_card *card = (struct qeth_card *)card_ptr;

3424
	if (card->dev->flags & IFF_UP)
3425 3426 3427
		napi_schedule(&card->napi);
}

3428 3429 3430 3431 3432 3433 3434 3435 3436 3437 3438 3439 3440
int qeth_configure_cq(struct qeth_card *card, enum qeth_cq cq)
{
	int rc;

	if (card->options.cq ==  QETH_CQ_NOTAVAILABLE) {
		rc = -1;
		goto out;
	} else {
		if (card->options.cq == cq) {
			rc = 0;
			goto out;
		}

3441
		if (card->state != CARD_STATE_DOWN) {
3442 3443 3444 3445
			rc = -1;
			goto out;
		}

3446
		qeth_free_qdio_queues(card);
3447 3448 3449 3450 3451 3452 3453 3454 3455
		card->options.cq = cq;
		rc = 0;
	}
out:
	return rc;

}
EXPORT_SYMBOL_GPL(qeth_configure_cq);

3456 3457 3458 3459
static void qeth_qdio_cq_handler(struct qeth_card *card, unsigned int qdio_err,
				 unsigned int queue, int first_element,
				 int count)
{
3460 3461 3462 3463 3464
	struct qeth_qdio_q *cq = card->qdio.c_q;
	int i;
	int rc;

	if (!qeth_is_cq(card, queue))
3465
		return;
3466 3467 3468 3469 3470 3471

	QETH_CARD_TEXT_(card, 5, "qcqhe%d", first_element);
	QETH_CARD_TEXT_(card, 5, "qcqhc%d", count);
	QETH_CARD_TEXT_(card, 5, "qcqherr%d", qdio_err);

	if (qdio_err) {
3472
		netif_tx_stop_all_queues(card->dev);
3473
		qeth_schedule_recovery(card);
3474
		return;
3475 3476 3477 3478
	}

	for (i = first_element; i < first_element + count; ++i) {
		int bidx = i % QDIO_MAX_BUFFERS_PER_Q;
3479
		struct qdio_buffer *buffer = cq->qdio_bufs[bidx];
3480
		int e = 0;
3481

3482 3483
		while ((e < QDIO_MAX_ELEMENTS_PER_BUFFER) &&
		       buffer->element[e].addr) {
3484 3485 3486 3487 3488 3489
			unsigned long phys_aob_addr;

			phys_aob_addr = (unsigned long) buffer->element[e].addr;
			qeth_qdio_handle_aob(card, phys_aob_addr);
			++e;
		}
3490
		qeth_scrub_qdio_buffer(buffer, QDIO_MAX_ELEMENTS_PER_BUFFER);
3491 3492 3493 3494 3495 3496 3497 3498 3499 3500 3501 3502 3503
	}
	rc = do_QDIO(CARD_DDEV(card), QDIO_FLAG_SYNC_INPUT, queue,
		    card->qdio.c_q->next_buf_to_init,
		    count);
	if (rc) {
		dev_warn(&card->gdev->dev,
			"QDIO reported an error, rc=%i\n", rc);
		QETH_CARD_TEXT(card, 2, "qcqherr");
	}
	card->qdio.c_q->next_buf_to_init = (card->qdio.c_q->next_buf_to_init
				   + count) % QDIO_MAX_BUFFERS_PER_Q;
}

3504 3505 3506 3507
static void qeth_qdio_input_handler(struct ccw_device *ccwdev,
				    unsigned int qdio_err, int queue,
				    int first_elem, int count,
				    unsigned long card_ptr)
3508 3509 3510
{
	struct qeth_card *card = (struct qeth_card *)card_ptr;

3511 3512 3513 3514 3515 3516
	QETH_CARD_TEXT_(card, 2, "qihq%d", queue);
	QETH_CARD_TEXT_(card, 2, "qiec%d", qdio_err);

	if (qeth_is_cq(card, queue))
		qeth_qdio_cq_handler(card, qdio_err, queue, first_elem, count);
	else if (qdio_err)
3517 3518 3519
		qeth_schedule_recovery(card);
}

3520 3521 3522 3523
static void qeth_qdio_output_handler(struct ccw_device *ccwdev,
				     unsigned int qdio_error, int __queue,
				     int first_element, int count,
				     unsigned long card_ptr)
3524 3525 3526 3527
{
	struct qeth_card *card        = (struct qeth_card *) card_ptr;
	struct qeth_qdio_out_q *queue = card->qdio.out_qs[__queue];
	struct qeth_qdio_out_buffer *buffer;
3528
	struct net_device *dev = card->dev;
3529
	struct netdev_queue *txq;
3530 3531
	int i;

3532
	QETH_CARD_TEXT(card, 6, "qdouhdl");
3533
	if (qdio_error & QDIO_ERROR_FATAL) {
3534
		QETH_CARD_TEXT(card, 2, "achkcond");
3535
		netif_tx_stop_all_queues(dev);
3536 3537
		qeth_schedule_recovery(card);
		return;
3538
	}
3539

3540
	for (i = first_element; i < (first_element + count); ++i) {
3541 3542
		int bidx = i % QDIO_MAX_BUFFERS_PER_Q;
		buffer = queue->bufs[bidx];
3543
		qeth_handle_send_error(card, buffer, qdio_error);
3544 3545 3546 3547

		if (queue->bufstates &&
		    (queue->bufstates[bidx].flags &
		     QDIO_OUTBUF_STATE_FLAG_PENDING) != 0) {
S
Stefan Raspl 已提交
3548
			WARN_ON_ONCE(card->options.cq != QETH_CQ_ENABLED);
3549 3550 3551 3552 3553 3554 3555 3556

			if (atomic_cmpxchg(&buffer->state,
					   QETH_QDIO_BUF_PRIMED,
					   QETH_QDIO_BUF_PENDING) ==
				QETH_QDIO_BUF_PRIMED) {
				qeth_notify_skbs(queue, buffer,
						 TX_NOTIFY_PENDING);
			}
3557
			QETH_CARD_TEXT_(queue->card, 5, "pel%d", bidx);
3558 3559 3560

			/* prepare the queue slot for re-use: */
			qeth_scrub_qdio_buffer(buffer->buffer,
3561
					       queue->max_elements);
3562 3563
			if (qeth_init_qdio_out_buf(queue, bidx)) {
				QETH_CARD_TEXT(card, 2, "outofbuf");
3564
				qeth_schedule_recovery(card);
3565
			}
3566
		} else {
3567 3568 3569 3570 3571 3572 3573 3574
			if (card->options.cq == QETH_CQ_ENABLED) {
				enum iucv_tx_notify n;

				n = qeth_compute_cq_notification(
					buffer->buffer->element[15].sflags, 0);
				qeth_notify_skbs(queue, buffer, n);
			}

3575
			qeth_clear_output_buffer(queue, buffer);
3576 3577
		}
		qeth_cleanup_handled_pending(queue, bidx, 0);
3578 3579 3580
	}
	atomic_sub(count, &queue->used_buffers);
	/* check if we need to do something on this outbound queue */
3581
	if (!IS_IQD(card))
3582 3583
		qeth_check_outbound_queue(queue);

3584 3585 3586 3587 3588 3589 3590 3591 3592
	if (IS_IQD(card))
		__queue = qeth_iqd_translate_txq(dev, __queue);
	txq = netdev_get_tx_queue(dev, __queue);
	/* xmit may have observed the full-condition, but not yet stopped the
	 * txq. In which case the code below won't trigger. So before returning,
	 * xmit will re-check the txq's fill level and wake it up if needed.
	 */
	if (netif_tx_queue_stopped(txq) && !qeth_out_queue_is_full(queue))
		netif_tx_wake_queue(txq);
3593 3594
}

3595 3596 3597
/**
 * Note: Function assumes that we have 4 outbound queues.
 */
3598
int qeth_get_priority_queue(struct qeth_card *card, struct sk_buff *skb)
3599
{
3600
	struct vlan_ethhdr *veth = vlan_eth_hdr(skb);
3601 3602 3603 3604 3605
	u8 tos;

	switch (card->qdio.do_prio_queueing) {
	case QETH_PRIO_Q_ING_TOS:
	case QETH_PRIO_Q_ING_PREC:
3606
		switch (qeth_get_ip_version(skb)) {
3607 3608 3609 3610 3611 3612 3613 3614
		case 4:
			tos = ipv4_get_dsfield(ip_hdr(skb));
			break;
		case 6:
			tos = ipv6_get_dsfield(ipv6_hdr(skb));
			break;
		default:
			return card->qdio.default_out_queue;
3615
		}
3616
		if (card->qdio.do_prio_queueing == QETH_PRIO_Q_ING_PREC)
3617
			return ~tos >> 6 & 3;
3618
		if (tos & IPTOS_MINCOST)
3619
			return 3;
3620 3621 3622 3623 3624 3625
		if (tos & IPTOS_RELIABILITY)
			return 2;
		if (tos & IPTOS_THROUGHPUT)
			return 1;
		if (tos & IPTOS_LOWDELAY)
			return 0;
3626 3627 3628 3629
		break;
	case QETH_PRIO_Q_ING_SKB:
		if (skb->priority > 5)
			return 0;
3630
		return ~skb->priority >> 1 & 3;
3631
	case QETH_PRIO_Q_ING_VLAN:
3632 3633 3634
		if (veth->h_vlan_proto == htons(ETH_P_8021Q))
			return ~ntohs(veth->h_vlan_TCI) >>
			       (VLAN_PRIO_SHIFT + 1) & 3;
3635
		break;
3636
	default:
3637
		break;
3638
	}
3639
	return card->qdio.default_out_queue;
3640 3641 3642
}
EXPORT_SYMBOL_GPL(qeth_get_priority_queue);

3643 3644 3645 3646 3647 3648 3649
/**
 * qeth_get_elements_for_frags() -	find number of SBALEs for skb frags.
 * @skb:				SKB address
 *
 * Returns the number of pages, and thus QDIO buffer elements, needed to cover
 * fragmented part of the SKB. Returns zero for linear SKB.
 */
3650
static int qeth_get_elements_for_frags(struct sk_buff *skb)
3651
{
3652
	int cnt, elements = 0;
3653 3654

	for (cnt = 0; cnt < skb_shinfo(skb)->nr_frags; cnt++) {
3655 3656 3657 3658 3659
		struct skb_frag_struct *frag = &skb_shinfo(skb)->frags[cnt];

		elements += qeth_get_elements_for_range(
			(addr_t)skb_frag_address(frag),
			(addr_t)skb_frag_address(frag) + skb_frag_size(frag));
3660 3661 3662 3663
	}
	return elements;
}

3664 3665 3666 3667 3668 3669 3670 3671 3672 3673
/**
 * qeth_count_elements() -	Counts the number of QDIO buffer elements needed
 *				to transmit an skb.
 * @skb:			the skb to operate on.
 * @data_offset:		skip this part of the skb's linear data
 *
 * Returns the number of pages, and thus QDIO buffer elements, needed to map the
 * skb's data (both its linear part and paged fragments).
 */
unsigned int qeth_count_elements(struct sk_buff *skb, unsigned int data_offset)
3674 3675 3676 3677 3678 3679 3680 3681 3682
{
	unsigned int elements = qeth_get_elements_for_frags(skb);
	addr_t end = (addr_t)skb->data + skb_headlen(skb);
	addr_t start = (addr_t)skb->data + data_offset;

	if (start != end)
		elements += qeth_get_elements_for_range(start, end);
	return elements;
}
3683
EXPORT_SYMBOL_GPL(qeth_count_elements);
3684

3685 3686
#define QETH_HDR_CACHE_OBJ_SIZE		(sizeof(struct qeth_hdr_tso) + \
					 MAX_TCP_HEADER)
3687

3688
/**
3689 3690
 * qeth_add_hw_header() - add a HW header to an skb.
 * @skb: skb that the HW header should be added to.
3691 3692
 * @hdr: double pointer to a qeth_hdr. When returning with >= 0,
 *	 it contains a valid pointer to a qeth_hdr.
3693 3694 3695
 * @hdr_len: length of the HW header.
 * @proto_len: length of protocol headers that need to be in same page as the
 *	       HW header.
3696 3697 3698 3699
 *
 * Returns the pushed length. If the header can't be pushed on
 * (eg. because it would cross a page boundary), it is allocated from
 * the cache instead and 0 is returned.
3700
 * The number of needed buffer elements is returned in @elements.
3701 3702
 * Error to create the hdr is indicated by returning with < 0.
 */
3703 3704 3705 3706
static int qeth_add_hw_header(struct qeth_qdio_out_q *queue,
			      struct sk_buff *skb, struct qeth_hdr **hdr,
			      unsigned int hdr_len, unsigned int proto_len,
			      unsigned int *elements)
3707
{
3708
	const unsigned int contiguous = proto_len ? proto_len : 1;
3709
	const unsigned int max_elements = queue->max_elements;
3710 3711 3712 3713 3714 3715
	unsigned int __elements;
	addr_t start, end;
	bool push_ok;
	int rc;

check_layout:
3716
	start = (addr_t)skb->data - hdr_len;
3717 3718
	end = (addr_t)skb->data;

3719
	if (qeth_get_elements_for_range(start, end + contiguous) == 1) {
3720 3721
		/* Push HW header into same page as first protocol header. */
		push_ok = true;
3722 3723 3724 3725 3726
		/* ... but TSO always needs a separate element for headers: */
		if (skb_is_gso(skb))
			__elements = 1 + qeth_count_elements(skb, proto_len);
		else
			__elements = qeth_count_elements(skb, 0);
3727 3728
	} else if (!proto_len && PAGE_ALIGNED(skb->data)) {
		/* Push HW header into preceding page, flush with skb->data. */
3729
		push_ok = true;
3730
		__elements = 1 + qeth_count_elements(skb, 0);
3731 3732 3733 3734
	} else {
		/* Use header cache, copy protocol headers up. */
		push_ok = false;
		__elements = 1 + qeth_count_elements(skb, proto_len);
3735 3736 3737 3738 3739 3740 3741 3742 3743 3744 3745 3746
	}

	/* Compress skb to fit into one IO buffer: */
	if (__elements > max_elements) {
		if (!skb_is_nonlinear(skb)) {
			/* Drop it, no easy way of shrinking it further. */
			QETH_DBF_MESSAGE(2, "Dropped an oversized skb (Max Elements=%u / Actual=%u / Length=%u).\n",
					 max_elements, __elements, skb->len);
			return -E2BIG;
		}

		rc = skb_linearize(skb);
3747 3748
		if (rc) {
			QETH_TXQ_STAT_INC(queue, skbs_linearized_fail);
3749
			return rc;
3750
		}
3751

3752
		QETH_TXQ_STAT_INC(queue, skbs_linearized);
3753 3754 3755 3756 3757 3758 3759
		/* Linearization changed the layout, re-evaluate: */
		goto check_layout;
	}

	*elements = __elements;
	/* Add the header: */
	if (push_ok) {
3760 3761
		*hdr = skb_push(skb, hdr_len);
		return hdr_len;
3762 3763
	}
	/* fall back */
3764 3765
	if (hdr_len + proto_len > QETH_HDR_CACHE_OBJ_SIZE)
		return -E2BIG;
3766 3767 3768
	*hdr = kmem_cache_alloc(qeth_core_header_cache, GFP_ATOMIC);
	if (!*hdr)
		return -ENOMEM;
3769 3770
	/* Copy protocol headers behind HW header: */
	skb_copy_from_linear_data(skb, ((char *)*hdr) + hdr_len, proto_len);
3771 3772 3773
	return 0;
}

3774 3775 3776
static void __qeth_fill_buffer(struct sk_buff *skb,
			       struct qeth_qdio_out_buffer *buf,
			       bool is_first_elem, unsigned int offset)
3777
{
3778 3779
	struct qdio_buffer *buffer = buf->buffer;
	int element = buf->next_element_to_fill;
3780 3781
	int length = skb_headlen(skb) - offset;
	char *data = skb->data + offset;
3782
	unsigned int elem_length, cnt;
3783

3784
	/* map linear part into buffer element(s) */
3785
	while (length > 0) {
3786 3787
		elem_length = min_t(unsigned int, length,
				    PAGE_SIZE - offset_in_page(data));
3788 3789

		buffer->element[element].addr = data;
3790 3791
		buffer->element[element].length = elem_length;
		length -= elem_length;
3792 3793
		if (is_first_elem) {
			is_first_elem = false;
3794 3795
			if (length || skb_is_nonlinear(skb))
				/* skb needs additional elements */
3796
				buffer->element[element].eflags =
3797
					SBAL_EFLAGS_FIRST_FRAG;
3798
			else
3799 3800 3801 3802
				buffer->element[element].eflags = 0;
		} else {
			buffer->element[element].eflags =
				SBAL_EFLAGS_MIDDLE_FRAG;
3803
		}
3804 3805

		data += elem_length;
3806 3807
		element++;
	}
3808

3809
	/* map page frags into buffer element(s) */
3810
	for (cnt = 0; cnt < skb_shinfo(skb)->nr_frags; cnt++) {
3811 3812 3813 3814
		skb_frag_t *frag = &skb_shinfo(skb)->frags[cnt];

		data = skb_frag_address(frag);
		length = skb_frag_size(frag);
3815
		while (length > 0) {
3816 3817
			elem_length = min_t(unsigned int, length,
					    PAGE_SIZE - offset_in_page(data));
3818 3819

			buffer->element[element].addr = data;
3820
			buffer->element[element].length = elem_length;
3821 3822
			buffer->element[element].eflags =
				SBAL_EFLAGS_MIDDLE_FRAG;
3823 3824 3825

			length -= elem_length;
			data += elem_length;
3826 3827
			element++;
		}
3828 3829
	}

3830 3831
	if (buffer->element[element - 1].eflags)
		buffer->element[element - 1].eflags = SBAL_EFLAGS_LAST_FRAG;
3832
	buf->next_element_to_fill = element;
3833 3834
}

3835 3836 3837 3838 3839 3840 3841 3842 3843
/**
 * qeth_fill_buffer() - map skb into an output buffer
 * @queue:	QDIO queue to submit the buffer on
 * @buf:	buffer to transport the skb
 * @skb:	skb to map into the buffer
 * @hdr:	qeth_hdr for this skb. Either at skb->data, or allocated
 *		from qeth_core_header_cache.
 * @offset:	when mapping the skb, start at skb->data + offset
 * @hd_len:	if > 0, build a dedicated header element of this size
3844
 * flush:	Prepare the buffer to be flushed, regardless of its fill level.
3845
 */
3846 3847 3848
static int qeth_fill_buffer(struct qeth_qdio_out_q *queue,
			    struct qeth_qdio_out_buffer *buf,
			    struct sk_buff *skb, struct qeth_hdr *hdr,
3849 3850
			    unsigned int offset, unsigned int hd_len,
			    bool flush)
3851
{
3852
	struct qdio_buffer *buffer = buf->buffer;
3853
	bool is_first_elem = true;
3854

3855
	__skb_queue_tail(&buf->skb_list, skb);
3856

3857 3858
	/* build dedicated header element */
	if (hd_len) {
3859
		int element = buf->next_element_to_fill;
3860 3861
		is_first_elem = false;

3862
		buffer->element[element].addr = hdr;
3863
		buffer->element[element].length = hd_len;
3864
		buffer->element[element].eflags = SBAL_EFLAGS_FIRST_FRAG;
3865 3866
		/* remember to free cache-allocated qeth_hdr: */
		buf->is_header[element] = ((void *)hdr != skb->data);
3867 3868 3869
		buf->next_element_to_fill++;
	}

3870
	__qeth_fill_buffer(skb, buf, is_first_elem, offset);
3871 3872

	if (!queue->do_pack) {
3873
		QETH_CARD_TEXT(queue->card, 6, "fillbfnp");
3874
	} else {
3875
		QETH_CARD_TEXT(queue->card, 6, "fillbfpa");
3876

3877
		QETH_TXQ_STAT_INC(queue, skbs_pack);
3878
		/* If the buffer still has free elements, keep using it. */
3879 3880
		if (!flush &&
		    buf->next_element_to_fill < queue->max_elements)
3881
			return 0;
3882
	}
3883 3884 3885 3886 3887 3888

	/* flush out the buffer */
	atomic_set(&buf->state, QETH_QDIO_BUF_PRIMED);
	queue->next_buf_to_fill = (queue->next_buf_to_fill + 1) %
				  QDIO_MAX_BUFFERS_PER_Q;
	return 1;
3889 3890
}

3891 3892 3893
static int qeth_do_send_packet_fast(struct qeth_qdio_out_q *queue,
				    struct sk_buff *skb, struct qeth_hdr *hdr,
				    unsigned int offset, unsigned int hd_len)
3894
{
3895 3896
	int index = queue->next_buf_to_fill;
	struct qeth_qdio_out_buffer *buffer = queue->bufs[index];
3897 3898
	struct netdev_queue *txq;
	bool stopped = false;
3899

3900 3901
	/* Just a sanity check, the wake/stop logic should ensure that we always
	 * get a free buffer.
3902 3903
	 */
	if (atomic_read(&buffer->state) != QETH_QDIO_BUF_EMPTY)
3904
		return -EBUSY;
3905 3906 3907 3908 3909 3910 3911 3912 3913 3914 3915 3916 3917

	txq = netdev_get_tx_queue(queue->card->dev, skb_get_queue_mapping(skb));

	if (atomic_inc_return(&queue->used_buffers) >= QDIO_MAX_BUFFERS_PER_Q) {
		/* If a TX completion happens right _here_ and misses to wake
		 * the txq, then our re-check below will catch the race.
		 */
		QETH_TXQ_STAT_INC(queue, stopped);
		netif_tx_stop_queue(txq);
		stopped = true;
	}

	qeth_fill_buffer(queue, buffer, skb, hdr, offset, hd_len, stopped);
F
Frank Blaschka 已提交
3918
	qeth_flush_buffers(queue, index, 1);
3919 3920 3921

	if (stopped && !qeth_out_queue_is_full(queue))
		netif_tx_start_queue(txq);
3922 3923 3924 3925
	return 0;
}

int qeth_do_send_packet(struct qeth_card *card, struct qeth_qdio_out_q *queue,
3926
			struct sk_buff *skb, struct qeth_hdr *hdr,
3927 3928
			unsigned int offset, unsigned int hd_len,
			int elements_needed)
3929 3930
{
	struct qeth_qdio_out_buffer *buffer;
3931 3932
	struct netdev_queue *txq;
	bool stopped = false;
3933 3934 3935 3936 3937 3938 3939 3940 3941 3942
	int start_index;
	int flush_count = 0;
	int do_pack = 0;
	int tmp;
	int rc = 0;

	/* spin until we get the queue ... */
	while (atomic_cmpxchg(&queue->state, QETH_OUT_Q_UNLOCKED,
			      QETH_OUT_Q_LOCKED) != QETH_OUT_Q_UNLOCKED);
	start_index = queue->next_buf_to_fill;
3943
	buffer = queue->bufs[queue->next_buf_to_fill];
3944 3945 3946

	/* Just a sanity check, the wake/stop logic should ensure that we always
	 * get a free buffer.
3947 3948 3949 3950 3951
	 */
	if (atomic_read(&buffer->state) != QETH_QDIO_BUF_EMPTY) {
		atomic_set(&queue->state, QETH_OUT_Q_UNLOCKED);
		return -EBUSY;
	}
3952 3953 3954

	txq = netdev_get_tx_queue(card->dev, skb_get_queue_mapping(skb));

3955 3956 3957 3958
	/* check if we need to switch packing state of this queue */
	qeth_switch_to_packing_if_needed(queue);
	if (queue->do_pack) {
		do_pack = 1;
F
Frank Blaschka 已提交
3959
		/* does packet fit in current buffer? */
3960 3961
		if (buffer->next_element_to_fill + elements_needed >
		    queue->max_elements) {
F
Frank Blaschka 已提交
3962 3963 3964 3965 3966 3967
			/* ... no -> set state PRIMED */
			atomic_set(&buffer->state, QETH_QDIO_BUF_PRIMED);
			flush_count++;
			queue->next_buf_to_fill =
				(queue->next_buf_to_fill + 1) %
				QDIO_MAX_BUFFERS_PER_Q;
3968
			buffer = queue->bufs[queue->next_buf_to_fill];
3969 3970

			/* We stepped forward, so sanity-check again: */
F
Frank Blaschka 已提交
3971 3972 3973
			if (atomic_read(&buffer->state) !=
			    QETH_QDIO_BUF_EMPTY) {
				qeth_flush_buffers(queue, start_index,
3974
							   flush_count);
F
Frank Blaschka 已提交
3975
				atomic_set(&queue->state,
3976
						QETH_OUT_Q_UNLOCKED);
3977 3978
				rc = -EBUSY;
				goto out;
3979 3980 3981
			}
		}
	}
3982

3983 3984 3985 3986 3987 3988 3989 3990 3991 3992 3993 3994
	if (buffer->next_element_to_fill == 0 &&
	    atomic_inc_return(&queue->used_buffers) >= QDIO_MAX_BUFFERS_PER_Q) {
		/* If a TX completion happens right _here_ and misses to wake
		 * the txq, then our re-check below will catch the race.
		 */
		QETH_TXQ_STAT_INC(queue, stopped);
		netif_tx_stop_queue(txq);
		stopped = true;
	}

	flush_count += qeth_fill_buffer(queue, buffer, skb, hdr, offset, hd_len,
					stopped);
3995
	if (flush_count)
3996
		qeth_flush_buffers(queue, start_index, flush_count);
3997 3998 3999 4000 4001 4002 4003 4004 4005 4006 4007
	else if (!atomic_read(&queue->set_pci_flags_count))
		atomic_xchg(&queue->state, QETH_OUT_Q_LOCKED_FLUSH);
	/*
	 * queue->state will go from LOCKED -> UNLOCKED or from
	 * LOCKED_FLUSH -> LOCKED if output_handler wanted to 'notify' us
	 * (switch packing state or flush buffer to get another pci flag out).
	 * In that case we will enter this loop
	 */
	while (atomic_dec_return(&queue->state)) {
		start_index = queue->next_buf_to_fill;
		/* check if we can go back to non-packing state */
4008
		tmp = qeth_switch_to_nonpacking_if_needed(queue);
4009 4010 4011 4012
		/*
		 * check if we need to flush a packing buffer to get a pci
		 * flag out on the queue
		 */
4013 4014 4015 4016 4017 4018
		if (!tmp && !atomic_read(&queue->set_pci_flags_count))
			tmp = qeth_prep_flush_pack_buffer(queue);
		if (tmp) {
			qeth_flush_buffers(queue, start_index, tmp);
			flush_count += tmp;
		}
4019
	}
4020
out:
4021
	/* at this point the queue is UNLOCKED again */
4022 4023
	if (do_pack)
		QETH_TXQ_STAT_ADD(queue, bufs_pack, flush_count);
4024

4025 4026
	if (stopped && !qeth_out_queue_is_full(queue))
		netif_tx_start_queue(txq);
4027 4028 4029 4030
	return rc;
}
EXPORT_SYMBOL_GPL(qeth_do_send_packet);

4031 4032 4033
static void qeth_fill_tso_ext(struct qeth_hdr_tso *hdr,
			      unsigned int payload_len, struct sk_buff *skb,
			      unsigned int proto_len)
4034 4035 4036 4037 4038 4039 4040 4041 4042 4043 4044 4045 4046
{
	struct qeth_hdr_ext_tso *ext = &hdr->ext;

	ext->hdr_tot_len = sizeof(*ext);
	ext->imb_hdr_no = 1;
	ext->hdr_type = 1;
	ext->hdr_version = 1;
	ext->hdr_len = 28;
	ext->payload_len = payload_len;
	ext->mss = skb_shinfo(skb)->gso_size;
	ext->dg_hdr_len = proto_len;
}

4047 4048
int qeth_xmit(struct qeth_card *card, struct sk_buff *skb,
	      struct qeth_qdio_out_q *queue, int ipv, int cast_type,
4049 4050 4051
	      void (*fill_header)(struct qeth_qdio_out_q *queue,
				  struct qeth_hdr *hdr, struct sk_buff *skb,
				  int ipv, int cast_type,
4052 4053
				  unsigned int data_len))
{
4054
	unsigned int proto_len, hw_hdr_len;
4055
	unsigned int frame_len = skb->len;
4056
	bool is_tso = skb_is_gso(skb);
4057 4058 4059 4060 4061 4062 4063
	unsigned int data_offset = 0;
	struct qeth_hdr *hdr = NULL;
	unsigned int hd_len = 0;
	unsigned int elements;
	int push_len, rc;
	bool is_sg;

4064 4065 4066 4067 4068
	if (is_tso) {
		hw_hdr_len = sizeof(struct qeth_hdr_tso);
		proto_len = skb_transport_offset(skb) + tcp_hdrlen(skb);
	} else {
		hw_hdr_len = sizeof(struct qeth_hdr);
4069
		proto_len = (IS_IQD(card) && IS_LAYER2(card)) ? ETH_HLEN : 0;
4070 4071
	}

4072 4073 4074 4075
	rc = skb_cow_head(skb, hw_hdr_len);
	if (rc)
		return rc;

4076
	push_len = qeth_add_hw_header(queue, skb, &hdr, hw_hdr_len, proto_len,
4077 4078 4079
				      &elements);
	if (push_len < 0)
		return push_len;
4080
	if (is_tso || !push_len) {
4081 4082
		/* HW header needs its own buffer element. */
		hd_len = hw_hdr_len + proto_len;
4083
		data_offset = push_len + proto_len;
4084
	}
4085
	memset(hdr, 0, hw_hdr_len);
4086
	fill_header(queue, hdr, skb, ipv, cast_type, frame_len);
4087 4088 4089
	if (is_tso)
		qeth_fill_tso_ext((struct qeth_hdr_tso *) hdr,
				  frame_len - proto_len, skb, proto_len);
4090 4091 4092 4093 4094 4095 4096 4097 4098 4099 4100 4101 4102

	is_sg = skb_is_nonlinear(skb);
	if (IS_IQD(card)) {
		rc = qeth_do_send_packet_fast(queue, skb, hdr, data_offset,
					      hd_len);
	} else {
		/* TODO: drop skb_orphan() once TX completion is fast enough */
		skb_orphan(skb);
		rc = qeth_do_send_packet(card, queue, skb, hdr, data_offset,
					 hd_len, elements);
	}

	if (!rc) {
4103 4104 4105 4106 4107 4108
		QETH_TXQ_STAT_ADD(queue, buf_elements, elements);
		if (is_sg)
			QETH_TXQ_STAT_INC(queue, skbs_sg);
		if (is_tso) {
			QETH_TXQ_STAT_INC(queue, skbs_tso);
			QETH_TXQ_STAT_ADD(queue, tso_bytes, frame_len);
4109 4110 4111 4112 4113 4114 4115 4116 4117
		}
	} else {
		if (!push_len)
			kmem_cache_free(qeth_core_header_cache, hdr);
	}
	return rc;
}
EXPORT_SYMBOL_GPL(qeth_xmit);

4118 4119 4120
static int qeth_setadp_promisc_mode_cb(struct qeth_card *card,
		struct qeth_reply *reply, unsigned long data)
{
4121
	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
4122 4123
	struct qeth_ipacmd_setadpparms *setparms;

4124
	QETH_CARD_TEXT(card, 4, "prmadpcb");
4125 4126

	setparms = &(cmd->data.setadapterparms);
4127
	if (qeth_setadpparms_inspect_rc(cmd)) {
4128
		QETH_CARD_TEXT_(card, 4, "prmrc%x", cmd->hdr.return_code);
4129 4130 4131
		setparms->data.mode = SET_PROMISC_MODE_OFF;
	}
	card->info.promisc_mode = setparms->data.mode;
4132
	return (cmd->hdr.return_code) ? -EIO : 0;
4133 4134 4135 4136 4137 4138 4139 4140 4141
}

void qeth_setadp_promisc_mode(struct qeth_card *card)
{
	enum qeth_ipa_promisc_modes mode;
	struct net_device *dev = card->dev;
	struct qeth_cmd_buffer *iob;
	struct qeth_ipa_cmd *cmd;

4142
	QETH_CARD_TEXT(card, 4, "setprom");
4143 4144 4145 4146 4147 4148 4149 4150 4151

	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;
	mode = SET_PROMISC_MODE_OFF;
	if (dev->flags & IFF_PROMISC)
		mode = SET_PROMISC_MODE_ON;
4152
	QETH_CARD_TEXT_(card, 4, "mode:%x", mode);
4153 4154

	iob = qeth_get_adapter_cmd(card, IPA_SETADP_SET_PROMISC_MODE,
S
Stefan Raspl 已提交
4155
			sizeof(struct qeth_ipacmd_setadpparms_hdr) + 8);
4156 4157
	if (!iob)
		return;
4158
	cmd = __ipa_cmd(iob);
4159 4160 4161 4162 4163 4164 4165 4166
	cmd->data.setadapterparms.data.mode = mode;
	qeth_send_ipa_cmd(card, iob, qeth_setadp_promisc_mode_cb, NULL);
}
EXPORT_SYMBOL_GPL(qeth_setadp_promisc_mode);

static int qeth_setadpparms_change_macaddr_cb(struct qeth_card *card,
		struct qeth_reply *reply, unsigned long data)
{
4167
	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
4168
	struct qeth_ipacmd_setadpparms *adp_cmd;
4169

4170
	QETH_CARD_TEXT(card, 4, "chgmaccb");
4171
	if (qeth_setadpparms_inspect_rc(cmd))
4172
		return -EIO;
4173

4174
	adp_cmd = &cmd->data.setadapterparms;
4175 4176 4177
	if (!is_valid_ether_addr(adp_cmd->data.change_addr.addr))
		return -EADDRNOTAVAIL;

4178 4179
	if (IS_LAYER2(card) && IS_OSD(card) && !IS_VM_NIC(card) &&
	    !(adp_cmd->hdr.flags & QETH_SETADP_FLAGS_VIRTUAL_MAC))
4180
		return -EADDRNOTAVAIL;
4181 4182

	ether_addr_copy(card->dev->dev_addr, adp_cmd->data.change_addr.addr);
4183 4184 4185 4186 4187 4188 4189 4190 4191
	return 0;
}

int qeth_setadpparms_change_macaddr(struct qeth_card *card)
{
	int rc;
	struct qeth_cmd_buffer *iob;
	struct qeth_ipa_cmd *cmd;

4192
	QETH_CARD_TEXT(card, 4, "chgmac");
4193 4194

	iob = qeth_get_adapter_cmd(card, IPA_SETADP_ALTER_MAC_ADDRESS,
S
Stefan Raspl 已提交
4195 4196
				   sizeof(struct qeth_ipacmd_setadpparms_hdr) +
				   sizeof(struct qeth_change_addr));
4197 4198
	if (!iob)
		return -ENOMEM;
4199
	cmd = __ipa_cmd(iob);
4200
	cmd->data.setadapterparms.data.change_addr.cmd = CHANGE_ADDR_READ_MAC;
4201 4202 4203
	cmd->data.setadapterparms.data.change_addr.addr_size = ETH_ALEN;
	ether_addr_copy(cmd->data.setadapterparms.data.change_addr.addr,
			card->dev->dev_addr);
4204 4205 4206 4207 4208 4209
	rc = qeth_send_ipa_cmd(card, iob, qeth_setadpparms_change_macaddr_cb,
			       NULL);
	return rc;
}
EXPORT_SYMBOL_GPL(qeth_setadpparms_change_macaddr);

4210 4211 4212
static int qeth_setadpparms_set_access_ctrl_cb(struct qeth_card *card,
		struct qeth_reply *reply, unsigned long data)
{
4213
	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
4214
	struct qeth_set_access_ctrl *access_ctrl_req;
S
Stefan Raspl 已提交
4215
	int fallback = *(int *)reply->param;
4216

4217
	QETH_CARD_TEXT(card, 4, "setaccb");
4218
	if (cmd->hdr.return_code)
4219
		return -EIO;
4220
	qeth_setadpparms_inspect_rc(cmd);
4221 4222 4223 4224 4225 4226

	access_ctrl_req = &cmd->data.setadapterparms.data.set_access_ctrl;
	QETH_DBF_TEXT_(SETUP, 2, "setaccb");
	QETH_DBF_TEXT_(SETUP, 2, "%s", card->gdev->dev.kobj.name);
	QETH_DBF_TEXT_(SETUP, 2, "rc=%d",
		cmd->data.setadapterparms.hdr.return_code);
S
Stefan Raspl 已提交
4227 4228
	if (cmd->data.setadapterparms.hdr.return_code !=
						SET_ACCESS_CTRL_RC_SUCCESS)
4229 4230 4231
		QETH_DBF_MESSAGE(3, "ERR:SET_ACCESS_CTRL(%#x) on device %x: %#x\n",
				 access_ctrl_req->subcmd_code, CARD_DEVID(card),
				 cmd->data.setadapterparms.hdr.return_code);
4232 4233 4234 4235 4236 4237 4238 4239 4240 4241
	switch (cmd->data.setadapterparms.hdr.return_code) {
	case SET_ACCESS_CTRL_RC_SUCCESS:
		if (card->options.isolation == ISOLATION_MODE_NONE) {
			dev_info(&card->gdev->dev,
			    "QDIO data connection isolation is deactivated\n");
		} else {
			dev_info(&card->gdev->dev,
			    "QDIO data connection isolation is activated\n");
		}
		break;
S
Stefan Raspl 已提交
4242
	case SET_ACCESS_CTRL_RC_ALREADY_NOT_ISOLATED:
4243 4244
		QETH_DBF_MESSAGE(2, "QDIO data connection isolation on device %x already deactivated\n",
				 CARD_DEVID(card));
S
Stefan Raspl 已提交
4245 4246 4247 4248
		if (fallback)
			card->options.isolation = card->options.prev_isolation;
		break;
	case SET_ACCESS_CTRL_RC_ALREADY_ISOLATED:
4249 4250
		QETH_DBF_MESSAGE(2, "QDIO data connection isolation on device %x already activated\n",
				 CARD_DEVID(card));
S
Stefan Raspl 已提交
4251 4252 4253
		if (fallback)
			card->options.isolation = card->options.prev_isolation;
		break;
4254 4255 4256 4257 4258 4259 4260 4261
	case SET_ACCESS_CTRL_RC_NOT_SUPPORTED:
		dev_err(&card->gdev->dev, "Adapter does not "
			"support QDIO data connection isolation\n");
		break;
	case SET_ACCESS_CTRL_RC_NONE_SHARED_ADAPTER:
		dev_err(&card->gdev->dev,
			"Adapter is dedicated. "
			"QDIO data connection isolation not supported\n");
S
Stefan Raspl 已提交
4262 4263
		if (fallback)
			card->options.isolation = card->options.prev_isolation;
4264 4265 4266 4267
		break;
	case SET_ACCESS_CTRL_RC_ACTIVE_CHECKSUM_OFF:
		dev_err(&card->gdev->dev,
			"TSO does not permit QDIO data connection isolation\n");
S
Stefan Raspl 已提交
4268 4269 4270 4271 4272 4273 4274 4275 4276 4277 4278 4279 4280 4281 4282 4283 4284 4285
		if (fallback)
			card->options.isolation = card->options.prev_isolation;
		break;
	case SET_ACCESS_CTRL_RC_REFLREL_UNSUPPORTED:
		dev_err(&card->gdev->dev, "The adjacent switch port does not "
			"support reflective relay mode\n");
		if (fallback)
			card->options.isolation = card->options.prev_isolation;
		break;
	case SET_ACCESS_CTRL_RC_REFLREL_FAILED:
		dev_err(&card->gdev->dev, "The reflective relay mode cannot be "
					"enabled at the adjacent switch port");
		if (fallback)
			card->options.isolation = card->options.prev_isolation;
		break;
	case SET_ACCESS_CTRL_RC_REFLREL_DEACT_FAILED:
		dev_warn(&card->gdev->dev, "Turning off reflective relay mode "
					"at the adjacent switch failed\n");
4286 4287 4288
		break;
	default:
		/* this should never happen */
S
Stefan Raspl 已提交
4289 4290
		if (fallback)
			card->options.isolation = card->options.prev_isolation;
4291 4292
		break;
	}
4293
	return (cmd->hdr.return_code) ? -EIO : 0;
4294 4295 4296
}

static int qeth_setadpparms_set_access_ctrl(struct qeth_card *card,
S
Stefan Raspl 已提交
4297
		enum qeth_ipa_isolation_modes isolation, int fallback)
4298 4299 4300 4301 4302 4303
{
	int rc;
	struct qeth_cmd_buffer *iob;
	struct qeth_ipa_cmd *cmd;
	struct qeth_set_access_ctrl *access_ctrl_req;

4304
	QETH_CARD_TEXT(card, 4, "setacctl");
4305 4306 4307 4308 4309 4310 4311

	QETH_DBF_TEXT_(SETUP, 2, "setacctl");
	QETH_DBF_TEXT_(SETUP, 2, "%s", card->gdev->dev.kobj.name);

	iob = qeth_get_adapter_cmd(card, IPA_SETADP_SET_ACCESS_CONTROL,
				   sizeof(struct qeth_ipacmd_setadpparms_hdr) +
				   sizeof(struct qeth_set_access_ctrl));
4312 4313
	if (!iob)
		return -ENOMEM;
4314
	cmd = __ipa_cmd(iob);
4315 4316 4317 4318
	access_ctrl_req = &cmd->data.setadapterparms.data.set_access_ctrl;
	access_ctrl_req->subcmd_code = isolation;

	rc = qeth_send_ipa_cmd(card, iob, qeth_setadpparms_set_access_ctrl_cb,
S
Stefan Raspl 已提交
4319
			       &fallback);
4320 4321 4322 4323
	QETH_DBF_TEXT_(SETUP, 2, "rc=%d", rc);
	return rc;
}

S
Stefan Raspl 已提交
4324
int qeth_set_access_ctrl_online(struct qeth_card *card, int fallback)
4325 4326 4327
{
	int rc = 0;

4328
	QETH_CARD_TEXT(card, 4, "setactlo");
4329

4330 4331
	if ((IS_OSD(card) || IS_OSX(card)) &&
	    qeth_adp_supported(card, IPA_SETADP_SET_ACCESS_CONTROL)) {
4332
		rc = qeth_setadpparms_set_access_ctrl(card,
S
Stefan Raspl 已提交
4333
			card->options.isolation, fallback);
4334
		if (rc) {
4335 4336
			QETH_DBF_MESSAGE(3, "IPA(SET_ACCESS_CTRL(%d) on device %x: sent failed\n",
					 rc, CARD_DEVID(card));
S
Stefan Raspl 已提交
4337
			rc = -EOPNOTSUPP;
4338 4339 4340 4341 4342 4343 4344 4345 4346 4347 4348 4349
		}
	} else if (card->options.isolation != ISOLATION_MODE_NONE) {
		card->options.isolation = ISOLATION_MODE_NONE;

		dev_err(&card->gdev->dev, "Adapter does not "
			"support QDIO data connection isolation\n");
		rc = -EOPNOTSUPP;
	}
	return rc;
}
EXPORT_SYMBOL_GPL(qeth_set_access_ctrl_online);

4350 4351 4352 4353
void qeth_tx_timeout(struct net_device *dev)
{
	struct qeth_card *card;

4354
	card = dev->ml_priv;
4355
	QETH_CARD_TEXT(card, 4, "txtimeo");
4356 4357 4358 4359
	qeth_schedule_recovery(card);
}
EXPORT_SYMBOL_GPL(qeth_tx_timeout);

4360
static int qeth_mdio_read(struct net_device *dev, int phy_id, int regnum)
4361
{
4362
	struct qeth_card *card = dev->ml_priv;
4363 4364 4365 4366 4367 4368 4369
	int rc = 0;

	switch (regnum) {
	case MII_BMCR: /* Basic mode control register */
		rc = BMCR_FULLDPLX;
		if ((card->info.link_type != QETH_LINK_TYPE_GBIT_ETH) &&
		    (card->info.link_type != QETH_LINK_TYPE_OSN) &&
4370 4371
		    (card->info.link_type != QETH_LINK_TYPE_10GBIT_ETH) &&
		    (card->info.link_type != QETH_LINK_TYPE_25GBIT_ETH))
4372 4373 4374 4375 4376 4377 4378 4379 4380 4381 4382 4383 4384 4385 4386 4387 4388 4389 4390 4391 4392 4393 4394 4395 4396 4397 4398 4399 4400 4401 4402 4403 4404 4405 4406 4407 4408 4409 4410 4411 4412 4413 4414 4415 4416 4417 4418 4419 4420 4421 4422 4423 4424 4425 4426 4427 4428 4429 4430
			rc |= BMCR_SPEED100;
		break;
	case MII_BMSR: /* Basic mode status register */
		rc = BMSR_ERCAP | BMSR_ANEGCOMPLETE | BMSR_LSTATUS |
		     BMSR_10HALF | BMSR_10FULL | BMSR_100HALF | BMSR_100FULL |
		     BMSR_100BASE4;
		break;
	case MII_PHYSID1: /* PHYS ID 1 */
		rc = (dev->dev_addr[0] << 16) | (dev->dev_addr[1] << 8) |
		     dev->dev_addr[2];
		rc = (rc >> 5) & 0xFFFF;
		break;
	case MII_PHYSID2: /* PHYS ID 2 */
		rc = (dev->dev_addr[2] << 10) & 0xFFFF;
		break;
	case MII_ADVERTISE: /* Advertisement control reg */
		rc = ADVERTISE_ALL;
		break;
	case MII_LPA: /* Link partner ability reg */
		rc = LPA_10HALF | LPA_10FULL | LPA_100HALF | LPA_100FULL |
		     LPA_100BASE4 | LPA_LPACK;
		break;
	case MII_EXPANSION: /* Expansion register */
		break;
	case MII_DCOUNTER: /* disconnect counter */
		break;
	case MII_FCSCOUNTER: /* false carrier counter */
		break;
	case MII_NWAYTEST: /* N-way auto-neg test register */
		break;
	case MII_RERRCOUNTER: /* rx error counter */
		rc = card->stats.rx_errors;
		break;
	case MII_SREVISION: /* silicon revision */
		break;
	case MII_RESV1: /* reserved 1 */
		break;
	case MII_LBRERROR: /* loopback, rx, bypass error */
		break;
	case MII_PHYADDR: /* physical address */
		break;
	case MII_RESV2: /* reserved 2 */
		break;
	case MII_TPISTATUS: /* TPI status for 10mbps */
		break;
	case MII_NCONFIG: /* network interface config */
		break;
	default:
		break;
	}
	return rc;
}

static int qeth_snmp_command_cb(struct qeth_card *card,
		struct qeth_reply *reply, unsigned long sdata)
{
	struct qeth_ipa_cmd *cmd;
	struct qeth_arp_query_info *qinfo;
	unsigned char *data;
4431
	void *snmp_data;
4432 4433
	__u16 data_len;

4434
	QETH_CARD_TEXT(card, 3, "snpcmdcb");
4435 4436 4437 4438 4439 4440

	cmd = (struct qeth_ipa_cmd *) sdata;
	data = (unsigned char *)((char *)cmd - reply->offset);
	qinfo = (struct qeth_arp_query_info *) reply->param;

	if (cmd->hdr.return_code) {
4441
		QETH_CARD_TEXT_(card, 4, "scer1%x", cmd->hdr.return_code);
4442
		return -EIO;
4443 4444 4445 4446
	}
	if (cmd->data.setadapterparms.hdr.return_code) {
		cmd->hdr.return_code =
			cmd->data.setadapterparms.hdr.return_code;
4447
		QETH_CARD_TEXT_(card, 4, "scer2%x", cmd->hdr.return_code);
4448
		return -EIO;
4449 4450
	}
	data_len = *((__u16 *)QETH_IPA_PDU_LEN_PDU1(data));
4451 4452 4453 4454 4455 4456 4457 4458 4459
	if (cmd->data.setadapterparms.hdr.seq_no == 1) {
		snmp_data = &cmd->data.setadapterparms.data.snmp;
		data_len -= offsetof(struct qeth_ipa_cmd,
				     data.setadapterparms.data.snmp);
	} else {
		snmp_data = &cmd->data.setadapterparms.data.snmp.request;
		data_len -= offsetof(struct qeth_ipa_cmd,
				     data.setadapterparms.data.snmp.request);
	}
4460 4461 4462

	/* check if there is enough room in userspace */
	if ((qinfo->udata_len - qinfo->udata_offset) < data_len) {
4463 4464
		QETH_CARD_TEXT_(card, 4, "scer3%i", -ENOSPC);
		return -ENOSPC;
4465
	}
4466
	QETH_CARD_TEXT_(card, 4, "snore%i",
4467
		       cmd->data.setadapterparms.hdr.used_total);
4468
	QETH_CARD_TEXT_(card, 4, "sseqn%i",
4469 4470
		cmd->data.setadapterparms.hdr.seq_no);
	/*copy entries to user buffer*/
4471
	memcpy(qinfo->udata + qinfo->udata_offset, snmp_data, data_len);
4472
	qinfo->udata_offset += data_len;
4473

4474
	/* check if all replies received ... */
4475
		QETH_CARD_TEXT_(card, 4, "srtot%i",
4476
			       cmd->data.setadapterparms.hdr.used_total);
4477
		QETH_CARD_TEXT_(card, 4, "srseq%i",
4478 4479 4480 4481 4482 4483 4484
			       cmd->data.setadapterparms.hdr.seq_no);
	if (cmd->data.setadapterparms.hdr.seq_no <
	    cmd->data.setadapterparms.hdr.used_total)
		return 1;
	return 0;
}

4485
static int qeth_snmp_command(struct qeth_card *card, char __user *udata)
4486 4487 4488 4489
{
	struct qeth_cmd_buffer *iob;
	struct qeth_ipa_cmd *cmd;
	struct qeth_snmp_ureq *ureq;
4490
	unsigned int req_len;
4491 4492 4493
	struct qeth_arp_query_info qinfo = {0, };
	int rc = 0;

4494
	QETH_CARD_TEXT(card, 3, "snmpcmd");
4495

4496
	if (IS_VM_NIC(card))
4497 4498 4499
		return -EOPNOTSUPP;

	if ((!qeth_adp_supported(card, IPA_SETADP_SET_SNMP_CONTROL)) &&
4500
	    IS_LAYER3(card))
4501
		return -EOPNOTSUPP;
4502

4503 4504 4505
	/* skip 4 bytes (data_len struct member) to get req_len */
	if (copy_from_user(&req_len, udata + sizeof(int), sizeof(int)))
		return -EFAULT;
4506 4507 4508 4509
	if (req_len > (QETH_BUFSIZE - IPA_PDU_HEADER_SIZE -
		       sizeof(struct qeth_ipacmd_hdr) -
		       sizeof(struct qeth_ipacmd_setadpparms_hdr)))
		return -EINVAL;
4510 4511
	ureq = memdup_user(udata, req_len + sizeof(struct qeth_snmp_ureq_hdr));
	if (IS_ERR(ureq)) {
4512
		QETH_CARD_TEXT(card, 2, "snmpnome");
4513
		return PTR_ERR(ureq);
4514 4515 4516 4517 4518 4519 4520 4521 4522 4523 4524
	}
	qinfo.udata_len = ureq->hdr.data_len;
	qinfo.udata = kzalloc(qinfo.udata_len, GFP_KERNEL);
	if (!qinfo.udata) {
		kfree(ureq);
		return -ENOMEM;
	}
	qinfo.udata_offset = sizeof(struct qeth_snmp_ureq_hdr);

	iob = qeth_get_adapter_cmd(card, IPA_SETADP_SET_SNMP_CONTROL,
				   QETH_SNMP_SETADP_CMDLENGTH + req_len);
4525 4526 4527 4528
	if (!iob) {
		rc = -ENOMEM;
		goto out;
	}
4529 4530 4531 4532

	/* for large requests, fix-up the length fields: */
	qeth_prepare_ipa_cmd(card, iob, QETH_SETADP_BASE_LEN + req_len);

4533
	cmd = __ipa_cmd(iob);
4534
	memcpy(&cmd->data.setadapterparms.data.snmp, &ureq->cmd, req_len);
4535
	rc = qeth_send_ipa_cmd(card, iob, qeth_snmp_command_cb, &qinfo);
4536
	if (rc)
4537 4538
		QETH_DBF_MESSAGE(2, "SNMP command failed on device %x: (%#x)\n",
				 CARD_DEVID(card), rc);
4539 4540 4541 4542
	else {
		if (copy_to_user(udata, qinfo.udata, qinfo.udata_len))
			rc = -EFAULT;
	}
4543
out:
4544 4545 4546 4547 4548
	kfree(ureq);
	kfree(qinfo.udata);
	return rc;
}

4549 4550 4551
static int qeth_setadpparms_query_oat_cb(struct qeth_card *card,
		struct qeth_reply *reply, unsigned long data)
{
4552
	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *)data;
4553 4554 4555 4556 4557
	struct qeth_qoat_priv *priv;
	char *resdata;
	int resdatalen;

	QETH_CARD_TEXT(card, 3, "qoatcb");
4558
	if (qeth_setadpparms_inspect_rc(cmd))
4559
		return -EIO;
4560 4561 4562 4563 4564

	priv = (struct qeth_qoat_priv *)reply->param;
	resdatalen = cmd->data.setadapterparms.hdr.cmdlength;
	resdata = (char *)data + 28;

4565 4566
	if (resdatalen > (priv->buffer_len - priv->response_len))
		return -ENOSPC;
4567 4568 4569 4570 4571 4572 4573 4574 4575 4576 4577

	memcpy((priv->buffer + priv->response_len), resdata,
		resdatalen);
	priv->response_len += resdatalen;

	if (cmd->data.setadapterparms.hdr.seq_no <
	    cmd->data.setadapterparms.hdr.used_total)
		return 1;
	return 0;
}

4578
static int qeth_query_oat_command(struct qeth_card *card, char __user *udata)
4579 4580 4581 4582 4583 4584 4585 4586 4587 4588 4589 4590 4591 4592 4593 4594 4595 4596 4597 4598 4599 4600 4601 4602
{
	int rc = 0;
	struct qeth_cmd_buffer *iob;
	struct qeth_ipa_cmd *cmd;
	struct qeth_query_oat *oat_req;
	struct qeth_query_oat_data oat_data;
	struct qeth_qoat_priv priv;
	void __user *tmp;

	QETH_CARD_TEXT(card, 3, "qoatcmd");

	if (!qeth_adp_supported(card, IPA_SETADP_QUERY_OAT)) {
		rc = -EOPNOTSUPP;
		goto out;
	}

	if (copy_from_user(&oat_data, udata,
	    sizeof(struct qeth_query_oat_data))) {
			rc = -EFAULT;
			goto out;
	}

	priv.buffer_len = oat_data.buffer_len;
	priv.response_len = 0;
4603
	priv.buffer = vzalloc(oat_data.buffer_len);
4604 4605 4606 4607 4608 4609 4610 4611
	if (!priv.buffer) {
		rc = -ENOMEM;
		goto out;
	}

	iob = qeth_get_adapter_cmd(card, IPA_SETADP_QUERY_OAT,
				   sizeof(struct qeth_ipacmd_setadpparms_hdr) +
				   sizeof(struct qeth_query_oat));
4612 4613 4614 4615
	if (!iob) {
		rc = -ENOMEM;
		goto out_free;
	}
4616
	cmd = __ipa_cmd(iob);
4617 4618 4619 4620 4621 4622 4623 4624 4625 4626 4627 4628 4629 4630 4631 4632 4633 4634 4635 4636 4637 4638
	oat_req = &cmd->data.setadapterparms.data.query_oat;
	oat_req->subcmd_code = oat_data.command;

	rc = qeth_send_ipa_cmd(card, iob, qeth_setadpparms_query_oat_cb,
			       &priv);
	if (!rc) {
		if (is_compat_task())
			tmp = compat_ptr(oat_data.ptr);
		else
			tmp = (void __user *)(unsigned long)oat_data.ptr;

		if (copy_to_user(tmp, priv.buffer,
		    priv.response_len)) {
			rc = -EFAULT;
			goto out_free;
		}

		oat_data.response_len = priv.response_len;

		if (copy_to_user(udata, &oat_data,
		    sizeof(struct qeth_query_oat_data)))
			rc = -EFAULT;
4639
	}
4640 4641

out_free:
4642
	vfree(priv.buffer);
4643 4644 4645 4646
out:
	return rc;
}

4647 4648
static int qeth_query_card_info_cb(struct qeth_card *card,
				   struct qeth_reply *reply, unsigned long data)
4649
{
4650 4651
	struct carrier_info *carrier_info = (struct carrier_info *)reply->param;
	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *)data;
4652 4653 4654
	struct qeth_query_card_info *card_info;

	QETH_CARD_TEXT(card, 2, "qcrdincb");
4655
	if (qeth_setadpparms_inspect_rc(cmd))
4656
		return -EIO;
4657

4658 4659 4660 4661
	card_info = &cmd->data.setadapterparms.data.card_info;
	carrier_info->card_type = card_info->card_type;
	carrier_info->port_mode = card_info->port_mode;
	carrier_info->port_speed = card_info->port_speed;
4662 4663 4664
	return 0;
}

4665 4666
int qeth_query_card_info(struct qeth_card *card,
			 struct carrier_info *carrier_info)
4667 4668 4669 4670 4671 4672 4673 4674
{
	struct qeth_cmd_buffer *iob;

	QETH_CARD_TEXT(card, 2, "qcrdinfo");
	if (!qeth_adp_supported(card, IPA_SETADP_QUERY_CARD_INFO))
		return -EOPNOTSUPP;
	iob = qeth_get_adapter_cmd(card, IPA_SETADP_QUERY_CARD_INFO,
		sizeof(struct qeth_ipacmd_setadpparms_hdr));
4675 4676
	if (!iob)
		return -ENOMEM;
4677 4678 4679 4680
	return qeth_send_ipa_cmd(card, iob, qeth_query_card_info_cb,
					(void *)carrier_info);
}

4681 4682 4683 4684 4685 4686 4687 4688 4689 4690 4691 4692 4693 4694 4695 4696 4697 4698 4699 4700 4701 4702 4703 4704
/**
 * qeth_vm_request_mac() - Request a hypervisor-managed MAC address
 * @card: pointer to a qeth_card
 *
 * Returns
 *	0, if a MAC address has been set for the card's netdevice
 *	a return code, for various error conditions
 */
int qeth_vm_request_mac(struct qeth_card *card)
{
	struct diag26c_mac_resp *response;
	struct diag26c_mac_req *request;
	struct ccw_dev_id id;
	int rc;

	QETH_DBF_TEXT(SETUP, 2, "vmreqmac");

	request = kzalloc(sizeof(*request), GFP_KERNEL | GFP_DMA);
	response = kzalloc(sizeof(*response), GFP_KERNEL | GFP_DMA);
	if (!request || !response) {
		rc = -ENOMEM;
		goto out;
	}

4705
	ccw_device_get_id(CARD_DDEV(card), &id);
4706 4707 4708 4709 4710
	request->resp_buf_len = sizeof(*response);
	request->resp_version = DIAG26C_VERSION2;
	request->op_code = DIAG26C_GET_MAC;
	request->devno = id.devno;

4711
	QETH_DBF_HEX(CTRL, 2, request, sizeof(*request));
4712
	rc = diag26c(request, response, DIAG26C_MAC_SERVICES);
4713
	QETH_DBF_HEX(CTRL, 2, request, sizeof(*request));
4714 4715
	if (rc)
		goto out;
4716
	QETH_DBF_HEX(CTRL, 2, response, sizeof(*response));
4717 4718 4719 4720 4721 4722 4723 4724 4725 4726 4727 4728 4729 4730 4731 4732 4733 4734 4735 4736 4737 4738

	if (request->resp_buf_len < sizeof(*response) ||
	    response->version != request->resp_version) {
		rc = -EIO;
		QETH_DBF_TEXT(SETUP, 2, "badresp");
		QETH_DBF_HEX(SETUP, 2, &request->resp_buf_len,
			     sizeof(request->resp_buf_len));
	} else if (!is_valid_ether_addr(response->mac)) {
		rc = -EINVAL;
		QETH_DBF_TEXT(SETUP, 2, "badmac");
		QETH_DBF_HEX(SETUP, 2, response->mac, ETH_ALEN);
	} else {
		ether_addr_copy(card->dev->dev_addr, response->mac);
	}

out:
	kfree(response);
	kfree(request);
	return rc;
}
EXPORT_SYMBOL_GPL(qeth_vm_request_mac);

4739 4740 4741 4742 4743 4744 4745 4746 4747 4748 4749 4750 4751 4752 4753 4754 4755 4756 4757 4758 4759
static void qeth_determine_capabilities(struct qeth_card *card)
{
	int rc;
	int length;
	char *prcd;
	struct ccw_device *ddev;
	int ddev_offline = 0;

	QETH_DBF_TEXT(SETUP, 2, "detcapab");
	ddev = CARD_DDEV(card);
	if (!ddev->online) {
		ddev_offline = 1;
		rc = ccw_device_set_online(ddev);
		if (rc) {
			QETH_DBF_TEXT_(SETUP, 2, "3err%d", rc);
			goto out;
		}
	}

	rc = qeth_read_conf_data(card, (void **) &prcd, &length);
	if (rc) {
4760 4761
		QETH_DBF_MESSAGE(2, "qeth_read_conf_data on device %x returned %i\n",
				 CARD_DEVID(card), rc);
4762 4763 4764 4765
		QETH_DBF_TEXT_(SETUP, 2, "5err%d", rc);
		goto out_offline;
	}
	qeth_configure_unitaddr(card, prcd);
4766 4767
	if (ddev_offline)
		qeth_configure_blkt_default(card, prcd);
4768 4769 4770 4771 4772 4773
	kfree(prcd);

	rc = qdio_get_ssqd_desc(ddev, &card->ssqd);
	if (rc)
		QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc);

4774
	QETH_DBF_TEXT_(SETUP, 2, "qfmt%d", card->ssqd.qfmt);
4775 4776 4777
	QETH_DBF_TEXT_(SETUP, 2, "ac1:%02x", card->ssqd.qdioac1);
	QETH_DBF_TEXT_(SETUP, 2, "ac2:%04x", card->ssqd.qdioac2);
	QETH_DBF_TEXT_(SETUP, 2, "ac3:%04x", card->ssqd.qdioac3);
4778 4779 4780 4781 4782 4783 4784 4785 4786 4787 4788
	QETH_DBF_TEXT_(SETUP, 2, "icnt%d", card->ssqd.icnt);
	if (!((card->ssqd.qfmt != QDIO_IQDIO_QFMT) ||
	    ((card->ssqd.qdioac1 & CHSC_AC1_INITIATE_INPUTQ) == 0) ||
	    ((card->ssqd.qdioac3 & CHSC_AC3_FORMAT2_CQ_AVAILABLE) == 0))) {
		dev_info(&card->gdev->dev,
			"Completion Queueing supported\n");
	} else {
		card->options.cq = QETH_CQ_NOTAVAILABLE;
	}


4789 4790 4791 4792 4793 4794 4795
out_offline:
	if (ddev_offline == 1)
		ccw_device_set_offline(ddev);
out:
	return;
}

4796 4797 4798 4799 4800 4801
static void qeth_qdio_establish_cq(struct qeth_card *card,
				   struct qdio_buffer **in_sbal_ptrs,
				   void (**queue_start_poll)
					(struct ccw_device *, int,
					 unsigned long))
{
4802 4803 4804 4805 4806 4807 4808 4809 4810 4811 4812 4813 4814 4815
	int i;

	if (card->options.cq == QETH_CQ_ENABLED) {
		int offset = QDIO_MAX_BUFFERS_PER_Q *
			     (card->qdio.no_in_queues - 1);
		for (i = 0; i < QDIO_MAX_BUFFERS_PER_Q; ++i) {
			in_sbal_ptrs[offset + i] = (struct qdio_buffer *)
				virt_to_phys(card->qdio.c_q->bufs[i].buffer);
		}

		queue_start_poll[card->qdio.no_in_queues - 1] = NULL;
	}
}

4816 4817 4818 4819 4820
static int qeth_qdio_establish(struct qeth_card *card)
{
	struct qdio_initialize init_data;
	char *qib_param_field;
	struct qdio_buffer **in_sbal_ptrs;
4821
	void (**queue_start_poll) (struct ccw_device *, int, unsigned long);
4822 4823 4824 4825
	struct qdio_buffer **out_sbal_ptrs;
	int i, j, k;
	int rc = 0;

4826
	QETH_DBF_TEXT(SETUP, 2, "qdioest");
4827

4828 4829
	qib_param_field = kzalloc(QDIO_MAX_BUFFERS_PER_Q,
				  GFP_KERNEL);
4830 4831 4832 4833
	if (!qib_param_field) {
		rc =  -ENOMEM;
		goto out_free_nothing;
	}
4834 4835 4836 4837

	qeth_create_qib_param_field(card, qib_param_field);
	qeth_create_qib_param_field_blkt(card, qib_param_field);

4838 4839
	in_sbal_ptrs = kcalloc(card->qdio.no_in_queues * QDIO_MAX_BUFFERS_PER_Q,
			       sizeof(void *),
4840 4841
			       GFP_KERNEL);
	if (!in_sbal_ptrs) {
4842 4843
		rc = -ENOMEM;
		goto out_free_qib_param;
4844
	}
4845
	for (i = 0; i < QDIO_MAX_BUFFERS_PER_Q; ++i) {
4846 4847
		in_sbal_ptrs[i] = (struct qdio_buffer *)
			virt_to_phys(card->qdio.in_q->bufs[i].buffer);
4848
	}
4849

4850
	queue_start_poll = kcalloc(card->qdio.no_in_queues, sizeof(void *),
4851
				   GFP_KERNEL);
4852 4853 4854 4855
	if (!queue_start_poll) {
		rc = -ENOMEM;
		goto out_free_in_sbals;
	}
4856
	for (i = 0; i < card->qdio.no_in_queues; ++i)
4857
		queue_start_poll[i] = qeth_qdio_start_poll;
4858 4859

	qeth_qdio_establish_cq(card, in_sbal_ptrs, queue_start_poll);
4860

4861
	out_sbal_ptrs =
4862 4863 4864
		kcalloc(card->qdio.no_out_queues * QDIO_MAX_BUFFERS_PER_Q,
			sizeof(void *),
			GFP_KERNEL);
4865
	if (!out_sbal_ptrs) {
4866 4867
		rc = -ENOMEM;
		goto out_free_queue_start_poll;
4868 4869 4870 4871
	}
	for (i = 0, k = 0; i < card->qdio.no_out_queues; ++i)
		for (j = 0; j < QDIO_MAX_BUFFERS_PER_Q; ++j, ++k) {
			out_sbal_ptrs[k] = (struct qdio_buffer *)virt_to_phys(
4872
				card->qdio.out_qs[i]->bufs[j]->buffer);
4873 4874 4875 4876
		}

	memset(&init_data, 0, sizeof(struct qdio_initialize));
	init_data.cdev                   = CARD_DDEV(card);
4877 4878
	init_data.q_format		 = IS_IQD(card) ? QDIO_IQDIO_QFMT :
							  QDIO_QETH_QFMT;
4879 4880
	init_data.qib_param_field_format = 0;
	init_data.qib_param_field        = qib_param_field;
4881
	init_data.no_input_qs            = card->qdio.no_in_queues;
4882
	init_data.no_output_qs           = card->qdio.no_out_queues;
4883 4884
	init_data.input_handler		 = qeth_qdio_input_handler;
	init_data.output_handler	 = qeth_qdio_output_handler;
4885
	init_data.queue_start_poll_array = queue_start_poll;
4886
	init_data.int_parm               = (unsigned long) card;
4887 4888
	init_data.input_sbal_addr_array  = in_sbal_ptrs;
	init_data.output_sbal_addr_array = out_sbal_ptrs;
4889
	init_data.output_sbal_state_array = card->qdio.out_bufstates;
4890
	init_data.scan_threshold	 = IS_IQD(card) ? 1 : 32;
4891 4892 4893

	if (atomic_cmpxchg(&card->qdio.state, QETH_QDIO_ALLOCATED,
		QETH_QDIO_ESTABLISHED) == QETH_QDIO_ALLOCATED) {
4894 4895 4896 4897 4898 4899 4900
		rc = qdio_allocate(&init_data);
		if (rc) {
			atomic_set(&card->qdio.state, QETH_QDIO_ALLOCATED);
			goto out;
		}
		rc = qdio_establish(&init_data);
		if (rc) {
4901
			atomic_set(&card->qdio.state, QETH_QDIO_ALLOCATED);
4902 4903
			qdio_free(CARD_DDEV(card));
		}
4904
	}
4905 4906 4907 4908 4909 4910 4911 4912 4913 4914 4915

	switch (card->options.cq) {
	case QETH_CQ_ENABLED:
		dev_info(&card->gdev->dev, "Completion Queue support enabled");
		break;
	case QETH_CQ_DISABLED:
		dev_info(&card->gdev->dev, "Completion Queue support disabled");
		break;
	default:
		break;
	}
4916
out:
4917
	kfree(out_sbal_ptrs);
4918 4919 4920
out_free_queue_start_poll:
	kfree(queue_start_poll);
out_free_in_sbals:
4921
	kfree(in_sbal_ptrs);
4922
out_free_qib_param:
4923
	kfree(qib_param_field);
4924
out_free_nothing:
4925 4926 4927 4928 4929
	return rc;
}

static void qeth_core_free_card(struct qeth_card *card)
{
4930 4931
	QETH_DBF_TEXT(SETUP, 2, "freecrd");
	QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
4932 4933
	qeth_clean_channel(&card->read);
	qeth_clean_channel(&card->write);
4934
	qeth_clean_channel(&card->data);
4935
	destroy_workqueue(card->event_wq);
4936
	qeth_free_qdio_queues(card);
4937
	unregister_service_level(&card->qeth_service_level);
4938
	dev_set_drvdata(&card->gdev->dev, NULL);
4939 4940 4941
	kfree(card);
}

4942 4943 4944
void qeth_trace_features(struct qeth_card *card)
{
	QETH_CARD_TEXT(card, 2, "features");
4945 4946 4947 4948 4949
	QETH_CARD_HEX(card, 2, &card->options.ipa4, sizeof(card->options.ipa4));
	QETH_CARD_HEX(card, 2, &card->options.ipa6, sizeof(card->options.ipa6));
	QETH_CARD_HEX(card, 2, &card->options.adp, sizeof(card->options.adp));
	QETH_CARD_HEX(card, 2, &card->info.diagass_support,
		      sizeof(card->info.diagass_support));
4950 4951 4952
}
EXPORT_SYMBOL_GPL(qeth_trace_features);

4953
static struct ccw_device_id qeth_ids[] = {
4954 4955 4956 4957 4958 4959 4960 4961 4962 4963
	{CCW_DEVICE_DEVTYPE(0x1731, 0x01, 0x1732, 0x01),
					.driver_info = QETH_CARD_TYPE_OSD},
	{CCW_DEVICE_DEVTYPE(0x1731, 0x05, 0x1732, 0x05),
					.driver_info = QETH_CARD_TYPE_IQD},
	{CCW_DEVICE_DEVTYPE(0x1731, 0x06, 0x1732, 0x06),
					.driver_info = QETH_CARD_TYPE_OSN},
	{CCW_DEVICE_DEVTYPE(0x1731, 0x02, 0x1732, 0x03),
					.driver_info = QETH_CARD_TYPE_OSM},
	{CCW_DEVICE_DEVTYPE(0x1731, 0x02, 0x1732, 0x02),
					.driver_info = QETH_CARD_TYPE_OSX},
4964 4965 4966 4967 4968
	{},
};
MODULE_DEVICE_TABLE(ccw, qeth_ids);

static struct ccw_driver qeth_ccw_driver = {
4969
	.driver = {
4970
		.owner = THIS_MODULE,
4971 4972
		.name = "qeth",
	},
4973 4974 4975 4976 4977
	.ids = qeth_ids,
	.probe = ccwgroup_probe_ccwdev,
	.remove = ccwgroup_remove_ccwdev,
};

4978
int qeth_core_hardsetup_card(struct qeth_card *card, bool *carrier_ok)
4979
{
4980
	int retries = 3;
4981 4982
	int rc;

4983
	QETH_DBF_TEXT(SETUP, 2, "hrdsetup");
4984
	atomic_set(&card->force_alloc_skb, 0);
4985 4986 4987
	rc = qeth_update_from_chp_desc(card);
	if (rc)
		return rc;
4988
retry:
4989
	if (retries < 3)
4990 4991
		QETH_DBF_MESSAGE(2, "Retrying to do IDX activates on device %x.\n",
				 CARD_DEVID(card));
4992
	rc = qeth_qdio_clear_card(card, !IS_IQD(card));
4993 4994 4995
	ccw_device_set_offline(CARD_DDEV(card));
	ccw_device_set_offline(CARD_WDEV(card));
	ccw_device_set_offline(CARD_RDEV(card));
4996
	qdio_free(CARD_DDEV(card));
4997 4998 4999 5000 5001 5002 5003 5004 5005 5006
	rc = ccw_device_set_online(CARD_RDEV(card));
	if (rc)
		goto retriable;
	rc = ccw_device_set_online(CARD_WDEV(card));
	if (rc)
		goto retriable;
	rc = ccw_device_set_online(CARD_DDEV(card));
	if (rc)
		goto retriable;
retriable:
5007
	if (rc == -ERESTARTSYS) {
5008
		QETH_DBF_TEXT(SETUP, 2, "break1");
5009 5010
		return rc;
	} else if (rc) {
5011
		QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
5012
		if (--retries < 0)
5013 5014 5015 5016
			goto out;
		else
			goto retry;
	}
5017
	qeth_determine_capabilities(card);
5018 5019
	qeth_init_tokens(card);
	qeth_init_func_level(card);
5020 5021 5022

	rc = qeth_idx_activate_read_channel(card);
	if (rc == -EINTR) {
5023
		QETH_DBF_TEXT(SETUP, 2, "break2");
5024 5025
		return rc;
	} else if (rc) {
5026
		QETH_DBF_TEXT_(SETUP, 2, "3err%d", rc);
5027 5028 5029 5030 5031
		if (--retries < 0)
			goto out;
		else
			goto retry;
	}
5032 5033 5034

	rc = qeth_idx_activate_write_channel(card);
	if (rc == -EINTR) {
5035
		QETH_DBF_TEXT(SETUP, 2, "break3");
5036 5037
		return rc;
	} else if (rc) {
5038
		QETH_DBF_TEXT_(SETUP, 2, "4err%d", rc);
5039 5040 5041 5042 5043
		if (--retries < 0)
			goto out;
		else
			goto retry;
	}
5044
	card->read_or_write_problem = 0;
5045 5046
	rc = qeth_mpc_initialize(card);
	if (rc) {
5047
		QETH_DBF_TEXT_(SETUP, 2, "5err%d", rc);
5048 5049
		goto out;
	}
5050

5051 5052 5053
	rc = qeth_send_startlan(card);
	if (rc) {
		QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc);
5054 5055
		if (rc == -ENETDOWN) {
			dev_warn(&card->gdev->dev, "The LAN is offline\n");
5056
			*carrier_ok = false;
5057 5058 5059
		} else {
			goto out;
		}
5060
	} else {
5061 5062 5063
		*carrier_ok = true;
	}

5064
	card->options.ipa4.supported_funcs = 0;
5065
	card->options.ipa6.supported_funcs = 0;
5066
	card->options.adp.supported_funcs = 0;
5067
	card->options.sbp.supported_funcs = 0;
5068
	card->info.diagass_support = 0;
5069 5070 5071
	rc = qeth_query_ipassists(card, QETH_PROT_IPV4);
	if (rc == -ENOMEM)
		goto out;
5072 5073 5074 5075 5076
	if (qeth_is_supported(card, IPA_IPV6)) {
		rc = qeth_query_ipassists(card, QETH_PROT_IPV6);
		if (rc == -ENOMEM)
			goto out;
	}
5077 5078 5079
	if (qeth_is_supported(card, IPA_SETADAPTERPARMS)) {
		rc = qeth_query_setadapterparms(card);
		if (rc < 0) {
5080
			QETH_DBF_TEXT_(SETUP, 2, "7err%d", rc);
5081 5082 5083 5084 5085 5086
			goto out;
		}
	}
	if (qeth_adp_supported(card, IPA_SETADP_SET_DIAG_ASSIST)) {
		rc = qeth_query_setdiagass(card);
		if (rc < 0) {
5087
			QETH_DBF_TEXT_(SETUP, 2, "8err%d", rc);
5088 5089 5090
			goto out;
		}
	}
5091 5092
	return 0;
out:
5093 5094
	dev_warn(&card->gdev->dev, "The qeth device driver failed to recover "
		"an error on the device\n");
5095 5096
	QETH_DBF_MESSAGE(2, "Initialization for device %x failed in hardsetup! rc=%d\n",
			 CARD_DEVID(card), rc);
5097 5098 5099 5100
	return rc;
}
EXPORT_SYMBOL_GPL(qeth_core_hardsetup_card);

5101 5102
static void qeth_create_skb_frag(struct qdio_buffer_element *element,
				 struct sk_buff *skb, int offset, int data_len)
5103 5104
{
	struct page *page = virt_to_page(element->addr);
5105
	unsigned int next_frag;
5106

5107 5108 5109
	/* first fill the linear space */
	if (!skb->len) {
		unsigned int linear = min(data_len, skb_tailroom(skb));
5110

5111 5112 5113 5114 5115 5116
		skb_put_data(skb, element->addr + offset, linear);
		data_len -= linear;
		if (!data_len)
			return;
		offset += linear;
		/* fall through to add page frag for remaining data */
5117
	}
5118

5119
	next_frag = skb_shinfo(skb)->nr_frags;
5120
	get_page(page);
5121
	skb_add_rx_frag(skb, next_frag, page, offset, data_len, data_len);
5122 5123
}

5124 5125 5126 5127 5128
static inline int qeth_is_last_sbale(struct qdio_buffer_element *sbale)
{
	return (sbale->eflags & SBAL_EFLAGS_LAST_ENTRY);
}

5129
struct sk_buff *qeth_core_get_next_skb(struct qeth_card *card,
5130
		struct qeth_qdio_buffer *qethbuffer,
5131 5132 5133 5134
		struct qdio_buffer_element **__element, int *__offset,
		struct qeth_hdr **hdr)
{
	struct qdio_buffer_element *element = *__element;
5135
	struct qdio_buffer *buffer = qethbuffer->buffer;
5136
	int offset = *__offset;
5137
	struct sk_buff *skb;
5138
	int skb_len = 0;
5139 5140 5141 5142 5143 5144
	void *data_ptr;
	int data_len;
	int headroom = 0;
	int use_rx_sg = 0;

	/* qeth_hdr must not cross element boundaries */
5145
	while (element->length < offset + sizeof(struct qeth_hdr)) {
5146 5147 5148 5149 5150 5151 5152 5153
		if (qeth_is_last_sbale(element))
			return NULL;
		element++;
		offset = 0;
	}
	*hdr = element->addr + offset;

	offset += sizeof(struct qeth_hdr);
5154 5155 5156 5157 5158
	switch ((*hdr)->hdr.l2.id) {
	case QETH_HEADER_TYPE_LAYER2:
		skb_len = (*hdr)->hdr.l2.pkt_length;
		break;
	case QETH_HEADER_TYPE_LAYER3:
5159
		skb_len = (*hdr)->hdr.l3.length;
5160
		headroom = ETH_HLEN;
5161 5162 5163 5164 5165 5166 5167
		break;
	case QETH_HEADER_TYPE_OSN:
		skb_len = (*hdr)->hdr.osn.pdu_length;
		headroom = sizeof(struct qeth_hdr);
		break;
	default:
		break;
5168 5169 5170 5171 5172
	}

	if (!skb_len)
		return NULL;

5173
	if (((skb_len >= card->options.rx_sg_cb) &&
5174
	     !IS_OSN(card) &&
5175
	     (!atomic_read(&card->force_alloc_skb))) ||
5176
	    (card->options.cq == QETH_CQ_ENABLED))
5177
		use_rx_sg = 1;
5178 5179 5180 5181 5182

	if (use_rx_sg && qethbuffer->rx_skb) {
		/* QETH_CQ_ENABLED only: */
		skb = qethbuffer->rx_skb;
		qethbuffer->rx_skb = NULL;
5183
	} else {
5184 5185
		unsigned int linear = (use_rx_sg) ? QETH_RX_PULL_LEN : skb_len;

5186
		skb = napi_alloc_skb(&card->napi, linear + headroom);
5187
	}
5188 5189 5190 5191
	if (!skb)
		goto no_mem;
	if (headroom)
		skb_reserve(skb, headroom);
5192 5193 5194 5195 5196

	data_ptr = element->addr + offset;
	while (skb_len) {
		data_len = min(skb_len, (int)(element->length - offset));
		if (data_len) {
5197 5198 5199 5200
			if (use_rx_sg)
				qeth_create_skb_frag(element, skb, offset,
						     data_len);
			else
5201
				skb_put_data(skb, data_ptr, data_len);
5202 5203 5204 5205
		}
		skb_len -= data_len;
		if (skb_len) {
			if (qeth_is_last_sbale(element)) {
5206
				QETH_CARD_TEXT(card, 4, "unexeob");
5207
				QETH_CARD_HEX(card, 2, buffer, sizeof(void *));
5208
				dev_kfree_skb_any(skb);
5209
				QETH_CARD_STAT_INC(card, rx_errors);
5210 5211 5212 5213 5214 5215 5216 5217 5218 5219 5220
				return NULL;
			}
			element++;
			offset = 0;
			data_ptr = element->addr;
		} else {
			offset += data_len;
		}
	}
	*__element = element;
	*__offset = offset;
5221 5222 5223 5224
	if (use_rx_sg) {
		QETH_CARD_STAT_INC(card, rx_sg_skbs);
		QETH_CARD_STAT_ADD(card, rx_sg_frags,
				   skb_shinfo(skb)->nr_frags);
5225 5226 5227 5228
	}
	return skb;
no_mem:
	if (net_ratelimit()) {
5229
		QETH_CARD_TEXT(card, 2, "noskbmem");
5230
	}
5231
	QETH_CARD_STAT_INC(card, rx_dropped);
5232 5233 5234 5235
	return NULL;
}
EXPORT_SYMBOL_GPL(qeth_core_get_next_skb);

5236 5237 5238 5239 5240 5241 5242 5243 5244 5245 5246 5247 5248 5249 5250 5251 5252 5253 5254 5255 5256 5257 5258 5259 5260 5261 5262 5263 5264 5265 5266 5267 5268 5269 5270 5271
int qeth_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;

	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 +=
					card->discipline->process_rx_buffer(
						card, new_budget, &done);
			else
				done = 1;

			if (done) {
5272
				QETH_CARD_STAT_INC(card, rx_bufs);
5273 5274 5275 5276 5277 5278 5279 5280 5281 5282 5283 5284 5285 5286 5287 5288 5289 5290 5291 5292 5293 5294 5295
				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;
		}
	}

5296
	napi_complete_done(napi, work_done);
5297 5298 5299 5300 5301 5302 5303
	if (qdio_start_irq(card->data.ccwdev, 0))
		napi_schedule(&card->napi);
out:
	return work_done;
}
EXPORT_SYMBOL_GPL(qeth_poll);

5304 5305 5306 5307 5308 5309 5310
static int qeth_setassparms_inspect_rc(struct qeth_ipa_cmd *cmd)
{
	if (!cmd->hdr.return_code)
		cmd->hdr.return_code = cmd->data.setassparms.hdr.return_code;
	return cmd->hdr.return_code;
}

5311 5312 5313 5314 5315 5316 5317 5318
static int qeth_setassparms_get_caps_cb(struct qeth_card *card,
					struct qeth_reply *reply,
					unsigned long data)
{
	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
	struct qeth_ipa_caps *caps = reply->param;

	if (qeth_setassparms_inspect_rc(cmd))
5319
		return -EIO;
5320 5321 5322 5323 5324 5325

	caps->supported = cmd->data.setassparms.data.caps.supported;
	caps->enabled = cmd->data.setassparms.data.caps.enabled;
	return 0;
}

5326 5327
int qeth_setassparms_cb(struct qeth_card *card,
			struct qeth_reply *reply, unsigned long data)
5328
{
5329
	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
5330 5331 5332

	QETH_CARD_TEXT(card, 4, "defadpcb");

5333 5334 5335 5336 5337 5338 5339 5340
	if (cmd->hdr.return_code)
		return -EIO;

	cmd->hdr.return_code = cmd->data.setassparms.hdr.return_code;
	if (cmd->hdr.prot_version == QETH_PROT_IPV4)
		card->options.ipa4.enabled_funcs = cmd->hdr.ipa_enabled;
	if (cmd->hdr.prot_version == QETH_PROT_IPV6)
		card->options.ipa6.enabled_funcs = cmd->hdr.ipa_enabled;
5341 5342
	return 0;
}
5343
EXPORT_SYMBOL_GPL(qeth_setassparms_cb);
5344

5345 5346 5347 5348
struct qeth_cmd_buffer *qeth_get_setassparms_cmd(struct qeth_card *card,
						 enum qeth_ipa_funcs ipa_func,
						 __u16 cmd_code, __u16 len,
						 enum qeth_prot_versions prot)
5349 5350 5351 5352 5353 5354 5355 5356
{
	struct qeth_cmd_buffer *iob;
	struct qeth_ipa_cmd *cmd;

	QETH_CARD_TEXT(card, 4, "getasscm");
	iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SETASSPARMS, prot);

	if (iob) {
5357
		cmd = __ipa_cmd(iob);
5358 5359 5360 5361 5362 5363 5364
		cmd->data.setassparms.hdr.assist_no = ipa_func;
		cmd->data.setassparms.hdr.length = 8 + len;
		cmd->data.setassparms.hdr.command_code = cmd_code;
	}

	return iob;
}
5365
EXPORT_SYMBOL_GPL(qeth_get_setassparms_cmd);
5366

5367 5368 5369 5370
int qeth_send_simple_setassparms_prot(struct qeth_card *card,
				      enum qeth_ipa_funcs ipa_func,
				      u16 cmd_code, long data,
				      enum qeth_prot_versions prot)
5371 5372 5373 5374
{
	int length = 0;
	struct qeth_cmd_buffer *iob;

5375
	QETH_CARD_TEXT_(card, 4, "simassp%i", prot);
5376 5377
	if (data)
		length = sizeof(__u32);
5378
	iob = qeth_get_setassparms_cmd(card, ipa_func, cmd_code, length, prot);
5379 5380
	if (!iob)
		return -ENOMEM;
5381 5382 5383

	__ipa_cmd(iob)->data.setassparms.data.flags_32bit = (__u32) data;
	return qeth_send_ipa_cmd(card, iob, qeth_setassparms_cb, NULL);
5384
}
5385
EXPORT_SYMBOL_GPL(qeth_send_simple_setassparms_prot);
5386

5387 5388
static void qeth_unregister_dbf_views(void)
{
5389 5390 5391 5392 5393
	int x;
	for (x = 0; x < QETH_DBF_INFOS; x++) {
		debug_unregister(qeth_dbf[x].id);
		qeth_dbf[x].id = NULL;
	}
5394 5395
}

5396
void qeth_dbf_longtext(debug_info_t *id, int level, char *fmt, ...)
5397 5398
{
	char dbf_txt_buf[32];
5399
	va_list args;
5400

5401
	if (!debug_level_enabled(id, level))
5402
		return;
5403 5404 5405
	va_start(args, fmt);
	vsnprintf(dbf_txt_buf, sizeof(dbf_txt_buf), fmt, args);
	va_end(args);
5406
	debug_text_event(id, level, dbf_txt_buf);
5407 5408 5409
}
EXPORT_SYMBOL_GPL(qeth_dbf_longtext);

5410 5411
static int qeth_register_dbf_views(void)
{
5412 5413 5414 5415 5416 5417 5418 5419 5420 5421 5422 5423 5424
	int ret;
	int x;

	for (x = 0; x < QETH_DBF_INFOS; x++) {
		/* register the areas */
		qeth_dbf[x].id = debug_register(qeth_dbf[x].name,
						qeth_dbf[x].pages,
						qeth_dbf[x].areas,
						qeth_dbf[x].len);
		if (qeth_dbf[x].id == NULL) {
			qeth_unregister_dbf_views();
			return -ENOMEM;
		}
5425

5426 5427 5428 5429 5430 5431
		/* register a view */
		ret = debug_register_view(qeth_dbf[x].id, qeth_dbf[x].view);
		if (ret) {
			qeth_unregister_dbf_views();
			return ret;
		}
5432

5433 5434 5435
		/* set a passing level */
		debug_set_level(qeth_dbf[x].id, qeth_dbf[x].level);
	}
5436 5437 5438 5439

	return 0;
}

5440 5441
static DEFINE_MUTEX(qeth_mod_mutex);	/* for synchronized module loading */

5442 5443 5444
int qeth_core_load_discipline(struct qeth_card *card,
		enum qeth_discipline_id discipline)
{
5445
	mutex_lock(&qeth_mod_mutex);
5446 5447
	switch (discipline) {
	case QETH_DISCIPLINE_LAYER3:
5448 5449
		card->discipline = try_then_request_module(
			symbol_get(qeth_l3_discipline), "qeth_l3");
5450 5451
		break;
	case QETH_DISCIPLINE_LAYER2:
5452 5453
		card->discipline = try_then_request_module(
			symbol_get(qeth_l2_discipline), "qeth_l2");
5454
		break;
5455 5456
	default:
		break;
5457
	}
5458
	mutex_unlock(&qeth_mod_mutex);
5459

5460
	if (!card->discipline) {
5461 5462
		dev_err(&card->gdev->dev, "There is no kernel module to "
			"support discipline %d\n", discipline);
5463
		return -EINVAL;
5464
	}
5465

5466
	card->options.layer = discipline;
5467
	return 0;
5468 5469 5470 5471
}

void qeth_core_free_discipline(struct qeth_card *card)
{
5472
	if (IS_LAYER2(card))
5473
		symbol_put(qeth_l2_discipline);
5474
	else
5475
		symbol_put(qeth_l3_discipline);
5476
	card->options.layer = QETH_DISCIPLINE_UNDETERMINED;
5477
	card->discipline = NULL;
5478 5479
}

5480
const struct device_type qeth_generic_devtype = {
5481 5482 5483
	.name = "qeth_generic",
	.groups = qeth_generic_attr_groups,
};
5484 5485
EXPORT_SYMBOL_GPL(qeth_generic_devtype);

5486 5487 5488 5489 5490
static const struct device_type qeth_osn_devtype = {
	.name = "qeth_osn",
	.groups = qeth_osn_attr_groups,
};

5491 5492 5493 5494 5495 5496 5497 5498 5499 5500 5501 5502 5503 5504 5505 5506 5507 5508 5509 5510 5511 5512 5513 5514 5515 5516 5517 5518 5519 5520 5521 5522 5523 5524 5525 5526 5527 5528 5529 5530 5531 5532 5533 5534 5535 5536 5537 5538 5539 5540 5541 5542 5543 5544 5545 5546 5547 5548 5549 5550 5551 5552 5553 5554 5555 5556 5557 5558
#define DBF_NAME_LEN	20

struct qeth_dbf_entry {
	char dbf_name[DBF_NAME_LEN];
	debug_info_t *dbf_info;
	struct list_head dbf_list;
};

static LIST_HEAD(qeth_dbf_list);
static DEFINE_MUTEX(qeth_dbf_list_mutex);

static debug_info_t *qeth_get_dbf_entry(char *name)
{
	struct qeth_dbf_entry *entry;
	debug_info_t *rc = NULL;

	mutex_lock(&qeth_dbf_list_mutex);
	list_for_each_entry(entry, &qeth_dbf_list, dbf_list) {
		if (strcmp(entry->dbf_name, name) == 0) {
			rc = entry->dbf_info;
			break;
		}
	}
	mutex_unlock(&qeth_dbf_list_mutex);
	return rc;
}

static int qeth_add_dbf_entry(struct qeth_card *card, char *name)
{
	struct qeth_dbf_entry *new_entry;

	card->debug = debug_register(name, 2, 1, 8);
	if (!card->debug) {
		QETH_DBF_TEXT_(SETUP, 2, "%s", "qcdbf");
		goto err;
	}
	if (debug_register_view(card->debug, &debug_hex_ascii_view))
		goto err_dbg;
	new_entry = kzalloc(sizeof(struct qeth_dbf_entry), GFP_KERNEL);
	if (!new_entry)
		goto err_dbg;
	strncpy(new_entry->dbf_name, name, DBF_NAME_LEN);
	new_entry->dbf_info = card->debug;
	mutex_lock(&qeth_dbf_list_mutex);
	list_add(&new_entry->dbf_list, &qeth_dbf_list);
	mutex_unlock(&qeth_dbf_list_mutex);

	return 0;

err_dbg:
	debug_unregister(card->debug);
err:
	return -ENOMEM;
}

static void qeth_clear_dbf_list(void)
{
	struct qeth_dbf_entry *entry, *tmp;

	mutex_lock(&qeth_dbf_list_mutex);
	list_for_each_entry_safe(entry, tmp, &qeth_dbf_list, dbf_list) {
		list_del(&entry->dbf_list);
		debug_unregister(entry->dbf_info);
		kfree(entry);
	}
	mutex_unlock(&qeth_dbf_list_mutex);
}

5559 5560 5561 5562 5563 5564
static struct net_device *qeth_alloc_netdev(struct qeth_card *card)
{
	struct net_device *dev;

	switch (card->info.type) {
	case QETH_CARD_TYPE_IQD:
5565 5566
		dev = alloc_netdev_mqs(0, "hsi%d", NET_NAME_UNKNOWN,
				       ether_setup, QETH_MAX_QUEUES, 1);
5567
		break;
5568 5569 5570
	case QETH_CARD_TYPE_OSM:
		dev = alloc_etherdev(0);
		break;
5571 5572 5573 5574
	case QETH_CARD_TYPE_OSN:
		dev = alloc_netdev(0, "osn%d", NET_NAME_UNKNOWN, ether_setup);
		break;
	default:
5575
		dev = alloc_etherdev_mqs(0, QETH_MAX_QUEUES, 1);
5576 5577 5578 5579 5580 5581 5582
	}

	if (!dev)
		return NULL;

	dev->ml_priv = card;
	dev->watchdog_timeo = QETH_TX_TIMEOUT;
5583
	dev->min_mtu = IS_OSN(card) ? 64 : 576;
5584 5585 5586
	 /* initialized when device first goes online: */
	dev->max_mtu = 0;
	dev->mtu = 0;
5587 5588
	SET_NETDEV_DEV(dev, &card->gdev->dev);
	netif_carrier_off(dev);
5589

5590 5591 5592 5593
	if (IS_OSN(card)) {
		dev->ethtool_ops = &qeth_osn_ethtool_ops;
	} else {
		dev->ethtool_ops = &qeth_ethtool_ops;
5594 5595 5596
		dev->priv_flags &= ~IFF_TX_SKB_SHARING;
		dev->hw_features |= NETIF_F_SG;
		dev->vlan_features |= NETIF_F_SG;
5597
		if (IS_IQD(card)) {
5598
			dev->features |= NETIF_F_SG;
5599 5600 5601 5602 5603
			if (netif_set_real_num_tx_queues(dev,
							 QETH_IQD_MIN_TXQ)) {
				free_netdev(dev);
				return NULL;
			}
5604
		}
5605 5606
	}

5607 5608 5609 5610 5611 5612 5613 5614 5615 5616 5617 5618 5619 5620
	return dev;
}

struct net_device *qeth_clone_netdev(struct net_device *orig)
{
	struct net_device *clone = qeth_alloc_netdev(orig->ml_priv);

	if (!clone)
		return NULL;

	clone->dev_port = orig->dev_port;
	return clone;
}

5621 5622 5623 5624 5625
static int qeth_core_probe_device(struct ccwgroup_device *gdev)
{
	struct qeth_card *card;
	struct device *dev;
	int rc;
5626
	enum qeth_discipline_id enforced_disc;
5627
	char dbf_name[DBF_NAME_LEN];
5628

5629
	QETH_DBF_TEXT(SETUP, 2, "probedev");
5630 5631 5632 5633 5634

	dev = &gdev->dev;
	if (!get_device(dev))
		return -ENODEV;

5635
	QETH_DBF_TEXT_(SETUP, 2, "%s", dev_name(&gdev->dev));
5636

5637
	card = qeth_alloc_card(gdev);
5638
	if (!card) {
5639
		QETH_DBF_TEXT_(SETUP, 2, "1err%d", -ENOMEM);
5640 5641 5642
		rc = -ENOMEM;
		goto err_dev;
	}
5643 5644 5645

	snprintf(dbf_name, sizeof(dbf_name), "qeth_card_%s",
		dev_name(&gdev->dev));
5646
	card->debug = qeth_get_dbf_entry(dbf_name);
5647
	if (!card->debug) {
5648 5649 5650
		rc = qeth_add_dbf_entry(card, dbf_name);
		if (rc)
			goto err_card;
5651 5652
	}

5653
	qeth_setup_card(card);
5654
	card->dev = qeth_alloc_netdev(card);
5655 5656
	if (!card->dev) {
		rc = -ENOMEM;
5657
		goto err_card;
5658
	}
5659

5660 5661 5662 5663
	card->qdio.no_out_queues = card->dev->num_tx_queues;
	rc = qeth_update_from_chp_desc(card);
	if (rc)
		goto err_chp_desc;
5664 5665 5666 5667 5668 5669 5670 5671 5672
	qeth_determine_capabilities(card);
	enforced_disc = qeth_enforce_discipline(card);
	switch (enforced_disc) {
	case QETH_DISCIPLINE_UNDETERMINED:
		gdev->dev.type = &qeth_generic_devtype;
		break;
	default:
		card->info.layer_enforced = true;
		rc = qeth_core_load_discipline(card, enforced_disc);
5673
		if (rc)
5674
			goto err_load;
5675

5676 5677
		gdev->dev.type = IS_OSN(card) ? &qeth_osn_devtype :
						card->discipline->devtype;
5678
		rc = card->discipline->setup(card->gdev);
5679
		if (rc)
5680
			goto err_disc;
5681
		break;
5682 5683 5684 5685
	}

	return 0;

5686 5687
err_disc:
	qeth_core_free_discipline(card);
5688
err_load:
5689
err_chp_desc:
5690
	free_netdev(card->dev);
5691 5692 5693 5694 5695 5696 5697 5698 5699 5700 5701
err_card:
	qeth_core_free_card(card);
err_dev:
	put_device(dev);
	return rc;
}

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

5702
	QETH_DBF_TEXT(SETUP, 2, "removedv");
5703

5704 5705
	if (card->discipline) {
		card->discipline->remove(gdev);
5706 5707 5708
		qeth_core_free_discipline(card);
	}

5709
	free_netdev(card->dev);
5710 5711 5712 5713 5714 5715 5716 5717
	qeth_core_free_card(card);
	put_device(&gdev->dev);
}

static int qeth_core_set_online(struct ccwgroup_device *gdev)
{
	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
	int rc = 0;
5718
	enum qeth_discipline_id def_discipline;
5719

5720
	if (!card->discipline) {
5721 5722
		def_discipline = IS_IQD(card) ? QETH_DISCIPLINE_LAYER3 :
						QETH_DISCIPLINE_LAYER2;
5723 5724 5725
		rc = qeth_core_load_discipline(card, def_discipline);
		if (rc)
			goto err;
5726
		rc = card->discipline->setup(card->gdev);
5727 5728
		if (rc) {
			qeth_core_free_discipline(card);
5729
			goto err;
5730
		}
5731
	}
5732
	rc = card->discipline->set_online(gdev);
5733 5734 5735 5736 5737 5738 5739
err:
	return rc;
}

static int qeth_core_set_offline(struct ccwgroup_device *gdev)
{
	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
5740
	return card->discipline->set_offline(gdev);
5741 5742 5743 5744 5745
}

static void qeth_core_shutdown(struct ccwgroup_device *gdev)
{
	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
5746 5747 5748 5749
	qeth_set_allowed_threads(card, 0, 1);
	if ((gdev->state == CCWGROUP_ONLINE) && card->info.hwtrap)
		qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM);
	qeth_qdio_clear_card(card, 0);
5750
	qeth_drain_output_queues(card);
5751
	qdio_free(CARD_DDEV(card));
5752 5753
}

5754 5755 5756
static int qeth_core_freeze(struct ccwgroup_device *gdev)
{
	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
5757 5758
	if (card->discipline && card->discipline->freeze)
		return card->discipline->freeze(gdev);
5759 5760 5761 5762 5763 5764
	return 0;
}

static int qeth_core_thaw(struct ccwgroup_device *gdev)
{
	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
5765 5766
	if (card->discipline && card->discipline->thaw)
		return card->discipline->thaw(gdev);
5767 5768 5769 5770 5771 5772
	return 0;
}

static int qeth_core_restore(struct ccwgroup_device *gdev)
{
	struct qeth_card *card = dev_get_drvdata(&gdev->dev);
5773 5774
	if (card->discipline && card->discipline->restore)
		return card->discipline->restore(gdev);
5775 5776 5777
	return 0;
}

5778 5779
static ssize_t group_store(struct device_driver *ddrv, const char *buf,
			   size_t count)
5780 5781 5782
{
	int err;

5783 5784
	err = ccwgroup_create_dev(qeth_core_root_dev, to_ccwgroupdrv(ddrv), 3,
				  buf);
5785 5786 5787

	return err ? err : count;
}
5788
static DRIVER_ATTR_WO(group);
5789

5790 5791 5792 5793 5794 5795 5796 5797 5798 5799 5800 5801
static struct attribute *qeth_drv_attrs[] = {
	&driver_attr_group.attr,
	NULL,
};
static struct attribute_group qeth_drv_attr_group = {
	.attrs = qeth_drv_attrs,
};
static const struct attribute_group *qeth_drv_attr_groups[] = {
	&qeth_drv_attr_group,
	NULL,
};

5802 5803 5804 5805 5806 5807 5808 5809 5810 5811 5812 5813 5814 5815 5816 5817 5818 5819 5820
static struct ccwgroup_driver qeth_core_ccwgroup_driver = {
	.driver = {
		.groups = qeth_drv_attr_groups,
		.owner = THIS_MODULE,
		.name = "qeth",
	},
	.ccw_driver = &qeth_ccw_driver,
	.setup = qeth_core_probe_device,
	.remove = qeth_core_remove_device,
	.set_online = qeth_core_set_online,
	.set_offline = qeth_core_set_offline,
	.shutdown = qeth_core_shutdown,
	.prepare = NULL,
	.complete = NULL,
	.freeze = qeth_core_freeze,
	.thaw = qeth_core_thaw,
	.restore = qeth_core_restore,
};

5821 5822 5823 5824 5825 5826 5827 5828 5829 5830 5831 5832 5833 5834 5835
struct qeth_card *qeth_get_card_by_busid(char *bus_id)
{
	struct ccwgroup_device *gdev;
	struct qeth_card *card;

	gdev = get_ccwgroupdev_by_busid(&qeth_core_ccwgroup_driver, bus_id);
	if (!gdev)
		return NULL;

	card = dev_get_drvdata(&gdev->dev);
	put_device(&gdev->dev);
	return card;
}
EXPORT_SYMBOL_GPL(qeth_get_card_by_busid);

5836 5837 5838 5839 5840 5841 5842 5843 5844 5845 5846 5847 5848 5849
int qeth_do_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
{
	struct qeth_card *card = dev->ml_priv;
	struct mii_ioctl_data *mii_data;
	int rc = 0;

	if (!card)
		return -ENODEV;

	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:
5850 5851
		if ((IS_OSD(card) || IS_OSM(card) || IS_OSX(card)) &&
		    !IS_VM_NIC(card))
5852
			return 1;
5853
		return 0;
5854 5855 5856 5857 5858 5859 5860 5861 5862 5863 5864 5865 5866 5867 5868 5869 5870 5871 5872 5873 5874 5875 5876 5877 5878 5879 5880
	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;
	case SIOC_QETH_QUERY_OAT:
		rc = qeth_query_oat_command(card, rq->ifr_ifru.ifru_data);
		break;
	default:
		if (card->discipline->do_ioctl)
			rc = card->discipline->do_ioctl(dev, rq, cmd);
		else
			rc = -EOPNOTSUPP;
	}
	if (rc)
		QETH_CARD_TEXT_(card, 2, "ioce%x", rc);
	return rc;
}
EXPORT_SYMBOL_GPL(qeth_do_ioctl);

5881 5882
static int qeth_start_csum_cb(struct qeth_card *card, struct qeth_reply *reply,
			      unsigned long data)
5883 5884
{
	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
5885
	u32 *features = reply->param;
5886

5887
	if (qeth_setassparms_inspect_rc(cmd))
5888
		return -EIO;
5889

5890
	*features = cmd->data.setassparms.data.flags_32bit;
5891 5892 5893
	return 0;
}

5894 5895
static int qeth_set_csum_off(struct qeth_card *card, enum qeth_ipa_funcs cstype,
			     enum qeth_prot_versions prot)
5896
{
5897 5898
	return qeth_send_simple_setassparms_prot(card, cstype,
						 IPA_CMD_ASS_STOP, 0, prot);
5899 5900
}

5901 5902
static int qeth_set_csum_on(struct qeth_card *card, enum qeth_ipa_funcs cstype,
			    enum qeth_prot_versions prot)
5903
{
5904
	u32 required_features = QETH_IPA_CHECKSUM_UDP | QETH_IPA_CHECKSUM_TCP;
5905 5906 5907
	struct qeth_cmd_buffer *iob;
	struct qeth_ipa_caps caps;
	u32 features;
5908 5909
	int rc;

5910 5911 5912
	/* some L3 HW requires combined L3+L4 csum offload: */
	if (IS_LAYER3(card) && prot == QETH_PROT_IPV4 &&
	    cstype == IPA_OUTBOUND_CHECKSUM)
5913
		required_features |= QETH_IPA_CHECKSUM_IP_HDR;
5914

5915 5916 5917 5918 5919 5920 5921
	iob = qeth_get_setassparms_cmd(card, cstype, IPA_CMD_ASS_START, 0,
				       prot);
	if (!iob)
		return -ENOMEM;

	rc = qeth_send_ipa_cmd(card, iob, qeth_start_csum_cb, &features);
	if (rc)
5922
		return rc;
5923

5924 5925 5926 5927
	if ((required_features & features) != required_features) {
		qeth_set_csum_off(card, cstype, prot);
		return -EOPNOTSUPP;
	}
5928

5929
	iob = qeth_get_setassparms_cmd(card, cstype, IPA_CMD_ASS_ENABLE, 4,
5930
				       prot);
5931 5932 5933
	if (!iob) {
		qeth_set_csum_off(card, cstype, prot);
		return -ENOMEM;
5934
	}
5935 5936 5937 5938 5939

	if (features & QETH_IPA_CHECKSUM_LP2LP)
		required_features |= QETH_IPA_CHECKSUM_LP2LP;
	__ipa_cmd(iob)->data.setassparms.data.flags_32bit = required_features;
	rc = qeth_send_ipa_cmd(card, iob, qeth_setassparms_get_caps_cb, &caps);
5940
	if (rc) {
5941
		qeth_set_csum_off(card, cstype, prot);
5942 5943
		return rc;
	}
5944

5945 5946 5947 5948 5949 5950
	if (!qeth_ipa_caps_supported(&caps, required_features) ||
	    !qeth_ipa_caps_enabled(&caps, required_features)) {
		qeth_set_csum_off(card, cstype, prot);
		return -EOPNOTSUPP;
	}

5951 5952
	dev_info(&card->gdev->dev, "HW Checksumming (%sbound IPv%d) enabled\n",
		 cstype == IPA_INBOUND_CHECKSUM ? "in" : "out", prot);
5953 5954 5955 5956 5957
	if (!qeth_ipa_caps_enabled(&caps, QETH_IPA_CHECKSUM_LP2LP) &&
	    cstype == IPA_OUTBOUND_CHECKSUM)
		dev_warn(&card->gdev->dev,
			 "Hardware checksumming is performed only if %s and its peer use different OSA Express 3 ports\n",
			 QETH_CARD_IFNAME(card));
5958 5959 5960
	return 0;
}

5961 5962
static int qeth_set_ipa_csum(struct qeth_card *card, bool on, int cstype,
			     enum qeth_prot_versions prot)
5963
{
5964 5965
	return on ? qeth_set_csum_on(card, cstype, prot) :
		    qeth_set_csum_off(card, cstype, prot);
5966 5967
}

5968 5969 5970 5971 5972 5973 5974
static int qeth_start_tso_cb(struct qeth_card *card, struct qeth_reply *reply,
			     unsigned long data)
{
	struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
	struct qeth_tso_start_data *tso_data = reply->param;

	if (qeth_setassparms_inspect_rc(cmd))
5975
		return -EIO;
5976 5977 5978 5979 5980 5981

	tso_data->mss = cmd->data.setassparms.data.tso.mss;
	tso_data->supported = cmd->data.setassparms.data.tso.supported;
	return 0;
}

5982 5983
static int qeth_set_tso_off(struct qeth_card *card,
			    enum qeth_prot_versions prot)
5984
{
5985 5986 5987
	return qeth_send_simple_setassparms_prot(card, IPA_OUTBOUND_TSO,
						 IPA_CMD_ASS_STOP, 0, prot);
}
5988

5989 5990 5991
static int qeth_set_tso_on(struct qeth_card *card,
			   enum qeth_prot_versions prot)
{
5992 5993 5994 5995 5996 5997 5998 5999 6000 6001
	struct qeth_tso_start_data tso_data;
	struct qeth_cmd_buffer *iob;
	struct qeth_ipa_caps caps;
	int rc;

	iob = qeth_get_setassparms_cmd(card, IPA_OUTBOUND_TSO,
				       IPA_CMD_ASS_START, 0, prot);
	if (!iob)
		return -ENOMEM;

6002
	rc = qeth_send_ipa_cmd(card, iob, qeth_start_tso_cb, &tso_data);
6003 6004 6005 6006 6007 6008 6009 6010 6011 6012 6013 6014 6015 6016 6017 6018
	if (rc)
		return rc;

	if (!tso_data.mss || !(tso_data.supported & QETH_IPA_LARGE_SEND_TCP)) {
		qeth_set_tso_off(card, prot);
		return -EOPNOTSUPP;
	}

	iob = qeth_get_setassparms_cmd(card, IPA_OUTBOUND_TSO,
				       IPA_CMD_ASS_ENABLE, sizeof(caps), prot);
	if (!iob) {
		qeth_set_tso_off(card, prot);
		return -ENOMEM;
	}

	/* enable TSO capability */
6019 6020 6021
	__ipa_cmd(iob)->data.setassparms.data.caps.enabled =
		QETH_IPA_LARGE_SEND_TCP;
	rc = qeth_send_ipa_cmd(card, iob, qeth_setassparms_get_caps_cb, &caps);
6022 6023 6024 6025 6026 6027 6028 6029 6030 6031 6032 6033 6034 6035
	if (rc) {
		qeth_set_tso_off(card, prot);
		return rc;
	}

	if (!qeth_ipa_caps_supported(&caps, QETH_IPA_LARGE_SEND_TCP) ||
	    !qeth_ipa_caps_enabled(&caps, QETH_IPA_LARGE_SEND_TCP)) {
		qeth_set_tso_off(card, prot);
		return -EOPNOTSUPP;
	}

	dev_info(&card->gdev->dev, "TSOv%u enabled (MSS: %u)\n", prot,
		 tso_data.mss);
	return 0;
6036
}
6037

6038 6039 6040
static int qeth_set_ipa_tso(struct qeth_card *card, bool on,
			    enum qeth_prot_versions prot)
{
6041
	return on ? qeth_set_tso_on(card, prot) : qeth_set_tso_off(card, prot);
6042
}
6043

6044 6045 6046 6047 6048 6049 6050 6051 6052 6053 6054
static int qeth_set_ipa_rx_csum(struct qeth_card *card, bool on)
{
	int rc_ipv4 = (on) ? -EOPNOTSUPP : 0;
	int rc_ipv6;

	if (qeth_is_supported(card, IPA_INBOUND_CHECKSUM))
		rc_ipv4 = qeth_set_ipa_csum(card, on, IPA_INBOUND_CHECKSUM,
					    QETH_PROT_IPV4);
	if (!qeth_is_supported6(card, IPA_INBOUND_CHECKSUM_V6))
		/* no/one Offload Assist available, so the rc is trivial */
		return rc_ipv4;
6055

6056 6057 6058 6059 6060 6061 6062 6063 6064 6065 6066
	rc_ipv6 = qeth_set_ipa_csum(card, on, IPA_INBOUND_CHECKSUM,
				    QETH_PROT_IPV6);

	if (on)
		/* enable: success if any Assist is active */
		return (rc_ipv6) ? rc_ipv4 : 0;

	/* disable: failure if any Assist is still active */
	return (rc_ipv6) ? rc_ipv6 : rc_ipv4;
}

6067
/**
6068 6069
 * qeth_enable_hw_features() - (Re-)Enable HW functions for device features
 * @dev:	a net_device
6070
 */
6071
void qeth_enable_hw_features(struct net_device *dev)
6072 6073
{
	struct qeth_card *card = dev->ml_priv;
6074
	netdev_features_t features;
6075

6076
	features = dev->features;
6077
	/* force-off any feature that might need an IPA sequence.
6078 6079
	 * netdev_update_features() will restart them.
	 */
6080 6081 6082 6083 6084 6085
	dev->features &= ~dev->hw_features;
	/* toggle VLAN filter, so that VIDs are re-programmed: */
	if (IS_LAYER2(card) && IS_VM_NIC(card)) {
		dev->features &= ~NETIF_F_HW_VLAN_CTAG_FILTER;
		dev->wanted_features |= NETIF_F_HW_VLAN_CTAG_FILTER;
	}
6086
	netdev_update_features(dev);
6087 6088 6089
	if (features != dev->features)
		dev_warn(&card->gdev->dev,
			 "Device recovery failed to restore all offload features\n");
6090
}
6091
EXPORT_SYMBOL_GPL(qeth_enable_hw_features);
6092

6093 6094 6095
int qeth_set_features(struct net_device *dev, netdev_features_t features)
{
	struct qeth_card *card = dev->ml_priv;
6096
	netdev_features_t changed = dev->features ^ features;
6097 6098 6099 6100 6101
	int rc = 0;

	QETH_DBF_TEXT(SETUP, 2, "setfeat");
	QETH_DBF_HEX(SETUP, 2, &features, sizeof(features));

6102
	if ((changed & NETIF_F_IP_CSUM)) {
6103 6104
		rc = qeth_set_ipa_csum(card, features & NETIF_F_IP_CSUM,
				       IPA_OUTBOUND_CHECKSUM, QETH_PROT_IPV4);
6105 6106 6107
		if (rc)
			changed ^= NETIF_F_IP_CSUM;
	}
6108 6109 6110 6111 6112 6113
	if (changed & NETIF_F_IPV6_CSUM) {
		rc = qeth_set_ipa_csum(card, features & NETIF_F_IPV6_CSUM,
				       IPA_OUTBOUND_CHECKSUM, QETH_PROT_IPV6);
		if (rc)
			changed ^= NETIF_F_IPV6_CSUM;
	}
6114 6115
	if (changed & NETIF_F_RXCSUM) {
		rc = qeth_set_ipa_rx_csum(card, features & NETIF_F_RXCSUM);
6116 6117 6118
		if (rc)
			changed ^= NETIF_F_RXCSUM;
	}
6119 6120 6121
	if (changed & NETIF_F_TSO) {
		rc = qeth_set_ipa_tso(card, features & NETIF_F_TSO,
				      QETH_PROT_IPV4);
6122 6123 6124
		if (rc)
			changed ^= NETIF_F_TSO;
	}
6125 6126 6127 6128 6129 6130
	if (changed & NETIF_F_TSO6) {
		rc = qeth_set_ipa_tso(card, features & NETIF_F_TSO6,
				      QETH_PROT_IPV6);
		if (rc)
			changed ^= NETIF_F_TSO6;
	}
6131 6132 6133 6134 6135 6136 6137

	/* everything changed successfully? */
	if ((dev->features ^ features) == changed)
		return 0;
	/* something went wrong. save changed features and return error */
	dev->features ^= changed;
	return -EIO;
6138 6139 6140 6141 6142 6143 6144 6145 6146 6147 6148
}
EXPORT_SYMBOL_GPL(qeth_set_features);

netdev_features_t qeth_fix_features(struct net_device *dev,
				    netdev_features_t features)
{
	struct qeth_card *card = dev->ml_priv;

	QETH_DBF_TEXT(SETUP, 2, "fixfeat");
	if (!qeth_is_supported(card, IPA_OUTBOUND_CHECKSUM))
		features &= ~NETIF_F_IP_CSUM;
6149 6150
	if (!qeth_is_supported6(card, IPA_OUTBOUND_CHECKSUM_V6))
		features &= ~NETIF_F_IPV6_CSUM;
6151 6152
	if (!qeth_is_supported(card, IPA_INBOUND_CHECKSUM) &&
	    !qeth_is_supported6(card, IPA_INBOUND_CHECKSUM_V6))
6153
		features &= ~NETIF_F_RXCSUM;
6154
	if (!qeth_is_supported(card, IPA_OUTBOUND_TSO))
6155
		features &= ~NETIF_F_TSO;
6156 6157
	if (!qeth_is_supported6(card, IPA_OUTBOUND_TSO))
		features &= ~NETIF_F_TSO6;
6158

6159 6160 6161 6162
	QETH_DBF_HEX(SETUP, 2, &features, sizeof(features));
	return features;
}
EXPORT_SYMBOL_GPL(qeth_fix_features);
6163

6164 6165 6166 6167 6168 6169 6170 6171 6172 6173 6174 6175 6176 6177 6178 6179 6180 6181 6182 6183 6184 6185 6186 6187 6188 6189
netdev_features_t qeth_features_check(struct sk_buff *skb,
				      struct net_device *dev,
				      netdev_features_t features)
{
	/* GSO segmentation builds skbs with
	 *	a (small) linear part for the headers, and
	 *	page frags for the data.
	 * Compared to a linear skb, the header-only part consumes an
	 * additional buffer element. This reduces buffer utilization, and
	 * hurts throughput. So compress small segments into one element.
	 */
	if (netif_needs_gso(skb, features)) {
		/* match skb_segment(): */
		unsigned int doffset = skb->data - skb_mac_header(skb);
		unsigned int hsize = skb_shinfo(skb)->gso_size;
		unsigned int hroom = skb_headroom(skb);

		/* linearize only if resulting skb allocations are order-0: */
		if (SKB_DATA_ALIGN(hroom + doffset + hsize) <= SKB_MAX_HEAD(0))
			features &= ~NETIF_F_SG;
	}

	return vlan_features_check(skb, features);
}
EXPORT_SYMBOL_GPL(qeth_features_check);

6190 6191 6192 6193 6194 6195 6196 6197 6198 6199 6200 6201 6202 6203 6204 6205 6206 6207 6208 6209 6210 6211 6212 6213 6214
void qeth_get_stats64(struct net_device *dev, struct rtnl_link_stats64 *stats)
{
	struct qeth_card *card = dev->ml_priv;
	struct qeth_qdio_out_q *queue;
	unsigned int i;

	QETH_CARD_TEXT(card, 5, "getstat");

	stats->rx_packets = card->stats.rx_packets;
	stats->rx_bytes = card->stats.rx_bytes;
	stats->rx_errors = card->stats.rx_errors;
	stats->rx_dropped = card->stats.rx_dropped;
	stats->multicast = card->stats.rx_multicast;

	for (i = 0; i < card->qdio.no_out_queues; i++) {
		queue = card->qdio.out_qs[i];

		stats->tx_packets += queue->stats.tx_packets;
		stats->tx_bytes += queue->stats.tx_bytes;
		stats->tx_errors += queue->stats.tx_errors;
		stats->tx_dropped += queue->stats.tx_dropped;
	}
}
EXPORT_SYMBOL_GPL(qeth_get_stats64);

6215 6216 6217 6218 6219 6220 6221 6222 6223
u16 qeth_iqd_select_queue(struct net_device *dev, struct sk_buff *skb,
			  u8 cast_type, struct net_device *sb_dev)
{
	if (cast_type != RTN_UNICAST)
		return QETH_IQD_MCAST_TXQ;
	return QETH_IQD_MIN_UCAST_TXQ;
}
EXPORT_SYMBOL_GPL(qeth_iqd_select_queue);

6224
int qeth_open(struct net_device *dev)
6225 6226 6227 6228 6229 6230 6231 6232 6233
{
	struct qeth_card *card = dev->ml_priv;

	QETH_CARD_TEXT(card, 4, "qethopen");

	if (qdio_stop_irq(CARD_DDEV(card), 0) < 0)
		return -EIO;

	card->data.state = CH_STATE_UP;
6234
	netif_tx_start_all_queues(dev);
6235 6236 6237 6238 6239 6240 6241 6242 6243 6244 6245 6246 6247 6248 6249 6250

	napi_enable(&card->napi);
	local_bh_disable();
	napi_schedule(&card->napi);
	/* kick-start the NAPI softirq: */
	local_bh_enable();
	return 0;
}
EXPORT_SYMBOL_GPL(qeth_open);

int qeth_stop(struct net_device *dev)
{
	struct qeth_card *card = dev->ml_priv;

	QETH_CARD_TEXT(card, 4, "qethstop");
	netif_tx_disable(dev);
6251
	napi_disable(&card->napi);
6252 6253 6254 6255
	return 0;
}
EXPORT_SYMBOL_GPL(qeth_stop);

6256 6257 6258 6259
static int __init qeth_core_init(void)
{
	int rc;

6260
	pr_info("loading core functions\n");
6261 6262 6263

	rc = qeth_register_dbf_views();
	if (rc)
6264
		goto dbf_err;
6265
	qeth_core_root_dev = root_device_register("qeth");
6266
	rc = PTR_ERR_OR_ZERO(qeth_core_root_dev);
6267 6268
	if (rc)
		goto register_err;
6269 6270 6271 6272
	qeth_core_header_cache =
		kmem_cache_create("qeth_hdr", QETH_HDR_CACHE_OBJ_SIZE,
				  roundup_pow_of_two(QETH_HDR_CACHE_OBJ_SIZE),
				  0, NULL);
6273 6274 6275 6276
	if (!qeth_core_header_cache) {
		rc = -ENOMEM;
		goto slab_err;
	}
6277 6278 6279 6280 6281 6282
	qeth_qdio_outbuf_cache = kmem_cache_create("qeth_buf",
			sizeof(struct qeth_qdio_out_buffer), 0, 0, NULL);
	if (!qeth_qdio_outbuf_cache) {
		rc = -ENOMEM;
		goto cqslab_err;
	}
6283 6284 6285 6286 6287 6288
	rc = ccw_driver_register(&qeth_ccw_driver);
	if (rc)
		goto ccw_err;
	rc = ccwgroup_driver_register(&qeth_core_ccwgroup_driver);
	if (rc)
		goto ccwgroup_err;
6289

6290
	return 0;
6291 6292 6293 6294 6295

ccwgroup_err:
	ccw_driver_unregister(&qeth_ccw_driver);
ccw_err:
	kmem_cache_destroy(qeth_qdio_outbuf_cache);
6296 6297
cqslab_err:
	kmem_cache_destroy(qeth_core_header_cache);
6298
slab_err:
6299
	root_device_unregister(qeth_core_root_dev);
6300 6301
register_err:
	qeth_unregister_dbf_views();
6302
dbf_err:
6303
	pr_err("Initializing the qeth device driver failed\n");
6304 6305 6306 6307 6308
	return rc;
}

static void __exit qeth_core_exit(void)
{
6309
	qeth_clear_dbf_list();
6310 6311
	ccwgroup_driver_unregister(&qeth_core_ccwgroup_driver);
	ccw_driver_unregister(&qeth_ccw_driver);
6312
	kmem_cache_destroy(qeth_qdio_outbuf_cache);
6313
	kmem_cache_destroy(qeth_core_header_cache);
6314
	root_device_unregister(qeth_core_root_dev);
6315
	qeth_unregister_dbf_views();
6316
	pr_info("core functions removed\n");
6317 6318 6319 6320 6321 6322 6323
}

module_init(qeth_core_init);
module_exit(qeth_core_exit);
MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>");
MODULE_DESCRIPTION("qeth core functions");
MODULE_LICENSE("GPL");
反馈
建议
客服 返回
顶部