Emmanuel Grumbach | c85eb61 | 2011-06-14 10:13:24 +0300 | [diff] [blame] | 1 | /****************************************************************************** |
| 2 | * |
| 3 | * This file is provided under a dual BSD/GPLv2 license. When using or |
| 4 | * redistributing this file, you may do so under either license. |
| 5 | * |
| 6 | * GPL LICENSE SUMMARY |
| 7 | * |
Wey-Yi Guy | 4e31826 | 2011-12-27 11:21:32 -0800 | [diff] [blame] | 8 | * Copyright(c) 2007 - 2012 Intel Corporation. All rights reserved. |
Emmanuel Grumbach | c85eb61 | 2011-06-14 10:13:24 +0300 | [diff] [blame] | 9 | * |
| 10 | * This program is free software; you can redistribute it and/or modify |
| 11 | * it under the terms of version 2 of the GNU General Public License as |
| 12 | * published by the Free Software Foundation. |
| 13 | * |
| 14 | * This program is distributed in the hope that it will be useful, but |
| 15 | * WITHOUT ANY WARRANTY; without even the implied warranty of |
| 16 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
| 17 | * General Public License for more details. |
| 18 | * |
| 19 | * You should have received a copy of the GNU General Public License |
| 20 | * along with this program; if not, write to the Free Software |
| 21 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110, |
| 22 | * USA |
| 23 | * |
| 24 | * The full GNU General Public License is included in this distribution |
| 25 | * in the file called LICENSE.GPL. |
| 26 | * |
| 27 | * Contact Information: |
| 28 | * Intel Linux Wireless <ilw@linux.intel.com> |
| 29 | * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 |
| 30 | * |
| 31 | * BSD LICENSE |
| 32 | * |
Wey-Yi Guy | 4e31826 | 2011-12-27 11:21:32 -0800 | [diff] [blame] | 33 | * Copyright(c) 2005 - 2012 Intel Corporation. All rights reserved. |
Emmanuel Grumbach | c85eb61 | 2011-06-14 10:13:24 +0300 | [diff] [blame] | 34 | * All rights reserved. |
| 35 | * |
| 36 | * Redistribution and use in source and binary forms, with or without |
| 37 | * modification, are permitted provided that the following conditions |
| 38 | * are met: |
| 39 | * |
| 40 | * * Redistributions of source code must retain the above copyright |
| 41 | * notice, this list of conditions and the following disclaimer. |
| 42 | * * Redistributions in binary form must reproduce the above copyright |
| 43 | * notice, this list of conditions and the following disclaimer in |
| 44 | * the documentation and/or other materials provided with the |
| 45 | * distribution. |
| 46 | * * Neither the name Intel Corporation nor the names of its |
| 47 | * contributors may be used to endorse or promote products derived |
| 48 | * from this software without specific prior written permission. |
| 49 | * |
| 50 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
| 51 | * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
| 52 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR |
| 53 | * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT |
| 54 | * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, |
| 55 | * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT |
| 56 | * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
| 57 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
| 58 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| 59 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE |
| 60 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| 61 | * |
| 62 | *****************************************************************************/ |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 63 | #include <linux/pci.h> |
| 64 | #include <linux/pci-aspm.h> |
Emmanuel Grumbach | e6bb4c9 | 2011-08-25 23:10:48 -0700 | [diff] [blame] | 65 | #include <linux/interrupt.h> |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 66 | #include <linux/debugfs.h> |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 67 | #include <linux/sched.h> |
Emmanuel Grumbach | 6d8f6ee | 2011-08-25 23:11:06 -0700 | [diff] [blame] | 68 | #include <linux/bitops.h> |
| 69 | #include <linux/gfp.h> |
Emmanuel Grumbach | e6bb4c9 | 2011-08-25 23:10:48 -0700 | [diff] [blame] | 70 | |
Johannes Berg | 8257510 | 2012-04-03 16:44:37 -0700 | [diff] [blame] | 71 | #include "iwl-drv.h" |
Emmanuel Grumbach | c85eb61 | 2011-06-14 10:13:24 +0300 | [diff] [blame] | 72 | #include "iwl-trans.h" |
Emmanuel Grumbach | 522376d | 2011-09-06 09:31:19 -0700 | [diff] [blame] | 73 | #include "iwl-csr.h" |
| 74 | #include "iwl-prph.h" |
Emmanuel Grumbach | 7a10e3e4 | 2011-09-06 09:31:21 -0700 | [diff] [blame] | 75 | #include "iwl-agn-hw.h" |
Johannes Berg | 6468a01 | 2012-05-16 19:13:54 +0200 | [diff] [blame] | 76 | #include "internal.h" |
Johannes Berg | 0439bb6 | 2012-03-05 11:24:45 -0800 | [diff] [blame] | 77 | |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 78 | static void iwl_pcie_set_pwr_vmain(struct iwl_trans *trans) |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 79 | { |
| 80 | /* |
| 81 | * (for documentation purposes) |
| 82 | * to set power to V_AUX, do: |
| 83 | |
| 84 | if (pci_pme_capable(priv->pci_dev, PCI_D3cold)) |
Emmanuel Grumbach | 1042db2 | 2012-01-03 16:56:15 +0200 | [diff] [blame] | 85 | iwl_set_bits_mask_prph(trans, APMG_PS_CTRL_REG, |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 86 | APMG_PS_CTRL_VAL_PWR_SRC_VAUX, |
| 87 | ~APMG_PS_CTRL_MSK_PWR_SRC); |
| 88 | */ |
| 89 | |
Emmanuel Grumbach | 1042db2 | 2012-01-03 16:56:15 +0200 | [diff] [blame] | 90 | iwl_set_bits_mask_prph(trans, APMG_PS_CTRL_REG, |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 91 | APMG_PS_CTRL_VAL_PWR_SRC_VMAIN, |
| 92 | ~APMG_PS_CTRL_MSK_PWR_SRC); |
| 93 | } |
| 94 | |
Emmanuel Grumbach | af634be | 2012-01-08 21:12:22 +0200 | [diff] [blame] | 95 | /* PCI registers */ |
| 96 | #define PCI_CFG_RETRY_TIMEOUT 0x041 |
Emmanuel Grumbach | af634be | 2012-01-08 21:12:22 +0200 | [diff] [blame] | 97 | |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 98 | static void iwl_pcie_apm_config(struct iwl_trans *trans) |
Emmanuel Grumbach | af634be | 2012-01-08 21:12:22 +0200 | [diff] [blame] | 99 | { |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 100 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 101 | u16 lctl; |
Emmanuel Grumbach | af634be | 2012-01-08 21:12:22 +0200 | [diff] [blame] | 102 | |
Emmanuel Grumbach | af634be | 2012-01-08 21:12:22 +0200 | [diff] [blame] | 103 | /* |
| 104 | * HW bug W/A for instability in PCIe bus L0S->L1 transition. |
| 105 | * Check if BIOS (or OS) enabled L1-ASPM on this device. |
| 106 | * If so (likely), disable L0S, so device moves directly L0->L1; |
| 107 | * costs negligible amount of power savings. |
| 108 | * If not (unlikely), enable L0S, so there is at least some |
| 109 | * power savings, even without L1. |
| 110 | */ |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 111 | pcie_capability_read_word(trans_pcie->pci_dev, PCI_EXP_LNKCTL, &lctl); |
Bjorn Helgaas | 438a0f0 | 2012-12-05 13:51:21 -0700 | [diff] [blame] | 112 | if (lctl & PCI_EXP_LNKCTL_ASPM_L1) { |
Emmanuel Grumbach | af634be | 2012-01-08 21:12:22 +0200 | [diff] [blame] | 113 | /* L1-ASPM enabled; disable(!) L0S */ |
| 114 | iwl_set_bit(trans, CSR_GIO_REG, CSR_GIO_REG_VAL_L0S_ENABLED); |
Joe Perches | 6a4b09f | 2012-10-28 01:05:47 -0700 | [diff] [blame] | 115 | dev_info(trans->dev, "L1 Enabled; Disabling L0S\n"); |
Emmanuel Grumbach | af634be | 2012-01-08 21:12:22 +0200 | [diff] [blame] | 116 | } else { |
| 117 | /* L1-ASPM disabled; enable(!) L0S */ |
| 118 | iwl_clear_bit(trans, CSR_GIO_REG, CSR_GIO_REG_VAL_L0S_ENABLED); |
Joe Perches | 6a4b09f | 2012-10-28 01:05:47 -0700 | [diff] [blame] | 119 | dev_info(trans->dev, "L1 Disabled; Enabling L0S\n"); |
Emmanuel Grumbach | af634be | 2012-01-08 21:12:22 +0200 | [diff] [blame] | 120 | } |
Bjorn Helgaas | 438a0f0 | 2012-12-05 13:51:21 -0700 | [diff] [blame] | 121 | trans->pm_support = !(lctl & PCI_EXP_LNKCTL_ASPM_L0S); |
Emmanuel Grumbach | af634be | 2012-01-08 21:12:22 +0200 | [diff] [blame] | 122 | } |
| 123 | |
Emmanuel Grumbach | a6c684e | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 124 | /* |
| 125 | * Start up NIC's basic functionality after it has been reset |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 126 | * (e.g. after platform boot, or shutdown via iwl_pcie_apm_stop()) |
Emmanuel Grumbach | a6c684e | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 127 | * NOTE: This does not load uCode nor start the embedded processor |
| 128 | */ |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 129 | static int iwl_pcie_apm_init(struct iwl_trans *trans) |
Emmanuel Grumbach | a6c684e | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 130 | { |
Don Fry | 8362640 | 2012-03-07 09:52:37 -0800 | [diff] [blame] | 131 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
Emmanuel Grumbach | a6c684e | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 132 | int ret = 0; |
| 133 | IWL_DEBUG_INFO(trans, "Init card's basic functions\n"); |
| 134 | |
| 135 | /* |
| 136 | * Use "set_bit" below rather than "write", to preserve any hardware |
| 137 | * bits already set by default after reset. |
| 138 | */ |
| 139 | |
| 140 | /* Disable L0S exit timer (platform NMI Work/Around) */ |
| 141 | iwl_set_bit(trans, CSR_GIO_CHICKEN_BITS, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 142 | CSR_GIO_CHICKEN_BITS_REG_BIT_DIS_L0S_EXIT_TIMER); |
Emmanuel Grumbach | a6c684e | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 143 | |
| 144 | /* |
| 145 | * Disable L0s without affecting L1; |
| 146 | * don't wait for ICH L0s (ICH bug W/A) |
| 147 | */ |
| 148 | iwl_set_bit(trans, CSR_GIO_CHICKEN_BITS, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 149 | CSR_GIO_CHICKEN_BITS_REG_BIT_L1A_NO_L0S_RX); |
Emmanuel Grumbach | a6c684e | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 150 | |
| 151 | /* Set FH wait threshold to maximum (HW error during stress W/A) */ |
| 152 | iwl_set_bit(trans, CSR_DBG_HPET_MEM_REG, CSR_DBG_HPET_MEM_REG_VAL); |
| 153 | |
| 154 | /* |
| 155 | * Enable HAP INTA (interrupt from management bus) to |
| 156 | * wake device's PCI Express link L1a -> L0s |
| 157 | */ |
| 158 | iwl_set_bit(trans, CSR_HW_IF_CONFIG_REG, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 159 | CSR_HW_IF_CONFIG_REG_BIT_HAP_WAKE_L1A); |
Emmanuel Grumbach | a6c684e | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 160 | |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 161 | iwl_pcie_apm_config(trans); |
Emmanuel Grumbach | a6c684e | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 162 | |
| 163 | /* Configure analog phase-lock-loop before activating to D0A */ |
Emmanuel Grumbach | 035f7ff | 2012-03-26 08:57:01 -0700 | [diff] [blame] | 164 | if (trans->cfg->base_params->pll_cfg_val) |
Emmanuel Grumbach | a6c684e | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 165 | iwl_set_bit(trans, CSR_ANA_PLL_CFG, |
Emmanuel Grumbach | 035f7ff | 2012-03-26 08:57:01 -0700 | [diff] [blame] | 166 | trans->cfg->base_params->pll_cfg_val); |
Emmanuel Grumbach | a6c684e | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 167 | |
| 168 | /* |
| 169 | * Set "initialization complete" bit to move adapter from |
| 170 | * D0U* --> D0A* (powered-up active) state. |
| 171 | */ |
| 172 | iwl_set_bit(trans, CSR_GP_CNTRL, CSR_GP_CNTRL_REG_FLAG_INIT_DONE); |
| 173 | |
| 174 | /* |
| 175 | * Wait for clock stabilization; once stabilized, access to |
| 176 | * device-internal resources is supported, e.g. iwl_write_prph() |
| 177 | * and accesses to uCode SRAM. |
| 178 | */ |
| 179 | ret = iwl_poll_bit(trans, CSR_GP_CNTRL, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 180 | CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY, |
| 181 | CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY, 25000); |
Emmanuel Grumbach | a6c684e | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 182 | if (ret < 0) { |
| 183 | IWL_DEBUG_INFO(trans, "Failed to init the card\n"); |
| 184 | goto out; |
| 185 | } |
| 186 | |
| 187 | /* |
| 188 | * Enable DMA clock and wait for it to stabilize. |
| 189 | * |
| 190 | * Write to "CLK_EN_REG"; "1" bits enable clocks, while "0" bits |
| 191 | * do not disable clocks. This preserves any hardware bits already |
| 192 | * set by default in "CLK_CTRL_REG" after reset. |
| 193 | */ |
| 194 | iwl_write_prph(trans, APMG_CLK_EN_REG, APMG_CLK_VAL_DMA_CLK_RQT); |
| 195 | udelay(20); |
| 196 | |
| 197 | /* Disable L1-Active */ |
| 198 | iwl_set_bits_prph(trans, APMG_PCIDEV_STT_REG, |
| 199 | APMG_PCIDEV_STT_VAL_L1_ACT_DIS); |
| 200 | |
Don Fry | 8362640 | 2012-03-07 09:52:37 -0800 | [diff] [blame] | 201 | set_bit(STATUS_DEVICE_ENABLED, &trans_pcie->status); |
Emmanuel Grumbach | a6c684e | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 202 | |
| 203 | out: |
| 204 | return ret; |
| 205 | } |
| 206 | |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 207 | static int iwl_pcie_apm_stop_master(struct iwl_trans *trans) |
Emmanuel Grumbach | cc56feb | 2012-01-08 13:37:59 +0200 | [diff] [blame] | 208 | { |
| 209 | int ret = 0; |
| 210 | |
| 211 | /* stop device's busmaster DMA activity */ |
| 212 | iwl_set_bit(trans, CSR_RESET, CSR_RESET_REG_FLAG_STOP_MASTER); |
| 213 | |
| 214 | ret = iwl_poll_bit(trans, CSR_RESET, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 215 | CSR_RESET_REG_FLAG_MASTER_DISABLED, |
| 216 | CSR_RESET_REG_FLAG_MASTER_DISABLED, 100); |
Emmanuel Grumbach | cc56feb | 2012-01-08 13:37:59 +0200 | [diff] [blame] | 217 | if (ret) |
| 218 | IWL_WARN(trans, "Master Disable Timed Out, 100 usec\n"); |
| 219 | |
| 220 | IWL_DEBUG_INFO(trans, "stop master\n"); |
| 221 | |
| 222 | return ret; |
| 223 | } |
| 224 | |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 225 | static void iwl_pcie_apm_stop(struct iwl_trans *trans) |
Emmanuel Grumbach | cc56feb | 2012-01-08 13:37:59 +0200 | [diff] [blame] | 226 | { |
Don Fry | 8362640 | 2012-03-07 09:52:37 -0800 | [diff] [blame] | 227 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
Emmanuel Grumbach | cc56feb | 2012-01-08 13:37:59 +0200 | [diff] [blame] | 228 | IWL_DEBUG_INFO(trans, "Stop card, put in low power state\n"); |
| 229 | |
Don Fry | 8362640 | 2012-03-07 09:52:37 -0800 | [diff] [blame] | 230 | clear_bit(STATUS_DEVICE_ENABLED, &trans_pcie->status); |
Emmanuel Grumbach | cc56feb | 2012-01-08 13:37:59 +0200 | [diff] [blame] | 231 | |
| 232 | /* Stop device's DMA activity */ |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 233 | iwl_pcie_apm_stop_master(trans); |
Emmanuel Grumbach | cc56feb | 2012-01-08 13:37:59 +0200 | [diff] [blame] | 234 | |
| 235 | /* Reset the entire device */ |
| 236 | iwl_set_bit(trans, CSR_RESET, CSR_RESET_REG_FLAG_SW_RESET); |
| 237 | |
| 238 | udelay(10); |
| 239 | |
| 240 | /* |
| 241 | * Clear "initialization complete" bit to move adapter from |
| 242 | * D0A* (powered-up Active) --> D0U* (Uninitialized) state. |
| 243 | */ |
| 244 | iwl_clear_bit(trans, CSR_GP_CNTRL, |
| 245 | CSR_GP_CNTRL_REG_FLAG_INIT_DONE); |
| 246 | } |
| 247 | |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 248 | static int iwl_pcie_nic_init(struct iwl_trans *trans) |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 249 | { |
Johannes Berg | 7b11488 | 2012-02-05 13:55:11 -0800 | [diff] [blame] | 250 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 251 | unsigned long flags; |
| 252 | |
| 253 | /* nic_init */ |
Johannes Berg | 7b11488 | 2012-02-05 13:55:11 -0800 | [diff] [blame] | 254 | spin_lock_irqsave(&trans_pcie->irq_lock, flags); |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 255 | iwl_pcie_apm_init(trans); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 256 | |
| 257 | /* Set interrupt coalescing calibration timer to default (512 usecs) */ |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 258 | iwl_write8(trans, CSR_INT_COALESCING, IWL_HOST_INT_CALIB_TIMEOUT_DEF); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 259 | |
Johannes Berg | 7b11488 | 2012-02-05 13:55:11 -0800 | [diff] [blame] | 260 | spin_unlock_irqrestore(&trans_pcie->irq_lock, flags); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 261 | |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 262 | iwl_pcie_set_pwr_vmain(trans); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 263 | |
Johannes Berg | ecdb975 | 2012-03-06 13:31:03 -0800 | [diff] [blame] | 264 | iwl_op_mode_nic_config(trans->op_mode); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 265 | |
| 266 | /* Allocate the RX queue, or reset if it is already allocated */ |
Emmanuel Grumbach | 9805c446 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 267 | iwl_pcie_rx_init(trans); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 268 | |
| 269 | /* Allocate or reset and init all Tx and Command queues */ |
Emmanuel Grumbach | f02831b | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 270 | if (iwl_pcie_tx_init(trans)) |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 271 | return -ENOMEM; |
| 272 | |
Emmanuel Grumbach | 035f7ff | 2012-03-26 08:57:01 -0700 | [diff] [blame] | 273 | if (trans->cfg->base_params->shadow_reg_enable) { |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 274 | /* enable shadow regs in HW */ |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 275 | iwl_set_bit(trans, CSR_MAC_SHADOW_REG_CTRL, 0x800FFFFF); |
Meenakshi Venkataraman | d38069d | 2012-05-16 22:54:30 +0200 | [diff] [blame] | 276 | IWL_DEBUG_INFO(trans, "Enabling shadow registers in device\n"); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 277 | } |
| 278 | |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 279 | return 0; |
| 280 | } |
| 281 | |
| 282 | #define HW_READY_TIMEOUT (50) |
| 283 | |
| 284 | /* Note: returns poll_bit return value, which is >= 0 if success */ |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 285 | static int iwl_pcie_set_hw_ready(struct iwl_trans *trans) |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 286 | { |
| 287 | int ret; |
| 288 | |
Emmanuel Grumbach | 1042db2 | 2012-01-03 16:56:15 +0200 | [diff] [blame] | 289 | iwl_set_bit(trans, CSR_HW_IF_CONFIG_REG, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 290 | CSR_HW_IF_CONFIG_REG_BIT_NIC_READY); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 291 | |
| 292 | /* See if we got it */ |
Emmanuel Grumbach | 1042db2 | 2012-01-03 16:56:15 +0200 | [diff] [blame] | 293 | ret = iwl_poll_bit(trans, CSR_HW_IF_CONFIG_REG, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 294 | CSR_HW_IF_CONFIG_REG_BIT_NIC_READY, |
| 295 | CSR_HW_IF_CONFIG_REG_BIT_NIC_READY, |
| 296 | HW_READY_TIMEOUT); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 297 | |
Emmanuel Grumbach | 6d8f6ee | 2011-08-25 23:11:06 -0700 | [diff] [blame] | 298 | IWL_DEBUG_INFO(trans, "hardware%s ready\n", ret < 0 ? " not" : ""); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 299 | return ret; |
| 300 | } |
| 301 | |
| 302 | /* Note: returns standard 0/-ERROR code */ |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 303 | static int iwl_pcie_prepare_card_hw(struct iwl_trans *trans) |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 304 | { |
| 305 | int ret; |
Emmanuel Grumbach | 289e550 | 2012-08-05 16:55:06 +0300 | [diff] [blame] | 306 | int t = 0; |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 307 | |
Emmanuel Grumbach | 6d8f6ee | 2011-08-25 23:11:06 -0700 | [diff] [blame] | 308 | IWL_DEBUG_INFO(trans, "iwl_trans_prepare_card_hw enter\n"); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 309 | |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 310 | ret = iwl_pcie_set_hw_ready(trans); |
Emmanuel Grumbach | ebb7678 | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 311 | /* If the card is ready, exit 0 */ |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 312 | if (ret >= 0) |
| 313 | return 0; |
| 314 | |
| 315 | /* If HW is not ready, prepare the conditions to check again */ |
Emmanuel Grumbach | 1042db2 | 2012-01-03 16:56:15 +0200 | [diff] [blame] | 316 | iwl_set_bit(trans, CSR_HW_IF_CONFIG_REG, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 317 | CSR_HW_IF_CONFIG_REG_PREPARE); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 318 | |
Emmanuel Grumbach | 289e550 | 2012-08-05 16:55:06 +0300 | [diff] [blame] | 319 | do { |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 320 | ret = iwl_pcie_set_hw_ready(trans); |
Emmanuel Grumbach | 289e550 | 2012-08-05 16:55:06 +0300 | [diff] [blame] | 321 | if (ret >= 0) |
| 322 | return 0; |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 323 | |
Emmanuel Grumbach | 289e550 | 2012-08-05 16:55:06 +0300 | [diff] [blame] | 324 | usleep_range(200, 1000); |
| 325 | t += 200; |
| 326 | } while (t < 150000); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 327 | |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 328 | return ret; |
| 329 | } |
| 330 | |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 331 | /* |
| 332 | * ucode |
| 333 | */ |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 334 | static int iwl_pcie_load_firmware_chunk(struct iwl_trans *trans, u32 dst_addr, |
Johannes Berg | 83f84d7 | 2012-09-10 11:50:18 +0200 | [diff] [blame] | 335 | dma_addr_t phy_addr, u32 byte_cnt) |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 336 | { |
Johannes Berg | 13df1aa | 2012-03-06 13:31:00 -0800 | [diff] [blame] | 337 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 338 | int ret; |
| 339 | |
Johannes Berg | 13df1aa | 2012-03-06 13:31:00 -0800 | [diff] [blame] | 340 | trans_pcie->ucode_write_complete = false; |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 341 | |
| 342 | iwl_write_direct32(trans, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 343 | FH_TCSR_CHNL_TX_CONFIG_REG(FH_SRVC_CHNL), |
| 344 | FH_TCSR_TX_CONFIG_REG_VAL_DMA_CHNL_PAUSE); |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 345 | |
| 346 | iwl_write_direct32(trans, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 347 | FH_SRVC_CHNL_SRAM_ADDR_REG(FH_SRVC_CHNL), |
| 348 | dst_addr); |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 349 | |
| 350 | iwl_write_direct32(trans, |
Johannes Berg | 83f84d7 | 2012-09-10 11:50:18 +0200 | [diff] [blame] | 351 | FH_TFDIB_CTRL0_REG(FH_SRVC_CHNL), |
| 352 | phy_addr & FH_MEM_TFDIB_DRAM_ADDR_LSB_MSK); |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 353 | |
| 354 | iwl_write_direct32(trans, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 355 | FH_TFDIB_CTRL1_REG(FH_SRVC_CHNL), |
| 356 | (iwl_get_dma_hi_addr(phy_addr) |
| 357 | << FH_MEM_TFDIB_REG1_ADDR_BITSHIFT) | byte_cnt); |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 358 | |
| 359 | iwl_write_direct32(trans, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 360 | FH_TCSR_CHNL_TX_BUF_STS_REG(FH_SRVC_CHNL), |
| 361 | 1 << FH_TCSR_CHNL_TX_BUF_STS_REG_POS_TB_NUM | |
| 362 | 1 << FH_TCSR_CHNL_TX_BUF_STS_REG_POS_TB_IDX | |
| 363 | FH_TCSR_CHNL_TX_BUF_STS_REG_VAL_TFDB_VALID); |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 364 | |
| 365 | iwl_write_direct32(trans, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 366 | FH_TCSR_CHNL_TX_CONFIG_REG(FH_SRVC_CHNL), |
| 367 | FH_TCSR_TX_CONFIG_REG_VAL_DMA_CHNL_ENABLE | |
| 368 | FH_TCSR_TX_CONFIG_REG_VAL_DMA_CREDIT_DISABLE | |
| 369 | FH_TCSR_TX_CONFIG_REG_VAL_CIRQ_HOST_ENDTFD); |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 370 | |
Johannes Berg | 13df1aa | 2012-03-06 13:31:00 -0800 | [diff] [blame] | 371 | ret = wait_event_timeout(trans_pcie->ucode_write_waitq, |
| 372 | trans_pcie->ucode_write_complete, 5 * HZ); |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 373 | if (!ret) { |
Johannes Berg | 83f84d7 | 2012-09-10 11:50:18 +0200 | [diff] [blame] | 374 | IWL_ERR(trans, "Failed to load firmware chunk!\n"); |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 375 | return -ETIMEDOUT; |
| 376 | } |
| 377 | |
| 378 | return 0; |
| 379 | } |
| 380 | |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 381 | static int iwl_pcie_load_section(struct iwl_trans *trans, u8 section_num, |
Johannes Berg | 83f84d7 | 2012-09-10 11:50:18 +0200 | [diff] [blame] | 382 | const struct fw_desc *section) |
| 383 | { |
| 384 | u8 *v_addr; |
| 385 | dma_addr_t p_addr; |
| 386 | u32 offset; |
| 387 | int ret = 0; |
| 388 | |
| 389 | IWL_DEBUG_FW(trans, "[%d] uCode section being loaded...\n", |
| 390 | section_num); |
| 391 | |
| 392 | v_addr = dma_alloc_coherent(trans->dev, PAGE_SIZE, &p_addr, GFP_KERNEL); |
| 393 | if (!v_addr) |
| 394 | return -ENOMEM; |
| 395 | |
| 396 | for (offset = 0; offset < section->len; offset += PAGE_SIZE) { |
| 397 | u32 copy_size; |
| 398 | |
| 399 | copy_size = min_t(u32, PAGE_SIZE, section->len - offset); |
| 400 | |
| 401 | memcpy(v_addr, (u8 *)section->data + offset, copy_size); |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 402 | ret = iwl_pcie_load_firmware_chunk(trans, |
| 403 | section->offset + offset, |
| 404 | p_addr, copy_size); |
Johannes Berg | 83f84d7 | 2012-09-10 11:50:18 +0200 | [diff] [blame] | 405 | if (ret) { |
| 406 | IWL_ERR(trans, |
| 407 | "Could not load the [%d] uCode section\n", |
| 408 | section_num); |
| 409 | break; |
| 410 | } |
| 411 | } |
| 412 | |
| 413 | dma_free_coherent(trans->dev, PAGE_SIZE, v_addr, p_addr); |
| 414 | return ret; |
| 415 | } |
| 416 | |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 417 | static int iwl_pcie_load_given_ucode(struct iwl_trans *trans, |
Johannes Berg | 0692fe4 | 2012-03-06 13:30:37 -0800 | [diff] [blame] | 418 | const struct fw_img *image) |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 419 | { |
Johannes Berg | 2d1c004 | 2012-09-09 20:59:17 +0200 | [diff] [blame] | 420 | int i, ret = 0; |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 421 | |
Johannes Berg | 2d1c004 | 2012-09-09 20:59:17 +0200 | [diff] [blame] | 422 | for (i = 0; i < IWL_UCODE_SECTION_MAX; i++) { |
Johannes Berg | 83f84d7 | 2012-09-10 11:50:18 +0200 | [diff] [blame] | 423 | if (!image->sec[i].data) |
Johannes Berg | 2d1c004 | 2012-09-09 20:59:17 +0200 | [diff] [blame] | 424 | break; |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 425 | |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 426 | ret = iwl_pcie_load_section(trans, i, &image->sec[i]); |
Johannes Berg | 2d1c004 | 2012-09-09 20:59:17 +0200 | [diff] [blame] | 427 | if (ret) |
| 428 | return ret; |
| 429 | } |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 430 | |
| 431 | /* Remove all resets to allow NIC to operate */ |
| 432 | iwl_write32(trans, CSR_RESET, 0); |
| 433 | |
| 434 | return 0; |
| 435 | } |
| 436 | |
Johannes Berg | 0692fe4 | 2012-03-06 13:30:37 -0800 | [diff] [blame] | 437 | static int iwl_trans_pcie_start_fw(struct iwl_trans *trans, |
| 438 | const struct fw_img *fw) |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 439 | { |
Johannes Berg | d18aa87 | 2012-11-06 16:36:21 +0100 | [diff] [blame] | 440 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 441 | int ret; |
Johannes Berg | c9eec95 | 2012-03-06 13:30:43 -0800 | [diff] [blame] | 442 | bool hw_rfkill; |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 443 | |
Johannes Berg | 496bab3 | 2012-03-06 13:30:45 -0800 | [diff] [blame] | 444 | /* This may fail if AMT took ownership of the device */ |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 445 | if (iwl_pcie_prepare_card_hw(trans)) { |
Emmanuel Grumbach | 6d8f6ee | 2011-08-25 23:11:06 -0700 | [diff] [blame] | 446 | IWL_WARN(trans, "Exit HW not ready\n"); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 447 | return -EIO; |
| 448 | } |
| 449 | |
Johannes Berg | d18aa87 | 2012-11-06 16:36:21 +0100 | [diff] [blame] | 450 | clear_bit(STATUS_FW_ERROR, &trans_pcie->status); |
| 451 | |
Emmanuel Grumbach | 8c46bb7 | 2012-03-28 09:57:46 +0200 | [diff] [blame] | 452 | iwl_enable_rfkill_int(trans); |
| 453 | |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 454 | /* If platform's RF_KILL switch is NOT set to KILL */ |
Emmanuel Grumbach | 8d42551 | 2012-03-28 11:00:58 +0200 | [diff] [blame] | 455 | hw_rfkill = iwl_is_rfkill_set(trans); |
Johannes Berg | c9eec95 | 2012-03-06 13:30:43 -0800 | [diff] [blame] | 456 | iwl_op_mode_hw_rf_kill(trans->op_mode, hw_rfkill); |
Emmanuel Grumbach | 8c46bb7 | 2012-03-28 09:57:46 +0200 | [diff] [blame] | 457 | if (hw_rfkill) |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 458 | return -ERFKILL; |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 459 | |
Emmanuel Grumbach | 1042db2 | 2012-01-03 16:56:15 +0200 | [diff] [blame] | 460 | iwl_write32(trans, CSR_INT, 0xFFFFFFFF); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 461 | |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 462 | ret = iwl_pcie_nic_init(trans); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 463 | if (ret) { |
Emmanuel Grumbach | 6d8f6ee | 2011-08-25 23:11:06 -0700 | [diff] [blame] | 464 | IWL_ERR(trans, "Unable to init nic\n"); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 465 | return ret; |
| 466 | } |
| 467 | |
| 468 | /* make sure rfkill handshake bits are cleared */ |
Emmanuel Grumbach | 1042db2 | 2012-01-03 16:56:15 +0200 | [diff] [blame] | 469 | iwl_write32(trans, CSR_UCODE_DRV_GP1_CLR, CSR_UCODE_SW_BIT_RFKILL); |
| 470 | iwl_write32(trans, CSR_UCODE_DRV_GP1_CLR, |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 471 | CSR_UCODE_DRV_GP1_BIT_CMD_BLOCKED); |
| 472 | |
| 473 | /* clear (again), then enable host interrupts */ |
Emmanuel Grumbach | 1042db2 | 2012-01-03 16:56:15 +0200 | [diff] [blame] | 474 | iwl_write32(trans, CSR_INT, 0xFFFFFFFF); |
Emmanuel Grumbach | 6d8f6ee | 2011-08-25 23:11:06 -0700 | [diff] [blame] | 475 | iwl_enable_interrupts(trans); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 476 | |
| 477 | /* really make sure rfkill handshake bits are cleared */ |
Emmanuel Grumbach | 1042db2 | 2012-01-03 16:56:15 +0200 | [diff] [blame] | 478 | iwl_write32(trans, CSR_UCODE_DRV_GP1_CLR, CSR_UCODE_SW_BIT_RFKILL); |
| 479 | iwl_write32(trans, CSR_UCODE_DRV_GP1_CLR, CSR_UCODE_SW_BIT_RFKILL); |
Emmanuel Grumbach | 392f8b7 | 2011-07-10 15:30:15 +0300 | [diff] [blame] | 480 | |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 481 | /* Load the given image to the HW */ |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 482 | return iwl_pcie_load_given_ucode(trans, fw); |
Emmanuel Grumbach | b3c2ce1 | 2011-07-07 15:50:10 +0300 | [diff] [blame] | 483 | } |
| 484 | |
Emmanuel Grumbach | adca123 | 2012-10-25 23:08:27 +0200 | [diff] [blame] | 485 | static void iwl_trans_pcie_fw_alive(struct iwl_trans *trans, u32 scd_addr) |
Emmanuel Grumbach | ed6a380 | 2012-01-02 16:10:08 +0200 | [diff] [blame] | 486 | { |
Emmanuel Grumbach | 990aa6d | 2012-11-14 12:39:52 +0200 | [diff] [blame] | 487 | iwl_pcie_reset_ict(trans); |
Emmanuel Grumbach | f02831b | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 488 | iwl_pcie_tx_start(trans, scd_addr); |
Emmanuel Grumbach | c170b86 | 2011-07-08 08:46:12 -0700 | [diff] [blame] | 489 | } |
| 490 | |
Emmanuel Grumbach | 43e5885 | 2011-11-09 16:50:50 -0800 | [diff] [blame] | 491 | static void iwl_trans_pcie_stop_device(struct iwl_trans *trans) |
Emmanuel Grumbach | ae2c30b | 2011-08-25 23:11:20 -0700 | [diff] [blame] | 492 | { |
Emmanuel Grumbach | 43e5885 | 2011-11-09 16:50:50 -0800 | [diff] [blame] | 493 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 494 | unsigned long flags; |
Emmanuel Grumbach | ae2c30b | 2011-08-25 23:11:20 -0700 | [diff] [blame] | 495 | |
Emmanuel Grumbach | 43e5885 | 2011-11-09 16:50:50 -0800 | [diff] [blame] | 496 | /* tell the device to stop sending interrupts */ |
Johannes Berg | 7b11488 | 2012-02-05 13:55:11 -0800 | [diff] [blame] | 497 | spin_lock_irqsave(&trans_pcie->irq_lock, flags); |
Emmanuel Grumbach | ae2c30b | 2011-08-25 23:11:20 -0700 | [diff] [blame] | 498 | iwl_disable_interrupts(trans); |
Johannes Berg | 7b11488 | 2012-02-05 13:55:11 -0800 | [diff] [blame] | 499 | spin_unlock_irqrestore(&trans_pcie->irq_lock, flags); |
Emmanuel Grumbach | ae2c30b | 2011-08-25 23:11:20 -0700 | [diff] [blame] | 500 | |
Emmanuel Grumbach | ab6cf8e | 2011-07-07 14:37:26 +0300 | [diff] [blame] | 501 | /* device going down, Stop using ICT table */ |
Emmanuel Grumbach | 990aa6d | 2012-11-14 12:39:52 +0200 | [diff] [blame] | 502 | iwl_pcie_disable_ict(trans); |
Emmanuel Grumbach | ab6cf8e | 2011-07-07 14:37:26 +0300 | [diff] [blame] | 503 | |
| 504 | /* |
| 505 | * If a HW restart happens during firmware loading, |
| 506 | * then the firmware loading might call this function |
| 507 | * and later it might be called again due to the |
| 508 | * restart. So don't process again if the device is |
| 509 | * already dead. |
| 510 | */ |
Don Fry | 8362640 | 2012-03-07 09:52:37 -0800 | [diff] [blame] | 511 | if (test_bit(STATUS_DEVICE_ENABLED, &trans_pcie->status)) { |
Emmanuel Grumbach | f02831b | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 512 | iwl_pcie_tx_stop(trans); |
Emmanuel Grumbach | 9805c446 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 513 | iwl_pcie_rx_stop(trans); |
Johannes Berg | 6379103 | 2012-09-06 15:33:42 +0200 | [diff] [blame] | 514 | |
Emmanuel Grumbach | ab6cf8e | 2011-07-07 14:37:26 +0300 | [diff] [blame] | 515 | /* Power-down device's busmaster DMA clocks */ |
Emmanuel Grumbach | 1042db2 | 2012-01-03 16:56:15 +0200 | [diff] [blame] | 516 | iwl_write_prph(trans, APMG_CLK_DIS_REG, |
Emmanuel Grumbach | ab6cf8e | 2011-07-07 14:37:26 +0300 | [diff] [blame] | 517 | APMG_CLK_VAL_DMA_CLK_RQT); |
| 518 | udelay(5); |
| 519 | } |
| 520 | |
| 521 | /* Make sure (redundant) we've released our request to stay awake */ |
Emmanuel Grumbach | 1042db2 | 2012-01-03 16:56:15 +0200 | [diff] [blame] | 522 | iwl_clear_bit(trans, CSR_GP_CNTRL, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 523 | CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ); |
Emmanuel Grumbach | ab6cf8e | 2011-07-07 14:37:26 +0300 | [diff] [blame] | 524 | |
| 525 | /* Stop the device, and put it in low power state */ |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 526 | iwl_pcie_apm_stop(trans); |
Emmanuel Grumbach | 43e5885 | 2011-11-09 16:50:50 -0800 | [diff] [blame] | 527 | |
| 528 | /* Upon stop, the APM issues an interrupt if HW RF kill is set. |
| 529 | * Clean again the interrupt here |
| 530 | */ |
Johannes Berg | 7b11488 | 2012-02-05 13:55:11 -0800 | [diff] [blame] | 531 | spin_lock_irqsave(&trans_pcie->irq_lock, flags); |
Emmanuel Grumbach | 43e5885 | 2011-11-09 16:50:50 -0800 | [diff] [blame] | 532 | iwl_disable_interrupts(trans); |
Johannes Berg | 7b11488 | 2012-02-05 13:55:11 -0800 | [diff] [blame] | 533 | spin_unlock_irqrestore(&trans_pcie->irq_lock, flags); |
Emmanuel Grumbach | 43e5885 | 2011-11-09 16:50:50 -0800 | [diff] [blame] | 534 | |
Emmanuel Grumbach | 218733c | 2012-03-31 08:28:38 -0700 | [diff] [blame] | 535 | iwl_enable_rfkill_int(trans); |
| 536 | |
Emmanuel Grumbach | 43e5885 | 2011-11-09 16:50:50 -0800 | [diff] [blame] | 537 | /* wait to make sure we flush pending tasklet*/ |
Johannes Berg | 7559553 | 2012-03-06 13:31:01 -0800 | [diff] [blame] | 538 | synchronize_irq(trans_pcie->irq); |
Emmanuel Grumbach | 43e5885 | 2011-11-09 16:50:50 -0800 | [diff] [blame] | 539 | tasklet_kill(&trans_pcie->irq_tasklet); |
| 540 | |
Johannes Berg | 1ee158d | 2012-02-17 10:07:44 -0800 | [diff] [blame] | 541 | cancel_work_sync(&trans_pcie->rx_replenish); |
| 542 | |
Emmanuel Grumbach | 43e5885 | 2011-11-09 16:50:50 -0800 | [diff] [blame] | 543 | /* stop and reset the on-board processor */ |
Emmanuel Grumbach | 1042db2 | 2012-01-03 16:56:15 +0200 | [diff] [blame] | 544 | iwl_write32(trans, CSR_RESET, CSR_RESET_REG_FLAG_NEVO_RESET); |
Don Fry | 74fda97 | 2012-03-20 16:36:54 -0700 | [diff] [blame] | 545 | |
| 546 | /* clear all status bits */ |
| 547 | clear_bit(STATUS_HCMD_ACTIVE, &trans_pcie->status); |
| 548 | clear_bit(STATUS_INT_ENABLED, &trans_pcie->status); |
| 549 | clear_bit(STATUS_DEVICE_ENABLED, &trans_pcie->status); |
Don Fry | 01d651d | 2012-03-23 08:34:31 -0700 | [diff] [blame] | 550 | clear_bit(STATUS_TPOWER_PMI, &trans_pcie->status); |
Emmanuel Grumbach | f946b52 | 2012-10-25 17:25:52 +0200 | [diff] [blame] | 551 | clear_bit(STATUS_RFKILL, &trans_pcie->status); |
Emmanuel Grumbach | ab6cf8e | 2011-07-07 14:37:26 +0300 | [diff] [blame] | 552 | } |
| 553 | |
Johannes Berg | 2dd4f9f | 2012-03-05 11:24:35 -0800 | [diff] [blame] | 554 | static void iwl_trans_pcie_wowlan_suspend(struct iwl_trans *trans) |
| 555 | { |
| 556 | /* let the ucode operate on its own */ |
| 557 | iwl_write32(trans, CSR_UCODE_DRV_GP1_SET, |
| 558 | CSR_UCODE_DRV_GP1_BIT_D3_CFG_COMPLETE); |
| 559 | |
| 560 | iwl_disable_interrupts(trans); |
| 561 | iwl_clear_bit(trans, CSR_GP_CNTRL, |
| 562 | CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ); |
| 563 | } |
| 564 | |
Emmanuel Grumbach | 57a1dc8 | 2012-01-08 13:22:16 +0200 | [diff] [blame] | 565 | static int iwl_trans_pcie_start_hw(struct iwl_trans *trans) |
Emmanuel Grumbach | a27367d | 2011-07-04 09:06:44 +0300 | [diff] [blame] | 566 | { |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 567 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
Emmanuel Grumbach | 34c1b7b | 2011-07-04 08:58:19 +0300 | [diff] [blame] | 568 | int err; |
Johannes Berg | c9eec95 | 2012-03-06 13:30:43 -0800 | [diff] [blame] | 569 | bool hw_rfkill; |
Emmanuel Grumbach | 34c1b7b | 2011-07-04 08:58:19 +0300 | [diff] [blame] | 570 | |
Emmanuel Grumbach | 0c32576 | 2011-08-25 23:10:53 -0700 | [diff] [blame] | 571 | trans_pcie->inta_mask = CSR_INI_SET_MASK; |
Emmanuel Grumbach | 1e89cbac | 2011-07-20 17:51:22 -0700 | [diff] [blame] | 572 | |
Emmanuel Grumbach | 57a1dc8 | 2012-01-08 13:22:16 +0200 | [diff] [blame] | 573 | if (!trans_pcie->irq_requested) { |
| 574 | tasklet_init(&trans_pcie->irq_tasklet, (void (*)(unsigned long)) |
Emmanuel Grumbach | 990aa6d | 2012-11-14 12:39:52 +0200 | [diff] [blame] | 575 | iwl_pcie_tasklet, (unsigned long)trans); |
Emmanuel Grumbach | 0c32576 | 2011-08-25 23:10:53 -0700 | [diff] [blame] | 576 | |
Emmanuel Grumbach | 990aa6d | 2012-11-14 12:39:52 +0200 | [diff] [blame] | 577 | iwl_pcie_alloc_ict(trans); |
Emmanuel Grumbach | 34c1b7b | 2011-07-04 08:58:19 +0300 | [diff] [blame] | 578 | |
Emmanuel Grumbach | 990aa6d | 2012-11-14 12:39:52 +0200 | [diff] [blame] | 579 | err = request_irq(trans_pcie->irq, iwl_pcie_isr_ict, |
| 580 | IRQF_SHARED, DRV_NAME, trans); |
Emmanuel Grumbach | 57a1dc8 | 2012-01-08 13:22:16 +0200 | [diff] [blame] | 581 | if (err) { |
| 582 | IWL_ERR(trans, "Error allocating IRQ %d\n", |
Johannes Berg | 7559553 | 2012-03-06 13:31:01 -0800 | [diff] [blame] | 583 | trans_pcie->irq); |
Emmanuel Grumbach | ebb7678 | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 584 | goto error; |
Emmanuel Grumbach | 57a1dc8 | 2012-01-08 13:22:16 +0200 | [diff] [blame] | 585 | } |
| 586 | |
Emmanuel Grumbach | 57a1dc8 | 2012-01-08 13:22:16 +0200 | [diff] [blame] | 587 | trans_pcie->irq_requested = true; |
Emmanuel Grumbach | 34c1b7b | 2011-07-04 08:58:19 +0300 | [diff] [blame] | 588 | } |
| 589 | |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 590 | err = iwl_pcie_prepare_card_hw(trans); |
Emmanuel Grumbach | ebb7678 | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 591 | if (err) { |
Johannes Berg | d6f1c31 | 2012-06-28 16:49:29 +0200 | [diff] [blame] | 592 | IWL_ERR(trans, "Error while preparing HW: %d\n", err); |
Johannes Berg | f057ac4 | 2012-01-29 18:36:01 -0800 | [diff] [blame] | 593 | goto err_free_irq; |
Emmanuel Grumbach | ebb7678 | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 594 | } |
Emmanuel Grumbach | a6c684e | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 595 | |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 596 | iwl_pcie_apm_init(trans); |
Emmanuel Grumbach | a6c684e | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 597 | |
Emmanuel Grumbach | 226c02c | 2012-03-28 10:33:09 +0200 | [diff] [blame] | 598 | /* From now on, the op_mode will be kept updated about RF kill state */ |
| 599 | iwl_enable_rfkill_int(trans); |
| 600 | |
Emmanuel Grumbach | 8d42551 | 2012-03-28 11:00:58 +0200 | [diff] [blame] | 601 | hw_rfkill = iwl_is_rfkill_set(trans); |
Johannes Berg | c9eec95 | 2012-03-06 13:30:43 -0800 | [diff] [blame] | 602 | iwl_op_mode_hw_rf_kill(trans->op_mode, hw_rfkill); |
Emmanuel Grumbach | d48e207 | 2012-01-08 13:48:21 +0200 | [diff] [blame] | 603 | |
Emmanuel Grumbach | ebb7678 | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 604 | return err; |
| 605 | |
Johannes Berg | f057ac4 | 2012-01-29 18:36:01 -0800 | [diff] [blame] | 606 | err_free_irq: |
Emmanuel Grumbach | a7be50b | 2012-09-18 19:48:59 +0200 | [diff] [blame] | 607 | trans_pcie->irq_requested = false; |
Johannes Berg | 7559553 | 2012-03-06 13:31:01 -0800 | [diff] [blame] | 608 | free_irq(trans_pcie->irq, trans); |
Emmanuel Grumbach | ebb7678 | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 609 | error: |
Emmanuel Grumbach | 990aa6d | 2012-11-14 12:39:52 +0200 | [diff] [blame] | 610 | iwl_pcie_free_ict(trans); |
Emmanuel Grumbach | ebb7678 | 2012-01-08 13:24:57 +0200 | [diff] [blame] | 611 | tasklet_kill(&trans_pcie->irq_tasklet); |
| 612 | return err; |
Emmanuel Grumbach | c85eb61 | 2011-06-14 10:13:24 +0300 | [diff] [blame] | 613 | } |
Emmanuel Grumbach | e6bb4c9 | 2011-08-25 23:10:48 -0700 | [diff] [blame] | 614 | |
Emmanuel Grumbach | 218733c | 2012-03-31 08:28:38 -0700 | [diff] [blame] | 615 | static void iwl_trans_pcie_stop_hw(struct iwl_trans *trans, |
| 616 | bool op_mode_leaving) |
Emmanuel Grumbach | cc56feb | 2012-01-08 13:37:59 +0200 | [diff] [blame] | 617 | { |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 618 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
Emmanuel Grumbach | d23f78e | 2012-03-28 10:34:02 +0200 | [diff] [blame] | 619 | bool hw_rfkill; |
Emmanuel Grumbach | 218733c | 2012-03-31 08:28:38 -0700 | [diff] [blame] | 620 | unsigned long flags; |
Emmanuel Grumbach | d23f78e | 2012-03-28 10:34:02 +0200 | [diff] [blame] | 621 | |
David Spinadel | ee7d737 | 2012-08-12 08:14:04 +0300 | [diff] [blame] | 622 | spin_lock_irqsave(&trans_pcie->irq_lock, flags); |
| 623 | iwl_disable_interrupts(trans); |
| 624 | spin_unlock_irqrestore(&trans_pcie->irq_lock, flags); |
| 625 | |
Emmanuel Grumbach | 7afe370 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 626 | iwl_pcie_apm_stop(trans); |
Emmanuel Grumbach | cc56feb | 2012-01-08 13:37:59 +0200 | [diff] [blame] | 627 | |
Emmanuel Grumbach | 218733c | 2012-03-31 08:28:38 -0700 | [diff] [blame] | 628 | spin_lock_irqsave(&trans_pcie->irq_lock, flags); |
| 629 | iwl_disable_interrupts(trans); |
| 630 | spin_unlock_irqrestore(&trans_pcie->irq_lock, flags); |
| 631 | |
Emmanuel Grumbach | 8d96bb6 | 2012-12-04 22:53:30 +0200 | [diff] [blame] | 632 | iwl_pcie_disable_ict(trans); |
| 633 | |
Emmanuel Grumbach | 218733c | 2012-03-31 08:28:38 -0700 | [diff] [blame] | 634 | if (!op_mode_leaving) { |
| 635 | /* |
| 636 | * Even if we stop the HW, we still want the RF kill |
| 637 | * interrupt |
| 638 | */ |
| 639 | iwl_enable_rfkill_int(trans); |
Emmanuel Grumbach | d23f78e | 2012-03-28 10:34:02 +0200 | [diff] [blame] | 640 | |
Emmanuel Grumbach | 218733c | 2012-03-31 08:28:38 -0700 | [diff] [blame] | 641 | /* |
| 642 | * Check again since the RF kill state may have changed while |
| 643 | * all the interrupts were disabled, in this case we couldn't |
| 644 | * receive the RF kill interrupt and update the state in the |
| 645 | * op_mode. |
| 646 | */ |
| 647 | hw_rfkill = iwl_is_rfkill_set(trans); |
| 648 | iwl_op_mode_hw_rf_kill(trans->op_mode, hw_rfkill); |
| 649 | } |
Emmanuel Grumbach | cc56feb | 2012-01-08 13:37:59 +0200 | [diff] [blame] | 650 | } |
| 651 | |
Emmanuel Grumbach | 0390549 | 2012-01-03 13:48:07 +0200 | [diff] [blame] | 652 | static void iwl_trans_pcie_write8(struct iwl_trans *trans, u32 ofs, u8 val) |
| 653 | { |
Stanislaw Gruszka | 05f5b97 | 2012-03-07 09:52:26 -0800 | [diff] [blame] | 654 | writeb(val, IWL_TRANS_GET_PCIE_TRANS(trans)->hw_base + ofs); |
Emmanuel Grumbach | 0390549 | 2012-01-03 13:48:07 +0200 | [diff] [blame] | 655 | } |
| 656 | |
| 657 | static void iwl_trans_pcie_write32(struct iwl_trans *trans, u32 ofs, u32 val) |
| 658 | { |
Stanislaw Gruszka | 05f5b97 | 2012-03-07 09:52:26 -0800 | [diff] [blame] | 659 | writel(val, IWL_TRANS_GET_PCIE_TRANS(trans)->hw_base + ofs); |
Emmanuel Grumbach | 0390549 | 2012-01-03 13:48:07 +0200 | [diff] [blame] | 660 | } |
| 661 | |
| 662 | static u32 iwl_trans_pcie_read32(struct iwl_trans *trans, u32 ofs) |
| 663 | { |
Stanislaw Gruszka | 05f5b97 | 2012-03-07 09:52:26 -0800 | [diff] [blame] | 664 | return readl(IWL_TRANS_GET_PCIE_TRANS(trans)->hw_base + ofs); |
Emmanuel Grumbach | 0390549 | 2012-01-03 13:48:07 +0200 | [diff] [blame] | 665 | } |
| 666 | |
Emmanuel Grumbach | 6a06b6c | 2012-12-02 13:07:30 +0200 | [diff] [blame] | 667 | static u32 iwl_trans_pcie_read_prph(struct iwl_trans *trans, u32 reg) |
| 668 | { |
| 669 | iwl_trans_pcie_write32(trans, HBUS_TARG_PRPH_RADDR, reg | (3 << 24)); |
| 670 | return iwl_trans_pcie_read32(trans, HBUS_TARG_PRPH_RDAT); |
| 671 | } |
| 672 | |
| 673 | static void iwl_trans_pcie_write_prph(struct iwl_trans *trans, u32 addr, |
| 674 | u32 val) |
| 675 | { |
| 676 | iwl_trans_pcie_write32(trans, HBUS_TARG_PRPH_WADDR, |
| 677 | ((addr & 0x0000FFFF) | (3 << 24))); |
| 678 | iwl_trans_pcie_write32(trans, HBUS_TARG_PRPH_WDAT, val); |
| 679 | } |
| 680 | |
Meenakshi Venkataraman | c6f600f | 2012-03-08 11:29:12 -0800 | [diff] [blame] | 681 | static void iwl_trans_pcie_configure(struct iwl_trans *trans, |
Johannes Berg | 9eae88f | 2012-03-15 13:26:52 -0700 | [diff] [blame] | 682 | const struct iwl_trans_config *trans_cfg) |
Meenakshi Venkataraman | c6f600f | 2012-03-08 11:29:12 -0800 | [diff] [blame] | 683 | { |
| 684 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
| 685 | |
| 686 | trans_pcie->cmd_queue = trans_cfg->cmd_queue; |
Emmanuel Grumbach | b04db9a | 2012-06-21 11:53:44 +0300 | [diff] [blame] | 687 | trans_pcie->cmd_fifo = trans_cfg->cmd_fifo; |
Johannes Berg | d663ee7 | 2012-03-10 13:00:07 -0800 | [diff] [blame] | 688 | if (WARN_ON(trans_cfg->n_no_reclaim_cmds > MAX_NO_RECLAIM_CMDS)) |
| 689 | trans_pcie->n_no_reclaim_cmds = 0; |
| 690 | else |
| 691 | trans_pcie->n_no_reclaim_cmds = trans_cfg->n_no_reclaim_cmds; |
| 692 | if (trans_pcie->n_no_reclaim_cmds) |
| 693 | memcpy(trans_pcie->no_reclaim_cmds, trans_cfg->no_reclaim_cmds, |
| 694 | trans_pcie->n_no_reclaim_cmds * sizeof(u8)); |
Johannes Berg | 9eae88f | 2012-03-15 13:26:52 -0700 | [diff] [blame] | 695 | |
Johannes Berg | b2cf410 | 2012-04-09 17:46:51 -0700 | [diff] [blame] | 696 | trans_pcie->rx_buf_size_8k = trans_cfg->rx_buf_size_8k; |
| 697 | if (trans_pcie->rx_buf_size_8k) |
| 698 | trans_pcie->rx_page_order = get_order(8 * 1024); |
| 699 | else |
| 700 | trans_pcie->rx_page_order = get_order(4 * 1024); |
Johannes Berg | 7c5ba4a | 2012-04-09 17:46:54 -0700 | [diff] [blame] | 701 | |
| 702 | trans_pcie->wd_timeout = |
| 703 | msecs_to_jiffies(trans_cfg->queue_watchdog_timeout); |
Johannes Berg | d9fb646 | 2012-03-26 08:23:39 -0700 | [diff] [blame] | 704 | |
| 705 | trans_pcie->command_names = trans_cfg->command_names; |
Emmanuel Grumbach | 046db34 | 2012-12-05 15:07:54 +0200 | [diff] [blame^] | 706 | trans_pcie->bc_table_dword = trans_cfg->bc_table_dword; |
Meenakshi Venkataraman | c6f600f | 2012-03-08 11:29:12 -0800 | [diff] [blame] | 707 | } |
| 708 | |
Johannes Berg | d1ff525 | 2012-04-12 06:24:30 -0700 | [diff] [blame] | 709 | void iwl_trans_pcie_free(struct iwl_trans *trans) |
Emmanuel Grumbach | e6bb4c9 | 2011-08-25 23:10:48 -0700 | [diff] [blame] | 710 | { |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 711 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 712 | |
Emmanuel Grumbach | f02831b | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 713 | iwl_pcie_tx_free(trans); |
Emmanuel Grumbach | 9805c446 | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 714 | iwl_pcie_rx_free(trans); |
Johannes Berg | 6379103 | 2012-09-06 15:33:42 +0200 | [diff] [blame] | 715 | |
Emmanuel Grumbach | 57a1dc8 | 2012-01-08 13:22:16 +0200 | [diff] [blame] | 716 | if (trans_pcie->irq_requested == true) { |
Johannes Berg | 7559553 | 2012-03-06 13:31:01 -0800 | [diff] [blame] | 717 | free_irq(trans_pcie->irq, trans); |
Emmanuel Grumbach | 990aa6d | 2012-11-14 12:39:52 +0200 | [diff] [blame] | 718 | iwl_pcie_free_ict(trans); |
Emmanuel Grumbach | 57a1dc8 | 2012-01-08 13:22:16 +0200 | [diff] [blame] | 719 | } |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 720 | |
| 721 | pci_disable_msi(trans_pcie->pci_dev); |
Stanislaw Gruszka | 05f5b97 | 2012-03-07 09:52:26 -0800 | [diff] [blame] | 722 | iounmap(trans_pcie->hw_base); |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 723 | pci_release_regions(trans_pcie->pci_dev); |
| 724 | pci_disable_device(trans_pcie->pci_dev); |
Emmanuel Grumbach | 59c647b | 2012-05-24 19:24:34 +0300 | [diff] [blame] | 725 | kmem_cache_destroy(trans->dev_cmd_pool); |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 726 | |
Emmanuel Grumbach | 6d8f6ee | 2011-08-25 23:11:06 -0700 | [diff] [blame] | 727 | kfree(trans); |
Emmanuel Grumbach | e6bb4c9 | 2011-08-25 23:10:48 -0700 | [diff] [blame] | 728 | } |
| 729 | |
Don Fry | 47107e8 | 2012-03-15 13:27:06 -0700 | [diff] [blame] | 730 | static void iwl_trans_pcie_set_pmi(struct iwl_trans *trans, bool state) |
| 731 | { |
| 732 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
| 733 | |
| 734 | if (state) |
Don Fry | 01d651d | 2012-03-23 08:34:31 -0700 | [diff] [blame] | 735 | set_bit(STATUS_TPOWER_PMI, &trans_pcie->status); |
Don Fry | 47107e8 | 2012-03-15 13:27:06 -0700 | [diff] [blame] | 736 | else |
Don Fry | 01d651d | 2012-03-23 08:34:31 -0700 | [diff] [blame] | 737 | clear_bit(STATUS_TPOWER_PMI, &trans_pcie->status); |
Don Fry | 47107e8 | 2012-03-15 13:27:06 -0700 | [diff] [blame] | 738 | } |
| 739 | |
Johannes Berg | c01a404 | 2011-09-15 11:46:45 -0700 | [diff] [blame] | 740 | #ifdef CONFIG_PM_SLEEP |
Emmanuel Grumbach | 57210f7 | 2011-08-25 23:10:52 -0700 | [diff] [blame] | 741 | static int iwl_trans_pcie_suspend(struct iwl_trans *trans) |
| 742 | { |
Emmanuel Grumbach | 57210f7 | 2011-08-25 23:10:52 -0700 | [diff] [blame] | 743 | return 0; |
| 744 | } |
| 745 | |
| 746 | static int iwl_trans_pcie_resume(struct iwl_trans *trans) |
| 747 | { |
Johannes Berg | c9eec95 | 2012-03-06 13:30:43 -0800 | [diff] [blame] | 748 | bool hw_rfkill; |
Emmanuel Grumbach | 57210f7 | 2011-08-25 23:10:52 -0700 | [diff] [blame] | 749 | |
Emmanuel Grumbach | 8c46bb7 | 2012-03-28 09:57:46 +0200 | [diff] [blame] | 750 | iwl_enable_rfkill_int(trans); |
| 751 | |
Emmanuel Grumbach | 8d42551 | 2012-03-28 11:00:58 +0200 | [diff] [blame] | 752 | hw_rfkill = iwl_is_rfkill_set(trans); |
Emmanuel Grumbach | 7120d98 | 2012-02-09 16:08:15 +0200 | [diff] [blame] | 753 | iwl_op_mode_hw_rf_kill(trans->op_mode, hw_rfkill); |
Emmanuel Grumbach | 57210f7 | 2011-08-25 23:10:52 -0700 | [diff] [blame] | 754 | |
Emmanuel Grumbach | 8c46bb7 | 2012-03-28 09:57:46 +0200 | [diff] [blame] | 755 | if (!hw_rfkill) |
| 756 | iwl_enable_interrupts(trans); |
| 757 | |
Emmanuel Grumbach | 57210f7 | 2011-08-25 23:10:52 -0700 | [diff] [blame] | 758 | return 0; |
| 759 | } |
Johannes Berg | c01a404 | 2011-09-15 11:46:45 -0700 | [diff] [blame] | 760 | #endif /* CONFIG_PM_SLEEP */ |
Emmanuel Grumbach | 57210f7 | 2011-08-25 23:10:52 -0700 | [diff] [blame] | 761 | |
Emmanuel Grumbach | 5f178cd | 2011-08-25 23:11:29 -0700 | [diff] [blame] | 762 | #define IWL_FLUSH_WAIT_MS 2000 |
| 763 | |
Emmanuel Grumbach | 990aa6d | 2012-11-14 12:39:52 +0200 | [diff] [blame] | 764 | static int iwl_trans_pcie_wait_txq_empty(struct iwl_trans *trans) |
Emmanuel Grumbach | 5f178cd | 2011-08-25 23:11:29 -0700 | [diff] [blame] | 765 | { |
Emmanuel Grumbach | 8ad71be | 2011-08-25 23:11:32 -0700 | [diff] [blame] | 766 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
Emmanuel Grumbach | 990aa6d | 2012-11-14 12:39:52 +0200 | [diff] [blame] | 767 | struct iwl_txq *txq; |
Emmanuel Grumbach | 5f178cd | 2011-08-25 23:11:29 -0700 | [diff] [blame] | 768 | struct iwl_queue *q; |
| 769 | int cnt; |
| 770 | unsigned long now = jiffies; |
| 771 | int ret = 0; |
| 772 | |
| 773 | /* waiting for all the tx frames complete might take a while */ |
Emmanuel Grumbach | 035f7ff | 2012-03-26 08:57:01 -0700 | [diff] [blame] | 774 | for (cnt = 0; cnt < trans->cfg->base_params->num_of_queues; cnt++) { |
Wey-Yi Guy | 9ba1947 | 2012-03-09 10:12:42 -0800 | [diff] [blame] | 775 | if (cnt == trans_pcie->cmd_queue) |
Emmanuel Grumbach | 5f178cd | 2011-08-25 23:11:29 -0700 | [diff] [blame] | 776 | continue; |
Emmanuel Grumbach | 8ad71be | 2011-08-25 23:11:32 -0700 | [diff] [blame] | 777 | txq = &trans_pcie->txq[cnt]; |
Emmanuel Grumbach | 5f178cd | 2011-08-25 23:11:29 -0700 | [diff] [blame] | 778 | q = &txq->q; |
| 779 | while (q->read_ptr != q->write_ptr && !time_after(jiffies, |
| 780 | now + msecs_to_jiffies(IWL_FLUSH_WAIT_MS))) |
| 781 | msleep(1); |
| 782 | |
| 783 | if (q->read_ptr != q->write_ptr) { |
| 784 | IWL_ERR(trans, "fail to flush all tx fifo queues\n"); |
| 785 | ret = -ETIMEDOUT; |
| 786 | break; |
| 787 | } |
| 788 | } |
| 789 | return ret; |
| 790 | } |
| 791 | |
Emmanuel Grumbach | ff62084 | 2011-09-06 09:31:25 -0700 | [diff] [blame] | 792 | static const char *get_fh_string(int cmd) |
| 793 | { |
Johannes Berg | d9fb646 | 2012-03-26 08:23:39 -0700 | [diff] [blame] | 794 | #define IWL_CMD(x) case x: return #x |
Emmanuel Grumbach | ff62084 | 2011-09-06 09:31:25 -0700 | [diff] [blame] | 795 | switch (cmd) { |
| 796 | IWL_CMD(FH_RSCSR_CHNL0_STTS_WPTR_REG); |
| 797 | IWL_CMD(FH_RSCSR_CHNL0_RBDCB_BASE_REG); |
| 798 | IWL_CMD(FH_RSCSR_CHNL0_WPTR); |
| 799 | IWL_CMD(FH_MEM_RCSR_CHNL0_CONFIG_REG); |
| 800 | IWL_CMD(FH_MEM_RSSR_SHARED_CTRL_REG); |
| 801 | IWL_CMD(FH_MEM_RSSR_RX_STATUS_REG); |
| 802 | IWL_CMD(FH_MEM_RSSR_RX_ENABLE_ERR_IRQ2DRV); |
| 803 | IWL_CMD(FH_TSSR_TX_STATUS_REG); |
| 804 | IWL_CMD(FH_TSSR_TX_ERROR_REG); |
| 805 | default: |
| 806 | return "UNKNOWN"; |
| 807 | } |
Johannes Berg | d9fb646 | 2012-03-26 08:23:39 -0700 | [diff] [blame] | 808 | #undef IWL_CMD |
Emmanuel Grumbach | ff62084 | 2011-09-06 09:31:25 -0700 | [diff] [blame] | 809 | } |
| 810 | |
Emmanuel Grumbach | 990aa6d | 2012-11-14 12:39:52 +0200 | [diff] [blame] | 811 | int iwl_pcie_dump_fh(struct iwl_trans *trans, char **buf) |
Emmanuel Grumbach | ff62084 | 2011-09-06 09:31:25 -0700 | [diff] [blame] | 812 | { |
| 813 | int i; |
Emmanuel Grumbach | ff62084 | 2011-09-06 09:31:25 -0700 | [diff] [blame] | 814 | static const u32 fh_tbl[] = { |
| 815 | FH_RSCSR_CHNL0_STTS_WPTR_REG, |
| 816 | FH_RSCSR_CHNL0_RBDCB_BASE_REG, |
| 817 | FH_RSCSR_CHNL0_WPTR, |
| 818 | FH_MEM_RCSR_CHNL0_CONFIG_REG, |
| 819 | FH_MEM_RSSR_SHARED_CTRL_REG, |
| 820 | FH_MEM_RSSR_RX_STATUS_REG, |
| 821 | FH_MEM_RSSR_RX_ENABLE_ERR_IRQ2DRV, |
| 822 | FH_TSSR_TX_STATUS_REG, |
| 823 | FH_TSSR_TX_ERROR_REG |
| 824 | }; |
Johannes Berg | 94543a8 | 2012-08-21 18:57:10 +0200 | [diff] [blame] | 825 | |
| 826 | #ifdef CONFIG_IWLWIFI_DEBUGFS |
| 827 | if (buf) { |
| 828 | int pos = 0; |
| 829 | size_t bufsz = ARRAY_SIZE(fh_tbl) * 48 + 40; |
| 830 | |
Emmanuel Grumbach | ff62084 | 2011-09-06 09:31:25 -0700 | [diff] [blame] | 831 | *buf = kmalloc(bufsz, GFP_KERNEL); |
| 832 | if (!*buf) |
| 833 | return -ENOMEM; |
Johannes Berg | 94543a8 | 2012-08-21 18:57:10 +0200 | [diff] [blame] | 834 | |
Emmanuel Grumbach | ff62084 | 2011-09-06 09:31:25 -0700 | [diff] [blame] | 835 | pos += scnprintf(*buf + pos, bufsz - pos, |
| 836 | "FH register values:\n"); |
Johannes Berg | 94543a8 | 2012-08-21 18:57:10 +0200 | [diff] [blame] | 837 | |
| 838 | for (i = 0; i < ARRAY_SIZE(fh_tbl); i++) |
Emmanuel Grumbach | ff62084 | 2011-09-06 09:31:25 -0700 | [diff] [blame] | 839 | pos += scnprintf(*buf + pos, bufsz - pos, |
| 840 | " %34s: 0X%08x\n", |
| 841 | get_fh_string(fh_tbl[i]), |
Emmanuel Grumbach | 1042db2 | 2012-01-03 16:56:15 +0200 | [diff] [blame] | 842 | iwl_read_direct32(trans, fh_tbl[i])); |
Johannes Berg | 94543a8 | 2012-08-21 18:57:10 +0200 | [diff] [blame] | 843 | |
Emmanuel Grumbach | ff62084 | 2011-09-06 09:31:25 -0700 | [diff] [blame] | 844 | return pos; |
| 845 | } |
| 846 | #endif |
Johannes Berg | 94543a8 | 2012-08-21 18:57:10 +0200 | [diff] [blame] | 847 | |
Emmanuel Grumbach | ff62084 | 2011-09-06 09:31:25 -0700 | [diff] [blame] | 848 | IWL_ERR(trans, "FH register values:\n"); |
Johannes Berg | 94543a8 | 2012-08-21 18:57:10 +0200 | [diff] [blame] | 849 | for (i = 0; i < ARRAY_SIZE(fh_tbl); i++) |
Emmanuel Grumbach | ff62084 | 2011-09-06 09:31:25 -0700 | [diff] [blame] | 850 | IWL_ERR(trans, " %34s: 0X%08x\n", |
| 851 | get_fh_string(fh_tbl[i]), |
Emmanuel Grumbach | 1042db2 | 2012-01-03 16:56:15 +0200 | [diff] [blame] | 852 | iwl_read_direct32(trans, fh_tbl[i])); |
Johannes Berg | 94543a8 | 2012-08-21 18:57:10 +0200 | [diff] [blame] | 853 | |
Emmanuel Grumbach | ff62084 | 2011-09-06 09:31:25 -0700 | [diff] [blame] | 854 | return 0; |
| 855 | } |
| 856 | |
| 857 | static const char *get_csr_string(int cmd) |
| 858 | { |
Johannes Berg | d9fb646 | 2012-03-26 08:23:39 -0700 | [diff] [blame] | 859 | #define IWL_CMD(x) case x: return #x |
Emmanuel Grumbach | ff62084 | 2011-09-06 09:31:25 -0700 | [diff] [blame] | 860 | switch (cmd) { |
| 861 | IWL_CMD(CSR_HW_IF_CONFIG_REG); |
| 862 | IWL_CMD(CSR_INT_COALESCING); |
| 863 | IWL_CMD(CSR_INT); |
| 864 | IWL_CMD(CSR_INT_MASK); |
| 865 | IWL_CMD(CSR_FH_INT_STATUS); |
| 866 | IWL_CMD(CSR_GPIO_IN); |
| 867 | IWL_CMD(CSR_RESET); |
| 868 | IWL_CMD(CSR_GP_CNTRL); |
| 869 | IWL_CMD(CSR_HW_REV); |
| 870 | IWL_CMD(CSR_EEPROM_REG); |
| 871 | IWL_CMD(CSR_EEPROM_GP); |
| 872 | IWL_CMD(CSR_OTP_GP_REG); |
| 873 | IWL_CMD(CSR_GIO_REG); |
| 874 | IWL_CMD(CSR_GP_UCODE_REG); |
| 875 | IWL_CMD(CSR_GP_DRIVER_REG); |
| 876 | IWL_CMD(CSR_UCODE_DRV_GP1); |
| 877 | IWL_CMD(CSR_UCODE_DRV_GP2); |
| 878 | IWL_CMD(CSR_LED_REG); |
| 879 | IWL_CMD(CSR_DRAM_INT_TBL_REG); |
| 880 | IWL_CMD(CSR_GIO_CHICKEN_BITS); |
| 881 | IWL_CMD(CSR_ANA_PLL_CFG); |
| 882 | IWL_CMD(CSR_HW_REV_WA_REG); |
| 883 | IWL_CMD(CSR_DBG_HPET_MEM_REG); |
| 884 | default: |
| 885 | return "UNKNOWN"; |
| 886 | } |
Johannes Berg | d9fb646 | 2012-03-26 08:23:39 -0700 | [diff] [blame] | 887 | #undef IWL_CMD |
Emmanuel Grumbach | ff62084 | 2011-09-06 09:31:25 -0700 | [diff] [blame] | 888 | } |
| 889 | |
Emmanuel Grumbach | 990aa6d | 2012-11-14 12:39:52 +0200 | [diff] [blame] | 890 | void iwl_pcie_dump_csr(struct iwl_trans *trans) |
Emmanuel Grumbach | ff62084 | 2011-09-06 09:31:25 -0700 | [diff] [blame] | 891 | { |
| 892 | int i; |
| 893 | static const u32 csr_tbl[] = { |
| 894 | CSR_HW_IF_CONFIG_REG, |
| 895 | CSR_INT_COALESCING, |
| 896 | CSR_INT, |
| 897 | CSR_INT_MASK, |
| 898 | CSR_FH_INT_STATUS, |
| 899 | CSR_GPIO_IN, |
| 900 | CSR_RESET, |
| 901 | CSR_GP_CNTRL, |
| 902 | CSR_HW_REV, |
| 903 | CSR_EEPROM_REG, |
| 904 | CSR_EEPROM_GP, |
| 905 | CSR_OTP_GP_REG, |
| 906 | CSR_GIO_REG, |
| 907 | CSR_GP_UCODE_REG, |
| 908 | CSR_GP_DRIVER_REG, |
| 909 | CSR_UCODE_DRV_GP1, |
| 910 | CSR_UCODE_DRV_GP2, |
| 911 | CSR_LED_REG, |
| 912 | CSR_DRAM_INT_TBL_REG, |
| 913 | CSR_GIO_CHICKEN_BITS, |
| 914 | CSR_ANA_PLL_CFG, |
| 915 | CSR_HW_REV_WA_REG, |
| 916 | CSR_DBG_HPET_MEM_REG |
| 917 | }; |
| 918 | IWL_ERR(trans, "CSR values:\n"); |
| 919 | IWL_ERR(trans, "(2nd byte of CSR_INT_COALESCING is " |
| 920 | "CSR_INT_PERIODIC_REG)\n"); |
| 921 | for (i = 0; i < ARRAY_SIZE(csr_tbl); i++) { |
| 922 | IWL_ERR(trans, " %25s: 0X%08x\n", |
| 923 | get_csr_string(csr_tbl[i]), |
Emmanuel Grumbach | 1042db2 | 2012-01-03 16:56:15 +0200 | [diff] [blame] | 924 | iwl_read32(trans, csr_tbl[i])); |
Emmanuel Grumbach | ff62084 | 2011-09-06 09:31:25 -0700 | [diff] [blame] | 925 | } |
| 926 | } |
| 927 | |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 928 | #ifdef CONFIG_IWLWIFI_DEBUGFS |
| 929 | /* create and remove of files */ |
| 930 | #define DEBUGFS_ADD_FILE(name, parent, mode) do { \ |
Emmanuel Grumbach | 5a878bf | 2011-08-25 23:10:51 -0700 | [diff] [blame] | 931 | if (!debugfs_create_file(#name, mode, parent, trans, \ |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 932 | &iwl_dbgfs_##name##_ops)) \ |
Meenakshi Venkataraman | 9da987a | 2012-07-16 18:43:56 -0700 | [diff] [blame] | 933 | goto err; \ |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 934 | } while (0) |
| 935 | |
| 936 | /* file operation */ |
| 937 | #define DEBUGFS_READ_FUNC(name) \ |
| 938 | static ssize_t iwl_dbgfs_##name##_read(struct file *file, \ |
| 939 | char __user *user_buf, \ |
| 940 | size_t count, loff_t *ppos); |
| 941 | |
| 942 | #define DEBUGFS_WRITE_FUNC(name) \ |
| 943 | static ssize_t iwl_dbgfs_##name##_write(struct file *file, \ |
| 944 | const char __user *user_buf, \ |
| 945 | size_t count, loff_t *ppos); |
| 946 | |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 947 | #define DEBUGFS_READ_FILE_OPS(name) \ |
| 948 | DEBUGFS_READ_FUNC(name); \ |
| 949 | static const struct file_operations iwl_dbgfs_##name##_ops = { \ |
| 950 | .read = iwl_dbgfs_##name##_read, \ |
Stephen Boyd | 234e340 | 2012-04-05 14:25:11 -0700 | [diff] [blame] | 951 | .open = simple_open, \ |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 952 | .llseek = generic_file_llseek, \ |
| 953 | }; |
| 954 | |
Emmanuel Grumbach | 16db88b | 2011-08-25 23:11:08 -0700 | [diff] [blame] | 955 | #define DEBUGFS_WRITE_FILE_OPS(name) \ |
| 956 | DEBUGFS_WRITE_FUNC(name); \ |
| 957 | static const struct file_operations iwl_dbgfs_##name##_ops = { \ |
| 958 | .write = iwl_dbgfs_##name##_write, \ |
Stephen Boyd | 234e340 | 2012-04-05 14:25:11 -0700 | [diff] [blame] | 959 | .open = simple_open, \ |
Emmanuel Grumbach | 16db88b | 2011-08-25 23:11:08 -0700 | [diff] [blame] | 960 | .llseek = generic_file_llseek, \ |
| 961 | }; |
| 962 | |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 963 | #define DEBUGFS_READ_WRITE_FILE_OPS(name) \ |
| 964 | DEBUGFS_READ_FUNC(name); \ |
| 965 | DEBUGFS_WRITE_FUNC(name); \ |
| 966 | static const struct file_operations iwl_dbgfs_##name##_ops = { \ |
| 967 | .write = iwl_dbgfs_##name##_write, \ |
| 968 | .read = iwl_dbgfs_##name##_read, \ |
Stephen Boyd | 234e340 | 2012-04-05 14:25:11 -0700 | [diff] [blame] | 969 | .open = simple_open, \ |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 970 | .llseek = generic_file_llseek, \ |
| 971 | }; |
| 972 | |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 973 | static ssize_t iwl_dbgfs_tx_queue_read(struct file *file, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 974 | char __user *user_buf, |
| 975 | size_t count, loff_t *ppos) |
Emmanuel Grumbach | 8ad71be | 2011-08-25 23:11:32 -0700 | [diff] [blame] | 976 | { |
Emmanuel Grumbach | 5a878bf | 2011-08-25 23:10:51 -0700 | [diff] [blame] | 977 | struct iwl_trans *trans = file->private_data; |
Emmanuel Grumbach | 8ad71be | 2011-08-25 23:11:32 -0700 | [diff] [blame] | 978 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
Emmanuel Grumbach | 990aa6d | 2012-11-14 12:39:52 +0200 | [diff] [blame] | 979 | struct iwl_txq *txq; |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 980 | struct iwl_queue *q; |
| 981 | char *buf; |
| 982 | int pos = 0; |
| 983 | int cnt; |
| 984 | int ret; |
Wey-Yi Guy | 1745e440 | 2012-03-09 11:13:40 -0800 | [diff] [blame] | 985 | size_t bufsz; |
| 986 | |
Emmanuel Grumbach | 035f7ff | 2012-03-26 08:57:01 -0700 | [diff] [blame] | 987 | bufsz = sizeof(char) * 64 * trans->cfg->base_params->num_of_queues; |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 988 | |
Johannes Berg | f9e7544 | 2012-03-30 09:37:39 +0200 | [diff] [blame] | 989 | if (!trans_pcie->txq) |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 990 | return -EAGAIN; |
Johannes Berg | f9e7544 | 2012-03-30 09:37:39 +0200 | [diff] [blame] | 991 | |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 992 | buf = kzalloc(bufsz, GFP_KERNEL); |
| 993 | if (!buf) |
| 994 | return -ENOMEM; |
| 995 | |
Emmanuel Grumbach | 035f7ff | 2012-03-26 08:57:01 -0700 | [diff] [blame] | 996 | for (cnt = 0; cnt < trans->cfg->base_params->num_of_queues; cnt++) { |
Emmanuel Grumbach | 8ad71be | 2011-08-25 23:11:32 -0700 | [diff] [blame] | 997 | txq = &trans_pcie->txq[cnt]; |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 998 | q = &txq->q; |
| 999 | pos += scnprintf(buf + pos, bufsz - pos, |
Johannes Berg | 9eae88f | 2012-03-15 13:26:52 -0700 | [diff] [blame] | 1000 | "hwq %.2d: read=%u write=%u use=%d stop=%d\n", |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 1001 | cnt, q->read_ptr, q->write_ptr, |
Johannes Berg | 9eae88f | 2012-03-15 13:26:52 -0700 | [diff] [blame] | 1002 | !!test_bit(cnt, trans_pcie->queue_used), |
| 1003 | !!test_bit(cnt, trans_pcie->queue_stopped)); |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 1004 | } |
| 1005 | ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos); |
| 1006 | kfree(buf); |
| 1007 | return ret; |
| 1008 | } |
| 1009 | |
| 1010 | static ssize_t iwl_dbgfs_rx_queue_read(struct file *file, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 1011 | char __user *user_buf, |
| 1012 | size_t count, loff_t *ppos) |
| 1013 | { |
Emmanuel Grumbach | 5a878bf | 2011-08-25 23:10:51 -0700 | [diff] [blame] | 1014 | struct iwl_trans *trans = file->private_data; |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 1015 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
Emmanuel Grumbach | 990aa6d | 2012-11-14 12:39:52 +0200 | [diff] [blame] | 1016 | struct iwl_rxq *rxq = &trans_pcie->rxq; |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 1017 | char buf[256]; |
| 1018 | int pos = 0; |
| 1019 | const size_t bufsz = sizeof(buf); |
| 1020 | |
| 1021 | pos += scnprintf(buf + pos, bufsz - pos, "read: %u\n", |
| 1022 | rxq->read); |
| 1023 | pos += scnprintf(buf + pos, bufsz - pos, "write: %u\n", |
| 1024 | rxq->write); |
| 1025 | pos += scnprintf(buf + pos, bufsz - pos, "free_count: %u\n", |
| 1026 | rxq->free_count); |
| 1027 | if (rxq->rb_stts) { |
| 1028 | pos += scnprintf(buf + pos, bufsz - pos, "closed_rb_num: %u\n", |
| 1029 | le16_to_cpu(rxq->rb_stts->closed_rb_num) & 0x0FFF); |
| 1030 | } else { |
| 1031 | pos += scnprintf(buf + pos, bufsz - pos, |
| 1032 | "closed_rb_num: Not Allocated\n"); |
| 1033 | } |
| 1034 | return simple_read_from_buffer(user_buf, count, ppos, buf, pos); |
| 1035 | } |
| 1036 | |
Emmanuel Grumbach | 1f7b617 | 2011-08-25 23:10:59 -0700 | [diff] [blame] | 1037 | static ssize_t iwl_dbgfs_interrupt_read(struct file *file, |
| 1038 | char __user *user_buf, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 1039 | size_t count, loff_t *ppos) |
| 1040 | { |
Emmanuel Grumbach | 1f7b617 | 2011-08-25 23:10:59 -0700 | [diff] [blame] | 1041 | struct iwl_trans *trans = file->private_data; |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 1042 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
Emmanuel Grumbach | 1f7b617 | 2011-08-25 23:10:59 -0700 | [diff] [blame] | 1043 | struct isr_statistics *isr_stats = &trans_pcie->isr_stats; |
| 1044 | |
| 1045 | int pos = 0; |
| 1046 | char *buf; |
| 1047 | int bufsz = 24 * 64; /* 24 items * 64 char per item */ |
| 1048 | ssize_t ret; |
| 1049 | |
| 1050 | buf = kzalloc(bufsz, GFP_KERNEL); |
Johannes Berg | f9e7544 | 2012-03-30 09:37:39 +0200 | [diff] [blame] | 1051 | if (!buf) |
Emmanuel Grumbach | 1f7b617 | 2011-08-25 23:10:59 -0700 | [diff] [blame] | 1052 | return -ENOMEM; |
Emmanuel Grumbach | 1f7b617 | 2011-08-25 23:10:59 -0700 | [diff] [blame] | 1053 | |
| 1054 | pos += scnprintf(buf + pos, bufsz - pos, |
| 1055 | "Interrupt Statistics Report:\n"); |
| 1056 | |
| 1057 | pos += scnprintf(buf + pos, bufsz - pos, "HW Error:\t\t\t %u\n", |
| 1058 | isr_stats->hw); |
| 1059 | pos += scnprintf(buf + pos, bufsz - pos, "SW Error:\t\t\t %u\n", |
| 1060 | isr_stats->sw); |
| 1061 | if (isr_stats->sw || isr_stats->hw) { |
| 1062 | pos += scnprintf(buf + pos, bufsz - pos, |
| 1063 | "\tLast Restarting Code: 0x%X\n", |
| 1064 | isr_stats->err_code); |
| 1065 | } |
| 1066 | #ifdef CONFIG_IWLWIFI_DEBUG |
| 1067 | pos += scnprintf(buf + pos, bufsz - pos, "Frame transmitted:\t\t %u\n", |
| 1068 | isr_stats->sch); |
| 1069 | pos += scnprintf(buf + pos, bufsz - pos, "Alive interrupt:\t\t %u\n", |
| 1070 | isr_stats->alive); |
| 1071 | #endif |
| 1072 | pos += scnprintf(buf + pos, bufsz - pos, |
| 1073 | "HW RF KILL switch toggled:\t %u\n", isr_stats->rfkill); |
| 1074 | |
| 1075 | pos += scnprintf(buf + pos, bufsz - pos, "CT KILL:\t\t\t %u\n", |
| 1076 | isr_stats->ctkill); |
| 1077 | |
| 1078 | pos += scnprintf(buf + pos, bufsz - pos, "Wakeup Interrupt:\t\t %u\n", |
| 1079 | isr_stats->wakeup); |
| 1080 | |
| 1081 | pos += scnprintf(buf + pos, bufsz - pos, |
| 1082 | "Rx command responses:\t\t %u\n", isr_stats->rx); |
| 1083 | |
| 1084 | pos += scnprintf(buf + pos, bufsz - pos, "Tx/FH interrupt:\t\t %u\n", |
| 1085 | isr_stats->tx); |
| 1086 | |
| 1087 | pos += scnprintf(buf + pos, bufsz - pos, "Unexpected INTA:\t\t %u\n", |
| 1088 | isr_stats->unhandled); |
| 1089 | |
| 1090 | ret = simple_read_from_buffer(user_buf, count, ppos, buf, pos); |
| 1091 | kfree(buf); |
| 1092 | return ret; |
| 1093 | } |
| 1094 | |
| 1095 | static ssize_t iwl_dbgfs_interrupt_write(struct file *file, |
| 1096 | const char __user *user_buf, |
| 1097 | size_t count, loff_t *ppos) |
| 1098 | { |
| 1099 | struct iwl_trans *trans = file->private_data; |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 1100 | struct iwl_trans_pcie *trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
Emmanuel Grumbach | 1f7b617 | 2011-08-25 23:10:59 -0700 | [diff] [blame] | 1101 | struct isr_statistics *isr_stats = &trans_pcie->isr_stats; |
| 1102 | |
| 1103 | char buf[8]; |
| 1104 | int buf_size; |
| 1105 | u32 reset_flag; |
| 1106 | |
| 1107 | memset(buf, 0, sizeof(buf)); |
| 1108 | buf_size = min(count, sizeof(buf) - 1); |
| 1109 | if (copy_from_user(buf, user_buf, buf_size)) |
| 1110 | return -EFAULT; |
| 1111 | if (sscanf(buf, "%x", &reset_flag) != 1) |
| 1112 | return -EFAULT; |
| 1113 | if (reset_flag == 0) |
| 1114 | memset(isr_stats, 0, sizeof(*isr_stats)); |
| 1115 | |
| 1116 | return count; |
| 1117 | } |
| 1118 | |
Emmanuel Grumbach | 16db88b | 2011-08-25 23:11:08 -0700 | [diff] [blame] | 1119 | static ssize_t iwl_dbgfs_csr_write(struct file *file, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 1120 | const char __user *user_buf, |
| 1121 | size_t count, loff_t *ppos) |
Emmanuel Grumbach | 16db88b | 2011-08-25 23:11:08 -0700 | [diff] [blame] | 1122 | { |
| 1123 | struct iwl_trans *trans = file->private_data; |
| 1124 | char buf[8]; |
| 1125 | int buf_size; |
| 1126 | int csr; |
| 1127 | |
| 1128 | memset(buf, 0, sizeof(buf)); |
| 1129 | buf_size = min(count, sizeof(buf) - 1); |
| 1130 | if (copy_from_user(buf, user_buf, buf_size)) |
| 1131 | return -EFAULT; |
| 1132 | if (sscanf(buf, "%d", &csr) != 1) |
| 1133 | return -EFAULT; |
| 1134 | |
Emmanuel Grumbach | 990aa6d | 2012-11-14 12:39:52 +0200 | [diff] [blame] | 1135 | iwl_pcie_dump_csr(trans); |
Emmanuel Grumbach | 16db88b | 2011-08-25 23:11:08 -0700 | [diff] [blame] | 1136 | |
| 1137 | return count; |
| 1138 | } |
| 1139 | |
Emmanuel Grumbach | 16db88b | 2011-08-25 23:11:08 -0700 | [diff] [blame] | 1140 | static ssize_t iwl_dbgfs_fh_reg_read(struct file *file, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 1141 | char __user *user_buf, |
| 1142 | size_t count, loff_t *ppos) |
Emmanuel Grumbach | 16db88b | 2011-08-25 23:11:08 -0700 | [diff] [blame] | 1143 | { |
| 1144 | struct iwl_trans *trans = file->private_data; |
Johannes Berg | 94543a8 | 2012-08-21 18:57:10 +0200 | [diff] [blame] | 1145 | char *buf = NULL; |
Emmanuel Grumbach | 16db88b | 2011-08-25 23:11:08 -0700 | [diff] [blame] | 1146 | int pos = 0; |
| 1147 | ssize_t ret = -EFAULT; |
| 1148 | |
Emmanuel Grumbach | 990aa6d | 2012-11-14 12:39:52 +0200 | [diff] [blame] | 1149 | ret = pos = iwl_pcie_dump_fh(trans, &buf); |
Emmanuel Grumbach | 16db88b | 2011-08-25 23:11:08 -0700 | [diff] [blame] | 1150 | if (buf) { |
| 1151 | ret = simple_read_from_buffer(user_buf, |
| 1152 | count, ppos, buf, pos); |
| 1153 | kfree(buf); |
| 1154 | } |
| 1155 | |
| 1156 | return ret; |
| 1157 | } |
| 1158 | |
Johannes Berg | 48dffd3 | 2012-04-09 17:46:57 -0700 | [diff] [blame] | 1159 | static ssize_t iwl_dbgfs_fw_restart_write(struct file *file, |
| 1160 | const char __user *user_buf, |
| 1161 | size_t count, loff_t *ppos) |
| 1162 | { |
| 1163 | struct iwl_trans *trans = file->private_data; |
| 1164 | |
| 1165 | if (!trans->op_mode) |
| 1166 | return -EAGAIN; |
| 1167 | |
Emmanuel Grumbach | 24172f3 | 2012-06-17 16:04:25 +0300 | [diff] [blame] | 1168 | local_bh_disable(); |
Johannes Berg | 48dffd3 | 2012-04-09 17:46:57 -0700 | [diff] [blame] | 1169 | iwl_op_mode_nic_error(trans->op_mode); |
Emmanuel Grumbach | 24172f3 | 2012-06-17 16:04:25 +0300 | [diff] [blame] | 1170 | local_bh_enable(); |
Johannes Berg | 48dffd3 | 2012-04-09 17:46:57 -0700 | [diff] [blame] | 1171 | |
| 1172 | return count; |
| 1173 | } |
| 1174 | |
Emmanuel Grumbach | 1f7b617 | 2011-08-25 23:10:59 -0700 | [diff] [blame] | 1175 | DEBUGFS_READ_WRITE_FILE_OPS(interrupt); |
Emmanuel Grumbach | 16db88b | 2011-08-25 23:11:08 -0700 | [diff] [blame] | 1176 | DEBUGFS_READ_FILE_OPS(fh_reg); |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 1177 | DEBUGFS_READ_FILE_OPS(rx_queue); |
| 1178 | DEBUGFS_READ_FILE_OPS(tx_queue); |
Emmanuel Grumbach | 16db88b | 2011-08-25 23:11:08 -0700 | [diff] [blame] | 1179 | DEBUGFS_WRITE_FILE_OPS(csr); |
Johannes Berg | 48dffd3 | 2012-04-09 17:46:57 -0700 | [diff] [blame] | 1180 | DEBUGFS_WRITE_FILE_OPS(fw_restart); |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 1181 | |
| 1182 | /* |
| 1183 | * Create the debugfs files and directories |
| 1184 | * |
| 1185 | */ |
| 1186 | static int iwl_trans_pcie_dbgfs_register(struct iwl_trans *trans, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 1187 | struct dentry *dir) |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 1188 | { |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 1189 | DEBUGFS_ADD_FILE(rx_queue, dir, S_IRUSR); |
| 1190 | DEBUGFS_ADD_FILE(tx_queue, dir, S_IRUSR); |
Emmanuel Grumbach | 1f7b617 | 2011-08-25 23:10:59 -0700 | [diff] [blame] | 1191 | DEBUGFS_ADD_FILE(interrupt, dir, S_IWUSR | S_IRUSR); |
Emmanuel Grumbach | 16db88b | 2011-08-25 23:11:08 -0700 | [diff] [blame] | 1192 | DEBUGFS_ADD_FILE(csr, dir, S_IWUSR); |
| 1193 | DEBUGFS_ADD_FILE(fh_reg, dir, S_IRUSR); |
Johannes Berg | 48dffd3 | 2012-04-09 17:46:57 -0700 | [diff] [blame] | 1194 | DEBUGFS_ADD_FILE(fw_restart, dir, S_IWUSR); |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 1195 | return 0; |
Meenakshi Venkataraman | 9da987a | 2012-07-16 18:43:56 -0700 | [diff] [blame] | 1196 | |
| 1197 | err: |
| 1198 | IWL_ERR(trans, "failed to create the trans debugfs entry\n"); |
| 1199 | return -ENOMEM; |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 1200 | } |
| 1201 | #else |
| 1202 | static int iwl_trans_pcie_dbgfs_register(struct iwl_trans *trans, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 1203 | struct dentry *dir) |
| 1204 | { |
| 1205 | return 0; |
| 1206 | } |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 1207 | #endif /*CONFIG_IWLWIFI_DEBUGFS */ |
| 1208 | |
Johannes Berg | d1ff525 | 2012-04-12 06:24:30 -0700 | [diff] [blame] | 1209 | static const struct iwl_trans_ops trans_ops_pcie = { |
Emmanuel Grumbach | 57a1dc8 | 2012-01-08 13:22:16 +0200 | [diff] [blame] | 1210 | .start_hw = iwl_trans_pcie_start_hw, |
Emmanuel Grumbach | cc56feb | 2012-01-08 13:37:59 +0200 | [diff] [blame] | 1211 | .stop_hw = iwl_trans_pcie_stop_hw, |
Emmanuel Grumbach | ed6a380 | 2012-01-02 16:10:08 +0200 | [diff] [blame] | 1212 | .fw_alive = iwl_trans_pcie_fw_alive, |
Emmanuel Grumbach | cf61429 | 2012-01-08 16:33:58 +0200 | [diff] [blame] | 1213 | .start_fw = iwl_trans_pcie_start_fw, |
Emmanuel Grumbach | e6bb4c9 | 2011-08-25 23:10:48 -0700 | [diff] [blame] | 1214 | .stop_device = iwl_trans_pcie_stop_device, |
| 1215 | |
Johannes Berg | 2dd4f9f | 2012-03-05 11:24:35 -0800 | [diff] [blame] | 1216 | .wowlan_suspend = iwl_trans_pcie_wowlan_suspend, |
| 1217 | |
Emmanuel Grumbach | f02831b | 2012-11-14 14:44:18 +0200 | [diff] [blame] | 1218 | .send_cmd = iwl_trans_pcie_send_hcmd, |
Emmanuel Grumbach | e6bb4c9 | 2011-08-25 23:10:48 -0700 | [diff] [blame] | 1219 | |
Emmanuel Grumbach | e6bb4c9 | 2011-08-25 23:10:48 -0700 | [diff] [blame] | 1220 | .tx = iwl_trans_pcie_tx, |
Emmanuel Grumbach | a0eaad7 | 2011-08-25 23:11:00 -0700 | [diff] [blame] | 1221 | .reclaim = iwl_trans_pcie_reclaim, |
Emmanuel Grumbach | e6bb4c9 | 2011-08-25 23:10:48 -0700 | [diff] [blame] | 1222 | |
Emmanuel Grumbach | d0624be | 2012-05-29 13:07:30 +0300 | [diff] [blame] | 1223 | .txq_disable = iwl_trans_pcie_txq_disable, |
Emmanuel Grumbach | 4beaf6c | 2012-05-29 11:29:10 +0300 | [diff] [blame] | 1224 | .txq_enable = iwl_trans_pcie_txq_enable, |
Emmanuel Grumbach | e6bb4c9 | 2011-08-25 23:10:48 -0700 | [diff] [blame] | 1225 | |
Emmanuel Grumbach | 87e5666 | 2011-08-25 23:10:50 -0700 | [diff] [blame] | 1226 | .dbgfs_register = iwl_trans_pcie_dbgfs_register, |
Emmanuel Grumbach | 5f178cd | 2011-08-25 23:11:29 -0700 | [diff] [blame] | 1227 | |
Emmanuel Grumbach | 990aa6d | 2012-11-14 12:39:52 +0200 | [diff] [blame] | 1228 | .wait_tx_queue_empty = iwl_trans_pcie_wait_txq_empty, |
Emmanuel Grumbach | 5f178cd | 2011-08-25 23:11:29 -0700 | [diff] [blame] | 1229 | |
Johannes Berg | c01a404 | 2011-09-15 11:46:45 -0700 | [diff] [blame] | 1230 | #ifdef CONFIG_PM_SLEEP |
Emmanuel Grumbach | 57210f7 | 2011-08-25 23:10:52 -0700 | [diff] [blame] | 1231 | .suspend = iwl_trans_pcie_suspend, |
| 1232 | .resume = iwl_trans_pcie_resume, |
Johannes Berg | c01a404 | 2011-09-15 11:46:45 -0700 | [diff] [blame] | 1233 | #endif |
Emmanuel Grumbach | 0390549 | 2012-01-03 13:48:07 +0200 | [diff] [blame] | 1234 | .write8 = iwl_trans_pcie_write8, |
| 1235 | .write32 = iwl_trans_pcie_write32, |
| 1236 | .read32 = iwl_trans_pcie_read32, |
Emmanuel Grumbach | 6a06b6c | 2012-12-02 13:07:30 +0200 | [diff] [blame] | 1237 | .read_prph = iwl_trans_pcie_read_prph, |
| 1238 | .write_prph = iwl_trans_pcie_write_prph, |
Meenakshi Venkataraman | c6f600f | 2012-03-08 11:29:12 -0800 | [diff] [blame] | 1239 | .configure = iwl_trans_pcie_configure, |
Don Fry | 47107e8 | 2012-03-15 13:27:06 -0700 | [diff] [blame] | 1240 | .set_pmi = iwl_trans_pcie_set_pmi, |
Emmanuel Grumbach | e6bb4c9 | 2011-08-25 23:10:48 -0700 | [diff] [blame] | 1241 | }; |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1242 | |
Emmanuel Grumbach | 87ce05a | 2012-03-26 09:03:18 -0700 | [diff] [blame] | 1243 | struct iwl_trans *iwl_trans_pcie_alloc(struct pci_dev *pdev, |
Emmanuel Grumbach | 035f7ff | 2012-03-26 08:57:01 -0700 | [diff] [blame] | 1244 | const struct pci_device_id *ent, |
| 1245 | const struct iwl_cfg *cfg) |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1246 | { |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1247 | struct iwl_trans_pcie *trans_pcie; |
| 1248 | struct iwl_trans *trans; |
| 1249 | u16 pci_cmd; |
| 1250 | int err; |
| 1251 | |
| 1252 | trans = kzalloc(sizeof(struct iwl_trans) + |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 1253 | sizeof(struct iwl_trans_pcie), GFP_KERNEL); |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1254 | |
Emmanuel Grumbach | dbeca58 | 2012-11-13 13:19:33 +0200 | [diff] [blame] | 1255 | if (!trans) |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1256 | return NULL; |
| 1257 | |
| 1258 | trans_pcie = IWL_TRANS_GET_PCIE_TRANS(trans); |
| 1259 | |
| 1260 | trans->ops = &trans_ops_pcie; |
Emmanuel Grumbach | 035f7ff | 2012-03-26 08:57:01 -0700 | [diff] [blame] | 1261 | trans->cfg = cfg; |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1262 | trans_pcie->trans = trans; |
Johannes Berg | 7b11488 | 2012-02-05 13:55:11 -0800 | [diff] [blame] | 1263 | spin_lock_init(&trans_pcie->irq_lock); |
Johannes Berg | 13df1aa | 2012-03-06 13:31:00 -0800 | [diff] [blame] | 1264 | init_waitqueue_head(&trans_pcie->ucode_write_waitq); |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1265 | |
| 1266 | /* W/A - seems to solve weird behavior. We need to remove this if we |
| 1267 | * don't want to stay in L1 all the time. This wastes a lot of power */ |
| 1268 | pci_disable_link_state(pdev, PCIE_LINK_STATE_L0S | PCIE_LINK_STATE_L1 | |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 1269 | PCIE_LINK_STATE_CLKPM); |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1270 | |
| 1271 | if (pci_enable_device(pdev)) { |
| 1272 | err = -ENODEV; |
| 1273 | goto out_no_pci; |
| 1274 | } |
| 1275 | |
| 1276 | pci_set_master(pdev); |
| 1277 | |
| 1278 | err = pci_set_dma_mask(pdev, DMA_BIT_MASK(36)); |
| 1279 | if (!err) |
| 1280 | err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(36)); |
| 1281 | if (err) { |
| 1282 | err = pci_set_dma_mask(pdev, DMA_BIT_MASK(32)); |
| 1283 | if (!err) |
| 1284 | err = pci_set_consistent_dma_mask(pdev, |
Johannes Berg | 20d3b64 | 2012-05-16 22:54:29 +0200 | [diff] [blame] | 1285 | DMA_BIT_MASK(32)); |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1286 | /* both attempts failed: */ |
| 1287 | if (err) { |
Joe Perches | 6a4b09f | 2012-10-28 01:05:47 -0700 | [diff] [blame] | 1288 | dev_err(&pdev->dev, "No suitable DMA available\n"); |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1289 | goto out_pci_disable_device; |
| 1290 | } |
| 1291 | } |
| 1292 | |
| 1293 | err = pci_request_regions(pdev, DRV_NAME); |
| 1294 | if (err) { |
Joe Perches | 6a4b09f | 2012-10-28 01:05:47 -0700 | [diff] [blame] | 1295 | dev_err(&pdev->dev, "pci_request_regions failed\n"); |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1296 | goto out_pci_disable_device; |
| 1297 | } |
| 1298 | |
Stanislaw Gruszka | 05f5b97 | 2012-03-07 09:52:26 -0800 | [diff] [blame] | 1299 | trans_pcie->hw_base = pci_ioremap_bar(pdev, 0); |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1300 | if (!trans_pcie->hw_base) { |
Joe Perches | 6a4b09f | 2012-10-28 01:05:47 -0700 | [diff] [blame] | 1301 | dev_err(&pdev->dev, "pci_ioremap_bar failed\n"); |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1302 | err = -ENODEV; |
| 1303 | goto out_pci_release_regions; |
| 1304 | } |
| 1305 | |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1306 | /* We disable the RETRY_TIMEOUT register (0x41) to keep |
| 1307 | * PCI Tx retries from interfering with C3 CPU state */ |
| 1308 | pci_write_config_byte(pdev, PCI_CFG_RETRY_TIMEOUT, 0x00); |
| 1309 | |
| 1310 | err = pci_enable_msi(pdev); |
Emmanuel Grumbach | 9f904b3 | 2012-11-13 13:35:43 +0200 | [diff] [blame] | 1311 | if (err) { |
Joe Perches | 6a4b09f | 2012-10-28 01:05:47 -0700 | [diff] [blame] | 1312 | dev_err(&pdev->dev, "pci_enable_msi failed(0X%x)\n", err); |
Emmanuel Grumbach | 9f904b3 | 2012-11-13 13:35:43 +0200 | [diff] [blame] | 1313 | /* enable rfkill interrupt: hw bug w/a */ |
| 1314 | pci_read_config_word(pdev, PCI_COMMAND, &pci_cmd); |
| 1315 | if (pci_cmd & PCI_COMMAND_INTX_DISABLE) { |
| 1316 | pci_cmd &= ~PCI_COMMAND_INTX_DISABLE; |
| 1317 | pci_write_config_word(pdev, PCI_COMMAND, pci_cmd); |
| 1318 | } |
| 1319 | } |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1320 | |
| 1321 | trans->dev = &pdev->dev; |
Johannes Berg | 7559553 | 2012-03-06 13:31:01 -0800 | [diff] [blame] | 1322 | trans_pcie->irq = pdev->irq; |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1323 | trans_pcie->pci_dev = pdev; |
Emmanuel Grumbach | 08079a4 | 2012-01-09 16:23:00 +0200 | [diff] [blame] | 1324 | trans->hw_rev = iwl_read32(trans, CSR_HW_REV); |
Emmanuel Grumbach | 99673ee | 2012-01-08 21:19:45 +0200 | [diff] [blame] | 1325 | trans->hw_id = (pdev->device << 16) + pdev->subsystem_device; |
Emmanuel Grumbach | 9ca8596 | 2012-01-08 21:19:45 +0200 | [diff] [blame] | 1326 | snprintf(trans->hw_id_str, sizeof(trans->hw_id_str), |
| 1327 | "PCI ID: 0x%04X:0x%04X", pdev->device, pdev->subsystem_device); |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1328 | |
Meenakshi Venkataraman | 69a10b2 | 2012-03-10 13:00:09 -0800 | [diff] [blame] | 1329 | /* Initialize the wait queue for commands */ |
Emmanuel Grumbach | f946b52 | 2012-10-25 17:25:52 +0200 | [diff] [blame] | 1330 | init_waitqueue_head(&trans_pcie->wait_command_queue); |
Emmanuel Grumbach | 8b5bed9 | 2012-04-23 15:03:06 -0700 | [diff] [blame] | 1331 | spin_lock_init(&trans->reg_lock); |
Meenakshi Venkataraman | 69a10b2 | 2012-03-10 13:00:09 -0800 | [diff] [blame] | 1332 | |
Johannes Berg | 3ec4588 | 2012-07-12 13:56:28 +0200 | [diff] [blame] | 1333 | snprintf(trans->dev_cmd_pool_name, sizeof(trans->dev_cmd_pool_name), |
| 1334 | "iwl_cmd_pool:%s", dev_name(trans->dev)); |
Emmanuel Grumbach | 59c647b | 2012-05-24 19:24:34 +0300 | [diff] [blame] | 1335 | |
| 1336 | trans->dev_cmd_headroom = 0; |
| 1337 | trans->dev_cmd_pool = |
Johannes Berg | 3ec4588 | 2012-07-12 13:56:28 +0200 | [diff] [blame] | 1338 | kmem_cache_create(trans->dev_cmd_pool_name, |
Emmanuel Grumbach | 59c647b | 2012-05-24 19:24:34 +0300 | [diff] [blame] | 1339 | sizeof(struct iwl_device_cmd) |
| 1340 | + trans->dev_cmd_headroom, |
| 1341 | sizeof(void *), |
| 1342 | SLAB_HWCACHE_ALIGN, |
| 1343 | NULL); |
| 1344 | |
| 1345 | if (!trans->dev_cmd_pool) |
| 1346 | goto out_pci_disable_msi; |
| 1347 | |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1348 | return trans; |
| 1349 | |
Emmanuel Grumbach | 59c647b | 2012-05-24 19:24:34 +0300 | [diff] [blame] | 1350 | out_pci_disable_msi: |
| 1351 | pci_disable_msi(pdev); |
Emmanuel Grumbach | a42a184 | 2012-02-02 14:33:08 -0800 | [diff] [blame] | 1352 | out_pci_release_regions: |
| 1353 | pci_release_regions(pdev); |
| 1354 | out_pci_disable_device: |
| 1355 | pci_disable_device(pdev); |
| 1356 | out_no_pci: |
| 1357 | kfree(trans); |
| 1358 | return NULL; |
| 1359 | } |