1 /*
2  * This file is part of the Chelsio T4 Ethernet driver for Linux.
3  *
4  * Copyright (c) 2003-2010 Chelsio Communications, Inc. All rights reserved.
5  *
6  * This software is available to you under a choice of one of two
7  * licenses.  You may choose to be licensed under the terms of the GNU
8  * General Public License (GPL) Version 2, available from the file
9  * COPYING in the main directory of this source tree, or the
10  * OpenIB.org BSD license below:
11  *
12  *     Redistribution and use in source and binary forms, with or
13  *     without modification, are permitted provided that the following
14  *     conditions are met:
15  *
16  *      - Redistributions of source code must retain the above
17  *        copyright notice, this list of conditions and the following
18  *        disclaimer.
19  *
20  *      - Redistributions in binary form must reproduce the above
21  *        copyright notice, this list of conditions and the following
22  *        disclaimer in the documentation and/or other materials
23  *        provided with the distribution.
24  *
25  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
26  * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
27  * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
28  * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
29  * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
30  * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
31  * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
32  * SOFTWARE.
33  */
34 
35 #include <linux/init.h>
36 #include <linux/delay.h>
37 #include "cxgb4.h"
38 #include "t4_regs.h"
39 #include "t4fw_api.h"
40 
41 /**
42  *	t4_wait_op_done_val - wait until an operation is completed
43  *	@adapter: the adapter performing the operation
44  *	@reg: the register to check for completion
45  *	@mask: a single-bit field within @reg that indicates completion
46  *	@polarity: the value of the field when the operation is completed
47  *	@attempts: number of check iterations
48  *	@delay: delay in usecs between iterations
49  *	@valp: where to store the value of the register at completion time
50  *
51  *	Wait until an operation is completed by checking a bit in a register
52  *	up to @attempts times.  If @valp is not NULL the value of the register
53  *	at the time it indicated completion is stored there.  Returns 0 if the
54  *	operation completes and	-EAGAIN	otherwise.
55  */
56 static int t4_wait_op_done_val(struct adapter *adapter, int reg, u32 mask,
57 			       int polarity, int attempts, int delay, u32 *valp)
58 {
59 	while (1) {
60 		u32 val = t4_read_reg(adapter, reg);
61 
62 		if (!!(val & mask) == polarity) {
63 			if (valp)
64 				*valp = val;
65 			return 0;
66 		}
67 		if (--attempts == 0)
68 			return -EAGAIN;
69 		if (delay)
70 			udelay(delay);
71 	}
72 }
73 
74 static inline int t4_wait_op_done(struct adapter *adapter, int reg, u32 mask,
75 				  int polarity, int attempts, int delay)
76 {
77 	return t4_wait_op_done_val(adapter, reg, mask, polarity, attempts,
78 				   delay, NULL);
79 }
80 
81 /**
82  *	t4_set_reg_field - set a register field to a value
83  *	@adapter: the adapter to program
84  *	@addr: the register address
85  *	@mask: specifies the portion of the register to modify
86  *	@val: the new value for the register field
87  *
88  *	Sets a register field specified by the supplied mask to the
89  *	given value.
90  */
91 void t4_set_reg_field(struct adapter *adapter, unsigned int addr, u32 mask,
92 		      u32 val)
93 {
94 	u32 v = t4_read_reg(adapter, addr) & ~mask;
95 
96 	t4_write_reg(adapter, addr, v | val);
97 	(void) t4_read_reg(adapter, addr);      /* flush */
98 }
99 
100 /**
101  *	t4_read_indirect - read indirectly addressed registers
102  *	@adap: the adapter
103  *	@addr_reg: register holding the indirect address
104  *	@data_reg: register holding the value of the indirect register
105  *	@vals: where the read register values are stored
106  *	@nregs: how many indirect registers to read
107  *	@start_idx: index of first indirect register to read
108  *
109  *	Reads registers that are accessed indirectly through an address/data
110  *	register pair.
111  */
112 void t4_read_indirect(struct adapter *adap, unsigned int addr_reg,
113 			     unsigned int data_reg, u32 *vals,
114 			     unsigned int nregs, unsigned int start_idx)
115 {
116 	while (nregs--) {
117 		t4_write_reg(adap, addr_reg, start_idx);
118 		*vals++ = t4_read_reg(adap, data_reg);
119 		start_idx++;
120 	}
121 }
122 
123 /**
124  *	t4_write_indirect - write indirectly addressed registers
125  *	@adap: the adapter
126  *	@addr_reg: register holding the indirect addresses
127  *	@data_reg: register holding the value for the indirect registers
128  *	@vals: values to write
129  *	@nregs: how many indirect registers to write
130  *	@start_idx: address of first indirect register to write
131  *
132  *	Writes a sequential block of registers that are accessed indirectly
133  *	through an address/data register pair.
134  */
135 void t4_write_indirect(struct adapter *adap, unsigned int addr_reg,
136 		       unsigned int data_reg, const u32 *vals,
137 		       unsigned int nregs, unsigned int start_idx)
138 {
139 	while (nregs--) {
140 		t4_write_reg(adap, addr_reg, start_idx++);
141 		t4_write_reg(adap, data_reg, *vals++);
142 	}
143 }
144 
145 /*
146  * Get the reply to a mailbox command and store it in @rpl in big-endian order.
147  */
148 static void get_mbox_rpl(struct adapter *adap, __be64 *rpl, int nflit,
149 			 u32 mbox_addr)
150 {
151 	for ( ; nflit; nflit--, mbox_addr += 8)
152 		*rpl++ = cpu_to_be64(t4_read_reg64(adap, mbox_addr));
153 }
154 
155 /*
156  * Handle a FW assertion reported in a mailbox.
157  */
158 static void fw_asrt(struct adapter *adap, u32 mbox_addr)
159 {
160 	struct fw_debug_cmd asrt;
161 
162 	get_mbox_rpl(adap, (__be64 *)&asrt, sizeof(asrt) / 8, mbox_addr);
163 	dev_alert(adap->pdev_dev,
164 		  "FW assertion at %.16s:%u, val0 %#x, val1 %#x\n",
165 		  asrt.u.assert.filename_0_7, ntohl(asrt.u.assert.line),
166 		  ntohl(asrt.u.assert.x), ntohl(asrt.u.assert.y));
167 }
168 
169 static void dump_mbox(struct adapter *adap, int mbox, u32 data_reg)
170 {
171 	dev_err(adap->pdev_dev,
172 		"mbox %d: %llx %llx %llx %llx %llx %llx %llx %llx\n", mbox,
173 		(unsigned long long)t4_read_reg64(adap, data_reg),
174 		(unsigned long long)t4_read_reg64(adap, data_reg + 8),
175 		(unsigned long long)t4_read_reg64(adap, data_reg + 16),
176 		(unsigned long long)t4_read_reg64(adap, data_reg + 24),
177 		(unsigned long long)t4_read_reg64(adap, data_reg + 32),
178 		(unsigned long long)t4_read_reg64(adap, data_reg + 40),
179 		(unsigned long long)t4_read_reg64(adap, data_reg + 48),
180 		(unsigned long long)t4_read_reg64(adap, data_reg + 56));
181 }
182 
183 /**
184  *	t4_wr_mbox_meat - send a command to FW through the given mailbox
185  *	@adap: the adapter
186  *	@mbox: index of the mailbox to use
187  *	@cmd: the command to write
188  *	@size: command length in bytes
189  *	@rpl: where to optionally store the reply
190  *	@sleep_ok: if true we may sleep while awaiting command completion
191  *
192  *	Sends the given command to FW through the selected mailbox and waits
193  *	for the FW to execute the command.  If @rpl is not %NULL it is used to
194  *	store the FW's reply to the command.  The command and its optional
195  *	reply are of the same length.  FW can take up to %FW_CMD_MAX_TIMEOUT ms
196  *	to respond.  @sleep_ok determines whether we may sleep while awaiting
197  *	the response.  If sleeping is allowed we use progressive backoff
198  *	otherwise we spin.
199  *
200  *	The return value is 0 on success or a negative errno on failure.  A
201  *	failure can happen either because we are not able to execute the
202  *	command or FW executes it but signals an error.  In the latter case
203  *	the return value is the error code indicated by FW (negated).
204  */
205 int t4_wr_mbox_meat(struct adapter *adap, int mbox, const void *cmd, int size,
206 		    void *rpl, bool sleep_ok)
207 {
208 	static const int delay[] = {
209 		1, 1, 3, 5, 10, 10, 20, 50, 100, 200
210 	};
211 
212 	u32 v;
213 	u64 res;
214 	int i, ms, delay_idx;
215 	const __be64 *p = cmd;
216 	u32 data_reg = PF_REG(mbox, CIM_PF_MAILBOX_DATA);
217 	u32 ctl_reg = PF_REG(mbox, CIM_PF_MAILBOX_CTRL);
218 
219 	if ((size & 15) || size > MBOX_LEN)
220 		return -EINVAL;
221 
222 	/*
223 	 * If the device is off-line, as in EEH, commands will time out.
224 	 * Fail them early so we don't waste time waiting.
225 	 */
226 	if (adap->pdev->error_state != pci_channel_io_normal)
227 		return -EIO;
228 
229 	v = MBOWNER_GET(t4_read_reg(adap, ctl_reg));
230 	for (i = 0; v == MBOX_OWNER_NONE && i < 3; i++)
231 		v = MBOWNER_GET(t4_read_reg(adap, ctl_reg));
232 
233 	if (v != MBOX_OWNER_DRV)
234 		return v ? -EBUSY : -ETIMEDOUT;
235 
236 	for (i = 0; i < size; i += 8)
237 		t4_write_reg64(adap, data_reg + i, be64_to_cpu(*p++));
238 
239 	t4_write_reg(adap, ctl_reg, MBMSGVALID | MBOWNER(MBOX_OWNER_FW));
240 	t4_read_reg(adap, ctl_reg);          /* flush write */
241 
242 	delay_idx = 0;
243 	ms = delay[0];
244 
245 	for (i = 0; i < FW_CMD_MAX_TIMEOUT; i += ms) {
246 		if (sleep_ok) {
247 			ms = delay[delay_idx];  /* last element may repeat */
248 			if (delay_idx < ARRAY_SIZE(delay) - 1)
249 				delay_idx++;
250 			msleep(ms);
251 		} else
252 			mdelay(ms);
253 
254 		v = t4_read_reg(adap, ctl_reg);
255 		if (MBOWNER_GET(v) == MBOX_OWNER_DRV) {
256 			if (!(v & MBMSGVALID)) {
257 				t4_write_reg(adap, ctl_reg, 0);
258 				continue;
259 			}
260 
261 			res = t4_read_reg64(adap, data_reg);
262 			if (FW_CMD_OP_GET(res >> 32) == FW_DEBUG_CMD) {
263 				fw_asrt(adap, data_reg);
264 				res = FW_CMD_RETVAL(EIO);
265 			} else if (rpl)
266 				get_mbox_rpl(adap, rpl, size / 8, data_reg);
267 
268 			if (FW_CMD_RETVAL_GET((int)res))
269 				dump_mbox(adap, mbox, data_reg);
270 			t4_write_reg(adap, ctl_reg, 0);
271 			return -FW_CMD_RETVAL_GET((int)res);
272 		}
273 	}
274 
275 	dump_mbox(adap, mbox, data_reg);
276 	dev_err(adap->pdev_dev, "command %#x in mailbox %d timed out\n",
277 		*(const u8 *)cmd, mbox);
278 	return -ETIMEDOUT;
279 }
280 
281 /**
282  *	t4_mc_read - read from MC through backdoor accesses
283  *	@adap: the adapter
284  *	@addr: address of first byte requested
285  *	@idx: which MC to access
286  *	@data: 64 bytes of data containing the requested address
287  *	@ecc: where to store the corresponding 64-bit ECC word
288  *
289  *	Read 64 bytes of data from MC starting at a 64-byte-aligned address
290  *	that covers the requested address @addr.  If @parity is not %NULL it
291  *	is assigned the 64-bit ECC word for the read data.
292  */
293 int t4_mc_read(struct adapter *adap, int idx, u32 addr, __be32 *data, u64 *ecc)
294 {
295 	int i;
296 	u32 mc_bist_cmd, mc_bist_cmd_addr, mc_bist_cmd_len;
297 	u32 mc_bist_status_rdata, mc_bist_data_pattern;
298 
299 	if (is_t4(adap->chip)) {
300 		mc_bist_cmd = MC_BIST_CMD;
301 		mc_bist_cmd_addr = MC_BIST_CMD_ADDR;
302 		mc_bist_cmd_len = MC_BIST_CMD_LEN;
303 		mc_bist_status_rdata = MC_BIST_STATUS_RDATA;
304 		mc_bist_data_pattern = MC_BIST_DATA_PATTERN;
305 	} else {
306 		mc_bist_cmd = MC_REG(MC_P_BIST_CMD, idx);
307 		mc_bist_cmd_addr = MC_REG(MC_P_BIST_CMD_ADDR, idx);
308 		mc_bist_cmd_len = MC_REG(MC_P_BIST_CMD_LEN, idx);
309 		mc_bist_status_rdata = MC_REG(MC_P_BIST_STATUS_RDATA, idx);
310 		mc_bist_data_pattern = MC_REG(MC_P_BIST_DATA_PATTERN, idx);
311 	}
312 
313 	if (t4_read_reg(adap, mc_bist_cmd) & START_BIST)
314 		return -EBUSY;
315 	t4_write_reg(adap, mc_bist_cmd_addr, addr & ~0x3fU);
316 	t4_write_reg(adap, mc_bist_cmd_len, 64);
317 	t4_write_reg(adap, mc_bist_data_pattern, 0xc);
318 	t4_write_reg(adap, mc_bist_cmd, BIST_OPCODE(1) | START_BIST |
319 		     BIST_CMD_GAP(1));
320 	i = t4_wait_op_done(adap, mc_bist_cmd, START_BIST, 0, 10, 1);
321 	if (i)
322 		return i;
323 
324 #define MC_DATA(i) MC_BIST_STATUS_REG(mc_bist_status_rdata, i)
325 
326 	for (i = 15; i >= 0; i--)
327 		*data++ = htonl(t4_read_reg(adap, MC_DATA(i)));
328 	if (ecc)
329 		*ecc = t4_read_reg64(adap, MC_DATA(16));
330 #undef MC_DATA
331 	return 0;
332 }
333 
334 /**
335  *	t4_edc_read - read from EDC through backdoor accesses
336  *	@adap: the adapter
337  *	@idx: which EDC to access
338  *	@addr: address of first byte requested
339  *	@data: 64 bytes of data containing the requested address
340  *	@ecc: where to store the corresponding 64-bit ECC word
341  *
342  *	Read 64 bytes of data from EDC starting at a 64-byte-aligned address
343  *	that covers the requested address @addr.  If @parity is not %NULL it
344  *	is assigned the 64-bit ECC word for the read data.
345  */
346 int t4_edc_read(struct adapter *adap, int idx, u32 addr, __be32 *data, u64 *ecc)
347 {
348 	int i;
349 	u32 edc_bist_cmd, edc_bist_cmd_addr, edc_bist_cmd_len;
350 	u32 edc_bist_cmd_data_pattern, edc_bist_status_rdata;
351 
352 	if (is_t4(adap->chip)) {
353 		edc_bist_cmd = EDC_REG(EDC_BIST_CMD, idx);
354 		edc_bist_cmd_addr = EDC_REG(EDC_BIST_CMD_ADDR, idx);
355 		edc_bist_cmd_len = EDC_REG(EDC_BIST_CMD_LEN, idx);
356 		edc_bist_cmd_data_pattern = EDC_REG(EDC_BIST_DATA_PATTERN,
357 						    idx);
358 		edc_bist_status_rdata = EDC_REG(EDC_BIST_STATUS_RDATA,
359 						    idx);
360 	} else {
361 		edc_bist_cmd = EDC_REG_T5(EDC_H_BIST_CMD, idx);
362 		edc_bist_cmd_addr = EDC_REG_T5(EDC_H_BIST_CMD_ADDR, idx);
363 		edc_bist_cmd_len = EDC_REG_T5(EDC_H_BIST_CMD_LEN, idx);
364 		edc_bist_cmd_data_pattern =
365 			EDC_REG_T5(EDC_H_BIST_DATA_PATTERN, idx);
366 		edc_bist_status_rdata =
367 			 EDC_REG_T5(EDC_H_BIST_STATUS_RDATA, idx);
368 	}
369 
370 	if (t4_read_reg(adap, edc_bist_cmd) & START_BIST)
371 		return -EBUSY;
372 	t4_write_reg(adap, edc_bist_cmd_addr, addr & ~0x3fU);
373 	t4_write_reg(adap, edc_bist_cmd_len, 64);
374 	t4_write_reg(adap, edc_bist_cmd_data_pattern, 0xc);
375 	t4_write_reg(adap, edc_bist_cmd,
376 		     BIST_OPCODE(1) | BIST_CMD_GAP(1) | START_BIST);
377 	i = t4_wait_op_done(adap, edc_bist_cmd, START_BIST, 0, 10, 1);
378 	if (i)
379 		return i;
380 
381 #define EDC_DATA(i) (EDC_BIST_STATUS_REG(edc_bist_status_rdata, i))
382 
383 	for (i = 15; i >= 0; i--)
384 		*data++ = htonl(t4_read_reg(adap, EDC_DATA(i)));
385 	if (ecc)
386 		*ecc = t4_read_reg64(adap, EDC_DATA(16));
387 #undef EDC_DATA
388 	return 0;
389 }
390 
391 /*
392  *	t4_mem_win_rw - read/write memory through PCIE memory window
393  *	@adap: the adapter
394  *	@addr: address of first byte requested
395  *	@data: MEMWIN0_APERTURE bytes of data containing the requested address
396  *	@dir: direction of transfer 1 => read, 0 => write
397  *
398  *	Read/write MEMWIN0_APERTURE bytes of data from MC starting at a
399  *	MEMWIN0_APERTURE-byte-aligned address that covers the requested
400  *	address @addr.
401  */
402 static int t4_mem_win_rw(struct adapter *adap, u32 addr, __be32 *data, int dir)
403 {
404 	int i;
405 	u32 win_pf = is_t4(adap->chip) ? 0 : V_PFNUM(adap->fn);
406 
407 	/*
408 	 * Setup offset into PCIE memory window.  Address must be a
409 	 * MEMWIN0_APERTURE-byte-aligned address.  (Read back MA register to
410 	 * ensure that changes propagate before we attempt to use the new
411 	 * values.)
412 	 */
413 	t4_write_reg(adap, PCIE_MEM_ACCESS_OFFSET,
414 		     (addr & ~(MEMWIN0_APERTURE - 1)) | win_pf);
415 	t4_read_reg(adap, PCIE_MEM_ACCESS_OFFSET);
416 
417 	/* Collecting data 4 bytes at a time upto MEMWIN0_APERTURE */
418 	for (i = 0; i < MEMWIN0_APERTURE; i = i+0x4) {
419 		if (dir)
420 			*data++ = (__force __be32) t4_read_reg(adap,
421 							(MEMWIN0_BASE + i));
422 		else
423 			t4_write_reg(adap, (MEMWIN0_BASE + i),
424 				     (__force u32) *data++);
425 	}
426 
427 	return 0;
428 }
429 
430 /**
431  *	t4_memory_rw - read/write EDC 0, EDC 1 or MC via PCIE memory window
432  *	@adap: the adapter
433  *	@mtype: memory type: MEM_EDC0, MEM_EDC1 or MEM_MC
434  *	@addr: address within indicated memory type
435  *	@len: amount of memory to transfer
436  *	@buf: host memory buffer
437  *	@dir: direction of transfer 1 => read, 0 => write
438  *
439  *	Reads/writes an [almost] arbitrary memory region in the firmware: the
440  *	firmware memory address, length and host buffer must be aligned on
441  *	32-bit boudaries.  The memory is transferred as a raw byte sequence
442  *	from/to the firmware's memory.  If this memory contains data
443  *	structures which contain multi-byte integers, it's the callers
444  *	responsibility to perform appropriate byte order conversions.
445  */
446 static int t4_memory_rw(struct adapter *adap, int mtype, u32 addr, u32 len,
447 			__be32 *buf, int dir)
448 {
449 	u32 pos, start, end, offset, memoffset;
450 	u32 edc_size, mc_size;
451 	int ret = 0;
452 	__be32 *data;
453 
454 	/*
455 	 * Argument sanity checks ...
456 	 */
457 	if ((addr & 0x3) || (len & 0x3))
458 		return -EINVAL;
459 
460 	data = vmalloc(MEMWIN0_APERTURE);
461 	if (!data)
462 		return -ENOMEM;
463 
464 	/* Offset into the region of memory which is being accessed
465 	 * MEM_EDC0 = 0
466 	 * MEM_EDC1 = 1
467 	 * MEM_MC   = 2 -- T4
468 	 * MEM_MC0  = 2 -- For T5
469 	 * MEM_MC1  = 3 -- For T5
470 	 */
471 	edc_size  = EDRAM_SIZE_GET(t4_read_reg(adap, MA_EDRAM0_BAR));
472 	if (mtype != MEM_MC1)
473 		memoffset = (mtype * (edc_size * 1024 * 1024));
474 	else {
475 		mc_size = EXT_MEM_SIZE_GET(t4_read_reg(adap,
476 						       MA_EXT_MEMORY_BAR));
477 		memoffset = (MEM_MC0 * edc_size + mc_size) * 1024 * 1024;
478 	}
479 
480 	/* Determine the PCIE_MEM_ACCESS_OFFSET */
481 	addr = addr + memoffset;
482 
483 	/*
484 	 * The underlaying EDC/MC read routines read MEMWIN0_APERTURE bytes
485 	 * at a time so we need to round down the start and round up the end.
486 	 * We'll start copying out of the first line at (addr - start) a word
487 	 * at a time.
488 	 */
489 	start = addr & ~(MEMWIN0_APERTURE-1);
490 	end = (addr + len + MEMWIN0_APERTURE-1) & ~(MEMWIN0_APERTURE-1);
491 	offset = (addr - start)/sizeof(__be32);
492 
493 	for (pos = start; pos < end; pos += MEMWIN0_APERTURE, offset = 0) {
494 
495 		/*
496 		 * If we're writing, copy the data from the caller's memory
497 		 * buffer
498 		 */
499 		if (!dir) {
500 			/*
501 			 * If we're doing a partial write, then we need to do
502 			 * a read-modify-write ...
503 			 */
504 			if (offset || len < MEMWIN0_APERTURE) {
505 				ret = t4_mem_win_rw(adap, pos, data, 1);
506 				if (ret)
507 					break;
508 			}
509 			while (offset < (MEMWIN0_APERTURE/sizeof(__be32)) &&
510 			       len > 0) {
511 				data[offset++] = *buf++;
512 				len -= sizeof(__be32);
513 			}
514 		}
515 
516 		/*
517 		 * Transfer a block of memory and bail if there's an error.
518 		 */
519 		ret = t4_mem_win_rw(adap, pos, data, dir);
520 		if (ret)
521 			break;
522 
523 		/*
524 		 * If we're reading, copy the data into the caller's memory
525 		 * buffer.
526 		 */
527 		if (dir)
528 			while (offset < (MEMWIN0_APERTURE/sizeof(__be32)) &&
529 			       len > 0) {
530 				*buf++ = data[offset++];
531 				len -= sizeof(__be32);
532 			}
533 	}
534 
535 	vfree(data);
536 	return ret;
537 }
538 
539 int t4_memory_write(struct adapter *adap, int mtype, u32 addr, u32 len,
540 		    __be32 *buf)
541 {
542 	return t4_memory_rw(adap, mtype, addr, len, buf, 0);
543 }
544 
545 #define EEPROM_STAT_ADDR   0x7bfc
546 #define VPD_BASE           0x400
547 #define VPD_BASE_OLD       0
548 #define VPD_LEN            1024
549 
550 /**
551  *	t4_seeprom_wp - enable/disable EEPROM write protection
552  *	@adapter: the adapter
553  *	@enable: whether to enable or disable write protection
554  *
555  *	Enables or disables write protection on the serial EEPROM.
556  */
557 int t4_seeprom_wp(struct adapter *adapter, bool enable)
558 {
559 	unsigned int v = enable ? 0xc : 0;
560 	int ret = pci_write_vpd(adapter->pdev, EEPROM_STAT_ADDR, 4, &v);
561 	return ret < 0 ? ret : 0;
562 }
563 
564 /**
565  *	get_vpd_params - read VPD parameters from VPD EEPROM
566  *	@adapter: adapter to read
567  *	@p: where to store the parameters
568  *
569  *	Reads card parameters stored in VPD EEPROM.
570  */
571 int get_vpd_params(struct adapter *adapter, struct vpd_params *p)
572 {
573 	u32 cclk_param, cclk_val;
574 	int i, ret, addr;
575 	int ec, sn;
576 	u8 *vpd, csum;
577 	unsigned int vpdr_len, kw_offset, id_len;
578 
579 	vpd = vmalloc(VPD_LEN);
580 	if (!vpd)
581 		return -ENOMEM;
582 
583 	ret = pci_read_vpd(adapter->pdev, VPD_BASE, sizeof(u32), vpd);
584 	if (ret < 0)
585 		goto out;
586 	addr = *vpd == 0x82 ? VPD_BASE : VPD_BASE_OLD;
587 
588 	ret = pci_read_vpd(adapter->pdev, addr, VPD_LEN, vpd);
589 	if (ret < 0)
590 		goto out;
591 
592 	if (vpd[0] != PCI_VPD_LRDT_ID_STRING) {
593 		dev_err(adapter->pdev_dev, "missing VPD ID string\n");
594 		ret = -EINVAL;
595 		goto out;
596 	}
597 
598 	id_len = pci_vpd_lrdt_size(vpd);
599 	if (id_len > ID_LEN)
600 		id_len = ID_LEN;
601 
602 	i = pci_vpd_find_tag(vpd, 0, VPD_LEN, PCI_VPD_LRDT_RO_DATA);
603 	if (i < 0) {
604 		dev_err(adapter->pdev_dev, "missing VPD-R section\n");
605 		ret = -EINVAL;
606 		goto out;
607 	}
608 
609 	vpdr_len = pci_vpd_lrdt_size(&vpd[i]);
610 	kw_offset = i + PCI_VPD_LRDT_TAG_SIZE;
611 	if (vpdr_len + kw_offset > VPD_LEN) {
612 		dev_err(adapter->pdev_dev, "bad VPD-R length %u\n", vpdr_len);
613 		ret = -EINVAL;
614 		goto out;
615 	}
616 
617 #define FIND_VPD_KW(var, name) do { \
618 	var = pci_vpd_find_info_keyword(vpd, kw_offset, vpdr_len, name); \
619 	if (var < 0) { \
620 		dev_err(adapter->pdev_dev, "missing VPD keyword " name "\n"); \
621 		ret = -EINVAL; \
622 		goto out; \
623 	} \
624 	var += PCI_VPD_INFO_FLD_HDR_SIZE; \
625 } while (0)
626 
627 	FIND_VPD_KW(i, "RV");
628 	for (csum = 0; i >= 0; i--)
629 		csum += vpd[i];
630 
631 	if (csum) {
632 		dev_err(adapter->pdev_dev,
633 			"corrupted VPD EEPROM, actual csum %u\n", csum);
634 		ret = -EINVAL;
635 		goto out;
636 	}
637 
638 	FIND_VPD_KW(ec, "EC");
639 	FIND_VPD_KW(sn, "SN");
640 #undef FIND_VPD_KW
641 
642 	memcpy(p->id, vpd + PCI_VPD_LRDT_TAG_SIZE, id_len);
643 	strim(p->id);
644 	memcpy(p->ec, vpd + ec, EC_LEN);
645 	strim(p->ec);
646 	i = pci_vpd_info_field_size(vpd + sn - PCI_VPD_INFO_FLD_HDR_SIZE);
647 	memcpy(p->sn, vpd + sn, min(i, SERNUM_LEN));
648 	strim(p->sn);
649 
650 	/*
651 	 * Ask firmware for the Core Clock since it knows how to translate the
652 	 * Reference Clock ('V2') VPD field into a Core Clock value ...
653 	 */
654 	cclk_param = (FW_PARAMS_MNEM(FW_PARAMS_MNEM_DEV) |
655 		      FW_PARAMS_PARAM_X(FW_PARAMS_PARAM_DEV_CCLK));
656 	ret = t4_query_params(adapter, adapter->mbox, 0, 0,
657 			      1, &cclk_param, &cclk_val);
658 
659 out:
660 	vfree(vpd);
661 	if (ret)
662 		return ret;
663 	p->cclk = cclk_val;
664 
665 	return 0;
666 }
667 
668 /* serial flash and firmware constants */
669 enum {
670 	SF_ATTEMPTS = 10,             /* max retries for SF operations */
671 
672 	/* flash command opcodes */
673 	SF_PROG_PAGE    = 2,          /* program page */
674 	SF_WR_DISABLE   = 4,          /* disable writes */
675 	SF_RD_STATUS    = 5,          /* read status register */
676 	SF_WR_ENABLE    = 6,          /* enable writes */
677 	SF_RD_DATA_FAST = 0xb,        /* read flash */
678 	SF_RD_ID        = 0x9f,       /* read ID */
679 	SF_ERASE_SECTOR = 0xd8,       /* erase sector */
680 
681 	FW_MAX_SIZE = 512 * 1024,
682 };
683 
684 /**
685  *	sf1_read - read data from the serial flash
686  *	@adapter: the adapter
687  *	@byte_cnt: number of bytes to read
688  *	@cont: whether another operation will be chained
689  *	@lock: whether to lock SF for PL access only
690  *	@valp: where to store the read data
691  *
692  *	Reads up to 4 bytes of data from the serial flash.  The location of
693  *	the read needs to be specified prior to calling this by issuing the
694  *	appropriate commands to the serial flash.
695  */
696 static int sf1_read(struct adapter *adapter, unsigned int byte_cnt, int cont,
697 		    int lock, u32 *valp)
698 {
699 	int ret;
700 
701 	if (!byte_cnt || byte_cnt > 4)
702 		return -EINVAL;
703 	if (t4_read_reg(adapter, SF_OP) & SF_BUSY)
704 		return -EBUSY;
705 	cont = cont ? SF_CONT : 0;
706 	lock = lock ? SF_LOCK : 0;
707 	t4_write_reg(adapter, SF_OP, lock | cont | BYTECNT(byte_cnt - 1));
708 	ret = t4_wait_op_done(adapter, SF_OP, SF_BUSY, 0, SF_ATTEMPTS, 5);
709 	if (!ret)
710 		*valp = t4_read_reg(adapter, SF_DATA);
711 	return ret;
712 }
713 
714 /**
715  *	sf1_write - write data to the serial flash
716  *	@adapter: the adapter
717  *	@byte_cnt: number of bytes to write
718  *	@cont: whether another operation will be chained
719  *	@lock: whether to lock SF for PL access only
720  *	@val: value to write
721  *
722  *	Writes up to 4 bytes of data to the serial flash.  The location of
723  *	the write needs to be specified prior to calling this by issuing the
724  *	appropriate commands to the serial flash.
725  */
726 static int sf1_write(struct adapter *adapter, unsigned int byte_cnt, int cont,
727 		     int lock, u32 val)
728 {
729 	if (!byte_cnt || byte_cnt > 4)
730 		return -EINVAL;
731 	if (t4_read_reg(adapter, SF_OP) & SF_BUSY)
732 		return -EBUSY;
733 	cont = cont ? SF_CONT : 0;
734 	lock = lock ? SF_LOCK : 0;
735 	t4_write_reg(adapter, SF_DATA, val);
736 	t4_write_reg(adapter, SF_OP, lock |
737 		     cont | BYTECNT(byte_cnt - 1) | OP_WR);
738 	return t4_wait_op_done(adapter, SF_OP, SF_BUSY, 0, SF_ATTEMPTS, 5);
739 }
740 
741 /**
742  *	flash_wait_op - wait for a flash operation to complete
743  *	@adapter: the adapter
744  *	@attempts: max number of polls of the status register
745  *	@delay: delay between polls in ms
746  *
747  *	Wait for a flash operation to complete by polling the status register.
748  */
749 static int flash_wait_op(struct adapter *adapter, int attempts, int delay)
750 {
751 	int ret;
752 	u32 status;
753 
754 	while (1) {
755 		if ((ret = sf1_write(adapter, 1, 1, 1, SF_RD_STATUS)) != 0 ||
756 		    (ret = sf1_read(adapter, 1, 0, 1, &status)) != 0)
757 			return ret;
758 		if (!(status & 1))
759 			return 0;
760 		if (--attempts == 0)
761 			return -EAGAIN;
762 		if (delay)
763 			msleep(delay);
764 	}
765 }
766 
767 /**
768  *	t4_read_flash - read words from serial flash
769  *	@adapter: the adapter
770  *	@addr: the start address for the read
771  *	@nwords: how many 32-bit words to read
772  *	@data: where to store the read data
773  *	@byte_oriented: whether to store data as bytes or as words
774  *
775  *	Read the specified number of 32-bit words from the serial flash.
776  *	If @byte_oriented is set the read data is stored as a byte array
777  *	(i.e., big-endian), otherwise as 32-bit words in the platform's
778  *	natural endianess.
779  */
780 static int t4_read_flash(struct adapter *adapter, unsigned int addr,
781 			 unsigned int nwords, u32 *data, int byte_oriented)
782 {
783 	int ret;
784 
785 	if (addr + nwords * sizeof(u32) > adapter->params.sf_size || (addr & 3))
786 		return -EINVAL;
787 
788 	addr = swab32(addr) | SF_RD_DATA_FAST;
789 
790 	if ((ret = sf1_write(adapter, 4, 1, 0, addr)) != 0 ||
791 	    (ret = sf1_read(adapter, 1, 1, 0, data)) != 0)
792 		return ret;
793 
794 	for ( ; nwords; nwords--, data++) {
795 		ret = sf1_read(adapter, 4, nwords > 1, nwords == 1, data);
796 		if (nwords == 1)
797 			t4_write_reg(adapter, SF_OP, 0);    /* unlock SF */
798 		if (ret)
799 			return ret;
800 		if (byte_oriented)
801 			*data = (__force __u32) (htonl(*data));
802 	}
803 	return 0;
804 }
805 
806 /**
807  *	t4_write_flash - write up to a page of data to the serial flash
808  *	@adapter: the adapter
809  *	@addr: the start address to write
810  *	@n: length of data to write in bytes
811  *	@data: the data to write
812  *
813  *	Writes up to a page of data (256 bytes) to the serial flash starting
814  *	at the given address.  All the data must be written to the same page.
815  */
816 static int t4_write_flash(struct adapter *adapter, unsigned int addr,
817 			  unsigned int n, const u8 *data)
818 {
819 	int ret;
820 	u32 buf[64];
821 	unsigned int i, c, left, val, offset = addr & 0xff;
822 
823 	if (addr >= adapter->params.sf_size || offset + n > SF_PAGE_SIZE)
824 		return -EINVAL;
825 
826 	val = swab32(addr) | SF_PROG_PAGE;
827 
828 	if ((ret = sf1_write(adapter, 1, 0, 1, SF_WR_ENABLE)) != 0 ||
829 	    (ret = sf1_write(adapter, 4, 1, 1, val)) != 0)
830 		goto unlock;
831 
832 	for (left = n; left; left -= c) {
833 		c = min(left, 4U);
834 		for (val = 0, i = 0; i < c; ++i)
835 			val = (val << 8) + *data++;
836 
837 		ret = sf1_write(adapter, c, c != left, 1, val);
838 		if (ret)
839 			goto unlock;
840 	}
841 	ret = flash_wait_op(adapter, 8, 1);
842 	if (ret)
843 		goto unlock;
844 
845 	t4_write_reg(adapter, SF_OP, 0);    /* unlock SF */
846 
847 	/* Read the page to verify the write succeeded */
848 	ret = t4_read_flash(adapter, addr & ~0xff, ARRAY_SIZE(buf), buf, 1);
849 	if (ret)
850 		return ret;
851 
852 	if (memcmp(data - n, (u8 *)buf + offset, n)) {
853 		dev_err(adapter->pdev_dev,
854 			"failed to correctly write the flash page at %#x\n",
855 			addr);
856 		return -EIO;
857 	}
858 	return 0;
859 
860 unlock:
861 	t4_write_reg(adapter, SF_OP, 0);    /* unlock SF */
862 	return ret;
863 }
864 
865 /**
866  *	get_fw_version - read the firmware version
867  *	@adapter: the adapter
868  *	@vers: where to place the version
869  *
870  *	Reads the FW version from flash.
871  */
872 static int get_fw_version(struct adapter *adapter, u32 *vers)
873 {
874 	return t4_read_flash(adapter, adapter->params.sf_fw_start +
875 			     offsetof(struct fw_hdr, fw_ver), 1, vers, 0);
876 }
877 
878 /**
879  *	get_tp_version - read the TP microcode version
880  *	@adapter: the adapter
881  *	@vers: where to place the version
882  *
883  *	Reads the TP microcode version from flash.
884  */
885 static int get_tp_version(struct adapter *adapter, u32 *vers)
886 {
887 	return t4_read_flash(adapter, adapter->params.sf_fw_start +
888 			     offsetof(struct fw_hdr, tp_microcode_ver),
889 			     1, vers, 0);
890 }
891 
892 /**
893  *	t4_check_fw_version - check if the FW is compatible with this driver
894  *	@adapter: the adapter
895  *
896  *	Checks if an adapter's FW is compatible with the driver.  Returns 0
897  *	if there's exact match, a negative error if the version could not be
898  *	read or there's a major version mismatch, and a positive value if the
899  *	expected major version is found but there's a minor version mismatch.
900  */
901 int t4_check_fw_version(struct adapter *adapter)
902 {
903 	u32 api_vers[2];
904 	int ret, major, minor, micro;
905 	int exp_major, exp_minor, exp_micro;
906 
907 	ret = get_fw_version(adapter, &adapter->params.fw_vers);
908 	if (!ret)
909 		ret = get_tp_version(adapter, &adapter->params.tp_vers);
910 	if (!ret)
911 		ret = t4_read_flash(adapter, adapter->params.sf_fw_start +
912 				    offsetof(struct fw_hdr, intfver_nic),
913 				    2, api_vers, 1);
914 	if (ret)
915 		return ret;
916 
917 	major = FW_HDR_FW_VER_MAJOR_GET(adapter->params.fw_vers);
918 	minor = FW_HDR_FW_VER_MINOR_GET(adapter->params.fw_vers);
919 	micro = FW_HDR_FW_VER_MICRO_GET(adapter->params.fw_vers);
920 
921 	switch (CHELSIO_CHIP_VERSION(adapter->chip)) {
922 	case CHELSIO_T4:
923 		exp_major = FW_VERSION_MAJOR;
924 		exp_minor = FW_VERSION_MINOR;
925 		exp_micro = FW_VERSION_MICRO;
926 		break;
927 	case CHELSIO_T5:
928 		exp_major = FW_VERSION_MAJOR_T5;
929 		exp_minor = FW_VERSION_MINOR_T5;
930 		exp_micro = FW_VERSION_MICRO_T5;
931 		break;
932 	default:
933 		dev_err(adapter->pdev_dev, "Unsupported chip type, %x\n",
934 			adapter->chip);
935 		return -EINVAL;
936 	}
937 
938 	memcpy(adapter->params.api_vers, api_vers,
939 	       sizeof(adapter->params.api_vers));
940 
941 	if (major != exp_major) {            /* major mismatch - fail */
942 		dev_err(adapter->pdev_dev,
943 			"card FW has major version %u, driver wants %u\n",
944 			major, exp_major);
945 		return -EINVAL;
946 	}
947 
948 	if (minor == exp_minor && micro == exp_micro)
949 		return 0;                                   /* perfect match */
950 
951 	/* Minor/micro version mismatch.  Report it but often it's OK. */
952 	return 1;
953 }
954 
955 /**
956  *	t4_flash_erase_sectors - erase a range of flash sectors
957  *	@adapter: the adapter
958  *	@start: the first sector to erase
959  *	@end: the last sector to erase
960  *
961  *	Erases the sectors in the given inclusive range.
962  */
963 static int t4_flash_erase_sectors(struct adapter *adapter, int start, int end)
964 {
965 	int ret = 0;
966 
967 	while (start <= end) {
968 		if ((ret = sf1_write(adapter, 1, 0, 1, SF_WR_ENABLE)) != 0 ||
969 		    (ret = sf1_write(adapter, 4, 0, 1,
970 				     SF_ERASE_SECTOR | (start << 8))) != 0 ||
971 		    (ret = flash_wait_op(adapter, 14, 500)) != 0) {
972 			dev_err(adapter->pdev_dev,
973 				"erase of flash sector %d failed, error %d\n",
974 				start, ret);
975 			break;
976 		}
977 		start++;
978 	}
979 	t4_write_reg(adapter, SF_OP, 0);    /* unlock SF */
980 	return ret;
981 }
982 
983 /**
984  *	t4_flash_cfg_addr - return the address of the flash configuration file
985  *	@adapter: the adapter
986  *
987  *	Return the address within the flash where the Firmware Configuration
988  *	File is stored.
989  */
990 unsigned int t4_flash_cfg_addr(struct adapter *adapter)
991 {
992 	if (adapter->params.sf_size == 0x100000)
993 		return FLASH_FPGA_CFG_START;
994 	else
995 		return FLASH_CFG_START;
996 }
997 
998 /**
999  *	t4_load_cfg - download config file
1000  *	@adap: the adapter
1001  *	@cfg_data: the cfg text file to write
1002  *	@size: text file size
1003  *
1004  *	Write the supplied config text file to the card's serial flash.
1005  */
1006 int t4_load_cfg(struct adapter *adap, const u8 *cfg_data, unsigned int size)
1007 {
1008 	int ret, i, n;
1009 	unsigned int addr;
1010 	unsigned int flash_cfg_start_sec;
1011 	unsigned int sf_sec_size = adap->params.sf_size / adap->params.sf_nsec;
1012 
1013 	addr = t4_flash_cfg_addr(adap);
1014 	flash_cfg_start_sec = addr / SF_SEC_SIZE;
1015 
1016 	if (size > FLASH_CFG_MAX_SIZE) {
1017 		dev_err(adap->pdev_dev, "cfg file too large, max is %u bytes\n",
1018 			FLASH_CFG_MAX_SIZE);
1019 		return -EFBIG;
1020 	}
1021 
1022 	i = DIV_ROUND_UP(FLASH_CFG_MAX_SIZE,	/* # of sectors spanned */
1023 			 sf_sec_size);
1024 	ret = t4_flash_erase_sectors(adap, flash_cfg_start_sec,
1025 				     flash_cfg_start_sec + i - 1);
1026 	/*
1027 	 * If size == 0 then we're simply erasing the FLASH sectors associated
1028 	 * with the on-adapter Firmware Configuration File.
1029 	 */
1030 	if (ret || size == 0)
1031 		goto out;
1032 
1033 	/* this will write to the flash up to SF_PAGE_SIZE at a time */
1034 	for (i = 0; i < size; i += SF_PAGE_SIZE) {
1035 		if ((size - i) <  SF_PAGE_SIZE)
1036 			n = size - i;
1037 		else
1038 			n = SF_PAGE_SIZE;
1039 		ret = t4_write_flash(adap, addr, n, cfg_data);
1040 		if (ret)
1041 			goto out;
1042 
1043 		addr += SF_PAGE_SIZE;
1044 		cfg_data += SF_PAGE_SIZE;
1045 	}
1046 
1047 out:
1048 	if (ret)
1049 		dev_err(adap->pdev_dev, "config file %s failed %d\n",
1050 			(size == 0 ? "clear" : "download"), ret);
1051 	return ret;
1052 }
1053 
1054 /**
1055  *	t4_load_fw - download firmware
1056  *	@adap: the adapter
1057  *	@fw_data: the firmware image to write
1058  *	@size: image size
1059  *
1060  *	Write the supplied firmware image to the card's serial flash.
1061  */
1062 int t4_load_fw(struct adapter *adap, const u8 *fw_data, unsigned int size)
1063 {
1064 	u32 csum;
1065 	int ret, addr;
1066 	unsigned int i;
1067 	u8 first_page[SF_PAGE_SIZE];
1068 	const __be32 *p = (const __be32 *)fw_data;
1069 	const struct fw_hdr *hdr = (const struct fw_hdr *)fw_data;
1070 	unsigned int sf_sec_size = adap->params.sf_size / adap->params.sf_nsec;
1071 	unsigned int fw_img_start = adap->params.sf_fw_start;
1072 	unsigned int fw_start_sec = fw_img_start / sf_sec_size;
1073 
1074 	if (!size) {
1075 		dev_err(adap->pdev_dev, "FW image has no data\n");
1076 		return -EINVAL;
1077 	}
1078 	if (size & 511) {
1079 		dev_err(adap->pdev_dev,
1080 			"FW image size not multiple of 512 bytes\n");
1081 		return -EINVAL;
1082 	}
1083 	if (ntohs(hdr->len512) * 512 != size) {
1084 		dev_err(adap->pdev_dev,
1085 			"FW image size differs from size in FW header\n");
1086 		return -EINVAL;
1087 	}
1088 	if (size > FW_MAX_SIZE) {
1089 		dev_err(adap->pdev_dev, "FW image too large, max is %u bytes\n",
1090 			FW_MAX_SIZE);
1091 		return -EFBIG;
1092 	}
1093 
1094 	for (csum = 0, i = 0; i < size / sizeof(csum); i++)
1095 		csum += ntohl(p[i]);
1096 
1097 	if (csum != 0xffffffff) {
1098 		dev_err(adap->pdev_dev,
1099 			"corrupted firmware image, checksum %#x\n", csum);
1100 		return -EINVAL;
1101 	}
1102 
1103 	i = DIV_ROUND_UP(size, sf_sec_size);        /* # of sectors spanned */
1104 	ret = t4_flash_erase_sectors(adap, fw_start_sec, fw_start_sec + i - 1);
1105 	if (ret)
1106 		goto out;
1107 
1108 	/*
1109 	 * We write the correct version at the end so the driver can see a bad
1110 	 * version if the FW write fails.  Start by writing a copy of the
1111 	 * first page with a bad version.
1112 	 */
1113 	memcpy(first_page, fw_data, SF_PAGE_SIZE);
1114 	((struct fw_hdr *)first_page)->fw_ver = htonl(0xffffffff);
1115 	ret = t4_write_flash(adap, fw_img_start, SF_PAGE_SIZE, first_page);
1116 	if (ret)
1117 		goto out;
1118 
1119 	addr = fw_img_start;
1120 	for (size -= SF_PAGE_SIZE; size; size -= SF_PAGE_SIZE) {
1121 		addr += SF_PAGE_SIZE;
1122 		fw_data += SF_PAGE_SIZE;
1123 		ret = t4_write_flash(adap, addr, SF_PAGE_SIZE, fw_data);
1124 		if (ret)
1125 			goto out;
1126 	}
1127 
1128 	ret = t4_write_flash(adap,
1129 			     fw_img_start + offsetof(struct fw_hdr, fw_ver),
1130 			     sizeof(hdr->fw_ver), (const u8 *)&hdr->fw_ver);
1131 out:
1132 	if (ret)
1133 		dev_err(adap->pdev_dev, "firmware download failed, error %d\n",
1134 			ret);
1135 	return ret;
1136 }
1137 
1138 #define ADVERT_MASK (FW_PORT_CAP_SPEED_100M | FW_PORT_CAP_SPEED_1G |\
1139 		     FW_PORT_CAP_SPEED_10G | FW_PORT_CAP_ANEG)
1140 
1141 /**
1142  *	t4_link_start - apply link configuration to MAC/PHY
1143  *	@phy: the PHY to setup
1144  *	@mac: the MAC to setup
1145  *	@lc: the requested link configuration
1146  *
1147  *	Set up a port's MAC and PHY according to a desired link configuration.
1148  *	- If the PHY can auto-negotiate first decide what to advertise, then
1149  *	  enable/disable auto-negotiation as desired, and reset.
1150  *	- If the PHY does not auto-negotiate just reset it.
1151  *	- If auto-negotiation is off set the MAC to the proper speed/duplex/FC,
1152  *	  otherwise do it later based on the outcome of auto-negotiation.
1153  */
1154 int t4_link_start(struct adapter *adap, unsigned int mbox, unsigned int port,
1155 		  struct link_config *lc)
1156 {
1157 	struct fw_port_cmd c;
1158 	unsigned int fc = 0, mdi = FW_PORT_MDI(FW_PORT_MDI_AUTO);
1159 
1160 	lc->link_ok = 0;
1161 	if (lc->requested_fc & PAUSE_RX)
1162 		fc |= FW_PORT_CAP_FC_RX;
1163 	if (lc->requested_fc & PAUSE_TX)
1164 		fc |= FW_PORT_CAP_FC_TX;
1165 
1166 	memset(&c, 0, sizeof(c));
1167 	c.op_to_portid = htonl(FW_CMD_OP(FW_PORT_CMD) | FW_CMD_REQUEST |
1168 			       FW_CMD_EXEC | FW_PORT_CMD_PORTID(port));
1169 	c.action_to_len16 = htonl(FW_PORT_CMD_ACTION(FW_PORT_ACTION_L1_CFG) |
1170 				  FW_LEN16(c));
1171 
1172 	if (!(lc->supported & FW_PORT_CAP_ANEG)) {
1173 		c.u.l1cfg.rcap = htonl((lc->supported & ADVERT_MASK) | fc);
1174 		lc->fc = lc->requested_fc & (PAUSE_RX | PAUSE_TX);
1175 	} else if (lc->autoneg == AUTONEG_DISABLE) {
1176 		c.u.l1cfg.rcap = htonl(lc->requested_speed | fc | mdi);
1177 		lc->fc = lc->requested_fc & (PAUSE_RX | PAUSE_TX);
1178 	} else
1179 		c.u.l1cfg.rcap = htonl(lc->advertising | fc | mdi);
1180 
1181 	return t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
1182 }
1183 
1184 /**
1185  *	t4_restart_aneg - restart autonegotiation
1186  *	@adap: the adapter
1187  *	@mbox: mbox to use for the FW command
1188  *	@port: the port id
1189  *
1190  *	Restarts autonegotiation for the selected port.
1191  */
1192 int t4_restart_aneg(struct adapter *adap, unsigned int mbox, unsigned int port)
1193 {
1194 	struct fw_port_cmd c;
1195 
1196 	memset(&c, 0, sizeof(c));
1197 	c.op_to_portid = htonl(FW_CMD_OP(FW_PORT_CMD) | FW_CMD_REQUEST |
1198 			       FW_CMD_EXEC | FW_PORT_CMD_PORTID(port));
1199 	c.action_to_len16 = htonl(FW_PORT_CMD_ACTION(FW_PORT_ACTION_L1_CFG) |
1200 				  FW_LEN16(c));
1201 	c.u.l1cfg.rcap = htonl(FW_PORT_CAP_ANEG);
1202 	return t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
1203 }
1204 
1205 typedef void (*int_handler_t)(struct adapter *adap);
1206 
1207 struct intr_info {
1208 	unsigned int mask;       /* bits to check in interrupt status */
1209 	const char *msg;         /* message to print or NULL */
1210 	short stat_idx;          /* stat counter to increment or -1 */
1211 	unsigned short fatal;    /* whether the condition reported is fatal */
1212 	int_handler_t int_handler; /* platform-specific int handler */
1213 };
1214 
1215 /**
1216  *	t4_handle_intr_status - table driven interrupt handler
1217  *	@adapter: the adapter that generated the interrupt
1218  *	@reg: the interrupt status register to process
1219  *	@acts: table of interrupt actions
1220  *
1221  *	A table driven interrupt handler that applies a set of masks to an
1222  *	interrupt status word and performs the corresponding actions if the
1223  *	interrupts described by the mask have occurred.  The actions include
1224  *	optionally emitting a warning or alert message.  The table is terminated
1225  *	by an entry specifying mask 0.  Returns the number of fatal interrupt
1226  *	conditions.
1227  */
1228 static int t4_handle_intr_status(struct adapter *adapter, unsigned int reg,
1229 				 const struct intr_info *acts)
1230 {
1231 	int fatal = 0;
1232 	unsigned int mask = 0;
1233 	unsigned int status = t4_read_reg(adapter, reg);
1234 
1235 	for ( ; acts->mask; ++acts) {
1236 		if (!(status & acts->mask))
1237 			continue;
1238 		if (acts->fatal) {
1239 			fatal++;
1240 			dev_alert(adapter->pdev_dev, "%s (0x%x)\n", acts->msg,
1241 				  status & acts->mask);
1242 		} else if (acts->msg && printk_ratelimit())
1243 			dev_warn(adapter->pdev_dev, "%s (0x%x)\n", acts->msg,
1244 				 status & acts->mask);
1245 		if (acts->int_handler)
1246 			acts->int_handler(adapter);
1247 		mask |= acts->mask;
1248 	}
1249 	status &= mask;
1250 	if (status)                           /* clear processed interrupts */
1251 		t4_write_reg(adapter, reg, status);
1252 	return fatal;
1253 }
1254 
1255 /*
1256  * Interrupt handler for the PCIE module.
1257  */
1258 static void pcie_intr_handler(struct adapter *adapter)
1259 {
1260 	static const struct intr_info sysbus_intr_info[] = {
1261 		{ RNPP, "RXNP array parity error", -1, 1 },
1262 		{ RPCP, "RXPC array parity error", -1, 1 },
1263 		{ RCIP, "RXCIF array parity error", -1, 1 },
1264 		{ RCCP, "Rx completions control array parity error", -1, 1 },
1265 		{ RFTP, "RXFT array parity error", -1, 1 },
1266 		{ 0 }
1267 	};
1268 	static const struct intr_info pcie_port_intr_info[] = {
1269 		{ TPCP, "TXPC array parity error", -1, 1 },
1270 		{ TNPP, "TXNP array parity error", -1, 1 },
1271 		{ TFTP, "TXFT array parity error", -1, 1 },
1272 		{ TCAP, "TXCA array parity error", -1, 1 },
1273 		{ TCIP, "TXCIF array parity error", -1, 1 },
1274 		{ RCAP, "RXCA array parity error", -1, 1 },
1275 		{ OTDD, "outbound request TLP discarded", -1, 1 },
1276 		{ RDPE, "Rx data parity error", -1, 1 },
1277 		{ TDUE, "Tx uncorrectable data error", -1, 1 },
1278 		{ 0 }
1279 	};
1280 	static const struct intr_info pcie_intr_info[] = {
1281 		{ MSIADDRLPERR, "MSI AddrL parity error", -1, 1 },
1282 		{ MSIADDRHPERR, "MSI AddrH parity error", -1, 1 },
1283 		{ MSIDATAPERR, "MSI data parity error", -1, 1 },
1284 		{ MSIXADDRLPERR, "MSI-X AddrL parity error", -1, 1 },
1285 		{ MSIXADDRHPERR, "MSI-X AddrH parity error", -1, 1 },
1286 		{ MSIXDATAPERR, "MSI-X data parity error", -1, 1 },
1287 		{ MSIXDIPERR, "MSI-X DI parity error", -1, 1 },
1288 		{ PIOCPLPERR, "PCI PIO completion FIFO parity error", -1, 1 },
1289 		{ PIOREQPERR, "PCI PIO request FIFO parity error", -1, 1 },
1290 		{ TARTAGPERR, "PCI PCI target tag FIFO parity error", -1, 1 },
1291 		{ CCNTPERR, "PCI CMD channel count parity error", -1, 1 },
1292 		{ CREQPERR, "PCI CMD channel request parity error", -1, 1 },
1293 		{ CRSPPERR, "PCI CMD channel response parity error", -1, 1 },
1294 		{ DCNTPERR, "PCI DMA channel count parity error", -1, 1 },
1295 		{ DREQPERR, "PCI DMA channel request parity error", -1, 1 },
1296 		{ DRSPPERR, "PCI DMA channel response parity error", -1, 1 },
1297 		{ HCNTPERR, "PCI HMA channel count parity error", -1, 1 },
1298 		{ HREQPERR, "PCI HMA channel request parity error", -1, 1 },
1299 		{ HRSPPERR, "PCI HMA channel response parity error", -1, 1 },
1300 		{ CFGSNPPERR, "PCI config snoop FIFO parity error", -1, 1 },
1301 		{ FIDPERR, "PCI FID parity error", -1, 1 },
1302 		{ INTXCLRPERR, "PCI INTx clear parity error", -1, 1 },
1303 		{ MATAGPERR, "PCI MA tag parity error", -1, 1 },
1304 		{ PIOTAGPERR, "PCI PIO tag parity error", -1, 1 },
1305 		{ RXCPLPERR, "PCI Rx completion parity error", -1, 1 },
1306 		{ RXWRPERR, "PCI Rx write parity error", -1, 1 },
1307 		{ RPLPERR, "PCI replay buffer parity error", -1, 1 },
1308 		{ PCIESINT, "PCI core secondary fault", -1, 1 },
1309 		{ PCIEPINT, "PCI core primary fault", -1, 1 },
1310 		{ UNXSPLCPLERR, "PCI unexpected split completion error", -1, 0 },
1311 		{ 0 }
1312 	};
1313 
1314 	static struct intr_info t5_pcie_intr_info[] = {
1315 		{ MSTGRPPERR, "Master Response Read Queue parity error",
1316 		  -1, 1 },
1317 		{ MSTTIMEOUTPERR, "Master Timeout FIFO parity error", -1, 1 },
1318 		{ MSIXSTIPERR, "MSI-X STI SRAM parity error", -1, 1 },
1319 		{ MSIXADDRLPERR, "MSI-X AddrL parity error", -1, 1 },
1320 		{ MSIXADDRHPERR, "MSI-X AddrH parity error", -1, 1 },
1321 		{ MSIXDATAPERR, "MSI-X data parity error", -1, 1 },
1322 		{ MSIXDIPERR, "MSI-X DI parity error", -1, 1 },
1323 		{ PIOCPLGRPPERR, "PCI PIO completion Group FIFO parity error",
1324 		  -1, 1 },
1325 		{ PIOREQGRPPERR, "PCI PIO request Group FIFO parity error",
1326 		  -1, 1 },
1327 		{ TARTAGPERR, "PCI PCI target tag FIFO parity error", -1, 1 },
1328 		{ MSTTAGQPERR, "PCI master tag queue parity error", -1, 1 },
1329 		{ CREQPERR, "PCI CMD channel request parity error", -1, 1 },
1330 		{ CRSPPERR, "PCI CMD channel response parity error", -1, 1 },
1331 		{ DREQWRPERR, "PCI DMA channel write request parity error",
1332 		  -1, 1 },
1333 		{ DREQPERR, "PCI DMA channel request parity error", -1, 1 },
1334 		{ DRSPPERR, "PCI DMA channel response parity error", -1, 1 },
1335 		{ HREQWRPERR, "PCI HMA channel count parity error", -1, 1 },
1336 		{ HREQPERR, "PCI HMA channel request parity error", -1, 1 },
1337 		{ HRSPPERR, "PCI HMA channel response parity error", -1, 1 },
1338 		{ CFGSNPPERR, "PCI config snoop FIFO parity error", -1, 1 },
1339 		{ FIDPERR, "PCI FID parity error", -1, 1 },
1340 		{ VFIDPERR, "PCI INTx clear parity error", -1, 1 },
1341 		{ MAGRPPERR, "PCI MA group FIFO parity error", -1, 1 },
1342 		{ PIOTAGPERR, "PCI PIO tag parity error", -1, 1 },
1343 		{ IPRXHDRGRPPERR, "PCI IP Rx header group parity error",
1344 		  -1, 1 },
1345 		{ IPRXDATAGRPPERR, "PCI IP Rx data group parity error", -1, 1 },
1346 		{ RPLPERR, "PCI IP replay buffer parity error", -1, 1 },
1347 		{ IPSOTPERR, "PCI IP SOT buffer parity error", -1, 1 },
1348 		{ TRGT1GRPPERR, "PCI TRGT1 group FIFOs parity error", -1, 1 },
1349 		{ READRSPERR, "Outbound read error", -1, 0 },
1350 		{ 0 }
1351 	};
1352 
1353 	int fat;
1354 
1355 	fat = t4_handle_intr_status(adapter,
1356 				    PCIE_CORE_UTL_SYSTEM_BUS_AGENT_STATUS,
1357 				    sysbus_intr_info) +
1358 	      t4_handle_intr_status(adapter,
1359 				    PCIE_CORE_UTL_PCI_EXPRESS_PORT_STATUS,
1360 				    pcie_port_intr_info) +
1361 	      t4_handle_intr_status(adapter, PCIE_INT_CAUSE,
1362 				    is_t4(adapter->chip) ?
1363 				    pcie_intr_info : t5_pcie_intr_info);
1364 
1365 	if (fat)
1366 		t4_fatal_err(adapter);
1367 }
1368 
1369 /*
1370  * TP interrupt handler.
1371  */
1372 static void tp_intr_handler(struct adapter *adapter)
1373 {
1374 	static const struct intr_info tp_intr_info[] = {
1375 		{ 0x3fffffff, "TP parity error", -1, 1 },
1376 		{ FLMTXFLSTEMPTY, "TP out of Tx pages", -1, 1 },
1377 		{ 0 }
1378 	};
1379 
1380 	if (t4_handle_intr_status(adapter, TP_INT_CAUSE, tp_intr_info))
1381 		t4_fatal_err(adapter);
1382 }
1383 
1384 /*
1385  * SGE interrupt handler.
1386  */
1387 static void sge_intr_handler(struct adapter *adapter)
1388 {
1389 	u64 v;
1390 
1391 	static const struct intr_info sge_intr_info[] = {
1392 		{ ERR_CPL_EXCEED_IQE_SIZE,
1393 		  "SGE received CPL exceeding IQE size", -1, 1 },
1394 		{ ERR_INVALID_CIDX_INC,
1395 		  "SGE GTS CIDX increment too large", -1, 0 },
1396 		{ ERR_CPL_OPCODE_0, "SGE received 0-length CPL", -1, 0 },
1397 		{ DBFIFO_LP_INT, NULL, -1, 0, t4_db_full },
1398 		{ DBFIFO_HP_INT, NULL, -1, 0, t4_db_full },
1399 		{ ERR_DROPPED_DB, NULL, -1, 0, t4_db_dropped },
1400 		{ ERR_DATA_CPL_ON_HIGH_QID1 | ERR_DATA_CPL_ON_HIGH_QID0,
1401 		  "SGE IQID > 1023 received CPL for FL", -1, 0 },
1402 		{ ERR_BAD_DB_PIDX3, "SGE DBP 3 pidx increment too large", -1,
1403 		  0 },
1404 		{ ERR_BAD_DB_PIDX2, "SGE DBP 2 pidx increment too large", -1,
1405 		  0 },
1406 		{ ERR_BAD_DB_PIDX1, "SGE DBP 1 pidx increment too large", -1,
1407 		  0 },
1408 		{ ERR_BAD_DB_PIDX0, "SGE DBP 0 pidx increment too large", -1,
1409 		  0 },
1410 		{ ERR_ING_CTXT_PRIO,
1411 		  "SGE too many priority ingress contexts", -1, 0 },
1412 		{ ERR_EGR_CTXT_PRIO,
1413 		  "SGE too many priority egress contexts", -1, 0 },
1414 		{ INGRESS_SIZE_ERR, "SGE illegal ingress QID", -1, 0 },
1415 		{ EGRESS_SIZE_ERR, "SGE illegal egress QID", -1, 0 },
1416 		{ 0 }
1417 	};
1418 
1419 	v = (u64)t4_read_reg(adapter, SGE_INT_CAUSE1) |
1420 		((u64)t4_read_reg(adapter, SGE_INT_CAUSE2) << 32);
1421 	if (v) {
1422 		dev_alert(adapter->pdev_dev, "SGE parity error (%#llx)\n",
1423 				(unsigned long long)v);
1424 		t4_write_reg(adapter, SGE_INT_CAUSE1, v);
1425 		t4_write_reg(adapter, SGE_INT_CAUSE2, v >> 32);
1426 	}
1427 
1428 	if (t4_handle_intr_status(adapter, SGE_INT_CAUSE3, sge_intr_info) ||
1429 	    v != 0)
1430 		t4_fatal_err(adapter);
1431 }
1432 
1433 /*
1434  * CIM interrupt handler.
1435  */
1436 static void cim_intr_handler(struct adapter *adapter)
1437 {
1438 	static const struct intr_info cim_intr_info[] = {
1439 		{ PREFDROPINT, "CIM control register prefetch drop", -1, 1 },
1440 		{ OBQPARERR, "CIM OBQ parity error", -1, 1 },
1441 		{ IBQPARERR, "CIM IBQ parity error", -1, 1 },
1442 		{ MBUPPARERR, "CIM mailbox uP parity error", -1, 1 },
1443 		{ MBHOSTPARERR, "CIM mailbox host parity error", -1, 1 },
1444 		{ TIEQINPARERRINT, "CIM TIEQ outgoing parity error", -1, 1 },
1445 		{ TIEQOUTPARERRINT, "CIM TIEQ incoming parity error", -1, 1 },
1446 		{ 0 }
1447 	};
1448 	static const struct intr_info cim_upintr_info[] = {
1449 		{ RSVDSPACEINT, "CIM reserved space access", -1, 1 },
1450 		{ ILLTRANSINT, "CIM illegal transaction", -1, 1 },
1451 		{ ILLWRINT, "CIM illegal write", -1, 1 },
1452 		{ ILLRDINT, "CIM illegal read", -1, 1 },
1453 		{ ILLRDBEINT, "CIM illegal read BE", -1, 1 },
1454 		{ ILLWRBEINT, "CIM illegal write BE", -1, 1 },
1455 		{ SGLRDBOOTINT, "CIM single read from boot space", -1, 1 },
1456 		{ SGLWRBOOTINT, "CIM single write to boot space", -1, 1 },
1457 		{ BLKWRBOOTINT, "CIM block write to boot space", -1, 1 },
1458 		{ SGLRDFLASHINT, "CIM single read from flash space", -1, 1 },
1459 		{ SGLWRFLASHINT, "CIM single write to flash space", -1, 1 },
1460 		{ BLKWRFLASHINT, "CIM block write to flash space", -1, 1 },
1461 		{ SGLRDEEPROMINT, "CIM single EEPROM read", -1, 1 },
1462 		{ SGLWREEPROMINT, "CIM single EEPROM write", -1, 1 },
1463 		{ BLKRDEEPROMINT, "CIM block EEPROM read", -1, 1 },
1464 		{ BLKWREEPROMINT, "CIM block EEPROM write", -1, 1 },
1465 		{ SGLRDCTLINT , "CIM single read from CTL space", -1, 1 },
1466 		{ SGLWRCTLINT , "CIM single write to CTL space", -1, 1 },
1467 		{ BLKRDCTLINT , "CIM block read from CTL space", -1, 1 },
1468 		{ BLKWRCTLINT , "CIM block write to CTL space", -1, 1 },
1469 		{ SGLRDPLINT , "CIM single read from PL space", -1, 1 },
1470 		{ SGLWRPLINT , "CIM single write to PL space", -1, 1 },
1471 		{ BLKRDPLINT , "CIM block read from PL space", -1, 1 },
1472 		{ BLKWRPLINT , "CIM block write to PL space", -1, 1 },
1473 		{ REQOVRLOOKUPINT , "CIM request FIFO overwrite", -1, 1 },
1474 		{ RSPOVRLOOKUPINT , "CIM response FIFO overwrite", -1, 1 },
1475 		{ TIMEOUTINT , "CIM PIF timeout", -1, 1 },
1476 		{ TIMEOUTMAINT , "CIM PIF MA timeout", -1, 1 },
1477 		{ 0 }
1478 	};
1479 
1480 	int fat;
1481 
1482 	fat = t4_handle_intr_status(adapter, CIM_HOST_INT_CAUSE,
1483 				    cim_intr_info) +
1484 	      t4_handle_intr_status(adapter, CIM_HOST_UPACC_INT_CAUSE,
1485 				    cim_upintr_info);
1486 	if (fat)
1487 		t4_fatal_err(adapter);
1488 }
1489 
1490 /*
1491  * ULP RX interrupt handler.
1492  */
1493 static void ulprx_intr_handler(struct adapter *adapter)
1494 {
1495 	static const struct intr_info ulprx_intr_info[] = {
1496 		{ 0x1800000, "ULPRX context error", -1, 1 },
1497 		{ 0x7fffff, "ULPRX parity error", -1, 1 },
1498 		{ 0 }
1499 	};
1500 
1501 	if (t4_handle_intr_status(adapter, ULP_RX_INT_CAUSE, ulprx_intr_info))
1502 		t4_fatal_err(adapter);
1503 }
1504 
1505 /*
1506  * ULP TX interrupt handler.
1507  */
1508 static void ulptx_intr_handler(struct adapter *adapter)
1509 {
1510 	static const struct intr_info ulptx_intr_info[] = {
1511 		{ PBL_BOUND_ERR_CH3, "ULPTX channel 3 PBL out of bounds", -1,
1512 		  0 },
1513 		{ PBL_BOUND_ERR_CH2, "ULPTX channel 2 PBL out of bounds", -1,
1514 		  0 },
1515 		{ PBL_BOUND_ERR_CH1, "ULPTX channel 1 PBL out of bounds", -1,
1516 		  0 },
1517 		{ PBL_BOUND_ERR_CH0, "ULPTX channel 0 PBL out of bounds", -1,
1518 		  0 },
1519 		{ 0xfffffff, "ULPTX parity error", -1, 1 },
1520 		{ 0 }
1521 	};
1522 
1523 	if (t4_handle_intr_status(adapter, ULP_TX_INT_CAUSE, ulptx_intr_info))
1524 		t4_fatal_err(adapter);
1525 }
1526 
1527 /*
1528  * PM TX interrupt handler.
1529  */
1530 static void pmtx_intr_handler(struct adapter *adapter)
1531 {
1532 	static const struct intr_info pmtx_intr_info[] = {
1533 		{ PCMD_LEN_OVFL0, "PMTX channel 0 pcmd too large", -1, 1 },
1534 		{ PCMD_LEN_OVFL1, "PMTX channel 1 pcmd too large", -1, 1 },
1535 		{ PCMD_LEN_OVFL2, "PMTX channel 2 pcmd too large", -1, 1 },
1536 		{ ZERO_C_CMD_ERROR, "PMTX 0-length pcmd", -1, 1 },
1537 		{ PMTX_FRAMING_ERROR, "PMTX framing error", -1, 1 },
1538 		{ OESPI_PAR_ERROR, "PMTX oespi parity error", -1, 1 },
1539 		{ DB_OPTIONS_PAR_ERROR, "PMTX db_options parity error", -1, 1 },
1540 		{ ICSPI_PAR_ERROR, "PMTX icspi parity error", -1, 1 },
1541 		{ C_PCMD_PAR_ERROR, "PMTX c_pcmd parity error", -1, 1},
1542 		{ 0 }
1543 	};
1544 
1545 	if (t4_handle_intr_status(adapter, PM_TX_INT_CAUSE, pmtx_intr_info))
1546 		t4_fatal_err(adapter);
1547 }
1548 
1549 /*
1550  * PM RX interrupt handler.
1551  */
1552 static void pmrx_intr_handler(struct adapter *adapter)
1553 {
1554 	static const struct intr_info pmrx_intr_info[] = {
1555 		{ ZERO_E_CMD_ERROR, "PMRX 0-length pcmd", -1, 1 },
1556 		{ PMRX_FRAMING_ERROR, "PMRX framing error", -1, 1 },
1557 		{ OCSPI_PAR_ERROR, "PMRX ocspi parity error", -1, 1 },
1558 		{ DB_OPTIONS_PAR_ERROR, "PMRX db_options parity error", -1, 1 },
1559 		{ IESPI_PAR_ERROR, "PMRX iespi parity error", -1, 1 },
1560 		{ E_PCMD_PAR_ERROR, "PMRX e_pcmd parity error", -1, 1},
1561 		{ 0 }
1562 	};
1563 
1564 	if (t4_handle_intr_status(adapter, PM_RX_INT_CAUSE, pmrx_intr_info))
1565 		t4_fatal_err(adapter);
1566 }
1567 
1568 /*
1569  * CPL switch interrupt handler.
1570  */
1571 static void cplsw_intr_handler(struct adapter *adapter)
1572 {
1573 	static const struct intr_info cplsw_intr_info[] = {
1574 		{ CIM_OP_MAP_PERR, "CPLSW CIM op_map parity error", -1, 1 },
1575 		{ CIM_OVFL_ERROR, "CPLSW CIM overflow", -1, 1 },
1576 		{ TP_FRAMING_ERROR, "CPLSW TP framing error", -1, 1 },
1577 		{ SGE_FRAMING_ERROR, "CPLSW SGE framing error", -1, 1 },
1578 		{ CIM_FRAMING_ERROR, "CPLSW CIM framing error", -1, 1 },
1579 		{ ZERO_SWITCH_ERROR, "CPLSW no-switch error", -1, 1 },
1580 		{ 0 }
1581 	};
1582 
1583 	if (t4_handle_intr_status(adapter, CPL_INTR_CAUSE, cplsw_intr_info))
1584 		t4_fatal_err(adapter);
1585 }
1586 
1587 /*
1588  * LE interrupt handler.
1589  */
1590 static void le_intr_handler(struct adapter *adap)
1591 {
1592 	static const struct intr_info le_intr_info[] = {
1593 		{ LIPMISS, "LE LIP miss", -1, 0 },
1594 		{ LIP0, "LE 0 LIP error", -1, 0 },
1595 		{ PARITYERR, "LE parity error", -1, 1 },
1596 		{ UNKNOWNCMD, "LE unknown command", -1, 1 },
1597 		{ REQQPARERR, "LE request queue parity error", -1, 1 },
1598 		{ 0 }
1599 	};
1600 
1601 	if (t4_handle_intr_status(adap, LE_DB_INT_CAUSE, le_intr_info))
1602 		t4_fatal_err(adap);
1603 }
1604 
1605 /*
1606  * MPS interrupt handler.
1607  */
1608 static void mps_intr_handler(struct adapter *adapter)
1609 {
1610 	static const struct intr_info mps_rx_intr_info[] = {
1611 		{ 0xffffff, "MPS Rx parity error", -1, 1 },
1612 		{ 0 }
1613 	};
1614 	static const struct intr_info mps_tx_intr_info[] = {
1615 		{ TPFIFO, "MPS Tx TP FIFO parity error", -1, 1 },
1616 		{ NCSIFIFO, "MPS Tx NC-SI FIFO parity error", -1, 1 },
1617 		{ TXDATAFIFO, "MPS Tx data FIFO parity error", -1, 1 },
1618 		{ TXDESCFIFO, "MPS Tx desc FIFO parity error", -1, 1 },
1619 		{ BUBBLE, "MPS Tx underflow", -1, 1 },
1620 		{ SECNTERR, "MPS Tx SOP/EOP error", -1, 1 },
1621 		{ FRMERR, "MPS Tx framing error", -1, 1 },
1622 		{ 0 }
1623 	};
1624 	static const struct intr_info mps_trc_intr_info[] = {
1625 		{ FILTMEM, "MPS TRC filter parity error", -1, 1 },
1626 		{ PKTFIFO, "MPS TRC packet FIFO parity error", -1, 1 },
1627 		{ MISCPERR, "MPS TRC misc parity error", -1, 1 },
1628 		{ 0 }
1629 	};
1630 	static const struct intr_info mps_stat_sram_intr_info[] = {
1631 		{ 0x1fffff, "MPS statistics SRAM parity error", -1, 1 },
1632 		{ 0 }
1633 	};
1634 	static const struct intr_info mps_stat_tx_intr_info[] = {
1635 		{ 0xfffff, "MPS statistics Tx FIFO parity error", -1, 1 },
1636 		{ 0 }
1637 	};
1638 	static const struct intr_info mps_stat_rx_intr_info[] = {
1639 		{ 0xffffff, "MPS statistics Rx FIFO parity error", -1, 1 },
1640 		{ 0 }
1641 	};
1642 	static const struct intr_info mps_cls_intr_info[] = {
1643 		{ MATCHSRAM, "MPS match SRAM parity error", -1, 1 },
1644 		{ MATCHTCAM, "MPS match TCAM parity error", -1, 1 },
1645 		{ HASHSRAM, "MPS hash SRAM parity error", -1, 1 },
1646 		{ 0 }
1647 	};
1648 
1649 	int fat;
1650 
1651 	fat = t4_handle_intr_status(adapter, MPS_RX_PERR_INT_CAUSE,
1652 				    mps_rx_intr_info) +
1653 	      t4_handle_intr_status(adapter, MPS_TX_INT_CAUSE,
1654 				    mps_tx_intr_info) +
1655 	      t4_handle_intr_status(adapter, MPS_TRC_INT_CAUSE,
1656 				    mps_trc_intr_info) +
1657 	      t4_handle_intr_status(adapter, MPS_STAT_PERR_INT_CAUSE_SRAM,
1658 				    mps_stat_sram_intr_info) +
1659 	      t4_handle_intr_status(adapter, MPS_STAT_PERR_INT_CAUSE_TX_FIFO,
1660 				    mps_stat_tx_intr_info) +
1661 	      t4_handle_intr_status(adapter, MPS_STAT_PERR_INT_CAUSE_RX_FIFO,
1662 				    mps_stat_rx_intr_info) +
1663 	      t4_handle_intr_status(adapter, MPS_CLS_INT_CAUSE,
1664 				    mps_cls_intr_info);
1665 
1666 	t4_write_reg(adapter, MPS_INT_CAUSE, CLSINT | TRCINT |
1667 		     RXINT | TXINT | STATINT);
1668 	t4_read_reg(adapter, MPS_INT_CAUSE);                    /* flush */
1669 	if (fat)
1670 		t4_fatal_err(adapter);
1671 }
1672 
1673 #define MEM_INT_MASK (PERR_INT_CAUSE | ECC_CE_INT_CAUSE | ECC_UE_INT_CAUSE)
1674 
1675 /*
1676  * EDC/MC interrupt handler.
1677  */
1678 static void mem_intr_handler(struct adapter *adapter, int idx)
1679 {
1680 	static const char name[3][5] = { "EDC0", "EDC1", "MC" };
1681 
1682 	unsigned int addr, cnt_addr, v;
1683 
1684 	if (idx <= MEM_EDC1) {
1685 		addr = EDC_REG(EDC_INT_CAUSE, idx);
1686 		cnt_addr = EDC_REG(EDC_ECC_STATUS, idx);
1687 	} else {
1688 		addr = MC_INT_CAUSE;
1689 		cnt_addr = MC_ECC_STATUS;
1690 	}
1691 
1692 	v = t4_read_reg(adapter, addr) & MEM_INT_MASK;
1693 	if (v & PERR_INT_CAUSE)
1694 		dev_alert(adapter->pdev_dev, "%s FIFO parity error\n",
1695 			  name[idx]);
1696 	if (v & ECC_CE_INT_CAUSE) {
1697 		u32 cnt = ECC_CECNT_GET(t4_read_reg(adapter, cnt_addr));
1698 
1699 		t4_write_reg(adapter, cnt_addr, ECC_CECNT_MASK);
1700 		if (printk_ratelimit())
1701 			dev_warn(adapter->pdev_dev,
1702 				 "%u %s correctable ECC data error%s\n",
1703 				 cnt, name[idx], cnt > 1 ? "s" : "");
1704 	}
1705 	if (v & ECC_UE_INT_CAUSE)
1706 		dev_alert(adapter->pdev_dev,
1707 			  "%s uncorrectable ECC data error\n", name[idx]);
1708 
1709 	t4_write_reg(adapter, addr, v);
1710 	if (v & (PERR_INT_CAUSE | ECC_UE_INT_CAUSE))
1711 		t4_fatal_err(adapter);
1712 }
1713 
1714 /*
1715  * MA interrupt handler.
1716  */
1717 static void ma_intr_handler(struct adapter *adap)
1718 {
1719 	u32 v, status = t4_read_reg(adap, MA_INT_CAUSE);
1720 
1721 	if (status & MEM_PERR_INT_CAUSE)
1722 		dev_alert(adap->pdev_dev,
1723 			  "MA parity error, parity status %#x\n",
1724 			  t4_read_reg(adap, MA_PARITY_ERROR_STATUS));
1725 	if (status & MEM_WRAP_INT_CAUSE) {
1726 		v = t4_read_reg(adap, MA_INT_WRAP_STATUS);
1727 		dev_alert(adap->pdev_dev, "MA address wrap-around error by "
1728 			  "client %u to address %#x\n",
1729 			  MEM_WRAP_CLIENT_NUM_GET(v),
1730 			  MEM_WRAP_ADDRESS_GET(v) << 4);
1731 	}
1732 	t4_write_reg(adap, MA_INT_CAUSE, status);
1733 	t4_fatal_err(adap);
1734 }
1735 
1736 /*
1737  * SMB interrupt handler.
1738  */
1739 static void smb_intr_handler(struct adapter *adap)
1740 {
1741 	static const struct intr_info smb_intr_info[] = {
1742 		{ MSTTXFIFOPARINT, "SMB master Tx FIFO parity error", -1, 1 },
1743 		{ MSTRXFIFOPARINT, "SMB master Rx FIFO parity error", -1, 1 },
1744 		{ SLVFIFOPARINT, "SMB slave FIFO parity error", -1, 1 },
1745 		{ 0 }
1746 	};
1747 
1748 	if (t4_handle_intr_status(adap, SMB_INT_CAUSE, smb_intr_info))
1749 		t4_fatal_err(adap);
1750 }
1751 
1752 /*
1753  * NC-SI interrupt handler.
1754  */
1755 static void ncsi_intr_handler(struct adapter *adap)
1756 {
1757 	static const struct intr_info ncsi_intr_info[] = {
1758 		{ CIM_DM_PRTY_ERR, "NC-SI CIM parity error", -1, 1 },
1759 		{ MPS_DM_PRTY_ERR, "NC-SI MPS parity error", -1, 1 },
1760 		{ TXFIFO_PRTY_ERR, "NC-SI Tx FIFO parity error", -1, 1 },
1761 		{ RXFIFO_PRTY_ERR, "NC-SI Rx FIFO parity error", -1, 1 },
1762 		{ 0 }
1763 	};
1764 
1765 	if (t4_handle_intr_status(adap, NCSI_INT_CAUSE, ncsi_intr_info))
1766 		t4_fatal_err(adap);
1767 }
1768 
1769 /*
1770  * XGMAC interrupt handler.
1771  */
1772 static void xgmac_intr_handler(struct adapter *adap, int port)
1773 {
1774 	u32 v, int_cause_reg;
1775 
1776 	if (is_t4(adap->chip))
1777 		int_cause_reg = PORT_REG(port, XGMAC_PORT_INT_CAUSE);
1778 	else
1779 		int_cause_reg = T5_PORT_REG(port, MAC_PORT_INT_CAUSE);
1780 
1781 	v = t4_read_reg(adap, int_cause_reg);
1782 
1783 	v &= TXFIFO_PRTY_ERR | RXFIFO_PRTY_ERR;
1784 	if (!v)
1785 		return;
1786 
1787 	if (v & TXFIFO_PRTY_ERR)
1788 		dev_alert(adap->pdev_dev, "XGMAC %d Tx FIFO parity error\n",
1789 			  port);
1790 	if (v & RXFIFO_PRTY_ERR)
1791 		dev_alert(adap->pdev_dev, "XGMAC %d Rx FIFO parity error\n",
1792 			  port);
1793 	t4_write_reg(adap, PORT_REG(port, XGMAC_PORT_INT_CAUSE), v);
1794 	t4_fatal_err(adap);
1795 }
1796 
1797 /*
1798  * PL interrupt handler.
1799  */
1800 static void pl_intr_handler(struct adapter *adap)
1801 {
1802 	static const struct intr_info pl_intr_info[] = {
1803 		{ FATALPERR, "T4 fatal parity error", -1, 1 },
1804 		{ PERRVFID, "PL VFID_MAP parity error", -1, 1 },
1805 		{ 0 }
1806 	};
1807 
1808 	if (t4_handle_intr_status(adap, PL_PL_INT_CAUSE, pl_intr_info))
1809 		t4_fatal_err(adap);
1810 }
1811 
1812 #define PF_INTR_MASK (PFSW)
1813 #define GLBL_INTR_MASK (CIM | MPS | PL | PCIE | MC | EDC0 | \
1814 		EDC1 | LE | TP | MA | PM_TX | PM_RX | ULP_RX | \
1815 		CPL_SWITCH | SGE | ULP_TX)
1816 
1817 /**
1818  *	t4_slow_intr_handler - control path interrupt handler
1819  *	@adapter: the adapter
1820  *
1821  *	T4 interrupt handler for non-data global interrupt events, e.g., errors.
1822  *	The designation 'slow' is because it involves register reads, while
1823  *	data interrupts typically don't involve any MMIOs.
1824  */
1825 int t4_slow_intr_handler(struct adapter *adapter)
1826 {
1827 	u32 cause = t4_read_reg(adapter, PL_INT_CAUSE);
1828 
1829 	if (!(cause & GLBL_INTR_MASK))
1830 		return 0;
1831 	if (cause & CIM)
1832 		cim_intr_handler(adapter);
1833 	if (cause & MPS)
1834 		mps_intr_handler(adapter);
1835 	if (cause & NCSI)
1836 		ncsi_intr_handler(adapter);
1837 	if (cause & PL)
1838 		pl_intr_handler(adapter);
1839 	if (cause & SMB)
1840 		smb_intr_handler(adapter);
1841 	if (cause & XGMAC0)
1842 		xgmac_intr_handler(adapter, 0);
1843 	if (cause & XGMAC1)
1844 		xgmac_intr_handler(adapter, 1);
1845 	if (cause & XGMAC_KR0)
1846 		xgmac_intr_handler(adapter, 2);
1847 	if (cause & XGMAC_KR1)
1848 		xgmac_intr_handler(adapter, 3);
1849 	if (cause & PCIE)
1850 		pcie_intr_handler(adapter);
1851 	if (cause & MC)
1852 		mem_intr_handler(adapter, MEM_MC);
1853 	if (cause & EDC0)
1854 		mem_intr_handler(adapter, MEM_EDC0);
1855 	if (cause & EDC1)
1856 		mem_intr_handler(adapter, MEM_EDC1);
1857 	if (cause & LE)
1858 		le_intr_handler(adapter);
1859 	if (cause & TP)
1860 		tp_intr_handler(adapter);
1861 	if (cause & MA)
1862 		ma_intr_handler(adapter);
1863 	if (cause & PM_TX)
1864 		pmtx_intr_handler(adapter);
1865 	if (cause & PM_RX)
1866 		pmrx_intr_handler(adapter);
1867 	if (cause & ULP_RX)
1868 		ulprx_intr_handler(adapter);
1869 	if (cause & CPL_SWITCH)
1870 		cplsw_intr_handler(adapter);
1871 	if (cause & SGE)
1872 		sge_intr_handler(adapter);
1873 	if (cause & ULP_TX)
1874 		ulptx_intr_handler(adapter);
1875 
1876 	/* Clear the interrupts just processed for which we are the master. */
1877 	t4_write_reg(adapter, PL_INT_CAUSE, cause & GLBL_INTR_MASK);
1878 	(void) t4_read_reg(adapter, PL_INT_CAUSE); /* flush */
1879 	return 1;
1880 }
1881 
1882 /**
1883  *	t4_intr_enable - enable interrupts
1884  *	@adapter: the adapter whose interrupts should be enabled
1885  *
1886  *	Enable PF-specific interrupts for the calling function and the top-level
1887  *	interrupt concentrator for global interrupts.  Interrupts are already
1888  *	enabled at each module,	here we just enable the roots of the interrupt
1889  *	hierarchies.
1890  *
1891  *	Note: this function should be called only when the driver manages
1892  *	non PF-specific interrupts from the various HW modules.  Only one PCI
1893  *	function at a time should be doing this.
1894  */
1895 void t4_intr_enable(struct adapter *adapter)
1896 {
1897 	u32 pf = SOURCEPF_GET(t4_read_reg(adapter, PL_WHOAMI));
1898 
1899 	t4_write_reg(adapter, SGE_INT_ENABLE3, ERR_CPL_EXCEED_IQE_SIZE |
1900 		     ERR_INVALID_CIDX_INC | ERR_CPL_OPCODE_0 |
1901 		     ERR_DROPPED_DB | ERR_DATA_CPL_ON_HIGH_QID1 |
1902 		     ERR_DATA_CPL_ON_HIGH_QID0 | ERR_BAD_DB_PIDX3 |
1903 		     ERR_BAD_DB_PIDX2 | ERR_BAD_DB_PIDX1 |
1904 		     ERR_BAD_DB_PIDX0 | ERR_ING_CTXT_PRIO |
1905 		     ERR_EGR_CTXT_PRIO | INGRESS_SIZE_ERR |
1906 		     DBFIFO_HP_INT | DBFIFO_LP_INT |
1907 		     EGRESS_SIZE_ERR);
1908 	t4_write_reg(adapter, MYPF_REG(PL_PF_INT_ENABLE), PF_INTR_MASK);
1909 	t4_set_reg_field(adapter, PL_INT_MAP0, 0, 1 << pf);
1910 }
1911 
1912 /**
1913  *	t4_intr_disable - disable interrupts
1914  *	@adapter: the adapter whose interrupts should be disabled
1915  *
1916  *	Disable interrupts.  We only disable the top-level interrupt
1917  *	concentrators.  The caller must be a PCI function managing global
1918  *	interrupts.
1919  */
1920 void t4_intr_disable(struct adapter *adapter)
1921 {
1922 	u32 pf = SOURCEPF_GET(t4_read_reg(adapter, PL_WHOAMI));
1923 
1924 	t4_write_reg(adapter, MYPF_REG(PL_PF_INT_ENABLE), 0);
1925 	t4_set_reg_field(adapter, PL_INT_MAP0, 1 << pf, 0);
1926 }
1927 
1928 /**
1929  *	hash_mac_addr - return the hash value of a MAC address
1930  *	@addr: the 48-bit Ethernet MAC address
1931  *
1932  *	Hashes a MAC address according to the hash function used by HW inexact
1933  *	(hash) address matching.
1934  */
1935 static int hash_mac_addr(const u8 *addr)
1936 {
1937 	u32 a = ((u32)addr[0] << 16) | ((u32)addr[1] << 8) | addr[2];
1938 	u32 b = ((u32)addr[3] << 16) | ((u32)addr[4] << 8) | addr[5];
1939 	a ^= b;
1940 	a ^= (a >> 12);
1941 	a ^= (a >> 6);
1942 	return a & 0x3f;
1943 }
1944 
1945 /**
1946  *	t4_config_rss_range - configure a portion of the RSS mapping table
1947  *	@adapter: the adapter
1948  *	@mbox: mbox to use for the FW command
1949  *	@viid: virtual interface whose RSS subtable is to be written
1950  *	@start: start entry in the table to write
1951  *	@n: how many table entries to write
1952  *	@rspq: values for the response queue lookup table
1953  *	@nrspq: number of values in @rspq
1954  *
1955  *	Programs the selected part of the VI's RSS mapping table with the
1956  *	provided values.  If @nrspq < @n the supplied values are used repeatedly
1957  *	until the full table range is populated.
1958  *
1959  *	The caller must ensure the values in @rspq are in the range allowed for
1960  *	@viid.
1961  */
1962 int t4_config_rss_range(struct adapter *adapter, int mbox, unsigned int viid,
1963 			int start, int n, const u16 *rspq, unsigned int nrspq)
1964 {
1965 	int ret;
1966 	const u16 *rsp = rspq;
1967 	const u16 *rsp_end = rspq + nrspq;
1968 	struct fw_rss_ind_tbl_cmd cmd;
1969 
1970 	memset(&cmd, 0, sizeof(cmd));
1971 	cmd.op_to_viid = htonl(FW_CMD_OP(FW_RSS_IND_TBL_CMD) |
1972 			       FW_CMD_REQUEST | FW_CMD_WRITE |
1973 			       FW_RSS_IND_TBL_CMD_VIID(viid));
1974 	cmd.retval_len16 = htonl(FW_LEN16(cmd));
1975 
1976 	/* each fw_rss_ind_tbl_cmd takes up to 32 entries */
1977 	while (n > 0) {
1978 		int nq = min(n, 32);
1979 		__be32 *qp = &cmd.iq0_to_iq2;
1980 
1981 		cmd.niqid = htons(nq);
1982 		cmd.startidx = htons(start);
1983 
1984 		start += nq;
1985 		n -= nq;
1986 
1987 		while (nq > 0) {
1988 			unsigned int v;
1989 
1990 			v = FW_RSS_IND_TBL_CMD_IQ0(*rsp);
1991 			if (++rsp >= rsp_end)
1992 				rsp = rspq;
1993 			v |= FW_RSS_IND_TBL_CMD_IQ1(*rsp);
1994 			if (++rsp >= rsp_end)
1995 				rsp = rspq;
1996 			v |= FW_RSS_IND_TBL_CMD_IQ2(*rsp);
1997 			if (++rsp >= rsp_end)
1998 				rsp = rspq;
1999 
2000 			*qp++ = htonl(v);
2001 			nq -= 3;
2002 		}
2003 
2004 		ret = t4_wr_mbox(adapter, mbox, &cmd, sizeof(cmd), NULL);
2005 		if (ret)
2006 			return ret;
2007 	}
2008 	return 0;
2009 }
2010 
2011 /**
2012  *	t4_config_glbl_rss - configure the global RSS mode
2013  *	@adapter: the adapter
2014  *	@mbox: mbox to use for the FW command
2015  *	@mode: global RSS mode
2016  *	@flags: mode-specific flags
2017  *
2018  *	Sets the global RSS mode.
2019  */
2020 int t4_config_glbl_rss(struct adapter *adapter, int mbox, unsigned int mode,
2021 		       unsigned int flags)
2022 {
2023 	struct fw_rss_glb_config_cmd c;
2024 
2025 	memset(&c, 0, sizeof(c));
2026 	c.op_to_write = htonl(FW_CMD_OP(FW_RSS_GLB_CONFIG_CMD) |
2027 			      FW_CMD_REQUEST | FW_CMD_WRITE);
2028 	c.retval_len16 = htonl(FW_LEN16(c));
2029 	if (mode == FW_RSS_GLB_CONFIG_CMD_MODE_MANUAL) {
2030 		c.u.manual.mode_pkd = htonl(FW_RSS_GLB_CONFIG_CMD_MODE(mode));
2031 	} else if (mode == FW_RSS_GLB_CONFIG_CMD_MODE_BASICVIRTUAL) {
2032 		c.u.basicvirtual.mode_pkd =
2033 			htonl(FW_RSS_GLB_CONFIG_CMD_MODE(mode));
2034 		c.u.basicvirtual.synmapen_to_hashtoeplitz = htonl(flags);
2035 	} else
2036 		return -EINVAL;
2037 	return t4_wr_mbox(adapter, mbox, &c, sizeof(c), NULL);
2038 }
2039 
2040 /**
2041  *	t4_tp_get_tcp_stats - read TP's TCP MIB counters
2042  *	@adap: the adapter
2043  *	@v4: holds the TCP/IP counter values
2044  *	@v6: holds the TCP/IPv6 counter values
2045  *
2046  *	Returns the values of TP's TCP/IP and TCP/IPv6 MIB counters.
2047  *	Either @v4 or @v6 may be %NULL to skip the corresponding stats.
2048  */
2049 void t4_tp_get_tcp_stats(struct adapter *adap, struct tp_tcp_stats *v4,
2050 			 struct tp_tcp_stats *v6)
2051 {
2052 	u32 val[TP_MIB_TCP_RXT_SEG_LO - TP_MIB_TCP_OUT_RST + 1];
2053 
2054 #define STAT_IDX(x) ((TP_MIB_TCP_##x) - TP_MIB_TCP_OUT_RST)
2055 #define STAT(x)     val[STAT_IDX(x)]
2056 #define STAT64(x)   (((u64)STAT(x##_HI) << 32) | STAT(x##_LO))
2057 
2058 	if (v4) {
2059 		t4_read_indirect(adap, TP_MIB_INDEX, TP_MIB_DATA, val,
2060 				 ARRAY_SIZE(val), TP_MIB_TCP_OUT_RST);
2061 		v4->tcpOutRsts = STAT(OUT_RST);
2062 		v4->tcpInSegs  = STAT64(IN_SEG);
2063 		v4->tcpOutSegs = STAT64(OUT_SEG);
2064 		v4->tcpRetransSegs = STAT64(RXT_SEG);
2065 	}
2066 	if (v6) {
2067 		t4_read_indirect(adap, TP_MIB_INDEX, TP_MIB_DATA, val,
2068 				 ARRAY_SIZE(val), TP_MIB_TCP_V6OUT_RST);
2069 		v6->tcpOutRsts = STAT(OUT_RST);
2070 		v6->tcpInSegs  = STAT64(IN_SEG);
2071 		v6->tcpOutSegs = STAT64(OUT_SEG);
2072 		v6->tcpRetransSegs = STAT64(RXT_SEG);
2073 	}
2074 #undef STAT64
2075 #undef STAT
2076 #undef STAT_IDX
2077 }
2078 
2079 /**
2080  *	t4_read_mtu_tbl - returns the values in the HW path MTU table
2081  *	@adap: the adapter
2082  *	@mtus: where to store the MTU values
2083  *	@mtu_log: where to store the MTU base-2 log (may be %NULL)
2084  *
2085  *	Reads the HW path MTU table.
2086  */
2087 void t4_read_mtu_tbl(struct adapter *adap, u16 *mtus, u8 *mtu_log)
2088 {
2089 	u32 v;
2090 	int i;
2091 
2092 	for (i = 0; i < NMTUS; ++i) {
2093 		t4_write_reg(adap, TP_MTU_TABLE,
2094 			     MTUINDEX(0xff) | MTUVALUE(i));
2095 		v = t4_read_reg(adap, TP_MTU_TABLE);
2096 		mtus[i] = MTUVALUE_GET(v);
2097 		if (mtu_log)
2098 			mtu_log[i] = MTUWIDTH_GET(v);
2099 	}
2100 }
2101 
2102 /**
2103  *	t4_tp_wr_bits_indirect - set/clear bits in an indirect TP register
2104  *	@adap: the adapter
2105  *	@addr: the indirect TP register address
2106  *	@mask: specifies the field within the register to modify
2107  *	@val: new value for the field
2108  *
2109  *	Sets a field of an indirect TP register to the given value.
2110  */
2111 void t4_tp_wr_bits_indirect(struct adapter *adap, unsigned int addr,
2112 			    unsigned int mask, unsigned int val)
2113 {
2114 	t4_write_reg(adap, TP_PIO_ADDR, addr);
2115 	val |= t4_read_reg(adap, TP_PIO_DATA) & ~mask;
2116 	t4_write_reg(adap, TP_PIO_DATA, val);
2117 }
2118 
2119 /**
2120  *	init_cong_ctrl - initialize congestion control parameters
2121  *	@a: the alpha values for congestion control
2122  *	@b: the beta values for congestion control
2123  *
2124  *	Initialize the congestion control parameters.
2125  */
2126 static void init_cong_ctrl(unsigned short *a, unsigned short *b)
2127 {
2128 	a[0] = a[1] = a[2] = a[3] = a[4] = a[5] = a[6] = a[7] = a[8] = 1;
2129 	a[9] = 2;
2130 	a[10] = 3;
2131 	a[11] = 4;
2132 	a[12] = 5;
2133 	a[13] = 6;
2134 	a[14] = 7;
2135 	a[15] = 8;
2136 	a[16] = 9;
2137 	a[17] = 10;
2138 	a[18] = 14;
2139 	a[19] = 17;
2140 	a[20] = 21;
2141 	a[21] = 25;
2142 	a[22] = 30;
2143 	a[23] = 35;
2144 	a[24] = 45;
2145 	a[25] = 60;
2146 	a[26] = 80;
2147 	a[27] = 100;
2148 	a[28] = 200;
2149 	a[29] = 300;
2150 	a[30] = 400;
2151 	a[31] = 500;
2152 
2153 	b[0] = b[1] = b[2] = b[3] = b[4] = b[5] = b[6] = b[7] = b[8] = 0;
2154 	b[9] = b[10] = 1;
2155 	b[11] = b[12] = 2;
2156 	b[13] = b[14] = b[15] = b[16] = 3;
2157 	b[17] = b[18] = b[19] = b[20] = b[21] = 4;
2158 	b[22] = b[23] = b[24] = b[25] = b[26] = b[27] = 5;
2159 	b[28] = b[29] = 6;
2160 	b[30] = b[31] = 7;
2161 }
2162 
2163 /* The minimum additive increment value for the congestion control table */
2164 #define CC_MIN_INCR 2U
2165 
2166 /**
2167  *	t4_load_mtus - write the MTU and congestion control HW tables
2168  *	@adap: the adapter
2169  *	@mtus: the values for the MTU table
2170  *	@alpha: the values for the congestion control alpha parameter
2171  *	@beta: the values for the congestion control beta parameter
2172  *
2173  *	Write the HW MTU table with the supplied MTUs and the high-speed
2174  *	congestion control table with the supplied alpha, beta, and MTUs.
2175  *	We write the two tables together because the additive increments
2176  *	depend on the MTUs.
2177  */
2178 void t4_load_mtus(struct adapter *adap, const unsigned short *mtus,
2179 		  const unsigned short *alpha, const unsigned short *beta)
2180 {
2181 	static const unsigned int avg_pkts[NCCTRL_WIN] = {
2182 		2, 6, 10, 14, 20, 28, 40, 56, 80, 112, 160, 224, 320, 448, 640,
2183 		896, 1281, 1792, 2560, 3584, 5120, 7168, 10240, 14336, 20480,
2184 		28672, 40960, 57344, 81920, 114688, 163840, 229376
2185 	};
2186 
2187 	unsigned int i, w;
2188 
2189 	for (i = 0; i < NMTUS; ++i) {
2190 		unsigned int mtu = mtus[i];
2191 		unsigned int log2 = fls(mtu);
2192 
2193 		if (!(mtu & ((1 << log2) >> 2)))     /* round */
2194 			log2--;
2195 		t4_write_reg(adap, TP_MTU_TABLE, MTUINDEX(i) |
2196 			     MTUWIDTH(log2) | MTUVALUE(mtu));
2197 
2198 		for (w = 0; w < NCCTRL_WIN; ++w) {
2199 			unsigned int inc;
2200 
2201 			inc = max(((mtu - 40) * alpha[w]) / avg_pkts[w],
2202 				  CC_MIN_INCR);
2203 
2204 			t4_write_reg(adap, TP_CCTRL_TABLE, (i << 21) |
2205 				     (w << 16) | (beta[w] << 13) | inc);
2206 		}
2207 	}
2208 }
2209 
2210 /**
2211  *	get_mps_bg_map - return the buffer groups associated with a port
2212  *	@adap: the adapter
2213  *	@idx: the port index
2214  *
2215  *	Returns a bitmap indicating which MPS buffer groups are associated
2216  *	with the given port.  Bit i is set if buffer group i is used by the
2217  *	port.
2218  */
2219 static unsigned int get_mps_bg_map(struct adapter *adap, int idx)
2220 {
2221 	u32 n = NUMPORTS_GET(t4_read_reg(adap, MPS_CMN_CTL));
2222 
2223 	if (n == 0)
2224 		return idx == 0 ? 0xf : 0;
2225 	if (n == 1)
2226 		return idx < 2 ? (3 << (2 * idx)) : 0;
2227 	return 1 << idx;
2228 }
2229 
2230 /**
2231  *	t4_get_port_stats - collect port statistics
2232  *	@adap: the adapter
2233  *	@idx: the port index
2234  *	@p: the stats structure to fill
2235  *
2236  *	Collect statistics related to the given port from HW.
2237  */
2238 void t4_get_port_stats(struct adapter *adap, int idx, struct port_stats *p)
2239 {
2240 	u32 bgmap = get_mps_bg_map(adap, idx);
2241 
2242 #define GET_STAT(name) \
2243 	t4_read_reg64(adap, \
2244 	(is_t4(adap->chip) ? PORT_REG(idx, MPS_PORT_STAT_##name##_L) : \
2245 	T5_PORT_REG(idx, MPS_PORT_STAT_##name##_L)))
2246 #define GET_STAT_COM(name) t4_read_reg64(adap, MPS_STAT_##name##_L)
2247 
2248 	p->tx_octets           = GET_STAT(TX_PORT_BYTES);
2249 	p->tx_frames           = GET_STAT(TX_PORT_FRAMES);
2250 	p->tx_bcast_frames     = GET_STAT(TX_PORT_BCAST);
2251 	p->tx_mcast_frames     = GET_STAT(TX_PORT_MCAST);
2252 	p->tx_ucast_frames     = GET_STAT(TX_PORT_UCAST);
2253 	p->tx_error_frames     = GET_STAT(TX_PORT_ERROR);
2254 	p->tx_frames_64        = GET_STAT(TX_PORT_64B);
2255 	p->tx_frames_65_127    = GET_STAT(TX_PORT_65B_127B);
2256 	p->tx_frames_128_255   = GET_STAT(TX_PORT_128B_255B);
2257 	p->tx_frames_256_511   = GET_STAT(TX_PORT_256B_511B);
2258 	p->tx_frames_512_1023  = GET_STAT(TX_PORT_512B_1023B);
2259 	p->tx_frames_1024_1518 = GET_STAT(TX_PORT_1024B_1518B);
2260 	p->tx_frames_1519_max  = GET_STAT(TX_PORT_1519B_MAX);
2261 	p->tx_drop             = GET_STAT(TX_PORT_DROP);
2262 	p->tx_pause            = GET_STAT(TX_PORT_PAUSE);
2263 	p->tx_ppp0             = GET_STAT(TX_PORT_PPP0);
2264 	p->tx_ppp1             = GET_STAT(TX_PORT_PPP1);
2265 	p->tx_ppp2             = GET_STAT(TX_PORT_PPP2);
2266 	p->tx_ppp3             = GET_STAT(TX_PORT_PPP3);
2267 	p->tx_ppp4             = GET_STAT(TX_PORT_PPP4);
2268 	p->tx_ppp5             = GET_STAT(TX_PORT_PPP5);
2269 	p->tx_ppp6             = GET_STAT(TX_PORT_PPP6);
2270 	p->tx_ppp7             = GET_STAT(TX_PORT_PPP7);
2271 
2272 	p->rx_octets           = GET_STAT(RX_PORT_BYTES);
2273 	p->rx_frames           = GET_STAT(RX_PORT_FRAMES);
2274 	p->rx_bcast_frames     = GET_STAT(RX_PORT_BCAST);
2275 	p->rx_mcast_frames     = GET_STAT(RX_PORT_MCAST);
2276 	p->rx_ucast_frames     = GET_STAT(RX_PORT_UCAST);
2277 	p->rx_too_long         = GET_STAT(RX_PORT_MTU_ERROR);
2278 	p->rx_jabber           = GET_STAT(RX_PORT_MTU_CRC_ERROR);
2279 	p->rx_fcs_err          = GET_STAT(RX_PORT_CRC_ERROR);
2280 	p->rx_len_err          = GET_STAT(RX_PORT_LEN_ERROR);
2281 	p->rx_symbol_err       = GET_STAT(RX_PORT_SYM_ERROR);
2282 	p->rx_runt             = GET_STAT(RX_PORT_LESS_64B);
2283 	p->rx_frames_64        = GET_STAT(RX_PORT_64B);
2284 	p->rx_frames_65_127    = GET_STAT(RX_PORT_65B_127B);
2285 	p->rx_frames_128_255   = GET_STAT(RX_PORT_128B_255B);
2286 	p->rx_frames_256_511   = GET_STAT(RX_PORT_256B_511B);
2287 	p->rx_frames_512_1023  = GET_STAT(RX_PORT_512B_1023B);
2288 	p->rx_frames_1024_1518 = GET_STAT(RX_PORT_1024B_1518B);
2289 	p->rx_frames_1519_max  = GET_STAT(RX_PORT_1519B_MAX);
2290 	p->rx_pause            = GET_STAT(RX_PORT_PAUSE);
2291 	p->rx_ppp0             = GET_STAT(RX_PORT_PPP0);
2292 	p->rx_ppp1             = GET_STAT(RX_PORT_PPP1);
2293 	p->rx_ppp2             = GET_STAT(RX_PORT_PPP2);
2294 	p->rx_ppp3             = GET_STAT(RX_PORT_PPP3);
2295 	p->rx_ppp4             = GET_STAT(RX_PORT_PPP4);
2296 	p->rx_ppp5             = GET_STAT(RX_PORT_PPP5);
2297 	p->rx_ppp6             = GET_STAT(RX_PORT_PPP6);
2298 	p->rx_ppp7             = GET_STAT(RX_PORT_PPP7);
2299 
2300 	p->rx_ovflow0 = (bgmap & 1) ? GET_STAT_COM(RX_BG_0_MAC_DROP_FRAME) : 0;
2301 	p->rx_ovflow1 = (bgmap & 2) ? GET_STAT_COM(RX_BG_1_MAC_DROP_FRAME) : 0;
2302 	p->rx_ovflow2 = (bgmap & 4) ? GET_STAT_COM(RX_BG_2_MAC_DROP_FRAME) : 0;
2303 	p->rx_ovflow3 = (bgmap & 8) ? GET_STAT_COM(RX_BG_3_MAC_DROP_FRAME) : 0;
2304 	p->rx_trunc0 = (bgmap & 1) ? GET_STAT_COM(RX_BG_0_MAC_TRUNC_FRAME) : 0;
2305 	p->rx_trunc1 = (bgmap & 2) ? GET_STAT_COM(RX_BG_1_MAC_TRUNC_FRAME) : 0;
2306 	p->rx_trunc2 = (bgmap & 4) ? GET_STAT_COM(RX_BG_2_MAC_TRUNC_FRAME) : 0;
2307 	p->rx_trunc3 = (bgmap & 8) ? GET_STAT_COM(RX_BG_3_MAC_TRUNC_FRAME) : 0;
2308 
2309 #undef GET_STAT
2310 #undef GET_STAT_COM
2311 }
2312 
2313 /**
2314  *	t4_wol_magic_enable - enable/disable magic packet WoL
2315  *	@adap: the adapter
2316  *	@port: the physical port index
2317  *	@addr: MAC address expected in magic packets, %NULL to disable
2318  *
2319  *	Enables/disables magic packet wake-on-LAN for the selected port.
2320  */
2321 void t4_wol_magic_enable(struct adapter *adap, unsigned int port,
2322 			 const u8 *addr)
2323 {
2324 	u32 mag_id_reg_l, mag_id_reg_h, port_cfg_reg;
2325 
2326 	if (is_t4(adap->chip)) {
2327 		mag_id_reg_l = PORT_REG(port, XGMAC_PORT_MAGIC_MACID_LO);
2328 		mag_id_reg_h = PORT_REG(port, XGMAC_PORT_MAGIC_MACID_HI);
2329 		port_cfg_reg = PORT_REG(port, XGMAC_PORT_CFG2);
2330 	} else {
2331 		mag_id_reg_l = T5_PORT_REG(port, MAC_PORT_MAGIC_MACID_LO);
2332 		mag_id_reg_h = T5_PORT_REG(port, MAC_PORT_MAGIC_MACID_HI);
2333 		port_cfg_reg = T5_PORT_REG(port, MAC_PORT_CFG2);
2334 	}
2335 
2336 	if (addr) {
2337 		t4_write_reg(adap, mag_id_reg_l,
2338 			     (addr[2] << 24) | (addr[3] << 16) |
2339 			     (addr[4] << 8) | addr[5]);
2340 		t4_write_reg(adap, mag_id_reg_h,
2341 			     (addr[0] << 8) | addr[1]);
2342 	}
2343 	t4_set_reg_field(adap, port_cfg_reg, MAGICEN,
2344 			 addr ? MAGICEN : 0);
2345 }
2346 
2347 /**
2348  *	t4_wol_pat_enable - enable/disable pattern-based WoL
2349  *	@adap: the adapter
2350  *	@port: the physical port index
2351  *	@map: bitmap of which HW pattern filters to set
2352  *	@mask0: byte mask for bytes 0-63 of a packet
2353  *	@mask1: byte mask for bytes 64-127 of a packet
2354  *	@crc: Ethernet CRC for selected bytes
2355  *	@enable: enable/disable switch
2356  *
2357  *	Sets the pattern filters indicated in @map to mask out the bytes
2358  *	specified in @mask0/@mask1 in received packets and compare the CRC of
2359  *	the resulting packet against @crc.  If @enable is %true pattern-based
2360  *	WoL is enabled, otherwise disabled.
2361  */
2362 int t4_wol_pat_enable(struct adapter *adap, unsigned int port, unsigned int map,
2363 		      u64 mask0, u64 mask1, unsigned int crc, bool enable)
2364 {
2365 	int i;
2366 	u32 port_cfg_reg;
2367 
2368 	if (is_t4(adap->chip))
2369 		port_cfg_reg = PORT_REG(port, XGMAC_PORT_CFG2);
2370 	else
2371 		port_cfg_reg = T5_PORT_REG(port, MAC_PORT_CFG2);
2372 
2373 	if (!enable) {
2374 		t4_set_reg_field(adap, port_cfg_reg, PATEN, 0);
2375 		return 0;
2376 	}
2377 	if (map > 0xff)
2378 		return -EINVAL;
2379 
2380 #define EPIO_REG(name) \
2381 	(is_t4(adap->chip) ? PORT_REG(port, XGMAC_PORT_EPIO_##name) : \
2382 	T5_PORT_REG(port, MAC_PORT_EPIO_##name))
2383 
2384 	t4_write_reg(adap, EPIO_REG(DATA1), mask0 >> 32);
2385 	t4_write_reg(adap, EPIO_REG(DATA2), mask1);
2386 	t4_write_reg(adap, EPIO_REG(DATA3), mask1 >> 32);
2387 
2388 	for (i = 0; i < NWOL_PAT; i++, map >>= 1) {
2389 		if (!(map & 1))
2390 			continue;
2391 
2392 		/* write byte masks */
2393 		t4_write_reg(adap, EPIO_REG(DATA0), mask0);
2394 		t4_write_reg(adap, EPIO_REG(OP), ADDRESS(i) | EPIOWR);
2395 		t4_read_reg(adap, EPIO_REG(OP));                /* flush */
2396 		if (t4_read_reg(adap, EPIO_REG(OP)) & SF_BUSY)
2397 			return -ETIMEDOUT;
2398 
2399 		/* write CRC */
2400 		t4_write_reg(adap, EPIO_REG(DATA0), crc);
2401 		t4_write_reg(adap, EPIO_REG(OP), ADDRESS(i + 32) | EPIOWR);
2402 		t4_read_reg(adap, EPIO_REG(OP));                /* flush */
2403 		if (t4_read_reg(adap, EPIO_REG(OP)) & SF_BUSY)
2404 			return -ETIMEDOUT;
2405 	}
2406 #undef EPIO_REG
2407 
2408 	t4_set_reg_field(adap, PORT_REG(port, XGMAC_PORT_CFG2), 0, PATEN);
2409 	return 0;
2410 }
2411 
2412 /*     t4_mk_filtdelwr - create a delete filter WR
2413  *     @ftid: the filter ID
2414  *     @wr: the filter work request to populate
2415  *     @qid: ingress queue to receive the delete notification
2416  *
2417  *     Creates a filter work request to delete the supplied filter.  If @qid is
2418  *     negative the delete notification is suppressed.
2419  */
2420 void t4_mk_filtdelwr(unsigned int ftid, struct fw_filter_wr *wr, int qid)
2421 {
2422 	memset(wr, 0, sizeof(*wr));
2423 	wr->op_pkd = htonl(FW_WR_OP(FW_FILTER_WR));
2424 	wr->len16_pkd = htonl(FW_WR_LEN16(sizeof(*wr) / 16));
2425 	wr->tid_to_iq = htonl(V_FW_FILTER_WR_TID(ftid) |
2426 			V_FW_FILTER_WR_NOREPLY(qid < 0));
2427 	wr->del_filter_to_l2tix = htonl(F_FW_FILTER_WR_DEL_FILTER);
2428 	if (qid >= 0)
2429 		wr->rx_chan_rx_rpl_iq = htons(V_FW_FILTER_WR_RX_RPL_IQ(qid));
2430 }
2431 
2432 #define INIT_CMD(var, cmd, rd_wr) do { \
2433 	(var).op_to_write = htonl(FW_CMD_OP(FW_##cmd##_CMD) | \
2434 				  FW_CMD_REQUEST | FW_CMD_##rd_wr); \
2435 	(var).retval_len16 = htonl(FW_LEN16(var)); \
2436 } while (0)
2437 
2438 int t4_fwaddrspace_write(struct adapter *adap, unsigned int mbox,
2439 			  u32 addr, u32 val)
2440 {
2441 	struct fw_ldst_cmd c;
2442 
2443 	memset(&c, 0, sizeof(c));
2444 	c.op_to_addrspace = htonl(FW_CMD_OP(FW_LDST_CMD) | FW_CMD_REQUEST |
2445 			    FW_CMD_WRITE |
2446 			    FW_LDST_CMD_ADDRSPACE(FW_LDST_ADDRSPC_FIRMWARE));
2447 	c.cycles_to_len16 = htonl(FW_LEN16(c));
2448 	c.u.addrval.addr = htonl(addr);
2449 	c.u.addrval.val = htonl(val);
2450 
2451 	return t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
2452 }
2453 
2454 /**
2455  *     t4_mem_win_read_len - read memory through PCIE memory window
2456  *     @adap: the adapter
2457  *     @addr: address of first byte requested aligned on 32b.
2458  *     @data: len bytes to hold the data read
2459  *     @len: amount of data to read from window.  Must be <=
2460  *            MEMWIN0_APERATURE after adjusting for 16B for T4 and
2461  *            128B for T5 alignment requirements of the the memory window.
2462  *
2463  *     Read len bytes of data from MC starting at @addr.
2464  */
2465 int t4_mem_win_read_len(struct adapter *adap, u32 addr, __be32 *data, int len)
2466 {
2467 	int i, off;
2468 	u32 win_pf = is_t4(adap->chip) ? 0 : V_PFNUM(adap->fn);
2469 
2470 	/* Align on a 2KB boundary.
2471 	 */
2472 	off = addr & MEMWIN0_APERTURE;
2473 	if ((addr & 3) || (len + off) > MEMWIN0_APERTURE)
2474 		return -EINVAL;
2475 
2476 	t4_write_reg(adap, PCIE_MEM_ACCESS_OFFSET,
2477 		     (addr & ~MEMWIN0_APERTURE) | win_pf);
2478 	t4_read_reg(adap, PCIE_MEM_ACCESS_OFFSET);
2479 
2480 	for (i = 0; i < len; i += 4)
2481 		*data++ = (__force __be32) t4_read_reg(adap,
2482 						(MEMWIN0_BASE + off + i));
2483 
2484 	return 0;
2485 }
2486 
2487 /**
2488  *	t4_mdio_rd - read a PHY register through MDIO
2489  *	@adap: the adapter
2490  *	@mbox: mailbox to use for the FW command
2491  *	@phy_addr: the PHY address
2492  *	@mmd: the PHY MMD to access (0 for clause 22 PHYs)
2493  *	@reg: the register to read
2494  *	@valp: where to store the value
2495  *
2496  *	Issues a FW command through the given mailbox to read a PHY register.
2497  */
2498 int t4_mdio_rd(struct adapter *adap, unsigned int mbox, unsigned int phy_addr,
2499 	       unsigned int mmd, unsigned int reg, u16 *valp)
2500 {
2501 	int ret;
2502 	struct fw_ldst_cmd c;
2503 
2504 	memset(&c, 0, sizeof(c));
2505 	c.op_to_addrspace = htonl(FW_CMD_OP(FW_LDST_CMD) | FW_CMD_REQUEST |
2506 		FW_CMD_READ | FW_LDST_CMD_ADDRSPACE(FW_LDST_ADDRSPC_MDIO));
2507 	c.cycles_to_len16 = htonl(FW_LEN16(c));
2508 	c.u.mdio.paddr_mmd = htons(FW_LDST_CMD_PADDR(phy_addr) |
2509 				   FW_LDST_CMD_MMD(mmd));
2510 	c.u.mdio.raddr = htons(reg);
2511 
2512 	ret = t4_wr_mbox(adap, mbox, &c, sizeof(c), &c);
2513 	if (ret == 0)
2514 		*valp = ntohs(c.u.mdio.rval);
2515 	return ret;
2516 }
2517 
2518 /**
2519  *	t4_mdio_wr - write a PHY register through MDIO
2520  *	@adap: the adapter
2521  *	@mbox: mailbox to use for the FW command
2522  *	@phy_addr: the PHY address
2523  *	@mmd: the PHY MMD to access (0 for clause 22 PHYs)
2524  *	@reg: the register to write
2525  *	@valp: value to write
2526  *
2527  *	Issues a FW command through the given mailbox to write a PHY register.
2528  */
2529 int t4_mdio_wr(struct adapter *adap, unsigned int mbox, unsigned int phy_addr,
2530 	       unsigned int mmd, unsigned int reg, u16 val)
2531 {
2532 	struct fw_ldst_cmd c;
2533 
2534 	memset(&c, 0, sizeof(c));
2535 	c.op_to_addrspace = htonl(FW_CMD_OP(FW_LDST_CMD) | FW_CMD_REQUEST |
2536 		FW_CMD_WRITE | FW_LDST_CMD_ADDRSPACE(FW_LDST_ADDRSPC_MDIO));
2537 	c.cycles_to_len16 = htonl(FW_LEN16(c));
2538 	c.u.mdio.paddr_mmd = htons(FW_LDST_CMD_PADDR(phy_addr) |
2539 				   FW_LDST_CMD_MMD(mmd));
2540 	c.u.mdio.raddr = htons(reg);
2541 	c.u.mdio.rval = htons(val);
2542 
2543 	return t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
2544 }
2545 
2546 /**
2547  *      t4_fw_hello - establish communication with FW
2548  *      @adap: the adapter
2549  *      @mbox: mailbox to use for the FW command
2550  *      @evt_mbox: mailbox to receive async FW events
2551  *      @master: specifies the caller's willingness to be the device master
2552  *	@state: returns the current device state (if non-NULL)
2553  *
2554  *	Issues a command to establish communication with FW.  Returns either
2555  *	an error (negative integer) or the mailbox of the Master PF.
2556  */
2557 int t4_fw_hello(struct adapter *adap, unsigned int mbox, unsigned int evt_mbox,
2558 		enum dev_master master, enum dev_state *state)
2559 {
2560 	int ret;
2561 	struct fw_hello_cmd c;
2562 	u32 v;
2563 	unsigned int master_mbox;
2564 	int retries = FW_CMD_HELLO_RETRIES;
2565 
2566 retry:
2567 	memset(&c, 0, sizeof(c));
2568 	INIT_CMD(c, HELLO, WRITE);
2569 	c.err_to_clearinit = htonl(
2570 		FW_HELLO_CMD_MASTERDIS(master == MASTER_CANT) |
2571 		FW_HELLO_CMD_MASTERFORCE(master == MASTER_MUST) |
2572 		FW_HELLO_CMD_MBMASTER(master == MASTER_MUST ? mbox :
2573 				      FW_HELLO_CMD_MBMASTER_MASK) |
2574 		FW_HELLO_CMD_MBASYNCNOT(evt_mbox) |
2575 		FW_HELLO_CMD_STAGE(fw_hello_cmd_stage_os) |
2576 		FW_HELLO_CMD_CLEARINIT);
2577 
2578 	/*
2579 	 * Issue the HELLO command to the firmware.  If it's not successful
2580 	 * but indicates that we got a "busy" or "timeout" condition, retry
2581 	 * the HELLO until we exhaust our retry limit.
2582 	 */
2583 	ret = t4_wr_mbox(adap, mbox, &c, sizeof(c), &c);
2584 	if (ret < 0) {
2585 		if ((ret == -EBUSY || ret == -ETIMEDOUT) && retries-- > 0)
2586 			goto retry;
2587 		return ret;
2588 	}
2589 
2590 	v = ntohl(c.err_to_clearinit);
2591 	master_mbox = FW_HELLO_CMD_MBMASTER_GET(v);
2592 	if (state) {
2593 		if (v & FW_HELLO_CMD_ERR)
2594 			*state = DEV_STATE_ERR;
2595 		else if (v & FW_HELLO_CMD_INIT)
2596 			*state = DEV_STATE_INIT;
2597 		else
2598 			*state = DEV_STATE_UNINIT;
2599 	}
2600 
2601 	/*
2602 	 * If we're not the Master PF then we need to wait around for the
2603 	 * Master PF Driver to finish setting up the adapter.
2604 	 *
2605 	 * Note that we also do this wait if we're a non-Master-capable PF and
2606 	 * there is no current Master PF; a Master PF may show up momentarily
2607 	 * and we wouldn't want to fail pointlessly.  (This can happen when an
2608 	 * OS loads lots of different drivers rapidly at the same time).  In
2609 	 * this case, the Master PF returned by the firmware will be
2610 	 * FW_PCIE_FW_MASTER_MASK so the test below will work ...
2611 	 */
2612 	if ((v & (FW_HELLO_CMD_ERR|FW_HELLO_CMD_INIT)) == 0 &&
2613 	    master_mbox != mbox) {
2614 		int waiting = FW_CMD_HELLO_TIMEOUT;
2615 
2616 		/*
2617 		 * Wait for the firmware to either indicate an error or
2618 		 * initialized state.  If we see either of these we bail out
2619 		 * and report the issue to the caller.  If we exhaust the
2620 		 * "hello timeout" and we haven't exhausted our retries, try
2621 		 * again.  Otherwise bail with a timeout error.
2622 		 */
2623 		for (;;) {
2624 			u32 pcie_fw;
2625 
2626 			msleep(50);
2627 			waiting -= 50;
2628 
2629 			/*
2630 			 * If neither Error nor Initialialized are indicated
2631 			 * by the firmware keep waiting till we exaust our
2632 			 * timeout ... and then retry if we haven't exhausted
2633 			 * our retries ...
2634 			 */
2635 			pcie_fw = t4_read_reg(adap, MA_PCIE_FW);
2636 			if (!(pcie_fw & (FW_PCIE_FW_ERR|FW_PCIE_FW_INIT))) {
2637 				if (waiting <= 0) {
2638 					if (retries-- > 0)
2639 						goto retry;
2640 
2641 					return -ETIMEDOUT;
2642 				}
2643 				continue;
2644 			}
2645 
2646 			/*
2647 			 * We either have an Error or Initialized condition
2648 			 * report errors preferentially.
2649 			 */
2650 			if (state) {
2651 				if (pcie_fw & FW_PCIE_FW_ERR)
2652 					*state = DEV_STATE_ERR;
2653 				else if (pcie_fw & FW_PCIE_FW_INIT)
2654 					*state = DEV_STATE_INIT;
2655 			}
2656 
2657 			/*
2658 			 * If we arrived before a Master PF was selected and
2659 			 * there's not a valid Master PF, grab its identity
2660 			 * for our caller.
2661 			 */
2662 			if (master_mbox == FW_PCIE_FW_MASTER_MASK &&
2663 			    (pcie_fw & FW_PCIE_FW_MASTER_VLD))
2664 				master_mbox = FW_PCIE_FW_MASTER_GET(pcie_fw);
2665 			break;
2666 		}
2667 	}
2668 
2669 	return master_mbox;
2670 }
2671 
2672 /**
2673  *	t4_fw_bye - end communication with FW
2674  *	@adap: the adapter
2675  *	@mbox: mailbox to use for the FW command
2676  *
2677  *	Issues a command to terminate communication with FW.
2678  */
2679 int t4_fw_bye(struct adapter *adap, unsigned int mbox)
2680 {
2681 	struct fw_bye_cmd c;
2682 
2683 	memset(&c, 0, sizeof(c));
2684 	INIT_CMD(c, BYE, WRITE);
2685 	return t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
2686 }
2687 
2688 /**
2689  *	t4_init_cmd - ask FW to initialize the device
2690  *	@adap: the adapter
2691  *	@mbox: mailbox to use for the FW command
2692  *
2693  *	Issues a command to FW to partially initialize the device.  This
2694  *	performs initialization that generally doesn't depend on user input.
2695  */
2696 int t4_early_init(struct adapter *adap, unsigned int mbox)
2697 {
2698 	struct fw_initialize_cmd c;
2699 
2700 	memset(&c, 0, sizeof(c));
2701 	INIT_CMD(c, INITIALIZE, WRITE);
2702 	return t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
2703 }
2704 
2705 /**
2706  *	t4_fw_reset - issue a reset to FW
2707  *	@adap: the adapter
2708  *	@mbox: mailbox to use for the FW command
2709  *	@reset: specifies the type of reset to perform
2710  *
2711  *	Issues a reset command of the specified type to FW.
2712  */
2713 int t4_fw_reset(struct adapter *adap, unsigned int mbox, int reset)
2714 {
2715 	struct fw_reset_cmd c;
2716 
2717 	memset(&c, 0, sizeof(c));
2718 	INIT_CMD(c, RESET, WRITE);
2719 	c.val = htonl(reset);
2720 	return t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
2721 }
2722 
2723 /**
2724  *	t4_fw_halt - issue a reset/halt to FW and put uP into RESET
2725  *	@adap: the adapter
2726  *	@mbox: mailbox to use for the FW RESET command (if desired)
2727  *	@force: force uP into RESET even if FW RESET command fails
2728  *
2729  *	Issues a RESET command to firmware (if desired) with a HALT indication
2730  *	and then puts the microprocessor into RESET state.  The RESET command
2731  *	will only be issued if a legitimate mailbox is provided (mbox <=
2732  *	FW_PCIE_FW_MASTER_MASK).
2733  *
2734  *	This is generally used in order for the host to safely manipulate the
2735  *	adapter without fear of conflicting with whatever the firmware might
2736  *	be doing.  The only way out of this state is to RESTART the firmware
2737  *	...
2738  */
2739 int t4_fw_halt(struct adapter *adap, unsigned int mbox, int force)
2740 {
2741 	int ret = 0;
2742 
2743 	/*
2744 	 * If a legitimate mailbox is provided, issue a RESET command
2745 	 * with a HALT indication.
2746 	 */
2747 	if (mbox <= FW_PCIE_FW_MASTER_MASK) {
2748 		struct fw_reset_cmd c;
2749 
2750 		memset(&c, 0, sizeof(c));
2751 		INIT_CMD(c, RESET, WRITE);
2752 		c.val = htonl(PIORST | PIORSTMODE);
2753 		c.halt_pkd = htonl(FW_RESET_CMD_HALT(1U));
2754 		ret = t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
2755 	}
2756 
2757 	/*
2758 	 * Normally we won't complete the operation if the firmware RESET
2759 	 * command fails but if our caller insists we'll go ahead and put the
2760 	 * uP into RESET.  This can be useful if the firmware is hung or even
2761 	 * missing ...  We'll have to take the risk of putting the uP into
2762 	 * RESET without the cooperation of firmware in that case.
2763 	 *
2764 	 * We also force the firmware's HALT flag to be on in case we bypassed
2765 	 * the firmware RESET command above or we're dealing with old firmware
2766 	 * which doesn't have the HALT capability.  This will serve as a flag
2767 	 * for the incoming firmware to know that it's coming out of a HALT
2768 	 * rather than a RESET ... if it's new enough to understand that ...
2769 	 */
2770 	if (ret == 0 || force) {
2771 		t4_set_reg_field(adap, CIM_BOOT_CFG, UPCRST, UPCRST);
2772 		t4_set_reg_field(adap, PCIE_FW, FW_PCIE_FW_HALT,
2773 				 FW_PCIE_FW_HALT);
2774 	}
2775 
2776 	/*
2777 	 * And we always return the result of the firmware RESET command
2778 	 * even when we force the uP into RESET ...
2779 	 */
2780 	return ret;
2781 }
2782 
2783 /**
2784  *	t4_fw_restart - restart the firmware by taking the uP out of RESET
2785  *	@adap: the adapter
2786  *	@reset: if we want to do a RESET to restart things
2787  *
2788  *	Restart firmware previously halted by t4_fw_halt().  On successful
2789  *	return the previous PF Master remains as the new PF Master and there
2790  *	is no need to issue a new HELLO command, etc.
2791  *
2792  *	We do this in two ways:
2793  *
2794  *	 1. If we're dealing with newer firmware we'll simply want to take
2795  *	    the chip's microprocessor out of RESET.  This will cause the
2796  *	    firmware to start up from its start vector.  And then we'll loop
2797  *	    until the firmware indicates it's started again (PCIE_FW.HALT
2798  *	    reset to 0) or we timeout.
2799  *
2800  *	 2. If we're dealing with older firmware then we'll need to RESET
2801  *	    the chip since older firmware won't recognize the PCIE_FW.HALT
2802  *	    flag and automatically RESET itself on startup.
2803  */
2804 int t4_fw_restart(struct adapter *adap, unsigned int mbox, int reset)
2805 {
2806 	if (reset) {
2807 		/*
2808 		 * Since we're directing the RESET instead of the firmware
2809 		 * doing it automatically, we need to clear the PCIE_FW.HALT
2810 		 * bit.
2811 		 */
2812 		t4_set_reg_field(adap, PCIE_FW, FW_PCIE_FW_HALT, 0);
2813 
2814 		/*
2815 		 * If we've been given a valid mailbox, first try to get the
2816 		 * firmware to do the RESET.  If that works, great and we can
2817 		 * return success.  Otherwise, if we haven't been given a
2818 		 * valid mailbox or the RESET command failed, fall back to
2819 		 * hitting the chip with a hammer.
2820 		 */
2821 		if (mbox <= FW_PCIE_FW_MASTER_MASK) {
2822 			t4_set_reg_field(adap, CIM_BOOT_CFG, UPCRST, 0);
2823 			msleep(100);
2824 			if (t4_fw_reset(adap, mbox,
2825 					PIORST | PIORSTMODE) == 0)
2826 				return 0;
2827 		}
2828 
2829 		t4_write_reg(adap, PL_RST, PIORST | PIORSTMODE);
2830 		msleep(2000);
2831 	} else {
2832 		int ms;
2833 
2834 		t4_set_reg_field(adap, CIM_BOOT_CFG, UPCRST, 0);
2835 		for (ms = 0; ms < FW_CMD_MAX_TIMEOUT; ) {
2836 			if (!(t4_read_reg(adap, PCIE_FW) & FW_PCIE_FW_HALT))
2837 				return 0;
2838 			msleep(100);
2839 			ms += 100;
2840 		}
2841 		return -ETIMEDOUT;
2842 	}
2843 	return 0;
2844 }
2845 
2846 /**
2847  *	t4_fw_upgrade - perform all of the steps necessary to upgrade FW
2848  *	@adap: the adapter
2849  *	@mbox: mailbox to use for the FW RESET command (if desired)
2850  *	@fw_data: the firmware image to write
2851  *	@size: image size
2852  *	@force: force upgrade even if firmware doesn't cooperate
2853  *
2854  *	Perform all of the steps necessary for upgrading an adapter's
2855  *	firmware image.  Normally this requires the cooperation of the
2856  *	existing firmware in order to halt all existing activities
2857  *	but if an invalid mailbox token is passed in we skip that step
2858  *	(though we'll still put the adapter microprocessor into RESET in
2859  *	that case).
2860  *
2861  *	On successful return the new firmware will have been loaded and
2862  *	the adapter will have been fully RESET losing all previous setup
2863  *	state.  On unsuccessful return the adapter may be completely hosed ...
2864  *	positive errno indicates that the adapter is ~probably~ intact, a
2865  *	negative errno indicates that things are looking bad ...
2866  */
2867 int t4_fw_upgrade(struct adapter *adap, unsigned int mbox,
2868 		  const u8 *fw_data, unsigned int size, int force)
2869 {
2870 	const struct fw_hdr *fw_hdr = (const struct fw_hdr *)fw_data;
2871 	int reset, ret;
2872 
2873 	ret = t4_fw_halt(adap, mbox, force);
2874 	if (ret < 0 && !force)
2875 		return ret;
2876 
2877 	ret = t4_load_fw(adap, fw_data, size);
2878 	if (ret < 0)
2879 		return ret;
2880 
2881 	/*
2882 	 * Older versions of the firmware don't understand the new
2883 	 * PCIE_FW.HALT flag and so won't know to perform a RESET when they
2884 	 * restart.  So for newly loaded older firmware we'll have to do the
2885 	 * RESET for it so it starts up on a clean slate.  We can tell if
2886 	 * the newly loaded firmware will handle this right by checking
2887 	 * its header flags to see if it advertises the capability.
2888 	 */
2889 	reset = ((ntohl(fw_hdr->flags) & FW_HDR_FLAGS_RESET_HALT) == 0);
2890 	return t4_fw_restart(adap, mbox, reset);
2891 }
2892 
2893 
2894 /**
2895  *	t4_fw_config_file - setup an adapter via a Configuration File
2896  *	@adap: the adapter
2897  *	@mbox: mailbox to use for the FW command
2898  *	@mtype: the memory type where the Configuration File is located
2899  *	@maddr: the memory address where the Configuration File is located
2900  *	@finiver: return value for CF [fini] version
2901  *	@finicsum: return value for CF [fini] checksum
2902  *	@cfcsum: return value for CF computed checksum
2903  *
2904  *	Issue a command to get the firmware to process the Configuration
2905  *	File located at the specified mtype/maddress.  If the Configuration
2906  *	File is processed successfully and return value pointers are
2907  *	provided, the Configuration File "[fini] section version and
2908  *	checksum values will be returned along with the computed checksum.
2909  *	It's up to the caller to decide how it wants to respond to the
2910  *	checksums not matching but it recommended that a prominant warning
2911  *	be emitted in order to help people rapidly identify changed or
2912  *	corrupted Configuration Files.
2913  *
2914  *	Also note that it's possible to modify things like "niccaps",
2915  *	"toecaps",etc. between processing the Configuration File and telling
2916  *	the firmware to use the new configuration.  Callers which want to
2917  *	do this will need to "hand-roll" their own CAPS_CONFIGS commands for
2918  *	Configuration Files if they want to do this.
2919  */
2920 int t4_fw_config_file(struct adapter *adap, unsigned int mbox,
2921 		      unsigned int mtype, unsigned int maddr,
2922 		      u32 *finiver, u32 *finicsum, u32 *cfcsum)
2923 {
2924 	struct fw_caps_config_cmd caps_cmd;
2925 	int ret;
2926 
2927 	/*
2928 	 * Tell the firmware to process the indicated Configuration File.
2929 	 * If there are no errors and the caller has provided return value
2930 	 * pointers for the [fini] section version, checksum and computed
2931 	 * checksum, pass those back to the caller.
2932 	 */
2933 	memset(&caps_cmd, 0, sizeof(caps_cmd));
2934 	caps_cmd.op_to_write =
2935 		htonl(FW_CMD_OP(FW_CAPS_CONFIG_CMD) |
2936 		      FW_CMD_REQUEST |
2937 		      FW_CMD_READ);
2938 	caps_cmd.cfvalid_to_len16 =
2939 		htonl(FW_CAPS_CONFIG_CMD_CFVALID |
2940 		      FW_CAPS_CONFIG_CMD_MEMTYPE_CF(mtype) |
2941 		      FW_CAPS_CONFIG_CMD_MEMADDR64K_CF(maddr >> 16) |
2942 		      FW_LEN16(caps_cmd));
2943 	ret = t4_wr_mbox(adap, mbox, &caps_cmd, sizeof(caps_cmd), &caps_cmd);
2944 	if (ret < 0)
2945 		return ret;
2946 
2947 	if (finiver)
2948 		*finiver = ntohl(caps_cmd.finiver);
2949 	if (finicsum)
2950 		*finicsum = ntohl(caps_cmd.finicsum);
2951 	if (cfcsum)
2952 		*cfcsum = ntohl(caps_cmd.cfcsum);
2953 
2954 	/*
2955 	 * And now tell the firmware to use the configuration we just loaded.
2956 	 */
2957 	caps_cmd.op_to_write =
2958 		htonl(FW_CMD_OP(FW_CAPS_CONFIG_CMD) |
2959 		      FW_CMD_REQUEST |
2960 		      FW_CMD_WRITE);
2961 	caps_cmd.cfvalid_to_len16 = htonl(FW_LEN16(caps_cmd));
2962 	return t4_wr_mbox(adap, mbox, &caps_cmd, sizeof(caps_cmd), NULL);
2963 }
2964 
2965 /**
2966  *	t4_fixup_host_params - fix up host-dependent parameters
2967  *	@adap: the adapter
2968  *	@page_size: the host's Base Page Size
2969  *	@cache_line_size: the host's Cache Line Size
2970  *
2971  *	Various registers in T4 contain values which are dependent on the
2972  *	host's Base Page and Cache Line Sizes.  This function will fix all of
2973  *	those registers with the appropriate values as passed in ...
2974  */
2975 int t4_fixup_host_params(struct adapter *adap, unsigned int page_size,
2976 			 unsigned int cache_line_size)
2977 {
2978 	unsigned int page_shift = fls(page_size) - 1;
2979 	unsigned int sge_hps = page_shift - 10;
2980 	unsigned int stat_len = cache_line_size > 64 ? 128 : 64;
2981 	unsigned int fl_align = cache_line_size < 32 ? 32 : cache_line_size;
2982 	unsigned int fl_align_log = fls(fl_align) - 1;
2983 
2984 	t4_write_reg(adap, SGE_HOST_PAGE_SIZE,
2985 		     HOSTPAGESIZEPF0(sge_hps) |
2986 		     HOSTPAGESIZEPF1(sge_hps) |
2987 		     HOSTPAGESIZEPF2(sge_hps) |
2988 		     HOSTPAGESIZEPF3(sge_hps) |
2989 		     HOSTPAGESIZEPF4(sge_hps) |
2990 		     HOSTPAGESIZEPF5(sge_hps) |
2991 		     HOSTPAGESIZEPF6(sge_hps) |
2992 		     HOSTPAGESIZEPF7(sge_hps));
2993 
2994 	t4_set_reg_field(adap, SGE_CONTROL,
2995 			 INGPADBOUNDARY_MASK |
2996 			 EGRSTATUSPAGESIZE_MASK,
2997 			 INGPADBOUNDARY(fl_align_log - 5) |
2998 			 EGRSTATUSPAGESIZE(stat_len != 64));
2999 
3000 	/*
3001 	 * Adjust various SGE Free List Host Buffer Sizes.
3002 	 *
3003 	 * This is something of a crock since we're using fixed indices into
3004 	 * the array which are also known by the sge.c code and the T4
3005 	 * Firmware Configuration File.  We need to come up with a much better
3006 	 * approach to managing this array.  For now, the first four entries
3007 	 * are:
3008 	 *
3009 	 *   0: Host Page Size
3010 	 *   1: 64KB
3011 	 *   2: Buffer size corresponding to 1500 byte MTU (unpacked mode)
3012 	 *   3: Buffer size corresponding to 9000 byte MTU (unpacked mode)
3013 	 *
3014 	 * For the single-MTU buffers in unpacked mode we need to include
3015 	 * space for the SGE Control Packet Shift, 14 byte Ethernet header,
3016 	 * possible 4 byte VLAN tag, all rounded up to the next Ingress Packet
3017 	 * Padding boundry.  All of these are accommodated in the Factory
3018 	 * Default Firmware Configuration File but we need to adjust it for
3019 	 * this host's cache line size.
3020 	 */
3021 	t4_write_reg(adap, SGE_FL_BUFFER_SIZE0, page_size);
3022 	t4_write_reg(adap, SGE_FL_BUFFER_SIZE2,
3023 		     (t4_read_reg(adap, SGE_FL_BUFFER_SIZE2) + fl_align-1)
3024 		     & ~(fl_align-1));
3025 	t4_write_reg(adap, SGE_FL_BUFFER_SIZE3,
3026 		     (t4_read_reg(adap, SGE_FL_BUFFER_SIZE3) + fl_align-1)
3027 		     & ~(fl_align-1));
3028 
3029 	t4_write_reg(adap, ULP_RX_TDDP_PSZ, HPZ0(page_shift - 12));
3030 
3031 	return 0;
3032 }
3033 
3034 /**
3035  *	t4_fw_initialize - ask FW to initialize the device
3036  *	@adap: the adapter
3037  *	@mbox: mailbox to use for the FW command
3038  *
3039  *	Issues a command to FW to partially initialize the device.  This
3040  *	performs initialization that generally doesn't depend on user input.
3041  */
3042 int t4_fw_initialize(struct adapter *adap, unsigned int mbox)
3043 {
3044 	struct fw_initialize_cmd c;
3045 
3046 	memset(&c, 0, sizeof(c));
3047 	INIT_CMD(c, INITIALIZE, WRITE);
3048 	return t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
3049 }
3050 
3051 /**
3052  *	t4_query_params - query FW or device parameters
3053  *	@adap: the adapter
3054  *	@mbox: mailbox to use for the FW command
3055  *	@pf: the PF
3056  *	@vf: the VF
3057  *	@nparams: the number of parameters
3058  *	@params: the parameter names
3059  *	@val: the parameter values
3060  *
3061  *	Reads the value of FW or device parameters.  Up to 7 parameters can be
3062  *	queried at once.
3063  */
3064 int t4_query_params(struct adapter *adap, unsigned int mbox, unsigned int pf,
3065 		    unsigned int vf, unsigned int nparams, const u32 *params,
3066 		    u32 *val)
3067 {
3068 	int i, ret;
3069 	struct fw_params_cmd c;
3070 	__be32 *p = &c.param[0].mnem;
3071 
3072 	if (nparams > 7)
3073 		return -EINVAL;
3074 
3075 	memset(&c, 0, sizeof(c));
3076 	c.op_to_vfn = htonl(FW_CMD_OP(FW_PARAMS_CMD) | FW_CMD_REQUEST |
3077 			    FW_CMD_READ | FW_PARAMS_CMD_PFN(pf) |
3078 			    FW_PARAMS_CMD_VFN(vf));
3079 	c.retval_len16 = htonl(FW_LEN16(c));
3080 	for (i = 0; i < nparams; i++, p += 2)
3081 		*p = htonl(*params++);
3082 
3083 	ret = t4_wr_mbox(adap, mbox, &c, sizeof(c), &c);
3084 	if (ret == 0)
3085 		for (i = 0, p = &c.param[0].val; i < nparams; i++, p += 2)
3086 			*val++ = ntohl(*p);
3087 	return ret;
3088 }
3089 
3090 /**
3091  *	t4_set_params - sets FW or device parameters
3092  *	@adap: the adapter
3093  *	@mbox: mailbox to use for the FW command
3094  *	@pf: the PF
3095  *	@vf: the VF
3096  *	@nparams: the number of parameters
3097  *	@params: the parameter names
3098  *	@val: the parameter values
3099  *
3100  *	Sets the value of FW or device parameters.  Up to 7 parameters can be
3101  *	specified at once.
3102  */
3103 int t4_set_params(struct adapter *adap, unsigned int mbox, unsigned int pf,
3104 		  unsigned int vf, unsigned int nparams, const u32 *params,
3105 		  const u32 *val)
3106 {
3107 	struct fw_params_cmd c;
3108 	__be32 *p = &c.param[0].mnem;
3109 
3110 	if (nparams > 7)
3111 		return -EINVAL;
3112 
3113 	memset(&c, 0, sizeof(c));
3114 	c.op_to_vfn = htonl(FW_CMD_OP(FW_PARAMS_CMD) | FW_CMD_REQUEST |
3115 			    FW_CMD_WRITE | FW_PARAMS_CMD_PFN(pf) |
3116 			    FW_PARAMS_CMD_VFN(vf));
3117 	c.retval_len16 = htonl(FW_LEN16(c));
3118 	while (nparams--) {
3119 		*p++ = htonl(*params++);
3120 		*p++ = htonl(*val++);
3121 	}
3122 
3123 	return t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
3124 }
3125 
3126 /**
3127  *	t4_cfg_pfvf - configure PF/VF resource limits
3128  *	@adap: the adapter
3129  *	@mbox: mailbox to use for the FW command
3130  *	@pf: the PF being configured
3131  *	@vf: the VF being configured
3132  *	@txq: the max number of egress queues
3133  *	@txq_eth_ctrl: the max number of egress Ethernet or control queues
3134  *	@rxqi: the max number of interrupt-capable ingress queues
3135  *	@rxq: the max number of interruptless ingress queues
3136  *	@tc: the PCI traffic class
3137  *	@vi: the max number of virtual interfaces
3138  *	@cmask: the channel access rights mask for the PF/VF
3139  *	@pmask: the port access rights mask for the PF/VF
3140  *	@nexact: the maximum number of exact MPS filters
3141  *	@rcaps: read capabilities
3142  *	@wxcaps: write/execute capabilities
3143  *
3144  *	Configures resource limits and capabilities for a physical or virtual
3145  *	function.
3146  */
3147 int t4_cfg_pfvf(struct adapter *adap, unsigned int mbox, unsigned int pf,
3148 		unsigned int vf, unsigned int txq, unsigned int txq_eth_ctrl,
3149 		unsigned int rxqi, unsigned int rxq, unsigned int tc,
3150 		unsigned int vi, unsigned int cmask, unsigned int pmask,
3151 		unsigned int nexact, unsigned int rcaps, unsigned int wxcaps)
3152 {
3153 	struct fw_pfvf_cmd c;
3154 
3155 	memset(&c, 0, sizeof(c));
3156 	c.op_to_vfn = htonl(FW_CMD_OP(FW_PFVF_CMD) | FW_CMD_REQUEST |
3157 			    FW_CMD_WRITE | FW_PFVF_CMD_PFN(pf) |
3158 			    FW_PFVF_CMD_VFN(vf));
3159 	c.retval_len16 = htonl(FW_LEN16(c));
3160 	c.niqflint_niq = htonl(FW_PFVF_CMD_NIQFLINT(rxqi) |
3161 			       FW_PFVF_CMD_NIQ(rxq));
3162 	c.type_to_neq = htonl(FW_PFVF_CMD_CMASK(cmask) |
3163 			       FW_PFVF_CMD_PMASK(pmask) |
3164 			       FW_PFVF_CMD_NEQ(txq));
3165 	c.tc_to_nexactf = htonl(FW_PFVF_CMD_TC(tc) | FW_PFVF_CMD_NVI(vi) |
3166 				FW_PFVF_CMD_NEXACTF(nexact));
3167 	c.r_caps_to_nethctrl = htonl(FW_PFVF_CMD_R_CAPS(rcaps) |
3168 				     FW_PFVF_CMD_WX_CAPS(wxcaps) |
3169 				     FW_PFVF_CMD_NETHCTRL(txq_eth_ctrl));
3170 	return t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
3171 }
3172 
3173 /**
3174  *	t4_alloc_vi - allocate a virtual interface
3175  *	@adap: the adapter
3176  *	@mbox: mailbox to use for the FW command
3177  *	@port: physical port associated with the VI
3178  *	@pf: the PF owning the VI
3179  *	@vf: the VF owning the VI
3180  *	@nmac: number of MAC addresses needed (1 to 5)
3181  *	@mac: the MAC addresses of the VI
3182  *	@rss_size: size of RSS table slice associated with this VI
3183  *
3184  *	Allocates a virtual interface for the given physical port.  If @mac is
3185  *	not %NULL it contains the MAC addresses of the VI as assigned by FW.
3186  *	@mac should be large enough to hold @nmac Ethernet addresses, they are
3187  *	stored consecutively so the space needed is @nmac * 6 bytes.
3188  *	Returns a negative error number or the non-negative VI id.
3189  */
3190 int t4_alloc_vi(struct adapter *adap, unsigned int mbox, unsigned int port,
3191 		unsigned int pf, unsigned int vf, unsigned int nmac, u8 *mac,
3192 		unsigned int *rss_size)
3193 {
3194 	int ret;
3195 	struct fw_vi_cmd c;
3196 
3197 	memset(&c, 0, sizeof(c));
3198 	c.op_to_vfn = htonl(FW_CMD_OP(FW_VI_CMD) | FW_CMD_REQUEST |
3199 			    FW_CMD_WRITE | FW_CMD_EXEC |
3200 			    FW_VI_CMD_PFN(pf) | FW_VI_CMD_VFN(vf));
3201 	c.alloc_to_len16 = htonl(FW_VI_CMD_ALLOC | FW_LEN16(c));
3202 	c.portid_pkd = FW_VI_CMD_PORTID(port);
3203 	c.nmac = nmac - 1;
3204 
3205 	ret = t4_wr_mbox(adap, mbox, &c, sizeof(c), &c);
3206 	if (ret)
3207 		return ret;
3208 
3209 	if (mac) {
3210 		memcpy(mac, c.mac, sizeof(c.mac));
3211 		switch (nmac) {
3212 		case 5:
3213 			memcpy(mac + 24, c.nmac3, sizeof(c.nmac3));
3214 		case 4:
3215 			memcpy(mac + 18, c.nmac2, sizeof(c.nmac2));
3216 		case 3:
3217 			memcpy(mac + 12, c.nmac1, sizeof(c.nmac1));
3218 		case 2:
3219 			memcpy(mac + 6,  c.nmac0, sizeof(c.nmac0));
3220 		}
3221 	}
3222 	if (rss_size)
3223 		*rss_size = FW_VI_CMD_RSSSIZE_GET(ntohs(c.rsssize_pkd));
3224 	return FW_VI_CMD_VIID_GET(ntohs(c.type_viid));
3225 }
3226 
3227 /**
3228  *	t4_set_rxmode - set Rx properties of a virtual interface
3229  *	@adap: the adapter
3230  *	@mbox: mailbox to use for the FW command
3231  *	@viid: the VI id
3232  *	@mtu: the new MTU or -1
3233  *	@promisc: 1 to enable promiscuous mode, 0 to disable it, -1 no change
3234  *	@all_multi: 1 to enable all-multi mode, 0 to disable it, -1 no change
3235  *	@bcast: 1 to enable broadcast Rx, 0 to disable it, -1 no change
3236  *	@vlanex: 1 to enable HW VLAN extraction, 0 to disable it, -1 no change
3237  *	@sleep_ok: if true we may sleep while awaiting command completion
3238  *
3239  *	Sets Rx properties of a virtual interface.
3240  */
3241 int t4_set_rxmode(struct adapter *adap, unsigned int mbox, unsigned int viid,
3242 		  int mtu, int promisc, int all_multi, int bcast, int vlanex,
3243 		  bool sleep_ok)
3244 {
3245 	struct fw_vi_rxmode_cmd c;
3246 
3247 	/* convert to FW values */
3248 	if (mtu < 0)
3249 		mtu = FW_RXMODE_MTU_NO_CHG;
3250 	if (promisc < 0)
3251 		promisc = FW_VI_RXMODE_CMD_PROMISCEN_MASK;
3252 	if (all_multi < 0)
3253 		all_multi = FW_VI_RXMODE_CMD_ALLMULTIEN_MASK;
3254 	if (bcast < 0)
3255 		bcast = FW_VI_RXMODE_CMD_BROADCASTEN_MASK;
3256 	if (vlanex < 0)
3257 		vlanex = FW_VI_RXMODE_CMD_VLANEXEN_MASK;
3258 
3259 	memset(&c, 0, sizeof(c));
3260 	c.op_to_viid = htonl(FW_CMD_OP(FW_VI_RXMODE_CMD) | FW_CMD_REQUEST |
3261 			     FW_CMD_WRITE | FW_VI_RXMODE_CMD_VIID(viid));
3262 	c.retval_len16 = htonl(FW_LEN16(c));
3263 	c.mtu_to_vlanexen = htonl(FW_VI_RXMODE_CMD_MTU(mtu) |
3264 				  FW_VI_RXMODE_CMD_PROMISCEN(promisc) |
3265 				  FW_VI_RXMODE_CMD_ALLMULTIEN(all_multi) |
3266 				  FW_VI_RXMODE_CMD_BROADCASTEN(bcast) |
3267 				  FW_VI_RXMODE_CMD_VLANEXEN(vlanex));
3268 	return t4_wr_mbox_meat(adap, mbox, &c, sizeof(c), NULL, sleep_ok);
3269 }
3270 
3271 /**
3272  *	t4_alloc_mac_filt - allocates exact-match filters for MAC addresses
3273  *	@adap: the adapter
3274  *	@mbox: mailbox to use for the FW command
3275  *	@viid: the VI id
3276  *	@free: if true any existing filters for this VI id are first removed
3277  *	@naddr: the number of MAC addresses to allocate filters for (up to 7)
3278  *	@addr: the MAC address(es)
3279  *	@idx: where to store the index of each allocated filter
3280  *	@hash: pointer to hash address filter bitmap
3281  *	@sleep_ok: call is allowed to sleep
3282  *
3283  *	Allocates an exact-match filter for each of the supplied addresses and
3284  *	sets it to the corresponding address.  If @idx is not %NULL it should
3285  *	have at least @naddr entries, each of which will be set to the index of
3286  *	the filter allocated for the corresponding MAC address.  If a filter
3287  *	could not be allocated for an address its index is set to 0xffff.
3288  *	If @hash is not %NULL addresses that fail to allocate an exact filter
3289  *	are hashed and update the hash filter bitmap pointed at by @hash.
3290  *
3291  *	Returns a negative error number or the number of filters allocated.
3292  */
3293 int t4_alloc_mac_filt(struct adapter *adap, unsigned int mbox,
3294 		      unsigned int viid, bool free, unsigned int naddr,
3295 		      const u8 **addr, u16 *idx, u64 *hash, bool sleep_ok)
3296 {
3297 	int i, ret;
3298 	struct fw_vi_mac_cmd c;
3299 	struct fw_vi_mac_exact *p;
3300 	unsigned int max_naddr = is_t4(adap->chip) ?
3301 				       NUM_MPS_CLS_SRAM_L_INSTANCES :
3302 				       NUM_MPS_T5_CLS_SRAM_L_INSTANCES;
3303 
3304 	if (naddr > 7)
3305 		return -EINVAL;
3306 
3307 	memset(&c, 0, sizeof(c));
3308 	c.op_to_viid = htonl(FW_CMD_OP(FW_VI_MAC_CMD) | FW_CMD_REQUEST |
3309 			     FW_CMD_WRITE | (free ? FW_CMD_EXEC : 0) |
3310 			     FW_VI_MAC_CMD_VIID(viid));
3311 	c.freemacs_to_len16 = htonl(FW_VI_MAC_CMD_FREEMACS(free) |
3312 				    FW_CMD_LEN16((naddr + 2) / 2));
3313 
3314 	for (i = 0, p = c.u.exact; i < naddr; i++, p++) {
3315 		p->valid_to_idx = htons(FW_VI_MAC_CMD_VALID |
3316 				      FW_VI_MAC_CMD_IDX(FW_VI_MAC_ADD_MAC));
3317 		memcpy(p->macaddr, addr[i], sizeof(p->macaddr));
3318 	}
3319 
3320 	ret = t4_wr_mbox_meat(adap, mbox, &c, sizeof(c), &c, sleep_ok);
3321 	if (ret)
3322 		return ret;
3323 
3324 	for (i = 0, p = c.u.exact; i < naddr; i++, p++) {
3325 		u16 index = FW_VI_MAC_CMD_IDX_GET(ntohs(p->valid_to_idx));
3326 
3327 		if (idx)
3328 			idx[i] = index >= max_naddr ? 0xffff : index;
3329 		if (index < max_naddr)
3330 			ret++;
3331 		else if (hash)
3332 			*hash |= (1ULL << hash_mac_addr(addr[i]));
3333 	}
3334 	return ret;
3335 }
3336 
3337 /**
3338  *	t4_change_mac - modifies the exact-match filter for a MAC address
3339  *	@adap: the adapter
3340  *	@mbox: mailbox to use for the FW command
3341  *	@viid: the VI id
3342  *	@idx: index of existing filter for old value of MAC address, or -1
3343  *	@addr: the new MAC address value
3344  *	@persist: whether a new MAC allocation should be persistent
3345  *	@add_smt: if true also add the address to the HW SMT
3346  *
3347  *	Modifies an exact-match filter and sets it to the new MAC address.
3348  *	Note that in general it is not possible to modify the value of a given
3349  *	filter so the generic way to modify an address filter is to free the one
3350  *	being used by the old address value and allocate a new filter for the
3351  *	new address value.  @idx can be -1 if the address is a new addition.
3352  *
3353  *	Returns a negative error number or the index of the filter with the new
3354  *	MAC value.
3355  */
3356 int t4_change_mac(struct adapter *adap, unsigned int mbox, unsigned int viid,
3357 		  int idx, const u8 *addr, bool persist, bool add_smt)
3358 {
3359 	int ret, mode;
3360 	struct fw_vi_mac_cmd c;
3361 	struct fw_vi_mac_exact *p = c.u.exact;
3362 	unsigned int max_mac_addr = is_t4(adap->chip) ?
3363 				    NUM_MPS_CLS_SRAM_L_INSTANCES :
3364 				    NUM_MPS_T5_CLS_SRAM_L_INSTANCES;
3365 
3366 	if (idx < 0)                             /* new allocation */
3367 		idx = persist ? FW_VI_MAC_ADD_PERSIST_MAC : FW_VI_MAC_ADD_MAC;
3368 	mode = add_smt ? FW_VI_MAC_SMT_AND_MPSTCAM : FW_VI_MAC_MPS_TCAM_ENTRY;
3369 
3370 	memset(&c, 0, sizeof(c));
3371 	c.op_to_viid = htonl(FW_CMD_OP(FW_VI_MAC_CMD) | FW_CMD_REQUEST |
3372 			     FW_CMD_WRITE | FW_VI_MAC_CMD_VIID(viid));
3373 	c.freemacs_to_len16 = htonl(FW_CMD_LEN16(1));
3374 	p->valid_to_idx = htons(FW_VI_MAC_CMD_VALID |
3375 				FW_VI_MAC_CMD_SMAC_RESULT(mode) |
3376 				FW_VI_MAC_CMD_IDX(idx));
3377 	memcpy(p->macaddr, addr, sizeof(p->macaddr));
3378 
3379 	ret = t4_wr_mbox(adap, mbox, &c, sizeof(c), &c);
3380 	if (ret == 0) {
3381 		ret = FW_VI_MAC_CMD_IDX_GET(ntohs(p->valid_to_idx));
3382 		if (ret >= max_mac_addr)
3383 			ret = -ENOMEM;
3384 	}
3385 	return ret;
3386 }
3387 
3388 /**
3389  *	t4_set_addr_hash - program the MAC inexact-match hash filter
3390  *	@adap: the adapter
3391  *	@mbox: mailbox to use for the FW command
3392  *	@viid: the VI id
3393  *	@ucast: whether the hash filter should also match unicast addresses
3394  *	@vec: the value to be written to the hash filter
3395  *	@sleep_ok: call is allowed to sleep
3396  *
3397  *	Sets the 64-bit inexact-match hash filter for a virtual interface.
3398  */
3399 int t4_set_addr_hash(struct adapter *adap, unsigned int mbox, unsigned int viid,
3400 		     bool ucast, u64 vec, bool sleep_ok)
3401 {
3402 	struct fw_vi_mac_cmd c;
3403 
3404 	memset(&c, 0, sizeof(c));
3405 	c.op_to_viid = htonl(FW_CMD_OP(FW_VI_MAC_CMD) | FW_CMD_REQUEST |
3406 			     FW_CMD_WRITE | FW_VI_ENABLE_CMD_VIID(viid));
3407 	c.freemacs_to_len16 = htonl(FW_VI_MAC_CMD_HASHVECEN |
3408 				    FW_VI_MAC_CMD_HASHUNIEN(ucast) |
3409 				    FW_CMD_LEN16(1));
3410 	c.u.hash.hashvec = cpu_to_be64(vec);
3411 	return t4_wr_mbox_meat(adap, mbox, &c, sizeof(c), NULL, sleep_ok);
3412 }
3413 
3414 /**
3415  *	t4_enable_vi - enable/disable a virtual interface
3416  *	@adap: the adapter
3417  *	@mbox: mailbox to use for the FW command
3418  *	@viid: the VI id
3419  *	@rx_en: 1=enable Rx, 0=disable Rx
3420  *	@tx_en: 1=enable Tx, 0=disable Tx
3421  *
3422  *	Enables/disables a virtual interface.
3423  */
3424 int t4_enable_vi(struct adapter *adap, unsigned int mbox, unsigned int viid,
3425 		 bool rx_en, bool tx_en)
3426 {
3427 	struct fw_vi_enable_cmd c;
3428 
3429 	memset(&c, 0, sizeof(c));
3430 	c.op_to_viid = htonl(FW_CMD_OP(FW_VI_ENABLE_CMD) | FW_CMD_REQUEST |
3431 			     FW_CMD_EXEC | FW_VI_ENABLE_CMD_VIID(viid));
3432 	c.ien_to_len16 = htonl(FW_VI_ENABLE_CMD_IEN(rx_en) |
3433 			       FW_VI_ENABLE_CMD_EEN(tx_en) | FW_LEN16(c));
3434 	return t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
3435 }
3436 
3437 /**
3438  *	t4_identify_port - identify a VI's port by blinking its LED
3439  *	@adap: the adapter
3440  *	@mbox: mailbox to use for the FW command
3441  *	@viid: the VI id
3442  *	@nblinks: how many times to blink LED at 2.5 Hz
3443  *
3444  *	Identifies a VI's port by blinking its LED.
3445  */
3446 int t4_identify_port(struct adapter *adap, unsigned int mbox, unsigned int viid,
3447 		     unsigned int nblinks)
3448 {
3449 	struct fw_vi_enable_cmd c;
3450 
3451 	memset(&c, 0, sizeof(c));
3452 	c.op_to_viid = htonl(FW_CMD_OP(FW_VI_ENABLE_CMD) | FW_CMD_REQUEST |
3453 			     FW_CMD_EXEC | FW_VI_ENABLE_CMD_VIID(viid));
3454 	c.ien_to_len16 = htonl(FW_VI_ENABLE_CMD_LED | FW_LEN16(c));
3455 	c.blinkdur = htons(nblinks);
3456 	return t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
3457 }
3458 
3459 /**
3460  *	t4_iq_free - free an ingress queue and its FLs
3461  *	@adap: the adapter
3462  *	@mbox: mailbox to use for the FW command
3463  *	@pf: the PF owning the queues
3464  *	@vf: the VF owning the queues
3465  *	@iqtype: the ingress queue type
3466  *	@iqid: ingress queue id
3467  *	@fl0id: FL0 queue id or 0xffff if no attached FL0
3468  *	@fl1id: FL1 queue id or 0xffff if no attached FL1
3469  *
3470  *	Frees an ingress queue and its associated FLs, if any.
3471  */
3472 int t4_iq_free(struct adapter *adap, unsigned int mbox, unsigned int pf,
3473 	       unsigned int vf, unsigned int iqtype, unsigned int iqid,
3474 	       unsigned int fl0id, unsigned int fl1id)
3475 {
3476 	struct fw_iq_cmd c;
3477 
3478 	memset(&c, 0, sizeof(c));
3479 	c.op_to_vfn = htonl(FW_CMD_OP(FW_IQ_CMD) | FW_CMD_REQUEST |
3480 			    FW_CMD_EXEC | FW_IQ_CMD_PFN(pf) |
3481 			    FW_IQ_CMD_VFN(vf));
3482 	c.alloc_to_len16 = htonl(FW_IQ_CMD_FREE | FW_LEN16(c));
3483 	c.type_to_iqandstindex = htonl(FW_IQ_CMD_TYPE(iqtype));
3484 	c.iqid = htons(iqid);
3485 	c.fl0id = htons(fl0id);
3486 	c.fl1id = htons(fl1id);
3487 	return t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
3488 }
3489 
3490 /**
3491  *	t4_eth_eq_free - free an Ethernet egress queue
3492  *	@adap: the adapter
3493  *	@mbox: mailbox to use for the FW command
3494  *	@pf: the PF owning the queue
3495  *	@vf: the VF owning the queue
3496  *	@eqid: egress queue id
3497  *
3498  *	Frees an Ethernet egress queue.
3499  */
3500 int t4_eth_eq_free(struct adapter *adap, unsigned int mbox, unsigned int pf,
3501 		   unsigned int vf, unsigned int eqid)
3502 {
3503 	struct fw_eq_eth_cmd c;
3504 
3505 	memset(&c, 0, sizeof(c));
3506 	c.op_to_vfn = htonl(FW_CMD_OP(FW_EQ_ETH_CMD) | FW_CMD_REQUEST |
3507 			    FW_CMD_EXEC | FW_EQ_ETH_CMD_PFN(pf) |
3508 			    FW_EQ_ETH_CMD_VFN(vf));
3509 	c.alloc_to_len16 = htonl(FW_EQ_ETH_CMD_FREE | FW_LEN16(c));
3510 	c.eqid_pkd = htonl(FW_EQ_ETH_CMD_EQID(eqid));
3511 	return t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
3512 }
3513 
3514 /**
3515  *	t4_ctrl_eq_free - free a control egress queue
3516  *	@adap: the adapter
3517  *	@mbox: mailbox to use for the FW command
3518  *	@pf: the PF owning the queue
3519  *	@vf: the VF owning the queue
3520  *	@eqid: egress queue id
3521  *
3522  *	Frees a control egress queue.
3523  */
3524 int t4_ctrl_eq_free(struct adapter *adap, unsigned int mbox, unsigned int pf,
3525 		    unsigned int vf, unsigned int eqid)
3526 {
3527 	struct fw_eq_ctrl_cmd c;
3528 
3529 	memset(&c, 0, sizeof(c));
3530 	c.op_to_vfn = htonl(FW_CMD_OP(FW_EQ_CTRL_CMD) | FW_CMD_REQUEST |
3531 			    FW_CMD_EXEC | FW_EQ_CTRL_CMD_PFN(pf) |
3532 			    FW_EQ_CTRL_CMD_VFN(vf));
3533 	c.alloc_to_len16 = htonl(FW_EQ_CTRL_CMD_FREE | FW_LEN16(c));
3534 	c.cmpliqid_eqid = htonl(FW_EQ_CTRL_CMD_EQID(eqid));
3535 	return t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
3536 }
3537 
3538 /**
3539  *	t4_ofld_eq_free - free an offload egress queue
3540  *	@adap: the adapter
3541  *	@mbox: mailbox to use for the FW command
3542  *	@pf: the PF owning the queue
3543  *	@vf: the VF owning the queue
3544  *	@eqid: egress queue id
3545  *
3546  *	Frees a control egress queue.
3547  */
3548 int t4_ofld_eq_free(struct adapter *adap, unsigned int mbox, unsigned int pf,
3549 		    unsigned int vf, unsigned int eqid)
3550 {
3551 	struct fw_eq_ofld_cmd c;
3552 
3553 	memset(&c, 0, sizeof(c));
3554 	c.op_to_vfn = htonl(FW_CMD_OP(FW_EQ_OFLD_CMD) | FW_CMD_REQUEST |
3555 			    FW_CMD_EXEC | FW_EQ_OFLD_CMD_PFN(pf) |
3556 			    FW_EQ_OFLD_CMD_VFN(vf));
3557 	c.alloc_to_len16 = htonl(FW_EQ_OFLD_CMD_FREE | FW_LEN16(c));
3558 	c.eqid_pkd = htonl(FW_EQ_OFLD_CMD_EQID(eqid));
3559 	return t4_wr_mbox(adap, mbox, &c, sizeof(c), NULL);
3560 }
3561 
3562 /**
3563  *	t4_handle_fw_rpl - process a FW reply message
3564  *	@adap: the adapter
3565  *	@rpl: start of the FW message
3566  *
3567  *	Processes a FW message, such as link state change messages.
3568  */
3569 int t4_handle_fw_rpl(struct adapter *adap, const __be64 *rpl)
3570 {
3571 	u8 opcode = *(const u8 *)rpl;
3572 
3573 	if (opcode == FW_PORT_CMD) {    /* link/module state change message */
3574 		int speed = 0, fc = 0;
3575 		const struct fw_port_cmd *p = (void *)rpl;
3576 		int chan = FW_PORT_CMD_PORTID_GET(ntohl(p->op_to_portid));
3577 		int port = adap->chan_map[chan];
3578 		struct port_info *pi = adap2pinfo(adap, port);
3579 		struct link_config *lc = &pi->link_cfg;
3580 		u32 stat = ntohl(p->u.info.lstatus_to_modtype);
3581 		int link_ok = (stat & FW_PORT_CMD_LSTATUS) != 0;
3582 		u32 mod = FW_PORT_CMD_MODTYPE_GET(stat);
3583 
3584 		if (stat & FW_PORT_CMD_RXPAUSE)
3585 			fc |= PAUSE_RX;
3586 		if (stat & FW_PORT_CMD_TXPAUSE)
3587 			fc |= PAUSE_TX;
3588 		if (stat & FW_PORT_CMD_LSPEED(FW_PORT_CAP_SPEED_100M))
3589 			speed = SPEED_100;
3590 		else if (stat & FW_PORT_CMD_LSPEED(FW_PORT_CAP_SPEED_1G))
3591 			speed = SPEED_1000;
3592 		else if (stat & FW_PORT_CMD_LSPEED(FW_PORT_CAP_SPEED_10G))
3593 			speed = SPEED_10000;
3594 
3595 		if (link_ok != lc->link_ok || speed != lc->speed ||
3596 		    fc != lc->fc) {                    /* something changed */
3597 			lc->link_ok = link_ok;
3598 			lc->speed = speed;
3599 			lc->fc = fc;
3600 			t4_os_link_changed(adap, port, link_ok);
3601 		}
3602 		if (mod != pi->mod_type) {
3603 			pi->mod_type = mod;
3604 			t4_os_portmod_changed(adap, port);
3605 		}
3606 	}
3607 	return 0;
3608 }
3609 
3610 static void get_pci_mode(struct adapter *adapter, struct pci_params *p)
3611 {
3612 	u16 val;
3613 
3614 	if (pci_is_pcie(adapter->pdev)) {
3615 		pcie_capability_read_word(adapter->pdev, PCI_EXP_LNKSTA, &val);
3616 		p->speed = val & PCI_EXP_LNKSTA_CLS;
3617 		p->width = (val & PCI_EXP_LNKSTA_NLW) >> 4;
3618 	}
3619 }
3620 
3621 /**
3622  *	init_link_config - initialize a link's SW state
3623  *	@lc: structure holding the link state
3624  *	@caps: link capabilities
3625  *
3626  *	Initializes the SW state maintained for each link, including the link's
3627  *	capabilities and default speed/flow-control/autonegotiation settings.
3628  */
3629 static void init_link_config(struct link_config *lc, unsigned int caps)
3630 {
3631 	lc->supported = caps;
3632 	lc->requested_speed = 0;
3633 	lc->speed = 0;
3634 	lc->requested_fc = lc->fc = PAUSE_RX | PAUSE_TX;
3635 	if (lc->supported & FW_PORT_CAP_ANEG) {
3636 		lc->advertising = lc->supported & ADVERT_MASK;
3637 		lc->autoneg = AUTONEG_ENABLE;
3638 		lc->requested_fc |= PAUSE_AUTONEG;
3639 	} else {
3640 		lc->advertising = 0;
3641 		lc->autoneg = AUTONEG_DISABLE;
3642 	}
3643 }
3644 
3645 int t4_wait_dev_ready(struct adapter *adap)
3646 {
3647 	if (t4_read_reg(adap, PL_WHOAMI) != 0xffffffff)
3648 		return 0;
3649 	msleep(500);
3650 	return t4_read_reg(adap, PL_WHOAMI) != 0xffffffff ? 0 : -EIO;
3651 }
3652 
3653 static int get_flash_params(struct adapter *adap)
3654 {
3655 	int ret;
3656 	u32 info;
3657 
3658 	ret = sf1_write(adap, 1, 1, 0, SF_RD_ID);
3659 	if (!ret)
3660 		ret = sf1_read(adap, 3, 0, 1, &info);
3661 	t4_write_reg(adap, SF_OP, 0);                    /* unlock SF */
3662 	if (ret)
3663 		return ret;
3664 
3665 	if ((info & 0xff) != 0x20)             /* not a Numonix flash */
3666 		return -EINVAL;
3667 	info >>= 16;                           /* log2 of size */
3668 	if (info >= 0x14 && info < 0x18)
3669 		adap->params.sf_nsec = 1 << (info - 16);
3670 	else if (info == 0x18)
3671 		adap->params.sf_nsec = 64;
3672 	else
3673 		return -EINVAL;
3674 	adap->params.sf_size = 1 << info;
3675 	adap->params.sf_fw_start =
3676 		t4_read_reg(adap, CIM_BOOT_CFG) & BOOTADDR_MASK;
3677 	return 0;
3678 }
3679 
3680 /**
3681  *	t4_prep_adapter - prepare SW and HW for operation
3682  *	@adapter: the adapter
3683  *	@reset: if true perform a HW reset
3684  *
3685  *	Initialize adapter SW state for the various HW modules, set initial
3686  *	values for some adapter tunables, take PHYs out of reset, and
3687  *	initialize the MDIO interface.
3688  */
3689 int t4_prep_adapter(struct adapter *adapter)
3690 {
3691 	int ret, ver;
3692 	uint16_t device_id;
3693 
3694 	ret = t4_wait_dev_ready(adapter);
3695 	if (ret < 0)
3696 		return ret;
3697 
3698 	get_pci_mode(adapter, &adapter->params.pci);
3699 	adapter->params.rev = t4_read_reg(adapter, PL_REV);
3700 
3701 	ret = get_flash_params(adapter);
3702 	if (ret < 0) {
3703 		dev_err(adapter->pdev_dev, "error %d identifying flash\n", ret);
3704 		return ret;
3705 	}
3706 
3707 	/* Retrieve adapter's device ID
3708 	 */
3709 	pci_read_config_word(adapter->pdev, PCI_DEVICE_ID, &device_id);
3710 	ver = device_id >> 12;
3711 	switch (ver) {
3712 	case CHELSIO_T4:
3713 		adapter->chip = CHELSIO_CHIP_CODE(CHELSIO_T4,
3714 						  adapter->params.rev);
3715 		break;
3716 	case CHELSIO_T5:
3717 		adapter->chip = CHELSIO_CHIP_CODE(CHELSIO_T5,
3718 						  adapter->params.rev);
3719 		break;
3720 	default:
3721 		dev_err(adapter->pdev_dev, "Device %d is not supported\n",
3722 			device_id);
3723 		return -EINVAL;
3724 	}
3725 
3726 	/* Reassign the updated revision field */
3727 	adapter->params.rev = adapter->chip;
3728 
3729 	init_cong_ctrl(adapter->params.a_wnd, adapter->params.b_wnd);
3730 
3731 	/*
3732 	 * Default port for debugging in case we can't reach FW.
3733 	 */
3734 	adapter->params.nports = 1;
3735 	adapter->params.portvec = 1;
3736 	adapter->params.vpd.cclk = 50000;
3737 	return 0;
3738 }
3739 
3740 int t4_port_init(struct adapter *adap, int mbox, int pf, int vf)
3741 {
3742 	u8 addr[6];
3743 	int ret, i, j = 0;
3744 	struct fw_port_cmd c;
3745 	struct fw_rss_vi_config_cmd rvc;
3746 
3747 	memset(&c, 0, sizeof(c));
3748 	memset(&rvc, 0, sizeof(rvc));
3749 
3750 	for_each_port(adap, i) {
3751 		unsigned int rss_size;
3752 		struct port_info *p = adap2pinfo(adap, i);
3753 
3754 		while ((adap->params.portvec & (1 << j)) == 0)
3755 			j++;
3756 
3757 		c.op_to_portid = htonl(FW_CMD_OP(FW_PORT_CMD) |
3758 				       FW_CMD_REQUEST | FW_CMD_READ |
3759 				       FW_PORT_CMD_PORTID(j));
3760 		c.action_to_len16 = htonl(
3761 			FW_PORT_CMD_ACTION(FW_PORT_ACTION_GET_PORT_INFO) |
3762 			FW_LEN16(c));
3763 		ret = t4_wr_mbox(adap, mbox, &c, sizeof(c), &c);
3764 		if (ret)
3765 			return ret;
3766 
3767 		ret = t4_alloc_vi(adap, mbox, j, pf, vf, 1, addr, &rss_size);
3768 		if (ret < 0)
3769 			return ret;
3770 
3771 		p->viid = ret;
3772 		p->tx_chan = j;
3773 		p->lport = j;
3774 		p->rss_size = rss_size;
3775 		memcpy(adap->port[i]->dev_addr, addr, ETH_ALEN);
3776 		adap->port[i]->dev_id = j;
3777 
3778 		ret = ntohl(c.u.info.lstatus_to_modtype);
3779 		p->mdio_addr = (ret & FW_PORT_CMD_MDIOCAP) ?
3780 			FW_PORT_CMD_MDIOADDR_GET(ret) : -1;
3781 		p->port_type = FW_PORT_CMD_PTYPE_GET(ret);
3782 		p->mod_type = FW_PORT_MOD_TYPE_NA;
3783 
3784 		rvc.op_to_viid = htonl(FW_CMD_OP(FW_RSS_VI_CONFIG_CMD) |
3785 				       FW_CMD_REQUEST | FW_CMD_READ |
3786 				       FW_RSS_VI_CONFIG_CMD_VIID(p->viid));
3787 		rvc.retval_len16 = htonl(FW_LEN16(rvc));
3788 		ret = t4_wr_mbox(adap, mbox, &rvc, sizeof(rvc), &rvc);
3789 		if (ret)
3790 			return ret;
3791 		p->rss_mode = ntohl(rvc.u.basicvirtual.defaultq_to_udpen);
3792 
3793 		init_link_config(&p->link_cfg, ntohs(c.u.info.pcap));
3794 		j++;
3795 	}
3796 	return 0;
3797 }
3798