sge.c 57.8 KB
Newer Older
1 2 3
/*****************************************************************************
 *                                                                           *
 * File: sge.c                                                               *
S
Scott Bardone 已提交
4 5
 * $Revision: 1.26 $                                                         *
 * $Date: 2005/06/21 18:29:48 $                                              *
6 7 8 9 10 11 12 13 14
 * Description:                                                              *
 *  DMA engine.                                                              *
 *  part of the Chelsio 10Gb Ethernet Driver.                                *
 *                                                                           *
 * This program is free software; you can redistribute it and/or modify      *
 * it under the terms of the GNU General Public License, version 2, as       *
 * published by the Free Software Foundation.                                *
 *                                                                           *
 * You should have received a copy of the GNU General Public License along   *
15
 * with this program; if not, see <http://www.gnu.org/licenses/>.            *
16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43
 *                                                                           *
 * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED    *
 * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF      *
 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.                     *
 *                                                                           *
 * http://www.chelsio.com                                                    *
 *                                                                           *
 * Copyright (c) 2003 - 2005 Chelsio Communications, Inc.                    *
 * All rights reserved.                                                      *
 *                                                                           *
 * Maintainers: maintainers@chelsio.com                                      *
 *                                                                           *
 * Authors: Dimitrios Michailidis   <dm@chelsio.com>                         *
 *          Tina Yang               <tainay@chelsio.com>                     *
 *          Felix Marti             <felix@chelsio.com>                      *
 *          Scott Bardone           <sbardone@chelsio.com>                   *
 *          Kurt Ottaway            <kottaway@chelsio.com>                   *
 *          Frank DiMambro          <frank@chelsio.com>                      *
 *                                                                           *
 * History:                                                                  *
 *                                                                           *
 ****************************************************************************/

#include "common.h"

#include <linux/types.h>
#include <linux/errno.h>
#include <linux/pci.h>
44
#include <linux/ktime.h>
45 46 47 48 49
#include <linux/netdevice.h>
#include <linux/etherdevice.h>
#include <linux/if_vlan.h>
#include <linux/skbuff.h>
#include <linux/mm.h>
50
#include <linux/tcp.h>
51 52 53
#include <linux/ip.h>
#include <linux/in.h>
#include <linux/if_arp.h>
54
#include <linux/slab.h>
55
#include <linux/prefetch.h>
56 57 58 59 60 61

#include "cpl5_cmd.h"
#include "sge.h"
#include "regs.h"
#include "espi.h"

62 63
/* This belongs in if_ether.h */
#define ETH_P_CPL5 0xf
64 65 66

#define SGE_CMDQ_N		2
#define SGE_FREELQ_N		2
S
Scott Bardone 已提交
67
#define SGE_CMDQ0_E_N		1024
68 69 70 71 72
#define SGE_CMDQ1_E_N		128
#define SGE_FREEL_SIZE		4096
#define SGE_JUMBO_FREEL_SIZE	512
#define SGE_FREEL_REFILL_THRESH	16
#define SGE_RESPQ_E_N		1024
S
Scott Bardone 已提交
73
#define SGE_INTRTIMER_NRES	1000
74
#define SGE_RX_SM_BUF_SIZE	1536
75
#define SGE_TX_DESC_MAX_PLEN	16384
76

S
Scott Bardone 已提交
77 78 79 80 81 82 83
#define SGE_RESPQ_REPLENISH_THRES (SGE_RESPQ_E_N / 4)

/*
 * Period of the TX buffer reclaim timer.  This timer does not need to run
 * frequently as TX buffers are usually reclaimed by new TX packets.
 */
#define TX_RECLAIM_PERIOD (HZ / 4)
84

S
Scott Bardone 已提交
85 86 87 88 89 90 91 92 93
#define M_CMD_LEN       0x7fffffff
#define V_CMD_LEN(v)    (v)
#define G_CMD_LEN(v)    ((v) & M_CMD_LEN)
#define V_CMD_GEN1(v)   ((v) << 31)
#define V_CMD_GEN2(v)   (v)
#define F_CMD_DATAVALID (1 << 1)
#define F_CMD_SOP       (1 << 2)
#define V_CMD_EOP(v)    ((v) << 3)

94
/*
S
Scott Bardone 已提交
95
 * Command queue, receive buffer list, and response queue descriptors.
96 97 98
 */
#if defined(__BIG_ENDIAN_BITFIELD)
struct cmdQ_e {
S
Scott Bardone 已提交
99 100 101 102
	u32 addr_lo;
	u32 len_gen;
	u32 flags;
	u32 addr_hi;
103 104 105
};

struct freelQ_e {
S
Scott Bardone 已提交
106 107 108 109
	u32 addr_lo;
	u32 len_gen;
	u32 gen2;
	u32 addr_hi;
110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128
};

struct respQ_e {
	u32 Qsleeping		: 4;
	u32 Cmdq1CreditReturn	: 5;
	u32 Cmdq1DmaComplete	: 5;
	u32 Cmdq0CreditReturn	: 5;
	u32 Cmdq0DmaComplete	: 5;
	u32 FreelistQid		: 2;
	u32 CreditValid		: 1;
	u32 DataValid		: 1;
	u32 Offload		: 1;
	u32 Eop			: 1;
	u32 Sop			: 1;
	u32 GenerationBit	: 1;
	u32 BufferLength;
};
#elif defined(__LITTLE_ENDIAN_BITFIELD)
struct cmdQ_e {
S
Scott Bardone 已提交
129 130 131 132
	u32 len_gen;
	u32 addr_lo;
	u32 addr_hi;
	u32 flags;
133 134 135
};

struct freelQ_e {
S
Scott Bardone 已提交
136 137 138 139
	u32 len_gen;
	u32 addr_lo;
	u32 addr_hi;
	u32 gen2;
140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163
};

struct respQ_e {
	u32 BufferLength;
	u32 GenerationBit	: 1;
	u32 Sop			: 1;
	u32 Eop			: 1;
	u32 Offload		: 1;
	u32 DataValid		: 1;
	u32 CreditValid		: 1;
	u32 FreelistQid		: 2;
	u32 Cmdq0DmaComplete	: 5;
	u32 Cmdq0CreditReturn	: 5;
	u32 Cmdq1DmaComplete	: 5;
	u32 Cmdq1CreditReturn	: 5;
	u32 Qsleeping		: 4;
} ;
#endif

/*
 * SW Context Command and Freelist Queue Descriptors
 */
struct cmdQ_ce {
	struct sk_buff *skb;
164 165
	DEFINE_DMA_UNMAP_ADDR(dma_addr);
	DEFINE_DMA_UNMAP_LEN(dma_len);
166 167 168 169
};

struct freelQ_ce {
	struct sk_buff *skb;
170 171
	DEFINE_DMA_UNMAP_ADDR(dma_addr);
	DEFINE_DMA_UNMAP_LEN(dma_len);
172 173 174
};

/*
S
Scott Bardone 已提交
175
 * SW command, freelist and response rings
176 177
 */
struct cmdQ {
S
Scott Bardone 已提交
178 179 180
	unsigned long   status;         /* HW DMA fetch status */
	unsigned int    in_use;         /* # of in-use command descriptors */
	unsigned int	size;	        /* # of descriptors */
181 182 183
	unsigned int    processed;      /* total # of descs HW has processed */
	unsigned int    cleaned;        /* total # of descs SW has reclaimed */
	unsigned int    stop_thres;     /* SW TX queue suspend threshold */
S
Scott Bardone 已提交
184 185 186
	u16		pidx;           /* producer index (SW) */
	u16		cidx;           /* consumer index (HW) */
	u8		genbit;         /* current generation (=valid) bit */
187
	u8              sop;            /* is next entry start of packet? */
S
Scott Bardone 已提交
188 189 190
	struct cmdQ_e  *entries;        /* HW command descriptor Q */
	struct cmdQ_ce *centries;       /* SW command context descriptor Q */
	dma_addr_t	dma_addr;       /* DMA addr HW command descriptor Q */
191
	spinlock_t	lock;           /* Lock to protect cmdQ enqueuing */
192 193 194
};

struct freelQ {
S
Scott Bardone 已提交
195 196 197 198
	unsigned int	credits;        /* # of available RX buffers */
	unsigned int	size;	        /* free list capacity */
	u16		pidx;           /* producer index (SW) */
	u16		cidx;           /* consumer index (HW) */
199
	u16		rx_buffer_size; /* Buffer size on this free list */
200 201
	u16             dma_offset;     /* DMA offset to align IP headers */
	u16             recycleq_idx;   /* skb recycle q to use */
S
Scott Bardone 已提交
202 203 204 205
	u8		genbit;	        /* current generation (=valid) bit */
	struct freelQ_e	*entries;       /* HW freelist descriptor Q */
	struct freelQ_ce *centries;     /* SW freelist context descriptor Q */
	dma_addr_t	dma_addr;       /* DMA addr HW freelist descriptor Q */
206 207 208
};

struct respQ {
S
Scott Bardone 已提交
209 210 211 212
	unsigned int	credits;        /* credits to be returned to SGE */
	unsigned int	size;	        /* # of response Q descriptors */
	u16		cidx;	        /* consumer index (SW) */
	u8		genbit;	        /* current generation(=valid) bit */
213
	struct respQ_e *entries;        /* HW response descriptor Q */
S
Scott Bardone 已提交
214 215 216 217 218 219 220
	dma_addr_t	dma_addr;       /* DMA addr HW response descriptor Q */
};

/* Bit flags for cmdQ.status */
enum {
	CMDQ_STAT_RUNNING = 1,          /* fetch engine is running */
	CMDQ_STAT_LAST_PKT_DB = 2       /* last packet rung the doorbell */
221 222
};

223 224 225 226 227 228 229 230 231 232 233 234 235 236
/* T204 TX SW scheduler */

/* Per T204 TX port */
struct sched_port {
	unsigned int	avail;		/* available bits - quota */
	unsigned int	drain_bits_per_1024ns; /* drain rate */
	unsigned int	speed;		/* drain rate, mbps */
	unsigned int	mtu;		/* mtu size */
	struct sk_buff_head skbq;	/* pending skbs */
};

/* Per T204 device */
struct sched {
	ktime_t         last_updated;   /* last time quotas were computed */
237 238 239
	unsigned int	max_avail;	/* max bits to be sent to any port */
	unsigned int	port;		/* port index (round robin ports) */
	unsigned int	num;		/* num skbs in per port queues */
240 241 242 243 244 245
	struct sched_port p[MAX_NPORTS];
	struct tasklet_struct sched_tsk;/* tasklet used to run scheduler */
};
static void restart_sched(unsigned long);


246 247 248 249 250
/*
 * Main SGE data structure
 *
 * Interrupts are handled by a single CPU and it is likely that on a MP system
 * the application is migrated to another CPU. In that scenario, we try to
D
Daniel Mack 已提交
251
 * separate the RX(in irq context) and TX state in order to decrease memory
252 253 254
 * contention.
 */
struct sge {
255
	struct adapter *adapter;	/* adapter backpointer */
S
Scott Bardone 已提交
256
	struct net_device *netdev;      /* netdevice backpointer */
257 258
	struct freelQ	freelQ[SGE_FREELQ_N]; /* buffer free lists */
	struct respQ	respQ;		/* response Q */
S
Scott Bardone 已提交
259
	unsigned long   stopped_tx_queues; /* bitmap of suspended Tx queues */
260 261
	unsigned int	rx_pkt_pad;     /* RX padding for L2 packets */
	unsigned int	jumbo_fl;       /* jumbo freelist Q index */
S
Scott Bardone 已提交
262
	unsigned int	intrtimer_nres;	/* no-resource interrupt timer */
263
	unsigned int    fixed_intrtimer;/* non-adaptive interrupt timer */
S
Scott Bardone 已提交
264 265
	struct timer_list tx_reclaim_timer; /* reclaims TX buffers */
	struct timer_list espibug_timer;
266 267
	unsigned long	espibug_timeout;
	struct sk_buff	*espibug_skb[MAX_NPORTS];
S
Scott Bardone 已提交
268 269
	u32		sge_control;	/* shadow value of sge control reg */
	struct sge_intr_counts stats;
270
	struct sge_port_stats __percpu *port_stats[MAX_NPORTS];
271
	struct sched	*tx_sched;
S
Scott Bardone 已提交
272
	struct cmdQ cmdQ[SGE_CMDQ_N] ____cacheline_aligned_in_smp;
273 274
};

J
Joe Perches 已提交
275 276 277 278
static const u8 ch_mac_addr[ETH_ALEN] = {
	0x0, 0x7, 0x43, 0x0, 0x0, 0x0
};

279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303
/*
 * stop tasklet and free all pending skb's
 */
static void tx_sched_stop(struct sge *sge)
{
	struct sched *s = sge->tx_sched;
	int i;

	tasklet_kill(&s->sched_tsk);

	for (i = 0; i < MAX_NPORTS; i++)
		__skb_queue_purge(&s->p[s->port].skbq);
}

/*
 * t1_sched_update_parms() is called when the MTU or link speed changes. It
 * re-computes scheduler parameters to scope with the change.
 */
unsigned int t1_sched_update_parms(struct sge *sge, unsigned int port,
				   unsigned int mtu, unsigned int speed)
{
	struct sched *s = sge->tx_sched;
	struct sched_port *p = &s->p[port];
	unsigned int max_avail_segs;

304
	pr_debug("%s mtu=%d speed=%d\n", __func__, mtu, speed);
305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336
	if (speed)
		p->speed = speed;
	if (mtu)
		p->mtu = mtu;

	if (speed || mtu) {
		unsigned long long drain = 1024ULL * p->speed * (p->mtu - 40);
		do_div(drain, (p->mtu + 50) * 1000);
		p->drain_bits_per_1024ns = (unsigned int) drain;

		if (p->speed < 1000)
			p->drain_bits_per_1024ns =
				90 * p->drain_bits_per_1024ns / 100;
	}

	if (board_info(sge->adapter)->board == CHBT_BOARD_CHT204) {
		p->drain_bits_per_1024ns -= 16;
		s->max_avail = max(4096U, p->mtu + 16 + 14 + 4);
		max_avail_segs = max(1U, 4096 / (p->mtu - 40));
	} else {
		s->max_avail = 16384;
		max_avail_segs = max(1U, 9000 / (p->mtu - 40));
	}

	pr_debug("t1_sched_update_parms: mtu %u speed %u max_avail %u "
		 "max_avail_segs %u drain_bits_per_1024ns %u\n", p->mtu,
		 p->speed, s->max_avail, max_avail_segs,
		 p->drain_bits_per_1024ns);

	return max_avail_segs * (p->mtu - 40);
}

337 338
#if 0

339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365
/*
 * t1_sched_max_avail_bytes() tells the scheduler the maximum amount of
 * data that can be pushed per port.
 */
void t1_sched_set_max_avail_bytes(struct sge *sge, unsigned int val)
{
	struct sched *s = sge->tx_sched;
	unsigned int i;

	s->max_avail = val;
	for (i = 0; i < MAX_NPORTS; i++)
		t1_sched_update_parms(sge, i, 0, 0);
}

/*
 * t1_sched_set_drain_bits_per_us() tells the scheduler at which rate a port
 * is draining.
 */
void t1_sched_set_drain_bits_per_us(struct sge *sge, unsigned int port,
					 unsigned int val)
{
	struct sched *s = sge->tx_sched;
	struct sched_port *p = &s->p[port];
	p->drain_bits_per_1024ns = val * 1024 / 1000;
	t1_sched_update_parms(sge, port, 0, 0);
}

366 367
#endif  /*  0  */

368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399
/*
 * tx_sched_init() allocates resources and does basic initialization.
 */
static int tx_sched_init(struct sge *sge)
{
	struct sched *s;
	int i;

	s = kzalloc(sizeof (struct sched), GFP_KERNEL);
	if (!s)
		return -ENOMEM;

	pr_debug("tx_sched_init\n");
	tasklet_init(&s->sched_tsk, restart_sched, (unsigned long) sge);
	sge->tx_sched = s;

	for (i = 0; i < MAX_NPORTS; i++) {
		skb_queue_head_init(&s->p[i].skbq);
		t1_sched_update_parms(sge, i, 1500, 1000);
	}

	return 0;
}

/*
 * sched_update_avail() computes the delta since the last time it was called
 * and updates the per port quota (number of bits that can be sent to the any
 * port).
 */
static inline int sched_update_avail(struct sge *sge)
{
	struct sched *s = sge->tx_sched;
400
	ktime_t now = ktime_get();
401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451
	unsigned int i;
	long long delta_time_ns;

	delta_time_ns = ktime_to_ns(ktime_sub(now, s->last_updated));

	pr_debug("sched_update_avail delta=%lld\n", delta_time_ns);
	if (delta_time_ns < 15000)
		return 0;

	for (i = 0; i < MAX_NPORTS; i++) {
		struct sched_port *p = &s->p[i];
		unsigned int delta_avail;

		delta_avail = (p->drain_bits_per_1024ns * delta_time_ns) >> 13;
		p->avail = min(p->avail + delta_avail, s->max_avail);
	}

	s->last_updated = now;

	return 1;
}

/*
 * sched_skb() is called from two different places. In the tx path, any
 * packet generating load on an output port will call sched_skb()
 * (skb != NULL). In addition, sched_skb() is called from the irq/soft irq
 * context (skb == NULL).
 * The scheduler only returns a skb (which will then be sent) if the
 * length of the skb is <= the current quota of the output port.
 */
static struct sk_buff *sched_skb(struct sge *sge, struct sk_buff *skb,
				unsigned int credits)
{
	struct sched *s = sge->tx_sched;
	struct sk_buff_head *skbq;
	unsigned int i, len, update = 1;

	pr_debug("sched_skb %p\n", skb);
	if (!skb) {
		if (!s->num)
			return NULL;
	} else {
		skbq = &s->p[skb->dev->if_port].skbq;
		__skb_queue_tail(skbq, skb);
		s->num++;
		skb = NULL;
	}

	if (credits < MAX_SKB_FRAGS + 1)
		goto out;

452
again:
453
	for (i = 0; i < MAX_NPORTS; i++) {
D
David S. Miller 已提交
454
		s->port = (s->port + 1) & (MAX_NPORTS - 1);
455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474
		skbq = &s->p[s->port].skbq;

		skb = skb_peek(skbq);

		if (!skb)
			continue;

		len = skb->len;
		if (len <= s->p[s->port].avail) {
			s->p[s->port].avail -= len;
			s->num--;
			__skb_unlink(skb, skbq);
			goto out;
		}
		skb = NULL;
	}

	if (update-- && sched_update_avail(sge))
		goto again;

475 476
out:
	/* If there are more pending skbs, we use the hardware to schedule us
477 478 479 480 481 482 483 484 485 486 487 488 489 490 491
	 * again.
	 */
	if (s->num && !skb) {
		struct cmdQ *q = &sge->cmdQ[0];
		clear_bit(CMDQ_STAT_LAST_PKT_DB, &q->status);
		if (test_and_set_bit(CMDQ_STAT_RUNNING, &q->status) == 0) {
			set_bit(CMDQ_STAT_LAST_PKT_DB, &q->status);
			writel(F_CMDQ0_ENABLE, sge->adapter->regs + A_SG_DOORBELL);
		}
	}
	pr_debug("sched_skb ret %p\n", skb);

	return skb;
}

492 493 494
/*
 * PIO to indicate that memory mapped Q contains valid descriptor(s).
 */
S
Scott Bardone 已提交
495
static inline void doorbell_pio(struct adapter *adapter, u32 val)
496 497
{
	wmb();
S
Scott Bardone 已提交
498
	writel(val, adapter->regs + A_SG_DOORBELL);
499 500 501 502 503 504
}

/*
 * Frees all RX buffers on the freelist Q. The caller must make sure that
 * the SGE is turned off before calling this function.
 */
S
Scott Bardone 已提交
505
static void free_freelQ_buffers(struct pci_dev *pdev, struct freelQ *q)
506
{
S
Scott Bardone 已提交
507
	unsigned int cidx = q->cidx;
508

S
Scott Bardone 已提交
509 510
	while (q->credits--) {
		struct freelQ_ce *ce = &q->centries[cidx];
511

512 513
		pci_unmap_single(pdev, dma_unmap_addr(ce, dma_addr),
				 dma_unmap_len(ce, dma_len),
514 515 516
				 PCI_DMA_FROMDEVICE);
		dev_kfree_skb(ce->skb);
		ce->skb = NULL;
S
Scott Bardone 已提交
517
		if (++cidx == q->size)
518 519 520 521 522 523 524 525 526 527 528 529 530
			cidx = 0;
	}
}

/*
 * Free RX free list and response queue resources.
 */
static void free_rx_resources(struct sge *sge)
{
	struct pci_dev *pdev = sge->adapter->pdev;
	unsigned int size, i;

	if (sge->respQ.entries) {
S
Scott Bardone 已提交
531
		size = sizeof(struct respQ_e) * sge->respQ.size;
532 533 534 535 536
		pci_free_consistent(pdev, size, sge->respQ.entries,
				    sge->respQ.dma_addr);
	}

	for (i = 0; i < SGE_FREELQ_N; i++) {
S
Scott Bardone 已提交
537
		struct freelQ *q = &sge->freelQ[i];
538

S
Scott Bardone 已提交
539 540 541
		if (q->centries) {
			free_freelQ_buffers(pdev, q);
			kfree(q->centries);
542
		}
S
Scott Bardone 已提交
543 544 545 546
		if (q->entries) {
			size = sizeof(struct freelQ_e) * q->size;
			pci_free_consistent(pdev, size, q->entries,
					    q->dma_addr);
547 548 549 550 551 552
		}
	}
}

/*
 * Allocates basic RX resources, consisting of memory mapped freelist Qs and a
S
Scott Bardone 已提交
553
 * response queue.
554 555 556 557 558 559 560
 */
static int alloc_rx_resources(struct sge *sge, struct sge_params *p)
{
	struct pci_dev *pdev = sge->adapter->pdev;
	unsigned int size, i;

	for (i = 0; i < SGE_FREELQ_N; i++) {
S
Scott Bardone 已提交
561 562 563 564 565 566
		struct freelQ *q = &sge->freelQ[i];

		q->genbit = 1;
		q->size = p->freelQ_size[i];
		q->dma_offset = sge->rx_pkt_pad ? 0 : NET_IP_ALIGN;
		size = sizeof(struct freelQ_e) * q->size;
F
Francois Romieu 已提交
567
		q->entries = pci_alloc_consistent(pdev, size, &q->dma_addr);
S
Scott Bardone 已提交
568
		if (!q->entries)
569
			goto err_no_mem;
F
Francois Romieu 已提交
570

S
Scott Bardone 已提交
571
		size = sizeof(struct freelQ_ce) * q->size;
S
Stephen Hemminger 已提交
572
		q->centries = kzalloc(size, GFP_KERNEL);
S
Scott Bardone 已提交
573
		if (!q->centries)
574 575 576 577 578 579 580 581 582 583 584 585 586
			goto err_no_mem;
	}

	/*
	 * Calculate the buffer sizes for the two free lists.  FL0 accommodates
	 * regular sized Ethernet frames, FL1 is sized not to exceed 16K,
	 * including all the sk_buff overhead.
	 *
	 * Note: For T2 FL0 and FL1 are reversed.
	 */
	sge->freelQ[!sge->jumbo_fl].rx_buffer_size = SGE_RX_SM_BUF_SIZE +
		sizeof(struct cpl_rx_data) +
		sge->freelQ[!sge->jumbo_fl].dma_offset;
587 588 589 590 591

		size = (16 * 1024) -
		    SKB_DATA_ALIGN(sizeof(struct skb_shared_info));

	sge->freelQ[sge->jumbo_fl].rx_buffer_size = size;
592

S
Scott Bardone 已提交
593 594 595 596 597 598 599
	/*
	 * Setup which skb recycle Q should be used when recycling buffers from
	 * each free list.
	 */
	sge->freelQ[!sge->jumbo_fl].recycleq_idx = 0;
	sge->freelQ[sge->jumbo_fl].recycleq_idx = 1;

600
	sge->respQ.genbit = 1;
S
Scott Bardone 已提交
601 602 603
	sge->respQ.size = SGE_RESPQ_E_N;
	sge->respQ.credits = 0;
	size = sizeof(struct respQ_e) * sge->respQ.size;
F
Francois Romieu 已提交
604
	sge->respQ.entries =
605 606 607 608 609 610 611 612 613 614 615
		pci_alloc_consistent(pdev, size, &sge->respQ.dma_addr);
	if (!sge->respQ.entries)
		goto err_no_mem;
	return 0;

err_no_mem:
	free_rx_resources(sge);
	return -ENOMEM;
}

/*
S
Scott Bardone 已提交
616
 * Reclaims n TX descriptors and frees the buffers associated with them.
617
 */
S
Scott Bardone 已提交
618
static void free_cmdQ_buffers(struct sge *sge, struct cmdQ *q, unsigned int n)
619
{
S
Scott Bardone 已提交
620
	struct cmdQ_ce *ce;
621
	struct pci_dev *pdev = sge->adapter->pdev;
S
Scott Bardone 已提交
622
	unsigned int cidx = q->cidx;
623

S
Scott Bardone 已提交
624 625 626
	q->in_use -= n;
	ce = &q->centries[cidx];
	while (n--) {
627 628 629
		if (likely(dma_unmap_len(ce, dma_len))) {
			pci_unmap_single(pdev, dma_unmap_addr(ce, dma_addr),
					 dma_unmap_len(ce, dma_len),
F
Francois Romieu 已提交
630 631
					 PCI_DMA_TODEVICE);
			if (q->sop)
632 633
				q->sop = 0;
		}
S
Scott Bardone 已提交
634
		if (ce->skb) {
635
			dev_kfree_skb_any(ce->skb);
S
Scott Bardone 已提交
636 637
			q->sop = 1;
		}
638
		ce++;
S
Scott Bardone 已提交
639
		if (++cidx == q->size) {
640
			cidx = 0;
S
Scott Bardone 已提交
641
			ce = q->centries;
642 643
		}
	}
S
Scott Bardone 已提交
644
	q->cidx = cidx;
645 646 647 648 649 650 651 652 653 654 655 656 657
}

/*
 * Free TX resources.
 *
 * Assumes that SGE is stopped and all interrupts are disabled.
 */
static void free_tx_resources(struct sge *sge)
{
	struct pci_dev *pdev = sge->adapter->pdev;
	unsigned int size, i;

	for (i = 0; i < SGE_CMDQ_N; i++) {
S
Scott Bardone 已提交
658
		struct cmdQ *q = &sge->cmdQ[i];
659

S
Scott Bardone 已提交
660 661 662 663
		if (q->centries) {
			if (q->in_use)
				free_cmdQ_buffers(sge, q, q->in_use);
			kfree(q->centries);
664
		}
S
Scott Bardone 已提交
665 666 667 668
		if (q->entries) {
			size = sizeof(struct cmdQ_e) * q->size;
			pci_free_consistent(pdev, size, q->entries,
					    q->dma_addr);
669 670 671 672 673 674 675 676 677 678 679 680 681
		}
	}
}

/*
 * Allocates basic TX resources, consisting of memory mapped command Qs.
 */
static int alloc_tx_resources(struct sge *sge, struct sge_params *p)
{
	struct pci_dev *pdev = sge->adapter->pdev;
	unsigned int size, i;

	for (i = 0; i < SGE_CMDQ_N; i++) {
S
Scott Bardone 已提交
682 683 684 685 686 687 688 689 690 691 692
		struct cmdQ *q = &sge->cmdQ[i];

		q->genbit = 1;
		q->sop = 1;
		q->size = p->cmdQ_size[i];
		q->in_use = 0;
		q->status = 0;
		q->processed = q->cleaned = 0;
		q->stop_thres = 0;
		spin_lock_init(&q->lock);
		size = sizeof(struct cmdQ_e) * q->size;
F
Francois Romieu 已提交
693
		q->entries = pci_alloc_consistent(pdev, size, &q->dma_addr);
S
Scott Bardone 已提交
694
		if (!q->entries)
695
			goto err_no_mem;
F
Francois Romieu 已提交
696

S
Scott Bardone 已提交
697
		size = sizeof(struct cmdQ_ce) * q->size;
S
Stephen Hemminger 已提交
698
		q->centries = kzalloc(size, GFP_KERNEL);
S
Scott Bardone 已提交
699
		if (!q->centries)
700 701 702
			goto err_no_mem;
	}

S
Scott Bardone 已提交
703 704 705 706 707 708 709 710 711
	/*
	 * CommandQ 0 handles Ethernet and TOE packets, while queue 1 is TOE
	 * only.  For queue 0 set the stop threshold so we can handle one more
	 * packet from each port, plus reserve an additional 24 entries for
	 * Ethernet packets only.  Queue 1 never suspends nor do we reserve
	 * space for Ethernet packets.
	 */
	sge->cmdQ[0].stop_thres = sge->adapter->params.nports *
		(MAX_SKB_FRAGS + 1);
712 713 714 715 716 717 718 719 720 721 722
	return 0;

err_no_mem:
	free_tx_resources(sge);
	return -ENOMEM;
}

static inline void setup_ring_params(struct adapter *adapter, u64 addr,
				     u32 size, int base_reg_lo,
				     int base_reg_hi, int size_reg)
{
S
Scott Bardone 已提交
723 724 725
	writel((u32)addr, adapter->regs + base_reg_lo);
	writel(addr >> 32, adapter->regs + base_reg_hi);
	writel(size, adapter->regs + size_reg);
726 727 728 729 730
}

/*
 * Enable/disable VLAN acceleration.
 */
731
void t1_vlan_mode(struct adapter *adapter, netdev_features_t features)
732 733 734
{
	struct sge *sge = adapter->sge;

735
	if (features & NETIF_F_HW_VLAN_CTAG_RX)
736
		sge->sge_control |= F_VLAN_XTRACT;
J
Jiri Pirko 已提交
737 738
	else
		sge->sge_control &= ~F_VLAN_XTRACT;
739
	if (adapter->open_device_map) {
S
Scott Bardone 已提交
740
		writel(sge->sge_control, adapter->regs + A_SG_CONTROL);
741
		readl(adapter->regs + A_SG_CONTROL);   /* flush */
742 743 744 745 746 747 748 749 750 751
	}
}

/*
 * Programs the various SGE registers. However, the engine is not yet enabled,
 * but sge->sge_control is setup and ready to go.
 */
static void configure_sge(struct sge *sge, struct sge_params *p)
{
	struct adapter *ap = sge->adapter;
752

S
Scott Bardone 已提交
753 754
	writel(0, ap->regs + A_SG_CONTROL);
	setup_ring_params(ap, sge->cmdQ[0].dma_addr, sge->cmdQ[0].size,
755
			  A_SG_CMD0BASELWR, A_SG_CMD0BASEUPR, A_SG_CMD0SIZE);
S
Scott Bardone 已提交
756
	setup_ring_params(ap, sge->cmdQ[1].dma_addr, sge->cmdQ[1].size,
757 758
			  A_SG_CMD1BASELWR, A_SG_CMD1BASEUPR, A_SG_CMD1SIZE);
	setup_ring_params(ap, sge->freelQ[0].dma_addr,
S
Scott Bardone 已提交
759
			  sge->freelQ[0].size, A_SG_FL0BASELWR,
760 761
			  A_SG_FL0BASEUPR, A_SG_FL0SIZE);
	setup_ring_params(ap, sge->freelQ[1].dma_addr,
S
Scott Bardone 已提交
762
			  sge->freelQ[1].size, A_SG_FL1BASELWR,
763 764 765
			  A_SG_FL1BASEUPR, A_SG_FL1SIZE);

	/* The threshold comparison uses <. */
S
Scott Bardone 已提交
766
	writel(SGE_RX_SM_BUF_SIZE + 1, ap->regs + A_SG_FLTHRESHOLD);
767

S
Scott Bardone 已提交
768 769 770
	setup_ring_params(ap, sge->respQ.dma_addr, sge->respQ.size,
			  A_SG_RSPBASELWR, A_SG_RSPBASEUPR, A_SG_RSPSIZE);
	writel((u32)sge->respQ.size - 1, ap->regs + A_SG_RSPQUEUECREDIT);
771 772 773 774 775 776 777 778 779 780

	sge->sge_control = F_CMDQ0_ENABLE | F_CMDQ1_ENABLE | F_FL0_ENABLE |
		F_FL1_ENABLE | F_CPL_ENABLE | F_RESPONSE_QUEUE_ENABLE |
		V_CMDQ_PRIORITY(2) | F_DISABLE_CMDQ1_GTS | F_ISCSI_COALESCE |
		V_RX_PKT_OFFSET(sge->rx_pkt_pad);

#if defined(__BIG_ENDIAN_BITFIELD)
	sge->sge_control |= F_ENABLE_BIG_ENDIAN;
#endif

S
Scott Bardone 已提交
781 782 783 784
	/* Initialize no-resource timer */
	sge->intrtimer_nres = SGE_INTRTIMER_NRES * core_ticks_per_usec(ap);

	t1_sge_set_coalesce_params(sge, p);
785 786 787 788 789 790 791 792
}

/*
 * Return the payload capacity of the jumbo free-list buffers.
 */
static inline unsigned int jumbo_payload_capacity(const struct sge *sge)
{
	return sge->freelQ[sge->jumbo_fl].rx_buffer_size -
S
Scott Bardone 已提交
793 794
		sge->freelQ[sge->jumbo_fl].dma_offset -
		sizeof(struct cpl_rx_data);
795 796 797 798 799 800 801
}

/*
 * Frees all SGE related resources and the sge structure itself
 */
void t1_sge_destroy(struct sge *sge)
{
802 803 804 805 806
	int i;

	for_each_port(sge->adapter, i)
		free_percpu(sge->port_stats[i]);

807
	kfree(sge->tx_sched);
808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824
	free_tx_resources(sge);
	free_rx_resources(sge);
	kfree(sge);
}

/*
 * Allocates new RX buffers on the freelist Q (and tracks them on the freelist
 * context Q) until the Q is full or alloc_skb fails.
 *
 * It is possible that the generation bits already match, indicating that the
 * buffer is already valid and nothing needs to be done. This happens when we
 * copied a received buffer into a new sk_buff during the interrupt processing.
 *
 * If the SGE doesn't automatically align packets properly (!sge->rx_pkt_pad),
 * we specify a RX_OFFSET in order to make sure that the IP header is 4B
 * aligned.
 */
S
Scott Bardone 已提交
825
static void refill_free_list(struct sge *sge, struct freelQ *q)
826 827
{
	struct pci_dev *pdev = sge->adapter->pdev;
S
Scott Bardone 已提交
828 829 830
	struct freelQ_ce *ce = &q->centries[q->pidx];
	struct freelQ_e *e = &q->entries[q->pidx];
	unsigned int dma_len = q->rx_buffer_size - q->dma_offset;
831

S
Scott Bardone 已提交
832 833 834
	while (q->credits < q->size) {
		struct sk_buff *skb;
		dma_addr_t mapping;
835

E
Eric Dumazet 已提交
836
		skb = dev_alloc_skb(q->rx_buffer_size);
S
Scott Bardone 已提交
837 838 839 840 841 842
		if (!skb)
			break;

		skb_reserve(skb, q->dma_offset);
		mapping = pci_map_single(pdev, skb->data, dma_len,
					 PCI_DMA_FROMDEVICE);
S
Stephen Hemminger 已提交
843 844
		skb_reserve(skb, sge->rx_pkt_pad);

S
Scott Bardone 已提交
845
		ce->skb = skb;
846 847
		dma_unmap_addr_set(ce, dma_addr, mapping);
		dma_unmap_len_set(ce, dma_len, dma_len);
S
Scott Bardone 已提交
848 849 850 851 852
		e->addr_lo = (u32)mapping;
		e->addr_hi = (u64)mapping >> 32;
		e->len_gen = V_CMD_LEN(dma_len) | V_CMD_GEN1(q->genbit);
		wmb();
		e->gen2 = V_CMD_GEN2(q->genbit);
853 854 855

		e++;
		ce++;
S
Scott Bardone 已提交
856 857 858 859 860
		if (++q->pidx == q->size) {
			q->pidx = 0;
			q->genbit ^= 1;
			ce = q->centries;
			e = q->entries;
861
		}
S
Scott Bardone 已提交
862
		q->credits++;
863 864 865 866
	}
}

/*
S
Scott Bardone 已提交
867 868 869
 * Calls refill_free_list for both free lists. If we cannot fill at least 1/4
 * of both rings, we go into 'few interrupt mode' in order to give the system
 * time to free up resources.
870 871 872
 */
static void freelQs_empty(struct sge *sge)
{
S
Scott Bardone 已提交
873 874
	struct adapter *adapter = sge->adapter;
	u32 irq_reg = readl(adapter->regs + A_SG_INT_ENABLE);
875 876 877 878 879
	u32 irqholdoff_reg;

	refill_free_list(sge, &sge->freelQ[0]);
	refill_free_list(sge, &sge->freelQ[1]);

S
Scott Bardone 已提交
880 881
	if (sge->freelQ[0].credits > (sge->freelQ[0].size >> 2) &&
	    sge->freelQ[1].credits > (sge->freelQ[1].size >> 2)) {
882
		irq_reg |= F_FL_EXHAUSTED;
S
Scott Bardone 已提交
883
		irqholdoff_reg = sge->fixed_intrtimer;
884 885 886 887 888
	} else {
		/* Clear the F_FL_EXHAUSTED interrupts for now */
		irq_reg &= ~F_FL_EXHAUSTED;
		irqholdoff_reg = sge->intrtimer_nres;
	}
S
Scott Bardone 已提交
889 890
	writel(irqholdoff_reg, adapter->regs + A_SG_INTRTIMER);
	writel(irq_reg, adapter->regs + A_SG_INT_ENABLE);
891 892

	/* We reenable the Qs to force a freelist GTS interrupt later */
S
Scott Bardone 已提交
893
	doorbell_pio(adapter, F_FL0_ENABLE | F_FL1_ENABLE);
894 895 896 897 898 899 900 901 902 903 904 905
}

#define SGE_PL_INTR_MASK (F_PL_INTR_SGE_ERR | F_PL_INTR_SGE_DATA)
#define SGE_INT_FATAL (F_RESPQ_OVERFLOW | F_PACKET_TOO_BIG | F_PACKET_MISMATCH)
#define SGE_INT_ENABLE (F_RESPQ_EXHAUSTED | F_RESPQ_OVERFLOW | \
			F_FL_EXHAUSTED | F_PACKET_TOO_BIG | F_PACKET_MISMATCH)

/*
 * Disable SGE Interrupts
 */
void t1_sge_intr_disable(struct sge *sge)
{
S
Scott Bardone 已提交
906
	u32 val = readl(sge->adapter->regs + A_PL_ENABLE);
907

S
Scott Bardone 已提交
908 909
	writel(val & ~SGE_PL_INTR_MASK, sge->adapter->regs + A_PL_ENABLE);
	writel(0, sge->adapter->regs + A_SG_INT_ENABLE);
910 911 912 913 914 915 916 917
}

/*
 * Enable SGE interrupts.
 */
void t1_sge_intr_enable(struct sge *sge)
{
	u32 en = SGE_INT_ENABLE;
S
Scott Bardone 已提交
918
	u32 val = readl(sge->adapter->regs + A_PL_ENABLE);
919

920
	if (sge->adapter->port[0].dev->hw_features & NETIF_F_TSO)
921
		en &= ~F_PACKET_TOO_BIG;
S
Scott Bardone 已提交
922 923
	writel(en, sge->adapter->regs + A_SG_INT_ENABLE);
	writel(val | SGE_PL_INTR_MASK, sge->adapter->regs + A_PL_ENABLE);
924 925 926 927 928 929 930
}

/*
 * Clear SGE interrupts.
 */
void t1_sge_intr_clear(struct sge *sge)
{
S
Scott Bardone 已提交
931 932
	writel(SGE_PL_INTR_MASK, sge->adapter->regs + A_PL_CAUSE);
	writel(0xffffffff, sge->adapter->regs + A_SG_INT_CAUSE);
933 934 935 936 937 938 939 940
}

/*
 * SGE 'Error' interrupt handler
 */
int t1_sge_intr_error_handler(struct sge *sge)
{
	struct adapter *adapter = sge->adapter;
S
Scott Bardone 已提交
941
	u32 cause = readl(adapter->regs + A_SG_INT_CAUSE);
942

943
	if (adapter->port[0].dev->hw_features & NETIF_F_TSO)
944 945
		cause &= ~F_PACKET_TOO_BIG;
	if (cause & F_RESPQ_EXHAUSTED)
S
Scott Bardone 已提交
946
		sge->stats.respQ_empty++;
947
	if (cause & F_RESPQ_OVERFLOW) {
S
Scott Bardone 已提交
948
		sge->stats.respQ_overflow++;
949
		pr_alert("%s: SGE response queue overflow\n",
950 951 952
			 adapter->name);
	}
	if (cause & F_FL_EXHAUSTED) {
S
Scott Bardone 已提交
953
		sge->stats.freelistQ_empty++;
954 955 956
		freelQs_empty(sge);
	}
	if (cause & F_PACKET_TOO_BIG) {
S
Scott Bardone 已提交
957
		sge->stats.pkt_too_big++;
958
		pr_alert("%s: SGE max packet size exceeded\n",
959 960 961
			 adapter->name);
	}
	if (cause & F_PACKET_MISMATCH) {
S
Scott Bardone 已提交
962
		sge->stats.pkt_mismatch++;
963
		pr_alert("%s: SGE packet mismatch\n", adapter->name);
964 965 966 967
	}
	if (cause & SGE_INT_FATAL)
		t1_fatal_err(adapter);

S
Scott Bardone 已提交
968
	writel(cause, adapter->regs + A_SG_INT_CAUSE);
969 970 971
	return 0;
}

972
const struct sge_intr_counts *t1_sge_get_intr_counts(const struct sge *sge)
S
Scott Bardone 已提交
973 974 975 976
{
	return &sge->stats;
}

977 978
void t1_sge_get_port_stats(const struct sge *sge, int port,
			   struct sge_port_stats *ss)
S
Scott Bardone 已提交
979
{
980 981 982 983 984 985 986 987 988
	int cpu;

	memset(ss, 0, sizeof(*ss));
	for_each_possible_cpu(cpu) {
		struct sge_port_stats *st = per_cpu_ptr(sge->port_stats[port], cpu);

		ss->rx_cso_good += st->rx_cso_good;
		ss->tx_cso += st->tx_cso;
		ss->tx_tso += st->tx_tso;
D
Divy Le Ray 已提交
989
		ss->tx_need_hdrroom += st->tx_need_hdrroom;
990 991 992
		ss->vlan_xtract += st->vlan_xtract;
		ss->vlan_insert += st->vlan_insert;
	}
S
Scott Bardone 已提交
993 994 995 996 997 998
}

/**
 *	recycle_fl_buf - recycle a free list buffer
 *	@fl: the free list
 *	@idx: index of buffer to recycle
999
 *
S
Scott Bardone 已提交
1000 1001
 *	Recycles the specified buffer on the given free list by adding it at
 *	the next available slot on the list.
1002
 */
S
Scott Bardone 已提交
1003
static void recycle_fl_buf(struct freelQ *fl, int idx)
1004
{
S
Scott Bardone 已提交
1005 1006
	struct freelQ_e *from = &fl->entries[idx];
	struct freelQ_e *to = &fl->entries[fl->pidx];
1007

S
Scott Bardone 已提交
1008 1009 1010 1011 1012 1013 1014
	fl->centries[fl->pidx] = fl->centries[idx];
	to->addr_lo = from->addr_lo;
	to->addr_hi = from->addr_hi;
	to->len_gen = G_CMD_LEN(from->len_gen) | V_CMD_GEN1(fl->genbit);
	wmb();
	to->gen2 = V_CMD_GEN2(fl->genbit);
	fl->credits++;
1015

S
Scott Bardone 已提交
1016 1017 1018
	if (++fl->pidx == fl->size) {
		fl->pidx = 0;
		fl->genbit ^= 1;
1019
	}
S
Scott Bardone 已提交
1020
}
1021

S
Stephen Hemminger 已提交
1022 1023 1024 1025
static int copybreak __read_mostly = 256;
module_param(copybreak, int, 0);
MODULE_PARM_DESC(copybreak, "Receive copy threshold");

S
Scott Bardone 已提交
1026 1027
/**
 *	get_packet - return the next ingress packet buffer
1028
 *	@adapter: the adapter that received the packet
S
Scott Bardone 已提交
1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039
 *	@fl: the SGE free list holding the packet
 *	@len: the actual packet length, excluding any SGE padding
 *
 *	Get the next packet from a free list and complete setup of the
 *	sk_buff.  If the packet is small we make a copy and recycle the
 *	original buffer, otherwise we use the original buffer itself.  If a
 *	positive drop threshold is supplied packets are dropped and their
 *	buffers recycled if (a) the number of remaining buffers is under the
 *	threshold and the packet is too big to copy, or (b) the packet should
 *	be copied but there is no memory for the copy.
 */
1040
static inline struct sk_buff *get_packet(struct adapter *adapter,
S
Stephen Hemminger 已提交
1041
					 struct freelQ *fl, unsigned int len)
S
Scott Bardone 已提交
1042
{
S
Stephen Hemminger 已提交
1043
	const struct freelQ_ce *ce = &fl->centries[fl->cidx];
1044 1045
	struct pci_dev *pdev = adapter->pdev;
	struct sk_buff *skb;
S
Scott Bardone 已提交
1046

S
Stephen Hemminger 已提交
1047
	if (len < copybreak) {
1048
		skb = napi_alloc_skb(&adapter->napi, len);
S
Stephen Hemminger 已提交
1049 1050 1051 1052 1053
		if (!skb)
			goto use_orig_buf;

		skb_put(skb, len);
		pci_dma_sync_single_for_cpu(pdev,
1054 1055
					    dma_unmap_addr(ce, dma_addr),
					    dma_unmap_len(ce, dma_len),
S
Scott Bardone 已提交
1056
					    PCI_DMA_FROMDEVICE);
1057
		skb_copy_from_linear_data(ce->skb, skb->data, len);
S
Stephen Hemminger 已提交
1058
		pci_dma_sync_single_for_device(pdev,
1059 1060
					       dma_unmap_addr(ce, dma_addr),
					       dma_unmap_len(ce, dma_len),
S
Stephen Hemminger 已提交
1061
					       PCI_DMA_FROMDEVICE);
S
Scott Bardone 已提交
1062 1063
		recycle_fl_buf(fl, fl->cidx);
		return skb;
1064 1065
	}

S
Stephen Hemminger 已提交
1066 1067
use_orig_buf:
	if (fl->credits < 2) {
S
Scott Bardone 已提交
1068 1069 1070
		recycle_fl_buf(fl, fl->cidx);
		return NULL;
	}
1071

1072 1073
	pci_unmap_single(pdev, dma_unmap_addr(ce, dma_addr),
			 dma_unmap_len(ce, dma_len), PCI_DMA_FROMDEVICE);
S
Scott Bardone 已提交
1074
	skb = ce->skb;
S
Stephen Hemminger 已提交
1075 1076
	prefetch(skb->data);

S
Scott Bardone 已提交
1077 1078 1079
	skb_put(skb, len);
	return skb;
}
1080

S
Scott Bardone 已提交
1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094
/**
 *	unexpected_offload - handle an unexpected offload packet
 *	@adapter: the adapter
 *	@fl: the free list that received the packet
 *
 *	Called when we receive an unexpected offload packet (e.g., the TOE
 *	function is disabled or the card is a NIC).  Prints a message and
 *	recycles the buffer.
 */
static void unexpected_offload(struct adapter *adapter, struct freelQ *fl)
{
	struct freelQ_ce *ce = &fl->centries[fl->cidx];
	struct sk_buff *skb = ce->skb;

1095 1096
	pci_dma_sync_single_for_cpu(adapter->pdev, dma_unmap_addr(ce, dma_addr),
			    dma_unmap_len(ce, dma_len), PCI_DMA_FROMDEVICE);
1097
	pr_err("%s: unexpected offload packet, cmd %u\n",
S
Scott Bardone 已提交
1098 1099
	       adapter->name, *skb->data);
	recycle_fl_buf(fl, fl->cidx);
1100 1101
}

1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114
/*
 * T1/T2 SGE limits the maximum DMA size per TX descriptor to
 * SGE_TX_DESC_MAX_PLEN (16KB). If the PAGE_SIZE is larger than 16KB, the
 * stack might send more than SGE_TX_DESC_MAX_PLEN in a contiguous manner.
 * Note that the *_large_page_tx_descs stuff will be optimized out when
 * PAGE_SIZE <= SGE_TX_DESC_MAX_PLEN.
 *
 * compute_large_page_descs() computes how many additional descriptors are
 * required to break down the stack's request.
 */
static inline unsigned int compute_large_page_tx_descs(struct sk_buff *skb)
{
	unsigned int count = 0;
1115

1116 1117
	if (PAGE_SIZE > SGE_TX_DESC_MAX_PLEN) {
		unsigned int nfrags = skb_shinfo(skb)->nr_frags;
E
Eric Dumazet 已提交
1118
		unsigned int i, len = skb_headlen(skb);
1119 1120 1121 1122 1123
		while (len > SGE_TX_DESC_MAX_PLEN) {
			count++;
			len -= SGE_TX_DESC_MAX_PLEN;
		}
		for (i = 0; nfrags--; i++) {
E
Eric Dumazet 已提交
1124 1125
			const skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
			len = skb_frag_size(frag);
1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144
			while (len > SGE_TX_DESC_MAX_PLEN) {
				count++;
				len -= SGE_TX_DESC_MAX_PLEN;
			}
		}
	}
	return count;
}

/*
 * Write a cmdQ entry.
 *
 * Since this function writes the 'flags' field, it must not be used to
 * write the first cmdQ entry.
 */
static inline void write_tx_desc(struct cmdQ_e *e, dma_addr_t mapping,
				 unsigned int len, unsigned int gen,
				 unsigned int eop)
{
1145 1146
	BUG_ON(len > SGE_TX_DESC_MAX_PLEN);

1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176
	e->addr_lo = (u32)mapping;
	e->addr_hi = (u64)mapping >> 32;
	e->len_gen = V_CMD_LEN(len) | V_CMD_GEN1(gen);
	e->flags = F_CMD_DATAVALID | V_CMD_EOP(eop) | V_CMD_GEN2(gen);
}

/*
 * See comment for previous function.
 *
 * write_tx_descs_large_page() writes additional SGE tx descriptors if
 * *desc_len exceeds HW's capability.
 */
static inline unsigned int write_large_page_tx_descs(unsigned int pidx,
						     struct cmdQ_e **e,
						     struct cmdQ_ce **ce,
						     unsigned int *gen,
						     dma_addr_t *desc_mapping,
						     unsigned int *desc_len,
						     unsigned int nfrags,
						     struct cmdQ *q)
{
	if (PAGE_SIZE > SGE_TX_DESC_MAX_PLEN) {
		struct cmdQ_e *e1 = *e;
		struct cmdQ_ce *ce1 = *ce;

		while (*desc_len > SGE_TX_DESC_MAX_PLEN) {
			*desc_len -= SGE_TX_DESC_MAX_PLEN;
			write_tx_desc(e1, *desc_mapping, SGE_TX_DESC_MAX_PLEN,
				      *gen, nfrags == 0 && *desc_len == 0);
			ce1->skb = NULL;
1177
			dma_unmap_len_set(ce1, dma_len, 0);
1178 1179 1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195
			*desc_mapping += SGE_TX_DESC_MAX_PLEN;
			if (*desc_len) {
				ce1++;
				e1++;
				if (++pidx == q->size) {
					pidx = 0;
					*gen ^= 1;
					ce1 = q->centries;
					e1 = q->entries;
				}
			}
		}
		*e = e1;
		*ce = ce1;
	}
	return pidx;
}

1196
/*
S
Scott Bardone 已提交
1197 1198
 * Write the command descriptors to transmit the given skb starting at
 * descriptor pidx with the given generation.
1199
 */
S
Scott Bardone 已提交
1200 1201 1202
static inline void write_tx_descs(struct adapter *adapter, struct sk_buff *skb,
				  unsigned int pidx, unsigned int gen,
				  struct cmdQ *q)
1203
{
1204
	dma_addr_t mapping, desc_mapping;
S
Scott Bardone 已提交
1205 1206
	struct cmdQ_e *e, *e1;
	struct cmdQ_ce *ce;
1207 1208
	unsigned int i, flags, first_desc_len, desc_len,
	    nfrags = skb_shinfo(skb)->nr_frags;
S
Scott Bardone 已提交
1209

1210
	e = e1 = &q->entries[pidx];
S
Scott Bardone 已提交
1211
	ce = &q->centries[pidx];
1212 1213

	mapping = pci_map_single(adapter->pdev, skb->data,
E
Eric Dumazet 已提交
1214
				 skb_headlen(skb), PCI_DMA_TODEVICE);
1215 1216

	desc_mapping = mapping;
E
Eric Dumazet 已提交
1217
	desc_len = skb_headlen(skb);
1218 1219 1220 1221 1222 1223 1224 1225 1226 1227

	flags = F_CMD_DATAVALID | F_CMD_SOP |
	    V_CMD_EOP(nfrags == 0 && desc_len <= SGE_TX_DESC_MAX_PLEN) |
	    V_CMD_GEN2(gen);
	first_desc_len = (desc_len <= SGE_TX_DESC_MAX_PLEN) ?
	    desc_len : SGE_TX_DESC_MAX_PLEN;
	e->addr_lo = (u32)desc_mapping;
	e->addr_hi = (u64)desc_mapping >> 32;
	e->len_gen = V_CMD_LEN(first_desc_len) | V_CMD_GEN1(gen);
	ce->skb = NULL;
1228
	dma_unmap_len_set(ce, dma_len, 0);
1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250

	if (PAGE_SIZE > SGE_TX_DESC_MAX_PLEN &&
	    desc_len > SGE_TX_DESC_MAX_PLEN) {
		desc_mapping += first_desc_len;
		desc_len -= first_desc_len;
		e1++;
		ce++;
		if (++pidx == q->size) {
			pidx = 0;
			gen ^= 1;
			e1 = q->entries;
			ce = q->centries;
		}
		pidx = write_large_page_tx_descs(pidx, &e1, &ce, &gen,
						 &desc_mapping, &desc_len,
						 nfrags, q);

		if (likely(desc_len))
			write_tx_desc(e1, desc_mapping, desc_len, gen,
				      nfrags == 0);
	}

S
Scott Bardone 已提交
1251
	ce->skb = NULL;
1252
	dma_unmap_addr_set(ce, dma_addr, mapping);
E
Eric Dumazet 已提交
1253
	dma_unmap_len_set(ce, dma_len, skb_headlen(skb));
1254

1255
	for (i = 0; nfrags--; i++) {
S
Scott Bardone 已提交
1256 1257
		skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
		e1++;
1258
		ce++;
S
Scott Bardone 已提交
1259 1260 1261 1262
		if (++pidx == q->size) {
			pidx = 0;
			gen ^= 1;
			e1 = q->entries;
1263
			ce = q->centries;
1264 1265
		}

1266
		mapping = skb_frag_dma_map(&adapter->pdev->dev, frag, 0,
E
Eric Dumazet 已提交
1267
					   skb_frag_size(frag), DMA_TO_DEVICE);
1268
		desc_mapping = mapping;
E
Eric Dumazet 已提交
1269
		desc_len = skb_frag_size(frag);
1270 1271 1272 1273 1274 1275 1276

		pidx = write_large_page_tx_descs(pidx, &e1, &ce, &gen,
						 &desc_mapping, &desc_len,
						 nfrags, q);
		if (likely(desc_len))
			write_tx_desc(e1, desc_mapping, desc_len, gen,
				      nfrags == 0);
S
Scott Bardone 已提交
1277
		ce->skb = NULL;
1278
		dma_unmap_addr_set(ce, dma_addr, mapping);
E
Eric Dumazet 已提交
1279
		dma_unmap_len_set(ce, dma_len, skb_frag_size(frag));
1280
	}
S
Scott Bardone 已提交
1281 1282 1283 1284
	ce->skb = skb;
	wmb();
	e->flags = flags;
}
1285

S
Scott Bardone 已提交
1286 1287 1288 1289 1290 1291
/*
 * Clean up completed Tx buffers.
 */
static inline void reclaim_completed_tx(struct sge *sge, struct cmdQ *q)
{
	unsigned int reclaim = q->processed - q->cleaned;
1292

S
Scott Bardone 已提交
1293
	if (reclaim) {
1294 1295
		pr_debug("reclaim_completed_tx processed:%d cleaned:%d\n",
			 q->processed, q->cleaned);
S
Scott Bardone 已提交
1296 1297
		free_cmdQ_buffers(sge, q, reclaim);
		q->cleaned += reclaim;
1298
	}
S
Scott Bardone 已提交
1299
}
1300

1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320
/*
 * Called from tasklet. Checks the scheduler for any
 * pending skbs that can be sent.
 */
static void restart_sched(unsigned long arg)
{
	struct sge *sge = (struct sge *) arg;
	struct adapter *adapter = sge->adapter;
	struct cmdQ *q = &sge->cmdQ[0];
	struct sk_buff *skb;
	unsigned int credits, queued_skb = 0;

	spin_lock(&q->lock);
	reclaim_completed_tx(sge, q);

	credits = q->size - q->in_use;
	pr_debug("restart_sched credits=%d\n", credits);
	while ((skb = sched_skb(sge, NULL, credits)) != NULL) {
		unsigned int genbit, pidx, count;
	        count = 1 + skb_shinfo(skb)->nr_frags;
1321
		count += compute_large_page_tx_descs(skb);
1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343
		q->in_use += count;
		genbit = q->genbit;
		pidx = q->pidx;
		q->pidx += count;
		if (q->pidx >= q->size) {
			q->pidx -= q->size;
			q->genbit ^= 1;
		}
		write_tx_descs(adapter, skb, pidx, genbit, q);
	        credits = q->size - q->in_use;
		queued_skb = 1;
	}

	if (queued_skb) {
		clear_bit(CMDQ_STAT_LAST_PKT_DB, &q->status);
		if (test_and_set_bit(CMDQ_STAT_RUNNING, &q->status) == 0) {
			set_bit(CMDQ_STAT_LAST_PKT_DB, &q->status);
			writel(F_CMDQ0_ENABLE, adapter->regs + A_SG_DOORBELL);
		}
	}
	spin_unlock(&q->lock);
}
1344

S
Scott Bardone 已提交
1345 1346 1347 1348 1349
/**
 *	sge_rx - process an ingress ethernet packet
 *	@sge: the sge structure
 *	@fl: the free list that contains the packet buffer
 *	@len: the packet length
1350
 *
S
Scott Bardone 已提交
1351
 *	Process an ingress ethernet pakcet and deliver it to the stack.
1352
 */
S
Stephen Hemminger 已提交
1353
static void sge_rx(struct sge *sge, struct freelQ *fl, unsigned int len)
1354
{
S
Scott Bardone 已提交
1355
	struct sk_buff *skb;
S
Stephen Hemminger 已提交
1356
	const struct cpl_rx_pkt *p;
S
Scott Bardone 已提交
1357
	struct adapter *adapter = sge->adapter;
1358
	struct sge_port_stats *st;
1359
	struct net_device *dev;
1360

1361
	skb = get_packet(adapter, fl, len - sge->rx_pkt_pad);
1362 1363
	if (unlikely(!skb)) {
		sge->stats.rx_drops++;
S
Stephen Hemminger 已提交
1364
		return;
1365
	}
S
Scott Bardone 已提交
1366

S
Stephen Hemminger 已提交
1367
	p = (const struct cpl_rx_pkt *) skb->data;
1368 1369
	if (p->iff >= adapter->params.nports) {
		kfree_skb(skb);
S
Stephen Hemminger 已提交
1370
		return;
1371
	}
S
Stephen Hemminger 已提交
1372
	__skb_pull(skb, sizeof(*p));
1373

1374
	st = this_cpu_ptr(sge->port_stats[p->iff]);
1375
	dev = adapter->port[p->iff].dev;
1376

1377 1378
	skb->protocol = eth_type_trans(skb, dev);
	if ((dev->features & NETIF_F_RXCSUM) && p->csum == 0xffff &&
S
Scott Bardone 已提交
1379 1380
	    skb->protocol == htons(ETH_P_IP) &&
	    (skb->data[9] == IPPROTO_TCP || skb->data[9] == IPPROTO_UDP)) {
1381
		++st->rx_cso_good;
S
Scott Bardone 已提交
1382 1383
		skb->ip_summed = CHECKSUM_UNNECESSARY;
	} else
1384
		skb_checksum_none_assert(skb);
S
Scott Bardone 已提交
1385

J
Jiri Pirko 已提交
1386
	if (p->vlan_valid) {
1387
		st->vlan_xtract++;
1388
		__vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), ntohs(p->vlan));
J
Jiri Pirko 已提交
1389 1390
	}
	netif_receive_skb(skb);
1391 1392 1393
}

/*
S
Scott Bardone 已提交
1394
 * Returns true if a command queue has enough available descriptors that
1395 1396
 * we can resume Tx operation after temporarily disabling its packet queue.
 */
S
Scott Bardone 已提交
1397
static inline int enough_free_Tx_descs(const struct cmdQ *q)
1398
{
S
Scott Bardone 已提交
1399 1400 1401
	unsigned int r = q->processed - q->cleaned;

	return q->in_use - r < (q->size >> 1);
1402 1403 1404
}

/*
S
Scott Bardone 已提交
1405 1406
 * Called when sufficient space has become available in the SGE command queues
 * after the Tx packet schedulers have been suspended to restart the Tx path.
1407
 */
S
Scott Bardone 已提交
1408
static void restart_tx_queues(struct sge *sge)
1409
{
S
Scott Bardone 已提交
1410
	struct adapter *adap = sge->adapter;
F
Francois Romieu 已提交
1411
	int i;
1412

F
Francois Romieu 已提交
1413 1414
	if (!enough_free_Tx_descs(&sge->cmdQ[0]))
		return;
S
Scott Bardone 已提交
1415

F
Francois Romieu 已提交
1416 1417
	for_each_port(adap, i) {
		struct net_device *nd = adap->port[i].dev;
S
Scott Bardone 已提交
1418

F
Francois Romieu 已提交
1419 1420 1421 1422
		if (test_and_clear_bit(nd->if_port, &sge->stopped_tx_queues) &&
		    netif_running(nd)) {
			sge->stats.cmdQ_restarted[2]++;
			netif_wake_queue(nd);
S
Scott Bardone 已提交
1423 1424 1425 1426 1427
		}
	}
}

/*
1428
 * update_tx_info is called from the interrupt handler/NAPI to return cmdQ0
S
Scott Bardone 已提交
1429 1430
 * information.
 */
1431 1432
static unsigned int update_tx_info(struct adapter *adapter,
					  unsigned int flags,
S
Scott Bardone 已提交
1433 1434 1435 1436
					  unsigned int pr0)
{
	struct sge *sge = adapter->sge;
	struct cmdQ *cmdq = &sge->cmdQ[0];
1437

S
Scott Bardone 已提交
1438
	cmdq->processed += pr0;
1439 1440 1441 1442
	if (flags & (F_FL0_ENABLE | F_FL1_ENABLE)) {
		freelQs_empty(sge);
		flags &= ~(F_FL0_ENABLE | F_FL1_ENABLE);
	}
S
Scott Bardone 已提交
1443 1444
	if (flags & F_CMDQ0_ENABLE) {
		clear_bit(CMDQ_STAT_RUNNING, &cmdq->status);
1445

S
Scott Bardone 已提交
1446 1447 1448 1449 1450
		if (cmdq->cleaned + cmdq->in_use != cmdq->processed &&
		    !test_and_set_bit(CMDQ_STAT_LAST_PKT_DB, &cmdq->status)) {
			set_bit(CMDQ_STAT_RUNNING, &cmdq->status);
			writel(F_CMDQ0_ENABLE, adapter->regs + A_SG_DOORBELL);
		}
1451 1452 1453 1454
		if (sge->tx_sched)
			tasklet_hi_schedule(&sge->tx_sched->sched_tsk);

		flags &= ~F_CMDQ0_ENABLE;
S
Scott Bardone 已提交
1455
	}
1456

S
Scott Bardone 已提交
1457 1458
	if (unlikely(sge->stopped_tx_queues != 0))
		restart_tx_queues(sge);
1459

S
Scott Bardone 已提交
1460 1461
	return flags;
}
1462

S
Scott Bardone 已提交
1463 1464 1465 1466 1467 1468 1469 1470 1471
/*
 * Process SGE responses, up to the supplied budget.  Returns the number of
 * responses processed.  A negative budget is effectively unlimited.
 */
static int process_responses(struct adapter *adapter, int budget)
{
	struct sge *sge = adapter->sge;
	struct respQ *q = &sge->respQ;
	struct respQ_e *e = &q->entries[q->cidx];
S
Stephen Hemminger 已提交
1472
	int done = 0;
S
Scott Bardone 已提交
1473 1474
	unsigned int flags = 0;
	unsigned int cmdq_processed[SGE_CMDQ_N] = {0, 0};
1475

S
Stephen Hemminger 已提交
1476
	while (done < budget && e->GenerationBit == q->genbit) {
S
Scott Bardone 已提交
1477
		flags |= e->Qsleeping;
1478

S
Scott Bardone 已提交
1479 1480
		cmdq_processed[0] += e->Cmdq0CreditReturn;
		cmdq_processed[1] += e->Cmdq1CreditReturn;
1481

S
Scott Bardone 已提交
1482 1483 1484 1485
		/* We batch updates to the TX side to avoid cacheline
		 * ping-pong of TX state information on MP where the sender
		 * might run on a different CPU than this function...
		 */
S
Stephen Hemminger 已提交
1486
		if (unlikely((flags & F_CMDQ0_ENABLE) || cmdq_processed[0] > 64)) {
S
Scott Bardone 已提交
1487 1488 1489
			flags = update_tx_info(adapter, flags, cmdq_processed[0]);
			cmdq_processed[0] = 0;
		}
S
Stephen Hemminger 已提交
1490

S
Scott Bardone 已提交
1491 1492 1493
		if (unlikely(cmdq_processed[1] > 16)) {
			sge->cmdQ[1].processed += cmdq_processed[1];
			cmdq_processed[1] = 0;
1494
		}
S
Stephen Hemminger 已提交
1495

1496
		if (likely(e->DataValid)) {
S
Scott Bardone 已提交
1497 1498
			struct freelQ *fl = &sge->freelQ[e->FreelistQid];

1499
			BUG_ON(!e->Sop || !e->Eop);
S
Scott Bardone 已提交
1500 1501 1502 1503 1504
			if (unlikely(e->Offload))
				unexpected_offload(adapter, fl);
			else
				sge_rx(sge, fl, e->BufferLength);

S
Stephen Hemminger 已提交
1505 1506
			++done;

S
Scott Bardone 已提交
1507 1508 1509 1510 1511 1512
			/*
			 * Note: this depends on each packet consuming a
			 * single free-list buffer; cf. the BUG above.
			 */
			if (++fl->cidx == fl->size)
				fl->cidx = 0;
S
Stephen Hemminger 已提交
1513 1514
			prefetch(fl->centries[fl->cidx].skb);

S
Scott Bardone 已提交
1515 1516 1517 1518 1519
			if (unlikely(--fl->credits <
				     fl->size - SGE_FREEL_REFILL_THRESH))
				refill_free_list(sge, fl);
		} else
			sge->stats.pure_rsps++;
1520 1521

		e++;
S
Scott Bardone 已提交
1522 1523 1524 1525 1526 1527 1528 1529 1530 1531
		if (unlikely(++q->cidx == q->size)) {
			q->cidx = 0;
			q->genbit ^= 1;
			e = q->entries;
		}
		prefetch(e);

		if (++q->credits > SGE_RESPQ_REPLENISH_THRES) {
			writel(q->credits, adapter->regs + A_SG_RSPQUEUECREDIT);
			q->credits = 0;
1532 1533 1534
		}
	}

1535
	flags = update_tx_info(adapter, flags, cmdq_processed[0]);
S
Scott Bardone 已提交
1536
	sge->cmdQ[1].processed += cmdq_processed[1];
1537

S
Stephen Hemminger 已提交
1538
	return done;
S
Scott Bardone 已提交
1539
}
1540

1541 1542 1543 1544 1545
static inline int responses_pending(const struct adapter *adapter)
{
	const struct respQ *Q = &adapter->sge->respQ;
	const struct respQ_e *e = &Q->entries[Q->cidx];

1546
	return e->GenerationBit == Q->genbit;
1547 1548
}

S
Scott Bardone 已提交
1549 1550 1551 1552 1553 1554 1555 1556
/*
 * A simpler version of process_responses() that handles only pure (i.e.,
 * non data-carrying) responses.  Such respones are too light-weight to justify
 * calling a softirq when using NAPI, so we handle them specially in hard
 * interrupt context.  The function is called with a pointer to a response,
 * which the caller must ensure is a valid pure response.  Returns 1 if it
 * encounters a valid data-carrying response, 0 otherwise.
 */
1557
static int process_pure_responses(struct adapter *adapter)
S
Scott Bardone 已提交
1558 1559 1560
{
	struct sge *sge = adapter->sge;
	struct respQ *q = &sge->respQ;
1561
	struct respQ_e *e = &q->entries[q->cidx];
S
Stephen Hemminger 已提交
1562
	const struct freelQ *fl = &sge->freelQ[e->FreelistQid];
S
Scott Bardone 已提交
1563 1564
	unsigned int flags = 0;
	unsigned int cmdq_processed[SGE_CMDQ_N] = {0, 0};
1565

S
Stephen Hemminger 已提交
1566
	prefetch(fl->centries[fl->cidx].skb);
1567 1568
	if (e->DataValid)
		return 1;
S
Stephen Hemminger 已提交
1569

S
Scott Bardone 已提交
1570 1571
	do {
		flags |= e->Qsleeping;
1572

S
Scott Bardone 已提交
1573 1574
		cmdq_processed[0] += e->Cmdq0CreditReturn;
		cmdq_processed[1] += e->Cmdq1CreditReturn;
1575

S
Scott Bardone 已提交
1576 1577 1578 1579 1580
		e++;
		if (unlikely(++q->cidx == q->size)) {
			q->cidx = 0;
			q->genbit ^= 1;
			e = q->entries;
1581
		}
S
Scott Bardone 已提交
1582
		prefetch(e);
1583

S
Scott Bardone 已提交
1584 1585 1586
		if (++q->credits > SGE_RESPQ_REPLENISH_THRES) {
			writel(q->credits, adapter->regs + A_SG_RSPQUEUECREDIT);
			q->credits = 0;
1587
		}
S
Scott Bardone 已提交
1588 1589
		sge->stats.pure_rsps++;
	} while (e->GenerationBit == q->genbit && !e->DataValid);
1590

1591
	flags = update_tx_info(adapter, flags, cmdq_processed[0]);
S
Scott Bardone 已提交
1592
	sge->cmdQ[1].processed += cmdq_processed[1];
1593

S
Scott Bardone 已提交
1594
	return e->GenerationBit == q->genbit;
1595 1596 1597
}

/*
S
Scott Bardone 已提交
1598 1599 1600
 * Handler for new data events when using NAPI.  This does not need any locking
 * or protection from interrupts as data interrupts are off at this point and
 * other adapter interrupts do not interfere.
1601
 */
1602
int t1_poll(struct napi_struct *napi, int budget)
1603
{
1604
	struct adapter *adapter = container_of(napi, struct adapter, napi);
D
Divy Le Ray 已提交
1605
	int work_done = process_responses(adapter, budget);
S
Stephen Hemminger 已提交
1606

D
Divy Le Ray 已提交
1607
	if (likely(work_done < budget)) {
1608
		napi_complete(napi);
1609 1610 1611 1612
		writel(adapter->sge->respQ.cidx,
		       adapter->regs + A_SG_SLEEPING);
	}
	return work_done;
S
Scott Bardone 已提交
1613
}
1614

S
Stephen Hemminger 已提交
1615
irqreturn_t t1_interrupt(int irq, void *data)
S
Scott Bardone 已提交
1616 1617 1618
{
	struct adapter *adapter = data;
	struct sge *sge = adapter->sge;
1619
	int handled;
S
Scott Bardone 已提交
1620

1621
	if (likely(responses_pending(adapter))) {
1622
		writel(F_PL_INTR_SGE_DATA, adapter->regs + A_PL_CAUSE);
S
Stephen Hemminger 已提交
1623

1624
		if (napi_schedule_prep(&adapter->napi)) {
1625
			if (process_pure_responses(adapter))
1626
				__napi_schedule(&adapter->napi);
1627 1628 1629
			else {
				/* no data, no NAPI needed */
				writel(sge->respQ.cidx, adapter->regs + A_SG_SLEEPING);
1630 1631
				/* undo schedule_prep */
				napi_enable(&adapter->napi);
S
Stephen Hemminger 已提交
1632 1633
			}
		}
1634 1635 1636 1637 1638 1639
		return IRQ_HANDLED;
	}

	spin_lock(&adapter->async_lock);
	handled = t1_slow_intr_handler(adapter);
	spin_unlock(&adapter->async_lock);
S
Stephen Hemminger 已提交
1640

S
Scott Bardone 已提交
1641 1642
	if (!handled)
		sge->stats.unhandled_irqs++;
1643

S
Scott Bardone 已提交
1644 1645
	return IRQ_RETVAL(handled != 0);
}
1646

S
Scott Bardone 已提交
1647 1648 1649 1650 1651 1652
/*
 * Enqueues the sk_buff onto the cmdQ[qid] and has hardware fetch it.
 *
 * The code figures out how many entries the sk_buff will require in the
 * cmdQ and updates the cmdQ data structure with the state once the enqueue
 * has complete. Then, it doesn't access the global structure anymore, but
L
Lucas De Marchi 已提交
1653
 * uses the corresponding fields on the stack. In conjunction with a spinlock
S
Scott Bardone 已提交
1654 1655 1656 1657 1658 1659
 * around that code, we can make the function reentrant without holding the
 * lock when we actually enqueue (which might be expensive, especially on
 * architectures with IO MMUs).
 *
 * This runs with softirqs disabled.
 */
1660 1661
static int t1_sge_tx(struct sk_buff *skb, struct adapter *adapter,
		     unsigned int qid, struct net_device *dev)
S
Scott Bardone 已提交
1662 1663 1664
{
	struct sge *sge = adapter->sge;
	struct cmdQ *q = &sge->cmdQ[qid];
1665
	unsigned int credits, pidx, genbit, count, use_sched_skb = 0;
S
Scott Bardone 已提交
1666

1667 1668 1669
	if (!spin_trylock(&q->lock))
		return NETDEV_TX_LOCKED;

S
Scott Bardone 已提交
1670 1671 1672 1673 1674
	reclaim_completed_tx(sge, q);

	pidx = q->pidx;
	credits = q->size - q->in_use;
	count = 1 + skb_shinfo(skb)->nr_frags;
1675
	count += compute_large_page_tx_descs(skb);
S
Scott Bardone 已提交
1676

1677 1678 1679
	/* Ethernet packet */
	if (unlikely(credits < count)) {
		if (!netif_queue_stopped(dev)) {
S
Scott Bardone 已提交
1680 1681
			netif_stop_queue(dev);
			set_bit(dev->if_port, &sge->stopped_tx_queues);
1682
			sge->stats.cmdQ_full[2]++;
1683
			pr_err("%s: Tx ring full while queue awake!\n",
1684
			       adapter->name);
1685
		}
1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696 1697 1698 1699
		spin_unlock(&q->lock);
		return NETDEV_TX_BUSY;
	}

	if (unlikely(credits - count < q->stop_thres)) {
		netif_stop_queue(dev);
		set_bit(dev->if_port, &sge->stopped_tx_queues);
		sge->stats.cmdQ_full[2]++;
	}

	/* T204 cmdQ0 skbs that are destined for a certain port have to go
	 * through the scheduler.
	 */
	if (sge->tx_sched && !qid && skb->dev) {
1700
use_sched:
1701 1702 1703 1704 1705 1706 1707 1708
		use_sched_skb = 1;
		/* Note that the scheduler might return a different skb than
		 * the one passed in.
		 */
		skb = sched_skb(sge, skb, credits);
		if (!skb) {
			spin_unlock(&q->lock);
			return NETDEV_TX_OK;
S
Scott Bardone 已提交
1709
		}
1710 1711 1712
		pidx = q->pidx;
		count = 1 + skb_shinfo(skb)->nr_frags;
		count += compute_large_page_tx_descs(skb);
S
Scott Bardone 已提交
1713
	}
1714

S
Scott Bardone 已提交
1715 1716
	q->in_use += count;
	genbit = q->genbit;
1717
	pidx = q->pidx;
S
Scott Bardone 已提交
1718 1719 1720 1721
	q->pidx += count;
	if (q->pidx >= q->size) {
		q->pidx -= q->size;
		q->genbit ^= 1;
1722
	}
S
Scott Bardone 已提交
1723
	spin_unlock(&q->lock);
1724

S
Scott Bardone 已提交
1725
	write_tx_descs(adapter, skb, pidx, genbit, q);
1726 1727 1728 1729 1730 1731 1732 1733

	/*
	 * We always ring the doorbell for cmdQ1.  For cmdQ0, we only ring
	 * the doorbell if the Q is asleep. There is a natural race, where
	 * the hardware is going to sleep just after we checked, however,
	 * then the interrupt handler will detect the outstanding TX packet
	 * and ring the doorbell for us.
	 */
S
Scott Bardone 已提交
1734 1735 1736 1737 1738 1739 1740 1741
	if (qid)
		doorbell_pio(adapter, F_CMDQ1_ENABLE);
	else {
		clear_bit(CMDQ_STAT_LAST_PKT_DB, &q->status);
		if (test_and_set_bit(CMDQ_STAT_RUNNING, &q->status) == 0) {
			set_bit(CMDQ_STAT_LAST_PKT_DB, &q->status);
			writel(F_CMDQ0_ENABLE, adapter->regs + A_SG_DOORBELL);
		}
1742
	}
1743 1744 1745 1746 1747 1748 1749 1750

	if (use_sched_skb) {
		if (spin_trylock(&q->lock)) {
			credits = q->size - q->in_use;
			skb = NULL;
			goto use_sched;
		}
	}
1751
	return NETDEV_TX_OK;
1752 1753 1754 1755
}

#define MK_ETH_TYPE_MSS(type, mss) (((mss) & 0x3FFF) | ((type) << 14))

S
Scott Bardone 已提交
1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768
/*
 *	eth_hdr_len - return the length of an Ethernet header
 *	@data: pointer to the start of the Ethernet header
 *
 *	Returns the length of an Ethernet header, including optional VLAN tag.
 */
static inline int eth_hdr_len(const void *data)
{
	const struct ethhdr *e = data;

	return e->h_proto == htons(ETH_P_8021Q) ? VLAN_ETH_HLEN : ETH_HLEN;
}

1769 1770 1771
/*
 * Adds the CPL header to the sk_buff and passes it to t1_sge_tx.
 */
1772
netdev_tx_t t1_start_xmit(struct sk_buff *skb, struct net_device *dev)
1773
{
1774
	struct adapter *adapter = dev->ml_priv;
S
Scott Bardone 已提交
1775
	struct sge *sge = adapter->sge;
1776
	struct sge_port_stats *st = this_cpu_ptr(sge->port_stats[dev->if_port]);
1777
	struct cpl_tx_pkt *cpl;
1778 1779
	struct sk_buff *orig_skb = skb;
	int ret;
1780

1781 1782 1783
	if (skb->protocol == htons(ETH_P_CPL5))
		goto send;

D
Divy Le Ray 已提交
1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795
	/*
	 * We are using a non-standard hard_header_len.
	 * Allocate more header room in the rare cases it is not big enough.
	 */
	if (unlikely(skb_headroom(skb) < dev->hard_header_len - ETH_HLEN)) {
		skb = skb_realloc_headroom(skb, sizeof(struct cpl_tx_pkt_lso));
		++st->tx_need_hdrroom;
		dev_kfree_skb_any(orig_skb);
		if (!skb)
			return NETDEV_TX_OK;
	}

1796
	if (skb_shinfo(skb)->gso_size) {
1797 1798 1799
		int eth_type;
		struct cpl_tx_pkt_lso *hdr;

1800
		++st->tx_tso;
S
Scott Bardone 已提交
1801

1802
		eth_type = skb_network_offset(skb) == ETH_HLEN ?
1803 1804 1805 1806 1807
			CPL_ETH_II : CPL_ETH_II_VLAN;

		hdr = (struct cpl_tx_pkt_lso *)skb_push(skb, sizeof(*hdr));
		hdr->opcode = CPL_TX_PKT_LSO;
		hdr->ip_csum_dis = hdr->l4_csum_dis = 0;
1808
		hdr->ip_hdr_words = ip_hdr(skb)->ihl;
1809
		hdr->tcp_hdr_words = tcp_hdr(skb)->doff;
1810
		hdr->eth_type_mss = htons(MK_ETH_TYPE_MSS(eth_type,
1811
							  skb_shinfo(skb)->gso_size));
1812 1813
		hdr->len = htonl(skb->len - sizeof(*hdr));
		cpl = (struct cpl_tx_pkt *)hdr;
1814
	} else {
1815
		/*
1816
		 * Packets shorter than ETH_HLEN can break the MAC, drop them
S
Scott Bardone 已提交
1817 1818 1819
		 * early.  Also, we may get oversized packets because some
		 * parts of the kernel don't handle our unusual hard_header_len
		 * right, drop those too.
1820
		 */
S
Scott Bardone 已提交
1821 1822
		if (unlikely(skb->len < ETH_HLEN ||
			     skb->len > dev->mtu + eth_hdr_len(skb->data))) {
1823 1824
			netdev_dbg(dev, "packet size %d hdr %d mtu%d\n",
				   skb->len, eth_hdr_len(skb->data), dev->mtu);
S
Scott Bardone 已提交
1825
			dev_kfree_skb_any(skb);
1826
			return NETDEV_TX_OK;
S
Scott Bardone 已提交
1827 1828
		}

1829
		if (skb->ip_summed == CHECKSUM_PARTIAL &&
1830
		    ip_hdr(skb)->protocol == IPPROTO_UDP) {
1831
			if (unlikely(skb_checksum_help(skb))) {
1832
				netdev_dbg(dev, "unable to do udp checksum\n");
S
Scott Bardone 已提交
1833
				dev_kfree_skb_any(skb);
1834
				return NETDEV_TX_OK;
S
Scott Bardone 已提交
1835
			}
1836
		}
1837

S
Scott Bardone 已提交
1838 1839
		/* Hmmm, assuming to catch the gratious arp... and we'll use
		 * it to flush out stuck espi packets...
1840 1841
		 */
		if ((unlikely(!adapter->sge->espibug_skb[dev->if_port]))) {
1842
			if (skb->protocol == htons(ETH_P_ARP) &&
1843
			    arp_hdr(skb)->ar_op == htons(ARPOP_REQUEST)) {
1844
				adapter->sge->espibug_skb[dev->if_port] = skb;
S
Scott Bardone 已提交
1845 1846 1847 1848 1849 1850
				/* We want to re-use this skb later. We
				 * simply bump the reference count and it
				 * will not be freed...
				 */
				skb = skb_get(skb);
			}
1851
		}
S
Scott Bardone 已提交
1852 1853

		cpl = (struct cpl_tx_pkt *)__skb_push(skb, sizeof(*cpl));
1854 1855
		cpl->opcode = CPL_TX_PKT;
		cpl->ip_csum_dis = 1;    /* SW calculates IP csum */
1856
		cpl->l4_csum_dis = skb->ip_summed == CHECKSUM_PARTIAL ? 0 : 1;
1857
		/* the length field isn't used so don't bother setting it */
S
Scott Bardone 已提交
1858

1859
		st->tx_cso += (skb->ip_summed == CHECKSUM_PARTIAL);
1860 1861 1862
	}
	cpl->iff = dev->if_port;

1863
	if (vlan_tx_tag_present(skb)) {
1864 1865
		cpl->vlan_valid = 1;
		cpl->vlan = htons(vlan_tx_tag_get(skb));
S
Scott Bardone 已提交
1866
		st->vlan_insert++;
1867 1868 1869
	} else
		cpl->vlan_valid = 0;

1870
send:
1871 1872 1873 1874 1875 1876
	ret = t1_sge_tx(skb, adapter, 0, dev);

	/* If transmit busy, and we reallocated skb's due to headroom limit,
	 * then silently discard to avoid leak.
	 */
	if (unlikely(ret != NETDEV_TX_OK && skb != orig_skb)) {
1877
		dev_kfree_skb_any(skb);
1878
		ret = NETDEV_TX_OK;
1879
	}
1880
	return ret;
S
Scott Bardone 已提交
1881
}
1882

S
Scott Bardone 已提交
1883 1884 1885 1886 1887 1888 1889 1890 1891 1892 1893 1894 1895
/*
 * Callback for the Tx buffer reclaim timer.  Runs with softirqs disabled.
 */
static void sge_tx_reclaim_cb(unsigned long data)
{
	int i;
	struct sge *sge = (struct sge *)data;

	for (i = 0; i < SGE_CMDQ_N; ++i) {
		struct cmdQ *q = &sge->cmdQ[i];

		if (!spin_trylock(&q->lock))
			continue;
1896

S
Scott Bardone 已提交
1897
		reclaim_completed_tx(sge, q);
1898 1899 1900
		if (i == 0 && q->in_use) {    /* flush pending credits */
			writel(F_CMDQ0_ENABLE, sge->adapter->regs + A_SG_DOORBELL);
		}
S
Scott Bardone 已提交
1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913
		spin_unlock(&q->lock);
	}
	mod_timer(&sge->tx_reclaim_timer, jiffies + TX_RECLAIM_PERIOD);
}

/*
 * Propagate changes of the SGE coalescing parameters to the HW.
 */
int t1_sge_set_coalesce_params(struct sge *sge, struct sge_params *p)
{
	sge->fixed_intrtimer = p->rx_coalesce_usecs *
		core_ticks_per_usec(sge->adapter);
	writel(sge->fixed_intrtimer, sge->adapter->regs + A_SG_INTRTIMER);
1914 1915 1916
	return 0;
}

S
Scott Bardone 已提交
1917 1918 1919 1920 1921
/*
 * Allocates both RX and TX resources and configures the SGE. However,
 * the hardware is not enabled yet.
 */
int t1_sge_configure(struct sge *sge, struct sge_params *p)
1922
{
S
Scott Bardone 已提交
1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937 1938 1939
	if (alloc_rx_resources(sge, p))
		return -ENOMEM;
	if (alloc_tx_resources(sge, p)) {
		free_rx_resources(sge);
		return -ENOMEM;
	}
	configure_sge(sge, p);

	/*
	 * Now that we have sized the free lists calculate the payload
	 * capacity of the large buffers.  Other parts of the driver use
	 * this to set the max offload coalescing size so that RX packets
	 * do not overflow our large buffers.
	 */
	p->large_buf_capacity = jumbo_payload_capacity(sge);
	return 0;
}
1940

S
Scott Bardone 已提交
1941 1942 1943 1944 1945
/*
 * Disables the DMA engine.
 */
void t1_sge_stop(struct sge *sge)
{
1946
	int i;
S
Scott Bardone 已提交
1947
	writel(0, sge->adapter->regs + A_SG_CONTROL);
1948 1949
	readl(sge->adapter->regs + A_SG_CONTROL); /* flush */

S
Scott Bardone 已提交
1950 1951
	if (is_T2(sge->adapter))
		del_timer_sync(&sge->espibug_timer);
1952

S
Scott Bardone 已提交
1953
	del_timer_sync(&sge->tx_reclaim_timer);
1954 1955 1956 1957
	if (sge->tx_sched)
		tx_sched_stop(sge);

	for (i = 0; i < MAX_NPORTS; i++)
1958
		kfree_skb(sge->espibug_skb[i]);
1959 1960
}

S
Scott Bardone 已提交
1961 1962 1963 1964
/*
 * Enables the DMA engine.
 */
void t1_sge_start(struct sge *sge)
1965
{
S
Scott Bardone 已提交
1966 1967 1968 1969 1970
	refill_free_list(sge, &sge->freelQ[0]);
	refill_free_list(sge, &sge->freelQ[1]);

	writel(sge->sge_control, sge->adapter->regs + A_SG_CONTROL);
	doorbell_pio(sge->adapter, F_FL0_ENABLE | F_FL1_ENABLE);
1971
	readl(sge->adapter->regs + A_SG_CONTROL); /* flush */
S
Scott Bardone 已提交
1972 1973 1974

	mod_timer(&sge->tx_reclaim_timer, jiffies + TX_RECLAIM_PERIOD);

1975
	if (is_T2(sge->adapter))
S
Scott Bardone 已提交
1976 1977 1978 1979 1980 1981
		mod_timer(&sge->espibug_timer, jiffies + sge->espibug_timeout);
}

/*
 * Callback for the T2 ESPI 'stuck packet feature' workaorund
 */
1982
static void espibug_workaround_t204(unsigned long data)
S
Scott Bardone 已提交
1983 1984
{
	struct adapter *adapter = (struct adapter *)data;
1985
	struct sge *sge = adapter->sge;
1986 1987
	unsigned int nports = adapter->params.nports;
	u32 seop[MAX_NPORTS];
1988

1989 1990
	if (adapter->open_device_map & PORT_MASK) {
		int i;
1991 1992

		if (t1_espi_get_mon_t204(adapter, &(seop[0]), 0) < 0)
1993
			return;
1994

1995
		for (i = 0; i < nports; i++) {
1996 1997 1998 1999 2000 2001 2002 2003
			struct sk_buff *skb = sge->espibug_skb[i];

			if (!netif_running(adapter->port[i].dev) ||
			    netif_queue_stopped(adapter->port[i].dev) ||
			    !seop[i] || ((seop[i] & 0xfff) != 0) || !skb)
				continue;

			if (!skb->cb[0]) {
2004 2005 2006 2007 2008 2009 2010 2011
				skb_copy_to_linear_data_offset(skb,
						    sizeof(struct cpl_tx_pkt),
							       ch_mac_addr,
							       ETH_ALEN);
				skb_copy_to_linear_data_offset(skb,
							       skb->len - 10,
							       ch_mac_addr,
							       ETH_ALEN);
2012
				skb->cb[0] = 0xff;
S
Scott Bardone 已提交
2013
			}
2014 2015 2016 2017 2018 2019

			/* bump the reference count to avoid freeing of
			 * the skb once the DMA has completed.
			 */
			skb = skb_get(skb);
			t1_sge_tx(skb, adapter, 0, adapter->port[i].dev);
S
Scott Bardone 已提交
2020 2021 2022
		}
	}
	mod_timer(&sge->espibug_timer, jiffies + sge->espibug_timeout);
2023 2024
}

2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035
static void espibug_workaround(unsigned long data)
{
	struct adapter *adapter = (struct adapter *)data;
	struct sge *sge = adapter->sge;

	if (netif_running(adapter->port[0].dev)) {
	        struct sk_buff *skb = sge->espibug_skb[0];
	        u32 seop = t1_espi_get_mon(adapter, 0x930, 0);

	        if ((seop & 0xfff0fff) == 0xfff && skb) {
	                if (!skb->cb[0]) {
2036 2037 2038 2039 2040 2041 2042 2043
	                        skb_copy_to_linear_data_offset(skb,
						     sizeof(struct cpl_tx_pkt),
							       ch_mac_addr,
							       ETH_ALEN);
	                        skb_copy_to_linear_data_offset(skb,
							       skb->len - 10,
							       ch_mac_addr,
							       ETH_ALEN);
2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054 2055 2056
	                        skb->cb[0] = 0xff;
	                }

	                /* bump the reference count to avoid freeing of the
	                 * skb once the DMA has completed.
	                 */
	                skb = skb_get(skb);
	                t1_sge_tx(skb, adapter, 0, adapter->port[0].dev);
	        }
	}
	mod_timer(&sge->espibug_timer, jiffies + sge->espibug_timeout);
}

S
Scott Bardone 已提交
2057 2058 2059
/*
 * Creates a t1_sge structure and returns suggested resource parameters.
 */
2060
struct sge *t1_sge_create(struct adapter *adapter, struct sge_params *p)
S
Scott Bardone 已提交
2061
{
S
Stephen Hemminger 已提交
2062
	struct sge *sge = kzalloc(sizeof(*sge), GFP_KERNEL);
2063
	int i;
S
Scott Bardone 已提交
2064 2065 2066 2067 2068 2069 2070 2071 2072

	if (!sge)
		return NULL;

	sge->adapter = adapter;
	sge->netdev = adapter->port[0].dev;
	sge->rx_pkt_pad = t1_is_T1B(adapter) ? 0 : 2;
	sge->jumbo_fl = t1_is_T1B(adapter) ? 1 : 0;

2073 2074 2075 2076 2077 2078
	for_each_port(adapter, i) {
		sge->port_stats[i] = alloc_percpu(struct sge_port_stats);
		if (!sge->port_stats[i])
			goto nomem_port;
	}

S
Scott Bardone 已提交
2079 2080 2081 2082 2083 2084
	init_timer(&sge->tx_reclaim_timer);
	sge->tx_reclaim_timer.data = (unsigned long)sge;
	sge->tx_reclaim_timer.function = sge_tx_reclaim_cb;

	if (is_T2(sge->adapter)) {
		init_timer(&sge->espibug_timer);
2085 2086 2087 2088

		if (adapter->params.nports > 1) {
			tx_sched_init(sge);
			sge->espibug_timer.function = espibug_workaround_t204;
F
Francois Romieu 已提交
2089
		} else
2090
			sge->espibug_timer.function = espibug_workaround;
S
Scott Bardone 已提交
2091
		sge->espibug_timer.data = (unsigned long)sge->adapter;
2092

S
Scott Bardone 已提交
2093
		sge->espibug_timeout = 1;
2094 2095 2096
		/* for T204, every 10ms */
		if (adapter->params.nports > 1)
			sge->espibug_timeout = HZ/100;
S
Scott Bardone 已提交
2097
	}
2098

S
Scott Bardone 已提交
2099 2100 2101 2102 2103

	p->cmdQ_size[0] = SGE_CMDQ0_E_N;
	p->cmdQ_size[1] = SGE_CMDQ1_E_N;
	p->freelQ_size[!sge->jumbo_fl] = SGE_FREEL_SIZE;
	p->freelQ_size[sge->jumbo_fl] = SGE_JUMBO_FREEL_SIZE;
2104 2105 2106 2107 2108 2109 2110 2111
	if (sge->tx_sched) {
		if (board_info(sge->adapter)->board == CHBT_BOARD_CHT204)
			p->rx_coalesce_usecs = 15;
		else
			p->rx_coalesce_usecs = 50;
	} else
		p->rx_coalesce_usecs = 50;

S
Scott Bardone 已提交
2112 2113 2114 2115
	p->coalesce_enable = 0;
	p->sample_interval_usecs = 0;

	return sge;
2116 2117 2118 2119 2120 2121 2122 2123
nomem_port:
	while (i >= 0) {
		free_percpu(sge->port_stats[i]);
		--i;
	}
	kfree(sge);
	return NULL;

S
Scott Bardone 已提交
2124
}