| /* |
| * This file is provided under a dual BSD/GPLv2 license. When using or |
| * redistributing this file, you may do so under either license. |
| * |
| * GPL LICENSE SUMMARY |
| * |
| * Copyright(c) 2012 Intel Corporation. All rights reserved. |
| * Copyright (C) 2015 EMC Corporation. All Rights Reserved. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of version 2 of the GNU General Public License as |
| * published by the Free Software Foundation. |
| * |
| * BSD LICENSE |
| * |
| * Copyright(c) 2012 Intel Corporation. All rights reserved. |
| * Copyright (C) 2015 EMC Corporation. All Rights Reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions |
| * are met: |
| * |
| * * Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * * Redistributions in binary form must reproduce the above copy |
| * notice, this list of conditions and the following disclaimer in |
| * the documentation and/or other materials provided with the |
| * distribution. |
| * * Neither the name of Intel Corporation nor the names of its |
| * contributors may be used to endorse or promote products derived |
| * from this software without specific prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
| * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
| * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR |
| * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT |
| * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, |
| * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT |
| * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
| * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
| * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
| * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| * |
| * Intel PCIe NTB Linux driver |
| * |
| * Contact Information: |
| * Jon Mason <jon.mason@intel.com> |
| */ |
| |
| #include <linux/debugfs.h> |
| #include <linux/delay.h> |
| #include <linux/init.h> |
| #include <linux/interrupt.h> |
| #include <linux/module.h> |
| #include <linux/pci.h> |
| #include <linux/random.h> |
| #include <linux/slab.h> |
| #include <linux/ntb.h> |
| |
| #include "ntb_hw_intel.h" |
| |
| #define NTB_NAME "ntb_hw_intel" |
| #define NTB_DESC "Intel(R) PCI-E Non-Transparent Bridge Driver" |
| #define NTB_VER "2.0" |
| |
| MODULE_DESCRIPTION(NTB_DESC); |
| MODULE_VERSION(NTB_VER); |
| MODULE_LICENSE("Dual BSD/GPL"); |
| MODULE_AUTHOR("Intel Corporation"); |
| |
| #define bar0_off(base, bar) ((base) + ((bar) << 2)) |
| #define bar2_off(base, bar) bar0_off(base, (bar) - 2) |
| |
| static int b2b_mw_idx = -1; |
| module_param(b2b_mw_idx, int, 0644); |
| MODULE_PARM_DESC(b2b_mw_idx, "Use this mw idx to access the peer ntb. A " |
| "value of zero or positive starts from first mw idx, and a " |
| "negative value starts from last mw idx. Both sides MUST " |
| "set the same value here!"); |
| |
| static unsigned int b2b_mw_share; |
| module_param(b2b_mw_share, uint, 0644); |
| MODULE_PARM_DESC(b2b_mw_share, "If the b2b mw is large enough, configure the " |
| "ntb so that the peer ntb only occupies the first half of " |
| "the mw, so the second half can still be used as a mw. Both " |
| "sides MUST set the same value here!"); |
| |
| static const struct intel_ntb_reg bwd_reg; |
| static const struct intel_ntb_alt_reg bwd_pri_reg; |
| static const struct intel_ntb_alt_reg bwd_sec_reg; |
| static const struct intel_ntb_alt_reg bwd_b2b_reg; |
| static const struct intel_ntb_xlat_reg bwd_pri_xlat; |
| static const struct intel_ntb_xlat_reg bwd_sec_xlat; |
| static const struct intel_ntb_reg snb_reg; |
| static const struct intel_ntb_alt_reg snb_pri_reg; |
| static const struct intel_ntb_alt_reg snb_sec_reg; |
| static const struct intel_ntb_alt_reg snb_b2b_reg; |
| static const struct intel_ntb_xlat_reg snb_pri_xlat; |
| static const struct intel_ntb_xlat_reg snb_sec_xlat; |
| static const struct intel_b2b_addr snb_b2b_usd_addr; |
| static const struct intel_b2b_addr snb_b2b_dsd_addr; |
| |
| static const struct ntb_dev_ops intel_ntb_ops; |
| |
| static const struct file_operations intel_ntb_debugfs_info; |
| static struct dentry *debugfs_dir; |
| |
| #ifndef ioread64 |
| #ifdef readq |
| #define ioread64 readq |
| #else |
| #define ioread64 _ioread64 |
| static inline u64 _ioread64(void __iomem *mmio) |
| { |
| u64 low, high; |
| |
| low = ioread32(mmio); |
| high = ioread32(mmio + sizeof(u32)); |
| return low | (high << 32); |
| } |
| #endif |
| #endif |
| |
| #ifndef iowrite64 |
| #ifdef writeq |
| #define iowrite64 writeq |
| #else |
| #define iowrite64 _iowrite64 |
| static inline void _iowrite64(u64 val, void __iomem *mmio) |
| { |
| iowrite32(val, mmio); |
| iowrite32(val >> 32, mmio + sizeof(u32)); |
| } |
| #endif |
| #endif |
| |
| static inline int pdev_is_bwd(struct pci_dev *pdev) |
| { |
| switch (pdev->device) { |
| case PCI_DEVICE_ID_INTEL_NTB_B2B_BWD: |
| return 1; |
| } |
| return 0; |
| } |
| |
| static inline int pdev_is_snb(struct pci_dev *pdev) |
| { |
| switch (pdev->device) { |
| case PCI_DEVICE_ID_INTEL_NTB_SS_JSF: |
| case PCI_DEVICE_ID_INTEL_NTB_SS_SNB: |
| case PCI_DEVICE_ID_INTEL_NTB_SS_IVT: |
| case PCI_DEVICE_ID_INTEL_NTB_SS_HSX: |
| case PCI_DEVICE_ID_INTEL_NTB_PS_JSF: |
| case PCI_DEVICE_ID_INTEL_NTB_PS_SNB: |
| case PCI_DEVICE_ID_INTEL_NTB_PS_IVT: |
| case PCI_DEVICE_ID_INTEL_NTB_PS_HSX: |
| case PCI_DEVICE_ID_INTEL_NTB_B2B_JSF: |
| case PCI_DEVICE_ID_INTEL_NTB_B2B_SNB: |
| case PCI_DEVICE_ID_INTEL_NTB_B2B_IVT: |
| case PCI_DEVICE_ID_INTEL_NTB_B2B_HSX: |
| return 1; |
| } |
| return 0; |
| } |
| |
| static inline void ndev_reset_unsafe_flags(struct intel_ntb_dev *ndev) |
| { |
| ndev->unsafe_flags = 0; |
| ndev->unsafe_flags_ignore = 0; |
| |
| /* Only B2B has a workaround to avoid SDOORBELL */ |
| if (ndev->hwerr_flags & NTB_HWERR_SDOORBELL_LOCKUP) |
| if (!ntb_topo_is_b2b(ndev->ntb.topo)) |
| ndev->unsafe_flags |= NTB_UNSAFE_DB; |
| |
| /* No low level workaround to avoid SB01BASE */ |
| if (ndev->hwerr_flags & NTB_HWERR_SB01BASE_LOCKUP) { |
| ndev->unsafe_flags |= NTB_UNSAFE_DB; |
| ndev->unsafe_flags |= NTB_UNSAFE_SPAD; |
| } |
| } |
| |
| static inline int ndev_is_unsafe(struct intel_ntb_dev *ndev, |
| unsigned long flag) |
| { |
| return !!(flag & ndev->unsafe_flags & ~ndev->unsafe_flags_ignore); |
| } |
| |
| static inline int ndev_ignore_unsafe(struct intel_ntb_dev *ndev, |
| unsigned long flag) |
| { |
| flag &= ndev->unsafe_flags; |
| ndev->unsafe_flags_ignore |= flag; |
| |
| return !!flag; |
| } |
| |
| static int ndev_mw_to_bar(struct intel_ntb_dev *ndev, int idx) |
| { |
| if (idx < 0 || idx > ndev->mw_count) |
| return -EINVAL; |
| return ndev->reg->mw_bar[idx]; |
| } |
| |
| static inline int ndev_db_addr(struct intel_ntb_dev *ndev, |
| phys_addr_t *db_addr, resource_size_t *db_size, |
| phys_addr_t reg_addr, unsigned long reg) |
| { |
| WARN_ON_ONCE(ndev_is_unsafe(ndev, NTB_UNSAFE_DB)); |
| |
| if (db_addr) { |
| *db_addr = reg_addr + reg; |
| dev_dbg(ndev_dev(ndev), "Peer db addr %llx\n", *db_addr); |
| } |
| |
| if (db_size) { |
| *db_size = ndev->reg->db_size; |
| dev_dbg(ndev_dev(ndev), "Peer db size %llx\n", *db_size); |
| } |
| |
| return 0; |
| } |
| |
| static inline u64 ndev_db_read(struct intel_ntb_dev *ndev, |
| void __iomem *mmio) |
| { |
| WARN_ON_ONCE(ndev_is_unsafe(ndev, NTB_UNSAFE_DB)); |
| |
| return ndev->reg->db_ioread(mmio); |
| } |
| |
| static inline int ndev_db_write(struct intel_ntb_dev *ndev, u64 db_bits, |
| void __iomem *mmio) |
| { |
| WARN_ON_ONCE(ndev_is_unsafe(ndev, NTB_UNSAFE_DB)); |
| |
| if (db_bits & ~ndev->db_valid_mask) |
| return -EINVAL; |
| |
| ndev->reg->db_iowrite(db_bits, mmio); |
| |
| return 0; |
| } |
| |
| static inline int ndev_db_set_mask(struct intel_ntb_dev *ndev, u64 db_bits, |
| void __iomem *mmio) |
| { |
| unsigned long irqflags; |
| |
| WARN_ON_ONCE(ndev_is_unsafe(ndev, NTB_UNSAFE_DB)); |
| |
| if (db_bits & ~ndev->db_valid_mask) |
| return -EINVAL; |
| |
| spin_lock_irqsave(&ndev->db_mask_lock, irqflags); |
| { |
| ndev->db_mask |= db_bits; |
| ndev->reg->db_iowrite(ndev->db_mask, mmio); |
| } |
| spin_unlock_irqrestore(&ndev->db_mask_lock, irqflags); |
| |
| return 0; |
| } |
| |
| static inline int ndev_db_clear_mask(struct intel_ntb_dev *ndev, u64 db_bits, |
| void __iomem *mmio) |
| { |
| unsigned long irqflags; |
| |
| WARN_ON_ONCE(ndev_is_unsafe(ndev, NTB_UNSAFE_DB)); |
| |
| if (db_bits & ~ndev->db_valid_mask) |
| return -EINVAL; |
| |
| spin_lock_irqsave(&ndev->db_mask_lock, irqflags); |
| { |
| ndev->db_mask &= ~db_bits; |
| ndev->reg->db_iowrite(ndev->db_mask, mmio); |
| } |
| spin_unlock_irqrestore(&ndev->db_mask_lock, irqflags); |
| |
| return 0; |
| } |
| |
| static inline int ndev_vec_mask(struct intel_ntb_dev *ndev, int db_vector) |
| { |
| u64 shift, mask; |
| |
| shift = ndev->db_vec_shift; |
| mask = BIT_ULL(shift) - 1; |
| |
| return mask << (shift * db_vector); |
| } |
| |
| static inline int ndev_spad_addr(struct intel_ntb_dev *ndev, int idx, |
| phys_addr_t *spad_addr, phys_addr_t reg_addr, |
| unsigned long reg) |
| { |
| WARN_ON_ONCE(ndev_is_unsafe(ndev, NTB_UNSAFE_SPAD)); |
| |
| if (idx < 0 || idx >= ndev->spad_count) |
| return -EINVAL; |
| |
| if (spad_addr) { |
| *spad_addr = reg_addr + reg + (idx << 2); |
| dev_dbg(ndev_dev(ndev), "Peer spad addr %llx\n", *spad_addr); |
| } |
| |
| return 0; |
| } |
| |
| static inline u32 ndev_spad_read(struct intel_ntb_dev *ndev, int idx, |
| void __iomem *mmio) |
| { |
| WARN_ON_ONCE(ndev_is_unsafe(ndev, NTB_UNSAFE_SPAD)); |
| |
| if (idx < 0 || idx >= ndev->spad_count) |
| return 0; |
| |
| return ioread32(mmio + (idx << 2)); |
| } |
| |
| static inline int ndev_spad_write(struct intel_ntb_dev *ndev, int idx, u32 val, |
| void __iomem *mmio) |
| { |
| WARN_ON_ONCE(ndev_is_unsafe(ndev, NTB_UNSAFE_SPAD)); |
| |
| if (idx < 0 || idx >= ndev->spad_count) |
| return -EINVAL; |
| |
| iowrite32(val, mmio + (idx << 2)); |
| |
| return 0; |
| } |
| |
| static irqreturn_t ndev_interrupt(struct intel_ntb_dev *ndev, int vec) |
| { |
| u64 vec_mask; |
| |
| vec_mask = ndev_vec_mask(ndev, vec); |
| |
| dev_dbg(ndev_dev(ndev), "vec %d vec_mask %llx\n", vec, vec_mask); |
| |
| ndev->last_ts = jiffies; |
| |
| if (vec_mask & ndev->db_link_mask) { |
| if (ndev->reg->poll_link(ndev)) |
| ntb_link_event(&ndev->ntb); |
| } |
| |
| if (vec_mask & ndev->db_valid_mask) |
| ntb_db_event(&ndev->ntb, vec); |
| |
| return IRQ_HANDLED; |
| } |
| |
| static irqreturn_t ndev_vec_isr(int irq, void *dev) |
| { |
| struct intel_ntb_vec *nvec = dev; |
| |
| return ndev_interrupt(nvec->ndev, nvec->num); |
| } |
| |
| static irqreturn_t ndev_irq_isr(int irq, void *dev) |
| { |
| struct intel_ntb_dev *ndev = dev; |
| |
| return ndev_interrupt(ndev, irq - ndev_pdev(ndev)->irq); |
| } |
| |
| static int ndev_init_isr(struct intel_ntb_dev *ndev, |
| int msix_min, int msix_max, |
| int msix_shift, int total_shift) |
| { |
| struct pci_dev *pdev; |
| int rc, i, msix_count; |
| |
| pdev = ndev_pdev(ndev); |
| |
| /* Mask all doorbell interrupts */ |
| ndev->db_mask = ndev->db_valid_mask; |
| ndev->reg->db_iowrite(ndev->db_mask, |
| ndev->self_mmio + |
| ndev->self_reg->db_mask); |
| |
| /* Try to set up msix irq */ |
| |
| ndev->vec = kcalloc(msix_max, sizeof(*ndev->vec), GFP_KERNEL); |
| if (!ndev->vec) |
| goto err_msix_vec_alloc; |
| |
| ndev->msix = kcalloc(msix_max, sizeof(*ndev->msix), GFP_KERNEL); |
| if (!ndev->msix) |
| goto err_msix_alloc; |
| |
| for (i = 0; i < msix_max; ++i) |
| ndev->msix[i].entry = i; |
| |
| msix_count = pci_enable_msix_range(pdev, ndev->msix, |
| msix_min, msix_max); |
| if (msix_count < 0) |
| goto err_msix_enable; |
| |
| for (i = 0; i < msix_count; ++i) { |
| ndev->vec[i].ndev = ndev; |
| ndev->vec[i].num = i; |
| rc = request_irq(ndev->msix[i].vector, ndev_vec_isr, 0, |
| "ndev_vec_isr", &ndev->vec[i]); |
| if (rc) |
| goto err_msix_request; |
| } |
| |
| dev_dbg(ndev_dev(ndev), "Using msix interrupts\n"); |
| ndev->db_vec_count = msix_count; |
| ndev->db_vec_shift = msix_shift; |
| return 0; |
| |
| err_msix_request: |
| while (i-- > 0) |
| free_irq(ndev->msix[i].vector, ndev); |
| pci_disable_msix(pdev); |
| err_msix_enable: |
| kfree(ndev->msix); |
| err_msix_alloc: |
| kfree(ndev->vec); |
| err_msix_vec_alloc: |
| ndev->msix = NULL; |
| ndev->vec = NULL; |
| |
| /* Try to set up msi irq */ |
| |
| rc = pci_enable_msi(pdev); |
| if (rc) |
| goto err_msi_enable; |
| |
| rc = request_irq(pdev->irq, ndev_irq_isr, 0, |
| "ndev_irq_isr", ndev); |
| if (rc) |
| goto err_msi_request; |
| |
| dev_dbg(ndev_dev(ndev), "Using msi interrupts\n"); |
| ndev->db_vec_count = 1; |
| ndev->db_vec_shift = total_shift; |
| return 0; |
| |
| err_msi_request: |
| pci_disable_msi(pdev); |
| err_msi_enable: |
| |
| /* Try to set up intx irq */ |
| |
| pci_intx(pdev, 1); |
| |
| rc = request_irq(pdev->irq, ndev_irq_isr, IRQF_SHARED, |
| "ndev_irq_isr", ndev); |
| if (rc) |
| goto err_intx_request; |
| |
| dev_dbg(ndev_dev(ndev), "Using intx interrupts\n"); |
| ndev->db_vec_count = 1; |
| ndev->db_vec_shift = total_shift; |
| return 0; |
| |
| err_intx_request: |
| return rc; |
| } |
| |
| static void ndev_deinit_isr(struct intel_ntb_dev *ndev) |
| { |
| struct pci_dev *pdev; |
| int i; |
| |
| pdev = ndev_pdev(ndev); |
| |
| /* Mask all doorbell interrupts */ |
| ndev->db_mask = ndev->db_valid_mask; |
| ndev->reg->db_iowrite(ndev->db_mask, |
| ndev->self_mmio + |
| ndev->self_reg->db_mask); |
| |
| if (ndev->msix) { |
| i = ndev->db_vec_count; |
| while (i--) |
| free_irq(ndev->msix[i].vector, &ndev->vec[i]); |
| pci_disable_msix(pdev); |
| kfree(ndev->msix); |
| kfree(ndev->vec); |
| } else { |
| free_irq(pdev->irq, ndev); |
| if (pci_dev_msi_enabled(pdev)) |
| pci_disable_msi(pdev); |
| } |
| } |
| |
| static ssize_t ndev_debugfs_read(struct file *filp, char __user *ubuf, |
| size_t count, loff_t *offp) |
| { |
| struct intel_ntb_dev *ndev; |
| void __iomem *mmio; |
| char *buf; |
| size_t buf_size; |
| ssize_t ret, off; |
| union { u64 v64; u32 v32; u16 v16; } u; |
| |
| ndev = filp->private_data; |
| mmio = ndev->self_mmio; |
| |
| buf_size = min(count, 0x800ul); |
| |
| buf = kmalloc(buf_size, GFP_KERNEL); |
| if (!buf) |
| return -ENOMEM; |
| |
| off = 0; |
| |
| off += scnprintf(buf + off, buf_size - off, |
| "NTB Device Information:\n"); |
| |
| off += scnprintf(buf + off, buf_size - off, |
| "Connection Topology -\t%s\n", |
| ntb_topo_string(ndev->ntb.topo)); |
| |
| off += scnprintf(buf + off, buf_size - off, |
| "B2B Offset -\t\t%#lx\n", ndev->b2b_off); |
| off += scnprintf(buf + off, buf_size - off, |
| "B2B MW Idx -\t\t%d\n", ndev->b2b_idx); |
| off += scnprintf(buf + off, buf_size - off, |
| "BAR4 Split -\t\t%s\n", |
| ndev->bar4_split ? "yes" : "no"); |
| |
| off += scnprintf(buf + off, buf_size - off, |
| "NTB CTL -\t\t%#06x\n", ndev->ntb_ctl); |
| off += scnprintf(buf + off, buf_size - off, |
| "LNK STA -\t\t%#06x\n", ndev->lnk_sta); |
| |
| if (!ndev->reg->link_is_up(ndev)) { |
| off += scnprintf(buf + off, buf_size - off, |
| "Link Status -\t\tDown\n"); |
| } else { |
| off += scnprintf(buf + off, buf_size - off, |
| "Link Status -\t\tUp\n"); |
| off += scnprintf(buf + off, buf_size - off, |
| "Link Speed -\t\tPCI-E Gen %u\n", |
| NTB_LNK_STA_SPEED(ndev->lnk_sta)); |
| off += scnprintf(buf + off, buf_size - off, |
| "Link Width -\t\tx%u\n", |
| NTB_LNK_STA_WIDTH(ndev->lnk_sta)); |
| } |
| |
| off += scnprintf(buf + off, buf_size - off, |
| "Memory Window Count -\t%u\n", ndev->mw_count); |
| off += scnprintf(buf + off, buf_size - off, |
| "Scratchpad Count -\t%u\n", ndev->spad_count); |
| off += scnprintf(buf + off, buf_size - off, |
| "Doorbell Count -\t%u\n", ndev->db_count); |
| off += scnprintf(buf + off, buf_size - off, |
| "Doorbell Vector Count -\t%u\n", ndev->db_vec_count); |
| off += scnprintf(buf + off, buf_size - off, |
| "Doorbell Vector Shift -\t%u\n", ndev->db_vec_shift); |
| |
| off += scnprintf(buf + off, buf_size - off, |
| "Doorbell Valid Mask -\t%#llx\n", ndev->db_valid_mask); |
| off += scnprintf(buf + off, buf_size - off, |
| "Doorbell Link Mask -\t%#llx\n", ndev->db_link_mask); |
| off += scnprintf(buf + off, buf_size - off, |
| "Doorbell Mask Cached -\t%#llx\n", ndev->db_mask); |
| |
| u.v64 = ndev_db_read(ndev, mmio + ndev->self_reg->db_mask); |
| off += scnprintf(buf + off, buf_size - off, |
| "Doorbell Mask -\t\t%#llx\n", u.v64); |
| |
| u.v64 = ndev_db_read(ndev, mmio + ndev->self_reg->db_bell); |
| off += scnprintf(buf + off, buf_size - off, |
| "Doorbell Bell -\t\t%#llx\n", u.v64); |
| |
| off += scnprintf(buf + off, buf_size - off, |
| "\nNTB Incoming XLAT:\n"); |
| |
| u.v64 = ioread64(mmio + bar2_off(ndev->xlat_reg->bar2_xlat, 2)); |
| off += scnprintf(buf + off, buf_size - off, |
| "XLAT23 -\t\t%#018llx\n", u.v64); |
| |
| u.v64 = ioread64(mmio + bar2_off(ndev->xlat_reg->bar2_xlat, 4)); |
| off += scnprintf(buf + off, buf_size - off, |
| "XLAT45 -\t\t%#018llx\n", u.v64); |
| |
| u.v64 = ioread64(mmio + bar2_off(ndev->xlat_reg->bar2_limit, 2)); |
| off += scnprintf(buf + off, buf_size - off, |
| "LMT23 -\t\t\t%#018llx\n", u.v64); |
| |
| u.v64 = ioread64(mmio + bar2_off(ndev->xlat_reg->bar2_limit, 4)); |
| off += scnprintf(buf + off, buf_size - off, |
| "LMT45 -\t\t\t%#018llx\n", u.v64); |
| |
| if (pdev_is_snb(ndev->ntb.pdev)) { |
| if (ntb_topo_is_b2b(ndev->ntb.topo)) { |
| off += scnprintf(buf + off, buf_size - off, |
| "\nNTB Outgoing B2B XLAT:\n"); |
| |
| u.v64 = ioread64(mmio + SNB_PBAR23XLAT_OFFSET); |
| off += scnprintf(buf + off, buf_size - off, |
| "B2B XLAT23 -\t\t%#018llx\n", u.v64); |
| |
| u.v64 = ioread64(mmio + SNB_PBAR45XLAT_OFFSET); |
| off += scnprintf(buf + off, buf_size - off, |
| "B2B XLAT45 -\t\t%#018llx\n", u.v64); |
| |
| u.v64 = ioread64(mmio + SNB_PBAR23LMT_OFFSET); |
| off += scnprintf(buf + off, buf_size - off, |
| "B2B LMT23 -\t\t%#018llx\n", u.v64); |
| |
| u.v64 = ioread64(mmio + SNB_PBAR45LMT_OFFSET); |
| off += scnprintf(buf + off, buf_size - off, |
| "B2B LMT45 -\t\t%#018llx\n", u.v64); |
| |
| off += scnprintf(buf + off, buf_size - off, |
| "\nNTB Secondary BAR:\n"); |
| |
| u.v64 = ioread64(mmio + SNB_SBAR0BASE_OFFSET); |
| off += scnprintf(buf + off, buf_size - off, |
| "SBAR01 -\t\t%#018llx\n", u.v64); |
| |
| u.v64 = ioread64(mmio + SNB_SBAR23BASE_OFFSET); |
| off += scnprintf(buf + off, buf_size - off, |
| "SBAR23 -\t\t%#018llx\n", u.v64); |
| |
| u.v64 = ioread64(mmio + SNB_SBAR45BASE_OFFSET); |
| off += scnprintf(buf + off, buf_size - off, |
| "SBAR45 -\t\t%#018llx\n", u.v64); |
| } |
| |
| off += scnprintf(buf + off, buf_size - off, |
| "\nSNB NTB Statistics:\n"); |
| |
| u.v16 = ioread16(mmio + SNB_USMEMMISS_OFFSET); |
| off += scnprintf(buf + off, buf_size - off, |
| "Upstream Memory Miss -\t%u\n", u.v16); |
| |
| off += scnprintf(buf + off, buf_size - off, |
| "\nSNB NTB Hardware Errors:\n"); |
| |
| if (!pci_read_config_word(ndev->ntb.pdev, |
| SNB_DEVSTS_OFFSET, &u.v16)) |
| off += scnprintf(buf + off, buf_size - off, |
| "DEVSTS -\t\t%#06x\n", u.v16); |
| |
| if (!pci_read_config_word(ndev->ntb.pdev, |
| SNB_LINK_STATUS_OFFSET, &u.v16)) |
| off += scnprintf(buf + off, buf_size - off, |
| "LNKSTS -\t\t%#06x\n", u.v16); |
| |
| if (!pci_read_config_dword(ndev->ntb.pdev, |
| SNB_UNCERRSTS_OFFSET, &u.v32)) |
| off += scnprintf(buf + off, buf_size - off, |
| "UNCERRSTS -\t\t%#06x\n", u.v32); |
| |
| if (!pci_read_config_dword(ndev->ntb.pdev, |
| SNB_CORERRSTS_OFFSET, &u.v32)) |
| off += scnprintf(buf + off, buf_size - off, |
| "CORERRSTS -\t\t%#06x\n", u.v32); |
| } |
| |
| ret = simple_read_from_buffer(ubuf, count, offp, buf, off); |
| kfree(buf); |
| return ret; |
| } |
| |
| static void ndev_init_debugfs(struct intel_ntb_dev *ndev) |
| { |
| if (!debugfs_dir) { |
| ndev->debugfs_dir = NULL; |
| ndev->debugfs_info = NULL; |
| } else { |
| ndev->debugfs_dir = |
| debugfs_create_dir(ndev_name(ndev), debugfs_dir); |
| if (!ndev->debugfs_dir) |
| ndev->debugfs_info = NULL; |
| else |
| ndev->debugfs_info = |
| debugfs_create_file("info", S_IRUSR, |
| ndev->debugfs_dir, ndev, |
| &intel_ntb_debugfs_info); |
| } |
| } |
| |
| static void ndev_deinit_debugfs(struct intel_ntb_dev *ndev) |
| { |
| debugfs_remove_recursive(ndev->debugfs_dir); |
| } |
| |
| static int intel_ntb_mw_count(struct ntb_dev *ntb) |
| { |
| return ntb_ndev(ntb)->mw_count; |
| } |
| |
| static int intel_ntb_mw_get_range(struct ntb_dev *ntb, int idx, |
| phys_addr_t *base, |
| resource_size_t *size, |
| resource_size_t *align, |
| resource_size_t *align_size) |
| { |
| struct intel_ntb_dev *ndev = ntb_ndev(ntb); |
| int bar; |
| |
| if (idx >= ndev->b2b_idx && !ndev->b2b_off) |
| idx += 1; |
| |
| bar = ndev_mw_to_bar(ndev, idx); |
| if (bar < 0) |
| return bar; |
| |
| if (base) |
| *base = pci_resource_start(ndev->ntb.pdev, bar) + |
| (idx == ndev->b2b_idx ? ndev->b2b_off : 0); |
| |
| if (size) |
| *size = pci_resource_len(ndev->ntb.pdev, bar) - |
| (idx == ndev->b2b_idx ? ndev->b2b_off : 0); |
| |
| if (align) |
| *align = pci_resource_len(ndev->ntb.pdev, bar); |
| |
| if (align_size) |
| *align_size = 1; |
| |
| return 0; |
| } |
| |
| static int intel_ntb_mw_set_trans(struct ntb_dev *ntb, int idx, |
| dma_addr_t addr, resource_size_t size) |
| { |
| struct intel_ntb_dev *ndev = ntb_ndev(ntb); |
| unsigned long base_reg, xlat_reg, limit_reg; |
| resource_size_t bar_size, mw_size; |
| void __iomem *mmio; |
| u64 base, limit, reg_val; |
| int bar; |
| |
| if (idx >= ndev->b2b_idx && !ndev->b2b_off) |
| idx += 1; |
| |
| bar = ndev_mw_to_bar(ndev, idx); |
| if (bar < 0) |
| return bar; |
| |
| bar_size = pci_resource_len(ndev->ntb.pdev, bar); |
| |
| if (idx == ndev->b2b_idx) |
| mw_size = bar_size - ndev->b2b_off; |
| else |
| mw_size = bar_size; |
| |
| /* hardware requires that addr is aligned to bar size */ |
| if (addr & (bar_size - 1)) |
| return -EINVAL; |
| |
| /* make sure the range fits in the usable mw size */ |
| if (size > mw_size) |
| return -EINVAL; |
| |
| mmio = ndev->self_mmio; |
| base_reg = bar0_off(ndev->xlat_reg->bar0_base, bar); |
| xlat_reg = bar2_off(ndev->xlat_reg->bar2_xlat, bar); |
| limit_reg = bar2_off(ndev->xlat_reg->bar2_limit, bar); |
| |
| if (bar < 4 || !ndev->bar4_split) { |
| base = ioread64(mmio + base_reg); |
| |
| /* Set the limit if supported, if size is not mw_size */ |
| if (limit_reg && size != mw_size) |
| limit = base + size; |
| else |
| limit = 0; |
| |
| /* set and verify setting the translation address */ |
| iowrite64(addr, mmio + xlat_reg); |
| reg_val = ioread64(mmio + xlat_reg); |
| if (reg_val != addr) { |
| iowrite64(0, mmio + xlat_reg); |
| return -EIO; |
| } |
| |
| /* set and verify setting the limit */ |
| iowrite64(limit, mmio + limit_reg); |
| reg_val = ioread64(mmio + limit_reg); |
| if (reg_val != limit) { |
| iowrite64(base, mmio + limit_reg); |
| iowrite64(0, mmio + xlat_reg); |
| return -EIO; |
| } |
| } else { |
| /* split bar addr range must all be 32 bit */ |
| if (addr & (~0ull << 32)) |
| return -EINVAL; |
| if ((addr + size) & (~0ull << 32)) |
| return -EINVAL; |
| |
| base = ioread32(mmio + base_reg); |
| |
| /* Set the limit if supported, if size is not mw_size */ |
| if (limit_reg && size != mw_size) |
| limit = base + size; |
| else |
| limit = 0; |
| |
| /* set and verify setting the translation address */ |
| iowrite32(addr, mmio + xlat_reg); |
| reg_val = ioread32(mmio + xlat_reg); |
| if (reg_val != addr) { |
| iowrite32(0, mmio + xlat_reg); |
| return -EIO; |
| } |
| |
| /* set and verify setting the limit */ |
| iowrite32(limit, mmio + limit_reg); |
| reg_val = ioread32(mmio + limit_reg); |
| if (reg_val != limit) { |
| iowrite32(base, mmio + limit_reg); |
| iowrite32(0, mmio + xlat_reg); |
| return -EIO; |
| } |
| } |
| |
| return 0; |
| } |
| |
| static int intel_ntb_link_is_up(struct ntb_dev *ntb, |
| enum ntb_speed *speed, |
| enum ntb_width *width) |
| { |
| struct intel_ntb_dev *ndev = ntb_ndev(ntb); |
| |
| if (ndev->reg->link_is_up(ndev)) { |
| if (speed) |
| *speed = NTB_LNK_STA_SPEED(ndev->lnk_sta); |
| if (width) |
| *width = NTB_LNK_STA_WIDTH(ndev->lnk_sta); |
| return 1; |
| } else { |
| /* TODO MAYBE: is it possible to observe the link speed and |
| * width while link is training? */ |
| if (speed) |
| *speed = NTB_SPEED_NONE; |
| if (width) |
| *width = NTB_WIDTH_NONE; |
| return 0; |
| } |
| } |
| |
| static int intel_ntb_link_enable(struct ntb_dev *ntb, |
| enum ntb_speed max_speed, |
| enum ntb_width max_width) |
| { |
| struct intel_ntb_dev *ndev; |
| u32 ntb_ctl; |
| |
| ndev = container_of(ntb, struct intel_ntb_dev, ntb); |
| |
| if (ndev->ntb.topo == NTB_TOPO_SEC) |
| return -EINVAL; |
| |
| dev_dbg(ndev_dev(ndev), |
| "Enabling link with max_speed %d max_width %d\n", |
| max_speed, max_width); |
| if (max_speed != NTB_SPEED_AUTO) |
| dev_dbg(ndev_dev(ndev), "ignoring max_speed %d\n", max_speed); |
| if (max_width != NTB_WIDTH_AUTO) |
| dev_dbg(ndev_dev(ndev), "ignoring max_width %d\n", max_width); |
| |
| ntb_ctl = ioread32(ndev->self_mmio + ndev->reg->ntb_ctl); |
| ntb_ctl &= ~(NTB_CTL_DISABLE | NTB_CTL_CFG_LOCK); |
| ntb_ctl |= NTB_CTL_P2S_BAR2_SNOOP | NTB_CTL_S2P_BAR2_SNOOP; |
| ntb_ctl |= NTB_CTL_P2S_BAR4_SNOOP | NTB_CTL_S2P_BAR4_SNOOP; |
| if (ndev->bar4_split) |
| ntb_ctl |= NTB_CTL_P2S_BAR5_SNOOP | NTB_CTL_S2P_BAR5_SNOOP; |
| iowrite32(ntb_ctl, ndev->self_mmio + ndev->reg->ntb_ctl); |
| |
| return 0; |
| } |
| |
| static int intel_ntb_link_disable(struct ntb_dev *ntb) |
| { |
| struct intel_ntb_dev *ndev; |
| u32 ntb_cntl; |
| |
| ndev = container_of(ntb, struct intel_ntb_dev, ntb); |
| |
| if (ndev->ntb.topo == NTB_TOPO_SEC) |
| return -EINVAL; |
| |
| dev_dbg(ndev_dev(ndev), "Disabling link\n"); |
| |
| /* Bring NTB link down */ |
| ntb_cntl = ioread32(ndev->self_mmio + ndev->reg->ntb_ctl); |
| ntb_cntl &= ~(NTB_CTL_P2S_BAR2_SNOOP | NTB_CTL_S2P_BAR2_SNOOP); |
| ntb_cntl &= ~(NTB_CTL_P2S_BAR4_SNOOP | NTB_CTL_S2P_BAR4_SNOOP); |
| if (ndev->bar4_split) |
| ntb_cntl &= ~(NTB_CTL_P2S_BAR5_SNOOP | NTB_CTL_S2P_BAR5_SNOOP); |
| ntb_cntl |= NTB_CTL_DISABLE | NTB_CTL_CFG_LOCK; |
| iowrite32(ntb_cntl, ndev->self_mmio + ndev->reg->ntb_ctl); |
| |
| return 0; |
| } |
| |
| static int intel_ntb_db_is_unsafe(struct ntb_dev *ntb) |
| { |
| return ndev_ignore_unsafe(ntb_ndev(ntb), NTB_UNSAFE_DB); |
| } |
| |
| static u64 intel_ntb_db_valid_mask(struct ntb_dev *ntb) |
| { |
| return ntb_ndev(ntb)->db_valid_mask; |
| } |
| |
| static int intel_ntb_db_vector_count(struct ntb_dev *ntb) |
| { |
| struct intel_ntb_dev *ndev; |
| |
| ndev = container_of(ntb, struct intel_ntb_dev, ntb); |
| |
| return ndev->db_vec_count; |
| } |
| |
| static u64 intel_ntb_db_vector_mask(struct ntb_dev *ntb, int db_vector) |
| { |
| struct intel_ntb_dev *ndev = ntb_ndev(ntb); |
| |
| if (db_vector < 0 || db_vector > ndev->db_vec_count) |
| return 0; |
| |
| return ndev->db_valid_mask & ndev_vec_mask(ndev, db_vector); |
| } |
| |
| static u64 intel_ntb_db_read(struct ntb_dev *ntb) |
| { |
| struct intel_ntb_dev *ndev = ntb_ndev(ntb); |
| |
| return ndev_db_read(ndev, |
| ndev->self_mmio + |
| ndev->self_reg->db_bell); |
| } |
| |
| static int intel_ntb_db_clear(struct ntb_dev *ntb, u64 db_bits) |
| { |
| struct intel_ntb_dev *ndev = ntb_ndev(ntb); |
| |
| return ndev_db_write(ndev, db_bits, |
| ndev->self_mmio + |
| ndev->self_reg->db_bell); |
| } |
| |
| static int intel_ntb_db_set_mask(struct ntb_dev *ntb, u64 db_bits) |
| { |
| struct intel_ntb_dev *ndev = ntb_ndev(ntb); |
| |
| return ndev_db_set_mask(ndev, db_bits, |
| ndev->self_mmio + |
| ndev->self_reg->db_mask); |
| } |
| |
| static int intel_ntb_db_clear_mask(struct ntb_dev *ntb, u64 db_bits) |
| { |
| struct intel_ntb_dev *ndev = ntb_ndev(ntb); |
| |
| return ndev_db_clear_mask(ndev, db_bits, |
| ndev->self_mmio + |
| ndev->self_reg->db_mask); |
| } |
| |
| static int intel_ntb_peer_db_addr(struct ntb_dev *ntb, |
| phys_addr_t *db_addr, |
| resource_size_t *db_size) |
| { |
| struct intel_ntb_dev *ndev = ntb_ndev(ntb); |
| |
| return ndev_db_addr(ndev, db_addr, db_size, ndev->peer_addr, |
| ndev->peer_reg->db_bell); |
| } |
| |
| static int intel_ntb_peer_db_set(struct ntb_dev *ntb, u64 db_bits) |
| { |
| struct intel_ntb_dev *ndev = ntb_ndev(ntb); |
| |
| return ndev_db_write(ndev, db_bits, |
| ndev->peer_mmio + |
| ndev->peer_reg->db_bell); |
| } |
| |
| static int intel_ntb_spad_is_unsafe(struct ntb_dev *ntb) |
| { |
| return ndev_ignore_unsafe(ntb_ndev(ntb), NTB_UNSAFE_SPAD); |
| } |
| |
| static int intel_ntb_spad_count(struct ntb_dev *ntb) |
| { |
| struct intel_ntb_dev *ndev; |
| |
| ndev = container_of(ntb, struct intel_ntb_dev, ntb); |
| |
| return ndev->spad_count; |
| } |
| |
| static u32 intel_ntb_spad_read(struct ntb_dev *ntb, int idx) |
| { |
| struct intel_ntb_dev *ndev = ntb_ndev(ntb); |
| |
| return ndev_spad_read(ndev, idx, |
| ndev->self_mmio + |
| ndev->self_reg->spad); |
| } |
| |
| static int intel_ntb_spad_write(struct ntb_dev *ntb, |
| int idx, u32 val) |
| { |
| struct intel_ntb_dev *ndev = ntb_ndev(ntb); |
| |
| return ndev_spad_write(ndev, idx, val, |
| ndev->self_mmio + |
| ndev->self_reg->spad); |
| } |
| |
| static int intel_ntb_peer_spad_addr(struct ntb_dev *ntb, int idx, |
| phys_addr_t *spad_addr) |
| { |
| struct intel_ntb_dev *ndev = ntb_ndev(ntb); |
| |
| return ndev_spad_addr(ndev, idx, spad_addr, ndev->peer_addr, |
| ndev->peer_reg->spad); |
| } |
| |
| static u32 intel_ntb_peer_spad_read(struct ntb_dev *ntb, int idx) |
| { |
| struct intel_ntb_dev *ndev = ntb_ndev(ntb); |
| |
| return ndev_spad_read(ndev, idx, |
| ndev->peer_mmio + |
| ndev->peer_reg->spad); |
| } |
| |
| static int intel_ntb_peer_spad_write(struct ntb_dev *ntb, |
| int idx, u32 val) |
| { |
| struct intel_ntb_dev *ndev = ntb_ndev(ntb); |
| |
| return ndev_spad_write(ndev, idx, val, |
| ndev->peer_mmio + |
| ndev->peer_reg->spad); |
| } |
| |
| /* BWD */ |
| |
| static u64 bwd_db_ioread(void __iomem *mmio) |
| { |
| return ioread64(mmio); |
| } |
| |
| static void bwd_db_iowrite(u64 bits, void __iomem *mmio) |
| { |
| iowrite64(bits, mmio); |
| } |
| |
| static int bwd_poll_link(struct intel_ntb_dev *ndev) |
| { |
| u32 ntb_ctl; |
| |
| ntb_ctl = ioread32(ndev->self_mmio + BWD_NTBCNTL_OFFSET); |
| |
| if (ntb_ctl == ndev->ntb_ctl) |
| return 0; |
| |
| ndev->ntb_ctl = ntb_ctl; |
| |
| ndev->lnk_sta = ioread32(ndev->self_mmio + BWD_LINK_STATUS_OFFSET); |
| |
| return 1; |
| } |
| |
| static int bwd_link_is_up(struct intel_ntb_dev *ndev) |
| { |
| return BWD_NTB_CTL_ACTIVE(ndev->ntb_ctl); |
| } |
| |
| static int bwd_link_is_err(struct intel_ntb_dev *ndev) |
| { |
| if (ioread32(ndev->self_mmio + BWD_LTSSMSTATEJMP_OFFSET) |
| & BWD_LTSSMSTATEJMP_FORCEDETECT) |
| return 1; |
| |
| if (ioread32(ndev->self_mmio + BWD_IBSTERRRCRVSTS0_OFFSET) |
| & BWD_IBIST_ERR_OFLOW) |
| return 1; |
| |
| return 0; |
| } |
| |
| static inline enum ntb_topo bwd_ppd_topo(struct intel_ntb_dev *ndev, u32 ppd) |
| { |
| switch (ppd & BWD_PPD_TOPO_MASK) { |
| case BWD_PPD_TOPO_B2B_USD: |
| dev_dbg(ndev_dev(ndev), "PPD %d B2B USD\n", ppd); |
| return NTB_TOPO_B2B_USD; |
| |
| case BWD_PPD_TOPO_B2B_DSD: |
| dev_dbg(ndev_dev(ndev), "PPD %d B2B DSD\n", ppd); |
| return NTB_TOPO_B2B_DSD; |
| |
| case BWD_PPD_TOPO_PRI_USD: |
| case BWD_PPD_TOPO_PRI_DSD: /* accept bogus PRI_DSD */ |
| case BWD_PPD_TOPO_SEC_USD: |
| case BWD_PPD_TOPO_SEC_DSD: /* accept bogus SEC_DSD */ |
| dev_dbg(ndev_dev(ndev), "PPD %d non B2B disabled\n", ppd); |
| return NTB_TOPO_NONE; |
| } |
| |
| dev_dbg(ndev_dev(ndev), "PPD %d invalid\n", ppd); |
| return NTB_TOPO_NONE; |
| } |
| |
| static void bwd_link_hb(struct work_struct *work) |
| { |
| struct intel_ntb_dev *ndev = hb_ndev(work); |
| unsigned long poll_ts; |
| void __iomem *mmio; |
| u32 status32; |
| |
| poll_ts = ndev->last_ts + BWD_LINK_HB_TIMEOUT; |
| |
| /* Delay polling the link status if an interrupt was received, |
| * unless the cached link status says the link is down. |
| */ |
| if (time_after(poll_ts, jiffies) && bwd_link_is_up(ndev)) { |
| schedule_delayed_work(&ndev->hb_timer, poll_ts - jiffies); |
| return; |
| } |
| |
| if (bwd_poll_link(ndev)) |
| ntb_link_event(&ndev->ntb); |
| |
| if (bwd_link_is_up(ndev) || !bwd_link_is_err(ndev)) { |
| schedule_delayed_work(&ndev->hb_timer, BWD_LINK_HB_TIMEOUT); |
| return; |
| } |
| |
| /* Link is down with error: recover the link! */ |
| |
| mmio = ndev->self_mmio; |
| |
| /* Driver resets the NTB ModPhy lanes - magic! */ |
| iowrite8(0xe0, mmio + BWD_MODPHY_PCSREG6); |
| iowrite8(0x40, mmio + BWD_MODPHY_PCSREG4); |
| iowrite8(0x60, mmio + BWD_MODPHY_PCSREG4); |
| iowrite8(0x60, mmio + BWD_MODPHY_PCSREG6); |
| |
| /* Driver waits 100ms to allow the NTB ModPhy to settle */ |
| msleep(100); |
| |
| /* Clear AER Errors, write to clear */ |
| status32 = ioread32(mmio + BWD_ERRCORSTS_OFFSET); |
| dev_dbg(ndev_dev(ndev), "ERRCORSTS = %x\n", status32); |
| status32 &= PCI_ERR_COR_REP_ROLL; |
| iowrite32(status32, mmio + BWD_ERRCORSTS_OFFSET); |
| |
| /* Clear unexpected electrical idle event in LTSSM, write to clear */ |
| status32 = ioread32(mmio + BWD_LTSSMERRSTS0_OFFSET); |
| dev_dbg(ndev_dev(ndev), "LTSSMERRSTS0 = %x\n", status32); |
| status32 |= BWD_LTSSMERRSTS0_UNEXPECTEDEI; |
| iowrite32(status32, mmio + BWD_LTSSMERRSTS0_OFFSET); |
| |
| /* Clear DeSkew Buffer error, write to clear */ |
| status32 = ioread32(mmio + BWD_DESKEWSTS_OFFSET); |
| dev_dbg(ndev_dev(ndev), "DESKEWSTS = %x\n", status32); |
| status32 |= BWD_DESKEWSTS_DBERR; |
| iowrite32(status32, mmio + BWD_DESKEWSTS_OFFSET); |
| |
| status32 = ioread32(mmio + BWD_IBSTERRRCRVSTS0_OFFSET); |
| dev_dbg(ndev_dev(ndev), "IBSTERRRCRVSTS0 = %x\n", status32); |
| status32 &= BWD_IBIST_ERR_OFLOW; |
| iowrite32(status32, mmio + BWD_IBSTERRRCRVSTS0_OFFSET); |
| |
| /* Releases the NTB state machine to allow the link to retrain */ |
| status32 = ioread32(mmio + BWD_LTSSMSTATEJMP_OFFSET); |
| dev_dbg(ndev_dev(ndev), "LTSSMSTATEJMP = %x\n", status32); |
| status32 &= ~BWD_LTSSMSTATEJMP_FORCEDETECT; |
| iowrite32(status32, mmio + BWD_LTSSMSTATEJMP_OFFSET); |
| |
| /* There is a potential race between the 2 NTB devices recovering at the |
| * same time. If the times are the same, the link will not recover and |
| * the driver will be stuck in this loop forever. Add a random interval |
| * to the recovery time to prevent this race. |
| */ |
| schedule_delayed_work(&ndev->hb_timer, BWD_LINK_RECOVERY_TIME |
| + prandom_u32() % BWD_LINK_RECOVERY_TIME); |
| } |
| |
| static int bwd_init_isr(struct intel_ntb_dev *ndev) |
| { |
| int rc; |
| |
| rc = ndev_init_isr(ndev, 1, BWD_DB_MSIX_VECTOR_COUNT, |
| BWD_DB_MSIX_VECTOR_SHIFT, BWD_DB_TOTAL_SHIFT); |
| if (rc) |
| return rc; |
| |
| /* BWD doesn't have link status interrupt, poll on that platform */ |
| ndev->last_ts = jiffies; |
| INIT_DELAYED_WORK(&ndev->hb_timer, bwd_link_hb); |
| schedule_delayed_work(&ndev->hb_timer, BWD_LINK_HB_TIMEOUT); |
| |
| return 0; |
| } |
| |
| static void bwd_deinit_isr(struct intel_ntb_dev *ndev) |
| { |
| cancel_delayed_work_sync(&ndev->hb_timer); |
| ndev_deinit_isr(ndev); |
| } |
| |
| static int bwd_init_ntb(struct intel_ntb_dev *ndev) |
| { |
| ndev->mw_count = BWD_MW_COUNT; |
| ndev->spad_count = BWD_SPAD_COUNT; |
| ndev->db_count = BWD_DB_COUNT; |
| |
| switch (ndev->ntb.topo) { |
| case NTB_TOPO_B2B_USD: |
| case NTB_TOPO_B2B_DSD: |
| ndev->self_reg = &bwd_pri_reg; |
| ndev->peer_reg = &bwd_b2b_reg; |
| ndev->xlat_reg = &bwd_sec_xlat; |
| |
| /* Enable Bus Master and Memory Space on the secondary side */ |
| iowrite16(PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER, |
| ndev->self_mmio + BWD_SPCICMD_OFFSET); |
| |
| break; |
| |
| default: |
| return -EINVAL; |
| } |
| |
| ndev->db_valid_mask = BIT_ULL(ndev->db_count) - 1; |
| |
| return 0; |
| } |
| |
| static int bwd_init_dev(struct intel_ntb_dev *ndev) |
| { |
| u32 ppd; |
| int rc; |
| |
| rc = pci_read_config_dword(ndev->ntb.pdev, BWD_PPD_OFFSET, &ppd); |
| if (rc) |
| return -EIO; |
| |
| ndev->ntb.topo = bwd_ppd_topo(ndev, ppd); |
| if (ndev->ntb.topo == NTB_TOPO_NONE) |
| return -EINVAL; |
| |
| rc = bwd_init_ntb(ndev); |
| if (rc) |
| return rc; |
| |
| rc = bwd_init_isr(ndev); |
| if (rc) |
| return rc; |
| |
| if (ndev->ntb.topo != NTB_TOPO_SEC) { |
| /* Initiate PCI-E link training */ |
| rc = pci_write_config_dword(ndev->ntb.pdev, BWD_PPD_OFFSET, |
| ppd | BWD_PPD_INIT_LINK); |
| if (rc) |
| return rc; |
| } |
| |
| return 0; |
| } |
| |
| static void bwd_deinit_dev(struct intel_ntb_dev *ndev) |
| { |
| bwd_deinit_isr(ndev); |
| } |
| |
| /* SNB */ |
| |
| static u64 snb_db_ioread(void __iomem *mmio) |
| { |
| return (u64)ioread16(mmio); |
| } |
| |
| static void snb_db_iowrite(u64 bits, void __iomem *mmio) |
| { |
| iowrite16((u16)bits, mmio); |
| } |
| |
| static int snb_poll_link(struct intel_ntb_dev *ndev) |
| { |
| u16 reg_val; |
| int rc; |
| |
| ndev->reg->db_iowrite(ndev->db_link_mask, |
| ndev->self_mmio + |
| ndev->self_reg->db_bell); |
| |
| rc = pci_read_config_word(ndev->ntb.pdev, |
| SNB_LINK_STATUS_OFFSET, ®_val); |
| if (rc) |
| return 0; |
| |
| if (reg_val == ndev->lnk_sta) |
| return 0; |
| |
| ndev->lnk_sta = reg_val; |
| |
| return 1; |
| } |
| |
| static int snb_link_is_up(struct intel_ntb_dev *ndev) |
| { |
| if (ndev->ntb.topo == NTB_TOPO_SEC) |
| return 1; |
| |
| return NTB_LNK_STA_ACTIVE(ndev->lnk_sta); |
| } |
| |
| static inline enum ntb_topo snb_ppd_topo(struct intel_ntb_dev *ndev, u8 ppd) |
| { |
| switch (ppd & SNB_PPD_TOPO_MASK) { |
| case SNB_PPD_TOPO_B2B_USD: |
| return NTB_TOPO_B2B_USD; |
| |
| case SNB_PPD_TOPO_B2B_DSD: |
| return NTB_TOPO_B2B_DSD; |
| |
| case SNB_PPD_TOPO_PRI_USD: |
| case SNB_PPD_TOPO_PRI_DSD: /* accept bogus PRI_DSD */ |
| return NTB_TOPO_PRI; |
| |
| case SNB_PPD_TOPO_SEC_USD: |
| case SNB_PPD_TOPO_SEC_DSD: /* accept bogus SEC_DSD */ |
| return NTB_TOPO_SEC; |
| } |
| |
| return NTB_TOPO_NONE; |
| } |
| |
| static inline int snb_ppd_bar4_split(struct intel_ntb_dev *ndev, u8 ppd) |
| { |
| if (ppd & SNB_PPD_SPLIT_BAR_MASK) { |
| dev_dbg(ndev_dev(ndev), "PPD %d split bar\n", ppd); |
| return 1; |
| } |
| return 0; |
| } |
| |
| static int snb_init_isr(struct intel_ntb_dev *ndev) |
| { |
| return ndev_init_isr(ndev, SNB_DB_MSIX_VECTOR_COUNT, |
| SNB_DB_MSIX_VECTOR_COUNT, |
| SNB_DB_MSIX_VECTOR_SHIFT, |
| SNB_DB_TOTAL_SHIFT); |
| } |
| |
| static void snb_deinit_isr(struct intel_ntb_dev *ndev) |
| { |
| ndev_deinit_isr(ndev); |
| } |
| |
| static int snb_setup_b2b_mw(struct intel_ntb_dev *ndev, |
| const struct intel_b2b_addr *addr, |
| const struct intel_b2b_addr *peer_addr) |
| { |
| struct pci_dev *pdev; |
| void __iomem *mmio; |
| resource_size_t bar_size; |
| phys_addr_t bar_addr; |
| int b2b_bar; |
| u8 bar_sz; |
| |
| pdev = ndev_pdev(ndev); |
| mmio = ndev->self_mmio; |
| |
| if (ndev->b2b_idx >= ndev->mw_count) { |
| dev_dbg(ndev_dev(ndev), "not using b2b mw\n"); |
| b2b_bar = 0; |
| ndev->b2b_off = 0; |
| } else { |
| b2b_bar = ndev_mw_to_bar(ndev, ndev->b2b_idx); |
| if (b2b_bar < 0) |
| return -EIO; |
| |
| dev_dbg(ndev_dev(ndev), "using b2b mw bar %d\n", b2b_bar); |
| |
| bar_size = pci_resource_len(ndev->ntb.pdev, b2b_bar); |
| |
| dev_dbg(ndev_dev(ndev), "b2b bar size %#llx\n", bar_size); |
| |
| if (b2b_mw_share && SNB_B2B_MIN_SIZE <= bar_size >> 1) { |
| dev_dbg(ndev_dev(ndev), |
| "b2b using first half of bar\n"); |
| ndev->b2b_off = bar_size >> 1; |
| } else if (SNB_B2B_MIN_SIZE <= bar_size) { |
| dev_dbg(ndev_dev(ndev), |
| "b2b using whole bar\n"); |
| ndev->b2b_off = 0; |
| --ndev->mw_count; |
| } else { |
| dev_dbg(ndev_dev(ndev), |
| "b2b bar size is too small\n"); |
| return -EIO; |
| } |
| } |
| |
| /* Reset the secondary bar sizes to match the primary bar sizes, |
| * except disable or halve the size of the b2b secondary bar. |
| * |
| * Note: code for each specific bar size register, because the register |
| * offsets are not in a consistent order (bar5sz comes after ppd, odd). |
| */ |
| pci_read_config_byte(pdev, SNB_PBAR23SZ_OFFSET, &bar_sz); |
| dev_dbg(ndev_dev(ndev), "PBAR23SZ %#x\n", bar_sz); |
| if (b2b_bar == 2) { |
| if (ndev->b2b_off) |
| bar_sz -= 1; |
| else |
| bar_sz = 0; |
| } |
| pci_write_config_byte(pdev, SNB_SBAR23SZ_OFFSET, bar_sz); |
| pci_read_config_byte(pdev, SNB_SBAR23SZ_OFFSET, &bar_sz); |
| dev_dbg(ndev_dev(ndev), "SBAR23SZ %#x\n", bar_sz); |
| |
| if (!ndev->bar4_split) { |
| pci_read_config_byte(pdev, SNB_PBAR45SZ_OFFSET, &bar_sz); |
| dev_dbg(ndev_dev(ndev), "PBAR45SZ %#x\n", bar_sz); |
| if (b2b_bar == 4) { |
| if (ndev->b2b_off) |
| bar_sz -= 1; |
| else |
| bar_sz = 0; |
| } |
| pci_write_config_byte(pdev, SNB_SBAR45SZ_OFFSET, bar_sz); |
| pci_read_config_byte(pdev, SNB_SBAR45SZ_OFFSET, &bar_sz); |
| dev_dbg(ndev_dev(ndev), "SBAR45SZ %#x\n", bar_sz); |
| } else { |
| pci_read_config_byte(pdev, SNB_PBAR4SZ_OFFSET, &bar_sz); |
| dev_dbg(ndev_dev(ndev), "PBAR4SZ %#x\n", bar_sz); |
| if (b2b_bar == 4) { |
| if (ndev->b2b_off) |
| bar_sz -= 1; |
| else |
| bar_sz = 0; |
| } |
| pci_write_config_byte(pdev, SNB_SBAR4SZ_OFFSET, bar_sz); |
| pci_read_config_byte(pdev, SNB_SBAR4SZ_OFFSET, &bar_sz); |
| dev_dbg(ndev_dev(ndev), "SBAR4SZ %#x\n", bar_sz); |
| |
| pci_read_config_byte(pdev, SNB_PBAR5SZ_OFFSET, &bar_sz); |
| dev_dbg(ndev_dev(ndev), "PBAR5SZ %#x\n", bar_sz); |
| if (b2b_bar == 5) { |
| if (ndev->b2b_off) |
| bar_sz -= 1; |
| else |
| bar_sz = 0; |
| } |
| pci_write_config_byte(pdev, SNB_SBAR5SZ_OFFSET, bar_sz); |
| pci_read_config_byte(pdev, SNB_SBAR5SZ_OFFSET, &bar_sz); |
| dev_dbg(ndev_dev(ndev), "SBAR5SZ %#x\n", bar_sz); |
| } |
| |
| /* SBAR01 hit by first part of the b2b bar */ |
| if (b2b_bar == 0) |
| bar_addr = addr->bar0_addr; |
| else if (b2b_bar == 2) |
| bar_addr = addr->bar2_addr64; |
| else if (b2b_bar == 4 && !ndev->bar4_split) |
| bar_addr = addr->bar4_addr64; |
| else if (b2b_bar == 4) |
| bar_addr = addr->bar4_addr32; |
| else if (b2b_bar == 5) |
| bar_addr = addr->bar5_addr32; |
| else |
| return -EIO; |
| |
| dev_dbg(ndev_dev(ndev), "SBAR01 %#018llx\n", bar_addr); |
| iowrite64(bar_addr, mmio + SNB_SBAR0BASE_OFFSET); |
| |
| /* Other SBAR are normally hit by the PBAR xlat, except for b2b bar. |
| * The b2b bar is either disabled above, or configured half-size, and |
| * it starts at the PBAR xlat + offset. |
| */ |
| |
| bar_addr = addr->bar2_addr64 + (b2b_bar == 2 ? ndev->b2b_off : 0); |
| iowrite64(bar_addr, mmio + SNB_SBAR23BASE_OFFSET); |
| bar_addr = ioread64(mmio + SNB_SBAR23BASE_OFFSET); |
| dev_dbg(ndev_dev(ndev), "SBAR23 %#018llx\n", bar_addr); |
| |
| if (!ndev->bar4_split) { |
| bar_addr = addr->bar4_addr64 + |
| (b2b_bar == 4 ? ndev->b2b_off : 0); |
| iowrite64(bar_addr, mmio + SNB_SBAR45BASE_OFFSET); |
| bar_addr = ioread64(mmio + SNB_SBAR45BASE_OFFSET); |
| dev_dbg(ndev_dev(ndev), "SBAR45 %#018llx\n", bar_addr); |
| } else { |
| bar_addr = addr->bar4_addr32 + |
| (b2b_bar == 4 ? ndev->b2b_off : 0); |
| iowrite32(bar_addr, mmio + SNB_SBAR4BASE_OFFSET); |
| bar_addr = ioread32(mmio + SNB_SBAR4BASE_OFFSET); |
| dev_dbg(ndev_dev(ndev), "SBAR4 %#010llx\n", bar_addr); |
| |
| bar_addr = addr->bar5_addr32 + |
| (b2b_bar == 5 ? ndev->b2b_off : 0); |
| iowrite32(bar_addr, mmio + SNB_SBAR5BASE_OFFSET); |
| bar_addr = ioread32(mmio + SNB_SBAR5BASE_OFFSET); |
| dev_dbg(ndev_dev(ndev), "SBAR5 %#010llx\n", bar_addr); |
| } |
| |
| /* setup incoming bar limits == base addrs (zero length windows) */ |
| |
| bar_addr = addr->bar2_addr64 + (b2b_bar == 2 ? ndev->b2b_off : 0); |
| iowrite64(bar_addr, mmio + SNB_SBAR23LMT_OFFSET); |
| bar_addr = ioread64(mmio + SNB_SBAR23LMT_OFFSET); |
| dev_dbg(ndev_dev(ndev), "SBAR23LMT %#018llx\n", bar_addr); |
| |
| if (!ndev->bar4_split) { |
| bar_addr = addr->bar4_addr64 + |
| (b2b_bar == 4 ? ndev->b2b_off : 0); |
| iowrite64(bar_addr, mmio + SNB_SBAR45LMT_OFFSET); |
| bar_addr = ioread64(mmio + SNB_SBAR45LMT_OFFSET); |
| dev_dbg(ndev_dev(ndev), "SBAR45LMT %#018llx\n", bar_addr); |
| } else { |
| bar_addr = addr->bar4_addr32 + |
| (b2b_bar == 4 ? ndev->b2b_off : 0); |
| iowrite32(bar_addr, mmio + SNB_SBAR4LMT_OFFSET); |
| bar_addr = ioread32(mmio + SNB_SBAR4LMT_OFFSET); |
| dev_dbg(ndev_dev(ndev), "SBAR4LMT %#010llx\n", bar_addr); |
| |
| bar_addr = addr->bar5_addr32 + |
| (b2b_bar == 5 ? ndev->b2b_off : 0); |
| iowrite32(bar_addr, mmio + SNB_SBAR5LMT_OFFSET); |
| bar_addr = ioread32(mmio + SNB_SBAR5LMT_OFFSET); |
| dev_dbg(ndev_dev(ndev), "SBAR5LMT %#05llx\n", bar_addr); |
| } |
| |
| /* zero incoming translation addrs */ |
| iowrite64(0, mmio + SNB_SBAR23XLAT_OFFSET); |
| |
| if (!ndev->bar4_split) { |
| iowrite64(0, mmio + SNB_SBAR45XLAT_OFFSET); |
| } else { |
| iowrite32(0, mmio + SNB_SBAR4XLAT_OFFSET); |
| iowrite32(0, mmio + SNB_SBAR5XLAT_OFFSET); |
| } |
| |
| /* zero outgoing translation limits (whole bar size windows) */ |
| iowrite64(0, mmio + SNB_PBAR23LMT_OFFSET); |
| if (!ndev->bar4_split) { |
| iowrite64(0, mmio + SNB_PBAR45LMT_OFFSET); |
| } else { |
| iowrite32(0, mmio + SNB_PBAR4LMT_OFFSET); |
| iowrite32(0, mmio + SNB_PBAR5LMT_OFFSET); |
| } |
| |
| /* set outgoing translation offsets */ |
| bar_addr = peer_addr->bar2_addr64; |
| iowrite64(bar_addr, mmio + SNB_PBAR23XLAT_OFFSET); |
| bar_addr = ioread64(mmio + SNB_PBAR23XLAT_OFFSET); |
| dev_dbg(ndev_dev(ndev), "PBAR23XLAT %#018llx\n", bar_addr); |
| |
| if (!ndev->bar4_split) { |
| bar_addr = peer_addr->bar4_addr64; |
| iowrite64(bar_addr, mmio + SNB_PBAR45XLAT_OFFSET); |
| bar_addr = ioread64(mmio + SNB_PBAR45XLAT_OFFSET); |
| dev_dbg(ndev_dev(ndev), "PBAR45XLAT %#018llx\n", bar_addr); |
| } else { |
| bar_addr = peer_addr->bar4_addr32; |
| iowrite32(bar_addr, mmio + SNB_PBAR4XLAT_OFFSET); |
| bar_addr = ioread32(mmio + SNB_PBAR4XLAT_OFFSET); |
| dev_dbg(ndev_dev(ndev), "PBAR4XLAT %#010llx\n", bar_addr); |
| |
| bar_addr = peer_addr->bar5_addr32; |
| iowrite32(bar_addr, mmio + SNB_PBAR5XLAT_OFFSET); |
| bar_addr = ioread32(mmio + SNB_PBAR5XLAT_OFFSET); |
| dev_dbg(ndev_dev(ndev), "PBAR5XLAT %#010llx\n", bar_addr); |
| } |
| |
| /* set the translation offset for b2b registers */ |
| if (b2b_bar == 0) |
| bar_addr = peer_addr->bar0_addr; |
| else if (b2b_bar == 2) |
| bar_addr = peer_addr->bar2_addr64; |
| else if (b2b_bar == 4 && !ndev->bar4_split) |
| bar_addr = peer_addr->bar4_addr64; |
| else if (b2b_bar == 4) |
| bar_addr = peer_addr->bar4_addr32; |
| else if (b2b_bar == 5) |
| bar_addr = peer_addr->bar5_addr32; |
| else |
| return -EIO; |
| |
| /* B2B_XLAT_OFFSET is 64bit, but can only take 32bit writes */ |
| dev_dbg(ndev_dev(ndev), "B2BXLAT %#018llx\n", bar_addr); |
| iowrite32(bar_addr, mmio + SNB_B2B_XLAT_OFFSETL); |
| iowrite32(bar_addr >> 32, mmio + SNB_B2B_XLAT_OFFSETU); |
| |
| if (b2b_bar) { |
| /* map peer ntb mmio config space registers */ |
| ndev->peer_mmio = pci_iomap(pdev, b2b_bar, |
| SNB_B2B_MIN_SIZE); |
| if (!ndev->peer_mmio) |
| return -EIO; |
| } |
| |
| return 0; |
| } |
| |
| static int snb_init_ntb(struct intel_ntb_dev *ndev) |
| { |
| int rc; |
| u32 ntb_ctl; |
| |
| if (ndev->bar4_split) |
| ndev->mw_count = HSX_SPLIT_BAR_MW_COUNT; |
| else |
| ndev->mw_count = SNB_MW_COUNT; |
| |
| ndev->spad_count = SNB_SPAD_COUNT; |
| ndev->db_count = SNB_DB_COUNT; |
| ndev->db_link_mask = SNB_DB_LINK_BIT; |
| |
| switch (ndev->ntb.topo) { |
| case NTB_TOPO_PRI: |
| if (ndev->hwerr_flags & NTB_HWERR_SDOORBELL_LOCKUP) { |
| dev_err(ndev_dev(ndev), "NTB Primary config disabled\n"); |
| return -EINVAL; |
| } |
| |
| /* enable link to allow secondary side device to appear */ |
| ntb_ctl = ioread32(ndev->self_mmio + ndev->reg->ntb_ctl); |
| ntb_ctl &= ~NTB_CTL_DISABLE; |
| iowrite32(ntb_ctl, ndev->self_mmio + ndev->reg->ntb_ctl); |
| |
| /* use half the spads for the peer */ |
| ndev->spad_count >>= 1; |
| ndev->self_reg = &snb_pri_reg; |
| ndev->peer_reg = &snb_sec_reg; |
| ndev->xlat_reg = &snb_sec_xlat; |
| break; |
| |
| case NTB_TOPO_SEC: |
| if (ndev->hwerr_flags & NTB_HWERR_SDOORBELL_LOCKUP) { |
| dev_err(ndev_dev(ndev), "NTB Secondary config disabled\n"); |
| return -EINVAL; |
| } |
| /* use half the spads for the peer */ |
| ndev->spad_count >>= 1; |
| ndev->self_reg = &snb_sec_reg; |
| ndev->peer_reg = &snb_pri_reg; |
| ndev->xlat_reg = &snb_pri_xlat; |
| break; |
| |
| case NTB_TOPO_B2B_USD: |
| case NTB_TOPO_B2B_DSD: |
| ndev->self_reg = &snb_pri_reg; |
| ndev->peer_reg = &snb_b2b_reg; |
| ndev->xlat_reg = &snb_sec_xlat; |
| |
| if (ndev->hwerr_flags & NTB_HWERR_SDOORBELL_LOCKUP) { |
| ndev->peer_reg = &snb_pri_reg; |
| |
| if (b2b_mw_idx < 0) |
| ndev->b2b_idx = b2b_mw_idx + ndev->mw_count; |
| else |
| ndev->b2b_idx = b2b_mw_idx; |
| |
| dev_dbg(ndev_dev(ndev), |
| "setting up b2b mw idx %d means %d\n", |
| b2b_mw_idx, ndev->b2b_idx); |
| |
| } else if (ndev->hwerr_flags & NTB_HWERR_B2BDOORBELL_BIT14) { |
| dev_warn(ndev_dev(ndev), "Reduce doorbell count by 1\n"); |
| ndev->db_count -= 1; |
| } |
| |
| if (ndev->ntb.topo == NTB_TOPO_B2B_USD) { |
| rc = snb_setup_b2b_mw(ndev, |
| &snb_b2b_dsd_addr, |
| &snb_b2b_usd_addr); |
| } else { |
| rc = snb_setup_b2b_mw(ndev, |
| &snb_b2b_usd_addr, |
| &snb_b2b_dsd_addr); |
| } |
| if (rc) |
| return rc; |
| |
| /* Enable Bus Master and Memory Space on the secondary side */ |
| iowrite16(PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER, |
| ndev->self_mmio + SNB_SPCICMD_OFFSET); |
| |
| break; |
| |
| default: |
| return -EINVAL; |
| } |
| |
| ndev->db_valid_mask = BIT_ULL(ndev->db_count) - 1; |
| |
| ndev->reg->db_iowrite(ndev->db_valid_mask, |
| ndev->self_mmio + |
| ndev->self_reg->db_mask); |
| |
| return 0; |
| } |
| |
| static int snb_init_dev(struct intel_ntb_dev *ndev) |
| { |
| struct pci_dev *pdev; |
| u8 ppd; |
| int rc, mem; |
| |
| pdev = ndev_pdev(ndev); |
| |
| switch (pdev->device) { |
| /* There is a Xeon hardware errata related to writes to SDOORBELL or |
| * B2BDOORBELL in conjunction with inbound access to NTB MMIO Space, |
| * which may hang the system. To workaround this use the second memory |
| * window to access the interrupt and scratch pad registers on the |
| * remote system. |
| */ |
| case PCI_DEVICE_ID_INTEL_NTB_SS_JSF: |
| case PCI_DEVICE_ID_INTEL_NTB_PS_JSF: |
| case PCI_DEVICE_ID_INTEL_NTB_B2B_JSF: |
| case PCI_DEVICE_ID_INTEL_NTB_SS_SNB: |
| case PCI_DEVICE_ID_INTEL_NTB_PS_SNB: |
| case PCI_DEVICE_ID_INTEL_NTB_B2B_SNB: |
| case PCI_DEVICE_ID_INTEL_NTB_SS_IVT: |
| case PCI_DEVICE_ID_INTEL_NTB_PS_IVT: |
| case PCI_DEVICE_ID_INTEL_NTB_B2B_IVT: |
| case PCI_DEVICE_ID_INTEL_NTB_SS_HSX: |
| case PCI_DEVICE_ID_INTEL_NTB_PS_HSX: |
| case PCI_DEVICE_ID_INTEL_NTB_B2B_HSX: |
| ndev->hwerr_flags |= NTB_HWERR_SDOORBELL_LOCKUP; |
| break; |
| } |
| |
| switch (pdev->device) { |
| /* There is a hardware errata related to accessing any register in |
| * SB01BASE in the presence of bidirectional traffic crossing the NTB. |
| */ |
| case PCI_DEVICE_ID_INTEL_NTB_SS_IVT: |
| case PCI_DEVICE_ID_INTEL_NTB_PS_IVT: |
| case PCI_DEVICE_ID_INTEL_NTB_B2B_IVT: |
| case PCI_DEVICE_ID_INTEL_NTB_SS_HSX: |
| case PCI_DEVICE_ID_INTEL_NTB_PS_HSX: |
| case PCI_DEVICE_ID_INTEL_NTB_B2B_HSX: |
| ndev->hwerr_flags |= NTB_HWERR_SB01BASE_LOCKUP; |
| break; |
| } |
| |
| switch (pdev->device) { |
| /* HW Errata on bit 14 of b2bdoorbell register. Writes will not be |
| * mirrored to the remote system. Shrink the number of bits by one, |
| * since bit 14 is the last bit. |
| */ |
| case PCI_DEVICE_ID_INTEL_NTB_SS_JSF: |
| case PCI_DEVICE_ID_INTEL_NTB_PS_JSF: |
| case PCI_DEVICE_ID_INTEL_NTB_B2B_JSF: |
| case PCI_DEVICE_ID_INTEL_NTB_SS_SNB: |
| case PCI_DEVICE_ID_INTEL_NTB_PS_SNB: |
| case PCI_DEVICE_ID_INTEL_NTB_B2B_SNB: |
| case PCI_DEVICE_ID_INTEL_NTB_SS_IVT: |
| case PCI_DEVICE_ID_INTEL_NTB_PS_IVT: |
| case PCI_DEVICE_ID_INTEL_NTB_B2B_IVT: |
| case PCI_DEVICE_ID_INTEL_NTB_SS_HSX: |
| case PCI_DEVICE_ID_INTEL_NTB_PS_HSX: |
| case PCI_DEVICE_ID_INTEL_NTB_B2B_HSX: |
| ndev->hwerr_flags |= NTB_HWERR_B2BDOORBELL_BIT14; |
| break; |
| } |
| |
| ndev->reg = &snb_reg; |
| |
| rc = pci_read_config_byte(pdev, SNB_PPD_OFFSET, &ppd); |
| if (rc) |
| return -EIO; |
| |
| ndev->ntb.topo = snb_ppd_topo(ndev, ppd); |
| dev_dbg(ndev_dev(ndev), "ppd %#x topo %s\n", ppd, |
| ntb_topo_string(ndev->ntb.topo)); |
| if (ndev->ntb.topo == NTB_TOPO_NONE) |
| return -EINVAL; |
| |
| if (ndev->ntb.topo != NTB_TOPO_SEC) { |
| ndev->bar4_split = snb_ppd_bar4_split(ndev, ppd); |
| dev_dbg(ndev_dev(ndev), "ppd %#x bar4_split %d\n", |
| ppd, ndev->bar4_split); |
| } else { |
| /* This is a way for transparent BAR to figure out if we are |
| * doing split BAR or not. There is no way for the hw on the |
| * transparent side to know and set the PPD. |
| */ |
| mem = pci_select_bars(pdev, IORESOURCE_MEM); |
| ndev->bar4_split = hweight32(mem) == |
| HSX_SPLIT_BAR_MW_COUNT + 1; |
| dev_dbg(ndev_dev(ndev), "mem %#x bar4_split %d\n", |
| mem, ndev->bar4_split); |
| } |
| |
| rc = snb_init_ntb(ndev); |
| if (rc) |
| return rc; |
| |
| return snb_init_isr(ndev); |
| } |
| |
| static void snb_deinit_dev(struct intel_ntb_dev *ndev) |
| { |
| snb_deinit_isr(ndev); |
| } |
| |
| static int intel_ntb_init_pci(struct intel_ntb_dev *ndev, struct pci_dev *pdev) |
| { |
| int rc; |
| |
| pci_set_drvdata(pdev, ndev); |
| |
| rc = pci_enable_device(pdev); |
| if (rc) |
| goto err_pci_enable; |
| |
| rc = pci_request_regions(pdev, NTB_NAME); |
| if (rc) |
| goto err_pci_regions; |
| |
| pci_set_master(pdev); |
| |
| rc = pci_set_dma_mask(pdev, DMA_BIT_MASK(64)); |
| if (rc) { |
| rc = pci_set_dma_mask(pdev, DMA_BIT_MASK(32)); |
| if (rc) |
| goto err_dma_mask; |
| dev_warn(ndev_dev(ndev), "Cannot DMA highmem\n"); |
| } |
| |
| rc = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(64)); |
| if (rc) { |
| rc = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)); |
| if (rc) |
| goto err_dma_mask; |
| dev_warn(ndev_dev(ndev), "Cannot DMA consistent highmem\n"); |
| } |
| |
| ndev->self_mmio = pci_iomap(pdev, 0, 0); |
| if (!ndev->self_mmio) { |
| rc = -EIO; |
| goto err_mmio; |
| } |
| ndev->peer_mmio = ndev->self_mmio; |
| |
| return 0; |
| |
| err_mmio: |
| err_dma_mask: |
| pci_clear_master(pdev); |
| pci_release_regions(pdev); |
| err_pci_regions: |
| pci_disable_device(pdev); |
| err_pci_enable: |
| pci_set_drvdata(pdev, NULL); |
| return rc; |
| } |
| |
| static void intel_ntb_deinit_pci(struct intel_ntb_dev *ndev) |
| { |
| struct pci_dev *pdev = ndev_pdev(ndev); |
| |
| if (ndev->peer_mmio && ndev->peer_mmio != ndev->self_mmio) |
| pci_iounmap(pdev, ndev->peer_mmio); |
| pci_iounmap(pdev, ndev->self_mmio); |
| |
| pci_clear_master(pdev); |
| pci_release_regions(pdev); |
| pci_disable_device(pdev); |
| pci_set_drvdata(pdev, NULL); |
| } |
| |
| static inline void ndev_init_struct(struct intel_ntb_dev *ndev, |
| struct pci_dev *pdev) |
| { |
| ndev->ntb.pdev = pdev; |
| ndev->ntb.topo = NTB_TOPO_NONE; |
| ndev->ntb.ops = &intel_ntb_ops; |
| |
| ndev->b2b_off = 0; |
| ndev->b2b_idx = INT_MAX; |
| |
| ndev->bar4_split = 0; |
| |
| ndev->mw_count = 0; |
| ndev->spad_count = 0; |
| ndev->db_count = 0; |
| ndev->db_vec_count = 0; |
| ndev->db_vec_shift = 0; |
| |
| ndev->ntb_ctl = 0; |
| ndev->lnk_sta = 0; |
| |
| ndev->db_valid_mask = 0; |
| ndev->db_link_mask = 0; |
| ndev->db_mask = 0; |
| |
| spin_lock_init(&ndev->db_mask_lock); |
| } |
| |
| static int intel_ntb_pci_probe(struct pci_dev *pdev, |
| const struct pci_device_id *id) |
| { |
| struct intel_ntb_dev *ndev; |
| int rc; |
| |
| if (pdev_is_bwd(pdev)) { |
| ndev = kzalloc(sizeof(*ndev), GFP_KERNEL); |
| if (!ndev) { |
| rc = -ENOMEM; |
| goto err_ndev; |
| } |
| |
| ndev_init_struct(ndev, pdev); |
| |
| rc = intel_ntb_init_pci(ndev, pdev); |
| if (rc) |
| goto err_init_pci; |
| |
| rc = bwd_init_dev(ndev); |
| if (rc) |
| goto err_init_dev; |
| |
| } else if (pdev_is_snb(pdev)) { |
| ndev = kzalloc(sizeof(*ndev), GFP_KERNEL); |
| if (!ndev) { |
| rc = -ENOMEM; |
| goto err_ndev; |
| } |
| |
| ndev_init_struct(ndev, pdev); |
| |
| rc = intel_ntb_init_pci(ndev, pdev); |
| if (rc) |
| goto err_init_pci; |
| |
| rc = snb_init_dev(ndev); |
| if (rc) |
| goto err_init_dev; |
| |
| } else { |
| rc = -EINVAL; |
| goto err_ndev; |
| } |
| |
| ndev_reset_unsafe_flags(ndev); |
| |
| ndev->reg->poll_link(ndev); |
| |
| ndev_init_debugfs(ndev); |
| |
| rc = ntb_register_device(&ndev->ntb); |
| if (rc) |
| goto err_register; |
| |
| return 0; |
| |
| err_register: |
| ndev_deinit_debugfs(ndev); |
| if (pdev_is_bwd(pdev)) |
| bwd_deinit_dev(ndev); |
| else if (pdev_is_snb(pdev)) |
| snb_deinit_dev(ndev); |
| err_init_dev: |
| intel_ntb_deinit_pci(ndev); |
| err_init_pci: |
| kfree(ndev); |
| err_ndev: |
| return rc; |
| } |
| |
| static void intel_ntb_pci_remove(struct pci_dev *pdev) |
| { |
| struct intel_ntb_dev *ndev = pci_get_drvdata(pdev); |
| |
| ntb_unregister_device(&ndev->ntb); |
| ndev_deinit_debugfs(ndev); |
| if (pdev_is_bwd(pdev)) |
| bwd_deinit_dev(ndev); |
| else if (pdev_is_snb(pdev)) |
| snb_deinit_dev(ndev); |
| intel_ntb_deinit_pci(ndev); |
| kfree(ndev); |
| } |
| |
| static const struct intel_ntb_reg bwd_reg = { |
| .poll_link = bwd_poll_link, |
| .link_is_up = bwd_link_is_up, |
| .db_ioread = bwd_db_ioread, |
| .db_iowrite = bwd_db_iowrite, |
| .db_size = sizeof(u64), |
| .ntb_ctl = BWD_NTBCNTL_OFFSET, |
| .mw_bar = {2, 4}, |
| }; |
| |
| static const struct intel_ntb_alt_reg bwd_pri_reg = { |
| .db_bell = BWD_PDOORBELL_OFFSET, |
| .db_mask = BWD_PDBMSK_OFFSET, |
| .spad = BWD_SPAD_OFFSET, |
| }; |
| |
| static const struct intel_ntb_alt_reg bwd_b2b_reg = { |
| .db_bell = BWD_B2B_DOORBELL_OFFSET, |
| .spad = BWD_B2B_SPAD_OFFSET, |
| }; |
| |
| static const struct intel_ntb_xlat_reg bwd_sec_xlat = { |
| /* FIXME : .bar0_base = BWD_SBAR0BASE_OFFSET, */ |
| /* FIXME : .bar2_limit = BWD_SBAR2LMT_OFFSET, */ |
| .bar2_xlat = BWD_SBAR2XLAT_OFFSET, |
| }; |
| |
| static const struct intel_ntb_reg snb_reg = { |
| .poll_link = snb_poll_link, |
| .link_is_up = snb_link_is_up, |
| .db_ioread = snb_db_ioread, |
| .db_iowrite = snb_db_iowrite, |
| .db_size = sizeof(u32), |
| .ntb_ctl = SNB_NTBCNTL_OFFSET, |
| .mw_bar = {2, 4, 5}, |
| }; |
| |
| static const struct intel_ntb_alt_reg snb_pri_reg = { |
| .db_bell = SNB_PDOORBELL_OFFSET, |
| .db_mask = SNB_PDBMSK_OFFSET, |
| .spad = SNB_SPAD_OFFSET, |
| }; |
| |
| static const struct intel_ntb_alt_reg snb_sec_reg = { |
| .db_bell = SNB_SDOORBELL_OFFSET, |
| .db_mask = SNB_SDBMSK_OFFSET, |
| /* second half of the scratchpads */ |
| .spad = SNB_SPAD_OFFSET + (SNB_SPAD_COUNT << 1), |
| }; |
| |
| static const struct intel_ntb_alt_reg snb_b2b_reg = { |
| .db_bell = SNB_B2B_DOORBELL_OFFSET, |
| .spad = SNB_B2B_SPAD_OFFSET, |
| }; |
| |
| static const struct intel_ntb_xlat_reg snb_pri_xlat = { |
| /* Note: no primary .bar0_base visible to the secondary side. |
| * |
| * The secondary side cannot get the base address stored in primary |
| * bars. The base address is necessary to set the limit register to |
| * any value other than zero, or unlimited. |
| * |
| * WITHOUT THE BASE ADDRESS, THE SECONDARY SIDE CANNOT DISABLE the |
| * window by setting the limit equal to base, nor can it limit the size |
| * of the memory window by setting the limit to base + size. |
| */ |
| .bar2_limit = SNB_PBAR23LMT_OFFSET, |
| .bar2_xlat = SNB_PBAR23XLAT_OFFSET, |
| }; |
| |
| static const struct intel_ntb_xlat_reg snb_sec_xlat = { |
| .bar0_base = SNB_SBAR0BASE_OFFSET, |
| .bar2_limit = SNB_SBAR23LMT_OFFSET, |
| .bar2_xlat = SNB_SBAR23XLAT_OFFSET, |
| }; |
| |
| static const struct intel_b2b_addr snb_b2b_usd_addr = { |
| .bar2_addr64 = SNB_B2B_BAR2_USD_ADDR64, |
| .bar4_addr64 = SNB_B2B_BAR4_USD_ADDR64, |
| .bar4_addr32 = SNB_B2B_BAR4_USD_ADDR32, |
| .bar5_addr32 = SNB_B2B_BAR5_USD_ADDR32, |
| }; |
| |
| static const struct intel_b2b_addr snb_b2b_dsd_addr = { |
| .bar2_addr64 = SNB_B2B_BAR2_DSD_ADDR64, |
| .bar4_addr64 = SNB_B2B_BAR4_DSD_ADDR64, |
| .bar4_addr32 = SNB_B2B_BAR4_DSD_ADDR32, |
| .bar5_addr32 = SNB_B2B_BAR5_DSD_ADDR32, |
| }; |
| |
| /* operations for primary side of local ntb */ |
| static const struct ntb_dev_ops intel_ntb_ops = { |
| .mw_count = intel_ntb_mw_count, |
| .mw_get_range = intel_ntb_mw_get_range, |
| .mw_set_trans = intel_ntb_mw_set_trans, |
| .link_is_up = intel_ntb_link_is_up, |
| .link_enable = intel_ntb_link_enable, |
| .link_disable = intel_ntb_link_disable, |
| .db_is_unsafe = intel_ntb_db_is_unsafe, |
| .db_valid_mask = intel_ntb_db_valid_mask, |
| .db_vector_count = intel_ntb_db_vector_count, |
| .db_vector_mask = intel_ntb_db_vector_mask, |
| .db_read = intel_ntb_db_read, |
| .db_clear = intel_ntb_db_clear, |
| .db_set_mask = intel_ntb_db_set_mask, |
| .db_clear_mask = intel_ntb_db_clear_mask, |
| .peer_db_addr = intel_ntb_peer_db_addr, |
| .peer_db_set = intel_ntb_peer_db_set, |
| .spad_is_unsafe = intel_ntb_spad_is_unsafe, |
| .spad_count = intel_ntb_spad_count, |
| .spad_read = intel_ntb_spad_read, |
| .spad_write = intel_ntb_spad_write, |
| .peer_spad_addr = intel_ntb_peer_spad_addr, |
| .peer_spad_read = intel_ntb_peer_spad_read, |
| .peer_spad_write = intel_ntb_peer_spad_write, |
| }; |
| |
| static const struct file_operations intel_ntb_debugfs_info = { |
| .owner = THIS_MODULE, |
| .open = simple_open, |
| .read = ndev_debugfs_read, |
| }; |
| |
| static const struct pci_device_id intel_ntb_pci_tbl[] = { |
| {PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_NTB_B2B_BWD)}, |
| {PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_NTB_B2B_JSF)}, |
| {PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_NTB_B2B_SNB)}, |
| {PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_NTB_B2B_IVT)}, |
| {PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_NTB_B2B_HSX)}, |
| {PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_NTB_PS_JSF)}, |
| {PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_NTB_PS_SNB)}, |
| {PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_NTB_PS_IVT)}, |
| {PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_NTB_PS_HSX)}, |
| {PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_NTB_SS_JSF)}, |
| {PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_NTB_SS_SNB)}, |
| {PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_NTB_SS_IVT)}, |
| {PCI_VDEVICE(INTEL, PCI_DEVICE_ID_INTEL_NTB_SS_HSX)}, |
| {0} |
| }; |
| MODULE_DEVICE_TABLE(pci, intel_ntb_pci_tbl); |
| |
| static struct pci_driver intel_ntb_pci_driver = { |
| .name = KBUILD_MODNAME, |
| .id_table = intel_ntb_pci_tbl, |
| .probe = intel_ntb_pci_probe, |
| .remove = intel_ntb_pci_remove, |
| }; |
| |
| static int __init intel_ntb_pci_driver_init(void) |
| { |
| if (debugfs_initialized()) |
| debugfs_dir = debugfs_create_dir(KBUILD_MODNAME, NULL); |
| |
| return pci_register_driver(&intel_ntb_pci_driver); |
| } |
| module_init(intel_ntb_pci_driver_init); |
| |
| static void __exit intel_ntb_pci_driver_exit(void) |
| { |
| pci_unregister_driver(&intel_ntb_pci_driver); |
| |
| debugfs_remove_recursive(debugfs_dir); |
| } |
| module_exit(intel_ntb_pci_driver_exit); |
| |