net: vlan: rename NETIF_F_HW_VLAN_* feature flags to NETIF_F_HW_VLAN_CTAG_*
[deliverable/linux.git] / drivers / net / ethernet / chelsio / cxgb4 / cxgb4_main.c
CommitLineData
b8ff05a9
DM
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#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
36
37#include <linux/bitmap.h>
38#include <linux/crc32.h>
39#include <linux/ctype.h>
40#include <linux/debugfs.h>
41#include <linux/err.h>
42#include <linux/etherdevice.h>
43#include <linux/firmware.h>
01789349 44#include <linux/if.h>
b8ff05a9
DM
45#include <linux/if_vlan.h>
46#include <linux/init.h>
47#include <linux/log2.h>
48#include <linux/mdio.h>
49#include <linux/module.h>
50#include <linux/moduleparam.h>
51#include <linux/mutex.h>
52#include <linux/netdevice.h>
53#include <linux/pci.h>
54#include <linux/aer.h>
55#include <linux/rtnetlink.h>
56#include <linux/sched.h>
57#include <linux/seq_file.h>
58#include <linux/sockios.h>
59#include <linux/vmalloc.h>
60#include <linux/workqueue.h>
61#include <net/neighbour.h>
62#include <net/netevent.h>
63#include <asm/uaccess.h>
64
65#include "cxgb4.h"
66#include "t4_regs.h"
67#include "t4_msg.h"
68#include "t4fw_api.h"
69#include "l2t.h"
70
3a7f8554
SR
71#define DRV_VERSION "2.0.0-ko"
72#define DRV_DESC "Chelsio T4/T5 Network Driver"
b8ff05a9
DM
73
74/*
75 * Max interrupt hold-off timer value in us. Queues fall back to this value
76 * under extreme memory pressure so it's largish to give the system time to
77 * recover.
78 */
79#define MAX_SGE_TIMERVAL 200U
80
7ee9ff94 81enum {
13ee15d3
VP
82 /*
83 * Physical Function provisioning constants.
84 */
85 PFRES_NVI = 4, /* # of Virtual Interfaces */
86 PFRES_NETHCTRL = 128, /* # of EQs used for ETH or CTRL Qs */
87 PFRES_NIQFLINT = 128, /* # of ingress Qs/w Free List(s)/intr
88 */
89 PFRES_NEQ = 256, /* # of egress queues */
90 PFRES_NIQ = 0, /* # of ingress queues */
91 PFRES_TC = 0, /* PCI-E traffic class */
92 PFRES_NEXACTF = 128, /* # of exact MPS filters */
93
94 PFRES_R_CAPS = FW_CMD_CAP_PF,
95 PFRES_WX_CAPS = FW_CMD_CAP_PF,
96
97#ifdef CONFIG_PCI_IOV
98 /*
99 * Virtual Function provisioning constants. We need two extra Ingress
100 * Queues with Interrupt capability to serve as the VF's Firmware
101 * Event Queue and Forwarded Interrupt Queue (when using MSI mode) --
102 * neither will have Free Lists associated with them). For each
103 * Ethernet/Control Egress Queue and for each Free List, we need an
104 * Egress Context.
105 */
7ee9ff94
CL
106 VFRES_NPORTS = 1, /* # of "ports" per VF */
107 VFRES_NQSETS = 2, /* # of "Queue Sets" per VF */
108
109 VFRES_NVI = VFRES_NPORTS, /* # of Virtual Interfaces */
110 VFRES_NETHCTRL = VFRES_NQSETS, /* # of EQs used for ETH or CTRL Qs */
111 VFRES_NIQFLINT = VFRES_NQSETS+2,/* # of ingress Qs/w Free List(s)/intr */
7ee9ff94 112 VFRES_NEQ = VFRES_NQSETS*2, /* # of egress queues */
13ee15d3 113 VFRES_NIQ = 0, /* # of non-fl/int ingress queues */
7ee9ff94
CL
114 VFRES_TC = 0, /* PCI-E traffic class */
115 VFRES_NEXACTF = 16, /* # of exact MPS filters */
116
117 VFRES_R_CAPS = FW_CMD_CAP_DMAQ|FW_CMD_CAP_VF|FW_CMD_CAP_PORT,
118 VFRES_WX_CAPS = FW_CMD_CAP_DMAQ|FW_CMD_CAP_VF,
13ee15d3 119#endif
7ee9ff94
CL
120};
121
122/*
123 * Provide a Port Access Rights Mask for the specified PF/VF. This is very
124 * static and likely not to be useful in the long run. We really need to
125 * implement some form of persistent configuration which the firmware
126 * controls.
127 */
128static unsigned int pfvfres_pmask(struct adapter *adapter,
129 unsigned int pf, unsigned int vf)
130{
131 unsigned int portn, portvec;
132
133 /*
134 * Give PF's access to all of the ports.
135 */
136 if (vf == 0)
137 return FW_PFVF_CMD_PMASK_MASK;
138
139 /*
140 * For VFs, we'll assign them access to the ports based purely on the
141 * PF. We assign active ports in order, wrapping around if there are
142 * fewer active ports than PFs: e.g. active port[pf % nports].
143 * Unfortunately the adapter's port_info structs haven't been
144 * initialized yet so we have to compute this.
145 */
146 if (adapter->params.nports == 0)
147 return 0;
148
149 portn = pf % adapter->params.nports;
150 portvec = adapter->params.portvec;
151 for (;;) {
152 /*
153 * Isolate the lowest set bit in the port vector. If we're at
154 * the port number that we want, return that as the pmask.
155 * otherwise mask that bit out of the port vector and
156 * decrement our port number ...
157 */
158 unsigned int pmask = portvec ^ (portvec & (portvec-1));
159 if (portn == 0)
160 return pmask;
161 portn--;
162 portvec &= ~pmask;
163 }
164 /*NOTREACHED*/
165}
7ee9ff94 166
b8ff05a9
DM
167enum {
168 MAX_TXQ_ENTRIES = 16384,
169 MAX_CTRL_TXQ_ENTRIES = 1024,
170 MAX_RSPQ_ENTRIES = 16384,
171 MAX_RX_BUFFERS = 16384,
172 MIN_TXQ_ENTRIES = 32,
173 MIN_CTRL_TXQ_ENTRIES = 32,
174 MIN_RSPQ_ENTRIES = 128,
175 MIN_FL_ENTRIES = 16
176};
177
f2b7e78d
VP
178/* Host shadow copy of ingress filter entry. This is in host native format
179 * and doesn't match the ordering or bit order, etc. of the hardware of the
180 * firmware command. The use of bit-field structure elements is purely to
181 * remind ourselves of the field size limitations and save memory in the case
182 * where the filter table is large.
183 */
184struct filter_entry {
185 /* Administrative fields for filter.
186 */
187 u32 valid:1; /* filter allocated and valid */
188 u32 locked:1; /* filter is administratively locked */
189
190 u32 pending:1; /* filter action is pending firmware reply */
191 u32 smtidx:8; /* Source MAC Table index for smac */
192 struct l2t_entry *l2t; /* Layer Two Table entry for dmac */
193
194 /* The filter itself. Most of this is a straight copy of information
195 * provided by the extended ioctl(). Some fields are translated to
196 * internal forms -- for instance the Ingress Queue ID passed in from
197 * the ioctl() is translated into the Absolute Ingress Queue ID.
198 */
199 struct ch_filter_specification fs;
200};
201
b8ff05a9
DM
202#define DFLT_MSG_ENABLE (NETIF_MSG_DRV | NETIF_MSG_PROBE | NETIF_MSG_LINK | \
203 NETIF_MSG_TIMER | NETIF_MSG_IFDOWN | NETIF_MSG_IFUP |\
204 NETIF_MSG_RX_ERR | NETIF_MSG_TX_ERR)
205
060e0c75 206#define CH_DEVICE(devid, data) { PCI_VDEVICE(CHELSIO, devid), (data) }
b8ff05a9
DM
207
208static DEFINE_PCI_DEVICE_TABLE(cxgb4_pci_tbl) = {
060e0c75 209 CH_DEVICE(0xa000, 0), /* PE10K */
ccea790e
DM
210 CH_DEVICE(0x4001, -1),
211 CH_DEVICE(0x4002, -1),
212 CH_DEVICE(0x4003, -1),
213 CH_DEVICE(0x4004, -1),
214 CH_DEVICE(0x4005, -1),
215 CH_DEVICE(0x4006, -1),
216 CH_DEVICE(0x4007, -1),
217 CH_DEVICE(0x4008, -1),
218 CH_DEVICE(0x4009, -1),
219 CH_DEVICE(0x400a, -1),
220 CH_DEVICE(0x4401, 4),
221 CH_DEVICE(0x4402, 4),
222 CH_DEVICE(0x4403, 4),
223 CH_DEVICE(0x4404, 4),
224 CH_DEVICE(0x4405, 4),
225 CH_DEVICE(0x4406, 4),
226 CH_DEVICE(0x4407, 4),
227 CH_DEVICE(0x4408, 4),
228 CH_DEVICE(0x4409, 4),
229 CH_DEVICE(0x440a, 4),
f637d577
VP
230 CH_DEVICE(0x440d, 4),
231 CH_DEVICE(0x440e, 4),
9616407c
SR
232 CH_DEVICE(0x5001, 5),
233 CH_DEVICE(0x5002, 5),
234 CH_DEVICE(0x5003, 5),
235 CH_DEVICE(0x5004, 5),
236 CH_DEVICE(0x5005, 5),
237 CH_DEVICE(0x5006, 5),
238 CH_DEVICE(0x5007, 5),
239 CH_DEVICE(0x5008, 5),
240 CH_DEVICE(0x5009, 5),
241 CH_DEVICE(0x500A, 5),
242 CH_DEVICE(0x500B, 5),
243 CH_DEVICE(0x500C, 5),
244 CH_DEVICE(0x500D, 5),
245 CH_DEVICE(0x500E, 5),
246 CH_DEVICE(0x500F, 5),
247 CH_DEVICE(0x5010, 5),
248 CH_DEVICE(0x5011, 5),
249 CH_DEVICE(0x5012, 5),
250 CH_DEVICE(0x5013, 5),
251 CH_DEVICE(0x5401, 5),
252 CH_DEVICE(0x5402, 5),
253 CH_DEVICE(0x5403, 5),
254 CH_DEVICE(0x5404, 5),
255 CH_DEVICE(0x5405, 5),
256 CH_DEVICE(0x5406, 5),
257 CH_DEVICE(0x5407, 5),
258 CH_DEVICE(0x5408, 5),
259 CH_DEVICE(0x5409, 5),
260 CH_DEVICE(0x540A, 5),
261 CH_DEVICE(0x540B, 5),
262 CH_DEVICE(0x540C, 5),
263 CH_DEVICE(0x540D, 5),
264 CH_DEVICE(0x540E, 5),
265 CH_DEVICE(0x540F, 5),
266 CH_DEVICE(0x5410, 5),
267 CH_DEVICE(0x5411, 5),
268 CH_DEVICE(0x5412, 5),
269 CH_DEVICE(0x5413, 5),
b8ff05a9
DM
270 { 0, }
271};
272
273#define FW_FNAME "cxgb4/t4fw.bin"
0a57a536 274#define FW5_FNAME "cxgb4/t5fw.bin"
636f9d37 275#define FW_CFNAME "cxgb4/t4-config.txt"
0a57a536 276#define FW5_CFNAME "cxgb4/t5-config.txt"
b8ff05a9
DM
277
278MODULE_DESCRIPTION(DRV_DESC);
279MODULE_AUTHOR("Chelsio Communications");
280MODULE_LICENSE("Dual BSD/GPL");
281MODULE_VERSION(DRV_VERSION);
282MODULE_DEVICE_TABLE(pci, cxgb4_pci_tbl);
283MODULE_FIRMWARE(FW_FNAME);
0a57a536 284MODULE_FIRMWARE(FW5_FNAME);
b8ff05a9 285
636f9d37
VP
286/*
287 * Normally we're willing to become the firmware's Master PF but will be happy
288 * if another PF has already become the Master and initialized the adapter.
289 * Setting "force_init" will cause this driver to forcibly establish itself as
290 * the Master PF and initialize the adapter.
291 */
292static uint force_init;
293
294module_param(force_init, uint, 0644);
295MODULE_PARM_DESC(force_init, "Forcibly become Master PF and initialize adapter");
296
13ee15d3
VP
297/*
298 * Normally if the firmware we connect to has Configuration File support, we
299 * use that and only fall back to the old Driver-based initialization if the
300 * Configuration File fails for some reason. If force_old_init is set, then
301 * we'll always use the old Driver-based initialization sequence.
302 */
303static uint force_old_init;
304
305module_param(force_old_init, uint, 0644);
306MODULE_PARM_DESC(force_old_init, "Force old initialization sequence");
307
b8ff05a9
DM
308static int dflt_msg_enable = DFLT_MSG_ENABLE;
309
310module_param(dflt_msg_enable, int, 0644);
311MODULE_PARM_DESC(dflt_msg_enable, "Chelsio T4 default message enable bitmap");
312
313/*
314 * The driver uses the best interrupt scheme available on a platform in the
315 * order MSI-X, MSI, legacy INTx interrupts. This parameter determines which
316 * of these schemes the driver may consider as follows:
317 *
318 * msi = 2: choose from among all three options
319 * msi = 1: only consider MSI and INTx interrupts
320 * msi = 0: force INTx interrupts
321 */
322static int msi = 2;
323
324module_param(msi, int, 0644);
325MODULE_PARM_DESC(msi, "whether to use INTx (0), MSI (1) or MSI-X (2)");
326
327/*
328 * Queue interrupt hold-off timer values. Queues default to the first of these
329 * upon creation.
330 */
331static unsigned int intr_holdoff[SGE_NTIMERS - 1] = { 5, 10, 20, 50, 100 };
332
333module_param_array(intr_holdoff, uint, NULL, 0644);
334MODULE_PARM_DESC(intr_holdoff, "values for queue interrupt hold-off timers "
335 "0..4 in microseconds");
336
337static unsigned int intr_cnt[SGE_NCOUNTERS - 1] = { 4, 8, 16 };
338
339module_param_array(intr_cnt, uint, NULL, 0644);
340MODULE_PARM_DESC(intr_cnt,
341 "thresholds 1..3 for queue interrupt packet counters");
342
636f9d37
VP
343/*
344 * Normally we tell the chip to deliver Ingress Packets into our DMA buffers
345 * offset by 2 bytes in order to have the IP headers line up on 4-byte
346 * boundaries. This is a requirement for many architectures which will throw
347 * a machine check fault if an attempt is made to access one of the 4-byte IP
348 * header fields on a non-4-byte boundary. And it's a major performance issue
349 * even on some architectures which allow it like some implementations of the
350 * x86 ISA. However, some architectures don't mind this and for some very
351 * edge-case performance sensitive applications (like forwarding large volumes
352 * of small packets), setting this DMA offset to 0 will decrease the number of
353 * PCI-E Bus transfers enough to measurably affect performance.
354 */
355static int rx_dma_offset = 2;
356
eb939922 357static bool vf_acls;
b8ff05a9
DM
358
359#ifdef CONFIG_PCI_IOV
360module_param(vf_acls, bool, 0644);
361MODULE_PARM_DESC(vf_acls, "if set enable virtualization L2 ACL enforcement");
362
7d6727cf
SR
363/* Configure the number of PCI-E Virtual Function which are to be instantiated
364 * on SR-IOV Capable Physical Functions.
0a57a536 365 */
7d6727cf 366static unsigned int num_vf[NUM_OF_PF_WITH_SRIOV];
b8ff05a9
DM
367
368module_param_array(num_vf, uint, NULL, 0644);
7d6727cf 369MODULE_PARM_DESC(num_vf, "number of VFs for each of PFs 0-3");
b8ff05a9
DM
370#endif
371
13ee15d3
VP
372/*
373 * The filter TCAM has a fixed portion and a variable portion. The fixed
374 * portion can match on source/destination IP IPv4/IPv6 addresses and TCP/UDP
375 * ports. The variable portion is 36 bits which can include things like Exact
376 * Match MAC Index (9 bits), Ether Type (16 bits), IP Protocol (8 bits),
377 * [Inner] VLAN Tag (17 bits), etc. which, if all were somehow selected, would
378 * far exceed the 36-bit budget for this "compressed" header portion of the
379 * filter. Thus, we have a scarce resource which must be carefully managed.
380 *
381 * By default we set this up to mostly match the set of filter matching
382 * capabilities of T3 but with accommodations for some of T4's more
383 * interesting features:
384 *
385 * { IP Fragment (1), MPS Match Type (3), IP Protocol (8),
386 * [Inner] VLAN (17), Port (3), FCoE (1) }
387 */
388enum {
389 TP_VLAN_PRI_MAP_DEFAULT = HW_TPL_FR_MT_PR_IV_P_FC,
390 TP_VLAN_PRI_MAP_FIRST = FCOE_SHIFT,
391 TP_VLAN_PRI_MAP_LAST = FRAGMENTATION_SHIFT,
392};
393
394static unsigned int tp_vlan_pri_map = TP_VLAN_PRI_MAP_DEFAULT;
395
f2b7e78d
VP
396module_param(tp_vlan_pri_map, uint, 0644);
397MODULE_PARM_DESC(tp_vlan_pri_map, "global compressed filter configuration");
398
b8ff05a9
DM
399static struct dentry *cxgb4_debugfs_root;
400
401static LIST_HEAD(adapter_list);
402static DEFINE_MUTEX(uld_mutex);
403static struct cxgb4_uld_info ulds[CXGB4_ULD_MAX];
404static const char *uld_str[] = { "RDMA", "iSCSI" };
405
406static void link_report(struct net_device *dev)
407{
408 if (!netif_carrier_ok(dev))
409 netdev_info(dev, "link down\n");
410 else {
411 static const char *fc[] = { "no", "Rx", "Tx", "Tx/Rx" };
412
413 const char *s = "10Mbps";
414 const struct port_info *p = netdev_priv(dev);
415
416 switch (p->link_cfg.speed) {
417 case SPEED_10000:
418 s = "10Gbps";
419 break;
420 case SPEED_1000:
421 s = "1000Mbps";
422 break;
423 case SPEED_100:
424 s = "100Mbps";
425 break;
426 }
427
428 netdev_info(dev, "link up, %s, full-duplex, %s PAUSE\n", s,
429 fc[p->link_cfg.fc]);
430 }
431}
432
433void t4_os_link_changed(struct adapter *adapter, int port_id, int link_stat)
434{
435 struct net_device *dev = adapter->port[port_id];
436
437 /* Skip changes from disabled ports. */
438 if (netif_running(dev) && link_stat != netif_carrier_ok(dev)) {
439 if (link_stat)
440 netif_carrier_on(dev);
441 else
442 netif_carrier_off(dev);
443
444 link_report(dev);
445 }
446}
447
448void t4_os_portmod_changed(const struct adapter *adap, int port_id)
449{
450 static const char *mod_str[] = {
a0881cab 451 NULL, "LR", "SR", "ER", "passive DA", "active DA", "LRM"
b8ff05a9
DM
452 };
453
454 const struct net_device *dev = adap->port[port_id];
455 const struct port_info *pi = netdev_priv(dev);
456
457 if (pi->mod_type == FW_PORT_MOD_TYPE_NONE)
458 netdev_info(dev, "port module unplugged\n");
a0881cab 459 else if (pi->mod_type < ARRAY_SIZE(mod_str))
b8ff05a9
DM
460 netdev_info(dev, "%s module inserted\n", mod_str[pi->mod_type]);
461}
462
463/*
464 * Configure the exact and hash address filters to handle a port's multicast
465 * and secondary unicast MAC addresses.
466 */
467static int set_addr_filters(const struct net_device *dev, bool sleep)
468{
469 u64 mhash = 0;
470 u64 uhash = 0;
471 bool free = true;
472 u16 filt_idx[7];
473 const u8 *addr[7];
474 int ret, naddr = 0;
b8ff05a9
DM
475 const struct netdev_hw_addr *ha;
476 int uc_cnt = netdev_uc_count(dev);
4a35ecf8 477 int mc_cnt = netdev_mc_count(dev);
b8ff05a9 478 const struct port_info *pi = netdev_priv(dev);
060e0c75 479 unsigned int mb = pi->adapter->fn;
b8ff05a9
DM
480
481 /* first do the secondary unicast addresses */
482 netdev_for_each_uc_addr(ha, dev) {
483 addr[naddr++] = ha->addr;
484 if (--uc_cnt == 0 || naddr >= ARRAY_SIZE(addr)) {
060e0c75 485 ret = t4_alloc_mac_filt(pi->adapter, mb, pi->viid, free,
b8ff05a9
DM
486 naddr, addr, filt_idx, &uhash, sleep);
487 if (ret < 0)
488 return ret;
489
490 free = false;
491 naddr = 0;
492 }
493 }
494
495 /* next set up the multicast addresses */
4a35ecf8
DM
496 netdev_for_each_mc_addr(ha, dev) {
497 addr[naddr++] = ha->addr;
498 if (--mc_cnt == 0 || naddr >= ARRAY_SIZE(addr)) {
060e0c75 499 ret = t4_alloc_mac_filt(pi->adapter, mb, pi->viid, free,
b8ff05a9
DM
500 naddr, addr, filt_idx, &mhash, sleep);
501 if (ret < 0)
502 return ret;
503
504 free = false;
505 naddr = 0;
506 }
507 }
508
060e0c75 509 return t4_set_addr_hash(pi->adapter, mb, pi->viid, uhash != 0,
b8ff05a9
DM
510 uhash | mhash, sleep);
511}
512
3069ee9b
VP
513int dbfifo_int_thresh = 10; /* 10 == 640 entry threshold */
514module_param(dbfifo_int_thresh, int, 0644);
515MODULE_PARM_DESC(dbfifo_int_thresh, "doorbell fifo interrupt threshold");
516
404d9e3f
VP
517/*
518 * usecs to sleep while draining the dbfifo
519 */
520static int dbfifo_drain_delay = 1000;
3069ee9b
VP
521module_param(dbfifo_drain_delay, int, 0644);
522MODULE_PARM_DESC(dbfifo_drain_delay,
523 "usecs to sleep while draining the dbfifo");
524
b8ff05a9
DM
525/*
526 * Set Rx properties of a port, such as promiscruity, address filters, and MTU.
527 * If @mtu is -1 it is left unchanged.
528 */
529static int set_rxmode(struct net_device *dev, int mtu, bool sleep_ok)
530{
531 int ret;
532 struct port_info *pi = netdev_priv(dev);
533
534 ret = set_addr_filters(dev, sleep_ok);
535 if (ret == 0)
060e0c75 536 ret = t4_set_rxmode(pi->adapter, pi->adapter->fn, pi->viid, mtu,
b8ff05a9 537 (dev->flags & IFF_PROMISC) ? 1 : 0,
f8f5aafa 538 (dev->flags & IFF_ALLMULTI) ? 1 : 0, 1, -1,
b8ff05a9
DM
539 sleep_ok);
540 return ret;
541}
542
3069ee9b
VP
543static struct workqueue_struct *workq;
544
b8ff05a9
DM
545/**
546 * link_start - enable a port
547 * @dev: the port to enable
548 *
549 * Performs the MAC and PHY actions needed to enable a port.
550 */
551static int link_start(struct net_device *dev)
552{
553 int ret;
554 struct port_info *pi = netdev_priv(dev);
060e0c75 555 unsigned int mb = pi->adapter->fn;
b8ff05a9
DM
556
557 /*
558 * We do not set address filters and promiscuity here, the stack does
559 * that step explicitly.
560 */
060e0c75 561 ret = t4_set_rxmode(pi->adapter, mb, pi->viid, dev->mtu, -1, -1, -1,
f646968f 562 !!(dev->features & NETIF_F_HW_VLAN_CTAG_RX), true);
b8ff05a9 563 if (ret == 0) {
060e0c75 564 ret = t4_change_mac(pi->adapter, mb, pi->viid,
b8ff05a9 565 pi->xact_addr_filt, dev->dev_addr, true,
b6bd29e7 566 true);
b8ff05a9
DM
567 if (ret >= 0) {
568 pi->xact_addr_filt = ret;
569 ret = 0;
570 }
571 }
572 if (ret == 0)
060e0c75
DM
573 ret = t4_link_start(pi->adapter, mb, pi->tx_chan,
574 &pi->link_cfg);
b8ff05a9 575 if (ret == 0)
060e0c75 576 ret = t4_enable_vi(pi->adapter, mb, pi->viid, true, true);
b8ff05a9
DM
577 return ret;
578}
579
f2b7e78d
VP
580/* Clear a filter and release any of its resources that we own. This also
581 * clears the filter's "pending" status.
582 */
583static void clear_filter(struct adapter *adap, struct filter_entry *f)
584{
585 /* If the new or old filter have loopback rewriteing rules then we'll
586 * need to free any existing Layer Two Table (L2T) entries of the old
587 * filter rule. The firmware will handle freeing up any Source MAC
588 * Table (SMT) entries used for rewriting Source MAC Addresses in
589 * loopback rules.
590 */
591 if (f->l2t)
592 cxgb4_l2t_release(f->l2t);
593
594 /* The zeroing of the filter rule below clears the filter valid,
595 * pending, locked flags, l2t pointer, etc. so it's all we need for
596 * this operation.
597 */
598 memset(f, 0, sizeof(*f));
599}
600
601/* Handle a filter write/deletion reply.
602 */
603static void filter_rpl(struct adapter *adap, const struct cpl_set_tcb_rpl *rpl)
604{
605 unsigned int idx = GET_TID(rpl);
606 unsigned int nidx = idx - adap->tids.ftid_base;
607 unsigned int ret;
608 struct filter_entry *f;
609
610 if (idx >= adap->tids.ftid_base && nidx <
611 (adap->tids.nftids + adap->tids.nsftids)) {
612 idx = nidx;
613 ret = GET_TCB_COOKIE(rpl->cookie);
614 f = &adap->tids.ftid_tab[idx];
615
616 if (ret == FW_FILTER_WR_FLT_DELETED) {
617 /* Clear the filter when we get confirmation from the
618 * hardware that the filter has been deleted.
619 */
620 clear_filter(adap, f);
621 } else if (ret == FW_FILTER_WR_SMT_TBL_FULL) {
622 dev_err(adap->pdev_dev, "filter %u setup failed due to full SMT\n",
623 idx);
624 clear_filter(adap, f);
625 } else if (ret == FW_FILTER_WR_FLT_ADDED) {
626 f->smtidx = (be64_to_cpu(rpl->oldval) >> 24) & 0xff;
627 f->pending = 0; /* asynchronous setup completed */
628 f->valid = 1;
629 } else {
630 /* Something went wrong. Issue a warning about the
631 * problem and clear everything out.
632 */
633 dev_err(adap->pdev_dev, "filter %u setup failed with error %u\n",
634 idx, ret);
635 clear_filter(adap, f);
636 }
637 }
638}
639
640/* Response queue handler for the FW event queue.
b8ff05a9
DM
641 */
642static int fwevtq_handler(struct sge_rspq *q, const __be64 *rsp,
643 const struct pkt_gl *gl)
644{
645 u8 opcode = ((const struct rss_header *)rsp)->opcode;
646
647 rsp++; /* skip RSS header */
648 if (likely(opcode == CPL_SGE_EGR_UPDATE)) {
649 const struct cpl_sge_egr_update *p = (void *)rsp;
650 unsigned int qid = EGR_QID(ntohl(p->opcode_qid));
e46dab4d 651 struct sge_txq *txq;
b8ff05a9 652
e46dab4d 653 txq = q->adap->sge.egr_map[qid - q->adap->sge.egr_start];
b8ff05a9 654 txq->restarts++;
e46dab4d 655 if ((u8 *)txq < (u8 *)q->adap->sge.ofldtxq) {
b8ff05a9
DM
656 struct sge_eth_txq *eq;
657
658 eq = container_of(txq, struct sge_eth_txq, q);
659 netif_tx_wake_queue(eq->txq);
660 } else {
661 struct sge_ofld_txq *oq;
662
663 oq = container_of(txq, struct sge_ofld_txq, q);
664 tasklet_schedule(&oq->qresume_tsk);
665 }
666 } else if (opcode == CPL_FW6_MSG || opcode == CPL_FW4_MSG) {
667 const struct cpl_fw6_msg *p = (void *)rsp;
668
669 if (p->type == 0)
670 t4_handle_fw_rpl(q->adap, p->data);
671 } else if (opcode == CPL_L2T_WRITE_RPL) {
672 const struct cpl_l2t_write_rpl *p = (void *)rsp;
673
674 do_l2t_write_rpl(q->adap, p);
f2b7e78d
VP
675 } else if (opcode == CPL_SET_TCB_RPL) {
676 const struct cpl_set_tcb_rpl *p = (void *)rsp;
677
678 filter_rpl(q->adap, p);
b8ff05a9
DM
679 } else
680 dev_err(q->adap->pdev_dev,
681 "unexpected CPL %#x on FW event queue\n", opcode);
682 return 0;
683}
684
685/**
686 * uldrx_handler - response queue handler for ULD queues
687 * @q: the response queue that received the packet
688 * @rsp: the response queue descriptor holding the offload message
689 * @gl: the gather list of packet fragments
690 *
691 * Deliver an ingress offload packet to a ULD. All processing is done by
692 * the ULD, we just maintain statistics.
693 */
694static int uldrx_handler(struct sge_rspq *q, const __be64 *rsp,
695 const struct pkt_gl *gl)
696{
697 struct sge_ofld_rxq *rxq = container_of(q, struct sge_ofld_rxq, rspq);
698
699 if (ulds[q->uld].rx_handler(q->adap->uld_handle[q->uld], rsp, gl)) {
700 rxq->stats.nomem++;
701 return -1;
702 }
703 if (gl == NULL)
704 rxq->stats.imm++;
705 else if (gl == CXGB4_MSG_AN)
706 rxq->stats.an++;
707 else
708 rxq->stats.pkts++;
709 return 0;
710}
711
712static void disable_msi(struct adapter *adapter)
713{
714 if (adapter->flags & USING_MSIX) {
715 pci_disable_msix(adapter->pdev);
716 adapter->flags &= ~USING_MSIX;
717 } else if (adapter->flags & USING_MSI) {
718 pci_disable_msi(adapter->pdev);
719 adapter->flags &= ~USING_MSI;
720 }
721}
722
723/*
724 * Interrupt handler for non-data events used with MSI-X.
725 */
726static irqreturn_t t4_nondata_intr(int irq, void *cookie)
727{
728 struct adapter *adap = cookie;
729
730 u32 v = t4_read_reg(adap, MYPF_REG(PL_PF_INT_CAUSE));
731 if (v & PFSW) {
732 adap->swintr = 1;
733 t4_write_reg(adap, MYPF_REG(PL_PF_INT_CAUSE), v);
734 }
735 t4_slow_intr_handler(adap);
736 return IRQ_HANDLED;
737}
738
739/*
740 * Name the MSI-X interrupts.
741 */
742static void name_msix_vecs(struct adapter *adap)
743{
ba27816c 744 int i, j, msi_idx = 2, n = sizeof(adap->msix_info[0].desc);
b8ff05a9
DM
745
746 /* non-data interrupts */
b1a3c2b6 747 snprintf(adap->msix_info[0].desc, n, "%s", adap->port[0]->name);
b8ff05a9
DM
748
749 /* FW events */
b1a3c2b6
DM
750 snprintf(adap->msix_info[1].desc, n, "%s-FWeventq",
751 adap->port[0]->name);
b8ff05a9
DM
752
753 /* Ethernet queues */
754 for_each_port(adap, j) {
755 struct net_device *d = adap->port[j];
756 const struct port_info *pi = netdev_priv(d);
757
ba27816c 758 for (i = 0; i < pi->nqsets; i++, msi_idx++)
b8ff05a9
DM
759 snprintf(adap->msix_info[msi_idx].desc, n, "%s-Rx%d",
760 d->name, i);
b8ff05a9
DM
761 }
762
763 /* offload queues */
ba27816c
DM
764 for_each_ofldrxq(&adap->sge, i)
765 snprintf(adap->msix_info[msi_idx++].desc, n, "%s-ofld%d",
b1a3c2b6 766 adap->port[0]->name, i);
ba27816c
DM
767
768 for_each_rdmarxq(&adap->sge, i)
769 snprintf(adap->msix_info[msi_idx++].desc, n, "%s-rdma%d",
b1a3c2b6 770 adap->port[0]->name, i);
b8ff05a9
DM
771}
772
773static int request_msix_queue_irqs(struct adapter *adap)
774{
775 struct sge *s = &adap->sge;
404d9e3f 776 int err, ethqidx, ofldqidx = 0, rdmaqidx = 0, msi_index = 2;
b8ff05a9
DM
777
778 err = request_irq(adap->msix_info[1].vec, t4_sge_intr_msix, 0,
779 adap->msix_info[1].desc, &s->fw_evtq);
780 if (err)
781 return err;
782
783 for_each_ethrxq(s, ethqidx) {
404d9e3f
VP
784 err = request_irq(adap->msix_info[msi_index].vec,
785 t4_sge_intr_msix, 0,
786 adap->msix_info[msi_index].desc,
b8ff05a9
DM
787 &s->ethrxq[ethqidx].rspq);
788 if (err)
789 goto unwind;
404d9e3f 790 msi_index++;
b8ff05a9
DM
791 }
792 for_each_ofldrxq(s, ofldqidx) {
404d9e3f
VP
793 err = request_irq(adap->msix_info[msi_index].vec,
794 t4_sge_intr_msix, 0,
795 adap->msix_info[msi_index].desc,
b8ff05a9
DM
796 &s->ofldrxq[ofldqidx].rspq);
797 if (err)
798 goto unwind;
404d9e3f 799 msi_index++;
b8ff05a9
DM
800 }
801 for_each_rdmarxq(s, rdmaqidx) {
404d9e3f
VP
802 err = request_irq(adap->msix_info[msi_index].vec,
803 t4_sge_intr_msix, 0,
804 adap->msix_info[msi_index].desc,
b8ff05a9
DM
805 &s->rdmarxq[rdmaqidx].rspq);
806 if (err)
807 goto unwind;
404d9e3f 808 msi_index++;
b8ff05a9
DM
809 }
810 return 0;
811
812unwind:
813 while (--rdmaqidx >= 0)
404d9e3f 814 free_irq(adap->msix_info[--msi_index].vec,
b8ff05a9
DM
815 &s->rdmarxq[rdmaqidx].rspq);
816 while (--ofldqidx >= 0)
404d9e3f 817 free_irq(adap->msix_info[--msi_index].vec,
b8ff05a9
DM
818 &s->ofldrxq[ofldqidx].rspq);
819 while (--ethqidx >= 0)
404d9e3f
VP
820 free_irq(adap->msix_info[--msi_index].vec,
821 &s->ethrxq[ethqidx].rspq);
b8ff05a9
DM
822 free_irq(adap->msix_info[1].vec, &s->fw_evtq);
823 return err;
824}
825
826static void free_msix_queue_irqs(struct adapter *adap)
827{
404d9e3f 828 int i, msi_index = 2;
b8ff05a9
DM
829 struct sge *s = &adap->sge;
830
831 free_irq(adap->msix_info[1].vec, &s->fw_evtq);
832 for_each_ethrxq(s, i)
404d9e3f 833 free_irq(adap->msix_info[msi_index++].vec, &s->ethrxq[i].rspq);
b8ff05a9 834 for_each_ofldrxq(s, i)
404d9e3f 835 free_irq(adap->msix_info[msi_index++].vec, &s->ofldrxq[i].rspq);
b8ff05a9 836 for_each_rdmarxq(s, i)
404d9e3f 837 free_irq(adap->msix_info[msi_index++].vec, &s->rdmarxq[i].rspq);
b8ff05a9
DM
838}
839
671b0060
DM
840/**
841 * write_rss - write the RSS table for a given port
842 * @pi: the port
843 * @queues: array of queue indices for RSS
844 *
845 * Sets up the portion of the HW RSS table for the port's VI to distribute
846 * packets to the Rx queues in @queues.
847 */
848static int write_rss(const struct port_info *pi, const u16 *queues)
849{
850 u16 *rss;
851 int i, err;
852 const struct sge_eth_rxq *q = &pi->adapter->sge.ethrxq[pi->first_qset];
853
854 rss = kmalloc(pi->rss_size * sizeof(u16), GFP_KERNEL);
855 if (!rss)
856 return -ENOMEM;
857
858 /* map the queue indices to queue ids */
859 for (i = 0; i < pi->rss_size; i++, queues++)
860 rss[i] = q[*queues].rspq.abs_id;
861
060e0c75
DM
862 err = t4_config_rss_range(pi->adapter, pi->adapter->fn, pi->viid, 0,
863 pi->rss_size, rss, pi->rss_size);
671b0060
DM
864 kfree(rss);
865 return err;
866}
867
b8ff05a9
DM
868/**
869 * setup_rss - configure RSS
870 * @adap: the adapter
871 *
671b0060 872 * Sets up RSS for each port.
b8ff05a9
DM
873 */
874static int setup_rss(struct adapter *adap)
875{
671b0060 876 int i, err;
b8ff05a9
DM
877
878 for_each_port(adap, i) {
879 const struct port_info *pi = adap2pinfo(adap, i);
b8ff05a9 880
671b0060 881 err = write_rss(pi, pi->rss);
b8ff05a9
DM
882 if (err)
883 return err;
884 }
885 return 0;
886}
887
e46dab4d
DM
888/*
889 * Return the channel of the ingress queue with the given qid.
890 */
891static unsigned int rxq_to_chan(const struct sge *p, unsigned int qid)
892{
893 qid -= p->ingr_start;
894 return netdev2pinfo(p->ingr_map[qid]->netdev)->tx_chan;
895}
896
b8ff05a9
DM
897/*
898 * Wait until all NAPI handlers are descheduled.
899 */
900static void quiesce_rx(struct adapter *adap)
901{
902 int i;
903
904 for (i = 0; i < ARRAY_SIZE(adap->sge.ingr_map); i++) {
905 struct sge_rspq *q = adap->sge.ingr_map[i];
906
907 if (q && q->handler)
908 napi_disable(&q->napi);
909 }
910}
911
912/*
913 * Enable NAPI scheduling and interrupt generation for all Rx queues.
914 */
915static void enable_rx(struct adapter *adap)
916{
917 int i;
918
919 for (i = 0; i < ARRAY_SIZE(adap->sge.ingr_map); i++) {
920 struct sge_rspq *q = adap->sge.ingr_map[i];
921
922 if (!q)
923 continue;
924 if (q->handler)
925 napi_enable(&q->napi);
926 /* 0-increment GTS to start the timer and enable interrupts */
927 t4_write_reg(adap, MYPF_REG(SGE_PF_GTS),
928 SEINTARM(q->intr_params) |
929 INGRESSQID(q->cntxt_id));
930 }
931}
932
933/**
934 * setup_sge_queues - configure SGE Tx/Rx/response queues
935 * @adap: the adapter
936 *
937 * Determines how many sets of SGE queues to use and initializes them.
938 * We support multiple queue sets per port if we have MSI-X, otherwise
939 * just one queue set per port.
940 */
941static int setup_sge_queues(struct adapter *adap)
942{
943 int err, msi_idx, i, j;
944 struct sge *s = &adap->sge;
945
946 bitmap_zero(s->starving_fl, MAX_EGRQ);
947 bitmap_zero(s->txq_maperr, MAX_EGRQ);
948
949 if (adap->flags & USING_MSIX)
950 msi_idx = 1; /* vector 0 is for non-queue interrupts */
951 else {
952 err = t4_sge_alloc_rxq(adap, &s->intrq, false, adap->port[0], 0,
953 NULL, NULL);
954 if (err)
955 return err;
956 msi_idx = -((int)s->intrq.abs_id + 1);
957 }
958
959 err = t4_sge_alloc_rxq(adap, &s->fw_evtq, true, adap->port[0],
960 msi_idx, NULL, fwevtq_handler);
961 if (err) {
962freeout: t4_free_sge_resources(adap);
963 return err;
964 }
965
966 for_each_port(adap, i) {
967 struct net_device *dev = adap->port[i];
968 struct port_info *pi = netdev_priv(dev);
969 struct sge_eth_rxq *q = &s->ethrxq[pi->first_qset];
970 struct sge_eth_txq *t = &s->ethtxq[pi->first_qset];
971
972 for (j = 0; j < pi->nqsets; j++, q++) {
973 if (msi_idx > 0)
974 msi_idx++;
975 err = t4_sge_alloc_rxq(adap, &q->rspq, false, dev,
976 msi_idx, &q->fl,
977 t4_ethrx_handler);
978 if (err)
979 goto freeout;
980 q->rspq.idx = j;
981 memset(&q->stats, 0, sizeof(q->stats));
982 }
983 for (j = 0; j < pi->nqsets; j++, t++) {
984 err = t4_sge_alloc_eth_txq(adap, t, dev,
985 netdev_get_tx_queue(dev, j),
986 s->fw_evtq.cntxt_id);
987 if (err)
988 goto freeout;
989 }
990 }
991
992 j = s->ofldqsets / adap->params.nports; /* ofld queues per channel */
993 for_each_ofldrxq(s, i) {
994 struct sge_ofld_rxq *q = &s->ofldrxq[i];
995 struct net_device *dev = adap->port[i / j];
996
997 if (msi_idx > 0)
998 msi_idx++;
999 err = t4_sge_alloc_rxq(adap, &q->rspq, false, dev, msi_idx,
1000 &q->fl, uldrx_handler);
1001 if (err)
1002 goto freeout;
1003 memset(&q->stats, 0, sizeof(q->stats));
1004 s->ofld_rxq[i] = q->rspq.abs_id;
1005 err = t4_sge_alloc_ofld_txq(adap, &s->ofldtxq[i], dev,
1006 s->fw_evtq.cntxt_id);
1007 if (err)
1008 goto freeout;
1009 }
1010
1011 for_each_rdmarxq(s, i) {
1012 struct sge_ofld_rxq *q = &s->rdmarxq[i];
1013
1014 if (msi_idx > 0)
1015 msi_idx++;
1016 err = t4_sge_alloc_rxq(adap, &q->rspq, false, adap->port[i],
1017 msi_idx, &q->fl, uldrx_handler);
1018 if (err)
1019 goto freeout;
1020 memset(&q->stats, 0, sizeof(q->stats));
1021 s->rdma_rxq[i] = q->rspq.abs_id;
1022 }
1023
1024 for_each_port(adap, i) {
1025 /*
1026 * Note that ->rdmarxq[i].rspq.cntxt_id below is 0 if we don't
1027 * have RDMA queues, and that's the right value.
1028 */
1029 err = t4_sge_alloc_ctrl_txq(adap, &s->ctrlq[i], adap->port[i],
1030 s->fw_evtq.cntxt_id,
1031 s->rdmarxq[i].rspq.cntxt_id);
1032 if (err)
1033 goto freeout;
1034 }
1035
1036 t4_write_reg(adap, MPS_TRC_RSS_CONTROL,
1037 RSSCONTROL(netdev2pinfo(adap->port[0])->tx_chan) |
1038 QUEUENUMBER(s->ethrxq[0].rspq.abs_id));
1039 return 0;
1040}
1041
1042/*
1043 * Returns 0 if new FW was successfully loaded, a positive errno if a load was
1044 * started but failed, and a negative errno if flash load couldn't start.
1045 */
1046static int upgrade_fw(struct adapter *adap)
1047{
1048 int ret;
0a57a536 1049 u32 vers, exp_major;
b8ff05a9
DM
1050 const struct fw_hdr *hdr;
1051 const struct firmware *fw;
1052 struct device *dev = adap->pdev_dev;
0a57a536 1053 char *fw_file_name;
b8ff05a9 1054
0a57a536
SR
1055 switch (CHELSIO_CHIP_VERSION(adap->chip)) {
1056 case CHELSIO_T4:
1057 fw_file_name = FW_FNAME;
1058 exp_major = FW_VERSION_MAJOR;
1059 break;
1060 case CHELSIO_T5:
1061 fw_file_name = FW5_FNAME;
1062 exp_major = FW_VERSION_MAJOR_T5;
1063 break;
1064 default:
1065 dev_err(dev, "Unsupported chip type, %x\n", adap->chip);
1066 return -EINVAL;
1067 }
1068
1069 ret = request_firmware(&fw, fw_file_name, dev);
b8ff05a9 1070 if (ret < 0) {
0a57a536
SR
1071 dev_err(dev, "unable to load firmware image %s, error %d\n",
1072 fw_file_name, ret);
b8ff05a9
DM
1073 return ret;
1074 }
1075
1076 hdr = (const struct fw_hdr *)fw->data;
1077 vers = ntohl(hdr->fw_ver);
0a57a536 1078 if (FW_HDR_FW_VER_MAJOR_GET(vers) != exp_major) {
b8ff05a9
DM
1079 ret = -EINVAL; /* wrong major version, won't do */
1080 goto out;
1081 }
1082
1083 /*
1084 * If the flash FW is unusable or we found something newer, load it.
1085 */
0a57a536 1086 if (FW_HDR_FW_VER_MAJOR_GET(adap->params.fw_vers) != exp_major ||
b8ff05a9 1087 vers > adap->params.fw_vers) {
26f7cbc0
VP
1088 dev_info(dev, "upgrading firmware ...\n");
1089 ret = t4_fw_upgrade(adap, adap->mbox, fw->data, fw->size,
1090 /*force=*/false);
b8ff05a9 1091 if (!ret)
0a57a536
SR
1092 dev_info(dev,
1093 "firmware upgraded to version %pI4 from %s\n",
1094 &hdr->fw_ver, fw_file_name);
26f7cbc0
VP
1095 else
1096 dev_err(dev, "firmware upgrade failed! err=%d\n", -ret);
1648a22b
VP
1097 } else {
1098 /*
1099 * Tell our caller that we didn't upgrade the firmware.
1100 */
1101 ret = -EINVAL;
b8ff05a9 1102 }
1648a22b 1103
b8ff05a9
DM
1104out: release_firmware(fw);
1105 return ret;
1106}
1107
1108/*
1109 * Allocate a chunk of memory using kmalloc or, if that fails, vmalloc.
1110 * The allocated memory is cleared.
1111 */
1112void *t4_alloc_mem(size_t size)
1113{
89bf67f1 1114 void *p = kzalloc(size, GFP_KERNEL);
b8ff05a9
DM
1115
1116 if (!p)
89bf67f1 1117 p = vzalloc(size);
b8ff05a9
DM
1118 return p;
1119}
1120
1121/*
1122 * Free memory allocated through alloc_mem().
1123 */
31b9c19b 1124static void t4_free_mem(void *addr)
b8ff05a9
DM
1125{
1126 if (is_vmalloc_addr(addr))
1127 vfree(addr);
1128 else
1129 kfree(addr);
1130}
1131
f2b7e78d
VP
1132/* Send a Work Request to write the filter at a specified index. We construct
1133 * a Firmware Filter Work Request to have the work done and put the indicated
1134 * filter into "pending" mode which will prevent any further actions against
1135 * it till we get a reply from the firmware on the completion status of the
1136 * request.
1137 */
1138static int set_filter_wr(struct adapter *adapter, int fidx)
1139{
1140 struct filter_entry *f = &adapter->tids.ftid_tab[fidx];
1141 struct sk_buff *skb;
1142 struct fw_filter_wr *fwr;
1143 unsigned int ftid;
1144
1145 /* If the new filter requires loopback Destination MAC and/or VLAN
1146 * rewriting then we need to allocate a Layer 2 Table (L2T) entry for
1147 * the filter.
1148 */
1149 if (f->fs.newdmac || f->fs.newvlan) {
1150 /* allocate L2T entry for new filter */
1151 f->l2t = t4_l2t_alloc_switching(adapter->l2t);
1152 if (f->l2t == NULL)
1153 return -EAGAIN;
1154 if (t4_l2t_set_switching(adapter, f->l2t, f->fs.vlan,
1155 f->fs.eport, f->fs.dmac)) {
1156 cxgb4_l2t_release(f->l2t);
1157 f->l2t = NULL;
1158 return -ENOMEM;
1159 }
1160 }
1161
1162 ftid = adapter->tids.ftid_base + fidx;
1163
1164 skb = alloc_skb(sizeof(*fwr), GFP_KERNEL | __GFP_NOFAIL);
1165 fwr = (struct fw_filter_wr *)__skb_put(skb, sizeof(*fwr));
1166 memset(fwr, 0, sizeof(*fwr));
1167
1168 /* It would be nice to put most of the following in t4_hw.c but most
1169 * of the work is translating the cxgbtool ch_filter_specification
1170 * into the Work Request and the definition of that structure is
1171 * currently in cxgbtool.h which isn't appropriate to pull into the
1172 * common code. We may eventually try to come up with a more neutral
1173 * filter specification structure but for now it's easiest to simply
1174 * put this fairly direct code in line ...
1175 */
1176 fwr->op_pkd = htonl(FW_WR_OP(FW_FILTER_WR));
1177 fwr->len16_pkd = htonl(FW_WR_LEN16(sizeof(*fwr)/16));
1178 fwr->tid_to_iq =
1179 htonl(V_FW_FILTER_WR_TID(ftid) |
1180 V_FW_FILTER_WR_RQTYPE(f->fs.type) |
1181 V_FW_FILTER_WR_NOREPLY(0) |
1182 V_FW_FILTER_WR_IQ(f->fs.iq));
1183 fwr->del_filter_to_l2tix =
1184 htonl(V_FW_FILTER_WR_RPTTID(f->fs.rpttid) |
1185 V_FW_FILTER_WR_DROP(f->fs.action == FILTER_DROP) |
1186 V_FW_FILTER_WR_DIRSTEER(f->fs.dirsteer) |
1187 V_FW_FILTER_WR_MASKHASH(f->fs.maskhash) |
1188 V_FW_FILTER_WR_DIRSTEERHASH(f->fs.dirsteerhash) |
1189 V_FW_FILTER_WR_LPBK(f->fs.action == FILTER_SWITCH) |
1190 V_FW_FILTER_WR_DMAC(f->fs.newdmac) |
1191 V_FW_FILTER_WR_SMAC(f->fs.newsmac) |
1192 V_FW_FILTER_WR_INSVLAN(f->fs.newvlan == VLAN_INSERT ||
1193 f->fs.newvlan == VLAN_REWRITE) |
1194 V_FW_FILTER_WR_RMVLAN(f->fs.newvlan == VLAN_REMOVE ||
1195 f->fs.newvlan == VLAN_REWRITE) |
1196 V_FW_FILTER_WR_HITCNTS(f->fs.hitcnts) |
1197 V_FW_FILTER_WR_TXCHAN(f->fs.eport) |
1198 V_FW_FILTER_WR_PRIO(f->fs.prio) |
1199 V_FW_FILTER_WR_L2TIX(f->l2t ? f->l2t->idx : 0));
1200 fwr->ethtype = htons(f->fs.val.ethtype);
1201 fwr->ethtypem = htons(f->fs.mask.ethtype);
1202 fwr->frag_to_ovlan_vldm =
1203 (V_FW_FILTER_WR_FRAG(f->fs.val.frag) |
1204 V_FW_FILTER_WR_FRAGM(f->fs.mask.frag) |
1205 V_FW_FILTER_WR_IVLAN_VLD(f->fs.val.ivlan_vld) |
1206 V_FW_FILTER_WR_OVLAN_VLD(f->fs.val.ovlan_vld) |
1207 V_FW_FILTER_WR_IVLAN_VLDM(f->fs.mask.ivlan_vld) |
1208 V_FW_FILTER_WR_OVLAN_VLDM(f->fs.mask.ovlan_vld));
1209 fwr->smac_sel = 0;
1210 fwr->rx_chan_rx_rpl_iq =
1211 htons(V_FW_FILTER_WR_RX_CHAN(0) |
1212 V_FW_FILTER_WR_RX_RPL_IQ(adapter->sge.fw_evtq.abs_id));
1213 fwr->maci_to_matchtypem =
1214 htonl(V_FW_FILTER_WR_MACI(f->fs.val.macidx) |
1215 V_FW_FILTER_WR_MACIM(f->fs.mask.macidx) |
1216 V_FW_FILTER_WR_FCOE(f->fs.val.fcoe) |
1217 V_FW_FILTER_WR_FCOEM(f->fs.mask.fcoe) |
1218 V_FW_FILTER_WR_PORT(f->fs.val.iport) |
1219 V_FW_FILTER_WR_PORTM(f->fs.mask.iport) |
1220 V_FW_FILTER_WR_MATCHTYPE(f->fs.val.matchtype) |
1221 V_FW_FILTER_WR_MATCHTYPEM(f->fs.mask.matchtype));
1222 fwr->ptcl = f->fs.val.proto;
1223 fwr->ptclm = f->fs.mask.proto;
1224 fwr->ttyp = f->fs.val.tos;
1225 fwr->ttypm = f->fs.mask.tos;
1226 fwr->ivlan = htons(f->fs.val.ivlan);
1227 fwr->ivlanm = htons(f->fs.mask.ivlan);
1228 fwr->ovlan = htons(f->fs.val.ovlan);
1229 fwr->ovlanm = htons(f->fs.mask.ovlan);
1230 memcpy(fwr->lip, f->fs.val.lip, sizeof(fwr->lip));
1231 memcpy(fwr->lipm, f->fs.mask.lip, sizeof(fwr->lipm));
1232 memcpy(fwr->fip, f->fs.val.fip, sizeof(fwr->fip));
1233 memcpy(fwr->fipm, f->fs.mask.fip, sizeof(fwr->fipm));
1234 fwr->lp = htons(f->fs.val.lport);
1235 fwr->lpm = htons(f->fs.mask.lport);
1236 fwr->fp = htons(f->fs.val.fport);
1237 fwr->fpm = htons(f->fs.mask.fport);
1238 if (f->fs.newsmac)
1239 memcpy(fwr->sma, f->fs.smac, sizeof(fwr->sma));
1240
1241 /* Mark the filter as "pending" and ship off the Filter Work Request.
1242 * When we get the Work Request Reply we'll clear the pending status.
1243 */
1244 f->pending = 1;
1245 set_wr_txq(skb, CPL_PRIORITY_CONTROL, f->fs.val.iport & 0x3);
1246 t4_ofld_send(adapter, skb);
1247 return 0;
1248}
1249
1250/* Delete the filter at a specified index.
1251 */
1252static int del_filter_wr(struct adapter *adapter, int fidx)
1253{
1254 struct filter_entry *f = &adapter->tids.ftid_tab[fidx];
1255 struct sk_buff *skb;
1256 struct fw_filter_wr *fwr;
1257 unsigned int len, ftid;
1258
1259 len = sizeof(*fwr);
1260 ftid = adapter->tids.ftid_base + fidx;
1261
1262 skb = alloc_skb(len, GFP_KERNEL | __GFP_NOFAIL);
1263 fwr = (struct fw_filter_wr *)__skb_put(skb, len);
1264 t4_mk_filtdelwr(ftid, fwr, adapter->sge.fw_evtq.abs_id);
1265
1266 /* Mark the filter as "pending" and ship off the Filter Work Request.
1267 * When we get the Work Request Reply we'll clear the pending status.
1268 */
1269 f->pending = 1;
1270 t4_mgmt_tx(adapter, skb);
1271 return 0;
1272}
1273
b8ff05a9
DM
1274static inline int is_offload(const struct adapter *adap)
1275{
1276 return adap->params.offload;
1277}
1278
1279/*
1280 * Implementation of ethtool operations.
1281 */
1282
1283static u32 get_msglevel(struct net_device *dev)
1284{
1285 return netdev2adap(dev)->msg_enable;
1286}
1287
1288static void set_msglevel(struct net_device *dev, u32 val)
1289{
1290 netdev2adap(dev)->msg_enable = val;
1291}
1292
1293static char stats_strings[][ETH_GSTRING_LEN] = {
1294 "TxOctetsOK ",
1295 "TxFramesOK ",
1296 "TxBroadcastFrames ",
1297 "TxMulticastFrames ",
1298 "TxUnicastFrames ",
1299 "TxErrorFrames ",
1300
1301 "TxFrames64 ",
1302 "TxFrames65To127 ",
1303 "TxFrames128To255 ",
1304 "TxFrames256To511 ",
1305 "TxFrames512To1023 ",
1306 "TxFrames1024To1518 ",
1307 "TxFrames1519ToMax ",
1308
1309 "TxFramesDropped ",
1310 "TxPauseFrames ",
1311 "TxPPP0Frames ",
1312 "TxPPP1Frames ",
1313 "TxPPP2Frames ",
1314 "TxPPP3Frames ",
1315 "TxPPP4Frames ",
1316 "TxPPP5Frames ",
1317 "TxPPP6Frames ",
1318 "TxPPP7Frames ",
1319
1320 "RxOctetsOK ",
1321 "RxFramesOK ",
1322 "RxBroadcastFrames ",
1323 "RxMulticastFrames ",
1324 "RxUnicastFrames ",
1325
1326 "RxFramesTooLong ",
1327 "RxJabberErrors ",
1328 "RxFCSErrors ",
1329 "RxLengthErrors ",
1330 "RxSymbolErrors ",
1331 "RxRuntFrames ",
1332
1333 "RxFrames64 ",
1334 "RxFrames65To127 ",
1335 "RxFrames128To255 ",
1336 "RxFrames256To511 ",
1337 "RxFrames512To1023 ",
1338 "RxFrames1024To1518 ",
1339 "RxFrames1519ToMax ",
1340
1341 "RxPauseFrames ",
1342 "RxPPP0Frames ",
1343 "RxPPP1Frames ",
1344 "RxPPP2Frames ",
1345 "RxPPP3Frames ",
1346 "RxPPP4Frames ",
1347 "RxPPP5Frames ",
1348 "RxPPP6Frames ",
1349 "RxPPP7Frames ",
1350
1351 "RxBG0FramesDropped ",
1352 "RxBG1FramesDropped ",
1353 "RxBG2FramesDropped ",
1354 "RxBG3FramesDropped ",
1355 "RxBG0FramesTrunc ",
1356 "RxBG1FramesTrunc ",
1357 "RxBG2FramesTrunc ",
1358 "RxBG3FramesTrunc ",
1359
1360 "TSO ",
1361 "TxCsumOffload ",
1362 "RxCsumGood ",
1363 "VLANextractions ",
1364 "VLANinsertions ",
4a6346d4
DM
1365 "GROpackets ",
1366 "GROmerged ",
22adfe0a
SR
1367 "WriteCoalSuccess ",
1368 "WriteCoalFail ",
b8ff05a9
DM
1369};
1370
1371static int get_sset_count(struct net_device *dev, int sset)
1372{
1373 switch (sset) {
1374 case ETH_SS_STATS:
1375 return ARRAY_SIZE(stats_strings);
1376 default:
1377 return -EOPNOTSUPP;
1378 }
1379}
1380
1381#define T4_REGMAP_SIZE (160 * 1024)
251f9e88 1382#define T5_REGMAP_SIZE (332 * 1024)
b8ff05a9
DM
1383
1384static int get_regs_len(struct net_device *dev)
1385{
251f9e88
SR
1386 struct adapter *adap = netdev2adap(dev);
1387 if (is_t4(adap->chip))
1388 return T4_REGMAP_SIZE;
1389 else
1390 return T5_REGMAP_SIZE;
b8ff05a9
DM
1391}
1392
1393static int get_eeprom_len(struct net_device *dev)
1394{
1395 return EEPROMSIZE;
1396}
1397
1398static void get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
1399{
1400 struct adapter *adapter = netdev2adap(dev);
1401
23020ab3
RJ
1402 strlcpy(info->driver, KBUILD_MODNAME, sizeof(info->driver));
1403 strlcpy(info->version, DRV_VERSION, sizeof(info->version));
1404 strlcpy(info->bus_info, pci_name(adapter->pdev),
1405 sizeof(info->bus_info));
b8ff05a9 1406
84b40501 1407 if (adapter->params.fw_vers)
b8ff05a9
DM
1408 snprintf(info->fw_version, sizeof(info->fw_version),
1409 "%u.%u.%u.%u, TP %u.%u.%u.%u",
1410 FW_HDR_FW_VER_MAJOR_GET(adapter->params.fw_vers),
1411 FW_HDR_FW_VER_MINOR_GET(adapter->params.fw_vers),
1412 FW_HDR_FW_VER_MICRO_GET(adapter->params.fw_vers),
1413 FW_HDR_FW_VER_BUILD_GET(adapter->params.fw_vers),
1414 FW_HDR_FW_VER_MAJOR_GET(adapter->params.tp_vers),
1415 FW_HDR_FW_VER_MINOR_GET(adapter->params.tp_vers),
1416 FW_HDR_FW_VER_MICRO_GET(adapter->params.tp_vers),
1417 FW_HDR_FW_VER_BUILD_GET(adapter->params.tp_vers));
1418}
1419
1420static void get_strings(struct net_device *dev, u32 stringset, u8 *data)
1421{
1422 if (stringset == ETH_SS_STATS)
1423 memcpy(data, stats_strings, sizeof(stats_strings));
1424}
1425
1426/*
1427 * port stats maintained per queue of the port. They should be in the same
1428 * order as in stats_strings above.
1429 */
1430struct queue_port_stats {
1431 u64 tso;
1432 u64 tx_csum;
1433 u64 rx_csum;
1434 u64 vlan_ex;
1435 u64 vlan_ins;
4a6346d4
DM
1436 u64 gro_pkts;
1437 u64 gro_merged;
b8ff05a9
DM
1438};
1439
1440static void collect_sge_port_stats(const struct adapter *adap,
1441 const struct port_info *p, struct queue_port_stats *s)
1442{
1443 int i;
1444 const struct sge_eth_txq *tx = &adap->sge.ethtxq[p->first_qset];
1445 const struct sge_eth_rxq *rx = &adap->sge.ethrxq[p->first_qset];
1446
1447 memset(s, 0, sizeof(*s));
1448 for (i = 0; i < p->nqsets; i++, rx++, tx++) {
1449 s->tso += tx->tso;
1450 s->tx_csum += tx->tx_cso;
1451 s->rx_csum += rx->stats.rx_cso;
1452 s->vlan_ex += rx->stats.vlan_ex;
1453 s->vlan_ins += tx->vlan_ins;
4a6346d4
DM
1454 s->gro_pkts += rx->stats.lro_pkts;
1455 s->gro_merged += rx->stats.lro_merged;
b8ff05a9
DM
1456 }
1457}
1458
1459static void get_stats(struct net_device *dev, struct ethtool_stats *stats,
1460 u64 *data)
1461{
1462 struct port_info *pi = netdev_priv(dev);
1463 struct adapter *adapter = pi->adapter;
22adfe0a 1464 u32 val1, val2;
b8ff05a9
DM
1465
1466 t4_get_port_stats(adapter, pi->tx_chan, (struct port_stats *)data);
1467
1468 data += sizeof(struct port_stats) / sizeof(u64);
1469 collect_sge_port_stats(adapter, pi, (struct queue_port_stats *)data);
22adfe0a
SR
1470 data += sizeof(struct queue_port_stats) / sizeof(u64);
1471 if (!is_t4(adapter->chip)) {
1472 t4_write_reg(adapter, SGE_STAT_CFG, STATSOURCE_T5(7));
1473 val1 = t4_read_reg(adapter, SGE_STAT_TOTAL);
1474 val2 = t4_read_reg(adapter, SGE_STAT_MATCH);
1475 *data = val1 - val2;
1476 data++;
1477 *data = val2;
1478 data++;
1479 } else {
1480 memset(data, 0, 2 * sizeof(u64));
1481 *data += 2;
1482 }
b8ff05a9
DM
1483}
1484
1485/*
1486 * Return a version number to identify the type of adapter. The scheme is:
1487 * - bits 0..9: chip version
1488 * - bits 10..15: chip revision
835bb606 1489 * - bits 16..23: register dump version
b8ff05a9
DM
1490 */
1491static inline unsigned int mk_adap_vers(const struct adapter *ap)
1492{
0a57a536
SR
1493 return CHELSIO_CHIP_VERSION(ap->chip) |
1494 (CHELSIO_CHIP_RELEASE(ap->chip) << 10) | (1 << 16);
b8ff05a9
DM
1495}
1496
1497static void reg_block_dump(struct adapter *ap, void *buf, unsigned int start,
1498 unsigned int end)
1499{
1500 u32 *p = buf + start;
1501
1502 for ( ; start <= end; start += sizeof(u32))
1503 *p++ = t4_read_reg(ap, start);
1504}
1505
1506static void get_regs(struct net_device *dev, struct ethtool_regs *regs,
1507 void *buf)
1508{
251f9e88 1509 static const unsigned int t4_reg_ranges[] = {
b8ff05a9
DM
1510 0x1008, 0x1108,
1511 0x1180, 0x11b4,
1512 0x11fc, 0x123c,
1513 0x1300, 0x173c,
1514 0x1800, 0x18fc,
1515 0x3000, 0x30d8,
1516 0x30e0, 0x5924,
1517 0x5960, 0x59d4,
1518 0x5a00, 0x5af8,
1519 0x6000, 0x6098,
1520 0x6100, 0x6150,
1521 0x6200, 0x6208,
1522 0x6240, 0x6248,
1523 0x6280, 0x6338,
1524 0x6370, 0x638c,
1525 0x6400, 0x643c,
1526 0x6500, 0x6524,
1527 0x6a00, 0x6a38,
1528 0x6a60, 0x6a78,
1529 0x6b00, 0x6b84,
1530 0x6bf0, 0x6c84,
1531 0x6cf0, 0x6d84,
1532 0x6df0, 0x6e84,
1533 0x6ef0, 0x6f84,
1534 0x6ff0, 0x7084,
1535 0x70f0, 0x7184,
1536 0x71f0, 0x7284,
1537 0x72f0, 0x7384,
1538 0x73f0, 0x7450,
1539 0x7500, 0x7530,
1540 0x7600, 0x761c,
1541 0x7680, 0x76cc,
1542 0x7700, 0x7798,
1543 0x77c0, 0x77fc,
1544 0x7900, 0x79fc,
1545 0x7b00, 0x7c38,
1546 0x7d00, 0x7efc,
1547 0x8dc0, 0x8e1c,
1548 0x8e30, 0x8e78,
1549 0x8ea0, 0x8f6c,
1550 0x8fc0, 0x9074,
1551 0x90fc, 0x90fc,
1552 0x9400, 0x9458,
1553 0x9600, 0x96bc,
1554 0x9800, 0x9808,
1555 0x9820, 0x983c,
1556 0x9850, 0x9864,
1557 0x9c00, 0x9c6c,
1558 0x9c80, 0x9cec,
1559 0x9d00, 0x9d6c,
1560 0x9d80, 0x9dec,
1561 0x9e00, 0x9e6c,
1562 0x9e80, 0x9eec,
1563 0x9f00, 0x9f6c,
1564 0x9f80, 0x9fec,
1565 0xd004, 0xd03c,
1566 0xdfc0, 0xdfe0,
1567 0xe000, 0xea7c,
1568 0xf000, 0x11190,
835bb606
DM
1569 0x19040, 0x1906c,
1570 0x19078, 0x19080,
1571 0x1908c, 0x19124,
b8ff05a9
DM
1572 0x19150, 0x191b0,
1573 0x191d0, 0x191e8,
1574 0x19238, 0x1924c,
1575 0x193f8, 0x19474,
1576 0x19490, 0x194f8,
1577 0x19800, 0x19f30,
1578 0x1a000, 0x1a06c,
1579 0x1a0b0, 0x1a120,
1580 0x1a128, 0x1a138,
1581 0x1a190, 0x1a1c4,
1582 0x1a1fc, 0x1a1fc,
1583 0x1e040, 0x1e04c,
835bb606 1584 0x1e284, 0x1e28c,
b8ff05a9
DM
1585 0x1e2c0, 0x1e2c0,
1586 0x1e2e0, 0x1e2e0,
1587 0x1e300, 0x1e384,
1588 0x1e3c0, 0x1e3c8,
1589 0x1e440, 0x1e44c,
835bb606 1590 0x1e684, 0x1e68c,
b8ff05a9
DM
1591 0x1e6c0, 0x1e6c0,
1592 0x1e6e0, 0x1e6e0,
1593 0x1e700, 0x1e784,
1594 0x1e7c0, 0x1e7c8,
1595 0x1e840, 0x1e84c,
835bb606 1596 0x1ea84, 0x1ea8c,
b8ff05a9
DM
1597 0x1eac0, 0x1eac0,
1598 0x1eae0, 0x1eae0,
1599 0x1eb00, 0x1eb84,
1600 0x1ebc0, 0x1ebc8,
1601 0x1ec40, 0x1ec4c,
835bb606 1602 0x1ee84, 0x1ee8c,
b8ff05a9
DM
1603 0x1eec0, 0x1eec0,
1604 0x1eee0, 0x1eee0,
1605 0x1ef00, 0x1ef84,
1606 0x1efc0, 0x1efc8,
1607 0x1f040, 0x1f04c,
835bb606 1608 0x1f284, 0x1f28c,
b8ff05a9
DM
1609 0x1f2c0, 0x1f2c0,
1610 0x1f2e0, 0x1f2e0,
1611 0x1f300, 0x1f384,
1612 0x1f3c0, 0x1f3c8,
1613 0x1f440, 0x1f44c,
835bb606 1614 0x1f684, 0x1f68c,
b8ff05a9
DM
1615 0x1f6c0, 0x1f6c0,
1616 0x1f6e0, 0x1f6e0,
1617 0x1f700, 0x1f784,
1618 0x1f7c0, 0x1f7c8,
1619 0x1f840, 0x1f84c,
835bb606 1620 0x1fa84, 0x1fa8c,
b8ff05a9
DM
1621 0x1fac0, 0x1fac0,
1622 0x1fae0, 0x1fae0,
1623 0x1fb00, 0x1fb84,
1624 0x1fbc0, 0x1fbc8,
1625 0x1fc40, 0x1fc4c,
835bb606 1626 0x1fe84, 0x1fe8c,
b8ff05a9
DM
1627 0x1fec0, 0x1fec0,
1628 0x1fee0, 0x1fee0,
1629 0x1ff00, 0x1ff84,
1630 0x1ffc0, 0x1ffc8,
1631 0x20000, 0x2002c,
1632 0x20100, 0x2013c,
1633 0x20190, 0x201c8,
1634 0x20200, 0x20318,
1635 0x20400, 0x20528,
1636 0x20540, 0x20614,
1637 0x21000, 0x21040,
1638 0x2104c, 0x21060,
1639 0x210c0, 0x210ec,
1640 0x21200, 0x21268,
1641 0x21270, 0x21284,
1642 0x212fc, 0x21388,
1643 0x21400, 0x21404,
1644 0x21500, 0x21518,
1645 0x2152c, 0x2153c,
1646 0x21550, 0x21554,
1647 0x21600, 0x21600,
1648 0x21608, 0x21628,
1649 0x21630, 0x2163c,
1650 0x21700, 0x2171c,
1651 0x21780, 0x2178c,
1652 0x21800, 0x21c38,
1653 0x21c80, 0x21d7c,
1654 0x21e00, 0x21e04,
1655 0x22000, 0x2202c,
1656 0x22100, 0x2213c,
1657 0x22190, 0x221c8,
1658 0x22200, 0x22318,
1659 0x22400, 0x22528,
1660 0x22540, 0x22614,
1661 0x23000, 0x23040,
1662 0x2304c, 0x23060,
1663 0x230c0, 0x230ec,
1664 0x23200, 0x23268,
1665 0x23270, 0x23284,
1666 0x232fc, 0x23388,
1667 0x23400, 0x23404,
1668 0x23500, 0x23518,
1669 0x2352c, 0x2353c,
1670 0x23550, 0x23554,
1671 0x23600, 0x23600,
1672 0x23608, 0x23628,
1673 0x23630, 0x2363c,
1674 0x23700, 0x2371c,
1675 0x23780, 0x2378c,
1676 0x23800, 0x23c38,
1677 0x23c80, 0x23d7c,
1678 0x23e00, 0x23e04,
1679 0x24000, 0x2402c,
1680 0x24100, 0x2413c,
1681 0x24190, 0x241c8,
1682 0x24200, 0x24318,
1683 0x24400, 0x24528,
1684 0x24540, 0x24614,
1685 0x25000, 0x25040,
1686 0x2504c, 0x25060,
1687 0x250c0, 0x250ec,
1688 0x25200, 0x25268,
1689 0x25270, 0x25284,
1690 0x252fc, 0x25388,
1691 0x25400, 0x25404,
1692 0x25500, 0x25518,
1693 0x2552c, 0x2553c,
1694 0x25550, 0x25554,
1695 0x25600, 0x25600,
1696 0x25608, 0x25628,
1697 0x25630, 0x2563c,
1698 0x25700, 0x2571c,
1699 0x25780, 0x2578c,
1700 0x25800, 0x25c38,
1701 0x25c80, 0x25d7c,
1702 0x25e00, 0x25e04,
1703 0x26000, 0x2602c,
1704 0x26100, 0x2613c,
1705 0x26190, 0x261c8,
1706 0x26200, 0x26318,
1707 0x26400, 0x26528,
1708 0x26540, 0x26614,
1709 0x27000, 0x27040,
1710 0x2704c, 0x27060,
1711 0x270c0, 0x270ec,
1712 0x27200, 0x27268,
1713 0x27270, 0x27284,
1714 0x272fc, 0x27388,
1715 0x27400, 0x27404,
1716 0x27500, 0x27518,
1717 0x2752c, 0x2753c,
1718 0x27550, 0x27554,
1719 0x27600, 0x27600,
1720 0x27608, 0x27628,
1721 0x27630, 0x2763c,
1722 0x27700, 0x2771c,
1723 0x27780, 0x2778c,
1724 0x27800, 0x27c38,
1725 0x27c80, 0x27d7c,
1726 0x27e00, 0x27e04
1727 };
1728
251f9e88
SR
1729 static const unsigned int t5_reg_ranges[] = {
1730 0x1008, 0x1148,
1731 0x1180, 0x11b4,
1732 0x11fc, 0x123c,
1733 0x1280, 0x173c,
1734 0x1800, 0x18fc,
1735 0x3000, 0x3028,
1736 0x3060, 0x30d8,
1737 0x30e0, 0x30fc,
1738 0x3140, 0x357c,
1739 0x35a8, 0x35cc,
1740 0x35ec, 0x35ec,
1741 0x3600, 0x5624,
1742 0x56cc, 0x575c,
1743 0x580c, 0x5814,
1744 0x5890, 0x58bc,
1745 0x5940, 0x59dc,
1746 0x59fc, 0x5a18,
1747 0x5a60, 0x5a9c,
1748 0x5b9c, 0x5bfc,
1749 0x6000, 0x6040,
1750 0x6058, 0x614c,
1751 0x7700, 0x7798,
1752 0x77c0, 0x78fc,
1753 0x7b00, 0x7c54,
1754 0x7d00, 0x7efc,
1755 0x8dc0, 0x8de0,
1756 0x8df8, 0x8e84,
1757 0x8ea0, 0x8f84,
1758 0x8fc0, 0x90f8,
1759 0x9400, 0x9470,
1760 0x9600, 0x96f4,
1761 0x9800, 0x9808,
1762 0x9820, 0x983c,
1763 0x9850, 0x9864,
1764 0x9c00, 0x9c6c,
1765 0x9c80, 0x9cec,
1766 0x9d00, 0x9d6c,
1767 0x9d80, 0x9dec,
1768 0x9e00, 0x9e6c,
1769 0x9e80, 0x9eec,
1770 0x9f00, 0x9f6c,
1771 0x9f80, 0xa020,
1772 0xd004, 0xd03c,
1773 0xdfc0, 0xdfe0,
1774 0xe000, 0x11088,
1775 0x1109c, 0x1117c,
1776 0x11190, 0x11204,
1777 0x19040, 0x1906c,
1778 0x19078, 0x19080,
1779 0x1908c, 0x19124,
1780 0x19150, 0x191b0,
1781 0x191d0, 0x191e8,
1782 0x19238, 0x19290,
1783 0x193f8, 0x19474,
1784 0x19490, 0x194cc,
1785 0x194f0, 0x194f8,
1786 0x19c00, 0x19c60,
1787 0x19c94, 0x19e10,
1788 0x19e50, 0x19f34,
1789 0x19f40, 0x19f50,
1790 0x19f90, 0x19fe4,
1791 0x1a000, 0x1a06c,
1792 0x1a0b0, 0x1a120,
1793 0x1a128, 0x1a138,
1794 0x1a190, 0x1a1c4,
1795 0x1a1fc, 0x1a1fc,
1796 0x1e008, 0x1e00c,
1797 0x1e040, 0x1e04c,
1798 0x1e284, 0x1e290,
1799 0x1e2c0, 0x1e2c0,
1800 0x1e2e0, 0x1e2e0,
1801 0x1e300, 0x1e384,
1802 0x1e3c0, 0x1e3c8,
1803 0x1e408, 0x1e40c,
1804 0x1e440, 0x1e44c,
1805 0x1e684, 0x1e690,
1806 0x1e6c0, 0x1e6c0,
1807 0x1e6e0, 0x1e6e0,
1808 0x1e700, 0x1e784,
1809 0x1e7c0, 0x1e7c8,
1810 0x1e808, 0x1e80c,
1811 0x1e840, 0x1e84c,
1812 0x1ea84, 0x1ea90,
1813 0x1eac0, 0x1eac0,
1814 0x1eae0, 0x1eae0,
1815 0x1eb00, 0x1eb84,
1816 0x1ebc0, 0x1ebc8,
1817 0x1ec08, 0x1ec0c,
1818 0x1ec40, 0x1ec4c,
1819 0x1ee84, 0x1ee90,
1820 0x1eec0, 0x1eec0,
1821 0x1eee0, 0x1eee0,
1822 0x1ef00, 0x1ef84,
1823 0x1efc0, 0x1efc8,
1824 0x1f008, 0x1f00c,
1825 0x1f040, 0x1f04c,
1826 0x1f284, 0x1f290,
1827 0x1f2c0, 0x1f2c0,
1828 0x1f2e0, 0x1f2e0,
1829 0x1f300, 0x1f384,
1830 0x1f3c0, 0x1f3c8,
1831 0x1f408, 0x1f40c,
1832 0x1f440, 0x1f44c,
1833 0x1f684, 0x1f690,
1834 0x1f6c0, 0x1f6c0,
1835 0x1f6e0, 0x1f6e0,
1836 0x1f700, 0x1f784,
1837 0x1f7c0, 0x1f7c8,
1838 0x1f808, 0x1f80c,
1839 0x1f840, 0x1f84c,
1840 0x1fa84, 0x1fa90,
1841 0x1fac0, 0x1fac0,
1842 0x1fae0, 0x1fae0,
1843 0x1fb00, 0x1fb84,
1844 0x1fbc0, 0x1fbc8,
1845 0x1fc08, 0x1fc0c,
1846 0x1fc40, 0x1fc4c,
1847 0x1fe84, 0x1fe90,
1848 0x1fec0, 0x1fec0,
1849 0x1fee0, 0x1fee0,
1850 0x1ff00, 0x1ff84,
1851 0x1ffc0, 0x1ffc8,
1852 0x30000, 0x30030,
1853 0x30100, 0x30144,
1854 0x30190, 0x301d0,
1855 0x30200, 0x30318,
1856 0x30400, 0x3052c,
1857 0x30540, 0x3061c,
1858 0x30800, 0x30834,
1859 0x308c0, 0x30908,
1860 0x30910, 0x309ac,
1861 0x30a00, 0x30a04,
1862 0x30a0c, 0x30a2c,
1863 0x30a44, 0x30a50,
1864 0x30a74, 0x30c24,
1865 0x30d08, 0x30d14,
1866 0x30d1c, 0x30d20,
1867 0x30d3c, 0x30d50,
1868 0x31200, 0x3120c,
1869 0x31220, 0x31220,
1870 0x31240, 0x31240,
1871 0x31600, 0x31600,
1872 0x31608, 0x3160c,
1873 0x31a00, 0x31a1c,
1874 0x31e04, 0x31e20,
1875 0x31e38, 0x31e3c,
1876 0x31e80, 0x31e80,
1877 0x31e88, 0x31ea8,
1878 0x31eb0, 0x31eb4,
1879 0x31ec8, 0x31ed4,
1880 0x31fb8, 0x32004,
1881 0x32208, 0x3223c,
1882 0x32600, 0x32630,
1883 0x32a00, 0x32abc,
1884 0x32b00, 0x32b70,
1885 0x33000, 0x33048,
1886 0x33060, 0x3309c,
1887 0x330f0, 0x33148,
1888 0x33160, 0x3319c,
1889 0x331f0, 0x332e4,
1890 0x332f8, 0x333e4,
1891 0x333f8, 0x33448,
1892 0x33460, 0x3349c,
1893 0x334f0, 0x33548,
1894 0x33560, 0x3359c,
1895 0x335f0, 0x336e4,
1896 0x336f8, 0x337e4,
1897 0x337f8, 0x337fc,
1898 0x33814, 0x33814,
1899 0x3382c, 0x3382c,
1900 0x33880, 0x3388c,
1901 0x338e8, 0x338ec,
1902 0x33900, 0x33948,
1903 0x33960, 0x3399c,
1904 0x339f0, 0x33ae4,
1905 0x33af8, 0x33b10,
1906 0x33b28, 0x33b28,
1907 0x33b3c, 0x33b50,
1908 0x33bf0, 0x33c10,
1909 0x33c28, 0x33c28,
1910 0x33c3c, 0x33c50,
1911 0x33cf0, 0x33cfc,
1912 0x34000, 0x34030,
1913 0x34100, 0x34144,
1914 0x34190, 0x341d0,
1915 0x34200, 0x34318,
1916 0x34400, 0x3452c,
1917 0x34540, 0x3461c,
1918 0x34800, 0x34834,
1919 0x348c0, 0x34908,
1920 0x34910, 0x349ac,
1921 0x34a00, 0x34a04,
1922 0x34a0c, 0x34a2c,
1923 0x34a44, 0x34a50,
1924 0x34a74, 0x34c24,
1925 0x34d08, 0x34d14,
1926 0x34d1c, 0x34d20,
1927 0x34d3c, 0x34d50,
1928 0x35200, 0x3520c,
1929 0x35220, 0x35220,
1930 0x35240, 0x35240,
1931 0x35600, 0x35600,
1932 0x35608, 0x3560c,
1933 0x35a00, 0x35a1c,
1934 0x35e04, 0x35e20,
1935 0x35e38, 0x35e3c,
1936 0x35e80, 0x35e80,
1937 0x35e88, 0x35ea8,
1938 0x35eb0, 0x35eb4,
1939 0x35ec8, 0x35ed4,
1940 0x35fb8, 0x36004,
1941 0x36208, 0x3623c,
1942 0x36600, 0x36630,
1943 0x36a00, 0x36abc,
1944 0x36b00, 0x36b70,
1945 0x37000, 0x37048,
1946 0x37060, 0x3709c,
1947 0x370f0, 0x37148,
1948 0x37160, 0x3719c,
1949 0x371f0, 0x372e4,
1950 0x372f8, 0x373e4,
1951 0x373f8, 0x37448,
1952 0x37460, 0x3749c,
1953 0x374f0, 0x37548,
1954 0x37560, 0x3759c,
1955 0x375f0, 0x376e4,
1956 0x376f8, 0x377e4,
1957 0x377f8, 0x377fc,
1958 0x37814, 0x37814,
1959 0x3782c, 0x3782c,
1960 0x37880, 0x3788c,
1961 0x378e8, 0x378ec,
1962 0x37900, 0x37948,
1963 0x37960, 0x3799c,
1964 0x379f0, 0x37ae4,
1965 0x37af8, 0x37b10,
1966 0x37b28, 0x37b28,
1967 0x37b3c, 0x37b50,
1968 0x37bf0, 0x37c10,
1969 0x37c28, 0x37c28,
1970 0x37c3c, 0x37c50,
1971 0x37cf0, 0x37cfc,
1972 0x38000, 0x38030,
1973 0x38100, 0x38144,
1974 0x38190, 0x381d0,
1975 0x38200, 0x38318,
1976 0x38400, 0x3852c,
1977 0x38540, 0x3861c,
1978 0x38800, 0x38834,
1979 0x388c0, 0x38908,
1980 0x38910, 0x389ac,
1981 0x38a00, 0x38a04,
1982 0x38a0c, 0x38a2c,
1983 0x38a44, 0x38a50,
1984 0x38a74, 0x38c24,
1985 0x38d08, 0x38d14,
1986 0x38d1c, 0x38d20,
1987 0x38d3c, 0x38d50,
1988 0x39200, 0x3920c,
1989 0x39220, 0x39220,
1990 0x39240, 0x39240,
1991 0x39600, 0x39600,
1992 0x39608, 0x3960c,
1993 0x39a00, 0x39a1c,
1994 0x39e04, 0x39e20,
1995 0x39e38, 0x39e3c,
1996 0x39e80, 0x39e80,
1997 0x39e88, 0x39ea8,
1998 0x39eb0, 0x39eb4,
1999 0x39ec8, 0x39ed4,
2000 0x39fb8, 0x3a004,
2001 0x3a208, 0x3a23c,
2002 0x3a600, 0x3a630,
2003 0x3aa00, 0x3aabc,
2004 0x3ab00, 0x3ab70,
2005 0x3b000, 0x3b048,
2006 0x3b060, 0x3b09c,
2007 0x3b0f0, 0x3b148,
2008 0x3b160, 0x3b19c,
2009 0x3b1f0, 0x3b2e4,
2010 0x3b2f8, 0x3b3e4,
2011 0x3b3f8, 0x3b448,
2012 0x3b460, 0x3b49c,
2013 0x3b4f0, 0x3b548,
2014 0x3b560, 0x3b59c,
2015 0x3b5f0, 0x3b6e4,
2016 0x3b6f8, 0x3b7e4,
2017 0x3b7f8, 0x3b7fc,
2018 0x3b814, 0x3b814,
2019 0x3b82c, 0x3b82c,
2020 0x3b880, 0x3b88c,
2021 0x3b8e8, 0x3b8ec,
2022 0x3b900, 0x3b948,
2023 0x3b960, 0x3b99c,
2024 0x3b9f0, 0x3bae4,
2025 0x3baf8, 0x3bb10,
2026 0x3bb28, 0x3bb28,
2027 0x3bb3c, 0x3bb50,
2028 0x3bbf0, 0x3bc10,
2029 0x3bc28, 0x3bc28,
2030 0x3bc3c, 0x3bc50,
2031 0x3bcf0, 0x3bcfc,
2032 0x3c000, 0x3c030,
2033 0x3c100, 0x3c144,
2034 0x3c190, 0x3c1d0,
2035 0x3c200, 0x3c318,
2036 0x3c400, 0x3c52c,
2037 0x3c540, 0x3c61c,
2038 0x3c800, 0x3c834,
2039 0x3c8c0, 0x3c908,
2040 0x3c910, 0x3c9ac,
2041 0x3ca00, 0x3ca04,
2042 0x3ca0c, 0x3ca2c,
2043 0x3ca44, 0x3ca50,
2044 0x3ca74, 0x3cc24,
2045 0x3cd08, 0x3cd14,
2046 0x3cd1c, 0x3cd20,
2047 0x3cd3c, 0x3cd50,
2048 0x3d200, 0x3d20c,
2049 0x3d220, 0x3d220,
2050 0x3d240, 0x3d240,
2051 0x3d600, 0x3d600,
2052 0x3d608, 0x3d60c,
2053 0x3da00, 0x3da1c,
2054 0x3de04, 0x3de20,
2055 0x3de38, 0x3de3c,
2056 0x3de80, 0x3de80,
2057 0x3de88, 0x3dea8,
2058 0x3deb0, 0x3deb4,
2059 0x3dec8, 0x3ded4,
2060 0x3dfb8, 0x3e004,
2061 0x3e208, 0x3e23c,
2062 0x3e600, 0x3e630,
2063 0x3ea00, 0x3eabc,
2064 0x3eb00, 0x3eb70,
2065 0x3f000, 0x3f048,
2066 0x3f060, 0x3f09c,
2067 0x3f0f0, 0x3f148,
2068 0x3f160, 0x3f19c,
2069 0x3f1f0, 0x3f2e4,
2070 0x3f2f8, 0x3f3e4,
2071 0x3f3f8, 0x3f448,
2072 0x3f460, 0x3f49c,
2073 0x3f4f0, 0x3f548,
2074 0x3f560, 0x3f59c,
2075 0x3f5f0, 0x3f6e4,
2076 0x3f6f8, 0x3f7e4,
2077 0x3f7f8, 0x3f7fc,
2078 0x3f814, 0x3f814,
2079 0x3f82c, 0x3f82c,
2080 0x3f880, 0x3f88c,
2081 0x3f8e8, 0x3f8ec,
2082 0x3f900, 0x3f948,
2083 0x3f960, 0x3f99c,
2084 0x3f9f0, 0x3fae4,
2085 0x3faf8, 0x3fb10,
2086 0x3fb28, 0x3fb28,
2087 0x3fb3c, 0x3fb50,
2088 0x3fbf0, 0x3fc10,
2089 0x3fc28, 0x3fc28,
2090 0x3fc3c, 0x3fc50,
2091 0x3fcf0, 0x3fcfc,
2092 0x40000, 0x4000c,
2093 0x40040, 0x40068,
2094 0x40080, 0x40144,
2095 0x40180, 0x4018c,
2096 0x40200, 0x40298,
2097 0x402ac, 0x4033c,
2098 0x403f8, 0x403fc,
2099 0x41300, 0x413c4,
2100 0x41400, 0x4141c,
2101 0x41480, 0x414d0,
2102 0x44000, 0x44078,
2103 0x440c0, 0x44278,
2104 0x442c0, 0x44478,
2105 0x444c0, 0x44678,
2106 0x446c0, 0x44878,
2107 0x448c0, 0x449fc,
2108 0x45000, 0x45068,
2109 0x45080, 0x45084,
2110 0x450a0, 0x450b0,
2111 0x45200, 0x45268,
2112 0x45280, 0x45284,
2113 0x452a0, 0x452b0,
2114 0x460c0, 0x460e4,
2115 0x47000, 0x4708c,
2116 0x47200, 0x47250,
2117 0x47400, 0x47420,
2118 0x47600, 0x47618,
2119 0x47800, 0x47814,
2120 0x48000, 0x4800c,
2121 0x48040, 0x48068,
2122 0x48080, 0x48144,
2123 0x48180, 0x4818c,
2124 0x48200, 0x48298,
2125 0x482ac, 0x4833c,
2126 0x483f8, 0x483fc,
2127 0x49300, 0x493c4,
2128 0x49400, 0x4941c,
2129 0x49480, 0x494d0,
2130 0x4c000, 0x4c078,
2131 0x4c0c0, 0x4c278,
2132 0x4c2c0, 0x4c478,
2133 0x4c4c0, 0x4c678,
2134 0x4c6c0, 0x4c878,
2135 0x4c8c0, 0x4c9fc,
2136 0x4d000, 0x4d068,
2137 0x4d080, 0x4d084,
2138 0x4d0a0, 0x4d0b0,
2139 0x4d200, 0x4d268,
2140 0x4d280, 0x4d284,
2141 0x4d2a0, 0x4d2b0,
2142 0x4e0c0, 0x4e0e4,
2143 0x4f000, 0x4f08c,
2144 0x4f200, 0x4f250,
2145 0x4f400, 0x4f420,
2146 0x4f600, 0x4f618,
2147 0x4f800, 0x4f814,
2148 0x50000, 0x500cc,
2149 0x50400, 0x50400,
2150 0x50800, 0x508cc,
2151 0x50c00, 0x50c00,
2152 0x51000, 0x5101c,
2153 0x51300, 0x51308,
2154 };
2155
b8ff05a9
DM
2156 int i;
2157 struct adapter *ap = netdev2adap(dev);
251f9e88
SR
2158 static const unsigned int *reg_ranges;
2159 int arr_size = 0, buf_size = 0;
2160
2161 if (is_t4(ap->chip)) {
2162 reg_ranges = &t4_reg_ranges[0];
2163 arr_size = ARRAY_SIZE(t4_reg_ranges);
2164 buf_size = T4_REGMAP_SIZE;
2165 } else {
2166 reg_ranges = &t5_reg_ranges[0];
2167 arr_size = ARRAY_SIZE(t5_reg_ranges);
2168 buf_size = T5_REGMAP_SIZE;
2169 }
b8ff05a9
DM
2170
2171 regs->version = mk_adap_vers(ap);
2172
251f9e88
SR
2173 memset(buf, 0, buf_size);
2174 for (i = 0; i < arr_size; i += 2)
b8ff05a9
DM
2175 reg_block_dump(ap, buf, reg_ranges[i], reg_ranges[i + 1]);
2176}
2177
2178static int restart_autoneg(struct net_device *dev)
2179{
2180 struct port_info *p = netdev_priv(dev);
2181
2182 if (!netif_running(dev))
2183 return -EAGAIN;
2184 if (p->link_cfg.autoneg != AUTONEG_ENABLE)
2185 return -EINVAL;
060e0c75 2186 t4_restart_aneg(p->adapter, p->adapter->fn, p->tx_chan);
b8ff05a9
DM
2187 return 0;
2188}
2189
c5e06360
DM
2190static int identify_port(struct net_device *dev,
2191 enum ethtool_phys_id_state state)
b8ff05a9 2192{
c5e06360 2193 unsigned int val;
060e0c75
DM
2194 struct adapter *adap = netdev2adap(dev);
2195
c5e06360
DM
2196 if (state == ETHTOOL_ID_ACTIVE)
2197 val = 0xffff;
2198 else if (state == ETHTOOL_ID_INACTIVE)
2199 val = 0;
2200 else
2201 return -EINVAL;
b8ff05a9 2202
c5e06360 2203 return t4_identify_port(adap, adap->fn, netdev2pinfo(dev)->viid, val);
b8ff05a9
DM
2204}
2205
2206static unsigned int from_fw_linkcaps(unsigned int type, unsigned int caps)
2207{
2208 unsigned int v = 0;
2209
a0881cab
DM
2210 if (type == FW_PORT_TYPE_BT_SGMII || type == FW_PORT_TYPE_BT_XFI ||
2211 type == FW_PORT_TYPE_BT_XAUI) {
b8ff05a9
DM
2212 v |= SUPPORTED_TP;
2213 if (caps & FW_PORT_CAP_SPEED_100M)
2214 v |= SUPPORTED_100baseT_Full;
2215 if (caps & FW_PORT_CAP_SPEED_1G)
2216 v |= SUPPORTED_1000baseT_Full;
2217 if (caps & FW_PORT_CAP_SPEED_10G)
2218 v |= SUPPORTED_10000baseT_Full;
2219 } else if (type == FW_PORT_TYPE_KX4 || type == FW_PORT_TYPE_KX) {
2220 v |= SUPPORTED_Backplane;
2221 if (caps & FW_PORT_CAP_SPEED_1G)
2222 v |= SUPPORTED_1000baseKX_Full;
2223 if (caps & FW_PORT_CAP_SPEED_10G)
2224 v |= SUPPORTED_10000baseKX4_Full;
2225 } else if (type == FW_PORT_TYPE_KR)
2226 v |= SUPPORTED_Backplane | SUPPORTED_10000baseKR_Full;
a0881cab 2227 else if (type == FW_PORT_TYPE_BP_AP)
7d5e77aa
DM
2228 v |= SUPPORTED_Backplane | SUPPORTED_10000baseR_FEC |
2229 SUPPORTED_10000baseKR_Full | SUPPORTED_1000baseKX_Full;
2230 else if (type == FW_PORT_TYPE_BP4_AP)
2231 v |= SUPPORTED_Backplane | SUPPORTED_10000baseR_FEC |
2232 SUPPORTED_10000baseKR_Full | SUPPORTED_1000baseKX_Full |
2233 SUPPORTED_10000baseKX4_Full;
a0881cab
DM
2234 else if (type == FW_PORT_TYPE_FIBER_XFI ||
2235 type == FW_PORT_TYPE_FIBER_XAUI || type == FW_PORT_TYPE_SFP)
b8ff05a9
DM
2236 v |= SUPPORTED_FIBRE;
2237
2238 if (caps & FW_PORT_CAP_ANEG)
2239 v |= SUPPORTED_Autoneg;
2240 return v;
2241}
2242
2243static unsigned int to_fw_linkcaps(unsigned int caps)
2244{
2245 unsigned int v = 0;
2246
2247 if (caps & ADVERTISED_100baseT_Full)
2248 v |= FW_PORT_CAP_SPEED_100M;
2249 if (caps & ADVERTISED_1000baseT_Full)
2250 v |= FW_PORT_CAP_SPEED_1G;
2251 if (caps & ADVERTISED_10000baseT_Full)
2252 v |= FW_PORT_CAP_SPEED_10G;
2253 return v;
2254}
2255
2256static int get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
2257{
2258 const struct port_info *p = netdev_priv(dev);
2259
2260 if (p->port_type == FW_PORT_TYPE_BT_SGMII ||
a0881cab 2261 p->port_type == FW_PORT_TYPE_BT_XFI ||
b8ff05a9
DM
2262 p->port_type == FW_PORT_TYPE_BT_XAUI)
2263 cmd->port = PORT_TP;
a0881cab
DM
2264 else if (p->port_type == FW_PORT_TYPE_FIBER_XFI ||
2265 p->port_type == FW_PORT_TYPE_FIBER_XAUI)
b8ff05a9 2266 cmd->port = PORT_FIBRE;
a0881cab
DM
2267 else if (p->port_type == FW_PORT_TYPE_SFP) {
2268 if (p->mod_type == FW_PORT_MOD_TYPE_TWINAX_PASSIVE ||
2269 p->mod_type == FW_PORT_MOD_TYPE_TWINAX_ACTIVE)
2270 cmd->port = PORT_DA;
2271 else
2272 cmd->port = PORT_FIBRE;
2273 } else
b8ff05a9
DM
2274 cmd->port = PORT_OTHER;
2275
2276 if (p->mdio_addr >= 0) {
2277 cmd->phy_address = p->mdio_addr;
2278 cmd->transceiver = XCVR_EXTERNAL;
2279 cmd->mdio_support = p->port_type == FW_PORT_TYPE_BT_SGMII ?
2280 MDIO_SUPPORTS_C22 : MDIO_SUPPORTS_C45;
2281 } else {
2282 cmd->phy_address = 0; /* not really, but no better option */
2283 cmd->transceiver = XCVR_INTERNAL;
2284 cmd->mdio_support = 0;
2285 }
2286
2287 cmd->supported = from_fw_linkcaps(p->port_type, p->link_cfg.supported);
2288 cmd->advertising = from_fw_linkcaps(p->port_type,
2289 p->link_cfg.advertising);
70739497
DD
2290 ethtool_cmd_speed_set(cmd,
2291 netif_carrier_ok(dev) ? p->link_cfg.speed : 0);
b8ff05a9
DM
2292 cmd->duplex = DUPLEX_FULL;
2293 cmd->autoneg = p->link_cfg.autoneg;
2294 cmd->maxtxpkt = 0;
2295 cmd->maxrxpkt = 0;
2296 return 0;
2297}
2298
2299static unsigned int speed_to_caps(int speed)
2300{
2301 if (speed == SPEED_100)
2302 return FW_PORT_CAP_SPEED_100M;
2303 if (speed == SPEED_1000)
2304 return FW_PORT_CAP_SPEED_1G;
2305 if (speed == SPEED_10000)
2306 return FW_PORT_CAP_SPEED_10G;
2307 return 0;
2308}
2309
2310static int set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
2311{
2312 unsigned int cap;
2313 struct port_info *p = netdev_priv(dev);
2314 struct link_config *lc = &p->link_cfg;
25db0338 2315 u32 speed = ethtool_cmd_speed(cmd);
b8ff05a9
DM
2316
2317 if (cmd->duplex != DUPLEX_FULL) /* only full-duplex supported */
2318 return -EINVAL;
2319
2320 if (!(lc->supported & FW_PORT_CAP_ANEG)) {
2321 /*
2322 * PHY offers a single speed. See if that's what's
2323 * being requested.
2324 */
2325 if (cmd->autoneg == AUTONEG_DISABLE &&
25db0338
DD
2326 (lc->supported & speed_to_caps(speed)))
2327 return 0;
b8ff05a9
DM
2328 return -EINVAL;
2329 }
2330
2331 if (cmd->autoneg == AUTONEG_DISABLE) {
25db0338 2332 cap = speed_to_caps(speed);
b8ff05a9 2333
25db0338
DD
2334 if (!(lc->supported & cap) || (speed == SPEED_1000) ||
2335 (speed == SPEED_10000))
b8ff05a9
DM
2336 return -EINVAL;
2337 lc->requested_speed = cap;
2338 lc->advertising = 0;
2339 } else {
2340 cap = to_fw_linkcaps(cmd->advertising);
2341 if (!(lc->supported & cap))
2342 return -EINVAL;
2343 lc->requested_speed = 0;
2344 lc->advertising = cap | FW_PORT_CAP_ANEG;
2345 }
2346 lc->autoneg = cmd->autoneg;
2347
2348 if (netif_running(dev))
060e0c75
DM
2349 return t4_link_start(p->adapter, p->adapter->fn, p->tx_chan,
2350 lc);
b8ff05a9
DM
2351 return 0;
2352}
2353
2354static void get_pauseparam(struct net_device *dev,
2355 struct ethtool_pauseparam *epause)
2356{
2357 struct port_info *p = netdev_priv(dev);
2358
2359 epause->autoneg = (p->link_cfg.requested_fc & PAUSE_AUTONEG) != 0;
2360 epause->rx_pause = (p->link_cfg.fc & PAUSE_RX) != 0;
2361 epause->tx_pause = (p->link_cfg.fc & PAUSE_TX) != 0;
2362}
2363
2364static int set_pauseparam(struct net_device *dev,
2365 struct ethtool_pauseparam *epause)
2366{
2367 struct port_info *p = netdev_priv(dev);
2368 struct link_config *lc = &p->link_cfg;
2369
2370 if (epause->autoneg == AUTONEG_DISABLE)
2371 lc->requested_fc = 0;
2372 else if (lc->supported & FW_PORT_CAP_ANEG)
2373 lc->requested_fc = PAUSE_AUTONEG;
2374 else
2375 return -EINVAL;
2376
2377 if (epause->rx_pause)
2378 lc->requested_fc |= PAUSE_RX;
2379 if (epause->tx_pause)
2380 lc->requested_fc |= PAUSE_TX;
2381 if (netif_running(dev))
060e0c75
DM
2382 return t4_link_start(p->adapter, p->adapter->fn, p->tx_chan,
2383 lc);
b8ff05a9
DM
2384 return 0;
2385}
2386
b8ff05a9
DM
2387static void get_sge_param(struct net_device *dev, struct ethtool_ringparam *e)
2388{
2389 const struct port_info *pi = netdev_priv(dev);
2390 const struct sge *s = &pi->adapter->sge;
2391
2392 e->rx_max_pending = MAX_RX_BUFFERS;
2393 e->rx_mini_max_pending = MAX_RSPQ_ENTRIES;
2394 e->rx_jumbo_max_pending = 0;
2395 e->tx_max_pending = MAX_TXQ_ENTRIES;
2396
2397 e->rx_pending = s->ethrxq[pi->first_qset].fl.size - 8;
2398 e->rx_mini_pending = s->ethrxq[pi->first_qset].rspq.size;
2399 e->rx_jumbo_pending = 0;
2400 e->tx_pending = s->ethtxq[pi->first_qset].q.size;
2401}
2402
2403static int set_sge_param(struct net_device *dev, struct ethtool_ringparam *e)
2404{
2405 int i;
2406 const struct port_info *pi = netdev_priv(dev);
2407 struct adapter *adapter = pi->adapter;
2408 struct sge *s = &adapter->sge;
2409
2410 if (e->rx_pending > MAX_RX_BUFFERS || e->rx_jumbo_pending ||
2411 e->tx_pending > MAX_TXQ_ENTRIES ||
2412 e->rx_mini_pending > MAX_RSPQ_ENTRIES ||
2413 e->rx_mini_pending < MIN_RSPQ_ENTRIES ||
2414 e->rx_pending < MIN_FL_ENTRIES || e->tx_pending < MIN_TXQ_ENTRIES)
2415 return -EINVAL;
2416
2417 if (adapter->flags & FULL_INIT_DONE)
2418 return -EBUSY;
2419
2420 for (i = 0; i < pi->nqsets; ++i) {
2421 s->ethtxq[pi->first_qset + i].q.size = e->tx_pending;
2422 s->ethrxq[pi->first_qset + i].fl.size = e->rx_pending + 8;
2423 s->ethrxq[pi->first_qset + i].rspq.size = e->rx_mini_pending;
2424 }
2425 return 0;
2426}
2427
2428static int closest_timer(const struct sge *s, int time)
2429{
2430 int i, delta, match = 0, min_delta = INT_MAX;
2431
2432 for (i = 0; i < ARRAY_SIZE(s->timer_val); i++) {
2433 delta = time - s->timer_val[i];
2434 if (delta < 0)
2435 delta = -delta;
2436 if (delta < min_delta) {
2437 min_delta = delta;
2438 match = i;
2439 }
2440 }
2441 return match;
2442}
2443
2444static int closest_thres(const struct sge *s, int thres)
2445{
2446 int i, delta, match = 0, min_delta = INT_MAX;
2447
2448 for (i = 0; i < ARRAY_SIZE(s->counter_val); i++) {
2449 delta = thres - s->counter_val[i];
2450 if (delta < 0)
2451 delta = -delta;
2452 if (delta < min_delta) {
2453 min_delta = delta;
2454 match = i;
2455 }
2456 }
2457 return match;
2458}
2459
2460/*
2461 * Return a queue's interrupt hold-off time in us. 0 means no timer.
2462 */
2463static unsigned int qtimer_val(const struct adapter *adap,
2464 const struct sge_rspq *q)
2465{
2466 unsigned int idx = q->intr_params >> 1;
2467
2468 return idx < SGE_NTIMERS ? adap->sge.timer_val[idx] : 0;
2469}
2470
2471/**
2472 * set_rxq_intr_params - set a queue's interrupt holdoff parameters
2473 * @adap: the adapter
2474 * @q: the Rx queue
2475 * @us: the hold-off time in us, or 0 to disable timer
2476 * @cnt: the hold-off packet count, or 0 to disable counter
2477 *
2478 * Sets an Rx queue's interrupt hold-off time and packet count. At least
2479 * one of the two needs to be enabled for the queue to generate interrupts.
2480 */
2481static int set_rxq_intr_params(struct adapter *adap, struct sge_rspq *q,
2482 unsigned int us, unsigned int cnt)
2483{
2484 if ((us | cnt) == 0)
2485 cnt = 1;
2486
2487 if (cnt) {
2488 int err;
2489 u32 v, new_idx;
2490
2491 new_idx = closest_thres(&adap->sge, cnt);
2492 if (q->desc && q->pktcnt_idx != new_idx) {
2493 /* the queue has already been created, update it */
2494 v = FW_PARAMS_MNEM(FW_PARAMS_MNEM_DMAQ) |
2495 FW_PARAMS_PARAM_X(FW_PARAMS_PARAM_DMAQ_IQ_INTCNTTHRESH) |
2496 FW_PARAMS_PARAM_YZ(q->cntxt_id);
060e0c75
DM
2497 err = t4_set_params(adap, adap->fn, adap->fn, 0, 1, &v,
2498 &new_idx);
b8ff05a9
DM
2499 if (err)
2500 return err;
2501 }
2502 q->pktcnt_idx = new_idx;
2503 }
2504
2505 us = us == 0 ? 6 : closest_timer(&adap->sge, us);
2506 q->intr_params = QINTR_TIMER_IDX(us) | (cnt > 0 ? QINTR_CNT_EN : 0);
2507 return 0;
2508}
2509
2510static int set_coalesce(struct net_device *dev, struct ethtool_coalesce *c)
2511{
2512 const struct port_info *pi = netdev_priv(dev);
2513 struct adapter *adap = pi->adapter;
d4fc9dc2
TLSC
2514 struct sge_rspq *q;
2515 int i;
2516 int r = 0;
2517
2518 for (i = pi->first_qset; i < pi->first_qset + pi->nqsets; i++) {
2519 q = &adap->sge.ethrxq[i].rspq;
2520 r = set_rxq_intr_params(adap, q, c->rx_coalesce_usecs,
2521 c->rx_max_coalesced_frames);
2522 if (r) {
2523 dev_err(&dev->dev, "failed to set coalesce %d\n", r);
2524 break;
2525 }
2526 }
2527 return r;
b8ff05a9
DM
2528}
2529
2530static int get_coalesce(struct net_device *dev, struct ethtool_coalesce *c)
2531{
2532 const struct port_info *pi = netdev_priv(dev);
2533 const struct adapter *adap = pi->adapter;
2534 const struct sge_rspq *rq = &adap->sge.ethrxq[pi->first_qset].rspq;
2535
2536 c->rx_coalesce_usecs = qtimer_val(adap, rq);
2537 c->rx_max_coalesced_frames = (rq->intr_params & QINTR_CNT_EN) ?
2538 adap->sge.counter_val[rq->pktcnt_idx] : 0;
2539 return 0;
2540}
2541
1478b3ee
DM
2542/**
2543 * eeprom_ptov - translate a physical EEPROM address to virtual
2544 * @phys_addr: the physical EEPROM address
2545 * @fn: the PCI function number
2546 * @sz: size of function-specific area
2547 *
2548 * Translate a physical EEPROM address to virtual. The first 1K is
2549 * accessed through virtual addresses starting at 31K, the rest is
2550 * accessed through virtual addresses starting at 0.
2551 *
2552 * The mapping is as follows:
2553 * [0..1K) -> [31K..32K)
2554 * [1K..1K+A) -> [31K-A..31K)
2555 * [1K+A..ES) -> [0..ES-A-1K)
2556 *
2557 * where A = @fn * @sz, and ES = EEPROM size.
b8ff05a9 2558 */
1478b3ee 2559static int eeprom_ptov(unsigned int phys_addr, unsigned int fn, unsigned int sz)
b8ff05a9 2560{
1478b3ee 2561 fn *= sz;
b8ff05a9
DM
2562 if (phys_addr < 1024)
2563 return phys_addr + (31 << 10);
1478b3ee
DM
2564 if (phys_addr < 1024 + fn)
2565 return 31744 - fn + phys_addr - 1024;
b8ff05a9 2566 if (phys_addr < EEPROMSIZE)
1478b3ee 2567 return phys_addr - 1024 - fn;
b8ff05a9
DM
2568 return -EINVAL;
2569}
2570
2571/*
2572 * The next two routines implement eeprom read/write from physical addresses.
b8ff05a9
DM
2573 */
2574static int eeprom_rd_phys(struct adapter *adap, unsigned int phys_addr, u32 *v)
2575{
1478b3ee 2576 int vaddr = eeprom_ptov(phys_addr, adap->fn, EEPROMPFSIZE);
b8ff05a9
DM
2577
2578 if (vaddr >= 0)
2579 vaddr = pci_read_vpd(adap->pdev, vaddr, sizeof(u32), v);
2580 return vaddr < 0 ? vaddr : 0;
2581}
2582
2583static int eeprom_wr_phys(struct adapter *adap, unsigned int phys_addr, u32 v)
2584{
1478b3ee 2585 int vaddr = eeprom_ptov(phys_addr, adap->fn, EEPROMPFSIZE);
b8ff05a9
DM
2586
2587 if (vaddr >= 0)
2588 vaddr = pci_write_vpd(adap->pdev, vaddr, sizeof(u32), &v);
2589 return vaddr < 0 ? vaddr : 0;
2590}
2591
2592#define EEPROM_MAGIC 0x38E2F10C
2593
2594static int get_eeprom(struct net_device *dev, struct ethtool_eeprom *e,
2595 u8 *data)
2596{
2597 int i, err = 0;
2598 struct adapter *adapter = netdev2adap(dev);
2599
2600 u8 *buf = kmalloc(EEPROMSIZE, GFP_KERNEL);
2601 if (!buf)
2602 return -ENOMEM;
2603
2604 e->magic = EEPROM_MAGIC;
2605 for (i = e->offset & ~3; !err && i < e->offset + e->len; i += 4)
2606 err = eeprom_rd_phys(adapter, i, (u32 *)&buf[i]);
2607
2608 if (!err)
2609 memcpy(data, buf + e->offset, e->len);
2610 kfree(buf);
2611 return err;
2612}
2613
2614static int set_eeprom(struct net_device *dev, struct ethtool_eeprom *eeprom,
2615 u8 *data)
2616{
2617 u8 *buf;
2618 int err = 0;
2619 u32 aligned_offset, aligned_len, *p;
2620 struct adapter *adapter = netdev2adap(dev);
2621
2622 if (eeprom->magic != EEPROM_MAGIC)
2623 return -EINVAL;
2624
2625 aligned_offset = eeprom->offset & ~3;
2626 aligned_len = (eeprom->len + (eeprom->offset & 3) + 3) & ~3;
2627
1478b3ee
DM
2628 if (adapter->fn > 0) {
2629 u32 start = 1024 + adapter->fn * EEPROMPFSIZE;
2630
2631 if (aligned_offset < start ||
2632 aligned_offset + aligned_len > start + EEPROMPFSIZE)
2633 return -EPERM;
2634 }
2635
b8ff05a9
DM
2636 if (aligned_offset != eeprom->offset || aligned_len != eeprom->len) {
2637 /*
2638 * RMW possibly needed for first or last words.
2639 */
2640 buf = kmalloc(aligned_len, GFP_KERNEL);
2641 if (!buf)
2642 return -ENOMEM;
2643 err = eeprom_rd_phys(adapter, aligned_offset, (u32 *)buf);
2644 if (!err && aligned_len > 4)
2645 err = eeprom_rd_phys(adapter,
2646 aligned_offset + aligned_len - 4,
2647 (u32 *)&buf[aligned_len - 4]);
2648 if (err)
2649 goto out;
2650 memcpy(buf + (eeprom->offset & 3), data, eeprom->len);
2651 } else
2652 buf = data;
2653
2654 err = t4_seeprom_wp(adapter, false);
2655 if (err)
2656 goto out;
2657
2658 for (p = (u32 *)buf; !err && aligned_len; aligned_len -= 4, p++) {
2659 err = eeprom_wr_phys(adapter, aligned_offset, *p);
2660 aligned_offset += 4;
2661 }
2662
2663 if (!err)
2664 err = t4_seeprom_wp(adapter, true);
2665out:
2666 if (buf != data)
2667 kfree(buf);
2668 return err;
2669}
2670
2671static int set_flash(struct net_device *netdev, struct ethtool_flash *ef)
2672{
2673 int ret;
2674 const struct firmware *fw;
2675 struct adapter *adap = netdev2adap(netdev);
2676
2677 ef->data[sizeof(ef->data) - 1] = '\0';
2678 ret = request_firmware(&fw, ef->data, adap->pdev_dev);
2679 if (ret < 0)
2680 return ret;
2681
2682 ret = t4_load_fw(adap, fw->data, fw->size);
2683 release_firmware(fw);
2684 if (!ret)
2685 dev_info(adap->pdev_dev, "loaded firmware %s\n", ef->data);
2686 return ret;
2687}
2688
2689#define WOL_SUPPORTED (WAKE_BCAST | WAKE_MAGIC)
2690#define BCAST_CRC 0xa0ccc1a6
2691
2692static void get_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
2693{
2694 wol->supported = WAKE_BCAST | WAKE_MAGIC;
2695 wol->wolopts = netdev2adap(dev)->wol;
2696 memset(&wol->sopass, 0, sizeof(wol->sopass));
2697}
2698
2699static int set_wol(struct net_device *dev, struct ethtool_wolinfo *wol)
2700{
2701 int err = 0;
2702 struct port_info *pi = netdev_priv(dev);
2703
2704 if (wol->wolopts & ~WOL_SUPPORTED)
2705 return -EINVAL;
2706 t4_wol_magic_enable(pi->adapter, pi->tx_chan,
2707 (wol->wolopts & WAKE_MAGIC) ? dev->dev_addr : NULL);
2708 if (wol->wolopts & WAKE_BCAST) {
2709 err = t4_wol_pat_enable(pi->adapter, pi->tx_chan, 0xfe, ~0ULL,
2710 ~0ULL, 0, false);
2711 if (!err)
2712 err = t4_wol_pat_enable(pi->adapter, pi->tx_chan, 1,
2713 ~6ULL, ~0ULL, BCAST_CRC, true);
2714 } else
2715 t4_wol_pat_enable(pi->adapter, pi->tx_chan, 0, 0, 0, 0, false);
2716 return err;
2717}
2718
c8f44aff 2719static int cxgb_set_features(struct net_device *dev, netdev_features_t features)
87b6cf51 2720{
2ed28baa 2721 const struct port_info *pi = netdev_priv(dev);
c8f44aff 2722 netdev_features_t changed = dev->features ^ features;
19ecae2c 2723 int err;
19ecae2c 2724
f646968f 2725 if (!(changed & NETIF_F_HW_VLAN_CTAG_RX))
2ed28baa 2726 return 0;
19ecae2c 2727
2ed28baa
MM
2728 err = t4_set_rxmode(pi->adapter, pi->adapter->fn, pi->viid, -1,
2729 -1, -1, -1,
f646968f 2730 !!(features & NETIF_F_HW_VLAN_CTAG_RX), true);
2ed28baa 2731 if (unlikely(err))
f646968f 2732 dev->features = features ^ NETIF_F_HW_VLAN_CTAG_RX;
19ecae2c 2733 return err;
87b6cf51
DM
2734}
2735
7850f63f 2736static u32 get_rss_table_size(struct net_device *dev)
671b0060
DM
2737{
2738 const struct port_info *pi = netdev_priv(dev);
671b0060 2739
7850f63f
BH
2740 return pi->rss_size;
2741}
2742
2743static int get_rss_table(struct net_device *dev, u32 *p)
2744{
2745 const struct port_info *pi = netdev_priv(dev);
2746 unsigned int n = pi->rss_size;
2747
671b0060 2748 while (n--)
7850f63f 2749 p[n] = pi->rss[n];
671b0060
DM
2750 return 0;
2751}
2752
7850f63f 2753static int set_rss_table(struct net_device *dev, const u32 *p)
671b0060
DM
2754{
2755 unsigned int i;
2756 struct port_info *pi = netdev_priv(dev);
2757
7850f63f
BH
2758 for (i = 0; i < pi->rss_size; i++)
2759 pi->rss[i] = p[i];
671b0060
DM
2760 if (pi->adapter->flags & FULL_INIT_DONE)
2761 return write_rss(pi, pi->rss);
2762 return 0;
2763}
2764
2765static int get_rxnfc(struct net_device *dev, struct ethtool_rxnfc *info,
815c7db5 2766 u32 *rules)
671b0060 2767{
f796564a
DM
2768 const struct port_info *pi = netdev_priv(dev);
2769
671b0060 2770 switch (info->cmd) {
f796564a
DM
2771 case ETHTOOL_GRXFH: {
2772 unsigned int v = pi->rss_mode;
2773
2774 info->data = 0;
2775 switch (info->flow_type) {
2776 case TCP_V4_FLOW:
2777 if (v & FW_RSS_VI_CONFIG_CMD_IP4FOURTUPEN)
2778 info->data = RXH_IP_SRC | RXH_IP_DST |
2779 RXH_L4_B_0_1 | RXH_L4_B_2_3;
2780 else if (v & FW_RSS_VI_CONFIG_CMD_IP4TWOTUPEN)
2781 info->data = RXH_IP_SRC | RXH_IP_DST;
2782 break;
2783 case UDP_V4_FLOW:
2784 if ((v & FW_RSS_VI_CONFIG_CMD_IP4FOURTUPEN) &&
2785 (v & FW_RSS_VI_CONFIG_CMD_UDPEN))
2786 info->data = RXH_IP_SRC | RXH_IP_DST |
2787 RXH_L4_B_0_1 | RXH_L4_B_2_3;
2788 else if (v & FW_RSS_VI_CONFIG_CMD_IP4TWOTUPEN)
2789 info->data = RXH_IP_SRC | RXH_IP_DST;
2790 break;
2791 case SCTP_V4_FLOW:
2792 case AH_ESP_V4_FLOW:
2793 case IPV4_FLOW:
2794 if (v & FW_RSS_VI_CONFIG_CMD_IP4TWOTUPEN)
2795 info->data = RXH_IP_SRC | RXH_IP_DST;
2796 break;
2797 case TCP_V6_FLOW:
2798 if (v & FW_RSS_VI_CONFIG_CMD_IP6FOURTUPEN)
2799 info->data = RXH_IP_SRC | RXH_IP_DST |
2800 RXH_L4_B_0_1 | RXH_L4_B_2_3;
2801 else if (v & FW_RSS_VI_CONFIG_CMD_IP6TWOTUPEN)
2802 info->data = RXH_IP_SRC | RXH_IP_DST;
2803 break;
2804 case UDP_V6_FLOW:
2805 if ((v & FW_RSS_VI_CONFIG_CMD_IP6FOURTUPEN) &&
2806 (v & FW_RSS_VI_CONFIG_CMD_UDPEN))
2807 info->data = RXH_IP_SRC | RXH_IP_DST |
2808 RXH_L4_B_0_1 | RXH_L4_B_2_3;
2809 else if (v & FW_RSS_VI_CONFIG_CMD_IP6TWOTUPEN)
2810 info->data = RXH_IP_SRC | RXH_IP_DST;
2811 break;
2812 case SCTP_V6_FLOW:
2813 case AH_ESP_V6_FLOW:
2814 case IPV6_FLOW:
2815 if (v & FW_RSS_VI_CONFIG_CMD_IP6TWOTUPEN)
2816 info->data = RXH_IP_SRC | RXH_IP_DST;
2817 break;
2818 }
2819 return 0;
2820 }
671b0060 2821 case ETHTOOL_GRXRINGS:
f796564a 2822 info->data = pi->nqsets;
671b0060
DM
2823 return 0;
2824 }
2825 return -EOPNOTSUPP;
2826}
2827
9b07be4b 2828static const struct ethtool_ops cxgb_ethtool_ops = {
b8ff05a9
DM
2829 .get_settings = get_settings,
2830 .set_settings = set_settings,
2831 .get_drvinfo = get_drvinfo,
2832 .get_msglevel = get_msglevel,
2833 .set_msglevel = set_msglevel,
2834 .get_ringparam = get_sge_param,
2835 .set_ringparam = set_sge_param,
2836 .get_coalesce = get_coalesce,
2837 .set_coalesce = set_coalesce,
2838 .get_eeprom_len = get_eeprom_len,
2839 .get_eeprom = get_eeprom,
2840 .set_eeprom = set_eeprom,
2841 .get_pauseparam = get_pauseparam,
2842 .set_pauseparam = set_pauseparam,
b8ff05a9
DM
2843 .get_link = ethtool_op_get_link,
2844 .get_strings = get_strings,
c5e06360 2845 .set_phys_id = identify_port,
b8ff05a9
DM
2846 .nway_reset = restart_autoneg,
2847 .get_sset_count = get_sset_count,
2848 .get_ethtool_stats = get_stats,
2849 .get_regs_len = get_regs_len,
2850 .get_regs = get_regs,
2851 .get_wol = get_wol,
2852 .set_wol = set_wol,
671b0060 2853 .get_rxnfc = get_rxnfc,
7850f63f 2854 .get_rxfh_indir_size = get_rss_table_size,
671b0060
DM
2855 .get_rxfh_indir = get_rss_table,
2856 .set_rxfh_indir = set_rss_table,
b8ff05a9
DM
2857 .flash_device = set_flash,
2858};
2859
2860/*
2861 * debugfs support
2862 */
b8ff05a9
DM
2863static ssize_t mem_read(struct file *file, char __user *buf, size_t count,
2864 loff_t *ppos)
2865{
2866 loff_t pos = *ppos;
496ad9aa 2867 loff_t avail = file_inode(file)->i_size;
b8ff05a9
DM
2868 unsigned int mem = (uintptr_t)file->private_data & 3;
2869 struct adapter *adap = file->private_data - mem;
2870
2871 if (pos < 0)
2872 return -EINVAL;
2873 if (pos >= avail)
2874 return 0;
2875 if (count > avail - pos)
2876 count = avail - pos;
2877
2878 while (count) {
2879 size_t len;
2880 int ret, ofst;
2881 __be32 data[16];
2882
19dd37ba
SR
2883 if ((mem == MEM_MC) || (mem == MEM_MC1))
2884 ret = t4_mc_read(adap, mem % MEM_MC, pos, data, NULL);
b8ff05a9
DM
2885 else
2886 ret = t4_edc_read(adap, mem, pos, data, NULL);
2887 if (ret)
2888 return ret;
2889
2890 ofst = pos % sizeof(data);
2891 len = min(count, sizeof(data) - ofst);
2892 if (copy_to_user(buf, (u8 *)data + ofst, len))
2893 return -EFAULT;
2894
2895 buf += len;
2896 pos += len;
2897 count -= len;
2898 }
2899 count = pos - *ppos;
2900 *ppos = pos;
2901 return count;
2902}
2903
2904static const struct file_operations mem_debugfs_fops = {
2905 .owner = THIS_MODULE,
234e3405 2906 .open = simple_open,
b8ff05a9 2907 .read = mem_read,
6038f373 2908 .llseek = default_llseek,
b8ff05a9
DM
2909};
2910
91744948 2911static void add_debugfs_mem(struct adapter *adap, const char *name,
1dd06ae8 2912 unsigned int idx, unsigned int size_mb)
b8ff05a9
DM
2913{
2914 struct dentry *de;
2915
2916 de = debugfs_create_file(name, S_IRUSR, adap->debugfs_root,
2917 (void *)adap + idx, &mem_debugfs_fops);
2918 if (de && de->d_inode)
2919 de->d_inode->i_size = size_mb << 20;
2920}
2921
91744948 2922static int setup_debugfs(struct adapter *adap)
b8ff05a9
DM
2923{
2924 int i;
19dd37ba 2925 u32 size;
b8ff05a9
DM
2926
2927 if (IS_ERR_OR_NULL(adap->debugfs_root))
2928 return -1;
2929
2930 i = t4_read_reg(adap, MA_TARGET_MEM_ENABLE);
19dd37ba
SR
2931 if (i & EDRAM0_ENABLE) {
2932 size = t4_read_reg(adap, MA_EDRAM0_BAR);
2933 add_debugfs_mem(adap, "edc0", MEM_EDC0, EDRAM_SIZE_GET(size));
2934 }
2935 if (i & EDRAM1_ENABLE) {
2936 size = t4_read_reg(adap, MA_EDRAM1_BAR);
2937 add_debugfs_mem(adap, "edc1", MEM_EDC1, EDRAM_SIZE_GET(size));
2938 }
2939 if (is_t4(adap->chip)) {
2940 size = t4_read_reg(adap, MA_EXT_MEMORY_BAR);
2941 if (i & EXT_MEM_ENABLE)
2942 add_debugfs_mem(adap, "mc", MEM_MC,
2943 EXT_MEM_SIZE_GET(size));
2944 } else {
2945 if (i & EXT_MEM_ENABLE) {
2946 size = t4_read_reg(adap, MA_EXT_MEMORY_BAR);
2947 add_debugfs_mem(adap, "mc0", MEM_MC0,
2948 EXT_MEM_SIZE_GET(size));
2949 }
2950 if (i & EXT_MEM1_ENABLE) {
2951 size = t4_read_reg(adap, MA_EXT_MEMORY1_BAR);
2952 add_debugfs_mem(adap, "mc1", MEM_MC1,
2953 EXT_MEM_SIZE_GET(size));
2954 }
2955 }
b8ff05a9
DM
2956 if (adap->l2t)
2957 debugfs_create_file("l2t", S_IRUSR, adap->debugfs_root, adap,
2958 &t4_l2t_fops);
2959 return 0;
2960}
2961
2962/*
2963 * upper-layer driver support
2964 */
2965
2966/*
2967 * Allocate an active-open TID and set it to the supplied value.
2968 */
2969int cxgb4_alloc_atid(struct tid_info *t, void *data)
2970{
2971 int atid = -1;
2972
2973 spin_lock_bh(&t->atid_lock);
2974 if (t->afree) {
2975 union aopen_entry *p = t->afree;
2976
f2b7e78d 2977 atid = (p - t->atid_tab) + t->atid_base;
b8ff05a9
DM
2978 t->afree = p->next;
2979 p->data = data;
2980 t->atids_in_use++;
2981 }
2982 spin_unlock_bh(&t->atid_lock);
2983 return atid;
2984}
2985EXPORT_SYMBOL(cxgb4_alloc_atid);
2986
2987/*
2988 * Release an active-open TID.
2989 */
2990void cxgb4_free_atid(struct tid_info *t, unsigned int atid)
2991{
f2b7e78d 2992 union aopen_entry *p = &t->atid_tab[atid - t->atid_base];
b8ff05a9
DM
2993
2994 spin_lock_bh(&t->atid_lock);
2995 p->next = t->afree;
2996 t->afree = p;
2997 t->atids_in_use--;
2998 spin_unlock_bh(&t->atid_lock);
2999}
3000EXPORT_SYMBOL(cxgb4_free_atid);
3001
3002/*
3003 * Allocate a server TID and set it to the supplied value.
3004 */
3005int cxgb4_alloc_stid(struct tid_info *t, int family, void *data)
3006{
3007 int stid;
3008
3009 spin_lock_bh(&t->stid_lock);
3010 if (family == PF_INET) {
3011 stid = find_first_zero_bit(t->stid_bmap, t->nstids);
3012 if (stid < t->nstids)
3013 __set_bit(stid, t->stid_bmap);
3014 else
3015 stid = -1;
3016 } else {
3017 stid = bitmap_find_free_region(t->stid_bmap, t->nstids, 2);
3018 if (stid < 0)
3019 stid = -1;
3020 }
3021 if (stid >= 0) {
3022 t->stid_tab[stid].data = data;
3023 stid += t->stid_base;
3024 t->stids_in_use++;
3025 }
3026 spin_unlock_bh(&t->stid_lock);
3027 return stid;
3028}
3029EXPORT_SYMBOL(cxgb4_alloc_stid);
3030
dca4faeb
VP
3031/* Allocate a server filter TID and set it to the supplied value.
3032 */
3033int cxgb4_alloc_sftid(struct tid_info *t, int family, void *data)
3034{
3035 int stid;
3036
3037 spin_lock_bh(&t->stid_lock);
3038 if (family == PF_INET) {
3039 stid = find_next_zero_bit(t->stid_bmap,
3040 t->nstids + t->nsftids, t->nstids);
3041 if (stid < (t->nstids + t->nsftids))
3042 __set_bit(stid, t->stid_bmap);
3043 else
3044 stid = -1;
3045 } else {
3046 stid = -1;
3047 }
3048 if (stid >= 0) {
3049 t->stid_tab[stid].data = data;
3050 stid += t->stid_base;
3051 t->stids_in_use++;
3052 }
3053 spin_unlock_bh(&t->stid_lock);
3054 return stid;
3055}
3056EXPORT_SYMBOL(cxgb4_alloc_sftid);
3057
3058/* Release a server TID.
b8ff05a9
DM
3059 */
3060void cxgb4_free_stid(struct tid_info *t, unsigned int stid, int family)
3061{
3062 stid -= t->stid_base;
3063 spin_lock_bh(&t->stid_lock);
3064 if (family == PF_INET)
3065 __clear_bit(stid, t->stid_bmap);
3066 else
3067 bitmap_release_region(t->stid_bmap, stid, 2);
3068 t->stid_tab[stid].data = NULL;
3069 t->stids_in_use--;
3070 spin_unlock_bh(&t->stid_lock);
3071}
3072EXPORT_SYMBOL(cxgb4_free_stid);
3073
3074/*
3075 * Populate a TID_RELEASE WR. Caller must properly size the skb.
3076 */
3077static void mk_tid_release(struct sk_buff *skb, unsigned int chan,
3078 unsigned int tid)
3079{
3080 struct cpl_tid_release *req;
3081
3082 set_wr_txq(skb, CPL_PRIORITY_SETUP, chan);
3083 req = (struct cpl_tid_release *)__skb_put(skb, sizeof(*req));
3084 INIT_TP_WR(req, tid);
3085 OPCODE_TID(req) = htonl(MK_OPCODE_TID(CPL_TID_RELEASE, tid));
3086}
3087
3088/*
3089 * Queue a TID release request and if necessary schedule a work queue to
3090 * process it.
3091 */
31b9c19b 3092static void cxgb4_queue_tid_release(struct tid_info *t, unsigned int chan,
3093 unsigned int tid)
b8ff05a9
DM
3094{
3095 void **p = &t->tid_tab[tid];
3096 struct adapter *adap = container_of(t, struct adapter, tids);
3097
3098 spin_lock_bh(&adap->tid_release_lock);
3099 *p = adap->tid_release_head;
3100 /* Low 2 bits encode the Tx channel number */
3101 adap->tid_release_head = (void **)((uintptr_t)p | chan);
3102 if (!adap->tid_release_task_busy) {
3103 adap->tid_release_task_busy = true;
3069ee9b 3104 queue_work(workq, &adap->tid_release_task);
b8ff05a9
DM
3105 }
3106 spin_unlock_bh(&adap->tid_release_lock);
3107}
b8ff05a9
DM
3108
3109/*
3110 * Process the list of pending TID release requests.
3111 */
3112static void process_tid_release_list(struct work_struct *work)
3113{
3114 struct sk_buff *skb;
3115 struct adapter *adap;
3116
3117 adap = container_of(work, struct adapter, tid_release_task);
3118
3119 spin_lock_bh(&adap->tid_release_lock);
3120 while (adap->tid_release_head) {
3121 void **p = adap->tid_release_head;
3122 unsigned int chan = (uintptr_t)p & 3;
3123 p = (void *)p - chan;
3124
3125 adap->tid_release_head = *p;
3126 *p = NULL;
3127 spin_unlock_bh(&adap->tid_release_lock);
3128
3129 while (!(skb = alloc_skb(sizeof(struct cpl_tid_release),
3130 GFP_KERNEL)))
3131 schedule_timeout_uninterruptible(1);
3132
3133 mk_tid_release(skb, chan, p - adap->tids.tid_tab);
3134 t4_ofld_send(adap, skb);
3135 spin_lock_bh(&adap->tid_release_lock);
3136 }
3137 adap->tid_release_task_busy = false;
3138 spin_unlock_bh(&adap->tid_release_lock);
3139}
3140
3141/*
3142 * Release a TID and inform HW. If we are unable to allocate the release
3143 * message we defer to a work queue.
3144 */
3145void cxgb4_remove_tid(struct tid_info *t, unsigned int chan, unsigned int tid)
3146{
3147 void *old;
3148 struct sk_buff *skb;
3149 struct adapter *adap = container_of(t, struct adapter, tids);
3150
3151 old = t->tid_tab[tid];
3152 skb = alloc_skb(sizeof(struct cpl_tid_release), GFP_ATOMIC);
3153 if (likely(skb)) {
3154 t->tid_tab[tid] = NULL;
3155 mk_tid_release(skb, chan, tid);
3156 t4_ofld_send(adap, skb);
3157 } else
3158 cxgb4_queue_tid_release(t, chan, tid);
3159 if (old)
3160 atomic_dec(&t->tids_in_use);
3161}
3162EXPORT_SYMBOL(cxgb4_remove_tid);
3163
3164/*
3165 * Allocate and initialize the TID tables. Returns 0 on success.
3166 */
3167static int tid_init(struct tid_info *t)
3168{
3169 size_t size;
f2b7e78d 3170 unsigned int stid_bmap_size;
b8ff05a9
DM
3171 unsigned int natids = t->natids;
3172
dca4faeb 3173 stid_bmap_size = BITS_TO_LONGS(t->nstids + t->nsftids);
f2b7e78d
VP
3174 size = t->ntids * sizeof(*t->tid_tab) +
3175 natids * sizeof(*t->atid_tab) +
b8ff05a9 3176 t->nstids * sizeof(*t->stid_tab) +
dca4faeb 3177 t->nsftids * sizeof(*t->stid_tab) +
f2b7e78d 3178 stid_bmap_size * sizeof(long) +
dca4faeb
VP
3179 t->nftids * sizeof(*t->ftid_tab) +
3180 t->nsftids * sizeof(*t->ftid_tab);
f2b7e78d 3181
b8ff05a9
DM
3182 t->tid_tab = t4_alloc_mem(size);
3183 if (!t->tid_tab)
3184 return -ENOMEM;
3185
3186 t->atid_tab = (union aopen_entry *)&t->tid_tab[t->ntids];
3187 t->stid_tab = (struct serv_entry *)&t->atid_tab[natids];
dca4faeb 3188 t->stid_bmap = (unsigned long *)&t->stid_tab[t->nstids + t->nsftids];
f2b7e78d 3189 t->ftid_tab = (struct filter_entry *)&t->stid_bmap[stid_bmap_size];
b8ff05a9
DM
3190 spin_lock_init(&t->stid_lock);
3191 spin_lock_init(&t->atid_lock);
3192
3193 t->stids_in_use = 0;
3194 t->afree = NULL;
3195 t->atids_in_use = 0;
3196 atomic_set(&t->tids_in_use, 0);
3197
3198 /* Setup the free list for atid_tab and clear the stid bitmap. */
3199 if (natids) {
3200 while (--natids)
3201 t->atid_tab[natids - 1].next = &t->atid_tab[natids];
3202 t->afree = t->atid_tab;
3203 }
dca4faeb 3204 bitmap_zero(t->stid_bmap, t->nstids + t->nsftids);
b8ff05a9
DM
3205 return 0;
3206}
3207
3208/**
3209 * cxgb4_create_server - create an IP server
3210 * @dev: the device
3211 * @stid: the server TID
3212 * @sip: local IP address to bind server to
3213 * @sport: the server's TCP port
3214 * @queue: queue to direct messages from this server to
3215 *
3216 * Create an IP server for the given port and address.
3217 * Returns <0 on error and one of the %NET_XMIT_* values on success.
3218 */
3219int cxgb4_create_server(const struct net_device *dev, unsigned int stid,
793dad94
VP
3220 __be32 sip, __be16 sport, __be16 vlan,
3221 unsigned int queue)
b8ff05a9
DM
3222{
3223 unsigned int chan;
3224 struct sk_buff *skb;
3225 struct adapter *adap;
3226 struct cpl_pass_open_req *req;
3227
3228 skb = alloc_skb(sizeof(*req), GFP_KERNEL);
3229 if (!skb)
3230 return -ENOMEM;
3231
3232 adap = netdev2adap(dev);
3233 req = (struct cpl_pass_open_req *)__skb_put(skb, sizeof(*req));
3234 INIT_TP_WR(req, 0);
3235 OPCODE_TID(req) = htonl(MK_OPCODE_TID(CPL_PASS_OPEN_REQ, stid));
3236 req->local_port = sport;
3237 req->peer_port = htons(0);
3238 req->local_ip = sip;
3239 req->peer_ip = htonl(0);
e46dab4d 3240 chan = rxq_to_chan(&adap->sge, queue);
b8ff05a9
DM
3241 req->opt0 = cpu_to_be64(TX_CHAN(chan));
3242 req->opt1 = cpu_to_be64(CONN_POLICY_ASK |
3243 SYN_RSS_ENABLE | SYN_RSS_QUEUE(queue));
3244 return t4_mgmt_tx(adap, skb);
3245}
3246EXPORT_SYMBOL(cxgb4_create_server);
3247
b8ff05a9
DM
3248/**
3249 * cxgb4_best_mtu - find the entry in the MTU table closest to an MTU
3250 * @mtus: the HW MTU table
3251 * @mtu: the target MTU
3252 * @idx: index of selected entry in the MTU table
3253 *
3254 * Returns the index and the value in the HW MTU table that is closest to
3255 * but does not exceed @mtu, unless @mtu is smaller than any value in the
3256 * table, in which case that smallest available value is selected.
3257 */
3258unsigned int cxgb4_best_mtu(const unsigned short *mtus, unsigned short mtu,
3259 unsigned int *idx)
3260{
3261 unsigned int i = 0;
3262
3263 while (i < NMTUS - 1 && mtus[i + 1] <= mtu)
3264 ++i;
3265 if (idx)
3266 *idx = i;
3267 return mtus[i];
3268}
3269EXPORT_SYMBOL(cxgb4_best_mtu);
3270
3271/**
3272 * cxgb4_port_chan - get the HW channel of a port
3273 * @dev: the net device for the port
3274 *
3275 * Return the HW Tx channel of the given port.
3276 */
3277unsigned int cxgb4_port_chan(const struct net_device *dev)
3278{
3279 return netdev2pinfo(dev)->tx_chan;
3280}
3281EXPORT_SYMBOL(cxgb4_port_chan);
3282
881806bc
VP
3283unsigned int cxgb4_dbfifo_count(const struct net_device *dev, int lpfifo)
3284{
3285 struct adapter *adap = netdev2adap(dev);
2cc301d2 3286 u32 v1, v2, lp_count, hp_count;
881806bc 3287
2cc301d2
SR
3288 v1 = t4_read_reg(adap, A_SGE_DBFIFO_STATUS);
3289 v2 = t4_read_reg(adap, SGE_DBFIFO_STATUS2);
3290 if (is_t4(adap->chip)) {
3291 lp_count = G_LP_COUNT(v1);
3292 hp_count = G_HP_COUNT(v1);
3293 } else {
3294 lp_count = G_LP_COUNT_T5(v1);
3295 hp_count = G_HP_COUNT_T5(v2);
3296 }
3297 return lpfifo ? lp_count : hp_count;
881806bc
VP
3298}
3299EXPORT_SYMBOL(cxgb4_dbfifo_count);
3300
b8ff05a9
DM
3301/**
3302 * cxgb4_port_viid - get the VI id of a port
3303 * @dev: the net device for the port
3304 *
3305 * Return the VI id of the given port.
3306 */
3307unsigned int cxgb4_port_viid(const struct net_device *dev)
3308{
3309 return netdev2pinfo(dev)->viid;
3310}
3311EXPORT_SYMBOL(cxgb4_port_viid);
3312
3313/**
3314 * cxgb4_port_idx - get the index of a port
3315 * @dev: the net device for the port
3316 *
3317 * Return the index of the given port.
3318 */
3319unsigned int cxgb4_port_idx(const struct net_device *dev)
3320{
3321 return netdev2pinfo(dev)->port_id;
3322}
3323EXPORT_SYMBOL(cxgb4_port_idx);
3324
b8ff05a9
DM
3325void cxgb4_get_tcp_stats(struct pci_dev *pdev, struct tp_tcp_stats *v4,
3326 struct tp_tcp_stats *v6)
3327{
3328 struct adapter *adap = pci_get_drvdata(pdev);
3329
3330 spin_lock(&adap->stats_lock);
3331 t4_tp_get_tcp_stats(adap, v4, v6);
3332 spin_unlock(&adap->stats_lock);
3333}
3334EXPORT_SYMBOL(cxgb4_get_tcp_stats);
3335
3336void cxgb4_iscsi_init(struct net_device *dev, unsigned int tag_mask,
3337 const unsigned int *pgsz_order)
3338{
3339 struct adapter *adap = netdev2adap(dev);
3340
3341 t4_write_reg(adap, ULP_RX_ISCSI_TAGMASK, tag_mask);
3342 t4_write_reg(adap, ULP_RX_ISCSI_PSZ, HPZ0(pgsz_order[0]) |
3343 HPZ1(pgsz_order[1]) | HPZ2(pgsz_order[2]) |
3344 HPZ3(pgsz_order[3]));
3345}
3346EXPORT_SYMBOL(cxgb4_iscsi_init);
3347
3069ee9b
VP
3348int cxgb4_flush_eq_cache(struct net_device *dev)
3349{
3350 struct adapter *adap = netdev2adap(dev);
3351 int ret;
3352
3353 ret = t4_fwaddrspace_write(adap, adap->mbox,
3354 0xe1000000 + A_SGE_CTXT_CMD, 0x20000000);
3355 return ret;
3356}
3357EXPORT_SYMBOL(cxgb4_flush_eq_cache);
3358
3359static int read_eq_indices(struct adapter *adap, u16 qid, u16 *pidx, u16 *cidx)
3360{
3361 u32 addr = t4_read_reg(adap, A_SGE_DBQ_CTXT_BADDR) + 24 * qid + 8;
3362 __be64 indices;
3363 int ret;
3364
3365 ret = t4_mem_win_read_len(adap, addr, (__be32 *)&indices, 8);
3366 if (!ret) {
404d9e3f
VP
3367 *cidx = (be64_to_cpu(indices) >> 25) & 0xffff;
3368 *pidx = (be64_to_cpu(indices) >> 9) & 0xffff;
3069ee9b
VP
3369 }
3370 return ret;
3371}
3372
3373int cxgb4_sync_txq_pidx(struct net_device *dev, u16 qid, u16 pidx,
3374 u16 size)
3375{
3376 struct adapter *adap = netdev2adap(dev);
3377 u16 hw_pidx, hw_cidx;
3378 int ret;
3379
3380 ret = read_eq_indices(adap, qid, &hw_pidx, &hw_cidx);
3381 if (ret)
3382 goto out;
3383
3384 if (pidx != hw_pidx) {
3385 u16 delta;
3386
3387 if (pidx >= hw_pidx)
3388 delta = pidx - hw_pidx;
3389 else
3390 delta = size - hw_pidx + pidx;
3391 wmb();
840f3000
VP
3392 t4_write_reg(adap, MYPF_REG(SGE_PF_KDOORBELL),
3393 QID(qid) | PIDX(delta));
3069ee9b
VP
3394 }
3395out:
3396 return ret;
3397}
3398EXPORT_SYMBOL(cxgb4_sync_txq_pidx);
3399
3cbdb928
VP
3400void cxgb4_disable_db_coalescing(struct net_device *dev)
3401{
3402 struct adapter *adap;
3403
3404 adap = netdev2adap(dev);
3405 t4_set_reg_field(adap, A_SGE_DOORBELL_CONTROL, F_NOCOALESCE,
3406 F_NOCOALESCE);
3407}
3408EXPORT_SYMBOL(cxgb4_disable_db_coalescing);
3409
3410void cxgb4_enable_db_coalescing(struct net_device *dev)
3411{
3412 struct adapter *adap;
3413
3414 adap = netdev2adap(dev);
3415 t4_set_reg_field(adap, A_SGE_DOORBELL_CONTROL, F_NOCOALESCE, 0);
3416}
3417EXPORT_SYMBOL(cxgb4_enable_db_coalescing);
3418
b8ff05a9
DM
3419static struct pci_driver cxgb4_driver;
3420
3421static void check_neigh_update(struct neighbour *neigh)
3422{
3423 const struct device *parent;
3424 const struct net_device *netdev = neigh->dev;
3425
3426 if (netdev->priv_flags & IFF_802_1Q_VLAN)
3427 netdev = vlan_dev_real_dev(netdev);
3428 parent = netdev->dev.parent;
3429 if (parent && parent->driver == &cxgb4_driver.driver)
3430 t4_l2t_update(dev_get_drvdata(parent), neigh);
3431}
3432
3433static int netevent_cb(struct notifier_block *nb, unsigned long event,
3434 void *data)
3435{
3436 switch (event) {
3437 case NETEVENT_NEIGH_UPDATE:
3438 check_neigh_update(data);
3439 break;
b8ff05a9
DM
3440 case NETEVENT_REDIRECT:
3441 default:
3442 break;
3443 }
3444 return 0;
3445}
3446
3447static bool netevent_registered;
3448static struct notifier_block cxgb4_netevent_nb = {
3449 .notifier_call = netevent_cb
3450};
3451
3069ee9b
VP
3452static void drain_db_fifo(struct adapter *adap, int usecs)
3453{
2cc301d2 3454 u32 v1, v2, lp_count, hp_count;
3069ee9b
VP
3455
3456 do {
2cc301d2
SR
3457 v1 = t4_read_reg(adap, A_SGE_DBFIFO_STATUS);
3458 v2 = t4_read_reg(adap, SGE_DBFIFO_STATUS2);
3459 if (is_t4(adap->chip)) {
3460 lp_count = G_LP_COUNT(v1);
3461 hp_count = G_HP_COUNT(v1);
3462 } else {
3463 lp_count = G_LP_COUNT_T5(v1);
3464 hp_count = G_HP_COUNT_T5(v2);
3465 }
3466
3467 if (lp_count == 0 && hp_count == 0)
3468 break;
3069ee9b
VP
3469 set_current_state(TASK_UNINTERRUPTIBLE);
3470 schedule_timeout(usecs_to_jiffies(usecs));
3069ee9b
VP
3471 } while (1);
3472}
3473
3474static void disable_txq_db(struct sge_txq *q)
3475{
3476 spin_lock_irq(&q->db_lock);
3477 q->db_disabled = 1;
3478 spin_unlock_irq(&q->db_lock);
3479}
3480
3481static void enable_txq_db(struct sge_txq *q)
3482{
3483 spin_lock_irq(&q->db_lock);
3484 q->db_disabled = 0;
3485 spin_unlock_irq(&q->db_lock);
3486}
3487
3488static void disable_dbs(struct adapter *adap)
3489{
3490 int i;
3491
3492 for_each_ethrxq(&adap->sge, i)
3493 disable_txq_db(&adap->sge.ethtxq[i].q);
3494 for_each_ofldrxq(&adap->sge, i)
3495 disable_txq_db(&adap->sge.ofldtxq[i].q);
3496 for_each_port(adap, i)
3497 disable_txq_db(&adap->sge.ctrlq[i].q);
3498}
3499
3500static void enable_dbs(struct adapter *adap)
3501{
3502 int i;
3503
3504 for_each_ethrxq(&adap->sge, i)
3505 enable_txq_db(&adap->sge.ethtxq[i].q);
3506 for_each_ofldrxq(&adap->sge, i)
3507 enable_txq_db(&adap->sge.ofldtxq[i].q);
3508 for_each_port(adap, i)
3509 enable_txq_db(&adap->sge.ctrlq[i].q);
3510}
3511
3512static void sync_txq_pidx(struct adapter *adap, struct sge_txq *q)
3513{
3514 u16 hw_pidx, hw_cidx;
3515 int ret;
3516
3517 spin_lock_bh(&q->db_lock);
3518 ret = read_eq_indices(adap, (u16)q->cntxt_id, &hw_pidx, &hw_cidx);
3519 if (ret)
3520 goto out;
3521 if (q->db_pidx != hw_pidx) {
3522 u16 delta;
3523
3524 if (q->db_pidx >= hw_pidx)
3525 delta = q->db_pidx - hw_pidx;
3526 else
3527 delta = q->size - hw_pidx + q->db_pidx;
3528 wmb();
840f3000
VP
3529 t4_write_reg(adap, MYPF_REG(SGE_PF_KDOORBELL),
3530 QID(q->cntxt_id) | PIDX(delta));
3069ee9b
VP
3531 }
3532out:
3533 q->db_disabled = 0;
3534 spin_unlock_bh(&q->db_lock);
3535 if (ret)
3536 CH_WARN(adap, "DB drop recovery failed.\n");
3537}
3538static void recover_all_queues(struct adapter *adap)
3539{
3540 int i;
3541
3542 for_each_ethrxq(&adap->sge, i)
3543 sync_txq_pidx(adap, &adap->sge.ethtxq[i].q);
3544 for_each_ofldrxq(&adap->sge, i)
3545 sync_txq_pidx(adap, &adap->sge.ofldtxq[i].q);
3546 for_each_port(adap, i)
3547 sync_txq_pidx(adap, &adap->sge.ctrlq[i].q);
3548}
3549
881806bc
VP
3550static void notify_rdma_uld(struct adapter *adap, enum cxgb4_control cmd)
3551{
3552 mutex_lock(&uld_mutex);
3553 if (adap->uld_handle[CXGB4_ULD_RDMA])
3554 ulds[CXGB4_ULD_RDMA].control(adap->uld_handle[CXGB4_ULD_RDMA],
3555 cmd);
3556 mutex_unlock(&uld_mutex);
3557}
3558
3559static void process_db_full(struct work_struct *work)
3560{
3561 struct adapter *adap;
881806bc
VP
3562
3563 adap = container_of(work, struct adapter, db_full_task);
3564
881806bc 3565 notify_rdma_uld(adap, CXGB4_CONTROL_DB_FULL);
3069ee9b 3566 drain_db_fifo(adap, dbfifo_drain_delay);
840f3000
VP
3567 t4_set_reg_field(adap, SGE_INT_ENABLE3,
3568 DBFIFO_HP_INT | DBFIFO_LP_INT,
3569 DBFIFO_HP_INT | DBFIFO_LP_INT);
881806bc 3570 notify_rdma_uld(adap, CXGB4_CONTROL_DB_EMPTY);
881806bc
VP
3571}
3572
3573static void process_db_drop(struct work_struct *work)
3574{
3575 struct adapter *adap;
881806bc 3576
3069ee9b 3577 adap = container_of(work, struct adapter, db_drop_task);
881806bc 3578
2cc301d2
SR
3579 if (is_t4(adap->chip)) {
3580 disable_dbs(adap);
3581 notify_rdma_uld(adap, CXGB4_CONTROL_DB_DROP);
3582 drain_db_fifo(adap, 1);
3583 recover_all_queues(adap);
3584 enable_dbs(adap);
3585 } else {
3586 u32 dropped_db = t4_read_reg(adap, 0x010ac);
3587 u16 qid = (dropped_db >> 15) & 0x1ffff;
3588 u16 pidx_inc = dropped_db & 0x1fff;
3589 unsigned int s_qpp;
3590 unsigned short udb_density;
3591 unsigned long qpshift;
3592 int page;
3593 u32 udb;
3594
3595 dev_warn(adap->pdev_dev,
3596 "Dropped DB 0x%x qid %d bar2 %d coalesce %d pidx %d\n",
3597 dropped_db, qid,
3598 (dropped_db >> 14) & 1,
3599 (dropped_db >> 13) & 1,
3600 pidx_inc);
3601
3602 drain_db_fifo(adap, 1);
3603
3604 s_qpp = QUEUESPERPAGEPF1 * adap->fn;
3605 udb_density = 1 << QUEUESPERPAGEPF0_GET(t4_read_reg(adap,
3606 SGE_EGRESS_QUEUES_PER_PAGE_PF) >> s_qpp);
3607 qpshift = PAGE_SHIFT - ilog2(udb_density);
3608 udb = qid << qpshift;
3609 udb &= PAGE_MASK;
3610 page = udb / PAGE_SIZE;
3611 udb += (qid - (page * udb_density)) * 128;
3612
3613 writel(PIDX(pidx_inc), adap->bar2 + udb + 8);
3614
3615 /* Re-enable BAR2 WC */
3616 t4_set_reg_field(adap, 0x10b0, 1<<15, 1<<15);
3617 }
3618
3069ee9b 3619 t4_set_reg_field(adap, A_SGE_DOORBELL_CONTROL, F_DROPPED_DB, 0);
881806bc
VP
3620}
3621
3622void t4_db_full(struct adapter *adap)
3623{
2cc301d2
SR
3624 if (is_t4(adap->chip)) {
3625 t4_set_reg_field(adap, SGE_INT_ENABLE3,
3626 DBFIFO_HP_INT | DBFIFO_LP_INT, 0);
3627 queue_work(workq, &adap->db_full_task);
3628 }
881806bc
VP
3629}
3630
3631void t4_db_dropped(struct adapter *adap)
3632{
2cc301d2
SR
3633 if (is_t4(adap->chip))
3634 queue_work(workq, &adap->db_drop_task);
881806bc
VP
3635}
3636
b8ff05a9
DM
3637static void uld_attach(struct adapter *adap, unsigned int uld)
3638{
3639 void *handle;
3640 struct cxgb4_lld_info lli;
dca4faeb 3641 unsigned short i;
b8ff05a9
DM
3642
3643 lli.pdev = adap->pdev;
3644 lli.l2t = adap->l2t;
3645 lli.tids = &adap->tids;
3646 lli.ports = adap->port;
3647 lli.vr = &adap->vres;
3648 lli.mtus = adap->params.mtus;
3649 if (uld == CXGB4_ULD_RDMA) {
3650 lli.rxq_ids = adap->sge.rdma_rxq;
3651 lli.nrxq = adap->sge.rdmaqs;
3652 } else if (uld == CXGB4_ULD_ISCSI) {
3653 lli.rxq_ids = adap->sge.ofld_rxq;
3654 lli.nrxq = adap->sge.ofldqsets;
3655 }
3656 lli.ntxq = adap->sge.ofldqsets;
3657 lli.nchan = adap->params.nports;
3658 lli.nports = adap->params.nports;
3659 lli.wr_cred = adap->params.ofldq_wr_cred;
3660 lli.adapter_type = adap->params.rev;
3661 lli.iscsi_iolen = MAXRXDATA_GET(t4_read_reg(adap, TP_PARA_REG2));
3662 lli.udb_density = 1 << QUEUESPERPAGEPF0_GET(
060e0c75
DM
3663 t4_read_reg(adap, SGE_EGRESS_QUEUES_PER_PAGE_PF) >>
3664 (adap->fn * 4));
b8ff05a9 3665 lli.ucq_density = 1 << QUEUESPERPAGEPF0_GET(
060e0c75
DM
3666 t4_read_reg(adap, SGE_INGRESS_QUEUES_PER_PAGE_PF) >>
3667 (adap->fn * 4));
793dad94 3668 lli.filt_mode = adap->filter_mode;
dca4faeb
VP
3669 /* MODQ_REQ_MAP sets queues 0-3 to chan 0-3 */
3670 for (i = 0; i < NCHAN; i++)
3671 lli.tx_modq[i] = i;
b8ff05a9
DM
3672 lli.gts_reg = adap->regs + MYPF_REG(SGE_PF_GTS);
3673 lli.db_reg = adap->regs + MYPF_REG(SGE_PF_KDOORBELL);
3674 lli.fw_vers = adap->params.fw_vers;
3069ee9b 3675 lli.dbfifo_int_thresh = dbfifo_int_thresh;
dca4faeb
VP
3676 lli.sge_pktshift = adap->sge.pktshift;
3677 lli.enable_fw_ofld_conn = adap->flags & FW_OFLD_CONN;
b8ff05a9
DM
3678
3679 handle = ulds[uld].add(&lli);
3680 if (IS_ERR(handle)) {
3681 dev_warn(adap->pdev_dev,
3682 "could not attach to the %s driver, error %ld\n",
3683 uld_str[uld], PTR_ERR(handle));
3684 return;
3685 }
3686
3687 adap->uld_handle[uld] = handle;
3688
3689 if (!netevent_registered) {
3690 register_netevent_notifier(&cxgb4_netevent_nb);
3691 netevent_registered = true;
3692 }
e29f5dbc
DM
3693
3694 if (adap->flags & FULL_INIT_DONE)
3695 ulds[uld].state_change(handle, CXGB4_STATE_UP);
b8ff05a9
DM
3696}
3697
3698static void attach_ulds(struct adapter *adap)
3699{
3700 unsigned int i;
3701
3702 mutex_lock(&uld_mutex);
3703 list_add_tail(&adap->list_node, &adapter_list);
3704 for (i = 0; i < CXGB4_ULD_MAX; i++)
3705 if (ulds[i].add)
3706 uld_attach(adap, i);
3707 mutex_unlock(&uld_mutex);
3708}
3709
3710static void detach_ulds(struct adapter *adap)
3711{
3712 unsigned int i;
3713
3714 mutex_lock(&uld_mutex);
3715 list_del(&adap->list_node);
3716 for (i = 0; i < CXGB4_ULD_MAX; i++)
3717 if (adap->uld_handle[i]) {
3718 ulds[i].state_change(adap->uld_handle[i],
3719 CXGB4_STATE_DETACH);
3720 adap->uld_handle[i] = NULL;
3721 }
3722 if (netevent_registered && list_empty(&adapter_list)) {
3723 unregister_netevent_notifier(&cxgb4_netevent_nb);
3724 netevent_registered = false;
3725 }
3726 mutex_unlock(&uld_mutex);
3727}
3728
3729static void notify_ulds(struct adapter *adap, enum cxgb4_state new_state)
3730{
3731 unsigned int i;
3732
3733 mutex_lock(&uld_mutex);
3734 for (i = 0; i < CXGB4_ULD_MAX; i++)
3735 if (adap->uld_handle[i])
3736 ulds[i].state_change(adap->uld_handle[i], new_state);
3737 mutex_unlock(&uld_mutex);
3738}
3739
3740/**
3741 * cxgb4_register_uld - register an upper-layer driver
3742 * @type: the ULD type
3743 * @p: the ULD methods
3744 *
3745 * Registers an upper-layer driver with this driver and notifies the ULD
3746 * about any presently available devices that support its type. Returns
3747 * %-EBUSY if a ULD of the same type is already registered.
3748 */
3749int cxgb4_register_uld(enum cxgb4_uld type, const struct cxgb4_uld_info *p)
3750{
3751 int ret = 0;
3752 struct adapter *adap;
3753
3754 if (type >= CXGB4_ULD_MAX)
3755 return -EINVAL;
3756 mutex_lock(&uld_mutex);
3757 if (ulds[type].add) {
3758 ret = -EBUSY;
3759 goto out;
3760 }
3761 ulds[type] = *p;
3762 list_for_each_entry(adap, &adapter_list, list_node)
3763 uld_attach(adap, type);
3764out: mutex_unlock(&uld_mutex);
3765 return ret;
3766}
3767EXPORT_SYMBOL(cxgb4_register_uld);
3768
3769/**
3770 * cxgb4_unregister_uld - unregister an upper-layer driver
3771 * @type: the ULD type
3772 *
3773 * Unregisters an existing upper-layer driver.
3774 */
3775int cxgb4_unregister_uld(enum cxgb4_uld type)
3776{
3777 struct adapter *adap;
3778
3779 if (type >= CXGB4_ULD_MAX)
3780 return -EINVAL;
3781 mutex_lock(&uld_mutex);
3782 list_for_each_entry(adap, &adapter_list, list_node)
3783 adap->uld_handle[type] = NULL;
3784 ulds[type].add = NULL;
3785 mutex_unlock(&uld_mutex);
3786 return 0;
3787}
3788EXPORT_SYMBOL(cxgb4_unregister_uld);
3789
3790/**
3791 * cxgb_up - enable the adapter
3792 * @adap: adapter being enabled
3793 *
3794 * Called when the first port is enabled, this function performs the
3795 * actions necessary to make an adapter operational, such as completing
3796 * the initialization of HW modules, and enabling interrupts.
3797 *
3798 * Must be called with the rtnl lock held.
3799 */
3800static int cxgb_up(struct adapter *adap)
3801{
aaefae9b 3802 int err;
b8ff05a9 3803
aaefae9b
DM
3804 err = setup_sge_queues(adap);
3805 if (err)
3806 goto out;
3807 err = setup_rss(adap);
3808 if (err)
3809 goto freeq;
b8ff05a9
DM
3810
3811 if (adap->flags & USING_MSIX) {
aaefae9b 3812 name_msix_vecs(adap);
b8ff05a9
DM
3813 err = request_irq(adap->msix_info[0].vec, t4_nondata_intr, 0,
3814 adap->msix_info[0].desc, adap);
3815 if (err)
3816 goto irq_err;
3817
3818 err = request_msix_queue_irqs(adap);
3819 if (err) {
3820 free_irq(adap->msix_info[0].vec, adap);
3821 goto irq_err;
3822 }
3823 } else {
3824 err = request_irq(adap->pdev->irq, t4_intr_handler(adap),
3825 (adap->flags & USING_MSI) ? 0 : IRQF_SHARED,
b1a3c2b6 3826 adap->port[0]->name, adap);
b8ff05a9
DM
3827 if (err)
3828 goto irq_err;
3829 }
3830 enable_rx(adap);
3831 t4_sge_start(adap);
3832 t4_intr_enable(adap);
aaefae9b 3833 adap->flags |= FULL_INIT_DONE;
b8ff05a9
DM
3834 notify_ulds(adap, CXGB4_STATE_UP);
3835 out:
3836 return err;
3837 irq_err:
3838 dev_err(adap->pdev_dev, "request_irq failed, err %d\n", err);
aaefae9b
DM
3839 freeq:
3840 t4_free_sge_resources(adap);
b8ff05a9
DM
3841 goto out;
3842}
3843
3844static void cxgb_down(struct adapter *adapter)
3845{
3846 t4_intr_disable(adapter);
3847 cancel_work_sync(&adapter->tid_release_task);
881806bc
VP
3848 cancel_work_sync(&adapter->db_full_task);
3849 cancel_work_sync(&adapter->db_drop_task);
b8ff05a9 3850 adapter->tid_release_task_busy = false;
204dc3c0 3851 adapter->tid_release_head = NULL;
b8ff05a9
DM
3852
3853 if (adapter->flags & USING_MSIX) {
3854 free_msix_queue_irqs(adapter);
3855 free_irq(adapter->msix_info[0].vec, adapter);
3856 } else
3857 free_irq(adapter->pdev->irq, adapter);
3858 quiesce_rx(adapter);
aaefae9b
DM
3859 t4_sge_stop(adapter);
3860 t4_free_sge_resources(adapter);
3861 adapter->flags &= ~FULL_INIT_DONE;
b8ff05a9
DM
3862}
3863
3864/*
3865 * net_device operations
3866 */
3867static int cxgb_open(struct net_device *dev)
3868{
3869 int err;
3870 struct port_info *pi = netdev_priv(dev);
3871 struct adapter *adapter = pi->adapter;
3872
6a3c869a
DM
3873 netif_carrier_off(dev);
3874
aaefae9b
DM
3875 if (!(adapter->flags & FULL_INIT_DONE)) {
3876 err = cxgb_up(adapter);
3877 if (err < 0)
3878 return err;
3879 }
b8ff05a9 3880
f68707b8
DM
3881 err = link_start(dev);
3882 if (!err)
3883 netif_tx_start_all_queues(dev);
3884 return err;
b8ff05a9
DM
3885}
3886
3887static int cxgb_close(struct net_device *dev)
3888{
b8ff05a9
DM
3889 struct port_info *pi = netdev_priv(dev);
3890 struct adapter *adapter = pi->adapter;
3891
3892 netif_tx_stop_all_queues(dev);
3893 netif_carrier_off(dev);
060e0c75 3894 return t4_enable_vi(adapter, adapter->fn, pi->viid, false, false);
b8ff05a9
DM
3895}
3896
f2b7e78d
VP
3897/* Return an error number if the indicated filter isn't writable ...
3898 */
3899static int writable_filter(struct filter_entry *f)
3900{
3901 if (f->locked)
3902 return -EPERM;
3903 if (f->pending)
3904 return -EBUSY;
3905
3906 return 0;
3907}
3908
3909/* Delete the filter at the specified index (if valid). The checks for all
3910 * the common problems with doing this like the filter being locked, currently
3911 * pending in another operation, etc.
3912 */
3913static int delete_filter(struct adapter *adapter, unsigned int fidx)
3914{
3915 struct filter_entry *f;
3916 int ret;
3917
dca4faeb 3918 if (fidx >= adapter->tids.nftids + adapter->tids.nsftids)
f2b7e78d
VP
3919 return -EINVAL;
3920
3921 f = &adapter->tids.ftid_tab[fidx];
3922 ret = writable_filter(f);
3923 if (ret)
3924 return ret;
3925 if (f->valid)
3926 return del_filter_wr(adapter, fidx);
3927
3928 return 0;
3929}
3930
dca4faeb 3931int cxgb4_create_server_filter(const struct net_device *dev, unsigned int stid,
793dad94
VP
3932 __be32 sip, __be16 sport, __be16 vlan,
3933 unsigned int queue, unsigned char port, unsigned char mask)
dca4faeb
VP
3934{
3935 int ret;
3936 struct filter_entry *f;
3937 struct adapter *adap;
3938 int i;
3939 u8 *val;
3940
3941 adap = netdev2adap(dev);
3942
1cab775c
VP
3943 /* Adjust stid to correct filter index */
3944 stid -= adap->tids.nstids;
3945 stid += adap->tids.nftids;
3946
dca4faeb
VP
3947 /* Check to make sure the filter requested is writable ...
3948 */
3949 f = &adap->tids.ftid_tab[stid];
3950 ret = writable_filter(f);
3951 if (ret)
3952 return ret;
3953
3954 /* Clear out any old resources being used by the filter before
3955 * we start constructing the new filter.
3956 */
3957 if (f->valid)
3958 clear_filter(adap, f);
3959
3960 /* Clear out filter specifications */
3961 memset(&f->fs, 0, sizeof(struct ch_filter_specification));
3962 f->fs.val.lport = cpu_to_be16(sport);
3963 f->fs.mask.lport = ~0;
3964 val = (u8 *)&sip;
793dad94 3965 if ((val[0] | val[1] | val[2] | val[3]) != 0) {
dca4faeb
VP
3966 for (i = 0; i < 4; i++) {
3967 f->fs.val.lip[i] = val[i];
3968 f->fs.mask.lip[i] = ~0;
3969 }
793dad94
VP
3970 if (adap->filter_mode & F_PORT) {
3971 f->fs.val.iport = port;
3972 f->fs.mask.iport = mask;
3973 }
3974 }
dca4faeb
VP
3975
3976 f->fs.dirsteer = 1;
3977 f->fs.iq = queue;
3978 /* Mark filter as locked */
3979 f->locked = 1;
3980 f->fs.rpttid = 1;
3981
3982 ret = set_filter_wr(adap, stid);
3983 if (ret) {
3984 clear_filter(adap, f);
3985 return ret;
3986 }
3987
3988 return 0;
3989}
3990EXPORT_SYMBOL(cxgb4_create_server_filter);
3991
3992int cxgb4_remove_server_filter(const struct net_device *dev, unsigned int stid,
3993 unsigned int queue, bool ipv6)
3994{
3995 int ret;
3996 struct filter_entry *f;
3997 struct adapter *adap;
3998
3999 adap = netdev2adap(dev);
1cab775c
VP
4000
4001 /* Adjust stid to correct filter index */
4002 stid -= adap->tids.nstids;
4003 stid += adap->tids.nftids;
4004
dca4faeb
VP
4005 f = &adap->tids.ftid_tab[stid];
4006 /* Unlock the filter */
4007 f->locked = 0;
4008
4009 ret = delete_filter(adap, stid);
4010 if (ret)
4011 return ret;
4012
4013 return 0;
4014}
4015EXPORT_SYMBOL(cxgb4_remove_server_filter);
4016
f5152c90
DM
4017static struct rtnl_link_stats64 *cxgb_get_stats(struct net_device *dev,
4018 struct rtnl_link_stats64 *ns)
b8ff05a9
DM
4019{
4020 struct port_stats stats;
4021 struct port_info *p = netdev_priv(dev);
4022 struct adapter *adapter = p->adapter;
b8ff05a9
DM
4023
4024 spin_lock(&adapter->stats_lock);
4025 t4_get_port_stats(adapter, p->tx_chan, &stats);
4026 spin_unlock(&adapter->stats_lock);
4027
4028 ns->tx_bytes = stats.tx_octets;
4029 ns->tx_packets = stats.tx_frames;
4030 ns->rx_bytes = stats.rx_octets;
4031 ns->rx_packets = stats.rx_frames;
4032 ns->multicast = stats.rx_mcast_frames;
4033
4034 /* detailed rx_errors */
4035 ns->rx_length_errors = stats.rx_jabber + stats.rx_too_long +
4036 stats.rx_runt;
4037 ns->rx_over_errors = 0;
4038 ns->rx_crc_errors = stats.rx_fcs_err;
4039 ns->rx_frame_errors = stats.rx_symbol_err;
4040 ns->rx_fifo_errors = stats.rx_ovflow0 + stats.rx_ovflow1 +
4041 stats.rx_ovflow2 + stats.rx_ovflow3 +
4042 stats.rx_trunc0 + stats.rx_trunc1 +
4043 stats.rx_trunc2 + stats.rx_trunc3;
4044 ns->rx_missed_errors = 0;
4045
4046 /* detailed tx_errors */
4047 ns->tx_aborted_errors = 0;
4048 ns->tx_carrier_errors = 0;
4049 ns->tx_fifo_errors = 0;
4050 ns->tx_heartbeat_errors = 0;
4051 ns->tx_window_errors = 0;
4052
4053 ns->tx_errors = stats.tx_error_frames;
4054 ns->rx_errors = stats.rx_symbol_err + stats.rx_fcs_err +
4055 ns->rx_length_errors + stats.rx_len_err + ns->rx_fifo_errors;
4056 return ns;
4057}
4058
4059static int cxgb_ioctl(struct net_device *dev, struct ifreq *req, int cmd)
4060{
060e0c75 4061 unsigned int mbox;
b8ff05a9
DM
4062 int ret = 0, prtad, devad;
4063 struct port_info *pi = netdev_priv(dev);
4064 struct mii_ioctl_data *data = (struct mii_ioctl_data *)&req->ifr_data;
4065
4066 switch (cmd) {
4067 case SIOCGMIIPHY:
4068 if (pi->mdio_addr < 0)
4069 return -EOPNOTSUPP;
4070 data->phy_id = pi->mdio_addr;
4071 break;
4072 case SIOCGMIIREG:
4073 case SIOCSMIIREG:
4074 if (mdio_phy_id_is_c45(data->phy_id)) {
4075 prtad = mdio_phy_id_prtad(data->phy_id);
4076 devad = mdio_phy_id_devad(data->phy_id);
4077 } else if (data->phy_id < 32) {
4078 prtad = data->phy_id;
4079 devad = 0;
4080 data->reg_num &= 0x1f;
4081 } else
4082 return -EINVAL;
4083
060e0c75 4084 mbox = pi->adapter->fn;
b8ff05a9 4085 if (cmd == SIOCGMIIREG)
060e0c75 4086 ret = t4_mdio_rd(pi->adapter, mbox, prtad, devad,
b8ff05a9
DM
4087 data->reg_num, &data->val_out);
4088 else
060e0c75 4089 ret = t4_mdio_wr(pi->adapter, mbox, prtad, devad,
b8ff05a9
DM
4090 data->reg_num, data->val_in);
4091 break;
4092 default:
4093 return -EOPNOTSUPP;
4094 }
4095 return ret;
4096}
4097
4098static void cxgb_set_rxmode(struct net_device *dev)
4099{
4100 /* unfortunately we can't return errors to the stack */
4101 set_rxmode(dev, -1, false);
4102}
4103
4104static int cxgb_change_mtu(struct net_device *dev, int new_mtu)
4105{
4106 int ret;
4107 struct port_info *pi = netdev_priv(dev);
4108
4109 if (new_mtu < 81 || new_mtu > MAX_MTU) /* accommodate SACK */
4110 return -EINVAL;
060e0c75
DM
4111 ret = t4_set_rxmode(pi->adapter, pi->adapter->fn, pi->viid, new_mtu, -1,
4112 -1, -1, -1, true);
b8ff05a9
DM
4113 if (!ret)
4114 dev->mtu = new_mtu;
4115 return ret;
4116}
4117
4118static int cxgb_set_mac_addr(struct net_device *dev, void *p)
4119{
4120 int ret;
4121 struct sockaddr *addr = p;
4122 struct port_info *pi = netdev_priv(dev);
4123
4124 if (!is_valid_ether_addr(addr->sa_data))
504f9b5a 4125 return -EADDRNOTAVAIL;
b8ff05a9 4126
060e0c75
DM
4127 ret = t4_change_mac(pi->adapter, pi->adapter->fn, pi->viid,
4128 pi->xact_addr_filt, addr->sa_data, true, true);
b8ff05a9
DM
4129 if (ret < 0)
4130 return ret;
4131
4132 memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
4133 pi->xact_addr_filt = ret;
4134 return 0;
4135}
4136
b8ff05a9
DM
4137#ifdef CONFIG_NET_POLL_CONTROLLER
4138static void cxgb_netpoll(struct net_device *dev)
4139{
4140 struct port_info *pi = netdev_priv(dev);
4141 struct adapter *adap = pi->adapter;
4142
4143 if (adap->flags & USING_MSIX) {
4144 int i;
4145 struct sge_eth_rxq *rx = &adap->sge.ethrxq[pi->first_qset];
4146
4147 for (i = pi->nqsets; i; i--, rx++)
4148 t4_sge_intr_msix(0, &rx->rspq);
4149 } else
4150 t4_intr_handler(adap)(0, adap);
4151}
4152#endif
4153
4154static const struct net_device_ops cxgb4_netdev_ops = {
4155 .ndo_open = cxgb_open,
4156 .ndo_stop = cxgb_close,
4157 .ndo_start_xmit = t4_eth_xmit,
9be793bf 4158 .ndo_get_stats64 = cxgb_get_stats,
b8ff05a9
DM
4159 .ndo_set_rx_mode = cxgb_set_rxmode,
4160 .ndo_set_mac_address = cxgb_set_mac_addr,
2ed28baa 4161 .ndo_set_features = cxgb_set_features,
b8ff05a9
DM
4162 .ndo_validate_addr = eth_validate_addr,
4163 .ndo_do_ioctl = cxgb_ioctl,
4164 .ndo_change_mtu = cxgb_change_mtu,
b8ff05a9
DM
4165#ifdef CONFIG_NET_POLL_CONTROLLER
4166 .ndo_poll_controller = cxgb_netpoll,
4167#endif
4168};
4169
4170void t4_fatal_err(struct adapter *adap)
4171{
4172 t4_set_reg_field(adap, SGE_CONTROL, GLOBALENABLE, 0);
4173 t4_intr_disable(adap);
4174 dev_alert(adap->pdev_dev, "encountered fatal error, adapter stopped\n");
4175}
4176
4177static void setup_memwin(struct adapter *adap)
4178{
19dd37ba 4179 u32 bar0, mem_win0_base, mem_win1_base, mem_win2_base;
b8ff05a9
DM
4180
4181 bar0 = pci_resource_start(adap->pdev, 0); /* truncation intentional */
19dd37ba
SR
4182 if (is_t4(adap->chip)) {
4183 mem_win0_base = bar0 + MEMWIN0_BASE;
4184 mem_win1_base = bar0 + MEMWIN1_BASE;
4185 mem_win2_base = bar0 + MEMWIN2_BASE;
4186 } else {
4187 /* For T5, only relative offset inside the PCIe BAR is passed */
4188 mem_win0_base = MEMWIN0_BASE;
4189 mem_win1_base = MEMWIN1_BASE_T5;
4190 mem_win2_base = MEMWIN2_BASE_T5;
4191 }
b8ff05a9 4192 t4_write_reg(adap, PCIE_MEM_ACCESS_REG(PCIE_MEM_ACCESS_BASE_WIN, 0),
19dd37ba 4193 mem_win0_base | BIR(0) |
b8ff05a9
DM
4194 WINDOW(ilog2(MEMWIN0_APERTURE) - 10));
4195 t4_write_reg(adap, PCIE_MEM_ACCESS_REG(PCIE_MEM_ACCESS_BASE_WIN, 1),
19dd37ba 4196 mem_win1_base | BIR(0) |
b8ff05a9
DM
4197 WINDOW(ilog2(MEMWIN1_APERTURE) - 10));
4198 t4_write_reg(adap, PCIE_MEM_ACCESS_REG(PCIE_MEM_ACCESS_BASE_WIN, 2),
19dd37ba 4199 mem_win2_base | BIR(0) |
b8ff05a9 4200 WINDOW(ilog2(MEMWIN2_APERTURE) - 10));
636f9d37
VP
4201}
4202
4203static void setup_memwin_rdma(struct adapter *adap)
4204{
1ae970e0
DM
4205 if (adap->vres.ocq.size) {
4206 unsigned int start, sz_kb;
4207
4208 start = pci_resource_start(adap->pdev, 2) +
4209 OCQ_WIN_OFFSET(adap->pdev, &adap->vres);
4210 sz_kb = roundup_pow_of_two(adap->vres.ocq.size) >> 10;
4211 t4_write_reg(adap,
4212 PCIE_MEM_ACCESS_REG(PCIE_MEM_ACCESS_BASE_WIN, 3),
4213 start | BIR(1) | WINDOW(ilog2(sz_kb)));
4214 t4_write_reg(adap,
4215 PCIE_MEM_ACCESS_REG(PCIE_MEM_ACCESS_OFFSET, 3),
4216 adap->vres.ocq.start);
4217 t4_read_reg(adap,
4218 PCIE_MEM_ACCESS_REG(PCIE_MEM_ACCESS_OFFSET, 3));
4219 }
b8ff05a9
DM
4220}
4221
02b5fb8e
DM
4222static int adap_init1(struct adapter *adap, struct fw_caps_config_cmd *c)
4223{
4224 u32 v;
4225 int ret;
4226
4227 /* get device capabilities */
4228 memset(c, 0, sizeof(*c));
4229 c->op_to_write = htonl(FW_CMD_OP(FW_CAPS_CONFIG_CMD) |
4230 FW_CMD_REQUEST | FW_CMD_READ);
ce91a923 4231 c->cfvalid_to_len16 = htonl(FW_LEN16(*c));
060e0c75 4232 ret = t4_wr_mbox(adap, adap->fn, c, sizeof(*c), c);
02b5fb8e
DM
4233 if (ret < 0)
4234 return ret;
4235
4236 /* select capabilities we'll be using */
4237 if (c->niccaps & htons(FW_CAPS_CONFIG_NIC_VM)) {
4238 if (!vf_acls)
4239 c->niccaps ^= htons(FW_CAPS_CONFIG_NIC_VM);
4240 else
4241 c->niccaps = htons(FW_CAPS_CONFIG_NIC_VM);
4242 } else if (vf_acls) {
4243 dev_err(adap->pdev_dev, "virtualization ACLs not supported");
4244 return ret;
4245 }
4246 c->op_to_write = htonl(FW_CMD_OP(FW_CAPS_CONFIG_CMD) |
4247 FW_CMD_REQUEST | FW_CMD_WRITE);
060e0c75 4248 ret = t4_wr_mbox(adap, adap->fn, c, sizeof(*c), NULL);
02b5fb8e
DM
4249 if (ret < 0)
4250 return ret;
4251
060e0c75 4252 ret = t4_config_glbl_rss(adap, adap->fn,
02b5fb8e
DM
4253 FW_RSS_GLB_CONFIG_CMD_MODE_BASICVIRTUAL,
4254 FW_RSS_GLB_CONFIG_CMD_TNLMAPEN |
4255 FW_RSS_GLB_CONFIG_CMD_TNLALLLKP);
4256 if (ret < 0)
4257 return ret;
4258
060e0c75
DM
4259 ret = t4_cfg_pfvf(adap, adap->fn, adap->fn, 0, MAX_EGRQ, 64, MAX_INGQ,
4260 0, 0, 4, 0xf, 0xf, 16, FW_CMD_CAP_PF, FW_CMD_CAP_PF);
02b5fb8e
DM
4261 if (ret < 0)
4262 return ret;
4263
4264 t4_sge_init(adap);
4265
02b5fb8e
DM
4266 /* tweak some settings */
4267 t4_write_reg(adap, TP_SHIFT_CNT, 0x64f8849);
4268 t4_write_reg(adap, ULP_RX_TDDP_PSZ, HPZ0(PAGE_SHIFT - 12));
4269 t4_write_reg(adap, TP_PIO_ADDR, TP_INGRESS_CONFIG);
4270 v = t4_read_reg(adap, TP_PIO_DATA);
4271 t4_write_reg(adap, TP_PIO_DATA, v & ~CSUM_HAS_PSEUDO_HDR);
060e0c75 4272
dca4faeb
VP
4273 /* first 4 Tx modulation queues point to consecutive Tx channels */
4274 adap->params.tp.tx_modq_map = 0xE4;
4275 t4_write_reg(adap, A_TP_TX_MOD_QUEUE_REQ_MAP,
4276 V_TX_MOD_QUEUE_REQ_MAP(adap->params.tp.tx_modq_map));
4277
4278 /* associate each Tx modulation queue with consecutive Tx channels */
4279 v = 0x84218421;
4280 t4_write_indirect(adap, TP_PIO_ADDR, TP_PIO_DATA,
4281 &v, 1, A_TP_TX_SCHED_HDR);
4282 t4_write_indirect(adap, TP_PIO_ADDR, TP_PIO_DATA,
4283 &v, 1, A_TP_TX_SCHED_FIFO);
4284 t4_write_indirect(adap, TP_PIO_ADDR, TP_PIO_DATA,
4285 &v, 1, A_TP_TX_SCHED_PCMD);
4286
4287#define T4_TX_MODQ_10G_WEIGHT_DEFAULT 16 /* in KB units */
4288 if (is_offload(adap)) {
4289 t4_write_reg(adap, A_TP_TX_MOD_QUEUE_WEIGHT0,
4290 V_TX_MODQ_WEIGHT0(T4_TX_MODQ_10G_WEIGHT_DEFAULT) |
4291 V_TX_MODQ_WEIGHT1(T4_TX_MODQ_10G_WEIGHT_DEFAULT) |
4292 V_TX_MODQ_WEIGHT2(T4_TX_MODQ_10G_WEIGHT_DEFAULT) |
4293 V_TX_MODQ_WEIGHT3(T4_TX_MODQ_10G_WEIGHT_DEFAULT));
4294 t4_write_reg(adap, A_TP_TX_MOD_CHANNEL_WEIGHT,
4295 V_TX_MODQ_WEIGHT0(T4_TX_MODQ_10G_WEIGHT_DEFAULT) |
4296 V_TX_MODQ_WEIGHT1(T4_TX_MODQ_10G_WEIGHT_DEFAULT) |
4297 V_TX_MODQ_WEIGHT2(T4_TX_MODQ_10G_WEIGHT_DEFAULT) |
4298 V_TX_MODQ_WEIGHT3(T4_TX_MODQ_10G_WEIGHT_DEFAULT));
4299 }
4300
060e0c75
DM
4301 /* get basic stuff going */
4302 return t4_early_init(adap, adap->fn);
02b5fb8e
DM
4303}
4304
b8ff05a9
DM
4305/*
4306 * Max # of ATIDs. The absolute HW max is 16K but we keep it lower.
4307 */
4308#define MAX_ATIDS 8192U
4309
636f9d37
VP
4310/*
4311 * Phase 0 of initialization: contact FW, obtain config, perform basic init.
4312 *
4313 * If the firmware we're dealing with has Configuration File support, then
4314 * we use that to perform all configuration
4315 */
4316
4317/*
4318 * Tweak configuration based on module parameters, etc. Most of these have
4319 * defaults assigned to them by Firmware Configuration Files (if we're using
4320 * them) but need to be explicitly set if we're using hard-coded
4321 * initialization. But even in the case of using Firmware Configuration
4322 * Files, we'd like to expose the ability to change these via module
4323 * parameters so these are essentially common tweaks/settings for
4324 * Configuration Files and hard-coded initialization ...
4325 */
4326static int adap_init0_tweaks(struct adapter *adapter)
4327{
4328 /*
4329 * Fix up various Host-Dependent Parameters like Page Size, Cache
4330 * Line Size, etc. The firmware default is for a 4KB Page Size and
4331 * 64B Cache Line Size ...
4332 */
4333 t4_fixup_host_params(adapter, PAGE_SIZE, L1_CACHE_BYTES);
4334
4335 /*
4336 * Process module parameters which affect early initialization.
4337 */
4338 if (rx_dma_offset != 2 && rx_dma_offset != 0) {
4339 dev_err(&adapter->pdev->dev,
4340 "Ignoring illegal rx_dma_offset=%d, using 2\n",
4341 rx_dma_offset);
4342 rx_dma_offset = 2;
4343 }
4344 t4_set_reg_field(adapter, SGE_CONTROL,
4345 PKTSHIFT_MASK,
4346 PKTSHIFT(rx_dma_offset));
4347
4348 /*
4349 * Don't include the "IP Pseudo Header" in CPL_RX_PKT checksums: Linux
4350 * adds the pseudo header itself.
4351 */
4352 t4_tp_wr_bits_indirect(adapter, TP_INGRESS_CONFIG,
4353 CSUM_HAS_PSEUDO_HDR, 0);
4354
4355 return 0;
4356}
4357
4358/*
4359 * Attempt to initialize the adapter via a Firmware Configuration File.
4360 */
4361static int adap_init0_config(struct adapter *adapter, int reset)
4362{
4363 struct fw_caps_config_cmd caps_cmd;
4364 const struct firmware *cf;
4365 unsigned long mtype = 0, maddr = 0;
4366 u32 finiver, finicsum, cfcsum;
4367 int ret, using_flash;
0a57a536 4368 char *fw_config_file, fw_config_file_path[256];
636f9d37
VP
4369
4370 /*
4371 * Reset device if necessary.
4372 */
4373 if (reset) {
4374 ret = t4_fw_reset(adapter, adapter->mbox,
4375 PIORSTMODE | PIORST);
4376 if (ret < 0)
4377 goto bye;
4378 }
4379
4380 /*
4381 * If we have a T4 configuration file under /lib/firmware/cxgb4/,
4382 * then use that. Otherwise, use the configuration file stored
4383 * in the adapter flash ...
4384 */
0a57a536
SR
4385 switch (CHELSIO_CHIP_VERSION(adapter->chip)) {
4386 case CHELSIO_T4:
4387 fw_config_file = FW_CFNAME;
4388 break;
4389 case CHELSIO_T5:
4390 fw_config_file = FW5_CFNAME;
4391 break;
4392 default:
4393 dev_err(adapter->pdev_dev, "Device %d is not supported\n",
4394 adapter->pdev->device);
4395 ret = -EINVAL;
4396 goto bye;
4397 }
4398
4399 ret = request_firmware(&cf, fw_config_file, adapter->pdev_dev);
636f9d37
VP
4400 if (ret < 0) {
4401 using_flash = 1;
4402 mtype = FW_MEMTYPE_CF_FLASH;
4403 maddr = t4_flash_cfg_addr(adapter);
4404 } else {
4405 u32 params[7], val[7];
4406
4407 using_flash = 0;
4408 if (cf->size >= FLASH_CFG_MAX_SIZE)
4409 ret = -ENOMEM;
4410 else {
4411 params[0] = (FW_PARAMS_MNEM(FW_PARAMS_MNEM_DEV) |
4412 FW_PARAMS_PARAM_X(FW_PARAMS_PARAM_DEV_CF));
4413 ret = t4_query_params(adapter, adapter->mbox,
4414 adapter->fn, 0, 1, params, val);
4415 if (ret == 0) {
4416 /*
4417 * For t4_memory_write() below addresses and
4418 * sizes have to be in terms of multiples of 4
4419 * bytes. So, if the Configuration File isn't
4420 * a multiple of 4 bytes in length we'll have
4421 * to write that out separately since we can't
4422 * guarantee that the bytes following the
4423 * residual byte in the buffer returned by
4424 * request_firmware() are zeroed out ...
4425 */
4426 size_t resid = cf->size & 0x3;
4427 size_t size = cf->size & ~0x3;
4428 __be32 *data = (__be32 *)cf->data;
4429
4430 mtype = FW_PARAMS_PARAM_Y_GET(val[0]);
4431 maddr = FW_PARAMS_PARAM_Z_GET(val[0]) << 16;
4432
4433 ret = t4_memory_write(adapter, mtype, maddr,
4434 size, data);
4435 if (ret == 0 && resid != 0) {
4436 union {
4437 __be32 word;
4438 char buf[4];
4439 } last;
4440 int i;
4441
4442 last.word = data[size >> 2];
4443 for (i = resid; i < 4; i++)
4444 last.buf[i] = 0;
4445 ret = t4_memory_write(adapter, mtype,
4446 maddr + size,
4447 4, &last.word);
4448 }
4449 }
4450 }
4451
4452 release_firmware(cf);
4453 if (ret)
4454 goto bye;
4455 }
4456
4457 /*
4458 * Issue a Capability Configuration command to the firmware to get it
4459 * to parse the Configuration File. We don't use t4_fw_config_file()
4460 * because we want the ability to modify various features after we've
4461 * processed the configuration file ...
4462 */
4463 memset(&caps_cmd, 0, sizeof(caps_cmd));
4464 caps_cmd.op_to_write =
4465 htonl(FW_CMD_OP(FW_CAPS_CONFIG_CMD) |
4466 FW_CMD_REQUEST |
4467 FW_CMD_READ);
ce91a923 4468 caps_cmd.cfvalid_to_len16 =
636f9d37
VP
4469 htonl(FW_CAPS_CONFIG_CMD_CFVALID |
4470 FW_CAPS_CONFIG_CMD_MEMTYPE_CF(mtype) |
4471 FW_CAPS_CONFIG_CMD_MEMADDR64K_CF(maddr >> 16) |
4472 FW_LEN16(caps_cmd));
4473 ret = t4_wr_mbox(adapter, adapter->mbox, &caps_cmd, sizeof(caps_cmd),
4474 &caps_cmd);
4475 if (ret < 0)
4476 goto bye;
4477
4478 finiver = ntohl(caps_cmd.finiver);
4479 finicsum = ntohl(caps_cmd.finicsum);
4480 cfcsum = ntohl(caps_cmd.cfcsum);
4481 if (finicsum != cfcsum)
4482 dev_warn(adapter->pdev_dev, "Configuration File checksum "\
4483 "mismatch: [fini] csum=%#x, computed csum=%#x\n",
4484 finicsum, cfcsum);
4485
636f9d37
VP
4486 /*
4487 * And now tell the firmware to use the configuration we just loaded.
4488 */
4489 caps_cmd.op_to_write =
4490 htonl(FW_CMD_OP(FW_CAPS_CONFIG_CMD) |
4491 FW_CMD_REQUEST |
4492 FW_CMD_WRITE);
ce91a923 4493 caps_cmd.cfvalid_to_len16 = htonl(FW_LEN16(caps_cmd));
636f9d37
VP
4494 ret = t4_wr_mbox(adapter, adapter->mbox, &caps_cmd, sizeof(caps_cmd),
4495 NULL);
4496 if (ret < 0)
4497 goto bye;
4498
4499 /*
4500 * Tweak configuration based on system architecture, module
4501 * parameters, etc.
4502 */
4503 ret = adap_init0_tweaks(adapter);
4504 if (ret < 0)
4505 goto bye;
4506
4507 /*
4508 * And finally tell the firmware to initialize itself using the
4509 * parameters from the Configuration File.
4510 */
4511 ret = t4_fw_initialize(adapter, adapter->mbox);
4512 if (ret < 0)
4513 goto bye;
4514
0a57a536 4515 sprintf(fw_config_file_path, "/lib/firmware/%s", fw_config_file);
636f9d37
VP
4516 /*
4517 * Return successfully and note that we're operating with parameters
4518 * not supplied by the driver, rather than from hard-wired
4519 * initialization constants burried in the driver.
4520 */
4521 adapter->flags |= USING_SOFT_PARAMS;
4522 dev_info(adapter->pdev_dev, "Successfully configured using Firmware "\
4523 "Configuration File %s, version %#x, computed checksum %#x\n",
4524 (using_flash
4525 ? "in device FLASH"
0a57a536 4526 : fw_config_file_path),
636f9d37
VP
4527 finiver, cfcsum);
4528 return 0;
4529
4530 /*
4531 * Something bad happened. Return the error ... (If the "error"
4532 * is that there's no Configuration File on the adapter we don't
4533 * want to issue a warning since this is fairly common.)
4534 */
4535bye:
4536 if (ret != -ENOENT)
4537 dev_warn(adapter->pdev_dev, "Configuration file error %d\n",
4538 -ret);
4539 return ret;
4540}
4541
13ee15d3
VP
4542/*
4543 * Attempt to initialize the adapter via hard-coded, driver supplied
4544 * parameters ...
4545 */
4546static int adap_init0_no_config(struct adapter *adapter, int reset)
4547{
4548 struct sge *s = &adapter->sge;
4549 struct fw_caps_config_cmd caps_cmd;
4550 u32 v;
4551 int i, ret;
4552
4553 /*
4554 * Reset device if necessary
4555 */
4556 if (reset) {
4557 ret = t4_fw_reset(adapter, adapter->mbox,
4558 PIORSTMODE | PIORST);
4559 if (ret < 0)
4560 goto bye;
4561 }
4562
4563 /*
4564 * Get device capabilities and select which we'll be using.
4565 */
4566 memset(&caps_cmd, 0, sizeof(caps_cmd));
4567 caps_cmd.op_to_write = htonl(FW_CMD_OP(FW_CAPS_CONFIG_CMD) |
4568 FW_CMD_REQUEST | FW_CMD_READ);
ce91a923 4569 caps_cmd.cfvalid_to_len16 = htonl(FW_LEN16(caps_cmd));
13ee15d3
VP
4570 ret = t4_wr_mbox(adapter, adapter->mbox, &caps_cmd, sizeof(caps_cmd),
4571 &caps_cmd);
4572 if (ret < 0)
4573 goto bye;
4574
13ee15d3
VP
4575 if (caps_cmd.niccaps & htons(FW_CAPS_CONFIG_NIC_VM)) {
4576 if (!vf_acls)
4577 caps_cmd.niccaps ^= htons(FW_CAPS_CONFIG_NIC_VM);
4578 else
4579 caps_cmd.niccaps = htons(FW_CAPS_CONFIG_NIC_VM);
4580 } else if (vf_acls) {
4581 dev_err(adapter->pdev_dev, "virtualization ACLs not supported");
4582 goto bye;
4583 }
4584 caps_cmd.op_to_write = htonl(FW_CMD_OP(FW_CAPS_CONFIG_CMD) |
4585 FW_CMD_REQUEST | FW_CMD_WRITE);
4586 ret = t4_wr_mbox(adapter, adapter->mbox, &caps_cmd, sizeof(caps_cmd),
4587 NULL);
4588 if (ret < 0)
4589 goto bye;
4590
4591 /*
4592 * Tweak configuration based on system architecture, module
4593 * parameters, etc.
4594 */
4595 ret = adap_init0_tweaks(adapter);
4596 if (ret < 0)
4597 goto bye;
4598
4599 /*
4600 * Select RSS Global Mode we want to use. We use "Basic Virtual"
4601 * mode which maps each Virtual Interface to its own section of
4602 * the RSS Table and we turn on all map and hash enables ...
4603 */
4604 adapter->flags |= RSS_TNLALLLOOKUP;
4605 ret = t4_config_glbl_rss(adapter, adapter->mbox,
4606 FW_RSS_GLB_CONFIG_CMD_MODE_BASICVIRTUAL,
4607 FW_RSS_GLB_CONFIG_CMD_TNLMAPEN |
4608 FW_RSS_GLB_CONFIG_CMD_HASHTOEPLITZ |
4609 ((adapter->flags & RSS_TNLALLLOOKUP) ?
4610 FW_RSS_GLB_CONFIG_CMD_TNLALLLKP : 0));
4611 if (ret < 0)
4612 goto bye;
4613
4614 /*
4615 * Set up our own fundamental resource provisioning ...
4616 */
4617 ret = t4_cfg_pfvf(adapter, adapter->mbox, adapter->fn, 0,
4618 PFRES_NEQ, PFRES_NETHCTRL,
4619 PFRES_NIQFLINT, PFRES_NIQ,
4620 PFRES_TC, PFRES_NVI,
4621 FW_PFVF_CMD_CMASK_MASK,
4622 pfvfres_pmask(adapter, adapter->fn, 0),
4623 PFRES_NEXACTF,
4624 PFRES_R_CAPS, PFRES_WX_CAPS);
4625 if (ret < 0)
4626 goto bye;
4627
4628 /*
4629 * Perform low level SGE initialization. We need to do this before we
4630 * send the firmware the INITIALIZE command because that will cause
4631 * any other PF Drivers which are waiting for the Master
4632 * Initialization to proceed forward.
4633 */
4634 for (i = 0; i < SGE_NTIMERS - 1; i++)
4635 s->timer_val[i] = min(intr_holdoff[i], MAX_SGE_TIMERVAL);
4636 s->timer_val[SGE_NTIMERS - 1] = MAX_SGE_TIMERVAL;
4637 s->counter_val[0] = 1;
4638 for (i = 1; i < SGE_NCOUNTERS; i++)
4639 s->counter_val[i] = min(intr_cnt[i - 1],
4640 THRESHOLD_0_GET(THRESHOLD_0_MASK));
4641 t4_sge_init(adapter);
4642
4643#ifdef CONFIG_PCI_IOV
4644 /*
4645 * Provision resource limits for Virtual Functions. We currently
4646 * grant them all the same static resource limits except for the Port
4647 * Access Rights Mask which we're assigning based on the PF. All of
4648 * the static provisioning stuff for both the PF and VF really needs
4649 * to be managed in a persistent manner for each device which the
4650 * firmware controls.
4651 */
4652 {
4653 int pf, vf;
4654
7d6727cf 4655 for (pf = 0; pf < ARRAY_SIZE(num_vf); pf++) {
13ee15d3
VP
4656 if (num_vf[pf] <= 0)
4657 continue;
4658
4659 /* VF numbering starts at 1! */
4660 for (vf = 1; vf <= num_vf[pf]; vf++) {
4661 ret = t4_cfg_pfvf(adapter, adapter->mbox,
4662 pf, vf,
4663 VFRES_NEQ, VFRES_NETHCTRL,
4664 VFRES_NIQFLINT, VFRES_NIQ,
4665 VFRES_TC, VFRES_NVI,
1f1e4958 4666 FW_PFVF_CMD_CMASK_MASK,
13ee15d3
VP
4667 pfvfres_pmask(
4668 adapter, pf, vf),
4669 VFRES_NEXACTF,
4670 VFRES_R_CAPS, VFRES_WX_CAPS);
4671 if (ret < 0)
4672 dev_warn(adapter->pdev_dev,
4673 "failed to "\
4674 "provision pf/vf=%d/%d; "
4675 "err=%d\n", pf, vf, ret);
4676 }
4677 }
4678 }
4679#endif
4680
4681 /*
4682 * Set up the default filter mode. Later we'll want to implement this
4683 * via a firmware command, etc. ... This needs to be done before the
4684 * firmare initialization command ... If the selected set of fields
4685 * isn't equal to the default value, we'll need to make sure that the
4686 * field selections will fit in the 36-bit budget.
4687 */
4688 if (tp_vlan_pri_map != TP_VLAN_PRI_MAP_DEFAULT) {
404d9e3f 4689 int j, bits = 0;
13ee15d3 4690
404d9e3f
VP
4691 for (j = TP_VLAN_PRI_MAP_FIRST; j <= TP_VLAN_PRI_MAP_LAST; j++)
4692 switch (tp_vlan_pri_map & (1 << j)) {
13ee15d3
VP
4693 case 0:
4694 /* compressed filter field not enabled */
4695 break;
4696 case FCOE_MASK:
4697 bits += 1;
4698 break;
4699 case PORT_MASK:
4700 bits += 3;
4701 break;
4702 case VNIC_ID_MASK:
4703 bits += 17;
4704 break;
4705 case VLAN_MASK:
4706 bits += 17;
4707 break;
4708 case TOS_MASK:
4709 bits += 8;
4710 break;
4711 case PROTOCOL_MASK:
4712 bits += 8;
4713 break;
4714 case ETHERTYPE_MASK:
4715 bits += 16;
4716 break;
4717 case MACMATCH_MASK:
4718 bits += 9;
4719 break;
4720 case MPSHITTYPE_MASK:
4721 bits += 3;
4722 break;
4723 case FRAGMENTATION_MASK:
4724 bits += 1;
4725 break;
4726 }
4727
4728 if (bits > 36) {
4729 dev_err(adapter->pdev_dev,
4730 "tp_vlan_pri_map=%#x needs %d bits > 36;"\
4731 " using %#x\n", tp_vlan_pri_map, bits,
4732 TP_VLAN_PRI_MAP_DEFAULT);
4733 tp_vlan_pri_map = TP_VLAN_PRI_MAP_DEFAULT;
4734 }
4735 }
4736 v = tp_vlan_pri_map;
4737 t4_write_indirect(adapter, TP_PIO_ADDR, TP_PIO_DATA,
4738 &v, 1, TP_VLAN_PRI_MAP);
4739
4740 /*
4741 * We need Five Tuple Lookup mode to be set in TP_GLOBAL_CONFIG order
4742 * to support any of the compressed filter fields above. Newer
4743 * versions of the firmware do this automatically but it doesn't hurt
4744 * to set it here. Meanwhile, we do _not_ need to set Lookup Every
4745 * Packet in TP_INGRESS_CONFIG to support matching non-TCP packets
4746 * since the firmware automatically turns this on and off when we have
4747 * a non-zero number of filters active (since it does have a
4748 * performance impact).
4749 */
4750 if (tp_vlan_pri_map)
4751 t4_set_reg_field(adapter, TP_GLOBAL_CONFIG,
4752 FIVETUPLELOOKUP_MASK,
4753 FIVETUPLELOOKUP_MASK);
4754
4755 /*
4756 * Tweak some settings.
4757 */
4758 t4_write_reg(adapter, TP_SHIFT_CNT, SYNSHIFTMAX(6) |
4759 RXTSHIFTMAXR1(4) | RXTSHIFTMAXR2(15) |
4760 PERSHIFTBACKOFFMAX(8) | PERSHIFTMAX(8) |
4761 KEEPALIVEMAXR1(4) | KEEPALIVEMAXR2(9));
4762
4763 /*
4764 * Get basic stuff going by issuing the Firmware Initialize command.
4765 * Note that this _must_ be after all PFVF commands ...
4766 */
4767 ret = t4_fw_initialize(adapter, adapter->mbox);
4768 if (ret < 0)
4769 goto bye;
4770
4771 /*
4772 * Return successfully!
4773 */
4774 dev_info(adapter->pdev_dev, "Successfully configured using built-in "\
4775 "driver parameters\n");
4776 return 0;
4777
4778 /*
4779 * Something bad happened. Return the error ...
4780 */
4781bye:
4782 return ret;
4783}
4784
b8ff05a9
DM
4785/*
4786 * Phase 0 of initialization: contact FW, obtain config, perform basic init.
4787 */
4788static int adap_init0(struct adapter *adap)
4789{
4790 int ret;
4791 u32 v, port_vec;
4792 enum dev_state state;
4793 u32 params[7], val[7];
9a4da2cd 4794 struct fw_caps_config_cmd caps_cmd;
636f9d37 4795 int reset = 1, j;
b8ff05a9 4796
636f9d37
VP
4797 /*
4798 * Contact FW, advertising Master capability (and potentially forcing
4799 * ourselves as the Master PF if our module parameter force_init is
4800 * set).
4801 */
4802 ret = t4_fw_hello(adap, adap->mbox, adap->fn,
4803 force_init ? MASTER_MUST : MASTER_MAY,
4804 &state);
b8ff05a9
DM
4805 if (ret < 0) {
4806 dev_err(adap->pdev_dev, "could not connect to FW, error %d\n",
4807 ret);
4808 return ret;
4809 }
636f9d37
VP
4810 if (ret == adap->mbox)
4811 adap->flags |= MASTER_PF;
4812 if (force_init && state == DEV_STATE_INIT)
4813 state = DEV_STATE_UNINIT;
b8ff05a9 4814
636f9d37
VP
4815 /*
4816 * If we're the Master PF Driver and the device is uninitialized,
4817 * then let's consider upgrading the firmware ... (We always want
4818 * to check the firmware version number in order to A. get it for
4819 * later reporting and B. to warn if the currently loaded firmware
4820 * is excessively mismatched relative to the driver.)
4821 */
4822 ret = t4_check_fw_version(adap);
4823 if ((adap->flags & MASTER_PF) && state != DEV_STATE_INIT) {
4824 if (ret == -EINVAL || ret > 0) {
4825 if (upgrade_fw(adap) >= 0) {
4826 /*
4827 * Note that the chip was reset as part of the
4828 * firmware upgrade so we don't reset it again
4829 * below and grab the new firmware version.
4830 */
4831 reset = 0;
4832 ret = t4_check_fw_version(adap);
4833 }
4834 }
4835 if (ret < 0)
4836 return ret;
4837 }
b8ff05a9 4838
636f9d37
VP
4839 /*
4840 * Grab VPD parameters. This should be done after we establish a
4841 * connection to the firmware since some of the VPD parameters
4842 * (notably the Core Clock frequency) are retrieved via requests to
4843 * the firmware. On the other hand, we need these fairly early on
4844 * so we do this right after getting ahold of the firmware.
4845 */
4846 ret = get_vpd_params(adap, &adap->params.vpd);
a0881cab
DM
4847 if (ret < 0)
4848 goto bye;
a0881cab 4849
636f9d37 4850 /*
13ee15d3
VP
4851 * Find out what ports are available to us. Note that we need to do
4852 * this before calling adap_init0_no_config() since it needs nports
4853 * and portvec ...
636f9d37
VP
4854 */
4855 v =
4856 FW_PARAMS_MNEM(FW_PARAMS_MNEM_DEV) |
4857 FW_PARAMS_PARAM_X(FW_PARAMS_PARAM_DEV_PORTVEC);
4858 ret = t4_query_params(adap, adap->mbox, adap->fn, 0, 1, &v, &port_vec);
a0881cab
DM
4859 if (ret < 0)
4860 goto bye;
4861
636f9d37
VP
4862 adap->params.nports = hweight32(port_vec);
4863 adap->params.portvec = port_vec;
4864
4865 /*
4866 * If the firmware is initialized already (and we're not forcing a
4867 * master initialization), note that we're living with existing
4868 * adapter parameters. Otherwise, it's time to try initializing the
4869 * adapter ...
4870 */
4871 if (state == DEV_STATE_INIT) {
4872 dev_info(adap->pdev_dev, "Coming up as %s: "\
4873 "Adapter already initialized\n",
4874 adap->flags & MASTER_PF ? "MASTER" : "SLAVE");
4875 adap->flags |= USING_SOFT_PARAMS;
4876 } else {
4877 dev_info(adap->pdev_dev, "Coming up as MASTER: "\
4878 "Initializing adapter\n");
636f9d37
VP
4879
4880 /*
4881 * If the firmware doesn't support Configuration
4882 * Files warn user and exit,
4883 */
4884 if (ret < 0)
13ee15d3 4885 dev_warn(adap->pdev_dev, "Firmware doesn't support "
636f9d37 4886 "configuration file.\n");
13ee15d3
VP
4887 if (force_old_init)
4888 ret = adap_init0_no_config(adap, reset);
636f9d37
VP
4889 else {
4890 /*
13ee15d3
VP
4891 * Find out whether we're dealing with a version of
4892 * the firmware which has configuration file support.
636f9d37 4893 */
13ee15d3
VP
4894 params[0] = (FW_PARAMS_MNEM(FW_PARAMS_MNEM_DEV) |
4895 FW_PARAMS_PARAM_X(FW_PARAMS_PARAM_DEV_CF));
4896 ret = t4_query_params(adap, adap->mbox, adap->fn, 0, 1,
4897 params, val);
636f9d37 4898
13ee15d3
VP
4899 /*
4900 * If the firmware doesn't support Configuration
4901 * Files, use the old Driver-based, hard-wired
4902 * initialization. Otherwise, try using the
4903 * Configuration File support and fall back to the
4904 * Driver-based initialization if there's no
4905 * Configuration File found.
4906 */
4907 if (ret < 0)
4908 ret = adap_init0_no_config(adap, reset);
4909 else {
4910 /*
4911 * The firmware provides us with a memory
4912 * buffer where we can load a Configuration
4913 * File from the host if we want to override
4914 * the Configuration File in flash.
4915 */
4916
4917 ret = adap_init0_config(adap, reset);
4918 if (ret == -ENOENT) {
4919 dev_info(adap->pdev_dev,
4920 "No Configuration File present "
4921 "on adapter. Using hard-wired "
4922 "configuration parameters.\n");
4923 ret = adap_init0_no_config(adap, reset);
4924 }
636f9d37
VP
4925 }
4926 }
4927 if (ret < 0) {
4928 dev_err(adap->pdev_dev,
4929 "could not initialize adapter, error %d\n",
4930 -ret);
4931 goto bye;
4932 }
4933 }
4934
4935 /*
4936 * If we're living with non-hard-coded parameters (either from a
4937 * Firmware Configuration File or values programmed by a different PF
4938 * Driver), give the SGE code a chance to pull in anything that it
4939 * needs ... Note that this must be called after we retrieve our VPD
4940 * parameters in order to know how to convert core ticks to seconds.
4941 */
4942 if (adap->flags & USING_SOFT_PARAMS) {
4943 ret = t4_sge_init(adap);
4944 if (ret < 0)
4945 goto bye;
4946 }
4947
9a4da2cd
VP
4948 if (is_bypass_device(adap->pdev->device))
4949 adap->params.bypass = 1;
4950
636f9d37
VP
4951 /*
4952 * Grab some of our basic fundamental operating parameters.
4953 */
4954#define FW_PARAM_DEV(param) \
4955 (FW_PARAMS_MNEM(FW_PARAMS_MNEM_DEV) | \
4956 FW_PARAMS_PARAM_X(FW_PARAMS_PARAM_DEV_##param))
4957
b8ff05a9 4958#define FW_PARAM_PFVF(param) \
636f9d37
VP
4959 FW_PARAMS_MNEM(FW_PARAMS_MNEM_PFVF) | \
4960 FW_PARAMS_PARAM_X(FW_PARAMS_PARAM_PFVF_##param)| \
4961 FW_PARAMS_PARAM_Y(0) | \
4962 FW_PARAMS_PARAM_Z(0)
b8ff05a9 4963
636f9d37 4964 params[0] = FW_PARAM_PFVF(EQ_START);
b8ff05a9
DM
4965 params[1] = FW_PARAM_PFVF(L2T_START);
4966 params[2] = FW_PARAM_PFVF(L2T_END);
4967 params[3] = FW_PARAM_PFVF(FILTER_START);
4968 params[4] = FW_PARAM_PFVF(FILTER_END);
e46dab4d 4969 params[5] = FW_PARAM_PFVF(IQFLINT_START);
636f9d37 4970 ret = t4_query_params(adap, adap->mbox, adap->fn, 0, 6, params, val);
b8ff05a9
DM
4971 if (ret < 0)
4972 goto bye;
636f9d37
VP
4973 adap->sge.egr_start = val[0];
4974 adap->l2t_start = val[1];
4975 adap->l2t_end = val[2];
b8ff05a9
DM
4976 adap->tids.ftid_base = val[3];
4977 adap->tids.nftids = val[4] - val[3] + 1;
e46dab4d 4978 adap->sge.ingr_start = val[5];
b8ff05a9 4979
636f9d37
VP
4980 /* query params related to active filter region */
4981 params[0] = FW_PARAM_PFVF(ACTIVE_FILTER_START);
4982 params[1] = FW_PARAM_PFVF(ACTIVE_FILTER_END);
4983 ret = t4_query_params(adap, adap->mbox, adap->fn, 0, 2, params, val);
4984 /* If Active filter size is set we enable establishing
4985 * offload connection through firmware work request
4986 */
4987 if ((val[0] != val[1]) && (ret >= 0)) {
4988 adap->flags |= FW_OFLD_CONN;
4989 adap->tids.aftid_base = val[0];
4990 adap->tids.aftid_end = val[1];
4991 }
4992
636f9d37
VP
4993 /*
4994 * Get device capabilities so we can determine what resources we need
4995 * to manage.
4996 */
4997 memset(&caps_cmd, 0, sizeof(caps_cmd));
9a4da2cd 4998 caps_cmd.op_to_write = htonl(FW_CMD_OP(FW_CAPS_CONFIG_CMD) |
13ee15d3 4999 FW_CMD_REQUEST | FW_CMD_READ);
ce91a923 5000 caps_cmd.cfvalid_to_len16 = htonl(FW_LEN16(caps_cmd));
636f9d37
VP
5001 ret = t4_wr_mbox(adap, adap->mbox, &caps_cmd, sizeof(caps_cmd),
5002 &caps_cmd);
5003 if (ret < 0)
5004 goto bye;
5005
13ee15d3 5006 if (caps_cmd.ofldcaps) {
b8ff05a9
DM
5007 /* query offload-related parameters */
5008 params[0] = FW_PARAM_DEV(NTID);
5009 params[1] = FW_PARAM_PFVF(SERVER_START);
5010 params[2] = FW_PARAM_PFVF(SERVER_END);
5011 params[3] = FW_PARAM_PFVF(TDDP_START);
5012 params[4] = FW_PARAM_PFVF(TDDP_END);
5013 params[5] = FW_PARAM_DEV(FLOWC_BUFFIFO_SZ);
636f9d37
VP
5014 ret = t4_query_params(adap, adap->mbox, adap->fn, 0, 6,
5015 params, val);
b8ff05a9
DM
5016 if (ret < 0)
5017 goto bye;
5018 adap->tids.ntids = val[0];
5019 adap->tids.natids = min(adap->tids.ntids / 2, MAX_ATIDS);
5020 adap->tids.stid_base = val[1];
5021 adap->tids.nstids = val[2] - val[1] + 1;
636f9d37
VP
5022 /*
5023 * Setup server filter region. Divide the availble filter
5024 * region into two parts. Regular filters get 1/3rd and server
5025 * filters get 2/3rd part. This is only enabled if workarond
5026 * path is enabled.
5027 * 1. For regular filters.
5028 * 2. Server filter: This are special filters which are used
5029 * to redirect SYN packets to offload queue.
5030 */
5031 if (adap->flags & FW_OFLD_CONN && !is_bypass(adap)) {
5032 adap->tids.sftid_base = adap->tids.ftid_base +
5033 DIV_ROUND_UP(adap->tids.nftids, 3);
5034 adap->tids.nsftids = adap->tids.nftids -
5035 DIV_ROUND_UP(adap->tids.nftids, 3);
5036 adap->tids.nftids = adap->tids.sftid_base -
5037 adap->tids.ftid_base;
5038 }
b8ff05a9
DM
5039 adap->vres.ddp.start = val[3];
5040 adap->vres.ddp.size = val[4] - val[3] + 1;
5041 adap->params.ofldq_wr_cred = val[5];
636f9d37 5042
b8ff05a9
DM
5043 adap->params.offload = 1;
5044 }
636f9d37 5045 if (caps_cmd.rdmacaps) {
b8ff05a9
DM
5046 params[0] = FW_PARAM_PFVF(STAG_START);
5047 params[1] = FW_PARAM_PFVF(STAG_END);
5048 params[2] = FW_PARAM_PFVF(RQ_START);
5049 params[3] = FW_PARAM_PFVF(RQ_END);
5050 params[4] = FW_PARAM_PFVF(PBL_START);
5051 params[5] = FW_PARAM_PFVF(PBL_END);
636f9d37
VP
5052 ret = t4_query_params(adap, adap->mbox, adap->fn, 0, 6,
5053 params, val);
b8ff05a9
DM
5054 if (ret < 0)
5055 goto bye;
5056 adap->vres.stag.start = val[0];
5057 adap->vres.stag.size = val[1] - val[0] + 1;
5058 adap->vres.rq.start = val[2];
5059 adap->vres.rq.size = val[3] - val[2] + 1;
5060 adap->vres.pbl.start = val[4];
5061 adap->vres.pbl.size = val[5] - val[4] + 1;
a0881cab
DM
5062
5063 params[0] = FW_PARAM_PFVF(SQRQ_START);
5064 params[1] = FW_PARAM_PFVF(SQRQ_END);
5065 params[2] = FW_PARAM_PFVF(CQ_START);
5066 params[3] = FW_PARAM_PFVF(CQ_END);
1ae970e0
DM
5067 params[4] = FW_PARAM_PFVF(OCQ_START);
5068 params[5] = FW_PARAM_PFVF(OCQ_END);
636f9d37 5069 ret = t4_query_params(adap, 0, 0, 0, 6, params, val);
a0881cab
DM
5070 if (ret < 0)
5071 goto bye;
5072 adap->vres.qp.start = val[0];
5073 adap->vres.qp.size = val[1] - val[0] + 1;
5074 adap->vres.cq.start = val[2];
5075 adap->vres.cq.size = val[3] - val[2] + 1;
1ae970e0
DM
5076 adap->vres.ocq.start = val[4];
5077 adap->vres.ocq.size = val[5] - val[4] + 1;
b8ff05a9 5078 }
636f9d37 5079 if (caps_cmd.iscsicaps) {
b8ff05a9
DM
5080 params[0] = FW_PARAM_PFVF(ISCSI_START);
5081 params[1] = FW_PARAM_PFVF(ISCSI_END);
636f9d37
VP
5082 ret = t4_query_params(adap, adap->mbox, adap->fn, 0, 2,
5083 params, val);
b8ff05a9
DM
5084 if (ret < 0)
5085 goto bye;
5086 adap->vres.iscsi.start = val[0];
5087 adap->vres.iscsi.size = val[1] - val[0] + 1;
5088 }
5089#undef FW_PARAM_PFVF
5090#undef FW_PARAM_DEV
5091
636f9d37
VP
5092 /*
5093 * These are finalized by FW initialization, load their values now.
5094 */
b8ff05a9
DM
5095 v = t4_read_reg(adap, TP_TIMER_RESOLUTION);
5096 adap->params.tp.tre = TIMERRESOLUTION_GET(v);
636f9d37 5097 adap->params.tp.dack_re = DELAYEDACKRESOLUTION_GET(v);
b8ff05a9
DM
5098 t4_read_mtu_tbl(adap, adap->params.mtus, NULL);
5099 t4_load_mtus(adap, adap->params.mtus, adap->params.a_wnd,
5100 adap->params.b_wnd);
7ee9ff94 5101
636f9d37
VP
5102 /* MODQ_REQ_MAP defaults to setting queues 0-3 to chan 0-3 */
5103 for (j = 0; j < NCHAN; j++)
5104 adap->params.tp.tx_modq[j] = j;
7ee9ff94 5105
793dad94
VP
5106 t4_read_indirect(adap, TP_PIO_ADDR, TP_PIO_DATA,
5107 &adap->filter_mode, 1,
5108 TP_VLAN_PRI_MAP);
5109
636f9d37 5110 adap->flags |= FW_OK;
b8ff05a9
DM
5111 return 0;
5112
5113 /*
636f9d37
VP
5114 * Something bad happened. If a command timed out or failed with EIO
5115 * FW does not operate within its spec or something catastrophic
5116 * happened to HW/FW, stop issuing commands.
b8ff05a9 5117 */
636f9d37
VP
5118bye:
5119 if (ret != -ETIMEDOUT && ret != -EIO)
5120 t4_fw_bye(adap, adap->mbox);
b8ff05a9
DM
5121 return ret;
5122}
5123
204dc3c0
DM
5124/* EEH callbacks */
5125
5126static pci_ers_result_t eeh_err_detected(struct pci_dev *pdev,
5127 pci_channel_state_t state)
5128{
5129 int i;
5130 struct adapter *adap = pci_get_drvdata(pdev);
5131
5132 if (!adap)
5133 goto out;
5134
5135 rtnl_lock();
5136 adap->flags &= ~FW_OK;
5137 notify_ulds(adap, CXGB4_STATE_START_RECOVERY);
5138 for_each_port(adap, i) {
5139 struct net_device *dev = adap->port[i];
5140
5141 netif_device_detach(dev);
5142 netif_carrier_off(dev);
5143 }
5144 if (adap->flags & FULL_INIT_DONE)
5145 cxgb_down(adap);
5146 rtnl_unlock();
5147 pci_disable_device(pdev);
5148out: return state == pci_channel_io_perm_failure ?
5149 PCI_ERS_RESULT_DISCONNECT : PCI_ERS_RESULT_NEED_RESET;
5150}
5151
5152static pci_ers_result_t eeh_slot_reset(struct pci_dev *pdev)
5153{
5154 int i, ret;
5155 struct fw_caps_config_cmd c;
5156 struct adapter *adap = pci_get_drvdata(pdev);
5157
5158 if (!adap) {
5159 pci_restore_state(pdev);
5160 pci_save_state(pdev);
5161 return PCI_ERS_RESULT_RECOVERED;
5162 }
5163
5164 if (pci_enable_device(pdev)) {
5165 dev_err(&pdev->dev, "cannot reenable PCI device after reset\n");
5166 return PCI_ERS_RESULT_DISCONNECT;
5167 }
5168
5169 pci_set_master(pdev);
5170 pci_restore_state(pdev);
5171 pci_save_state(pdev);
5172 pci_cleanup_aer_uncorrect_error_status(pdev);
5173
5174 if (t4_wait_dev_ready(adap) < 0)
5175 return PCI_ERS_RESULT_DISCONNECT;
060e0c75 5176 if (t4_fw_hello(adap, adap->fn, adap->fn, MASTER_MUST, NULL))
204dc3c0
DM
5177 return PCI_ERS_RESULT_DISCONNECT;
5178 adap->flags |= FW_OK;
5179 if (adap_init1(adap, &c))
5180 return PCI_ERS_RESULT_DISCONNECT;
5181
5182 for_each_port(adap, i) {
5183 struct port_info *p = adap2pinfo(adap, i);
5184
060e0c75
DM
5185 ret = t4_alloc_vi(adap, adap->fn, p->tx_chan, adap->fn, 0, 1,
5186 NULL, NULL);
204dc3c0
DM
5187 if (ret < 0)
5188 return PCI_ERS_RESULT_DISCONNECT;
5189 p->viid = ret;
5190 p->xact_addr_filt = -1;
5191 }
5192
5193 t4_load_mtus(adap, adap->params.mtus, adap->params.a_wnd,
5194 adap->params.b_wnd);
1ae970e0 5195 setup_memwin(adap);
204dc3c0
DM
5196 if (cxgb_up(adap))
5197 return PCI_ERS_RESULT_DISCONNECT;
5198 return PCI_ERS_RESULT_RECOVERED;
5199}
5200
5201static void eeh_resume(struct pci_dev *pdev)
5202{
5203 int i;
5204 struct adapter *adap = pci_get_drvdata(pdev);
5205
5206 if (!adap)
5207 return;
5208
5209 rtnl_lock();
5210 for_each_port(adap, i) {
5211 struct net_device *dev = adap->port[i];
5212
5213 if (netif_running(dev)) {
5214 link_start(dev);
5215 cxgb_set_rxmode(dev);
5216 }
5217 netif_device_attach(dev);
5218 }
5219 rtnl_unlock();
5220}
5221
3646f0e5 5222static const struct pci_error_handlers cxgb4_eeh = {
204dc3c0
DM
5223 .error_detected = eeh_err_detected,
5224 .slot_reset = eeh_slot_reset,
5225 .resume = eeh_resume,
5226};
5227
b8ff05a9
DM
5228static inline bool is_10g_port(const struct link_config *lc)
5229{
5230 return (lc->supported & FW_PORT_CAP_SPEED_10G) != 0;
5231}
5232
5233static inline void init_rspq(struct sge_rspq *q, u8 timer_idx, u8 pkt_cnt_idx,
5234 unsigned int size, unsigned int iqe_size)
5235{
5236 q->intr_params = QINTR_TIMER_IDX(timer_idx) |
5237 (pkt_cnt_idx < SGE_NCOUNTERS ? QINTR_CNT_EN : 0);
5238 q->pktcnt_idx = pkt_cnt_idx < SGE_NCOUNTERS ? pkt_cnt_idx : 0;
5239 q->iqe_len = iqe_size;
5240 q->size = size;
5241}
5242
5243/*
5244 * Perform default configuration of DMA queues depending on the number and type
5245 * of ports we found and the number of available CPUs. Most settings can be
5246 * modified by the admin prior to actual use.
5247 */
91744948 5248static void cfg_queues(struct adapter *adap)
b8ff05a9
DM
5249{
5250 struct sge *s = &adap->sge;
5251 int i, q10g = 0, n10g = 0, qidx = 0;
5252
5253 for_each_port(adap, i)
5254 n10g += is_10g_port(&adap2pinfo(adap, i)->link_cfg);
5255
5256 /*
5257 * We default to 1 queue per non-10G port and up to # of cores queues
5258 * per 10G port.
5259 */
5260 if (n10g)
5261 q10g = (MAX_ETH_QSETS - (adap->params.nports - n10g)) / n10g;
5952dde7
YM
5262 if (q10g > netif_get_num_default_rss_queues())
5263 q10g = netif_get_num_default_rss_queues();
b8ff05a9
DM
5264
5265 for_each_port(adap, i) {
5266 struct port_info *pi = adap2pinfo(adap, i);
5267
5268 pi->first_qset = qidx;
5269 pi->nqsets = is_10g_port(&pi->link_cfg) ? q10g : 1;
5270 qidx += pi->nqsets;
5271 }
5272
5273 s->ethqsets = qidx;
5274 s->max_ethqsets = qidx; /* MSI-X may lower it later */
5275
5276 if (is_offload(adap)) {
5277 /*
5278 * For offload we use 1 queue/channel if all ports are up to 1G,
5279 * otherwise we divide all available queues amongst the channels
5280 * capped by the number of available cores.
5281 */
5282 if (n10g) {
5283 i = min_t(int, ARRAY_SIZE(s->ofldrxq),
5284 num_online_cpus());
5285 s->ofldqsets = roundup(i, adap->params.nports);
5286 } else
5287 s->ofldqsets = adap->params.nports;
5288 /* For RDMA one Rx queue per channel suffices */
5289 s->rdmaqs = adap->params.nports;
5290 }
5291
5292 for (i = 0; i < ARRAY_SIZE(s->ethrxq); i++) {
5293 struct sge_eth_rxq *r = &s->ethrxq[i];
5294
5295 init_rspq(&r->rspq, 0, 0, 1024, 64);
5296 r->fl.size = 72;
5297 }
5298
5299 for (i = 0; i < ARRAY_SIZE(s->ethtxq); i++)
5300 s->ethtxq[i].q.size = 1024;
5301
5302 for (i = 0; i < ARRAY_SIZE(s->ctrlq); i++)
5303 s->ctrlq[i].q.size = 512;
5304
5305 for (i = 0; i < ARRAY_SIZE(s->ofldtxq); i++)
5306 s->ofldtxq[i].q.size = 1024;
5307
5308 for (i = 0; i < ARRAY_SIZE(s->ofldrxq); i++) {
5309 struct sge_ofld_rxq *r = &s->ofldrxq[i];
5310
5311 init_rspq(&r->rspq, 0, 0, 1024, 64);
5312 r->rspq.uld = CXGB4_ULD_ISCSI;
5313 r->fl.size = 72;
5314 }
5315
5316 for (i = 0; i < ARRAY_SIZE(s->rdmarxq); i++) {
5317 struct sge_ofld_rxq *r = &s->rdmarxq[i];
5318
5319 init_rspq(&r->rspq, 0, 0, 511, 64);
5320 r->rspq.uld = CXGB4_ULD_RDMA;
5321 r->fl.size = 72;
5322 }
5323
5324 init_rspq(&s->fw_evtq, 6, 0, 512, 64);
5325 init_rspq(&s->intrq, 6, 0, 2 * MAX_INGQ, 64);
5326}
5327
5328/*
5329 * Reduce the number of Ethernet queues across all ports to at most n.
5330 * n provides at least one queue per port.
5331 */
91744948 5332static void reduce_ethqs(struct adapter *adap, int n)
b8ff05a9
DM
5333{
5334 int i;
5335 struct port_info *pi;
5336
5337 while (n < adap->sge.ethqsets)
5338 for_each_port(adap, i) {
5339 pi = adap2pinfo(adap, i);
5340 if (pi->nqsets > 1) {
5341 pi->nqsets--;
5342 adap->sge.ethqsets--;
5343 if (adap->sge.ethqsets <= n)
5344 break;
5345 }
5346 }
5347
5348 n = 0;
5349 for_each_port(adap, i) {
5350 pi = adap2pinfo(adap, i);
5351 pi->first_qset = n;
5352 n += pi->nqsets;
5353 }
5354}
5355
5356/* 2 MSI-X vectors needed for the FW queue and non-data interrupts */
5357#define EXTRA_VECS 2
5358
91744948 5359static int enable_msix(struct adapter *adap)
b8ff05a9
DM
5360{
5361 int ofld_need = 0;
5362 int i, err, want, need;
5363 struct sge *s = &adap->sge;
5364 unsigned int nchan = adap->params.nports;
5365 struct msix_entry entries[MAX_INGQ + 1];
5366
5367 for (i = 0; i < ARRAY_SIZE(entries); ++i)
5368 entries[i].entry = i;
5369
5370 want = s->max_ethqsets + EXTRA_VECS;
5371 if (is_offload(adap)) {
5372 want += s->rdmaqs + s->ofldqsets;
5373 /* need nchan for each possible ULD */
5374 ofld_need = 2 * nchan;
5375 }
5376 need = adap->params.nports + EXTRA_VECS + ofld_need;
5377
5378 while ((err = pci_enable_msix(adap->pdev, entries, want)) >= need)
5379 want = err;
5380
5381 if (!err) {
5382 /*
5383 * Distribute available vectors to the various queue groups.
5384 * Every group gets its minimum requirement and NIC gets top
5385 * priority for leftovers.
5386 */
5387 i = want - EXTRA_VECS - ofld_need;
5388 if (i < s->max_ethqsets) {
5389 s->max_ethqsets = i;
5390 if (i < s->ethqsets)
5391 reduce_ethqs(adap, i);
5392 }
5393 if (is_offload(adap)) {
5394 i = want - EXTRA_VECS - s->max_ethqsets;
5395 i -= ofld_need - nchan;
5396 s->ofldqsets = (i / nchan) * nchan; /* round down */
5397 }
5398 for (i = 0; i < want; ++i)
5399 adap->msix_info[i].vec = entries[i].vector;
5400 } else if (err > 0)
5401 dev_info(adap->pdev_dev,
5402 "only %d MSI-X vectors left, not using MSI-X\n", err);
5403 return err;
5404}
5405
5406#undef EXTRA_VECS
5407
91744948 5408static int init_rss(struct adapter *adap)
671b0060
DM
5409{
5410 unsigned int i, j;
5411
5412 for_each_port(adap, i) {
5413 struct port_info *pi = adap2pinfo(adap, i);
5414
5415 pi->rss = kcalloc(pi->rss_size, sizeof(u16), GFP_KERNEL);
5416 if (!pi->rss)
5417 return -ENOMEM;
5418 for (j = 0; j < pi->rss_size; j++)
278bc429 5419 pi->rss[j] = ethtool_rxfh_indir_default(j, pi->nqsets);
671b0060
DM
5420 }
5421 return 0;
5422}
5423
91744948 5424static void print_port_info(const struct net_device *dev)
b8ff05a9
DM
5425{
5426 static const char *base[] = {
a0881cab 5427 "R XFI", "R XAUI", "T SGMII", "T XFI", "T XAUI", "KX4", "CX4",
7d5e77aa 5428 "KX", "KR", "R SFP+", "KR/KX", "KR/KX/KX4"
b8ff05a9
DM
5429 };
5430
b8ff05a9 5431 char buf[80];
118969ed 5432 char *bufp = buf;
f1a051b9 5433 const char *spd = "";
118969ed
DM
5434 const struct port_info *pi = netdev_priv(dev);
5435 const struct adapter *adap = pi->adapter;
f1a051b9
DM
5436
5437 if (adap->params.pci.speed == PCI_EXP_LNKSTA_CLS_2_5GB)
5438 spd = " 2.5 GT/s";
5439 else if (adap->params.pci.speed == PCI_EXP_LNKSTA_CLS_5_0GB)
5440 spd = " 5 GT/s";
b8ff05a9 5441
118969ed
DM
5442 if (pi->link_cfg.supported & FW_PORT_CAP_SPEED_100M)
5443 bufp += sprintf(bufp, "100/");
5444 if (pi->link_cfg.supported & FW_PORT_CAP_SPEED_1G)
5445 bufp += sprintf(bufp, "1000/");
5446 if (pi->link_cfg.supported & FW_PORT_CAP_SPEED_10G)
5447 bufp += sprintf(bufp, "10G/");
5448 if (bufp != buf)
5449 --bufp;
5450 sprintf(bufp, "BASE-%s", base[pi->port_type]);
5451
5452 netdev_info(dev, "Chelsio %s rev %d %s %sNIC PCIe x%d%s%s\n",
0a57a536
SR
5453 adap->params.vpd.id,
5454 CHELSIO_CHIP_RELEASE(adap->params.rev), buf,
118969ed
DM
5455 is_offload(adap) ? "R" : "", adap->params.pci.width, spd,
5456 (adap->flags & USING_MSIX) ? " MSI-X" :
5457 (adap->flags & USING_MSI) ? " MSI" : "");
5458 netdev_info(dev, "S/N: %s, E/C: %s\n",
5459 adap->params.vpd.sn, adap->params.vpd.ec);
b8ff05a9
DM
5460}
5461
91744948 5462static void enable_pcie_relaxed_ordering(struct pci_dev *dev)
ef306b50 5463{
e5c8ae5f 5464 pcie_capability_set_word(dev, PCI_EXP_DEVCTL, PCI_EXP_DEVCTL_RELAX_EN);
ef306b50
DM
5465}
5466
06546391
DM
5467/*
5468 * Free the following resources:
5469 * - memory used for tables
5470 * - MSI/MSI-X
5471 * - net devices
5472 * - resources FW is holding for us
5473 */
5474static void free_some_resources(struct adapter *adapter)
5475{
5476 unsigned int i;
5477
5478 t4_free_mem(adapter->l2t);
5479 t4_free_mem(adapter->tids.tid_tab);
5480 disable_msi(adapter);
5481
5482 for_each_port(adapter, i)
671b0060
DM
5483 if (adapter->port[i]) {
5484 kfree(adap2pinfo(adapter, i)->rss);
06546391 5485 free_netdev(adapter->port[i]);
671b0060 5486 }
06546391 5487 if (adapter->flags & FW_OK)
060e0c75 5488 t4_fw_bye(adapter, adapter->fn);
06546391
DM
5489}
5490
2ed28baa 5491#define TSO_FLAGS (NETIF_F_TSO | NETIF_F_TSO6 | NETIF_F_TSO_ECN)
35d35682 5492#define VLAN_FEAT (NETIF_F_SG | NETIF_F_IP_CSUM | TSO_FLAGS | \
b8ff05a9 5493 NETIF_F_IPV6_CSUM | NETIF_F_HIGHDMA)
22adfe0a 5494#define SEGMENT_SIZE 128
b8ff05a9 5495
1dd06ae8 5496static int init_one(struct pci_dev *pdev, const struct pci_device_id *ent)
b8ff05a9 5497{
22adfe0a 5498 int func, i, err, s_qpp, qpp, num_seg;
b8ff05a9 5499 struct port_info *pi;
c8f44aff 5500 bool highdma = false;
b8ff05a9
DM
5501 struct adapter *adapter = NULL;
5502
5503 printk_once(KERN_INFO "%s - version %s\n", DRV_DESC, DRV_VERSION);
5504
5505 err = pci_request_regions(pdev, KBUILD_MODNAME);
5506 if (err) {
5507 /* Just info, some other driver may have claimed the device. */
5508 dev_info(&pdev->dev, "cannot obtain PCI resources\n");
5509 return err;
5510 }
5511
060e0c75 5512 /* We control everything through one PF */
b8ff05a9 5513 func = PCI_FUNC(pdev->devfn);
060e0c75 5514 if (func != ent->driver_data) {
204dc3c0 5515 pci_save_state(pdev); /* to restore SR-IOV later */
b8ff05a9 5516 goto sriov;
204dc3c0 5517 }
b8ff05a9
DM
5518
5519 err = pci_enable_device(pdev);
5520 if (err) {
5521 dev_err(&pdev->dev, "cannot enable PCI device\n");
5522 goto out_release_regions;
5523 }
5524
5525 if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(64))) {
c8f44aff 5526 highdma = true;
b8ff05a9
DM
5527 err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64));
5528 if (err) {
5529 dev_err(&pdev->dev, "unable to obtain 64-bit DMA for "
5530 "coherent allocations\n");
5531 goto out_disable_device;
5532 }
5533 } else {
5534 err = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
5535 if (err) {
5536 dev_err(&pdev->dev, "no usable DMA configuration\n");
5537 goto out_disable_device;
5538 }
5539 }
5540
5541 pci_enable_pcie_error_reporting(pdev);
ef306b50 5542 enable_pcie_relaxed_ordering(pdev);
b8ff05a9
DM
5543 pci_set_master(pdev);
5544 pci_save_state(pdev);
5545
5546 adapter = kzalloc(sizeof(*adapter), GFP_KERNEL);
5547 if (!adapter) {
5548 err = -ENOMEM;
5549 goto out_disable_device;
5550 }
5551
5552 adapter->regs = pci_ioremap_bar(pdev, 0);
5553 if (!adapter->regs) {
5554 dev_err(&pdev->dev, "cannot map device registers\n");
5555 err = -ENOMEM;
5556 goto out_free_adapter;
5557 }
5558
5559 adapter->pdev = pdev;
5560 adapter->pdev_dev = &pdev->dev;
3069ee9b 5561 adapter->mbox = func;
060e0c75 5562 adapter->fn = func;
b8ff05a9
DM
5563 adapter->msg_enable = dflt_msg_enable;
5564 memset(adapter->chan_map, 0xff, sizeof(adapter->chan_map));
5565
5566 spin_lock_init(&adapter->stats_lock);
5567 spin_lock_init(&adapter->tid_release_lock);
5568
5569 INIT_WORK(&adapter->tid_release_task, process_tid_release_list);
881806bc
VP
5570 INIT_WORK(&adapter->db_full_task, process_db_full);
5571 INIT_WORK(&adapter->db_drop_task, process_db_drop);
b8ff05a9
DM
5572
5573 err = t4_prep_adapter(adapter);
5574 if (err)
22adfe0a
SR
5575 goto out_unmap_bar0;
5576
5577 if (!is_t4(adapter->chip)) {
5578 s_qpp = QUEUESPERPAGEPF1 * adapter->fn;
5579 qpp = 1 << QUEUESPERPAGEPF0_GET(t4_read_reg(adapter,
5580 SGE_EGRESS_QUEUES_PER_PAGE_PF) >> s_qpp);
5581 num_seg = PAGE_SIZE / SEGMENT_SIZE;
5582
5583 /* Each segment size is 128B. Write coalescing is enabled only
5584 * when SGE_EGRESS_QUEUES_PER_PAGE_PF reg value for the
5585 * queue is less no of segments that can be accommodated in
5586 * a page size.
5587 */
5588 if (qpp > num_seg) {
5589 dev_err(&pdev->dev,
5590 "Incorrect number of egress queues per page\n");
5591 err = -EINVAL;
5592 goto out_unmap_bar0;
5593 }
5594 adapter->bar2 = ioremap_wc(pci_resource_start(pdev, 2),
5595 pci_resource_len(pdev, 2));
5596 if (!adapter->bar2) {
5597 dev_err(&pdev->dev, "cannot map device bar2 region\n");
5598 err = -ENOMEM;
5599 goto out_unmap_bar0;
5600 }
5601 }
5602
636f9d37 5603 setup_memwin(adapter);
b8ff05a9 5604 err = adap_init0(adapter);
636f9d37 5605 setup_memwin_rdma(adapter);
b8ff05a9
DM
5606 if (err)
5607 goto out_unmap_bar;
5608
5609 for_each_port(adapter, i) {
5610 struct net_device *netdev;
5611
5612 netdev = alloc_etherdev_mq(sizeof(struct port_info),
5613 MAX_ETH_QSETS);
5614 if (!netdev) {
5615 err = -ENOMEM;
5616 goto out_free_dev;
5617 }
5618
5619 SET_NETDEV_DEV(netdev, &pdev->dev);
5620
5621 adapter->port[i] = netdev;
5622 pi = netdev_priv(netdev);
5623 pi->adapter = adapter;
5624 pi->xact_addr_filt = -1;
b8ff05a9 5625 pi->port_id = i;
b8ff05a9
DM
5626 netdev->irq = pdev->irq;
5627
2ed28baa
MM
5628 netdev->hw_features = NETIF_F_SG | TSO_FLAGS |
5629 NETIF_F_IP_CSUM | NETIF_F_IPV6_CSUM |
5630 NETIF_F_RXCSUM | NETIF_F_RXHASH |
f646968f 5631 NETIF_F_HW_VLAN_CTAG_TX | NETIF_F_HW_VLAN_CTAG_RX;
c8f44aff
MM
5632 if (highdma)
5633 netdev->hw_features |= NETIF_F_HIGHDMA;
5634 netdev->features |= netdev->hw_features;
b8ff05a9
DM
5635 netdev->vlan_features = netdev->features & VLAN_FEAT;
5636
01789349
JP
5637 netdev->priv_flags |= IFF_UNICAST_FLT;
5638
b8ff05a9
DM
5639 netdev->netdev_ops = &cxgb4_netdev_ops;
5640 SET_ETHTOOL_OPS(netdev, &cxgb_ethtool_ops);
5641 }
5642
5643 pci_set_drvdata(pdev, adapter);
5644
5645 if (adapter->flags & FW_OK) {
060e0c75 5646 err = t4_port_init(adapter, func, func, 0);
b8ff05a9
DM
5647 if (err)
5648 goto out_free_dev;
5649 }
5650
5651 /*
5652 * Configure queues and allocate tables now, they can be needed as
5653 * soon as the first register_netdev completes.
5654 */
5655 cfg_queues(adapter);
5656
5657 adapter->l2t = t4_init_l2t();
5658 if (!adapter->l2t) {
5659 /* We tolerate a lack of L2T, giving up some functionality */
5660 dev_warn(&pdev->dev, "could not allocate L2T, continuing\n");
5661 adapter->params.offload = 0;
5662 }
5663
5664 if (is_offload(adapter) && tid_init(&adapter->tids) < 0) {
5665 dev_warn(&pdev->dev, "could not allocate TID table, "
5666 "continuing\n");
5667 adapter->params.offload = 0;
5668 }
5669
f7cabcdd
DM
5670 /* See what interrupts we'll be using */
5671 if (msi > 1 && enable_msix(adapter) == 0)
5672 adapter->flags |= USING_MSIX;
5673 else if (msi > 0 && pci_enable_msi(pdev) == 0)
5674 adapter->flags |= USING_MSI;
5675
671b0060
DM
5676 err = init_rss(adapter);
5677 if (err)
5678 goto out_free_dev;
5679
b8ff05a9
DM
5680 /*
5681 * The card is now ready to go. If any errors occur during device
5682 * registration we do not fail the whole card but rather proceed only
5683 * with the ports we manage to register successfully. However we must
5684 * register at least one net device.
5685 */
5686 for_each_port(adapter, i) {
a57cabe0
DM
5687 pi = adap2pinfo(adapter, i);
5688 netif_set_real_num_tx_queues(adapter->port[i], pi->nqsets);
5689 netif_set_real_num_rx_queues(adapter->port[i], pi->nqsets);
5690
b8ff05a9
DM
5691 err = register_netdev(adapter->port[i]);
5692 if (err)
b1a3c2b6 5693 break;
b1a3c2b6
DM
5694 adapter->chan_map[pi->tx_chan] = i;
5695 print_port_info(adapter->port[i]);
b8ff05a9 5696 }
b1a3c2b6 5697 if (i == 0) {
b8ff05a9
DM
5698 dev_err(&pdev->dev, "could not register any net devices\n");
5699 goto out_free_dev;
5700 }
b1a3c2b6
DM
5701 if (err) {
5702 dev_warn(&pdev->dev, "only %d net devices registered\n", i);
5703 err = 0;
6403eab1 5704 }
b8ff05a9
DM
5705
5706 if (cxgb4_debugfs_root) {
5707 adapter->debugfs_root = debugfs_create_dir(pci_name(pdev),
5708 cxgb4_debugfs_root);
5709 setup_debugfs(adapter);
5710 }
5711
6482aa7c
DLR
5712 /* PCIe EEH recovery on powerpc platforms needs fundamental reset */
5713 pdev->needs_freset = 1;
5714
b8ff05a9
DM
5715 if (is_offload(adapter))
5716 attach_ulds(adapter);
5717
b8ff05a9
DM
5718sriov:
5719#ifdef CONFIG_PCI_IOV
7d6727cf 5720 if (func < ARRAY_SIZE(num_vf) && num_vf[func] > 0)
b8ff05a9
DM
5721 if (pci_enable_sriov(pdev, num_vf[func]) == 0)
5722 dev_info(&pdev->dev,
5723 "instantiated %u virtual functions\n",
5724 num_vf[func]);
5725#endif
5726 return 0;
5727
5728 out_free_dev:
06546391 5729 free_some_resources(adapter);
b8ff05a9 5730 out_unmap_bar:
22adfe0a
SR
5731 if (!is_t4(adapter->chip))
5732 iounmap(adapter->bar2);
5733 out_unmap_bar0:
b8ff05a9
DM
5734 iounmap(adapter->regs);
5735 out_free_adapter:
5736 kfree(adapter);
5737 out_disable_device:
5738 pci_disable_pcie_error_reporting(pdev);
5739 pci_disable_device(pdev);
5740 out_release_regions:
5741 pci_release_regions(pdev);
5742 pci_set_drvdata(pdev, NULL);
5743 return err;
5744}
5745
91744948 5746static void remove_one(struct pci_dev *pdev)
b8ff05a9
DM
5747{
5748 struct adapter *adapter = pci_get_drvdata(pdev);
5749
636f9d37 5750#ifdef CONFIG_PCI_IOV
b8ff05a9
DM
5751 pci_disable_sriov(pdev);
5752
636f9d37
VP
5753#endif
5754
b8ff05a9
DM
5755 if (adapter) {
5756 int i;
5757
5758 if (is_offload(adapter))
5759 detach_ulds(adapter);
5760
5761 for_each_port(adapter, i)
8f3a7676 5762 if (adapter->port[i]->reg_state == NETREG_REGISTERED)
b8ff05a9
DM
5763 unregister_netdev(adapter->port[i]);
5764
5765 if (adapter->debugfs_root)
5766 debugfs_remove_recursive(adapter->debugfs_root);
5767
f2b7e78d
VP
5768 /* If we allocated filters, free up state associated with any
5769 * valid filters ...
5770 */
5771 if (adapter->tids.ftid_tab) {
5772 struct filter_entry *f = &adapter->tids.ftid_tab[0];
dca4faeb
VP
5773 for (i = 0; i < (adapter->tids.nftids +
5774 adapter->tids.nsftids); i++, f++)
f2b7e78d
VP
5775 if (f->valid)
5776 clear_filter(adapter, f);
5777 }
5778
aaefae9b
DM
5779 if (adapter->flags & FULL_INIT_DONE)
5780 cxgb_down(adapter);
b8ff05a9 5781
06546391 5782 free_some_resources(adapter);
b8ff05a9 5783 iounmap(adapter->regs);
22adfe0a
SR
5784 if (!is_t4(adapter->chip))
5785 iounmap(adapter->bar2);
b8ff05a9
DM
5786 kfree(adapter);
5787 pci_disable_pcie_error_reporting(pdev);
5788 pci_disable_device(pdev);
5789 pci_release_regions(pdev);
5790 pci_set_drvdata(pdev, NULL);
a069ec91 5791 } else
b8ff05a9
DM
5792 pci_release_regions(pdev);
5793}
5794
5795static struct pci_driver cxgb4_driver = {
5796 .name = KBUILD_MODNAME,
5797 .id_table = cxgb4_pci_tbl,
5798 .probe = init_one,
91744948 5799 .remove = remove_one,
204dc3c0 5800 .err_handler = &cxgb4_eeh,
b8ff05a9
DM
5801};
5802
5803static int __init cxgb4_init_module(void)
5804{
5805 int ret;
5806
3069ee9b
VP
5807 workq = create_singlethread_workqueue("cxgb4");
5808 if (!workq)
5809 return -ENOMEM;
5810
b8ff05a9
DM
5811 /* Debugfs support is optional, just warn if this fails */
5812 cxgb4_debugfs_root = debugfs_create_dir(KBUILD_MODNAME, NULL);
5813 if (!cxgb4_debugfs_root)
428ac43f 5814 pr_warn("could not create debugfs entry, continuing\n");
b8ff05a9
DM
5815
5816 ret = pci_register_driver(&cxgb4_driver);
5817 if (ret < 0)
5818 debugfs_remove(cxgb4_debugfs_root);
5819 return ret;
5820}
5821
5822static void __exit cxgb4_cleanup_module(void)
5823{
5824 pci_unregister_driver(&cxgb4_driver);
5825 debugfs_remove(cxgb4_debugfs_root); /* NULL ok */
3069ee9b
VP
5826 flush_workqueue(workq);
5827 destroy_workqueue(workq);
b8ff05a9
DM
5828}
5829
5830module_init(cxgb4_init_module);
5831module_exit(cxgb4_cleanup_module);
This page took 0.604743 seconds and 5 git commands to generate.