]> bbs.cooldavid.org Git - net-next-2.6.git/blame - drivers/net/qlcnic/qlcnic_main.c
git://bbs.cooldavid.org / net-next-2.6.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
qlcnic: remove unused register
[net-next-2.6.git] / drivers / net / qlcnic / qlcnic_main.c
CommitLineData
af19b491
AKS		 1/*
2 * Copyright (C) 2009 - QLogic Corporation.
3 * All rights reserved.
4 *
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of the GNU General Public License
7 * as published by the Free Software Foundation; either version 2
8 * of the License, or (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful, but
11 * WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 59 Temple Place - Suite 330, Boston,
18 * MA 02111-1307, USA.
19 *
20 * The full GNU General Public License is included in this distribution
21 * in the file called "COPYING".
22 *
23 */
24
5a0e3ad6 25#include <linux/slab.h>
af19b491
AKS		 26#include <linux/vmalloc.h>
27#include <linux/interrupt.h>
28
29#include "qlcnic.h"
30
31#include <linux/dma-mapping.h>
32#include <linux/if_vlan.h>
33#include <net/ip.h>
34#include <linux/ipv6.h>
35#include <linux/inetdevice.h>
36#include <linux/sysfs.h>
37
38MODULE_DESCRIPTION("QLogic 10 GbE Converged Ethernet Driver");
39MODULE_LICENSE("GPL");
40MODULE_VERSION(QLCNIC_LINUX_VERSIONID);
41MODULE_FIRMWARE(QLCNIC_UNIFIED_ROMIMAGE_NAME);
42
43char qlcnic_driver_name[] = "qlcnic";
44static const char qlcnic_driver_string[] = "QLogic Converged Ethernet Driver v"
45 QLCNIC_LINUX_VERSIONID;
46
47static int port_mode = QLCNIC_PORT_MODE_AUTO_NEG;
48
49/* Default to restricted 1G auto-neg mode */
50static int wol_port_mode = 5;
51
52static int use_msi = 1;
53module_param(use_msi, int, 0644);
54MODULE_PARM_DESC(use_msi, "MSI interrupt (0=disabled, 1=enabled");
55
56static int use_msi_x = 1;
57module_param(use_msi_x, int, 0644);
58MODULE_PARM_DESC(use_msi_x, "MSI-X interrupt (0=disabled, 1=enabled");
59
60static int auto_fw_reset = AUTO_FW_RESET_ENABLED;
61module_param(auto_fw_reset, int, 0644);
62MODULE_PARM_DESC(auto_fw_reset, "Auto firmware reset (0=disabled, 1=enabled");
63
4d5bdb38
AKS		 64static int load_fw_file;
65module_param(load_fw_file, int, 0644);
66MODULE_PARM_DESC(load_fw_file, "Load firmware from (0=flash, 1=file");
67
af19b491
AKS		 68static int __devinit qlcnic_probe(struct pci_dev *pdev,
69 const struct pci_device_id *ent);
70static void __devexit qlcnic_remove(struct pci_dev *pdev);
71static int qlcnic_open(struct net_device *netdev);
72static int qlcnic_close(struct net_device *netdev);
af19b491
AKS		 73static void qlcnic_tx_timeout(struct net_device *netdev);
74static void qlcnic_tx_timeout_task(struct work_struct *work);
75static void qlcnic_attach_work(struct work_struct *work);
76static void qlcnic_fwinit_work(struct work_struct *work);
77static void qlcnic_fw_poll_work(struct work_struct *work);
78static void qlcnic_schedule_work(struct qlcnic_adapter *adapter,
79 work_func_t func, int delay);
80static void qlcnic_cancel_fw_work(struct qlcnic_adapter *adapter);
81static int qlcnic_poll(struct napi_struct *napi, int budget);
82#ifdef CONFIG_NET_POLL_CONTROLLER
83static void qlcnic_poll_controller(struct net_device *netdev);
84#endif
85
86static void qlcnic_create_sysfs_entries(struct qlcnic_adapter *adapter);
87static void qlcnic_remove_sysfs_entries(struct qlcnic_adapter *adapter);
88static void qlcnic_create_diag_entries(struct qlcnic_adapter *adapter);
89static void qlcnic_remove_diag_entries(struct qlcnic_adapter *adapter);
90
6df900e9 91static void qlcnic_idc_debug_info(struct qlcnic_adapter *adapter, u8 encoding);
af19b491
AKS		 92static void qlcnic_clr_all_drv_state(struct qlcnic_adapter *adapter);
93static int qlcnic_can_start_firmware(struct qlcnic_adapter *adapter);
94
7eb9855d 95static irqreturn_t qlcnic_tmp_intr(int irq, void *data);
af19b491
AKS		 96static irqreturn_t qlcnic_intr(int irq, void *data);
97static irqreturn_t qlcnic_msi_intr(int irq, void *data);
98static irqreturn_t qlcnic_msix_intr(int irq, void *data);
99
100static struct net_device_stats *qlcnic_get_stats(struct net_device *netdev);
101static void qlcnic_config_indev_addr(struct net_device *dev, unsigned long);
102
103/* PCI Device ID Table */
104#define ENTRY(device) \
105 {PCI_DEVICE(PCI_VENDOR_ID_QLOGIC, (device)), \
106 .class = PCI_CLASS_NETWORK_ETHERNET << 8, .class_mask = ~0}
107
108#define PCI_DEVICE_ID_QLOGIC_QLE824X 0x8020
109
6a902881 110static DEFINE_PCI_DEVICE_TABLE(qlcnic_pci_tbl) = {
af19b491
AKS		 111 ENTRY(PCI_DEVICE_ID_QLOGIC_QLE824X),
112 {0,}
113};
114
115MODULE_DEVICE_TABLE(pci, qlcnic_pci_tbl);
116
117
118void
119qlcnic_update_cmd_producer(struct qlcnic_adapter *adapter,
120 struct qlcnic_host_tx_ring *tx_ring)
121{
122 writel(tx_ring->producer, tx_ring->crb_cmd_producer);
123
124 if (qlcnic_tx_avail(tx_ring) <= TX_STOP_THRESH) {
125 netif_stop_queue(adapter->netdev);
126 smp_mb();
8bfe8b91 127 adapter->stats.xmit_off++;
af19b491
AKS		 128 }
129}
130
131static const u32 msi_tgt_status[8] = {
132 ISR_INT_TARGET_STATUS, ISR_INT_TARGET_STATUS_F1,
133 ISR_INT_TARGET_STATUS_F2, ISR_INT_TARGET_STATUS_F3,
134 ISR_INT_TARGET_STATUS_F4, ISR_INT_TARGET_STATUS_F5,
135 ISR_INT_TARGET_STATUS_F6, ISR_INT_TARGET_STATUS_F7
136};
137
138static const
139struct qlcnic_legacy_intr_set legacy_intr[] = QLCNIC_LEGACY_INTR_CONFIG;
140
141static inline void qlcnic_disable_int(struct qlcnic_host_sds_ring *sds_ring)
142{
143 writel(0, sds_ring->crb_intr_mask);
144}
145
146static inline void qlcnic_enable_int(struct qlcnic_host_sds_ring *sds_ring)
147{
148 struct qlcnic_adapter *adapter = sds_ring->adapter;
149
150 writel(0x1, sds_ring->crb_intr_mask);
151
152 if (!QLCNIC_IS_MSI_FAMILY(adapter))
153 writel(0xfbff, adapter->tgt_mask_reg);
154}
155
156static int
157qlcnic_alloc_sds_rings(struct qlcnic_recv_context *recv_ctx, int count)
158{
159 int size = sizeof(struct qlcnic_host_sds_ring) * count;
160
161 recv_ctx->sds_rings = kzalloc(size, GFP_KERNEL);
162
163 return (recv_ctx->sds_rings == NULL);
164}
165
166static void
167qlcnic_free_sds_rings(struct qlcnic_recv_context *recv_ctx)
168{
169 if (recv_ctx->sds_rings != NULL)
170 kfree(recv_ctx->sds_rings);
171
172 recv_ctx->sds_rings = NULL;
173}
174
175static int
176qlcnic_napi_add(struct qlcnic_adapter *adapter, struct net_device *netdev)
177{
178 int ring;
179 struct qlcnic_host_sds_ring *sds_ring;
180 struct qlcnic_recv_context *recv_ctx = &adapter->recv_ctx;
181
182 if (qlcnic_alloc_sds_rings(recv_ctx, adapter->max_sds_rings))
183 return -ENOMEM;
184
185 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
186 sds_ring = &recv_ctx->sds_rings[ring];
187 netif_napi_add(netdev, &sds_ring->napi,
188 qlcnic_poll, QLCNIC_NETDEV_WEIGHT);
189 }
190
191 return 0;
192}
193
194static void
195qlcnic_napi_del(struct qlcnic_adapter *adapter)
196{
197 int ring;
198 struct qlcnic_host_sds_ring *sds_ring;
199 struct qlcnic_recv_context *recv_ctx = &adapter->recv_ctx;
200
201 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
202 sds_ring = &recv_ctx->sds_rings[ring];
203 netif_napi_del(&sds_ring->napi);
204 }
205
206 qlcnic_free_sds_rings(&adapter->recv_ctx);
207}
208
209static void
210qlcnic_napi_enable(struct qlcnic_adapter *adapter)
211{
212 int ring;
213 struct qlcnic_host_sds_ring *sds_ring;
214 struct qlcnic_recv_context *recv_ctx = &adapter->recv_ctx;
215
780ab790
AKS		 216 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
217 return;
218
af19b491
AKS		 219 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
220 sds_ring = &recv_ctx->sds_rings[ring];
221 napi_enable(&sds_ring->napi);
222 qlcnic_enable_int(sds_ring);
223 }
224}
225
226static void
227qlcnic_napi_disable(struct qlcnic_adapter *adapter)
228{
229 int ring;
230 struct qlcnic_host_sds_ring *sds_ring;
231 struct qlcnic_recv_context *recv_ctx = &adapter->recv_ctx;
232
780ab790
AKS		 233 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
234 return;
235
af19b491
AKS		 236 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
237 sds_ring = &recv_ctx->sds_rings[ring];
238 qlcnic_disable_int(sds_ring);
239 napi_synchronize(&sds_ring->napi);
240 napi_disable(&sds_ring->napi);
241 }
242}
243
244static void qlcnic_clear_stats(struct qlcnic_adapter *adapter)
245{
246 memset(&adapter->stats, 0, sizeof(adapter->stats));
af19b491
AKS		 247}
248
af19b491
AKS		 249static void qlcnic_set_port_mode(struct qlcnic_adapter *adapter)
250{
251 u32 val, data;
252
253 val = adapter->ahw.board_type;
254 if ((val == QLCNIC_BRDTYPE_P3_HMEZ) ||
255 (val == QLCNIC_BRDTYPE_P3_XG_LOM)) {
256 if (port_mode == QLCNIC_PORT_MODE_802_3_AP) {
257 data = QLCNIC_PORT_MODE_802_3_AP;
258 QLCWR32(adapter, QLCNIC_PORT_MODE_ADDR, data);
259 } else if (port_mode == QLCNIC_PORT_MODE_XG) {
260 data = QLCNIC_PORT_MODE_XG;
261 QLCWR32(adapter, QLCNIC_PORT_MODE_ADDR, data);
262 } else if (port_mode == QLCNIC_PORT_MODE_AUTO_NEG_1G) {
263 data = QLCNIC_PORT_MODE_AUTO_NEG_1G;
264 QLCWR32(adapter, QLCNIC_PORT_MODE_ADDR, data);
265 } else if (port_mode == QLCNIC_PORT_MODE_AUTO_NEG_XG) {
266 data = QLCNIC_PORT_MODE_AUTO_NEG_XG;
267 QLCWR32(adapter, QLCNIC_PORT_MODE_ADDR, data);
268 } else {
269 data = QLCNIC_PORT_MODE_AUTO_NEG;
270 QLCWR32(adapter, QLCNIC_PORT_MODE_ADDR, data);
271 }
272
273 if ((wol_port_mode != QLCNIC_PORT_MODE_802_3_AP) &&
274 (wol_port_mode != QLCNIC_PORT_MODE_XG) &&
275 (wol_port_mode != QLCNIC_PORT_MODE_AUTO_NEG_1G) &&
276 (wol_port_mode != QLCNIC_PORT_MODE_AUTO_NEG_XG)) {
277 wol_port_mode = QLCNIC_PORT_MODE_AUTO_NEG;
278 }
279 QLCWR32(adapter, QLCNIC_WOL_PORT_MODE, wol_port_mode);
280 }
281}
282
283static void qlcnic_set_msix_bit(struct pci_dev *pdev, int enable)
284{
285 u32 control;
286 int pos;
287
288 pos = pci_find_capability(pdev, PCI_CAP_ID_MSIX);
289 if (pos) {
290 pci_read_config_dword(pdev, pos, &control);
291 if (enable)
292 control |= PCI_MSIX_FLAGS_ENABLE;
293 else
294 control = 0;
295 pci_write_config_dword(pdev, pos, control);
296 }
297}
298
299static void qlcnic_init_msix_entries(struct qlcnic_adapter *adapter, int count)
300{
301 int i;
302
303 for (i = 0; i < count; i++)
304 adapter->msix_entries[i].entry = i;
305}
306
307static int
308qlcnic_read_mac_addr(struct qlcnic_adapter *adapter)
309{
310 int i;
311 unsigned char *p;
312 u64 mac_addr;
313 struct net_device *netdev = adapter->netdev;
314 struct pci_dev *pdev = adapter->pdev;
315
316 if (qlcnic_get_mac_addr(adapter, &mac_addr) != 0)
317 return -EIO;
318
319 p = (unsigned char *)&mac_addr;
320 for (i = 0; i < 6; i++)
321 netdev->dev_addr[i] = *(p + 5 - i);
322
323 memcpy(netdev->perm_addr, netdev->dev_addr, netdev->addr_len);
324 memcpy(adapter->mac_addr, netdev->dev_addr, netdev->addr_len);
325
326 /* set station address */
327
328 if (!is_valid_ether_addr(netdev->perm_addr))
329 dev_warn(&pdev->dev, "Bad MAC address %pM.\n",
330 netdev->dev_addr);
331
332 return 0;
333}
334
335static int qlcnic_set_mac(struct net_device *netdev, void *p)
336{
337 struct qlcnic_adapter *adapter = netdev_priv(netdev);
338 struct sockaddr *addr = p;
339
340 if (!is_valid_ether_addr(addr->sa_data))
341 return -EINVAL;
342
343 if (netif_running(netdev)) {
344 netif_device_detach(netdev);
345 qlcnic_napi_disable(adapter);
346 }
347
348 memcpy(adapter->mac_addr, addr->sa_data, netdev->addr_len);
349 memcpy(netdev->dev_addr, addr->sa_data, netdev->addr_len);
350 qlcnic_set_multi(adapter->netdev);
351
352 if (netif_running(netdev)) {
353 netif_device_attach(netdev);
354 qlcnic_napi_enable(adapter);
355 }
356 return 0;
357}
358
359static const struct net_device_ops qlcnic_netdev_ops = {
360 .ndo_open = qlcnic_open,
361 .ndo_stop = qlcnic_close,
362 .ndo_start_xmit = qlcnic_xmit_frame,
363 .ndo_get_stats = qlcnic_get_stats,
364 .ndo_validate_addr = eth_validate_addr,
365 .ndo_set_multicast_list = qlcnic_set_multi,
366 .ndo_set_mac_address = qlcnic_set_mac,
367 .ndo_change_mtu = qlcnic_change_mtu,
368 .ndo_tx_timeout = qlcnic_tx_timeout,
369#ifdef CONFIG_NET_POLL_CONTROLLER
370 .ndo_poll_controller = qlcnic_poll_controller,
371#endif
372};
373
374static void
375qlcnic_setup_intr(struct qlcnic_adapter *adapter)
376{
377 const struct qlcnic_legacy_intr_set *legacy_intrp;
378 struct pci_dev *pdev = adapter->pdev;
379 int err, num_msix;
380
381 if (adapter->rss_supported) {
382 num_msix = (num_online_cpus() >= MSIX_ENTRIES_PER_ADAPTER) ?
383 MSIX_ENTRIES_PER_ADAPTER : 2;
384 } else
385 num_msix = 1;
386
387 adapter->max_sds_rings = 1;
388
389 adapter->flags &= ~(QLCNIC_MSI_ENABLED | QLCNIC_MSIX_ENABLED);
390
391 legacy_intrp = &legacy_intr[adapter->ahw.pci_func];
392
393 adapter->int_vec_bit = legacy_intrp->int_vec_bit;
394 adapter->tgt_status_reg = qlcnic_get_ioaddr(adapter,
395 legacy_intrp->tgt_status_reg);
396 adapter->tgt_mask_reg = qlcnic_get_ioaddr(adapter,
397 legacy_intrp->tgt_mask_reg);
398 adapter->isr_int_vec = qlcnic_get_ioaddr(adapter, ISR_INT_VECTOR);
399
400 adapter->crb_int_state_reg = qlcnic_get_ioaddr(adapter,
401 ISR_INT_STATE_REG);
402
403 qlcnic_set_msix_bit(pdev, 0);
404
405 if (adapter->msix_supported) {
406
407 qlcnic_init_msix_entries(adapter, num_msix);
408 err = pci_enable_msix(pdev, adapter->msix_entries, num_msix);
409 if (err == 0) {
410 adapter->flags |= QLCNIC_MSIX_ENABLED;
411 qlcnic_set_msix_bit(pdev, 1);
412
413 if (adapter->rss_supported)
414 adapter->max_sds_rings = num_msix;
415
416 dev_info(&pdev->dev, "using msi-x interrupts\n");
417 return;
418 }
419
420 if (err > 0)
421 pci_disable_msix(pdev);
422
423 /* fall through for msi */
424 }
425
426 if (use_msi && !pci_enable_msi(pdev)) {
427 adapter->flags |= QLCNIC_MSI_ENABLED;
428 adapter->tgt_status_reg = qlcnic_get_ioaddr(adapter,
429 msi_tgt_status[adapter->ahw.pci_func]);
430 dev_info(&pdev->dev, "using msi interrupts\n");
431 adapter->msix_entries[0].vector = pdev->irq;
432 return;
433 }
434
435 dev_info(&pdev->dev, "using legacy interrupts\n");
436 adapter->msix_entries[0].vector = pdev->irq;
437}
438
439static void
440qlcnic_teardown_intr(struct qlcnic_adapter *adapter)
441{
442 if (adapter->flags & QLCNIC_MSIX_ENABLED)
443 pci_disable_msix(adapter->pdev);
444 if (adapter->flags & QLCNIC_MSI_ENABLED)
445 pci_disable_msi(adapter->pdev);
446}
447
448static void
449qlcnic_cleanup_pci_map(struct qlcnic_adapter *adapter)
450{
451 if (adapter->ahw.pci_base0 != NULL)
452 iounmap(adapter->ahw.pci_base0);
453}
454
455static int
456qlcnic_setup_pci_map(struct qlcnic_adapter *adapter)
457{
458 void __iomem *mem_ptr0 = NULL;
459 resource_size_t mem_base;
460 unsigned long mem_len, pci_len0 = 0;
461
462 struct pci_dev *pdev = adapter->pdev;
463 int pci_func = adapter->ahw.pci_func;
464
af19b491
AKS		 465 /* remap phys address */
466 mem_base = pci_resource_start(pdev, 0); /* 0 is for BAR 0 */
467 mem_len = pci_resource_len(pdev, 0);
468
469 if (mem_len == QLCNIC_PCI_2MB_SIZE) {
470
471 mem_ptr0 = pci_ioremap_bar(pdev, 0);
472 if (mem_ptr0 == NULL) {
473 dev_err(&pdev->dev, "failed to map PCI bar 0\n");
474 return -EIO;
475 }
476 pci_len0 = mem_len;
477 } else {
478 return -EIO;
479 }
480
481 dev_info(&pdev->dev, "%dMB memory map\n", (int)(mem_len>>20));
482
483 adapter->ahw.pci_base0 = mem_ptr0;
484 adapter->ahw.pci_len0 = pci_len0;
485
486 adapter->ahw.ocm_win_crb = qlcnic_get_ioaddr(adapter,
487 QLCNIC_PCIX_PS_REG(PCIX_OCM_WINDOW_REG(pci_func)));
488
489 return 0;
490}
491
492static void get_brd_name(struct qlcnic_adapter *adapter, char *name)
493{
494 struct pci_dev *pdev = adapter->pdev;
495 int i, found = 0;
496
497 for (i = 0; i < NUM_SUPPORTED_BOARDS; ++i) {
498 if (qlcnic_boards[i].vendor == pdev->vendor &&
499 qlcnic_boards[i].device == pdev->device &&
500 qlcnic_boards[i].sub_vendor == pdev->subsystem_vendor &&
501 qlcnic_boards[i].sub_device == pdev->subsystem_device) {
02f6e46f
SC		 502 sprintf(name, "%pM: %s" ,
503 adapter->mac_addr,
504 qlcnic_boards[i].short_name);
af19b491
AKS		 505 found = 1;
506 break;
507 }
508
509 }
510
511 if (!found)
512 name = "Unknown";
513}
514
515static void
516qlcnic_check_options(struct qlcnic_adapter *adapter)
517{
518 u32 fw_major, fw_minor, fw_build;
519 char brd_name[QLCNIC_MAX_BOARD_NAME_LEN];
520 char serial_num[32];
521 int i, offset, val;
522 int *ptr32;
523 struct pci_dev *pdev = adapter->pdev;
524
525 adapter->driver_mismatch = 0;
526
527 ptr32 = (int *)&serial_num;
528 offset = QLCNIC_FW_SERIAL_NUM_OFFSET;
529 for (i = 0; i < 8; i++) {
530 if (qlcnic_rom_fast_read(adapter, offset, &val) == -1) {
531 dev_err(&pdev->dev, "error reading board info\n");
532 adapter->driver_mismatch = 1;
533 return;
534 }
535 ptr32[i] = cpu_to_le32(val);
536 offset += sizeof(u32);
537 }
538
539 fw_major = QLCRD32(adapter, QLCNIC_FW_VERSION_MAJOR);
540 fw_minor = QLCRD32(adapter, QLCNIC_FW_VERSION_MINOR);
541 fw_build = QLCRD32(adapter, QLCNIC_FW_VERSION_SUB);
542
543 adapter->fw_version = QLCNIC_VERSION_CODE(fw_major, fw_minor, fw_build);
544
545 if (adapter->portnum == 0) {
546 get_brd_name(adapter, brd_name);
547
548 pr_info("%s: %s Board Chip rev 0x%x\n",
549 module_name(THIS_MODULE),
550 brd_name, adapter->ahw.revision_id);
551 }
552
251a84c9
AKS		 553 dev_info(&pdev->dev, "firmware v%d.%d.%d\n",
554 fw_major, fw_minor, fw_build);
af19b491 555
251a84c9 556 adapter->capabilities = QLCRD32(adapter, CRB_FW_CAPABILITIES_1);
af19b491
AKS		 557
558 adapter->flags &= ~QLCNIC_LRO_ENABLED;
559
560 if (adapter->ahw.port_type == QLCNIC_XGBE) {
561 adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_10G;
562 adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_10G;
563 } else if (adapter->ahw.port_type == QLCNIC_GBE) {
564 adapter->num_rxd = DEFAULT_RCV_DESCRIPTORS_1G;
565 adapter->num_jumbo_rxd = MAX_JUMBO_RCV_DESCRIPTORS_1G;
566 }
567
568 adapter->msix_supported = !!use_msi_x;
569 adapter->rss_supported = !!use_msi_x;
570
571 adapter->num_txd = MAX_CMD_DESCRIPTORS;
572
af19b491
AKS		 573 adapter->max_rds_rings = 2;
574}
575
576static int
577qlcnic_start_firmware(struct qlcnic_adapter *adapter)
578{
579 int val, err, first_boot;
580
aa5e18c0
SC		 581 err = qlcnic_can_start_firmware(adapter);
582 if (err < 0)
583 return err;
584 else if (!err)
af19b491
AKS		 585 goto wait_init;
586
587 first_boot = QLCRD32(adapter, QLCNIC_CAM_RAM(0x1fc));
588 if (first_boot == 0x55555555)
589 /* This is the first boot after power up */
590 QLCWR32(adapter, QLCNIC_CAM_RAM(0x1fc), QLCNIC_BDINFO_MAGIC);
591
4d5bdb38
AKS		 592 if (load_fw_file)
593 qlcnic_request_firmware(adapter);
594 else
595 adapter->fw_type = QLCNIC_FLASH_ROMIMAGE;
af19b491
AKS		 596
597 err = qlcnic_need_fw_reset(adapter);
598 if (err < 0)
599 goto err_out;
600 if (err == 0)
601 goto wait_init;
602
603 if (first_boot != 0x55555555) {
604 QLCWR32(adapter, CRB_CMDPEG_STATE, 0);
605 qlcnic_pinit_from_rom(adapter);
606 msleep(1);
607 }
608
af19b491
AKS		 609 QLCWR32(adapter, QLCNIC_PEG_HALT_STATUS1, 0);
610 QLCWR32(adapter, QLCNIC_PEG_HALT_STATUS2, 0);
611
612 qlcnic_set_port_mode(adapter);
613
614 err = qlcnic_load_firmware(adapter);
615 if (err)
616 goto err_out;
617
618 qlcnic_release_firmware(adapter);
619
620 val = (_QLCNIC_LINUX_MAJOR << 16)
621 | ((_QLCNIC_LINUX_MINOR << 8))
622 | (_QLCNIC_LINUX_SUBVERSION);
623 QLCWR32(adapter, CRB_DRIVER_VERSION, val);
624
625wait_init:
626 /* Handshake with the card before we register the devices. */
627 err = qlcnic_phantom_init(adapter);
628 if (err)
629 goto err_out;
630
631 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_READY);
6df900e9 632 qlcnic_idc_debug_info(adapter, 1);
af19b491 633
af19b491
AKS		 634 qlcnic_check_options(adapter);
635
636 adapter->need_fw_reset = 0;
637
638 /* fall through and release firmware */
639
640err_out:
641 qlcnic_release_firmware(adapter);
642 return err;
643}
644
645static int
646qlcnic_request_irq(struct qlcnic_adapter *adapter)
647{
648 irq_handler_t handler;
649 struct qlcnic_host_sds_ring *sds_ring;
650 int err, ring;
651
652 unsigned long flags = 0;
653 struct net_device *netdev = adapter->netdev;
654 struct qlcnic_recv_context *recv_ctx = &adapter->recv_ctx;
655
7eb9855d
AKS		 656 if (adapter->diag_test == QLCNIC_INTERRUPT_TEST) {
657 handler = qlcnic_tmp_intr;
658 if (!QLCNIC_IS_MSI_FAMILY(adapter))
659 flags |= IRQF_SHARED;
660
661 } else {
662 if (adapter->flags & QLCNIC_MSIX_ENABLED)
663 handler = qlcnic_msix_intr;
664 else if (adapter->flags & QLCNIC_MSI_ENABLED)
665 handler = qlcnic_msi_intr;
666 else {
667 flags |= IRQF_SHARED;
668 handler = qlcnic_intr;
669 }
af19b491
AKS		 670 }
671 adapter->irq = netdev->irq;
672
673 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
674 sds_ring = &recv_ctx->sds_rings[ring];
675 sprintf(sds_ring->name, "%s[%d]", netdev->name, ring);
676 err = request_irq(sds_ring->irq, handler,
677 flags, sds_ring->name, sds_ring);
678 if (err)
679 return err;
680 }
681
682 return 0;
683}
684
685static void
686qlcnic_free_irq(struct qlcnic_adapter *adapter)
687{
688 int ring;
689 struct qlcnic_host_sds_ring *sds_ring;
690
691 struct qlcnic_recv_context *recv_ctx = &adapter->recv_ctx;
692
693 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
694 sds_ring = &recv_ctx->sds_rings[ring];
695 free_irq(sds_ring->irq, sds_ring);
696 }
697}
698
699static void
700qlcnic_init_coalesce_defaults(struct qlcnic_adapter *adapter)
701{
702 adapter->coal.flags = QLCNIC_INTR_DEFAULT;
703 adapter->coal.normal.data.rx_time_us =
704 QLCNIC_DEFAULT_INTR_COALESCE_RX_TIME_US;
705 adapter->coal.normal.data.rx_packets =
706 QLCNIC_DEFAULT_INTR_COALESCE_RX_PACKETS;
707 adapter->coal.normal.data.tx_time_us =
708 QLCNIC_DEFAULT_INTR_COALESCE_TX_TIME_US;
709 adapter->coal.normal.data.tx_packets =
710 QLCNIC_DEFAULT_INTR_COALESCE_TX_PACKETS;
711}
712
713static int
714__qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
715{
716 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
717 return -EIO;
718
719 qlcnic_set_multi(netdev);
720 qlcnic_fw_cmd_set_mtu(adapter, netdev->mtu);
721
722 adapter->ahw.linkup = 0;
723
724 if (adapter->max_sds_rings > 1)
725 qlcnic_config_rss(adapter, 1);
726
727 qlcnic_config_intr_coalesce(adapter);
728
729 if (adapter->capabilities & QLCNIC_FW_CAPABILITY_HW_LRO)
730 qlcnic_config_hw_lro(adapter, QLCNIC_LRO_ENABLED);
731
732 qlcnic_napi_enable(adapter);
733
734 qlcnic_linkevent_request(adapter, 1);
735
736 set_bit(__QLCNIC_DEV_UP, &adapter->state);
737 return 0;
738}
739
740/* Usage: During resume and firmware recovery module.*/
741
742static int
743qlcnic_up(struct qlcnic_adapter *adapter, struct net_device *netdev)
744{
745 int err = 0;
746
747 rtnl_lock();
748 if (netif_running(netdev))
749 err = __qlcnic_up(adapter, netdev);
750 rtnl_unlock();
751
752 return err;
753}
754
755static void
756__qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
757{
758 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
759 return;
760
761 if (!test_and_clear_bit(__QLCNIC_DEV_UP, &adapter->state))
762 return;
763
764 smp_mb();
765 spin_lock(&adapter->tx_clean_lock);
766 netif_carrier_off(netdev);
767 netif_tx_disable(netdev);
768
769 qlcnic_free_mac_list(adapter);
770
771 qlcnic_nic_set_promisc(adapter, QLCNIC_NIU_NON_PROMISC_MODE);
772
773 qlcnic_napi_disable(adapter);
774
775 qlcnic_release_tx_buffers(adapter);
776 spin_unlock(&adapter->tx_clean_lock);
777}
778
779/* Usage: During suspend and firmware recovery module */
780
781static void
782qlcnic_down(struct qlcnic_adapter *adapter, struct net_device *netdev)
783{
784 rtnl_lock();
785 if (netif_running(netdev))
786 __qlcnic_down(adapter, netdev);
787 rtnl_unlock();
788
789}
790
791static int
792qlcnic_attach(struct qlcnic_adapter *adapter)
793{
794 struct net_device *netdev = adapter->netdev;
795 struct pci_dev *pdev = adapter->pdev;
796 int err, ring;
797 struct qlcnic_host_rds_ring *rds_ring;
798
799 if (adapter->is_up == QLCNIC_ADAPTER_UP_MAGIC)
800 return 0;
801
802 err = qlcnic_init_firmware(adapter);
803 if (err)
804 return err;
805
806 err = qlcnic_napi_add(adapter, netdev);
807 if (err)
808 return err;
809
810 err = qlcnic_alloc_sw_resources(adapter);
811 if (err) {
812 dev_err(&pdev->dev, "Error in setting sw resources\n");
813 return err;
814 }
815
816 err = qlcnic_alloc_hw_resources(adapter);
817 if (err) {
818 dev_err(&pdev->dev, "Error in setting hw resources\n");
819 goto err_out_free_sw;
820 }
821
822
823 for (ring = 0; ring < adapter->max_rds_rings; ring++) {
824 rds_ring = &adapter->recv_ctx.rds_rings[ring];
825 qlcnic_post_rx_buffers(adapter, ring, rds_ring);
826 }
827
828 err = qlcnic_request_irq(adapter);
829 if (err) {
830 dev_err(&pdev->dev, "failed to setup interrupt\n");
831 goto err_out_free_rxbuf;
832 }
833
834 qlcnic_init_coalesce_defaults(adapter);
835
836 qlcnic_create_sysfs_entries(adapter);
837
838 adapter->is_up = QLCNIC_ADAPTER_UP_MAGIC;
839 return 0;
840
841err_out_free_rxbuf:
842 qlcnic_release_rx_buffers(adapter);
843 qlcnic_free_hw_resources(adapter);
844err_out_free_sw:
845 qlcnic_free_sw_resources(adapter);
846 return err;
847}
848
849static void
850qlcnic_detach(struct qlcnic_adapter *adapter)
851{
852 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
853 return;
854
855 qlcnic_remove_sysfs_entries(adapter);
856
857 qlcnic_free_hw_resources(adapter);
858 qlcnic_release_rx_buffers(adapter);
859 qlcnic_free_irq(adapter);
860 qlcnic_napi_del(adapter);
861 qlcnic_free_sw_resources(adapter);
862
863 adapter->is_up = 0;
864}
865
7eb9855d
AKS		 866void qlcnic_diag_free_res(struct net_device *netdev, int max_sds_rings)
867{
868 struct qlcnic_adapter *adapter = netdev_priv(netdev);
869 struct qlcnic_host_sds_ring *sds_ring;
870 int ring;
871
78ad3892 872 clear_bit(__QLCNIC_DEV_UP, &adapter->state);
cdaff185
AKS		 873 if (adapter->diag_test == QLCNIC_INTERRUPT_TEST) {
874 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
875 sds_ring = &adapter->recv_ctx.sds_rings[ring];
876 qlcnic_disable_int(sds_ring);
877 }
7eb9855d
AKS		 878 }
879
880 qlcnic_detach(adapter);
881
882 adapter->diag_test = 0;
883 adapter->max_sds_rings = max_sds_rings;
884
885 if (qlcnic_attach(adapter))
34ce3626 886 goto out;
7eb9855d
AKS		 887
888 if (netif_running(netdev))
889 __qlcnic_up(adapter, netdev);
34ce3626 890out:
7eb9855d
AKS		 891 netif_device_attach(netdev);
892}
893
894int qlcnic_diag_alloc_res(struct net_device *netdev, int test)
895{
896 struct qlcnic_adapter *adapter = netdev_priv(netdev);
897 struct qlcnic_host_sds_ring *sds_ring;
898 int ring;
899 int ret;
900
901 netif_device_detach(netdev);
902
903 if (netif_running(netdev))
904 __qlcnic_down(adapter, netdev);
905
906 qlcnic_detach(adapter);
907
908 adapter->max_sds_rings = 1;
909 adapter->diag_test = test;
910
911 ret = qlcnic_attach(adapter);
34ce3626
AKS		 912 if (ret) {
913 netif_device_attach(netdev);
7eb9855d 914 return ret;
34ce3626 915 }
7eb9855d 916
cdaff185
AKS		 917 if (adapter->diag_test == QLCNIC_INTERRUPT_TEST) {
918 for (ring = 0; ring < adapter->max_sds_rings; ring++) {
919 sds_ring = &adapter->recv_ctx.sds_rings[ring];
920 qlcnic_enable_int(sds_ring);
921 }
7eb9855d 922 }
78ad3892 923 set_bit(__QLCNIC_DEV_UP, &adapter->state);
7eb9855d
AKS		 924
925 return 0;
926}
927
af19b491
AKS		 928int
929qlcnic_reset_context(struct qlcnic_adapter *adapter)
930{
931 int err = 0;
932 struct net_device *netdev = adapter->netdev;
933
934 if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
935 return -EBUSY;
936
937 if (adapter->is_up == QLCNIC_ADAPTER_UP_MAGIC) {
938
939 netif_device_detach(netdev);
940
941 if (netif_running(netdev))
942 __qlcnic_down(adapter, netdev);
943
944 qlcnic_detach(adapter);
945
946 if (netif_running(netdev)) {
947 err = qlcnic_attach(adapter);
948 if (!err)
34ce3626 949 __qlcnic_up(adapter, netdev);
af19b491
AKS		 950 }
951
952 netif_device_attach(netdev);
953 }
954
af19b491
AKS		 955 clear_bit(__QLCNIC_RESETTING, &adapter->state);
956 return err;
957}
958
959static int
960qlcnic_setup_netdev(struct qlcnic_adapter *adapter,
1bb09fb9 961 struct net_device *netdev, u8 pci_using_dac)
af19b491
AKS		 962{
963 int err;
964 struct pci_dev *pdev = adapter->pdev;
965
966 adapter->rx_csum = 1;
967 adapter->mc_enabled = 0;
968 adapter->max_mc_count = 38;
969
970 netdev->netdev_ops = &qlcnic_netdev_ops;
971 netdev->watchdog_timeo = 2*HZ;
972
973 qlcnic_change_mtu(netdev, netdev->mtu);
974
975 SET_ETHTOOL_OPS(netdev, &qlcnic_ethtool_ops);
976
977 netdev->features |= (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_TSO);
978 netdev->features |= (NETIF_F_GRO);
979 netdev->vlan_features |= (NETIF_F_SG | NETIF_F_IP_CSUM | NETIF_F_TSO);
980
981 netdev->features |= (NETIF_F_IPV6_CSUM | NETIF_F_TSO6);
982 netdev->vlan_features |= (NETIF_F_IPV6_CSUM | NETIF_F_TSO6);
983
1bb09fb9 984 if (pci_using_dac) {
af19b491
AKS		 985 netdev->features |= NETIF_F_HIGHDMA;
986 netdev->vlan_features |= NETIF_F_HIGHDMA;
987 }
988
989 if (adapter->capabilities & QLCNIC_FW_CAPABILITY_FVLANTX)
990 netdev->features |= (NETIF_F_HW_VLAN_TX);
991
992 if (adapter->capabilities & QLCNIC_FW_CAPABILITY_HW_LRO)
993 netdev->features |= NETIF_F_LRO;
994
995 netdev->irq = adapter->msix_entries[0].vector;
996
997 INIT_WORK(&adapter->tx_timeout_task, qlcnic_tx_timeout_task);
998
999 if (qlcnic_read_mac_addr(adapter))
1000 dev_warn(&pdev->dev, "failed to read mac addr\n");
1001
1002 netif_carrier_off(netdev);
1003 netif_stop_queue(netdev);
1004
1005 err = register_netdev(netdev);
1006 if (err) {
1007 dev_err(&pdev->dev, "failed to register net device\n");
1008 return err;
1009 }
1010
1011 return 0;
1012}
1013
1bb09fb9
AKS		 1014static int qlcnic_set_dma_mask(struct pci_dev *pdev, u8 *pci_using_dac)
1015{
1016 if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(64)) &&
1017 !pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)))
1018 *pci_using_dac = 1;
1019 else if (!pci_set_dma_mask(pdev, DMA_BIT_MASK(32)) &&
1020 !pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)))
1021 *pci_using_dac = 0;
1022 else {
1023 dev_err(&pdev->dev, "Unable to set DMA mask, aborting\n");
1024 return -EIO;
1025 }
1026
1027 return 0;
1028}
1029
af19b491
AKS		 1030static int __devinit
1031qlcnic_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
1032{
1033 struct net_device *netdev = NULL;
1034 struct qlcnic_adapter *adapter = NULL;
1035 int err;
1036 int pci_func_id = PCI_FUNC(pdev->devfn);
1037 uint8_t revision_id;
1bb09fb9 1038 uint8_t pci_using_dac;
af19b491
AKS		 1039
1040 err = pci_enable_device(pdev);
1041 if (err)
1042 return err;
1043
1044 if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
1045 err = -ENODEV;
1046 goto err_out_disable_pdev;
1047 }
1048
1bb09fb9
AKS		 1049 err = qlcnic_set_dma_mask(pdev, &pci_using_dac);
1050 if (err)
1051 goto err_out_disable_pdev;
1052
af19b491
AKS		 1053 err = pci_request_regions(pdev, qlcnic_driver_name);
1054 if (err)
1055 goto err_out_disable_pdev;
1056
1057 pci_set_master(pdev);
1058
1059 netdev = alloc_etherdev(sizeof(struct qlcnic_adapter));
1060 if (!netdev) {
1061 dev_err(&pdev->dev, "failed to allocate net_device\n");
1062 err = -ENOMEM;
1063 goto err_out_free_res;
1064 }
1065
1066 SET_NETDEV_DEV(netdev, &pdev->dev);
1067
1068 adapter = netdev_priv(netdev);
1069 adapter->netdev = netdev;
1070 adapter->pdev = pdev;
6df900e9 1071 adapter->dev_rst_time = jiffies;
af19b491
AKS		 1072 adapter->ahw.pci_func = pci_func_id;
1073
1074 revision_id = pdev->revision;
1075 adapter->ahw.revision_id = revision_id;
1076
1077 rwlock_init(&adapter->ahw.crb_lock);
1078 mutex_init(&adapter->ahw.mem_lock);
1079
1080 spin_lock_init(&adapter->tx_clean_lock);
1081 INIT_LIST_HEAD(&adapter->mac_list);
1082
1083 err = qlcnic_setup_pci_map(adapter);
1084 if (err)
1085 goto err_out_free_netdev;
1086
1087 /* This will be reset for mezz cards */
1088 adapter->portnum = pci_func_id;
1089
1090 err = qlcnic_get_board_info(adapter);
1091 if (err) {
1092 dev_err(&pdev->dev, "Error getting board config info.\n");
1093 goto err_out_iounmap;
1094 }
1095
02f6e46f
SC		 1096 if (qlcnic_read_mac_addr(adapter))
1097 dev_warn(&pdev->dev, "failed to read mac addr\n");
1098
b3a24649
SC		 1099 if (qlcnic_setup_idc_param(adapter))
1100 goto err_out_iounmap;
af19b491
AKS		 1101
1102 err = qlcnic_start_firmware(adapter);
1103 if (err)
1104 goto err_out_decr_ref;
1105
af19b491
AKS		 1106 qlcnic_clear_stats(adapter);
1107
1108 qlcnic_setup_intr(adapter);
1109
1bb09fb9 1110 err = qlcnic_setup_netdev(adapter, netdev, pci_using_dac);
af19b491
AKS		 1111 if (err)
1112 goto err_out_disable_msi;
1113
1114 pci_set_drvdata(pdev, adapter);
1115
1116 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
1117
1118 switch (adapter->ahw.port_type) {
1119 case QLCNIC_GBE:
1120 dev_info(&adapter->pdev->dev, "%s: GbE port initialized\n",
1121 adapter->netdev->name);
1122 break;
1123 case QLCNIC_XGBE:
1124 dev_info(&adapter->pdev->dev, "%s: XGbE port initialized\n",
1125 adapter->netdev->name);
1126 break;
1127 }
1128
1129 qlcnic_create_diag_entries(adapter);
1130
1131 return 0;
1132
1133err_out_disable_msi:
1134 qlcnic_teardown_intr(adapter);
1135
1136err_out_decr_ref:
1137 qlcnic_clr_all_drv_state(adapter);
1138
1139err_out_iounmap:
1140 qlcnic_cleanup_pci_map(adapter);
1141
1142err_out_free_netdev:
1143 free_netdev(netdev);
1144
1145err_out_free_res:
1146 pci_release_regions(pdev);
1147
1148err_out_disable_pdev:
1149 pci_set_drvdata(pdev, NULL);
1150 pci_disable_device(pdev);
1151 return err;
1152}
1153
1154static void __devexit qlcnic_remove(struct pci_dev *pdev)
1155{
1156 struct qlcnic_adapter *adapter;
1157 struct net_device *netdev;
1158
1159 adapter = pci_get_drvdata(pdev);
1160 if (adapter == NULL)
1161 return;
1162
1163 netdev = adapter->netdev;
1164
1165 qlcnic_cancel_fw_work(adapter);
1166
1167 unregister_netdev(netdev);
1168
1169 cancel_work_sync(&adapter->tx_timeout_task);
1170
1171 qlcnic_detach(adapter);
1172
1173 qlcnic_clr_all_drv_state(adapter);
1174
1175 clear_bit(__QLCNIC_RESETTING, &adapter->state);
1176
1177 qlcnic_teardown_intr(adapter);
1178
1179 qlcnic_remove_diag_entries(adapter);
1180
1181 qlcnic_cleanup_pci_map(adapter);
1182
1183 qlcnic_release_firmware(adapter);
1184
1185 pci_release_regions(pdev);
1186 pci_disable_device(pdev);
1187 pci_set_drvdata(pdev, NULL);
1188
1189 free_netdev(netdev);
1190}
1191static int __qlcnic_shutdown(struct pci_dev *pdev)
1192{
1193 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
1194 struct net_device *netdev = adapter->netdev;
1195 int retval;
1196
1197 netif_device_detach(netdev);
1198
1199 qlcnic_cancel_fw_work(adapter);
1200
1201 if (netif_running(netdev))
1202 qlcnic_down(adapter, netdev);
1203
1204 cancel_work_sync(&adapter->tx_timeout_task);
1205
1206 qlcnic_detach(adapter);
1207
1208 qlcnic_clr_all_drv_state(adapter);
1209
1210 clear_bit(__QLCNIC_RESETTING, &adapter->state);
1211
1212 retval = pci_save_state(pdev);
1213 if (retval)
1214 return retval;
1215
1216 if (qlcnic_wol_supported(adapter)) {
1217 pci_enable_wake(pdev, PCI_D3cold, 1);
1218 pci_enable_wake(pdev, PCI_D3hot, 1);
1219 }
1220
1221 return 0;
1222}
1223
1224static void qlcnic_shutdown(struct pci_dev *pdev)
1225{
1226 if (__qlcnic_shutdown(pdev))
1227 return;
1228
1229 pci_disable_device(pdev);
1230}
1231
1232#ifdef CONFIG_PM
1233static int
1234qlcnic_suspend(struct pci_dev *pdev, pm_message_t state)
1235{
1236 int retval;
1237
1238 retval = __qlcnic_shutdown(pdev);
1239 if (retval)
1240 return retval;
1241
1242 pci_set_power_state(pdev, pci_choose_state(pdev, state));
1243 return 0;
1244}
1245
1246static int
1247qlcnic_resume(struct pci_dev *pdev)
1248{
1249 struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
1250 struct net_device *netdev = adapter->netdev;
1251 int err;
1252
1253 err = pci_enable_device(pdev);
1254 if (err)
1255 return err;
1256
1257 pci_set_power_state(pdev, PCI_D0);
1258 pci_set_master(pdev);
1259 pci_restore_state(pdev);
1260
af19b491
AKS		 1261 err = qlcnic_start_firmware(adapter);
1262 if (err) {
1263 dev_err(&pdev->dev, "failed to start firmware\n");
1264 return err;
1265 }
1266
1267 if (netif_running(netdev)) {
1268 err = qlcnic_attach(adapter);
1269 if (err)
1270 goto err_out;
1271
1272 err = qlcnic_up(adapter, netdev);
1273 if (err)
1274 goto err_out_detach;
1275
1276
1277 qlcnic_config_indev_addr(netdev, NETDEV_UP);
1278 }
1279
1280 netif_device_attach(netdev);
1281 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
1282 return 0;
1283
1284err_out_detach:
1285 qlcnic_detach(adapter);
1286err_out:
1287 qlcnic_clr_all_drv_state(adapter);
34ce3626 1288 netif_device_attach(netdev);
af19b491
AKS		 1289 return err;
1290}
1291#endif
1292
1293static int qlcnic_open(struct net_device *netdev)
1294{
1295 struct qlcnic_adapter *adapter = netdev_priv(netdev);
1296 int err;
1297
1298 if (adapter->driver_mismatch)
1299 return -EIO;
1300
1301 err = qlcnic_attach(adapter);
1302 if (err)
1303 return err;
1304
1305 err = __qlcnic_up(adapter, netdev);
1306 if (err)
1307 goto err_out;
1308
1309 netif_start_queue(netdev);
1310
1311 return 0;
1312
1313err_out:
1314 qlcnic_detach(adapter);
1315 return err;
1316}
1317
1318/*
1319 * qlcnic_close - Disables a network interface entry point
1320 */
1321static int qlcnic_close(struct net_device *netdev)
1322{
1323 struct qlcnic_adapter *adapter = netdev_priv(netdev);
1324
1325 __qlcnic_down(adapter, netdev);
1326 return 0;
1327}
1328
1329static void
1330qlcnic_tso_check(struct net_device *netdev,
1331 struct qlcnic_host_tx_ring *tx_ring,
1332 struct cmd_desc_type0 *first_desc,
1333 struct sk_buff *skb)
1334{
1335 u8 opcode = TX_ETHER_PKT;
1336 __be16 protocol = skb->protocol;
1337 u16 flags = 0, vid = 0;
1338 u32 producer;
1339 int copied, offset, copy_len, hdr_len = 0, tso = 0, vlan_oob = 0;
1340 struct cmd_desc_type0 *hwdesc;
1341 struct vlan_ethhdr *vh;
8bfe8b91 1342 struct qlcnic_adapter *adapter = netdev_priv(netdev);
af19b491
AKS		 1343
1344 if (protocol == cpu_to_be16(ETH_P_8021Q)) {
1345
1346 vh = (struct vlan_ethhdr *)skb->data;
1347 protocol = vh->h_vlan_encapsulated_proto;
1348 flags = FLAGS_VLAN_TAGGED;
1349
1350 } else if (vlan_tx_tag_present(skb)) {
1351
1352 flags = FLAGS_VLAN_OOB;
1353 vid = vlan_tx_tag_get(skb);
1354 qlcnic_set_tx_vlan_tci(first_desc, vid);
1355 vlan_oob = 1;
1356 }
1357
1358 if ((netdev->features & (NETIF_F_TSO | NETIF_F_TSO6)) &&
1359 skb_shinfo(skb)->gso_size > 0) {
1360
1361 hdr_len = skb_transport_offset(skb) + tcp_hdrlen(skb);
1362
1363 first_desc->mss = cpu_to_le16(skb_shinfo(skb)->gso_size);
1364 first_desc->total_hdr_length = hdr_len;
1365 if (vlan_oob) {
1366 first_desc->total_hdr_length += VLAN_HLEN;
1367 first_desc->tcp_hdr_offset = VLAN_HLEN;
1368 first_desc->ip_hdr_offset = VLAN_HLEN;
1369 /* Only in case of TSO on vlan device */
1370 flags |= FLAGS_VLAN_TAGGED;
1371 }
1372
1373 opcode = (protocol == cpu_to_be16(ETH_P_IPV6)) ?
1374 TX_TCP_LSO6 : TX_TCP_LSO;
1375 tso = 1;
1376
1377 } else if (skb->ip_summed == CHECKSUM_PARTIAL) {
1378 u8 l4proto;
1379
1380 if (protocol == cpu_to_be16(ETH_P_IP)) {
1381 l4proto = ip_hdr(skb)->protocol;
1382
1383 if (l4proto == IPPROTO_TCP)
1384 opcode = TX_TCP_PKT;
1385 else if (l4proto == IPPROTO_UDP)
1386 opcode = TX_UDP_PKT;
1387 } else if (protocol == cpu_to_be16(ETH_P_IPV6)) {
1388 l4proto = ipv6_hdr(skb)->nexthdr;
1389
1390 if (l4proto == IPPROTO_TCP)
1391 opcode = TX_TCPV6_PKT;
1392 else if (l4proto == IPPROTO_UDP)
1393 opcode = TX_UDPV6_PKT;
1394 }
1395 }
1396
1397 first_desc->tcp_hdr_offset += skb_transport_offset(skb);
1398 first_desc->ip_hdr_offset += skb_network_offset(skb);
1399 qlcnic_set_tx_flags_opcode(first_desc, flags, opcode);
1400
1401 if (!tso)
1402 return;
1403
1404 /* For LSO, we need to copy the MAC/IP/TCP headers into
1405 * the descriptor ring
1406 */
1407 producer = tx_ring->producer;
1408 copied = 0;
1409 offset = 2;
1410
1411 if (vlan_oob) {
1412 /* Create a TSO vlan header template for firmware */
1413
1414 hwdesc = &tx_ring->desc_head[producer];
1415 tx_ring->cmd_buf_arr[producer].skb = NULL;
1416
1417 copy_len = min((int)sizeof(struct cmd_desc_type0) - offset,
1418 hdr_len + VLAN_HLEN);
1419
1420 vh = (struct vlan_ethhdr *)((char *)hwdesc + 2);
1421 skb_copy_from_linear_data(skb, vh, 12);
1422 vh->h_vlan_proto = htons(ETH_P_8021Q);
1423 vh->h_vlan_TCI = htons(vid);
1424 skb_copy_from_linear_data_offset(skb, 12,
1425 (char *)vh + 16, copy_len - 16);
1426
1427 copied = copy_len - VLAN_HLEN;
1428 offset = 0;
1429
1430 producer = get_next_index(producer, tx_ring->num_desc);
1431 }
1432
1433 while (copied < hdr_len) {
1434
1435 copy_len = min((int)sizeof(struct cmd_desc_type0) - offset,
1436 (hdr_len - copied));
1437
1438 hwdesc = &tx_ring->desc_head[producer];
1439 tx_ring->cmd_buf_arr[producer].skb = NULL;
1440
1441 skb_copy_from_linear_data_offset(skb, copied,
1442 (char *)hwdesc + offset, copy_len);
1443
1444 copied += copy_len;
1445 offset = 0;
1446
1447 producer = get_next_index(producer, tx_ring->num_desc);
1448 }
1449
1450 tx_ring->producer = producer;
1451 barrier();
8bfe8b91 1452 adapter->stats.lso_frames++;
af19b491
AKS		 1453}
1454
1455static int
1456qlcnic_map_tx_skb(struct pci_dev *pdev,
1457 struct sk_buff *skb, struct qlcnic_cmd_buffer *pbuf)
1458{
1459 struct qlcnic_skb_frag *nf;
1460 struct skb_frag_struct *frag;
1461 int i, nr_frags;
1462 dma_addr_t map;
1463
1464 nr_frags = skb_shinfo(skb)->nr_frags;
1465 nf = &pbuf->frag_array[0];
1466
1467 map = pci_map_single(pdev, skb->data,
1468 skb_headlen(skb), PCI_DMA_TODEVICE);
1469 if (pci_dma_mapping_error(pdev, map))
1470 goto out_err;
1471
1472 nf->dma = map;
1473 nf->length = skb_headlen(skb);
1474
1475 for (i = 0; i < nr_frags; i++) {
1476 frag = &skb_shinfo(skb)->frags[i];
1477 nf = &pbuf->frag_array[i+1];
1478
1479 map = pci_map_page(pdev, frag->page, frag->page_offset,
1480 frag->size, PCI_DMA_TODEVICE);
1481 if (pci_dma_mapping_error(pdev, map))
1482 goto unwind;
1483
1484 nf->dma = map;
1485 nf->length = frag->size;
1486 }
1487
1488 return 0;
1489
1490unwind:
1491 while (--i >= 0) {
1492 nf = &pbuf->frag_array[i+1];
1493 pci_unmap_page(pdev, nf->dma, nf->length, PCI_DMA_TODEVICE);
1494 }
1495
1496 nf = &pbuf->frag_array[0];
1497 pci_unmap_single(pdev, nf->dma, skb_headlen(skb), PCI_DMA_TODEVICE);
1498
1499out_err:
1500 return -ENOMEM;
1501}
1502
1503static inline void
1504qlcnic_clear_cmddesc(u64 *desc)
1505{
1506 desc[0] = 0ULL;
1507 desc[2] = 0ULL;
1508}
1509
cdaff185 1510netdev_tx_t
af19b491
AKS		 1511qlcnic_xmit_frame(struct sk_buff *skb, struct net_device *netdev)
1512{
1513 struct qlcnic_adapter *adapter = netdev_priv(netdev);
1514 struct qlcnic_host_tx_ring *tx_ring = adapter->tx_ring;
1515 struct qlcnic_cmd_buffer *pbuf;
1516 struct qlcnic_skb_frag *buffrag;
1517 struct cmd_desc_type0 *hwdesc, *first_desc;
1518 struct pci_dev *pdev;
1519 int i, k;
1520
1521 u32 producer;
1522 int frag_count, no_of_desc;
1523 u32 num_txd = tx_ring->num_desc;
1524
780ab790
AKS		 1525 if (!test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
1526 netif_stop_queue(netdev);
1527 return NETDEV_TX_BUSY;
1528 }
1529
af19b491
AKS		 1530 frag_count = skb_shinfo(skb)->nr_frags + 1;
1531
1532 /* 4 fragments per cmd des */
1533 no_of_desc = (frag_count + 3) >> 2;
1534
1535 if (unlikely(no_of_desc + 2 > qlcnic_tx_avail(tx_ring))) {
1536 netif_stop_queue(netdev);
8bfe8b91 1537 adapter->stats.xmit_off++;
af19b491
AKS		 1538 return NETDEV_TX_BUSY;
1539 }
1540
1541 producer = tx_ring->producer;
1542 pbuf = &tx_ring->cmd_buf_arr[producer];
1543
1544 pdev = adapter->pdev;
1545
8ae6df97
AKS		 1546 if (qlcnic_map_tx_skb(pdev, skb, pbuf)) {
1547 adapter->stats.tx_dma_map_error++;
af19b491 1548 goto drop_packet;
8ae6df97 1549 }
af19b491
AKS		 1550
1551 pbuf->skb = skb;
1552 pbuf->frag_count = frag_count;
1553
1554 first_desc = hwdesc = &tx_ring->desc_head[producer];
1555 qlcnic_clear_cmddesc((u64 *)hwdesc);
1556
1557 qlcnic_set_tx_frags_len(first_desc, frag_count, skb->len);
1558 qlcnic_set_tx_port(first_desc, adapter->portnum);
1559
1560 for (i = 0; i < frag_count; i++) {
1561
1562 k = i % 4;
1563
1564 if ((k == 0) && (i > 0)) {
1565 /* move to next desc.*/
1566 producer = get_next_index(producer, num_txd);
1567 hwdesc = &tx_ring->desc_head[producer];
1568 qlcnic_clear_cmddesc((u64 *)hwdesc);
1569 tx_ring->cmd_buf_arr[producer].skb = NULL;
1570 }
1571
1572 buffrag = &pbuf->frag_array[i];
1573
1574 hwdesc->buffer_length[k] = cpu_to_le16(buffrag->length);
1575 switch (k) {
1576 case 0:
1577 hwdesc->addr_buffer1 = cpu_to_le64(buffrag->dma);
1578 break;
1579 case 1:
1580 hwdesc->addr_buffer2 = cpu_to_le64(buffrag->dma);
1581 break;
1582 case 2:
1583 hwdesc->addr_buffer3 = cpu_to_le64(buffrag->dma);
1584 break;
1585 case 3:
1586 hwdesc->addr_buffer4 = cpu_to_le64(buffrag->dma);
1587 break;
1588 }
1589 }
1590
1591 tx_ring->producer = get_next_index(producer, num_txd);
1592
1593 qlcnic_tso_check(netdev, tx_ring, first_desc, skb);
1594
1595 qlcnic_update_cmd_producer(adapter, tx_ring);
1596
1597 adapter->stats.txbytes += skb->len;
1598 adapter->stats.xmitcalled++;
1599
1600 return NETDEV_TX_OK;
1601
1602drop_packet:
1603 adapter->stats.txdropped++;
1604 dev_kfree_skb_any(skb);
1605 return NETDEV_TX_OK;
1606}
1607
1608static int qlcnic_check_temp(struct qlcnic_adapter *adapter)
1609{
1610 struct net_device *netdev = adapter->netdev;
1611 u32 temp, temp_state, temp_val;
1612 int rv = 0;
1613
1614 temp = QLCRD32(adapter, CRB_TEMP_STATE);
1615
1616 temp_state = qlcnic_get_temp_state(temp);
1617 temp_val = qlcnic_get_temp_val(temp);
1618
1619 if (temp_state == QLCNIC_TEMP_PANIC) {
1620 dev_err(&netdev->dev,
1621 "Device temperature %d degrees C exceeds"
1622 " maximum allowed. Hardware has been shut down.\n",
1623 temp_val);
1624 rv = 1;
1625 } else if (temp_state == QLCNIC_TEMP_WARN) {
1626 if (adapter->temp == QLCNIC_TEMP_NORMAL) {
1627 dev_err(&netdev->dev,
1628 "Device temperature %d degrees C "
1629 "exceeds operating range."
1630 " Immediate action needed.\n",
1631 temp_val);
1632 }
1633 } else {
1634 if (adapter->temp == QLCNIC_TEMP_WARN) {
1635 dev_info(&netdev->dev,
1636 "Device temperature is now %d degrees C"
1637 " in normal range.\n", temp_val);
1638 }
1639 }
1640 adapter->temp = temp_state;
1641 return rv;
1642}
1643
1644void qlcnic_advert_link_change(struct qlcnic_adapter *adapter, int linkup)
1645{
1646 struct net_device *netdev = adapter->netdev;
1647
1648 if (adapter->ahw.linkup && !linkup) {
1649 dev_info(&netdev->dev, "NIC Link is down\n");
1650 adapter->ahw.linkup = 0;
1651 if (netif_running(netdev)) {
1652 netif_carrier_off(netdev);
1653 netif_stop_queue(netdev);
1654 }
1655 } else if (!adapter->ahw.linkup && linkup) {
1656 dev_info(&netdev->dev, "NIC Link is up\n");
1657 adapter->ahw.linkup = 1;
1658 if (netif_running(netdev)) {
1659 netif_carrier_on(netdev);
1660 netif_wake_queue(netdev);
1661 }
1662 }
1663}
1664
1665static void qlcnic_tx_timeout(struct net_device *netdev)
1666{
1667 struct qlcnic_adapter *adapter = netdev_priv(netdev);
1668
1669 if (test_bit(__QLCNIC_RESETTING, &adapter->state))
1670 return;
1671
1672 dev_err(&netdev->dev, "transmit timeout, resetting.\n");
1673 schedule_work(&adapter->tx_timeout_task);
1674}
1675
1676static void qlcnic_tx_timeout_task(struct work_struct *work)
1677{
1678 struct qlcnic_adapter *adapter =
1679 container_of(work, struct qlcnic_adapter, tx_timeout_task);
1680
1681 if (!netif_running(adapter->netdev))
1682 return;
1683
1684 if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
1685 return;
1686
1687 if (++adapter->tx_timeo_cnt >= QLCNIC_MAX_TX_TIMEOUTS)
1688 goto request_reset;
1689
1690 clear_bit(__QLCNIC_RESETTING, &adapter->state);
1691 if (!qlcnic_reset_context(adapter)) {
1692 adapter->netdev->trans_start = jiffies;
1693 return;
1694
1695 /* context reset failed, fall through for fw reset */
1696 }
1697
1698request_reset:
1699 adapter->need_fw_reset = 1;
1700 clear_bit(__QLCNIC_RESETTING, &adapter->state);
65b5b420 1701 QLCDB(adapter, DRV, "Resetting adapter\n");
af19b491
AKS		 1702}
1703
1704static struct net_device_stats *qlcnic_get_stats(struct net_device *netdev)
1705{
1706 struct qlcnic_adapter *adapter = netdev_priv(netdev);
1707 struct net_device_stats *stats = &netdev->stats;
1708
1709 memset(stats, 0, sizeof(*stats));
1710
1711 stats->rx_packets = adapter->stats.rx_pkts + adapter->stats.lro_pkts;
1712 stats->tx_packets = adapter->stats.xmitfinished;
7e382594 1713 stats->rx_bytes = adapter->stats.rxbytes + adapter->stats.lrobytes;
af19b491
AKS		 1714 stats->tx_bytes = adapter->stats.txbytes;
1715 stats->rx_dropped = adapter->stats.rxdropped;
1716 stats->tx_dropped = adapter->stats.txdropped;
1717
1718 return stats;
1719}
1720
7eb9855d 1721static irqreturn_t qlcnic_clear_legacy_intr(struct qlcnic_adapter *adapter)
af19b491 1722{
af19b491
AKS		 1723 u32 status;
1724
1725 status = readl(adapter->isr_int_vec);
1726
1727 if (!(status & adapter->int_vec_bit))
1728 return IRQ_NONE;
1729
1730 /* check interrupt state machine, to be sure */
1731 status = readl(adapter->crb_int_state_reg);
1732 if (!ISR_LEGACY_INT_TRIGGERED(status))
1733 return IRQ_NONE;
1734
1735 writel(0xffffffff, adapter->tgt_status_reg);
1736 /* read twice to ensure write is flushed */
1737 readl(adapter->isr_int_vec);
1738 readl(adapter->isr_int_vec);
1739
7eb9855d
AKS		 1740 return IRQ_HANDLED;
1741}
1742
1743static irqreturn_t qlcnic_tmp_intr(int irq, void *data)
1744{
1745 struct qlcnic_host_sds_ring *sds_ring = data;
1746 struct qlcnic_adapter *adapter = sds_ring->adapter;
1747
1748 if (adapter->flags & QLCNIC_MSIX_ENABLED)
1749 goto done;
1750 else if (adapter->flags & QLCNIC_MSI_ENABLED) {
1751 writel(0xffffffff, adapter->tgt_status_reg);
1752 goto done;
1753 }
1754
1755 if (qlcnic_clear_legacy_intr(adapter) == IRQ_NONE)
1756 return IRQ_NONE;
1757
1758done:
1759 adapter->diag_cnt++;
1760 qlcnic_enable_int(sds_ring);
1761 return IRQ_HANDLED;
1762}
1763
1764static irqreturn_t qlcnic_intr(int irq, void *data)
1765{
1766 struct qlcnic_host_sds_ring *sds_ring = data;
1767 struct qlcnic_adapter *adapter = sds_ring->adapter;
1768
1769 if (qlcnic_clear_legacy_intr(adapter) == IRQ_NONE)
1770 return IRQ_NONE;
1771
af19b491
AKS		 1772 napi_schedule(&sds_ring->napi);
1773
1774 return IRQ_HANDLED;
1775}
1776
1777static irqreturn_t qlcnic_msi_intr(int irq, void *data)
1778{
1779 struct qlcnic_host_sds_ring *sds_ring = data;
1780 struct qlcnic_adapter *adapter = sds_ring->adapter;
1781
1782 /* clear interrupt */
1783 writel(0xffffffff, adapter->tgt_status_reg);
1784
1785 napi_schedule(&sds_ring->napi);
1786 return IRQ_HANDLED;
1787}
1788
1789static irqreturn_t qlcnic_msix_intr(int irq, void *data)
1790{
1791 struct qlcnic_host_sds_ring *sds_ring = data;
1792
1793 napi_schedule(&sds_ring->napi);
1794 return IRQ_HANDLED;
1795}
1796
1797static int qlcnic_process_cmd_ring(struct qlcnic_adapter *adapter)
1798{
1799 u32 sw_consumer, hw_consumer;
1800 int count = 0, i;
1801 struct qlcnic_cmd_buffer *buffer;
1802 struct pci_dev *pdev = adapter->pdev;
1803 struct net_device *netdev = adapter->netdev;
1804 struct qlcnic_skb_frag *frag;
1805 int done;
1806 struct qlcnic_host_tx_ring *tx_ring = adapter->tx_ring;
1807
1808 if (!spin_trylock(&adapter->tx_clean_lock))
1809 return 1;
1810
1811 sw_consumer = tx_ring->sw_consumer;
1812 hw_consumer = le32_to_cpu(*(tx_ring->hw_consumer));
1813
1814 while (sw_consumer != hw_consumer) {
1815 buffer = &tx_ring->cmd_buf_arr[sw_consumer];
1816 if (buffer->skb) {
1817 frag = &buffer->frag_array[0];
1818 pci_unmap_single(pdev, frag->dma, frag->length,
1819 PCI_DMA_TODEVICE);
1820 frag->dma = 0ULL;
1821 for (i = 1; i < buffer->frag_count; i++) {
1822 frag++;
1823 pci_unmap_page(pdev, frag->dma, frag->length,
1824 PCI_DMA_TODEVICE);
1825 frag->dma = 0ULL;
1826 }
1827
1828 adapter->stats.xmitfinished++;
1829 dev_kfree_skb_any(buffer->skb);
1830 buffer->skb = NULL;
1831 }
1832
1833 sw_consumer = get_next_index(sw_consumer, tx_ring->num_desc);
1834 if (++count >= MAX_STATUS_HANDLE)
1835 break;
1836 }
1837
1838 if (count && netif_running(netdev)) {
1839 tx_ring->sw_consumer = sw_consumer;
1840
1841 smp_mb();
1842
1843 if (netif_queue_stopped(netdev) && netif_carrier_ok(netdev)) {
1844 __netif_tx_lock(tx_ring->txq, smp_processor_id());
1845 if (qlcnic_tx_avail(tx_ring) > TX_STOP_THRESH) {
1846 netif_wake_queue(netdev);
1847 adapter->tx_timeo_cnt = 0;
8bfe8b91 1848 adapter->stats.xmit_on++;
af19b491
AKS		 1849 }
1850 __netif_tx_unlock(tx_ring->txq);
1851 }
1852 }
1853 /*
1854 * If everything is freed up to consumer then check if the ring is full
1855 * If the ring is full then check if more needs to be freed and
1856 * schedule the call back again.
1857 *
1858 * This happens when there are 2 CPUs. One could be freeing and the
1859 * other filling it. If the ring is full when we get out of here and
1860 * the card has already interrupted the host then the host can miss the
1861 * interrupt.
1862 *
1863 * There is still a possible race condition and the host could miss an
1864 * interrupt. The card has to take care of this.
1865 */
1866 hw_consumer = le32_to_cpu(*(tx_ring->hw_consumer));
1867 done = (sw_consumer == hw_consumer);
1868 spin_unlock(&adapter->tx_clean_lock);
1869
1870 return done;
1871}
1872
1873static int qlcnic_poll(struct napi_struct *napi, int budget)
1874{
1875 struct qlcnic_host_sds_ring *sds_ring =
1876 container_of(napi, struct qlcnic_host_sds_ring, napi);
1877
1878 struct qlcnic_adapter *adapter = sds_ring->adapter;
1879
1880 int tx_complete;
1881 int work_done;
1882
1883 tx_complete = qlcnic_process_cmd_ring(adapter);
1884
1885 work_done = qlcnic_process_rcv_ring(sds_ring, budget);
1886
1887 if ((work_done < budget) && tx_complete) {
1888 napi_complete(&sds_ring->napi);
1889 if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
1890 qlcnic_enable_int(sds_ring);
1891 }
1892
1893 return work_done;
1894}
1895
1896#ifdef CONFIG_NET_POLL_CONTROLLER
1897static void qlcnic_poll_controller(struct net_device *netdev)
1898{
1899 struct qlcnic_adapter *adapter = netdev_priv(netdev);
1900 disable_irq(adapter->irq);
1901 qlcnic_intr(adapter->irq, adapter);
1902 enable_irq(adapter->irq);
1903}
1904#endif
1905
6df900e9
SC		 1906static void
1907qlcnic_idc_debug_info(struct qlcnic_adapter *adapter, u8 encoding)
1908{
1909 u32 val;
1910
1911 val = adapter->portnum & 0xf;
1912 val |= encoding << 7;
1913 val |= (jiffies - adapter->dev_rst_time) << 8;
1914
1915 QLCWR32(adapter, QLCNIC_CRB_DRV_SCRATCH, val);
1916 adapter->dev_rst_time = jiffies;
1917}
1918
ade91f8e
AKS		 1919static int
1920qlcnic_set_drv_state(struct qlcnic_adapter *adapter, u8 state)
af19b491
AKS		 1921{
1922 u32 val;
1923
1924 WARN_ON(state != QLCNIC_DEV_NEED_RESET &&
1925 state != QLCNIC_DEV_NEED_QUISCENT);
1926
1927 if (qlcnic_api_lock(adapter))
ade91f8e 1928 return -EIO;
af19b491
AKS		 1929
1930 val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
1931
1932 if (state == QLCNIC_DEV_NEED_RESET)
6d2a4724 1933 QLC_DEV_SET_RST_RDY(val, adapter->portnum);
af19b491 1934 else if (state == QLCNIC_DEV_NEED_QUISCENT)
6d2a4724 1935 QLC_DEV_SET_QSCNT_RDY(val, adapter->portnum);
af19b491
AKS		 1936
1937 QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
1938
1939 qlcnic_api_unlock(adapter);
ade91f8e
AKS		 1940
1941 return 0;
af19b491
AKS		 1942}
1943
1b95a839
AKS		 1944static int
1945qlcnic_clr_drv_state(struct qlcnic_adapter *adapter)
1946{
1947 u32 val;
1948
1949 if (qlcnic_api_lock(adapter))
1950 return -EBUSY;
1951
1952 val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
6d2a4724 1953 QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
1b95a839
AKS		 1954 QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
1955
1956 qlcnic_api_unlock(adapter);
1957
1958 return 0;
1959}
1960
af19b491
AKS		 1961static void
1962qlcnic_clr_all_drv_state(struct qlcnic_adapter *adapter)
1963{
1964 u32 val;
1965
1966 if (qlcnic_api_lock(adapter))
1967 goto err;
1968
1969 val = QLCRD32(adapter, QLCNIC_CRB_DEV_REF_COUNT);
6d2a4724 1970 QLC_DEV_CLR_REF_CNT(val, adapter->portnum);
af19b491
AKS		 1971 QLCWR32(adapter, QLCNIC_CRB_DEV_REF_COUNT, val);
1972
1973 if (!(val & 0x11111111))
1974 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_COLD);
1975
1976 val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
6d2a4724 1977 QLC_DEV_CLR_RST_QSCNT(val, adapter->portnum);
af19b491
AKS		 1978 QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
1979
1980 qlcnic_api_unlock(adapter);
1981err:
1982 adapter->fw_fail_cnt = 0;
1983 clear_bit(__QLCNIC_START_FW, &adapter->state);
1984 clear_bit(__QLCNIC_RESETTING, &adapter->state);
1985}
1986
f73dfc50 1987/* Grab api lock, before checking state */
af19b491
AKS		 1988static int
1989qlcnic_check_drv_state(struct qlcnic_adapter *adapter)
1990{
1991 int act, state;
1992
1993 state = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
1994 act = QLCRD32(adapter, QLCNIC_CRB_DEV_REF_COUNT);
1995
1996 if (((state & 0x11111111) == (act & 0x11111111)) ||
1997 ((act & 0x11111111) == ((state >> 1) & 0x11111111)))
1998 return 0;
1999 else
2000 return 1;
2001}
2002
96f8118c
SC		 2003static int qlcnic_check_idc_ver(struct qlcnic_adapter *adapter)
2004{
2005 u32 val = QLCRD32(adapter, QLCNIC_CRB_DRV_IDC_VER);
2006
2007 if (val != QLCNIC_DRV_IDC_VER) {
2008 dev_warn(&adapter->pdev->dev, "IDC Version mismatch, driver's"
2009 " idc ver = %x; reqd = %x\n", QLCNIC_DRV_IDC_VER, val);
2010 }
2011
2012 return 0;
2013}
2014
af19b491
AKS		 2015static int
2016qlcnic_can_start_firmware(struct qlcnic_adapter *adapter)
2017{
2018 u32 val, prev_state;
aa5e18c0 2019 u8 dev_init_timeo = adapter->dev_init_timeo;
6d2a4724 2020 u8 portnum = adapter->portnum;
96f8118c 2021 u8 ret;
af19b491 2022
f73dfc50
AKS		 2023 if (test_and_clear_bit(__QLCNIC_START_FW, &adapter->state))
2024 return 1;
2025
af19b491
AKS		 2026 if (qlcnic_api_lock(adapter))
2027 return -1;
2028
2029 val = QLCRD32(adapter, QLCNIC_CRB_DEV_REF_COUNT);
6d2a4724
AKS		 2030 if (!(val & (1 << (portnum * 4)))) {
2031 QLC_DEV_SET_REF_CNT(val, portnum);
af19b491 2032 QLCWR32(adapter, QLCNIC_CRB_DEV_REF_COUNT, val);
af19b491
AKS		 2033 }
2034
2035 prev_state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
65b5b420 2036 QLCDB(adapter, HW, "Device state = %u\n", prev_state);
af19b491
AKS		 2037
2038 switch (prev_state) {
2039 case QLCNIC_DEV_COLD:
bbd8c6a4 2040 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_INITIALIZING);
96f8118c 2041 QLCWR32(adapter, QLCNIC_CRB_DRV_IDC_VER, QLCNIC_DRV_IDC_VER);
6df900e9 2042 qlcnic_idc_debug_info(adapter, 0);
af19b491
AKS		 2043 qlcnic_api_unlock(adapter);
2044 return 1;
2045
2046 case QLCNIC_DEV_READY:
96f8118c 2047 ret = qlcnic_check_idc_ver(adapter);
af19b491 2048 qlcnic_api_unlock(adapter);
96f8118c 2049 return ret;
af19b491
AKS		 2050
2051 case QLCNIC_DEV_NEED_RESET:
2052 val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
6d2a4724 2053 QLC_DEV_SET_RST_RDY(val, portnum);
af19b491
AKS		 2054 QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2055 break;
2056
2057 case QLCNIC_DEV_NEED_QUISCENT:
2058 val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
6d2a4724 2059 QLC_DEV_SET_QSCNT_RDY(val, portnum);
af19b491
AKS		 2060 QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2061 break;
2062
2063 case QLCNIC_DEV_FAILED:
2064 qlcnic_api_unlock(adapter);
2065 return -1;
bbd8c6a4
AKS		 2066
2067 case QLCNIC_DEV_INITIALIZING:
2068 case QLCNIC_DEV_QUISCENT:
2069 break;
af19b491
AKS		 2070 }
2071
2072 qlcnic_api_unlock(adapter);
aa5e18c0
SC		 2073
2074 do {
af19b491 2075 msleep(1000);
a5e463d0
SC		 2076 prev_state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
2077
2078 if (prev_state == QLCNIC_DEV_QUISCENT)
2079 continue;
2080 } while ((prev_state != QLCNIC_DEV_READY) && --dev_init_timeo);
af19b491 2081
65b5b420
AKS		 2082 if (!dev_init_timeo) {
2083 dev_err(&adapter->pdev->dev,
2084 "Waiting for device to initialize timeout\n");
af19b491 2085 return -1;
65b5b420 2086 }
af19b491
AKS		 2087
2088 if (qlcnic_api_lock(adapter))
2089 return -1;
2090
2091 val = QLCRD32(adapter, QLCNIC_CRB_DRV_STATE);
6d2a4724 2092 QLC_DEV_CLR_RST_QSCNT(val, portnum);
af19b491
AKS		 2093 QLCWR32(adapter, QLCNIC_CRB_DRV_STATE, val);
2094
96f8118c 2095 ret = qlcnic_check_idc_ver(adapter);
af19b491
AKS		 2096 qlcnic_api_unlock(adapter);
2097
96f8118c 2098 return ret;
af19b491
AKS		 2099}
2100
2101static void
2102qlcnic_fwinit_work(struct work_struct *work)
2103{
2104 struct qlcnic_adapter *adapter = container_of(work,
2105 struct qlcnic_adapter, fw_work.work);
f73dfc50 2106 u32 dev_state = 0xf;
af19b491 2107
f73dfc50
AKS		 2108 if (qlcnic_api_lock(adapter))
2109 goto err_ret;
af19b491 2110
a5e463d0
SC		 2111 dev_state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
2112 if (dev_state == QLCNIC_DEV_QUISCENT) {
2113 qlcnic_api_unlock(adapter);
2114 qlcnic_schedule_work(adapter, qlcnic_fwinit_work,
2115 FW_POLL_DELAY * 2);
2116 return;
2117 }
2118
f73dfc50
AKS		 2119 if (adapter->fw_wait_cnt++ > adapter->reset_ack_timeo) {
2120 dev_err(&adapter->pdev->dev, "Reset:Failed to get ack %d sec\n",
2121 adapter->reset_ack_timeo);
2122 goto skip_ack_check;
2123 }
2124
2125 if (!qlcnic_check_drv_state(adapter)) {
2126skip_ack_check:
2127 dev_state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
a5e463d0
SC		 2128
2129 if (dev_state == QLCNIC_DEV_NEED_QUISCENT) {
2130 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE,
2131 QLCNIC_DEV_QUISCENT);
2132 qlcnic_schedule_work(adapter, qlcnic_fwinit_work,
2133 FW_POLL_DELAY * 2);
2134 QLCDB(adapter, DRV, "Quiscing the driver\n");
6df900e9
SC		 2135 qlcnic_idc_debug_info(adapter, 0);
2136
a5e463d0
SC		 2137 qlcnic_api_unlock(adapter);
2138 return;
2139 }
2140
f73dfc50
AKS		 2141 if (dev_state == QLCNIC_DEV_NEED_RESET) {
2142 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE,
2143 QLCNIC_DEV_INITIALIZING);
2144 set_bit(__QLCNIC_START_FW, &adapter->state);
2145 QLCDB(adapter, DRV, "Restarting fw\n");
6df900e9 2146 qlcnic_idc_debug_info(adapter, 0);
af19b491
AKS		 2147 }
2148
f73dfc50
AKS		 2149 qlcnic_api_unlock(adapter);
2150
af19b491
AKS		 2151 if (!qlcnic_start_firmware(adapter)) {
2152 qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
2153 return;
2154 }
af19b491
AKS		 2155 goto err_ret;
2156 }
2157
f73dfc50 2158 qlcnic_api_unlock(adapter);
aa5e18c0 2159
af19b491 2160 dev_state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
f73dfc50 2161 QLCDB(adapter, HW, "Func waiting: Device state=%u\n", dev_state);
65b5b420 2162
af19b491 2163 switch (dev_state) {
a5e463d0
SC		 2164 case QLCNIC_DEV_QUISCENT:
2165 case QLCNIC_DEV_NEED_QUISCENT:
f73dfc50
AKS		 2166 case QLCNIC_DEV_NEED_RESET:
2167 qlcnic_schedule_work(adapter,
2168 qlcnic_fwinit_work, FW_POLL_DELAY);
2169 return;
af19b491
AKS		 2170 case QLCNIC_DEV_FAILED:
2171 break;
2172
2173 default:
f73dfc50
AKS		 2174 if (!qlcnic_start_firmware(adapter)) {
2175 qlcnic_schedule_work(adapter, qlcnic_attach_work, 0);
2176 return;
2177 }
af19b491
AKS		 2178 }
2179
2180err_ret:
f73dfc50
AKS		 2181 dev_err(&adapter->pdev->dev, "Fwinit work failed state=%u "
2182 "fw_wait_cnt=%u\n", dev_state, adapter->fw_wait_cnt);
34ce3626 2183 netif_device_attach(adapter->netdev);
af19b491
AKS		 2184 qlcnic_clr_all_drv_state(adapter);
2185}
2186
2187static void
2188qlcnic_detach_work(struct work_struct *work)
2189{
2190 struct qlcnic_adapter *adapter = container_of(work,
2191 struct qlcnic_adapter, fw_work.work);
2192 struct net_device *netdev = adapter->netdev;
2193 u32 status;
2194
2195 netif_device_detach(netdev);
2196
2197 qlcnic_down(adapter, netdev);
2198
ce668443 2199 rtnl_lock();
af19b491 2200 qlcnic_detach(adapter);
ce668443 2201 rtnl_unlock();
af19b491
AKS		 2202
2203 status = QLCRD32(adapter, QLCNIC_PEG_HALT_STATUS1);
2204
2205 if (status & QLCNIC_RCODE_FATAL_ERROR)
2206 goto err_ret;
2207
2208 if (adapter->temp == QLCNIC_TEMP_PANIC)
2209 goto err_ret;
2210
ade91f8e
AKS		 2211 if (qlcnic_set_drv_state(adapter, adapter->dev_state))
2212 goto err_ret;
af19b491
AKS		 2213
2214 adapter->fw_wait_cnt = 0;
2215
2216 qlcnic_schedule_work(adapter, qlcnic_fwinit_work, FW_POLL_DELAY);
2217
2218 return;
2219
2220err_ret:
65b5b420
AKS		 2221 dev_err(&adapter->pdev->dev, "detach failed; status=%d temp=%d\n",
2222 status, adapter->temp);
34ce3626 2223 netif_device_attach(netdev);
af19b491
AKS		 2224 qlcnic_clr_all_drv_state(adapter);
2225
2226}
2227
f73dfc50 2228/*Transit to RESET state from READY state only */
af19b491
AKS		 2229static void
2230qlcnic_dev_request_reset(struct qlcnic_adapter *adapter)
2231{
2232 u32 state;
2233
2234 if (qlcnic_api_lock(adapter))
2235 return;
2236
2237 state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
2238
f73dfc50 2239 if (state == QLCNIC_DEV_READY) {
af19b491 2240 QLCWR32(adapter, QLCNIC_CRB_DEV_STATE, QLCNIC_DEV_NEED_RESET);
65b5b420 2241 QLCDB(adapter, DRV, "NEED_RESET state set\n");
6df900e9 2242 qlcnic_idc_debug_info(adapter, 0);
af19b491
AKS		 2243 }
2244
2245 qlcnic_api_unlock(adapter);
2246}
2247
2248static void
2249qlcnic_schedule_work(struct qlcnic_adapter *adapter,
2250 work_func_t func, int delay)
2251{
2252 INIT_DELAYED_WORK(&adapter->fw_work, func);
2253 schedule_delayed_work(&adapter->fw_work, round_jiffies_relative(delay));
2254}
2255
2256static void
2257qlcnic_cancel_fw_work(struct qlcnic_adapter *adapter)
2258{
2259 while (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
2260 msleep(10);
2261
2262 cancel_delayed_work_sync(&adapter->fw_work);
2263}
2264
2265static void
2266qlcnic_attach_work(struct work_struct *work)
2267{
2268 struct qlcnic_adapter *adapter = container_of(work,
2269 struct qlcnic_adapter, fw_work.work);
2270 struct net_device *netdev = adapter->netdev;
2271 int err;
2272
2273 if (netif_running(netdev)) {
2274 err = qlcnic_attach(adapter);
2275 if (err)
2276 goto done;
2277
2278 err = qlcnic_up(adapter, netdev);
2279 if (err) {
2280 qlcnic_detach(adapter);
2281 goto done;
2282 }
2283
2284 qlcnic_config_indev_addr(netdev, NETDEV_UP);
2285 }
2286
af19b491 2287done:
34ce3626 2288 netif_device_attach(netdev);
af19b491
AKS		 2289 adapter->fw_fail_cnt = 0;
2290 clear_bit(__QLCNIC_RESETTING, &adapter->state);
1b95a839
AKS		 2291
2292 if (!qlcnic_clr_drv_state(adapter))
2293 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work,
2294 FW_POLL_DELAY);
af19b491
AKS		 2295}
2296
2297static int
2298qlcnic_check_health(struct qlcnic_adapter *adapter)
2299{
2300 u32 state = 0, heartbit;
2301 struct net_device *netdev = adapter->netdev;
2302
2303 if (qlcnic_check_temp(adapter))
2304 goto detach;
2305
2372a5f1 2306 if (adapter->need_fw_reset)
af19b491 2307 qlcnic_dev_request_reset(adapter);
af19b491
AKS		 2308
2309 state = QLCRD32(adapter, QLCNIC_CRB_DEV_STATE);
2310 if (state == QLCNIC_DEV_NEED_RESET || state == QLCNIC_DEV_NEED_QUISCENT)
2311 adapter->need_fw_reset = 1;
2312
2313 heartbit = QLCRD32(adapter, QLCNIC_PEG_ALIVE_COUNTER);
2314 if (heartbit != adapter->heartbit) {
2315 adapter->heartbit = heartbit;
2316 adapter->fw_fail_cnt = 0;
2317 if (adapter->need_fw_reset)
2318 goto detach;
2319 return 0;
2320 }
2321
2322 if (++adapter->fw_fail_cnt < FW_FAIL_THRESH)
2323 return 0;
2324
2325 qlcnic_dev_request_reset(adapter);
2326
2327 clear_bit(__QLCNIC_FW_ATTACHED, &adapter->state);
2328
2329 dev_info(&netdev->dev, "firmware hang detected\n");
2330
2331detach:
2332 adapter->dev_state = (state == QLCNIC_DEV_NEED_QUISCENT) ? state :
2333 QLCNIC_DEV_NEED_RESET;
2334
2335 if ((auto_fw_reset == AUTO_FW_RESET_ENABLED) &&
65b5b420
AKS		 2336 !test_and_set_bit(__QLCNIC_RESETTING, &adapter->state)) {
2337
af19b491 2338 qlcnic_schedule_work(adapter, qlcnic_detach_work, 0);
65b5b420
AKS		 2339 QLCDB(adapter, DRV, "fw recovery scheduled.\n");
2340 }
af19b491
AKS		 2341
2342 return 1;
2343}
2344
2345static void
2346qlcnic_fw_poll_work(struct work_struct *work)
2347{
2348 struct qlcnic_adapter *adapter = container_of(work,
2349 struct qlcnic_adapter, fw_work.work);
2350
2351 if (test_bit(__QLCNIC_RESETTING, &adapter->state))
2352 goto reschedule;
2353
2354
2355 if (qlcnic_check_health(adapter))
2356 return;
2357
2358reschedule:
2359 qlcnic_schedule_work(adapter, qlcnic_fw_poll_work, FW_POLL_DELAY);
2360}
2361
2362static ssize_t
2363qlcnic_store_bridged_mode(struct device *dev,
2364 struct device_attribute *attr, const char *buf, size_t len)
2365{
2366 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
2367 unsigned long new;
2368 int ret = -EINVAL;
2369
2370 if (!(adapter->capabilities & QLCNIC_FW_CAPABILITY_BDG))
2371 goto err_out;
2372
2373 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
2374 goto err_out;
2375
2376 if (strict_strtoul(buf, 2, &new))
2377 goto err_out;
2378
2379 if (!qlcnic_config_bridged_mode(adapter, !!new))
2380 ret = len;
2381
2382err_out:
2383 return ret;
2384}
2385
2386static ssize_t
2387qlcnic_show_bridged_mode(struct device *dev,
2388 struct device_attribute *attr, char *buf)
2389{
2390 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
2391 int bridged_mode = 0;
2392
2393 if (adapter->capabilities & QLCNIC_FW_CAPABILITY_BDG)
2394 bridged_mode = !!(adapter->flags & QLCNIC_BRIDGE_ENABLED);
2395
2396 return sprintf(buf, "%d\n", bridged_mode);
2397}
2398
2399static struct device_attribute dev_attr_bridged_mode = {
2400 .attr = {.name = "bridged_mode", .mode = (S_IRUGO | S_IWUSR)},
2401 .show = qlcnic_show_bridged_mode,
2402 .store = qlcnic_store_bridged_mode,
2403};
2404
2405static ssize_t
2406qlcnic_store_diag_mode(struct device *dev,
2407 struct device_attribute *attr, const char *buf, size_t len)
2408{
2409 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
2410 unsigned long new;
2411
2412 if (strict_strtoul(buf, 2, &new))
2413 return -EINVAL;
2414
2415 if (!!new != !!(adapter->flags & QLCNIC_DIAG_ENABLED))
2416 adapter->flags ^= QLCNIC_DIAG_ENABLED;
2417
2418 return len;
2419}
2420
2421static ssize_t
2422qlcnic_show_diag_mode(struct device *dev,
2423 struct device_attribute *attr, char *buf)
2424{
2425 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
2426
2427 return sprintf(buf, "%d\n",
2428 !!(adapter->flags & QLCNIC_DIAG_ENABLED));
2429}
2430
2431static struct device_attribute dev_attr_diag_mode = {
2432 .attr = {.name = "diag_mode", .mode = (S_IRUGO | S_IWUSR)},
2433 .show = qlcnic_show_diag_mode,
2434 .store = qlcnic_store_diag_mode,
2435};
2436
2437static int
2438qlcnic_sysfs_validate_crb(struct qlcnic_adapter *adapter,
2439 loff_t offset, size_t size)
2440{
897e8c7c
DP		 2441 size_t crb_size = 4;
2442
af19b491
AKS		 2443 if (!(adapter->flags & QLCNIC_DIAG_ENABLED))
2444 return -EIO;
2445
897e8c7c
DP		 2446 if (offset < QLCNIC_PCI_CRBSPACE) {
2447 if (ADDR_IN_RANGE(offset, QLCNIC_PCI_CAMQM,
2448 QLCNIC_PCI_CAMQM_END))
2449 crb_size = 8;
2450 else
2451 return -EINVAL;
2452 }
af19b491 2453
897e8c7c
DP		 2454 if ((size != crb_size) || (offset & (crb_size-1)))
2455 return -EINVAL;
af19b491
AKS		 2456
2457 return 0;
2458}
2459
2460static ssize_t
2461qlcnic_sysfs_read_crb(struct kobject *kobj, struct bin_attribute *attr,
2462 char *buf, loff_t offset, size_t size)
2463{
2464 struct device *dev = container_of(kobj, struct device, kobj);
2465 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
2466 u32 data;
897e8c7c 2467 u64 qmdata;
af19b491
AKS		 2468 int ret;
2469
2470 ret = qlcnic_sysfs_validate_crb(adapter, offset, size);
2471 if (ret != 0)
2472 return ret;
2473
897e8c7c
DP		 2474 if (ADDR_IN_RANGE(offset, QLCNIC_PCI_CAMQM, QLCNIC_PCI_CAMQM_END)) {
2475 qlcnic_pci_camqm_read_2M(adapter, offset, &qmdata);
2476 memcpy(buf, &qmdata, size);
2477 } else {
2478 data = QLCRD32(adapter, offset);
2479 memcpy(buf, &data, size);
2480 }
af19b491
AKS		 2481 return size;
2482}
2483
2484static ssize_t
2485qlcnic_sysfs_write_crb(struct kobject *kobj, struct bin_attribute *attr,
2486 char *buf, loff_t offset, size_t size)
2487{
2488 struct device *dev = container_of(kobj, struct device, kobj);
2489 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
2490 u32 data;
897e8c7c 2491 u64 qmdata;
af19b491
AKS		 2492 int ret;
2493
2494 ret = qlcnic_sysfs_validate_crb(adapter, offset, size);
2495 if (ret != 0)
2496 return ret;
2497
897e8c7c
DP		 2498 if (ADDR_IN_RANGE(offset, QLCNIC_PCI_CAMQM, QLCNIC_PCI_CAMQM_END)) {
2499 memcpy(&qmdata, buf, size);
2500 qlcnic_pci_camqm_write_2M(adapter, offset, qmdata);
2501 } else {
2502 memcpy(&data, buf, size);
2503 QLCWR32(adapter, offset, data);
2504 }
af19b491
AKS		 2505 return size;
2506}
2507
2508static int
2509qlcnic_sysfs_validate_mem(struct qlcnic_adapter *adapter,
2510 loff_t offset, size_t size)
2511{
2512 if (!(adapter->flags & QLCNIC_DIAG_ENABLED))
2513 return -EIO;
2514
2515 if ((size != 8) || (offset & 0x7))
2516 return -EIO;
2517
2518 return 0;
2519}
2520
2521static ssize_t
2522qlcnic_sysfs_read_mem(struct kobject *kobj, struct bin_attribute *attr,
2523 char *buf, loff_t offset, size_t size)
2524{
2525 struct device *dev = container_of(kobj, struct device, kobj);
2526 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
2527 u64 data;
2528 int ret;
2529
2530 ret = qlcnic_sysfs_validate_mem(adapter, offset, size);
2531 if (ret != 0)
2532 return ret;
2533
2534 if (qlcnic_pci_mem_read_2M(adapter, offset, &data))
2535 return -EIO;
2536
2537 memcpy(buf, &data, size);
2538
2539 return size;
2540}
2541
2542static ssize_t
2543qlcnic_sysfs_write_mem(struct kobject *kobj, struct bin_attribute *attr,
2544 char *buf, loff_t offset, size_t size)
2545{
2546 struct device *dev = container_of(kobj, struct device, kobj);
2547 struct qlcnic_adapter *adapter = dev_get_drvdata(dev);
2548 u64 data;
2549 int ret;
2550
2551 ret = qlcnic_sysfs_validate_mem(adapter, offset, size);
2552 if (ret != 0)
2553 return ret;
2554
2555 memcpy(&data, buf, size);
2556
2557 if (qlcnic_pci_mem_write_2M(adapter, offset, data))
2558 return -EIO;
2559
2560 return size;
2561}
2562
2563
2564static struct bin_attribute bin_attr_crb = {
2565 .attr = {.name = "crb", .mode = (S_IRUGO | S_IWUSR)},
2566 .size = 0,
2567 .read = qlcnic_sysfs_read_crb,
2568 .write = qlcnic_sysfs_write_crb,
2569};
2570
2571static struct bin_attribute bin_attr_mem = {
2572 .attr = {.name = "mem", .mode = (S_IRUGO | S_IWUSR)},
2573 .size = 0,
2574 .read = qlcnic_sysfs_read_mem,
2575 .write = qlcnic_sysfs_write_mem,
2576};
2577
2578static void
2579qlcnic_create_sysfs_entries(struct qlcnic_adapter *adapter)
2580{
2581 struct device *dev = &adapter->pdev->dev;
2582
2583 if (adapter->capabilities & QLCNIC_FW_CAPABILITY_BDG)
2584 if (device_create_file(dev, &dev_attr_bridged_mode))
2585 dev_warn(dev,
2586 "failed to create bridged_mode sysfs entry\n");
2587}
2588
2589static void
2590qlcnic_remove_sysfs_entries(struct qlcnic_adapter *adapter)
2591{
2592 struct device *dev = &adapter->pdev->dev;
2593
2594 if (adapter->capabilities & QLCNIC_FW_CAPABILITY_BDG)
2595 device_remove_file(dev, &dev_attr_bridged_mode);
2596}
2597
2598static void
2599qlcnic_create_diag_entries(struct qlcnic_adapter *adapter)
2600{
2601 struct device *dev = &adapter->pdev->dev;
2602
2603 if (device_create_file(dev, &dev_attr_diag_mode))
2604 dev_info(dev, "failed to create diag_mode sysfs entry\n");
2605 if (device_create_bin_file(dev, &bin_attr_crb))
2606 dev_info(dev, "failed to create crb sysfs entry\n");
2607 if (device_create_bin_file(dev, &bin_attr_mem))
2608 dev_info(dev, "failed to create mem sysfs entry\n");
2609}
2610
2611
2612static void
2613qlcnic_remove_diag_entries(struct qlcnic_adapter *adapter)
2614{
2615 struct device *dev = &adapter->pdev->dev;
2616
2617 device_remove_file(dev, &dev_attr_diag_mode);
2618 device_remove_bin_file(dev, &bin_attr_crb);
2619 device_remove_bin_file(dev, &bin_attr_mem);
2620}
2621
2622#ifdef CONFIG_INET
2623
2624#define is_qlcnic_netdev(dev) (dev->netdev_ops == &qlcnic_netdev_ops)
2625
af19b491
AKS		 2626static void
2627qlcnic_config_indev_addr(struct net_device *dev, unsigned long event)
2628{
2629 struct in_device *indev;
2630 struct qlcnic_adapter *adapter = netdev_priv(dev);
2631
af19b491
AKS		 2632 indev = in_dev_get(dev);
2633 if (!indev)
2634 return;
2635
2636 for_ifa(indev) {
2637 switch (event) {
2638 case NETDEV_UP:
2639 qlcnic_config_ipaddr(adapter,
2640 ifa->ifa_address, QLCNIC_IP_UP);
2641 break;
2642 case NETDEV_DOWN:
2643 qlcnic_config_ipaddr(adapter,
2644 ifa->ifa_address, QLCNIC_IP_DOWN);
2645 break;
2646 default:
2647 break;
2648 }
2649 } endfor_ifa(indev);
2650
2651 in_dev_put(indev);
af19b491
AKS		 2652}
2653
2654static int qlcnic_netdev_event(struct notifier_block *this,
2655 unsigned long event, void *ptr)
2656{
2657 struct qlcnic_adapter *adapter;
2658 struct net_device *dev = (struct net_device *)ptr;
2659
2660recheck:
2661 if (dev == NULL)
2662 goto done;
2663
2664 if (dev->priv_flags & IFF_802_1Q_VLAN) {
2665 dev = vlan_dev_real_dev(dev);
2666 goto recheck;
2667 }
2668
2669 if (!is_qlcnic_netdev(dev))
2670 goto done;
2671
2672 adapter = netdev_priv(dev);
2673
2674 if (!adapter)
2675 goto done;
2676
2677 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
2678 goto done;
2679
2680 qlcnic_config_indev_addr(dev, event);
2681done:
2682 return NOTIFY_DONE;
2683}
2684
2685static int
2686qlcnic_inetaddr_event(struct notifier_block *this,
2687 unsigned long event, void *ptr)
2688{
2689 struct qlcnic_adapter *adapter;
2690 struct net_device *dev;
2691
2692 struct in_ifaddr *ifa = (struct in_ifaddr *)ptr;
2693
2694 dev = ifa->ifa_dev ? ifa->ifa_dev->dev : NULL;
2695
2696recheck:
2697 if (dev == NULL || !netif_running(dev))
2698 goto done;
2699
2700 if (dev->priv_flags & IFF_802_1Q_VLAN) {
2701 dev = vlan_dev_real_dev(dev);
2702 goto recheck;
2703 }
2704
2705 if (!is_qlcnic_netdev(dev))
2706 goto done;
2707
2708 adapter = netdev_priv(dev);
2709
251a84c9 2710 if (!adapter)
af19b491
AKS		 2711 goto done;
2712
2713 if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
2714 goto done;
2715
2716 switch (event) {
2717 case NETDEV_UP:
2718 qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_UP);
2719 break;
2720 case NETDEV_DOWN:
2721 qlcnic_config_ipaddr(adapter, ifa->ifa_address, QLCNIC_IP_DOWN);
2722 break;
2723 default:
2724 break;
2725 }
2726
2727done:
2728 return NOTIFY_DONE;
2729}
2730
2731static struct notifier_block qlcnic_netdev_cb = {
2732 .notifier_call = qlcnic_netdev_event,
2733};
2734
2735static struct notifier_block qlcnic_inetaddr_cb = {
2736 .notifier_call = qlcnic_inetaddr_event,
2737};
2738#else
2739static void
2740qlcnic_config_indev_addr(struct net_device *dev, unsigned long event)
2741{ }
2742#endif
2743
2744static struct pci_driver qlcnic_driver = {
2745 .name = qlcnic_driver_name,
2746 .id_table = qlcnic_pci_tbl,
2747 .probe = qlcnic_probe,
2748 .remove = __devexit_p(qlcnic_remove),
2749#ifdef CONFIG_PM
2750 .suspend = qlcnic_suspend,
2751 .resume = qlcnic_resume,
2752#endif
2753 .shutdown = qlcnic_shutdown
2754};
2755
2756static int __init qlcnic_init_module(void)
2757{
2758
2759 printk(KERN_INFO "%s\n", qlcnic_driver_string);
2760
2761#ifdef CONFIG_INET
2762 register_netdevice_notifier(&qlcnic_netdev_cb);
2763 register_inetaddr_notifier(&qlcnic_inetaddr_cb);
2764#endif
2765
2766
2767 return pci_register_driver(&qlcnic_driver);
2768}
2769
2770module_init(qlcnic_init_module);
2771
2772static void __exit qlcnic_exit_module(void)
2773{
2774
2775 pci_unregister_driver(&qlcnic_driver);
2776
2777#ifdef CONFIG_INET
2778 unregister_inetaddr_notifier(&qlcnic_inetaddr_cb);
2779 unregister_netdevice_notifier(&qlcnic_netdev_cb);
2780#endif
2781}
2782
2783module_exit(qlcnic_exit_module);
Clone of davem's net-next-2.6 tree