1fe56b9e6SYuval Mintz /* QLogic qed NIC Driver 2fe56b9e6SYuval Mintz * Copyright (c) 2015 QLogic Corporation 3fe56b9e6SYuval Mintz * 4fe56b9e6SYuval Mintz * This software is available under the terms of the GNU General Public License 5fe56b9e6SYuval Mintz * (GPL) Version 2, available from the file COPYING in the main directory of 6fe56b9e6SYuval Mintz * this source tree. 7fe56b9e6SYuval Mintz */ 8fe56b9e6SYuval Mintz 9fe56b9e6SYuval Mintz #include <linux/stddef.h> 10fe56b9e6SYuval Mintz #include <linux/pci.h> 11fe56b9e6SYuval Mintz #include <linux/kernel.h> 12fe56b9e6SYuval Mintz #include <linux/slab.h> 13fe56b9e6SYuval Mintz #include <linux/version.h> 14fe56b9e6SYuval Mintz #include <linux/delay.h> 15fe56b9e6SYuval Mintz #include <asm/byteorder.h> 16fe56b9e6SYuval Mintz #include <linux/dma-mapping.h> 17fe56b9e6SYuval Mintz #include <linux/string.h> 18fe56b9e6SYuval Mintz #include <linux/module.h> 19fe56b9e6SYuval Mintz #include <linux/interrupt.h> 20fe56b9e6SYuval Mintz #include <linux/workqueue.h> 21fe56b9e6SYuval Mintz #include <linux/ethtool.h> 22fe56b9e6SYuval Mintz #include <linux/etherdevice.h> 23fe56b9e6SYuval Mintz #include <linux/vmalloc.h> 24fe56b9e6SYuval Mintz #include <linux/qed/qed_if.h> 25fe56b9e6SYuval Mintz 26fe56b9e6SYuval Mintz #include "qed.h" 2737bff2b9SYuval Mintz #include "qed_sriov.h" 28fe56b9e6SYuval Mintz #include "qed_sp.h" 29fe56b9e6SYuval Mintz #include "qed_dev_api.h" 30fe56b9e6SYuval Mintz #include "qed_mcp.h" 31fe56b9e6SYuval Mintz #include "qed_hw.h" 3203dc76caSSudarsana Reddy Kalluru #include "qed_selftest.h" 33fe56b9e6SYuval Mintz 345abd7e92SYuval Mintz static char version[] = 355abd7e92SYuval Mintz "QLogic FastLinQ 4xxxx Core Module qed " DRV_MODULE_VERSION "\n"; 36fe56b9e6SYuval Mintz 375abd7e92SYuval Mintz MODULE_DESCRIPTION("QLogic FastLinQ 4xxxx Core Module"); 38fe56b9e6SYuval Mintz MODULE_LICENSE("GPL"); 39fe56b9e6SYuval Mintz MODULE_VERSION(DRV_MODULE_VERSION); 40fe56b9e6SYuval Mintz 41fe56b9e6SYuval Mintz #define FW_FILE_VERSION \ 42fe56b9e6SYuval Mintz __stringify(FW_MAJOR_VERSION) "." \ 43fe56b9e6SYuval Mintz __stringify(FW_MINOR_VERSION) "." \ 44fe56b9e6SYuval Mintz __stringify(FW_REVISION_VERSION) "." \ 45fe56b9e6SYuval Mintz __stringify(FW_ENGINEERING_VERSION) 46fe56b9e6SYuval Mintz 47fe56b9e6SYuval Mintz #define QED_FW_FILE_NAME \ 48fe56b9e6SYuval Mintz "qed/qed_init_values_zipped-" FW_FILE_VERSION ".bin" 49fe56b9e6SYuval Mintz 50d43d3f0fSYuval Mintz MODULE_FIRMWARE(QED_FW_FILE_NAME); 51d43d3f0fSYuval Mintz 52fe56b9e6SYuval Mintz static int __init qed_init(void) 53fe56b9e6SYuval Mintz { 54fe56b9e6SYuval Mintz pr_notice("qed_init called\n"); 55fe56b9e6SYuval Mintz 56fe56b9e6SYuval Mintz pr_info("%s", version); 57fe56b9e6SYuval Mintz 58fe56b9e6SYuval Mintz return 0; 59fe56b9e6SYuval Mintz } 60fe56b9e6SYuval Mintz 61fe56b9e6SYuval Mintz static void __exit qed_cleanup(void) 62fe56b9e6SYuval Mintz { 63fe56b9e6SYuval Mintz pr_notice("qed_cleanup called\n"); 64fe56b9e6SYuval Mintz } 65fe56b9e6SYuval Mintz 66fe56b9e6SYuval Mintz module_init(qed_init); 67fe56b9e6SYuval Mintz module_exit(qed_cleanup); 68fe56b9e6SYuval Mintz 69fe56b9e6SYuval Mintz /* Check if the DMA controller on the machine can properly handle the DMA 70fe56b9e6SYuval Mintz * addressing required by the device. 71fe56b9e6SYuval Mintz */ 72fe56b9e6SYuval Mintz static int qed_set_coherency_mask(struct qed_dev *cdev) 73fe56b9e6SYuval Mintz { 74fe56b9e6SYuval Mintz struct device *dev = &cdev->pdev->dev; 75fe56b9e6SYuval Mintz 76fe56b9e6SYuval Mintz if (dma_set_mask(dev, DMA_BIT_MASK(64)) == 0) { 77fe56b9e6SYuval Mintz if (dma_set_coherent_mask(dev, DMA_BIT_MASK(64)) != 0) { 78fe56b9e6SYuval Mintz DP_NOTICE(cdev, 79fe56b9e6SYuval Mintz "Can't request 64-bit consistent allocations\n"); 80fe56b9e6SYuval Mintz return -EIO; 81fe56b9e6SYuval Mintz } 82fe56b9e6SYuval Mintz } else if (dma_set_mask(dev, DMA_BIT_MASK(32)) != 0) { 83fe56b9e6SYuval Mintz DP_NOTICE(cdev, "Can't request 64b/32b DMA addresses\n"); 84fe56b9e6SYuval Mintz return -EIO; 85fe56b9e6SYuval Mintz } 86fe56b9e6SYuval Mintz 87fe56b9e6SYuval Mintz return 0; 88fe56b9e6SYuval Mintz } 89fe56b9e6SYuval Mintz 90fe56b9e6SYuval Mintz static void qed_free_pci(struct qed_dev *cdev) 91fe56b9e6SYuval Mintz { 92fe56b9e6SYuval Mintz struct pci_dev *pdev = cdev->pdev; 93fe56b9e6SYuval Mintz 94fe56b9e6SYuval Mintz if (cdev->doorbells) 95fe56b9e6SYuval Mintz iounmap(cdev->doorbells); 96fe56b9e6SYuval Mintz if (cdev->regview) 97fe56b9e6SYuval Mintz iounmap(cdev->regview); 98fe56b9e6SYuval Mintz if (atomic_read(&pdev->enable_cnt) == 1) 99fe56b9e6SYuval Mintz pci_release_regions(pdev); 100fe56b9e6SYuval Mintz 101fe56b9e6SYuval Mintz pci_disable_device(pdev); 102fe56b9e6SYuval Mintz } 103fe56b9e6SYuval Mintz 1040dfaba6dSYuval Mintz #define PCI_REVISION_ID_ERROR_VAL 0xff 1050dfaba6dSYuval Mintz 106fe56b9e6SYuval Mintz /* Performs PCI initializations as well as initializing PCI-related parameters 107fe56b9e6SYuval Mintz * in the device structrue. Returns 0 in case of success. 108fe56b9e6SYuval Mintz */ 109fe56b9e6SYuval Mintz static int qed_init_pci(struct qed_dev *cdev, 110fe56b9e6SYuval Mintz struct pci_dev *pdev) 111fe56b9e6SYuval Mintz { 1120dfaba6dSYuval Mintz u8 rev_id; 113fe56b9e6SYuval Mintz int rc; 114fe56b9e6SYuval Mintz 115fe56b9e6SYuval Mintz cdev->pdev = pdev; 116fe56b9e6SYuval Mintz 117fe56b9e6SYuval Mintz rc = pci_enable_device(pdev); 118fe56b9e6SYuval Mintz if (rc) { 119fe56b9e6SYuval Mintz DP_NOTICE(cdev, "Cannot enable PCI device\n"); 120fe56b9e6SYuval Mintz goto err0; 121fe56b9e6SYuval Mintz } 122fe56b9e6SYuval Mintz 123fe56b9e6SYuval Mintz if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) { 124fe56b9e6SYuval Mintz DP_NOTICE(cdev, "No memory region found in bar #0\n"); 125fe56b9e6SYuval Mintz rc = -EIO; 126fe56b9e6SYuval Mintz goto err1; 127fe56b9e6SYuval Mintz } 128fe56b9e6SYuval Mintz 129fe56b9e6SYuval Mintz if (!(pci_resource_flags(pdev, 2) & IORESOURCE_MEM)) { 130fe56b9e6SYuval Mintz DP_NOTICE(cdev, "No memory region found in bar #2\n"); 131fe56b9e6SYuval Mintz rc = -EIO; 132fe56b9e6SYuval Mintz goto err1; 133fe56b9e6SYuval Mintz } 134fe56b9e6SYuval Mintz 135fe56b9e6SYuval Mintz if (atomic_read(&pdev->enable_cnt) == 1) { 136fe56b9e6SYuval Mintz rc = pci_request_regions(pdev, "qed"); 137fe56b9e6SYuval Mintz if (rc) { 138fe56b9e6SYuval Mintz DP_NOTICE(cdev, 139fe56b9e6SYuval Mintz "Failed to request PCI memory resources\n"); 140fe56b9e6SYuval Mintz goto err1; 141fe56b9e6SYuval Mintz } 142fe56b9e6SYuval Mintz pci_set_master(pdev); 143fe56b9e6SYuval Mintz pci_save_state(pdev); 144fe56b9e6SYuval Mintz } 145fe56b9e6SYuval Mintz 1460dfaba6dSYuval Mintz pci_read_config_byte(pdev, PCI_REVISION_ID, &rev_id); 1470dfaba6dSYuval Mintz if (rev_id == PCI_REVISION_ID_ERROR_VAL) { 1480dfaba6dSYuval Mintz DP_NOTICE(cdev, 1490dfaba6dSYuval Mintz "Detected PCI device error [rev_id 0x%x]. Probably due to prior indication. Aborting.\n", 1500dfaba6dSYuval Mintz rev_id); 1510dfaba6dSYuval Mintz rc = -ENODEV; 1520dfaba6dSYuval Mintz goto err2; 1530dfaba6dSYuval Mintz } 154fe56b9e6SYuval Mintz if (!pci_is_pcie(pdev)) { 155fe56b9e6SYuval Mintz DP_NOTICE(cdev, "The bus is not PCI Express\n"); 156fe56b9e6SYuval Mintz rc = -EIO; 157fe56b9e6SYuval Mintz goto err2; 158fe56b9e6SYuval Mintz } 159fe56b9e6SYuval Mintz 160fe56b9e6SYuval Mintz cdev->pci_params.pm_cap = pci_find_capability(pdev, PCI_CAP_ID_PM); 161fe56b9e6SYuval Mintz if (cdev->pci_params.pm_cap == 0) 162fe56b9e6SYuval Mintz DP_NOTICE(cdev, "Cannot find power management capability\n"); 163fe56b9e6SYuval Mintz 164fe56b9e6SYuval Mintz rc = qed_set_coherency_mask(cdev); 165fe56b9e6SYuval Mintz if (rc) 166fe56b9e6SYuval Mintz goto err2; 167fe56b9e6SYuval Mintz 168fe56b9e6SYuval Mintz cdev->pci_params.mem_start = pci_resource_start(pdev, 0); 169fe56b9e6SYuval Mintz cdev->pci_params.mem_end = pci_resource_end(pdev, 0); 170fe56b9e6SYuval Mintz cdev->pci_params.irq = pdev->irq; 171fe56b9e6SYuval Mintz 172fe56b9e6SYuval Mintz cdev->regview = pci_ioremap_bar(pdev, 0); 173fe56b9e6SYuval Mintz if (!cdev->regview) { 174fe56b9e6SYuval Mintz DP_NOTICE(cdev, "Cannot map register space, aborting\n"); 175fe56b9e6SYuval Mintz rc = -ENOMEM; 176fe56b9e6SYuval Mintz goto err2; 177fe56b9e6SYuval Mintz } 178fe56b9e6SYuval Mintz 179fe56b9e6SYuval Mintz cdev->db_phys_addr = pci_resource_start(cdev->pdev, 2); 180fe56b9e6SYuval Mintz cdev->db_size = pci_resource_len(cdev->pdev, 2); 181fe56b9e6SYuval Mintz cdev->doorbells = ioremap_wc(cdev->db_phys_addr, cdev->db_size); 182fe56b9e6SYuval Mintz if (!cdev->doorbells) { 183fe56b9e6SYuval Mintz DP_NOTICE(cdev, "Cannot map doorbell space\n"); 184fe56b9e6SYuval Mintz return -ENOMEM; 185fe56b9e6SYuval Mintz } 186fe56b9e6SYuval Mintz 187fe56b9e6SYuval Mintz return 0; 188fe56b9e6SYuval Mintz 189fe56b9e6SYuval Mintz err2: 190fe56b9e6SYuval Mintz pci_release_regions(pdev); 191fe56b9e6SYuval Mintz err1: 192fe56b9e6SYuval Mintz pci_disable_device(pdev); 193fe56b9e6SYuval Mintz err0: 194fe56b9e6SYuval Mintz return rc; 195fe56b9e6SYuval Mintz } 196fe56b9e6SYuval Mintz 197fe56b9e6SYuval Mintz int qed_fill_dev_info(struct qed_dev *cdev, 198fe56b9e6SYuval Mintz struct qed_dev_info *dev_info) 199fe56b9e6SYuval Mintz { 200cee4d264SManish Chopra struct qed_ptt *ptt; 201cee4d264SManish Chopra 202fe56b9e6SYuval Mintz memset(dev_info, 0, sizeof(struct qed_dev_info)); 203fe56b9e6SYuval Mintz 204fe56b9e6SYuval Mintz dev_info->num_hwfns = cdev->num_hwfns; 205fe56b9e6SYuval Mintz dev_info->pci_mem_start = cdev->pci_params.mem_start; 206fe56b9e6SYuval Mintz dev_info->pci_mem_end = cdev->pci_params.mem_end; 207fe56b9e6SYuval Mintz dev_info->pci_irq = cdev->pci_params.irq; 208fc48b7a6SYuval Mintz dev_info->is_mf_default = IS_MF_DEFAULT(&cdev->hwfns[0]); 209fe56b9e6SYuval Mintz ether_addr_copy(dev_info->hw_mac, cdev->hwfns[0].hw_info.hw_mac_addr); 210fe56b9e6SYuval Mintz 211fe56b9e6SYuval Mintz dev_info->fw_major = FW_MAJOR_VERSION; 212fe56b9e6SYuval Mintz dev_info->fw_minor = FW_MINOR_VERSION; 213fe56b9e6SYuval Mintz dev_info->fw_rev = FW_REVISION_VERSION; 214fe56b9e6SYuval Mintz dev_info->fw_eng = FW_ENGINEERING_VERSION; 215fe56b9e6SYuval Mintz dev_info->mf_mode = cdev->mf_mode; 216fe56b9e6SYuval Mintz 217fe56b9e6SYuval Mintz qed_mcp_get_mfw_ver(cdev, &dev_info->mfw_rev); 218fe56b9e6SYuval Mintz 219cee4d264SManish Chopra ptt = qed_ptt_acquire(QED_LEADING_HWFN(cdev)); 220cee4d264SManish Chopra if (ptt) { 221cee4d264SManish Chopra qed_mcp_get_flash_size(QED_LEADING_HWFN(cdev), ptt, 222cee4d264SManish Chopra &dev_info->flash_size); 223cee4d264SManish Chopra 224cee4d264SManish Chopra qed_ptt_release(QED_LEADING_HWFN(cdev), ptt); 225cee4d264SManish Chopra } 226cee4d264SManish Chopra 227fe56b9e6SYuval Mintz return 0; 228fe56b9e6SYuval Mintz } 229fe56b9e6SYuval Mintz 230fe56b9e6SYuval Mintz static void qed_free_cdev(struct qed_dev *cdev) 231fe56b9e6SYuval Mintz { 232fe56b9e6SYuval Mintz kfree((void *)cdev); 233fe56b9e6SYuval Mintz } 234fe56b9e6SYuval Mintz 235fe56b9e6SYuval Mintz static struct qed_dev *qed_alloc_cdev(struct pci_dev *pdev) 236fe56b9e6SYuval Mintz { 237fe56b9e6SYuval Mintz struct qed_dev *cdev; 238fe56b9e6SYuval Mintz 239fe56b9e6SYuval Mintz cdev = kzalloc(sizeof(*cdev), GFP_KERNEL); 240fe56b9e6SYuval Mintz if (!cdev) 241fe56b9e6SYuval Mintz return cdev; 242fe56b9e6SYuval Mintz 243fe56b9e6SYuval Mintz qed_init_struct(cdev); 244fe56b9e6SYuval Mintz 245fe56b9e6SYuval Mintz return cdev; 246fe56b9e6SYuval Mintz } 247fe56b9e6SYuval Mintz 248fe56b9e6SYuval Mintz /* Sets the requested power state */ 249fe56b9e6SYuval Mintz static int qed_set_power_state(struct qed_dev *cdev, 250fe56b9e6SYuval Mintz pci_power_t state) 251fe56b9e6SYuval Mintz { 252fe56b9e6SYuval Mintz if (!cdev) 253fe56b9e6SYuval Mintz return -ENODEV; 254fe56b9e6SYuval Mintz 255fe56b9e6SYuval Mintz DP_VERBOSE(cdev, NETIF_MSG_DRV, "Omitting Power state change\n"); 256fe56b9e6SYuval Mintz return 0; 257fe56b9e6SYuval Mintz } 258fe56b9e6SYuval Mintz 259fe56b9e6SYuval Mintz /* probing */ 260fe56b9e6SYuval Mintz static struct qed_dev *qed_probe(struct pci_dev *pdev, 261fe56b9e6SYuval Mintz enum qed_protocol protocol, 262fe56b9e6SYuval Mintz u32 dp_module, 263fe56b9e6SYuval Mintz u8 dp_level) 264fe56b9e6SYuval Mintz { 265fe56b9e6SYuval Mintz struct qed_dev *cdev; 266fe56b9e6SYuval Mintz int rc; 267fe56b9e6SYuval Mintz 268fe56b9e6SYuval Mintz cdev = qed_alloc_cdev(pdev); 269fe56b9e6SYuval Mintz if (!cdev) 270fe56b9e6SYuval Mintz goto err0; 271fe56b9e6SYuval Mintz 272fe56b9e6SYuval Mintz cdev->protocol = protocol; 273fe56b9e6SYuval Mintz 274fe56b9e6SYuval Mintz qed_init_dp(cdev, dp_module, dp_level); 275fe56b9e6SYuval Mintz 276fe56b9e6SYuval Mintz rc = qed_init_pci(cdev, pdev); 277fe56b9e6SYuval Mintz if (rc) { 278fe56b9e6SYuval Mintz DP_ERR(cdev, "init pci failed\n"); 279fe56b9e6SYuval Mintz goto err1; 280fe56b9e6SYuval Mintz } 281fe56b9e6SYuval Mintz DP_INFO(cdev, "PCI init completed successfully\n"); 282fe56b9e6SYuval Mintz 283fe56b9e6SYuval Mintz rc = qed_hw_prepare(cdev, QED_PCI_DEFAULT); 284fe56b9e6SYuval Mintz if (rc) { 285fe56b9e6SYuval Mintz DP_ERR(cdev, "hw prepare failed\n"); 286fe56b9e6SYuval Mintz goto err2; 287fe56b9e6SYuval Mintz } 288fe56b9e6SYuval Mintz 289fe56b9e6SYuval Mintz DP_INFO(cdev, "qed_probe completed successffuly\n"); 290fe56b9e6SYuval Mintz 291fe56b9e6SYuval Mintz return cdev; 292fe56b9e6SYuval Mintz 293fe56b9e6SYuval Mintz err2: 294fe56b9e6SYuval Mintz qed_free_pci(cdev); 295fe56b9e6SYuval Mintz err1: 296fe56b9e6SYuval Mintz qed_free_cdev(cdev); 297fe56b9e6SYuval Mintz err0: 298fe56b9e6SYuval Mintz return NULL; 299fe56b9e6SYuval Mintz } 300fe56b9e6SYuval Mintz 301fe56b9e6SYuval Mintz static void qed_remove(struct qed_dev *cdev) 302fe56b9e6SYuval Mintz { 303fe56b9e6SYuval Mintz if (!cdev) 304fe56b9e6SYuval Mintz return; 305fe56b9e6SYuval Mintz 306fe56b9e6SYuval Mintz qed_hw_remove(cdev); 307fe56b9e6SYuval Mintz 308fe56b9e6SYuval Mintz qed_free_pci(cdev); 309fe56b9e6SYuval Mintz 310fe56b9e6SYuval Mintz qed_set_power_state(cdev, PCI_D3hot); 311fe56b9e6SYuval Mintz 312fe56b9e6SYuval Mintz qed_free_cdev(cdev); 313fe56b9e6SYuval Mintz } 314fe56b9e6SYuval Mintz 315fe56b9e6SYuval Mintz static void qed_disable_msix(struct qed_dev *cdev) 316fe56b9e6SYuval Mintz { 317fe56b9e6SYuval Mintz if (cdev->int_params.out.int_mode == QED_INT_MODE_MSIX) { 318fe56b9e6SYuval Mintz pci_disable_msix(cdev->pdev); 319fe56b9e6SYuval Mintz kfree(cdev->int_params.msix_table); 320fe56b9e6SYuval Mintz } else if (cdev->int_params.out.int_mode == QED_INT_MODE_MSI) { 321fe56b9e6SYuval Mintz pci_disable_msi(cdev->pdev); 322fe56b9e6SYuval Mintz } 323fe56b9e6SYuval Mintz 324fe56b9e6SYuval Mintz memset(&cdev->int_params.out, 0, sizeof(struct qed_int_param)); 325fe56b9e6SYuval Mintz } 326fe56b9e6SYuval Mintz 327fe56b9e6SYuval Mintz static int qed_enable_msix(struct qed_dev *cdev, 328fe56b9e6SYuval Mintz struct qed_int_params *int_params) 329fe56b9e6SYuval Mintz { 330fe56b9e6SYuval Mintz int i, rc, cnt; 331fe56b9e6SYuval Mintz 332fe56b9e6SYuval Mintz cnt = int_params->in.num_vectors; 333fe56b9e6SYuval Mintz 334fe56b9e6SYuval Mintz for (i = 0; i < cnt; i++) 335fe56b9e6SYuval Mintz int_params->msix_table[i].entry = i; 336fe56b9e6SYuval Mintz 337fe56b9e6SYuval Mintz rc = pci_enable_msix_range(cdev->pdev, int_params->msix_table, 338fe56b9e6SYuval Mintz int_params->in.min_msix_cnt, cnt); 339fe56b9e6SYuval Mintz if (rc < cnt && rc >= int_params->in.min_msix_cnt && 340fe56b9e6SYuval Mintz (rc % cdev->num_hwfns)) { 341fe56b9e6SYuval Mintz pci_disable_msix(cdev->pdev); 342fe56b9e6SYuval Mintz 343fe56b9e6SYuval Mintz /* If fastpath is initialized, we need at least one interrupt 344fe56b9e6SYuval Mintz * per hwfn [and the slow path interrupts]. New requested number 345fe56b9e6SYuval Mintz * should be a multiple of the number of hwfns. 346fe56b9e6SYuval Mintz */ 347fe56b9e6SYuval Mintz cnt = (rc / cdev->num_hwfns) * cdev->num_hwfns; 348fe56b9e6SYuval Mintz DP_NOTICE(cdev, 349fe56b9e6SYuval Mintz "Trying to enable MSI-X with less vectors (%d out of %d)\n", 350fe56b9e6SYuval Mintz cnt, int_params->in.num_vectors); 351fe56b9e6SYuval Mintz rc = pci_enable_msix_exact(cdev->pdev, 352fe56b9e6SYuval Mintz int_params->msix_table, cnt); 353fe56b9e6SYuval Mintz if (!rc) 354fe56b9e6SYuval Mintz rc = cnt; 355fe56b9e6SYuval Mintz } 356fe56b9e6SYuval Mintz 357fe56b9e6SYuval Mintz if (rc > 0) { 358fe56b9e6SYuval Mintz /* MSI-x configuration was achieved */ 359fe56b9e6SYuval Mintz int_params->out.int_mode = QED_INT_MODE_MSIX; 360fe56b9e6SYuval Mintz int_params->out.num_vectors = rc; 361fe56b9e6SYuval Mintz rc = 0; 362fe56b9e6SYuval Mintz } else { 363fe56b9e6SYuval Mintz DP_NOTICE(cdev, 364fe56b9e6SYuval Mintz "Failed to enable MSI-X [Requested %d vectors][rc %d]\n", 365fe56b9e6SYuval Mintz cnt, rc); 366fe56b9e6SYuval Mintz } 367fe56b9e6SYuval Mintz 368fe56b9e6SYuval Mintz return rc; 369fe56b9e6SYuval Mintz } 370fe56b9e6SYuval Mintz 371fe56b9e6SYuval Mintz /* This function outputs the int mode and the number of enabled msix vector */ 372fe56b9e6SYuval Mintz static int qed_set_int_mode(struct qed_dev *cdev, bool force_mode) 373fe56b9e6SYuval Mintz { 374fe56b9e6SYuval Mintz struct qed_int_params *int_params = &cdev->int_params; 375fe56b9e6SYuval Mintz struct msix_entry *tbl; 376fe56b9e6SYuval Mintz int rc = 0, cnt; 377fe56b9e6SYuval Mintz 378fe56b9e6SYuval Mintz switch (int_params->in.int_mode) { 379fe56b9e6SYuval Mintz case QED_INT_MODE_MSIX: 380fe56b9e6SYuval Mintz /* Allocate MSIX table */ 381fe56b9e6SYuval Mintz cnt = int_params->in.num_vectors; 382fe56b9e6SYuval Mintz int_params->msix_table = kcalloc(cnt, sizeof(*tbl), GFP_KERNEL); 383fe56b9e6SYuval Mintz if (!int_params->msix_table) { 384fe56b9e6SYuval Mintz rc = -ENOMEM; 385fe56b9e6SYuval Mintz goto out; 386fe56b9e6SYuval Mintz } 387fe56b9e6SYuval Mintz 388fe56b9e6SYuval Mintz /* Enable MSIX */ 389fe56b9e6SYuval Mintz rc = qed_enable_msix(cdev, int_params); 390fe56b9e6SYuval Mintz if (!rc) 391fe56b9e6SYuval Mintz goto out; 392fe56b9e6SYuval Mintz 393fe56b9e6SYuval Mintz DP_NOTICE(cdev, "Failed to enable MSI-X\n"); 394fe56b9e6SYuval Mintz kfree(int_params->msix_table); 395fe56b9e6SYuval Mintz if (force_mode) 396fe56b9e6SYuval Mintz goto out; 397fe56b9e6SYuval Mintz /* Fallthrough */ 398fe56b9e6SYuval Mintz 399fe56b9e6SYuval Mintz case QED_INT_MODE_MSI: 400fe56b9e6SYuval Mintz rc = pci_enable_msi(cdev->pdev); 401fe56b9e6SYuval Mintz if (!rc) { 402fe56b9e6SYuval Mintz int_params->out.int_mode = QED_INT_MODE_MSI; 403fe56b9e6SYuval Mintz goto out; 404fe56b9e6SYuval Mintz } 405fe56b9e6SYuval Mintz 406fe56b9e6SYuval Mintz DP_NOTICE(cdev, "Failed to enable MSI\n"); 407fe56b9e6SYuval Mintz if (force_mode) 408fe56b9e6SYuval Mintz goto out; 409fe56b9e6SYuval Mintz /* Fallthrough */ 410fe56b9e6SYuval Mintz 411fe56b9e6SYuval Mintz case QED_INT_MODE_INTA: 412fe56b9e6SYuval Mintz int_params->out.int_mode = QED_INT_MODE_INTA; 413fe56b9e6SYuval Mintz rc = 0; 414fe56b9e6SYuval Mintz goto out; 415fe56b9e6SYuval Mintz default: 416fe56b9e6SYuval Mintz DP_NOTICE(cdev, "Unknown int_mode value %d\n", 417fe56b9e6SYuval Mintz int_params->in.int_mode); 418fe56b9e6SYuval Mintz rc = -EINVAL; 419fe56b9e6SYuval Mintz } 420fe56b9e6SYuval Mintz 421fe56b9e6SYuval Mintz out: 422fe56b9e6SYuval Mintz cdev->int_coalescing_mode = QED_COAL_MODE_ENABLE; 423fe56b9e6SYuval Mintz 424fe56b9e6SYuval Mintz return rc; 425fe56b9e6SYuval Mintz } 426fe56b9e6SYuval Mintz 427fe56b9e6SYuval Mintz static void qed_simd_handler_config(struct qed_dev *cdev, void *token, 428fe56b9e6SYuval Mintz int index, void(*handler)(void *)) 429fe56b9e6SYuval Mintz { 430fe56b9e6SYuval Mintz struct qed_hwfn *hwfn = &cdev->hwfns[index % cdev->num_hwfns]; 431fe56b9e6SYuval Mintz int relative_idx = index / cdev->num_hwfns; 432fe56b9e6SYuval Mintz 433fe56b9e6SYuval Mintz hwfn->simd_proto_handler[relative_idx].func = handler; 434fe56b9e6SYuval Mintz hwfn->simd_proto_handler[relative_idx].token = token; 435fe56b9e6SYuval Mintz } 436fe56b9e6SYuval Mintz 437fe56b9e6SYuval Mintz static void qed_simd_handler_clean(struct qed_dev *cdev, int index) 438fe56b9e6SYuval Mintz { 439fe56b9e6SYuval Mintz struct qed_hwfn *hwfn = &cdev->hwfns[index % cdev->num_hwfns]; 440fe56b9e6SYuval Mintz int relative_idx = index / cdev->num_hwfns; 441fe56b9e6SYuval Mintz 442fe56b9e6SYuval Mintz memset(&hwfn->simd_proto_handler[relative_idx], 0, 443fe56b9e6SYuval Mintz sizeof(struct qed_simd_fp_handler)); 444fe56b9e6SYuval Mintz } 445fe56b9e6SYuval Mintz 446fe56b9e6SYuval Mintz static irqreturn_t qed_msix_sp_int(int irq, void *tasklet) 447fe56b9e6SYuval Mintz { 448fe56b9e6SYuval Mintz tasklet_schedule((struct tasklet_struct *)tasklet); 449fe56b9e6SYuval Mintz return IRQ_HANDLED; 450fe56b9e6SYuval Mintz } 451fe56b9e6SYuval Mintz 452fe56b9e6SYuval Mintz static irqreturn_t qed_single_int(int irq, void *dev_instance) 453fe56b9e6SYuval Mintz { 454fe56b9e6SYuval Mintz struct qed_dev *cdev = (struct qed_dev *)dev_instance; 455fe56b9e6SYuval Mintz struct qed_hwfn *hwfn; 456fe56b9e6SYuval Mintz irqreturn_t rc = IRQ_NONE; 457fe56b9e6SYuval Mintz u64 status; 458fe56b9e6SYuval Mintz int i, j; 459fe56b9e6SYuval Mintz 460fe56b9e6SYuval Mintz for (i = 0; i < cdev->num_hwfns; i++) { 461fe56b9e6SYuval Mintz status = qed_int_igu_read_sisr_reg(&cdev->hwfns[i]); 462fe56b9e6SYuval Mintz 463fe56b9e6SYuval Mintz if (!status) 464fe56b9e6SYuval Mintz continue; 465fe56b9e6SYuval Mintz 466fe56b9e6SYuval Mintz hwfn = &cdev->hwfns[i]; 467fe56b9e6SYuval Mintz 468fe56b9e6SYuval Mintz /* Slowpath interrupt */ 469fe56b9e6SYuval Mintz if (unlikely(status & 0x1)) { 470fe56b9e6SYuval Mintz tasklet_schedule(hwfn->sp_dpc); 471fe56b9e6SYuval Mintz status &= ~0x1; 472fe56b9e6SYuval Mintz rc = IRQ_HANDLED; 473fe56b9e6SYuval Mintz } 474fe56b9e6SYuval Mintz 475fe56b9e6SYuval Mintz /* Fastpath interrupts */ 476fe56b9e6SYuval Mintz for (j = 0; j < 64; j++) { 477fe56b9e6SYuval Mintz if ((0x2ULL << j) & status) { 478fe56b9e6SYuval Mintz hwfn->simd_proto_handler[j].func( 479fe56b9e6SYuval Mintz hwfn->simd_proto_handler[j].token); 480fe56b9e6SYuval Mintz status &= ~(0x2ULL << j); 481fe56b9e6SYuval Mintz rc = IRQ_HANDLED; 482fe56b9e6SYuval Mintz } 483fe56b9e6SYuval Mintz } 484fe56b9e6SYuval Mintz 485fe56b9e6SYuval Mintz if (unlikely(status)) 486fe56b9e6SYuval Mintz DP_VERBOSE(hwfn, NETIF_MSG_INTR, 487fe56b9e6SYuval Mintz "got an unknown interrupt status 0x%llx\n", 488fe56b9e6SYuval Mintz status); 489fe56b9e6SYuval Mintz } 490fe56b9e6SYuval Mintz 491fe56b9e6SYuval Mintz return rc; 492fe56b9e6SYuval Mintz } 493fe56b9e6SYuval Mintz 4948f16bc97SSudarsana Kalluru int qed_slowpath_irq_req(struct qed_hwfn *hwfn) 495fe56b9e6SYuval Mintz { 4968f16bc97SSudarsana Kalluru struct qed_dev *cdev = hwfn->cdev; 4978f16bc97SSudarsana Kalluru int rc = 0; 4988f16bc97SSudarsana Kalluru u8 id; 499fe56b9e6SYuval Mintz 500fe56b9e6SYuval Mintz if (cdev->int_params.out.int_mode == QED_INT_MODE_MSIX) { 5018f16bc97SSudarsana Kalluru id = hwfn->my_id; 5028f16bc97SSudarsana Kalluru snprintf(hwfn->name, NAME_SIZE, "sp-%d-%02x:%02x.%02x", 5038f16bc97SSudarsana Kalluru id, cdev->pdev->bus->number, 5048f16bc97SSudarsana Kalluru PCI_SLOT(cdev->pdev->devfn), hwfn->abs_pf_id); 5058f16bc97SSudarsana Kalluru rc = request_irq(cdev->int_params.msix_table[id].vector, 5068f16bc97SSudarsana Kalluru qed_msix_sp_int, 0, hwfn->name, hwfn->sp_dpc); 5078f16bc97SSudarsana Kalluru if (!rc) 5088f16bc97SSudarsana Kalluru DP_VERBOSE(hwfn, (NETIF_MSG_INTR | QED_MSG_SP), 509fe56b9e6SYuval Mintz "Requested slowpath MSI-X\n"); 510fe56b9e6SYuval Mintz } else { 511fe56b9e6SYuval Mintz unsigned long flags = 0; 512fe56b9e6SYuval Mintz 513fe56b9e6SYuval Mintz snprintf(cdev->name, NAME_SIZE, "%02x:%02x.%02x", 514fe56b9e6SYuval Mintz cdev->pdev->bus->number, PCI_SLOT(cdev->pdev->devfn), 515fe56b9e6SYuval Mintz PCI_FUNC(cdev->pdev->devfn)); 516fe56b9e6SYuval Mintz 517fe56b9e6SYuval Mintz if (cdev->int_params.out.int_mode == QED_INT_MODE_INTA) 518fe56b9e6SYuval Mintz flags |= IRQF_SHARED; 519fe56b9e6SYuval Mintz 520fe56b9e6SYuval Mintz rc = request_irq(cdev->pdev->irq, qed_single_int, 521fe56b9e6SYuval Mintz flags, cdev->name, cdev); 522fe56b9e6SYuval Mintz } 523fe56b9e6SYuval Mintz 524fe56b9e6SYuval Mintz return rc; 525fe56b9e6SYuval Mintz } 526fe56b9e6SYuval Mintz 527fe56b9e6SYuval Mintz static void qed_slowpath_irq_free(struct qed_dev *cdev) 528fe56b9e6SYuval Mintz { 529fe56b9e6SYuval Mintz int i; 530fe56b9e6SYuval Mintz 531fe56b9e6SYuval Mintz if (cdev->int_params.out.int_mode == QED_INT_MODE_MSIX) { 532fe56b9e6SYuval Mintz for_each_hwfn(cdev, i) { 5338f16bc97SSudarsana Kalluru if (!cdev->hwfns[i].b_int_requested) 5348f16bc97SSudarsana Kalluru break; 535fe56b9e6SYuval Mintz synchronize_irq(cdev->int_params.msix_table[i].vector); 536fe56b9e6SYuval Mintz free_irq(cdev->int_params.msix_table[i].vector, 537fe56b9e6SYuval Mintz cdev->hwfns[i].sp_dpc); 538fe56b9e6SYuval Mintz } 539fe56b9e6SYuval Mintz } else { 5408f16bc97SSudarsana Kalluru if (QED_LEADING_HWFN(cdev)->b_int_requested) 541fe56b9e6SYuval Mintz free_irq(cdev->pdev->irq, cdev); 542fe56b9e6SYuval Mintz } 5438f16bc97SSudarsana Kalluru qed_int_disable_post_isr_release(cdev); 544fe56b9e6SYuval Mintz } 545fe56b9e6SYuval Mintz 546fe56b9e6SYuval Mintz static int qed_nic_stop(struct qed_dev *cdev) 547fe56b9e6SYuval Mintz { 548fe56b9e6SYuval Mintz int i, rc; 549fe56b9e6SYuval Mintz 550fe56b9e6SYuval Mintz rc = qed_hw_stop(cdev); 551fe56b9e6SYuval Mintz 552fe56b9e6SYuval Mintz for (i = 0; i < cdev->num_hwfns; i++) { 553fe56b9e6SYuval Mintz struct qed_hwfn *p_hwfn = &cdev->hwfns[i]; 554fe56b9e6SYuval Mintz 555fe56b9e6SYuval Mintz if (p_hwfn->b_sp_dpc_enabled) { 556fe56b9e6SYuval Mintz tasklet_disable(p_hwfn->sp_dpc); 557fe56b9e6SYuval Mintz p_hwfn->b_sp_dpc_enabled = false; 558fe56b9e6SYuval Mintz DP_VERBOSE(cdev, NETIF_MSG_IFDOWN, 559fe56b9e6SYuval Mintz "Disabled sp taskelt [hwfn %d] at %p\n", 560fe56b9e6SYuval Mintz i, p_hwfn->sp_dpc); 561fe56b9e6SYuval Mintz } 562fe56b9e6SYuval Mintz } 563fe56b9e6SYuval Mintz 564fe56b9e6SYuval Mintz return rc; 565fe56b9e6SYuval Mintz } 566fe56b9e6SYuval Mintz 567fe56b9e6SYuval Mintz static int qed_nic_reset(struct qed_dev *cdev) 568fe56b9e6SYuval Mintz { 569fe56b9e6SYuval Mintz int rc; 570fe56b9e6SYuval Mintz 571fe56b9e6SYuval Mintz rc = qed_hw_reset(cdev); 572fe56b9e6SYuval Mintz if (rc) 573fe56b9e6SYuval Mintz return rc; 574fe56b9e6SYuval Mintz 575fe56b9e6SYuval Mintz qed_resc_free(cdev); 576fe56b9e6SYuval Mintz 577fe56b9e6SYuval Mintz return 0; 578fe56b9e6SYuval Mintz } 579fe56b9e6SYuval Mintz 580fe56b9e6SYuval Mintz static int qed_nic_setup(struct qed_dev *cdev) 581fe56b9e6SYuval Mintz { 582fe56b9e6SYuval Mintz int rc; 583fe56b9e6SYuval Mintz 584fe56b9e6SYuval Mintz rc = qed_resc_alloc(cdev); 585fe56b9e6SYuval Mintz if (rc) 586fe56b9e6SYuval Mintz return rc; 587fe56b9e6SYuval Mintz 588fe56b9e6SYuval Mintz DP_INFO(cdev, "Allocated qed resources\n"); 589fe56b9e6SYuval Mintz 590fe56b9e6SYuval Mintz qed_resc_setup(cdev); 591fe56b9e6SYuval Mintz 592fe56b9e6SYuval Mintz return rc; 593fe56b9e6SYuval Mintz } 594fe56b9e6SYuval Mintz 595fe56b9e6SYuval Mintz static int qed_set_int_fp(struct qed_dev *cdev, u16 cnt) 596fe56b9e6SYuval Mintz { 597fe56b9e6SYuval Mintz int limit = 0; 598fe56b9e6SYuval Mintz 599fe56b9e6SYuval Mintz /* Mark the fastpath as free/used */ 600fe56b9e6SYuval Mintz cdev->int_params.fp_initialized = cnt ? true : false; 601fe56b9e6SYuval Mintz 602fe56b9e6SYuval Mintz if (cdev->int_params.out.int_mode != QED_INT_MODE_MSIX) 603fe56b9e6SYuval Mintz limit = cdev->num_hwfns * 63; 604fe56b9e6SYuval Mintz else if (cdev->int_params.fp_msix_cnt) 605fe56b9e6SYuval Mintz limit = cdev->int_params.fp_msix_cnt; 606fe56b9e6SYuval Mintz 607fe56b9e6SYuval Mintz if (!limit) 608fe56b9e6SYuval Mintz return -ENOMEM; 609fe56b9e6SYuval Mintz 610fe56b9e6SYuval Mintz return min_t(int, cnt, limit); 611fe56b9e6SYuval Mintz } 612fe56b9e6SYuval Mintz 613fe56b9e6SYuval Mintz static int qed_get_int_fp(struct qed_dev *cdev, struct qed_int_info *info) 614fe56b9e6SYuval Mintz { 615fe56b9e6SYuval Mintz memset(info, 0, sizeof(struct qed_int_info)); 616fe56b9e6SYuval Mintz 617fe56b9e6SYuval Mintz if (!cdev->int_params.fp_initialized) { 618fe56b9e6SYuval Mintz DP_INFO(cdev, 619fe56b9e6SYuval Mintz "Protocol driver requested interrupt information, but its support is not yet configured\n"); 620fe56b9e6SYuval Mintz return -EINVAL; 621fe56b9e6SYuval Mintz } 622fe56b9e6SYuval Mintz 623fe56b9e6SYuval Mintz /* Need to expose only MSI-X information; Single IRQ is handled solely 624fe56b9e6SYuval Mintz * by qed. 625fe56b9e6SYuval Mintz */ 626fe56b9e6SYuval Mintz if (cdev->int_params.out.int_mode == QED_INT_MODE_MSIX) { 627fe56b9e6SYuval Mintz int msix_base = cdev->int_params.fp_msix_base; 628fe56b9e6SYuval Mintz 629fe56b9e6SYuval Mintz info->msix_cnt = cdev->int_params.fp_msix_cnt; 630fe56b9e6SYuval Mintz info->msix = &cdev->int_params.msix_table[msix_base]; 631fe56b9e6SYuval Mintz } 632fe56b9e6SYuval Mintz 633fe56b9e6SYuval Mintz return 0; 634fe56b9e6SYuval Mintz } 635fe56b9e6SYuval Mintz 636fe56b9e6SYuval Mintz static int qed_slowpath_setup_int(struct qed_dev *cdev, 637fe56b9e6SYuval Mintz enum qed_int_mode int_mode) 638fe56b9e6SYuval Mintz { 6394ac801b7SYuval Mintz struct qed_sb_cnt_info sb_cnt_info; 6404ac801b7SYuval Mintz int rc; 6414ac801b7SYuval Mintz int i; 642fe56b9e6SYuval Mintz memset(&cdev->int_params, 0, sizeof(struct qed_int_params)); 643fe56b9e6SYuval Mintz 644fe56b9e6SYuval Mintz cdev->int_params.in.int_mode = int_mode; 6454ac801b7SYuval Mintz for_each_hwfn(cdev, i) { 6464ac801b7SYuval Mintz memset(&sb_cnt_info, 0, sizeof(sb_cnt_info)); 6474ac801b7SYuval Mintz qed_int_get_num_sbs(&cdev->hwfns[i], &sb_cnt_info); 6484ac801b7SYuval Mintz cdev->int_params.in.num_vectors += sb_cnt_info.sb_cnt; 6494ac801b7SYuval Mintz cdev->int_params.in.num_vectors++; /* slowpath */ 6504ac801b7SYuval Mintz } 651fe56b9e6SYuval Mintz 652fe56b9e6SYuval Mintz /* We want a minimum of one slowpath and one fastpath vector per hwfn */ 653fe56b9e6SYuval Mintz cdev->int_params.in.min_msix_cnt = cdev->num_hwfns * 2; 654fe56b9e6SYuval Mintz 655fe56b9e6SYuval Mintz rc = qed_set_int_mode(cdev, false); 656fe56b9e6SYuval Mintz if (rc) { 657fe56b9e6SYuval Mintz DP_ERR(cdev, "qed_slowpath_setup_int ERR\n"); 658fe56b9e6SYuval Mintz return rc; 659fe56b9e6SYuval Mintz } 660fe56b9e6SYuval Mintz 661fe56b9e6SYuval Mintz cdev->int_params.fp_msix_base = cdev->num_hwfns; 662fe56b9e6SYuval Mintz cdev->int_params.fp_msix_cnt = cdev->int_params.out.num_vectors - 663fe56b9e6SYuval Mintz cdev->num_hwfns; 664fe56b9e6SYuval Mintz 665fe56b9e6SYuval Mintz return 0; 666fe56b9e6SYuval Mintz } 667fe56b9e6SYuval Mintz 668fe56b9e6SYuval Mintz u32 qed_unzip_data(struct qed_hwfn *p_hwfn, u32 input_len, 669fe56b9e6SYuval Mintz u8 *input_buf, u32 max_size, u8 *unzip_buf) 670fe56b9e6SYuval Mintz { 671fe56b9e6SYuval Mintz int rc; 672fe56b9e6SYuval Mintz 673fe56b9e6SYuval Mintz p_hwfn->stream->next_in = input_buf; 674fe56b9e6SYuval Mintz p_hwfn->stream->avail_in = input_len; 675fe56b9e6SYuval Mintz p_hwfn->stream->next_out = unzip_buf; 676fe56b9e6SYuval Mintz p_hwfn->stream->avail_out = max_size; 677fe56b9e6SYuval Mintz 678fe56b9e6SYuval Mintz rc = zlib_inflateInit2(p_hwfn->stream, MAX_WBITS); 679fe56b9e6SYuval Mintz 680fe56b9e6SYuval Mintz if (rc != Z_OK) { 681fe56b9e6SYuval Mintz DP_VERBOSE(p_hwfn, NETIF_MSG_DRV, "zlib init failed, rc = %d\n", 682fe56b9e6SYuval Mintz rc); 683fe56b9e6SYuval Mintz return 0; 684fe56b9e6SYuval Mintz } 685fe56b9e6SYuval Mintz 686fe56b9e6SYuval Mintz rc = zlib_inflate(p_hwfn->stream, Z_FINISH); 687fe56b9e6SYuval Mintz zlib_inflateEnd(p_hwfn->stream); 688fe56b9e6SYuval Mintz 689fe56b9e6SYuval Mintz if (rc != Z_OK && rc != Z_STREAM_END) { 690fe56b9e6SYuval Mintz DP_VERBOSE(p_hwfn, NETIF_MSG_DRV, "FW unzip error: %s, rc=%d\n", 691fe56b9e6SYuval Mintz p_hwfn->stream->msg, rc); 692fe56b9e6SYuval Mintz return 0; 693fe56b9e6SYuval Mintz } 694fe56b9e6SYuval Mintz 695fe56b9e6SYuval Mintz return p_hwfn->stream->total_out / 4; 696fe56b9e6SYuval Mintz } 697fe56b9e6SYuval Mintz 698fe56b9e6SYuval Mintz static int qed_alloc_stream_mem(struct qed_dev *cdev) 699fe56b9e6SYuval Mintz { 700fe56b9e6SYuval Mintz int i; 701fe56b9e6SYuval Mintz void *workspace; 702fe56b9e6SYuval Mintz 703fe56b9e6SYuval Mintz for_each_hwfn(cdev, i) { 704fe56b9e6SYuval Mintz struct qed_hwfn *p_hwfn = &cdev->hwfns[i]; 705fe56b9e6SYuval Mintz 706fe56b9e6SYuval Mintz p_hwfn->stream = kzalloc(sizeof(*p_hwfn->stream), GFP_KERNEL); 707fe56b9e6SYuval Mintz if (!p_hwfn->stream) 708fe56b9e6SYuval Mintz return -ENOMEM; 709fe56b9e6SYuval Mintz 710fe56b9e6SYuval Mintz workspace = vzalloc(zlib_inflate_workspacesize()); 711fe56b9e6SYuval Mintz if (!workspace) 712fe56b9e6SYuval Mintz return -ENOMEM; 713fe56b9e6SYuval Mintz p_hwfn->stream->workspace = workspace; 714fe56b9e6SYuval Mintz } 715fe56b9e6SYuval Mintz 716fe56b9e6SYuval Mintz return 0; 717fe56b9e6SYuval Mintz } 718fe56b9e6SYuval Mintz 719fe56b9e6SYuval Mintz static void qed_free_stream_mem(struct qed_dev *cdev) 720fe56b9e6SYuval Mintz { 721fe56b9e6SYuval Mintz int i; 722fe56b9e6SYuval Mintz 723fe56b9e6SYuval Mintz for_each_hwfn(cdev, i) { 724fe56b9e6SYuval Mintz struct qed_hwfn *p_hwfn = &cdev->hwfns[i]; 725fe56b9e6SYuval Mintz 726fe56b9e6SYuval Mintz if (!p_hwfn->stream) 727fe56b9e6SYuval Mintz return; 728fe56b9e6SYuval Mintz 729fe56b9e6SYuval Mintz vfree(p_hwfn->stream->workspace); 730fe56b9e6SYuval Mintz kfree(p_hwfn->stream); 731fe56b9e6SYuval Mintz } 732fe56b9e6SYuval Mintz } 733fe56b9e6SYuval Mintz 734fe56b9e6SYuval Mintz static void qed_update_pf_params(struct qed_dev *cdev, 735fe56b9e6SYuval Mintz struct qed_pf_params *params) 736fe56b9e6SYuval Mintz { 737fe56b9e6SYuval Mintz int i; 738fe56b9e6SYuval Mintz 739fe56b9e6SYuval Mintz for (i = 0; i < cdev->num_hwfns; i++) { 740fe56b9e6SYuval Mintz struct qed_hwfn *p_hwfn = &cdev->hwfns[i]; 741fe56b9e6SYuval Mintz 742fe56b9e6SYuval Mintz p_hwfn->pf_params = *params; 743fe56b9e6SYuval Mintz } 744fe56b9e6SYuval Mintz } 745fe56b9e6SYuval Mintz 746fe56b9e6SYuval Mintz static int qed_slowpath_start(struct qed_dev *cdev, 747fe56b9e6SYuval Mintz struct qed_slowpath_params *params) 748fe56b9e6SYuval Mintz { 749b18e170cSManish Chopra struct qed_tunn_start_params tunn_info; 750fe56b9e6SYuval Mintz struct qed_mcp_drv_version drv_version; 751fe56b9e6SYuval Mintz const u8 *data = NULL; 752fe56b9e6SYuval Mintz struct qed_hwfn *hwfn; 75337bff2b9SYuval Mintz int rc = -EINVAL; 75437bff2b9SYuval Mintz 75537bff2b9SYuval Mintz if (qed_iov_wq_start(cdev)) 75637bff2b9SYuval Mintz goto err; 757fe56b9e6SYuval Mintz 758fe56b9e6SYuval Mintz rc = request_firmware(&cdev->firmware, QED_FW_FILE_NAME, 759fe56b9e6SYuval Mintz &cdev->pdev->dev); 760fe56b9e6SYuval Mintz if (rc) { 761fe56b9e6SYuval Mintz DP_NOTICE(cdev, 762fe56b9e6SYuval Mintz "Failed to find fw file - /lib/firmware/%s\n", 763fe56b9e6SYuval Mintz QED_FW_FILE_NAME); 764fe56b9e6SYuval Mintz goto err; 765fe56b9e6SYuval Mintz } 766fe56b9e6SYuval Mintz 767fe56b9e6SYuval Mintz rc = qed_nic_setup(cdev); 768fe56b9e6SYuval Mintz if (rc) 769fe56b9e6SYuval Mintz goto err; 770fe56b9e6SYuval Mintz 771fe56b9e6SYuval Mintz rc = qed_slowpath_setup_int(cdev, params->int_mode); 772fe56b9e6SYuval Mintz if (rc) 773fe56b9e6SYuval Mintz goto err1; 774fe56b9e6SYuval Mintz 775fe56b9e6SYuval Mintz /* Allocate stream for unzipping */ 776fe56b9e6SYuval Mintz rc = qed_alloc_stream_mem(cdev); 777fe56b9e6SYuval Mintz if (rc) { 778fe56b9e6SYuval Mintz DP_NOTICE(cdev, "Failed to allocate stream memory\n"); 7798f16bc97SSudarsana Kalluru goto err2; 780fe56b9e6SYuval Mintz } 781fe56b9e6SYuval Mintz 782fe56b9e6SYuval Mintz /* Start the slowpath */ 783fe56b9e6SYuval Mintz data = cdev->firmware->data; 784fe56b9e6SYuval Mintz 785b18e170cSManish Chopra memset(&tunn_info, 0, sizeof(tunn_info)); 7869a109dd0SManish Chopra tunn_info.tunn_mode |= 1 << QED_MODE_VXLAN_TUNN | 787f7985869SManish Chopra 1 << QED_MODE_L2GRE_TUNN | 788f7985869SManish Chopra 1 << QED_MODE_IPGRE_TUNN | 7899a109dd0SManish Chopra 1 << QED_MODE_L2GENEVE_TUNN | 7909a109dd0SManish Chopra 1 << QED_MODE_IPGENEVE_TUNN; 7919a109dd0SManish Chopra 792b18e170cSManish Chopra tunn_info.tunn_clss_vxlan = QED_TUNN_CLSS_MAC_VLAN; 793f7985869SManish Chopra tunn_info.tunn_clss_l2gre = QED_TUNN_CLSS_MAC_VLAN; 794f7985869SManish Chopra tunn_info.tunn_clss_ipgre = QED_TUNN_CLSS_MAC_VLAN; 795b18e170cSManish Chopra 796b18e170cSManish Chopra rc = qed_hw_init(cdev, &tunn_info, true, 797b18e170cSManish Chopra cdev->int_params.out.int_mode, 798fe56b9e6SYuval Mintz true, data); 799fe56b9e6SYuval Mintz if (rc) 8008c925c44SYuval Mintz goto err2; 801fe56b9e6SYuval Mintz 802fe56b9e6SYuval Mintz DP_INFO(cdev, 803fe56b9e6SYuval Mintz "HW initialization and function start completed successfully\n"); 804fe56b9e6SYuval Mintz 805fe56b9e6SYuval Mintz hwfn = QED_LEADING_HWFN(cdev); 806fe56b9e6SYuval Mintz drv_version.version = (params->drv_major << 24) | 807fe56b9e6SYuval Mintz (params->drv_minor << 16) | 808fe56b9e6SYuval Mintz (params->drv_rev << 8) | 809fe56b9e6SYuval Mintz (params->drv_eng); 810fe56b9e6SYuval Mintz strlcpy(drv_version.name, params->name, 811fe56b9e6SYuval Mintz MCP_DRV_VER_STR_SIZE - 4); 812fe56b9e6SYuval Mintz rc = qed_mcp_send_drv_version(hwfn, hwfn->p_main_ptt, 813fe56b9e6SYuval Mintz &drv_version); 814fe56b9e6SYuval Mintz if (rc) { 815fe56b9e6SYuval Mintz DP_NOTICE(cdev, "Failed sending drv version command\n"); 816fe56b9e6SYuval Mintz return rc; 817fe56b9e6SYuval Mintz } 818fe56b9e6SYuval Mintz 8198c925c44SYuval Mintz qed_reset_vport_stats(cdev); 8208c925c44SYuval Mintz 821fe56b9e6SYuval Mintz return 0; 822fe56b9e6SYuval Mintz 823fe56b9e6SYuval Mintz err2: 8248c925c44SYuval Mintz qed_hw_timers_stop_all(cdev); 8258c925c44SYuval Mintz qed_slowpath_irq_free(cdev); 8268c925c44SYuval Mintz qed_free_stream_mem(cdev); 827fe56b9e6SYuval Mintz qed_disable_msix(cdev); 828fe56b9e6SYuval Mintz err1: 829fe56b9e6SYuval Mintz qed_resc_free(cdev); 830fe56b9e6SYuval Mintz err: 831fe56b9e6SYuval Mintz release_firmware(cdev->firmware); 832fe56b9e6SYuval Mintz 83337bff2b9SYuval Mintz qed_iov_wq_stop(cdev, false); 83437bff2b9SYuval Mintz 835fe56b9e6SYuval Mintz return rc; 836fe56b9e6SYuval Mintz } 837fe56b9e6SYuval Mintz 838fe56b9e6SYuval Mintz static int qed_slowpath_stop(struct qed_dev *cdev) 839fe56b9e6SYuval Mintz { 840fe56b9e6SYuval Mintz if (!cdev) 841fe56b9e6SYuval Mintz return -ENODEV; 842fe56b9e6SYuval Mintz 843fe56b9e6SYuval Mintz qed_free_stream_mem(cdev); 844fe56b9e6SYuval Mintz 845fe56b9e6SYuval Mintz qed_nic_stop(cdev); 846fe56b9e6SYuval Mintz qed_slowpath_irq_free(cdev); 847fe56b9e6SYuval Mintz 848fe56b9e6SYuval Mintz qed_disable_msix(cdev); 849fe56b9e6SYuval Mintz qed_nic_reset(cdev); 850fe56b9e6SYuval Mintz 85137bff2b9SYuval Mintz qed_iov_wq_stop(cdev, true); 85237bff2b9SYuval Mintz 853fe56b9e6SYuval Mintz release_firmware(cdev->firmware); 854fe56b9e6SYuval Mintz 855fe56b9e6SYuval Mintz return 0; 856fe56b9e6SYuval Mintz } 857fe56b9e6SYuval Mintz 858fe56b9e6SYuval Mintz static void qed_set_id(struct qed_dev *cdev, char name[NAME_SIZE], 859fe56b9e6SYuval Mintz char ver_str[VER_SIZE]) 860fe56b9e6SYuval Mintz { 861fe56b9e6SYuval Mintz int i; 862fe56b9e6SYuval Mintz 863fe56b9e6SYuval Mintz memcpy(cdev->name, name, NAME_SIZE); 864fe56b9e6SYuval Mintz for_each_hwfn(cdev, i) 865fe56b9e6SYuval Mintz snprintf(cdev->hwfns[i].name, NAME_SIZE, "%s-%d", name, i); 866fe56b9e6SYuval Mintz 867fe56b9e6SYuval Mintz memcpy(cdev->ver_str, ver_str, VER_SIZE); 868fe56b9e6SYuval Mintz cdev->drv_type = DRV_ID_DRV_TYPE_LINUX; 869fe56b9e6SYuval Mintz } 870fe56b9e6SYuval Mintz 871fe56b9e6SYuval Mintz static u32 qed_sb_init(struct qed_dev *cdev, 872fe56b9e6SYuval Mintz struct qed_sb_info *sb_info, 873fe56b9e6SYuval Mintz void *sb_virt_addr, 874fe56b9e6SYuval Mintz dma_addr_t sb_phy_addr, u16 sb_id, 875fe56b9e6SYuval Mintz enum qed_sb_type type) 876fe56b9e6SYuval Mintz { 877fe56b9e6SYuval Mintz struct qed_hwfn *p_hwfn; 878fe56b9e6SYuval Mintz int hwfn_index; 879fe56b9e6SYuval Mintz u16 rel_sb_id; 880fe56b9e6SYuval Mintz u8 n_hwfns; 881fe56b9e6SYuval Mintz u32 rc; 882fe56b9e6SYuval Mintz 883fe56b9e6SYuval Mintz /* RoCE uses single engine and CMT uses two engines. When using both 884fe56b9e6SYuval Mintz * we force only a single engine. Storage uses only engine 0 too. 885fe56b9e6SYuval Mintz */ 886fe56b9e6SYuval Mintz if (type == QED_SB_TYPE_L2_QUEUE) 887fe56b9e6SYuval Mintz n_hwfns = cdev->num_hwfns; 888fe56b9e6SYuval Mintz else 889fe56b9e6SYuval Mintz n_hwfns = 1; 890fe56b9e6SYuval Mintz 891fe56b9e6SYuval Mintz hwfn_index = sb_id % n_hwfns; 892fe56b9e6SYuval Mintz p_hwfn = &cdev->hwfns[hwfn_index]; 893fe56b9e6SYuval Mintz rel_sb_id = sb_id / n_hwfns; 894fe56b9e6SYuval Mintz 895fe56b9e6SYuval Mintz DP_VERBOSE(cdev, NETIF_MSG_INTR, 896fe56b9e6SYuval Mintz "hwfn [%d] <--[init]-- SB %04x [0x%04x upper]\n", 897fe56b9e6SYuval Mintz hwfn_index, rel_sb_id, sb_id); 898fe56b9e6SYuval Mintz 899fe56b9e6SYuval Mintz rc = qed_int_sb_init(p_hwfn, p_hwfn->p_main_ptt, sb_info, 900fe56b9e6SYuval Mintz sb_virt_addr, sb_phy_addr, rel_sb_id); 901fe56b9e6SYuval Mintz 902fe56b9e6SYuval Mintz return rc; 903fe56b9e6SYuval Mintz } 904fe56b9e6SYuval Mintz 905fe56b9e6SYuval Mintz static u32 qed_sb_release(struct qed_dev *cdev, 906fe56b9e6SYuval Mintz struct qed_sb_info *sb_info, 907fe56b9e6SYuval Mintz u16 sb_id) 908fe56b9e6SYuval Mintz { 909fe56b9e6SYuval Mintz struct qed_hwfn *p_hwfn; 910fe56b9e6SYuval Mintz int hwfn_index; 911fe56b9e6SYuval Mintz u16 rel_sb_id; 912fe56b9e6SYuval Mintz u32 rc; 913fe56b9e6SYuval Mintz 914fe56b9e6SYuval Mintz hwfn_index = sb_id % cdev->num_hwfns; 915fe56b9e6SYuval Mintz p_hwfn = &cdev->hwfns[hwfn_index]; 916fe56b9e6SYuval Mintz rel_sb_id = sb_id / cdev->num_hwfns; 917fe56b9e6SYuval Mintz 918fe56b9e6SYuval Mintz DP_VERBOSE(cdev, NETIF_MSG_INTR, 919fe56b9e6SYuval Mintz "hwfn [%d] <--[init]-- SB %04x [0x%04x upper]\n", 920fe56b9e6SYuval Mintz hwfn_index, rel_sb_id, sb_id); 921fe56b9e6SYuval Mintz 922fe56b9e6SYuval Mintz rc = qed_int_sb_release(p_hwfn, sb_info, rel_sb_id); 923fe56b9e6SYuval Mintz 924fe56b9e6SYuval Mintz return rc; 925fe56b9e6SYuval Mintz } 926fe56b9e6SYuval Mintz 927fe7cd2bfSYuval Mintz static bool qed_can_link_change(struct qed_dev *cdev) 928fe7cd2bfSYuval Mintz { 929fe7cd2bfSYuval Mintz return true; 930fe7cd2bfSYuval Mintz } 931fe7cd2bfSYuval Mintz 932cc875c2eSYuval Mintz static int qed_set_link(struct qed_dev *cdev, 933cc875c2eSYuval Mintz struct qed_link_params *params) 934cc875c2eSYuval Mintz { 935cc875c2eSYuval Mintz struct qed_hwfn *hwfn; 936cc875c2eSYuval Mintz struct qed_mcp_link_params *link_params; 937cc875c2eSYuval Mintz struct qed_ptt *ptt; 938cc875c2eSYuval Mintz int rc; 939cc875c2eSYuval Mintz 940cc875c2eSYuval Mintz if (!cdev) 941cc875c2eSYuval Mintz return -ENODEV; 942cc875c2eSYuval Mintz 943cc875c2eSYuval Mintz /* The link should be set only once per PF */ 944cc875c2eSYuval Mintz hwfn = &cdev->hwfns[0]; 945cc875c2eSYuval Mintz 946cc875c2eSYuval Mintz ptt = qed_ptt_acquire(hwfn); 947cc875c2eSYuval Mintz if (!ptt) 948cc875c2eSYuval Mintz return -EBUSY; 949cc875c2eSYuval Mintz 950cc875c2eSYuval Mintz link_params = qed_mcp_get_link_params(hwfn); 951cc875c2eSYuval Mintz if (params->override_flags & QED_LINK_OVERRIDE_SPEED_AUTONEG) 952cc875c2eSYuval Mintz link_params->speed.autoneg = params->autoneg; 953cc875c2eSYuval Mintz if (params->override_flags & QED_LINK_OVERRIDE_SPEED_ADV_SPEEDS) { 954cc875c2eSYuval Mintz link_params->speed.advertised_speeds = 0; 955cc875c2eSYuval Mintz if ((params->adv_speeds & SUPPORTED_1000baseT_Half) || 956cc875c2eSYuval Mintz (params->adv_speeds & SUPPORTED_1000baseT_Full)) 957cc875c2eSYuval Mintz link_params->speed.advertised_speeds |= 958cc875c2eSYuval Mintz NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_1G; 959cc875c2eSYuval Mintz if (params->adv_speeds & SUPPORTED_10000baseKR_Full) 960cc875c2eSYuval Mintz link_params->speed.advertised_speeds |= 961cc875c2eSYuval Mintz NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_10G; 962cc875c2eSYuval Mintz if (params->adv_speeds & SUPPORTED_40000baseLR4_Full) 963cc875c2eSYuval Mintz link_params->speed.advertised_speeds |= 964cc875c2eSYuval Mintz NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_40G; 965cc875c2eSYuval Mintz if (params->adv_speeds & 0) 966cc875c2eSYuval Mintz link_params->speed.advertised_speeds |= 967cc875c2eSYuval Mintz NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_50G; 968cc875c2eSYuval Mintz if (params->adv_speeds & 0) 969cc875c2eSYuval Mintz link_params->speed.advertised_speeds |= 970cc875c2eSYuval Mintz NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_100G; 971cc875c2eSYuval Mintz } 972cc875c2eSYuval Mintz if (params->override_flags & QED_LINK_OVERRIDE_SPEED_FORCED_SPEED) 973cc875c2eSYuval Mintz link_params->speed.forced_speed = params->forced_speed; 974a43f235fSSudarsana Reddy Kalluru if (params->override_flags & QED_LINK_OVERRIDE_PAUSE_CONFIG) { 975a43f235fSSudarsana Reddy Kalluru if (params->pause_config & QED_LINK_PAUSE_AUTONEG_ENABLE) 976a43f235fSSudarsana Reddy Kalluru link_params->pause.autoneg = true; 977a43f235fSSudarsana Reddy Kalluru else 978a43f235fSSudarsana Reddy Kalluru link_params->pause.autoneg = false; 979a43f235fSSudarsana Reddy Kalluru if (params->pause_config & QED_LINK_PAUSE_RX_ENABLE) 980a43f235fSSudarsana Reddy Kalluru link_params->pause.forced_rx = true; 981a43f235fSSudarsana Reddy Kalluru else 982a43f235fSSudarsana Reddy Kalluru link_params->pause.forced_rx = false; 983a43f235fSSudarsana Reddy Kalluru if (params->pause_config & QED_LINK_PAUSE_TX_ENABLE) 984a43f235fSSudarsana Reddy Kalluru link_params->pause.forced_tx = true; 985a43f235fSSudarsana Reddy Kalluru else 986a43f235fSSudarsana Reddy Kalluru link_params->pause.forced_tx = false; 987a43f235fSSudarsana Reddy Kalluru } 98803dc76caSSudarsana Reddy Kalluru if (params->override_flags & QED_LINK_OVERRIDE_LOOPBACK_MODE) { 98903dc76caSSudarsana Reddy Kalluru switch (params->loopback_mode) { 99003dc76caSSudarsana Reddy Kalluru case QED_LINK_LOOPBACK_INT_PHY: 99103dc76caSSudarsana Reddy Kalluru link_params->loopback_mode = PMM_LOOPBACK_INT_PHY; 99203dc76caSSudarsana Reddy Kalluru break; 99303dc76caSSudarsana Reddy Kalluru case QED_LINK_LOOPBACK_EXT_PHY: 99403dc76caSSudarsana Reddy Kalluru link_params->loopback_mode = PMM_LOOPBACK_EXT_PHY; 99503dc76caSSudarsana Reddy Kalluru break; 99603dc76caSSudarsana Reddy Kalluru case QED_LINK_LOOPBACK_EXT: 99703dc76caSSudarsana Reddy Kalluru link_params->loopback_mode = PMM_LOOPBACK_EXT; 99803dc76caSSudarsana Reddy Kalluru break; 99903dc76caSSudarsana Reddy Kalluru case QED_LINK_LOOPBACK_MAC: 100003dc76caSSudarsana Reddy Kalluru link_params->loopback_mode = PMM_LOOPBACK_MAC; 100103dc76caSSudarsana Reddy Kalluru break; 100203dc76caSSudarsana Reddy Kalluru default: 100303dc76caSSudarsana Reddy Kalluru link_params->loopback_mode = PMM_LOOPBACK_NONE; 100403dc76caSSudarsana Reddy Kalluru break; 100503dc76caSSudarsana Reddy Kalluru } 100603dc76caSSudarsana Reddy Kalluru } 1007cc875c2eSYuval Mintz 1008cc875c2eSYuval Mintz rc = qed_mcp_set_link(hwfn, ptt, params->link_up); 1009cc875c2eSYuval Mintz 1010cc875c2eSYuval Mintz qed_ptt_release(hwfn, ptt); 1011cc875c2eSYuval Mintz 1012cc875c2eSYuval Mintz return rc; 1013cc875c2eSYuval Mintz } 1014cc875c2eSYuval Mintz 1015cc875c2eSYuval Mintz static int qed_get_port_type(u32 media_type) 1016cc875c2eSYuval Mintz { 1017cc875c2eSYuval Mintz int port_type; 1018cc875c2eSYuval Mintz 1019cc875c2eSYuval Mintz switch (media_type) { 1020cc875c2eSYuval Mintz case MEDIA_SFPP_10G_FIBER: 1021cc875c2eSYuval Mintz case MEDIA_SFP_1G_FIBER: 1022cc875c2eSYuval Mintz case MEDIA_XFP_FIBER: 1023cc875c2eSYuval Mintz case MEDIA_KR: 1024cc875c2eSYuval Mintz port_type = PORT_FIBRE; 1025cc875c2eSYuval Mintz break; 1026cc875c2eSYuval Mintz case MEDIA_DA_TWINAX: 1027cc875c2eSYuval Mintz port_type = PORT_DA; 1028cc875c2eSYuval Mintz break; 1029cc875c2eSYuval Mintz case MEDIA_BASE_T: 1030cc875c2eSYuval Mintz port_type = PORT_TP; 1031cc875c2eSYuval Mintz break; 1032cc875c2eSYuval Mintz case MEDIA_NOT_PRESENT: 1033cc875c2eSYuval Mintz port_type = PORT_NONE; 1034cc875c2eSYuval Mintz break; 1035cc875c2eSYuval Mintz case MEDIA_UNSPECIFIED: 1036cc875c2eSYuval Mintz default: 1037cc875c2eSYuval Mintz port_type = PORT_OTHER; 1038cc875c2eSYuval Mintz break; 1039cc875c2eSYuval Mintz } 1040cc875c2eSYuval Mintz return port_type; 1041cc875c2eSYuval Mintz } 1042cc875c2eSYuval Mintz 1043cc875c2eSYuval Mintz static void qed_fill_link(struct qed_hwfn *hwfn, 1044cc875c2eSYuval Mintz struct qed_link_output *if_link) 1045cc875c2eSYuval Mintz { 1046cc875c2eSYuval Mintz struct qed_mcp_link_params params; 1047cc875c2eSYuval Mintz struct qed_mcp_link_state link; 1048cc875c2eSYuval Mintz struct qed_mcp_link_capabilities link_caps; 1049cc875c2eSYuval Mintz u32 media_type; 1050cc875c2eSYuval Mintz 1051cc875c2eSYuval Mintz memset(if_link, 0, sizeof(*if_link)); 1052cc875c2eSYuval Mintz 1053cc875c2eSYuval Mintz /* Prepare source inputs */ 1054cc875c2eSYuval Mintz memcpy(¶ms, qed_mcp_get_link_params(hwfn), sizeof(params)); 1055cc875c2eSYuval Mintz memcpy(&link, qed_mcp_get_link_state(hwfn), sizeof(link)); 1056cc875c2eSYuval Mintz memcpy(&link_caps, qed_mcp_get_link_capabilities(hwfn), 1057cc875c2eSYuval Mintz sizeof(link_caps)); 1058cc875c2eSYuval Mintz 1059cc875c2eSYuval Mintz /* Set the link parameters to pass to protocol driver */ 1060cc875c2eSYuval Mintz if (link.link_up) 1061cc875c2eSYuval Mintz if_link->link_up = true; 1062cc875c2eSYuval Mintz 1063cc875c2eSYuval Mintz /* TODO - at the moment assume supported and advertised speed equal */ 1064cc875c2eSYuval Mintz if_link->supported_caps = SUPPORTED_FIBRE; 1065cc875c2eSYuval Mintz if (params.speed.autoneg) 1066cc875c2eSYuval Mintz if_link->supported_caps |= SUPPORTED_Autoneg; 1067cc875c2eSYuval Mintz if (params.pause.autoneg || 1068cc875c2eSYuval Mintz (params.pause.forced_rx && params.pause.forced_tx)) 1069cc875c2eSYuval Mintz if_link->supported_caps |= SUPPORTED_Asym_Pause; 1070cc875c2eSYuval Mintz if (params.pause.autoneg || params.pause.forced_rx || 1071cc875c2eSYuval Mintz params.pause.forced_tx) 1072cc875c2eSYuval Mintz if_link->supported_caps |= SUPPORTED_Pause; 1073cc875c2eSYuval Mintz 1074cc875c2eSYuval Mintz if_link->advertised_caps = if_link->supported_caps; 1075cc875c2eSYuval Mintz if (params.speed.advertised_speeds & 1076cc875c2eSYuval Mintz NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_1G) 1077cc875c2eSYuval Mintz if_link->advertised_caps |= SUPPORTED_1000baseT_Half | 1078cc875c2eSYuval Mintz SUPPORTED_1000baseT_Full; 1079cc875c2eSYuval Mintz if (params.speed.advertised_speeds & 1080cc875c2eSYuval Mintz NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_10G) 1081cc875c2eSYuval Mintz if_link->advertised_caps |= SUPPORTED_10000baseKR_Full; 1082cc875c2eSYuval Mintz if (params.speed.advertised_speeds & 1083cc875c2eSYuval Mintz NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_40G) 1084cc875c2eSYuval Mintz if_link->advertised_caps |= SUPPORTED_40000baseLR4_Full; 1085cc875c2eSYuval Mintz if (params.speed.advertised_speeds & 1086cc875c2eSYuval Mintz NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_50G) 1087cc875c2eSYuval Mintz if_link->advertised_caps |= 0; 1088cc875c2eSYuval Mintz if (params.speed.advertised_speeds & 1089cc875c2eSYuval Mintz NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_100G) 1090cc875c2eSYuval Mintz if_link->advertised_caps |= 0; 1091cc875c2eSYuval Mintz 1092cc875c2eSYuval Mintz if (link_caps.speed_capabilities & 1093cc875c2eSYuval Mintz NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_1G) 1094cc875c2eSYuval Mintz if_link->supported_caps |= SUPPORTED_1000baseT_Half | 1095cc875c2eSYuval Mintz SUPPORTED_1000baseT_Full; 1096cc875c2eSYuval Mintz if (link_caps.speed_capabilities & 1097cc875c2eSYuval Mintz NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_10G) 1098cc875c2eSYuval Mintz if_link->supported_caps |= SUPPORTED_10000baseKR_Full; 1099cc875c2eSYuval Mintz if (link_caps.speed_capabilities & 1100cc875c2eSYuval Mintz NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_40G) 1101cc875c2eSYuval Mintz if_link->supported_caps |= SUPPORTED_40000baseLR4_Full; 1102cc875c2eSYuval Mintz if (link_caps.speed_capabilities & 1103cc875c2eSYuval Mintz NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_50G) 1104cc875c2eSYuval Mintz if_link->supported_caps |= 0; 1105cc875c2eSYuval Mintz if (link_caps.speed_capabilities & 1106cc875c2eSYuval Mintz NVM_CFG1_PORT_DRV_SPEED_CAPABILITY_MASK_100G) 1107cc875c2eSYuval Mintz if_link->supported_caps |= 0; 1108cc875c2eSYuval Mintz 1109cc875c2eSYuval Mintz if (link.link_up) 1110cc875c2eSYuval Mintz if_link->speed = link.speed; 1111cc875c2eSYuval Mintz 1112cc875c2eSYuval Mintz /* TODO - fill duplex properly */ 1113cc875c2eSYuval Mintz if_link->duplex = DUPLEX_FULL; 1114cc875c2eSYuval Mintz qed_mcp_get_media_type(hwfn->cdev, &media_type); 1115cc875c2eSYuval Mintz if_link->port = qed_get_port_type(media_type); 1116cc875c2eSYuval Mintz 1117cc875c2eSYuval Mintz if_link->autoneg = params.speed.autoneg; 1118cc875c2eSYuval Mintz 1119cc875c2eSYuval Mintz if (params.pause.autoneg) 1120cc875c2eSYuval Mintz if_link->pause_config |= QED_LINK_PAUSE_AUTONEG_ENABLE; 1121cc875c2eSYuval Mintz if (params.pause.forced_rx) 1122cc875c2eSYuval Mintz if_link->pause_config |= QED_LINK_PAUSE_RX_ENABLE; 1123cc875c2eSYuval Mintz if (params.pause.forced_tx) 1124cc875c2eSYuval Mintz if_link->pause_config |= QED_LINK_PAUSE_TX_ENABLE; 1125cc875c2eSYuval Mintz 1126cc875c2eSYuval Mintz /* Link partner capabilities */ 1127cc875c2eSYuval Mintz if (link.partner_adv_speed & 1128cc875c2eSYuval Mintz QED_LINK_PARTNER_SPEED_1G_HD) 1129cc875c2eSYuval Mintz if_link->lp_caps |= SUPPORTED_1000baseT_Half; 1130cc875c2eSYuval Mintz if (link.partner_adv_speed & 1131cc875c2eSYuval Mintz QED_LINK_PARTNER_SPEED_1G_FD) 1132cc875c2eSYuval Mintz if_link->lp_caps |= SUPPORTED_1000baseT_Full; 1133cc875c2eSYuval Mintz if (link.partner_adv_speed & 1134cc875c2eSYuval Mintz QED_LINK_PARTNER_SPEED_10G) 1135cc875c2eSYuval Mintz if_link->lp_caps |= SUPPORTED_10000baseKR_Full; 1136cc875c2eSYuval Mintz if (link.partner_adv_speed & 1137cc875c2eSYuval Mintz QED_LINK_PARTNER_SPEED_40G) 1138cc875c2eSYuval Mintz if_link->lp_caps |= SUPPORTED_40000baseLR4_Full; 1139cc875c2eSYuval Mintz if (link.partner_adv_speed & 1140cc875c2eSYuval Mintz QED_LINK_PARTNER_SPEED_50G) 1141cc875c2eSYuval Mintz if_link->lp_caps |= 0; 1142cc875c2eSYuval Mintz if (link.partner_adv_speed & 1143cc875c2eSYuval Mintz QED_LINK_PARTNER_SPEED_100G) 1144cc875c2eSYuval Mintz if_link->lp_caps |= 0; 1145cc875c2eSYuval Mintz 1146cc875c2eSYuval Mintz if (link.an_complete) 1147cc875c2eSYuval Mintz if_link->lp_caps |= SUPPORTED_Autoneg; 1148cc875c2eSYuval Mintz 1149cc875c2eSYuval Mintz if (link.partner_adv_pause) 1150cc875c2eSYuval Mintz if_link->lp_caps |= SUPPORTED_Pause; 1151cc875c2eSYuval Mintz if (link.partner_adv_pause == QED_LINK_PARTNER_ASYMMETRIC_PAUSE || 1152cc875c2eSYuval Mintz link.partner_adv_pause == QED_LINK_PARTNER_BOTH_PAUSE) 1153cc875c2eSYuval Mintz if_link->lp_caps |= SUPPORTED_Asym_Pause; 1154cc875c2eSYuval Mintz } 1155cc875c2eSYuval Mintz 1156cc875c2eSYuval Mintz static void qed_get_current_link(struct qed_dev *cdev, 1157cc875c2eSYuval Mintz struct qed_link_output *if_link) 1158cc875c2eSYuval Mintz { 1159cc875c2eSYuval Mintz qed_fill_link(&cdev->hwfns[0], if_link); 1160cc875c2eSYuval Mintz } 1161cc875c2eSYuval Mintz 1162cc875c2eSYuval Mintz void qed_link_update(struct qed_hwfn *hwfn) 1163cc875c2eSYuval Mintz { 1164cc875c2eSYuval Mintz void *cookie = hwfn->cdev->ops_cookie; 1165cc875c2eSYuval Mintz struct qed_common_cb_ops *op = hwfn->cdev->protocol_ops.common; 1166cc875c2eSYuval Mintz struct qed_link_output if_link; 1167cc875c2eSYuval Mintz 1168cc875c2eSYuval Mintz qed_fill_link(hwfn, &if_link); 1169cc875c2eSYuval Mintz 1170cc875c2eSYuval Mintz if (IS_LEAD_HWFN(hwfn) && cookie) 1171cc875c2eSYuval Mintz op->link_update(cookie, &if_link); 1172cc875c2eSYuval Mintz } 1173cc875c2eSYuval Mintz 1174fe56b9e6SYuval Mintz static int qed_drain(struct qed_dev *cdev) 1175fe56b9e6SYuval Mintz { 1176fe56b9e6SYuval Mintz struct qed_hwfn *hwfn; 1177fe56b9e6SYuval Mintz struct qed_ptt *ptt; 1178fe56b9e6SYuval Mintz int i, rc; 1179fe56b9e6SYuval Mintz 1180fe56b9e6SYuval Mintz for_each_hwfn(cdev, i) { 1181fe56b9e6SYuval Mintz hwfn = &cdev->hwfns[i]; 1182fe56b9e6SYuval Mintz ptt = qed_ptt_acquire(hwfn); 1183fe56b9e6SYuval Mintz if (!ptt) { 1184fe56b9e6SYuval Mintz DP_NOTICE(hwfn, "Failed to drain NIG; No PTT\n"); 1185fe56b9e6SYuval Mintz return -EBUSY; 1186fe56b9e6SYuval Mintz } 1187fe56b9e6SYuval Mintz rc = qed_mcp_drain(hwfn, ptt); 1188fe56b9e6SYuval Mintz if (rc) 1189fe56b9e6SYuval Mintz return rc; 1190fe56b9e6SYuval Mintz qed_ptt_release(hwfn, ptt); 1191fe56b9e6SYuval Mintz } 1192fe56b9e6SYuval Mintz 1193fe56b9e6SYuval Mintz return 0; 1194fe56b9e6SYuval Mintz } 1195fe56b9e6SYuval Mintz 119691420b83SSudarsana Kalluru static int qed_set_led(struct qed_dev *cdev, enum qed_led_mode mode) 119791420b83SSudarsana Kalluru { 119891420b83SSudarsana Kalluru struct qed_hwfn *hwfn = QED_LEADING_HWFN(cdev); 119991420b83SSudarsana Kalluru struct qed_ptt *ptt; 120091420b83SSudarsana Kalluru int status = 0; 120191420b83SSudarsana Kalluru 120291420b83SSudarsana Kalluru ptt = qed_ptt_acquire(hwfn); 120391420b83SSudarsana Kalluru if (!ptt) 120491420b83SSudarsana Kalluru return -EAGAIN; 120591420b83SSudarsana Kalluru 120691420b83SSudarsana Kalluru status = qed_mcp_set_led(hwfn, ptt, mode); 120791420b83SSudarsana Kalluru 120891420b83SSudarsana Kalluru qed_ptt_release(hwfn, ptt); 120991420b83SSudarsana Kalluru 121091420b83SSudarsana Kalluru return status; 121191420b83SSudarsana Kalluru } 121291420b83SSudarsana Kalluru 121303dc76caSSudarsana Reddy Kalluru struct qed_selftest_ops qed_selftest_ops_pass = { 121403dc76caSSudarsana Reddy Kalluru .selftest_memory = &qed_selftest_memory, 121503dc76caSSudarsana Reddy Kalluru .selftest_interrupt = &qed_selftest_interrupt, 121603dc76caSSudarsana Reddy Kalluru .selftest_register = &qed_selftest_register, 121703dc76caSSudarsana Reddy Kalluru .selftest_clock = &qed_selftest_clock, 121803dc76caSSudarsana Reddy Kalluru }; 121903dc76caSSudarsana Reddy Kalluru 1220fe56b9e6SYuval Mintz const struct qed_common_ops qed_common_ops_pass = { 122103dc76caSSudarsana Reddy Kalluru .selftest = &qed_selftest_ops_pass, 1222fe56b9e6SYuval Mintz .probe = &qed_probe, 1223fe56b9e6SYuval Mintz .remove = &qed_remove, 1224fe56b9e6SYuval Mintz .set_power_state = &qed_set_power_state, 1225fe56b9e6SYuval Mintz .set_id = &qed_set_id, 1226fe56b9e6SYuval Mintz .update_pf_params = &qed_update_pf_params, 1227fe56b9e6SYuval Mintz .slowpath_start = &qed_slowpath_start, 1228fe56b9e6SYuval Mintz .slowpath_stop = &qed_slowpath_stop, 1229fe56b9e6SYuval Mintz .set_fp_int = &qed_set_int_fp, 1230fe56b9e6SYuval Mintz .get_fp_int = &qed_get_int_fp, 1231fe56b9e6SYuval Mintz .sb_init = &qed_sb_init, 1232fe56b9e6SYuval Mintz .sb_release = &qed_sb_release, 1233fe56b9e6SYuval Mintz .simd_handler_config = &qed_simd_handler_config, 1234fe56b9e6SYuval Mintz .simd_handler_clean = &qed_simd_handler_clean, 1235fe7cd2bfSYuval Mintz .can_link_change = &qed_can_link_change, 1236cc875c2eSYuval Mintz .set_link = &qed_set_link, 1237cc875c2eSYuval Mintz .get_link = &qed_get_current_link, 1238fe56b9e6SYuval Mintz .drain = &qed_drain, 1239fe56b9e6SYuval Mintz .update_msglvl = &qed_init_dp, 1240fe56b9e6SYuval Mintz .chain_alloc = &qed_chain_alloc, 1241fe56b9e6SYuval Mintz .chain_free = &qed_chain_free, 124291420b83SSudarsana Kalluru .set_led = &qed_set_led, 1243fe56b9e6SYuval Mintz }; 1244