Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 1 | /****************************************************************************** |
| 2 | * |
| 3 | * Copyright(c) 2003 - 2007 Intel Corporation. All rights reserved. |
| 4 | * |
| 5 | * Portions of this file are derived from the ipw3945 project. |
| 6 | * |
| 7 | * This program is free software; you can redistribute it and/or modify it |
| 8 | * under the terms of version 2 of the GNU General Public License as |
| 9 | * published by the Free Software Foundation. |
| 10 | * |
| 11 | * This program is distributed in the hope that it will be useful, but WITHOUT |
| 12 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
| 13 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
| 14 | * more details. |
| 15 | * |
| 16 | * You should have received a copy of the GNU General Public License along with |
| 17 | * this program; if not, write to the Free Software Foundation, Inc., |
| 18 | * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA |
| 19 | * |
| 20 | * The full GNU General Public License is included in this distribution in the |
| 21 | * file called LICENSE. |
| 22 | * |
| 23 | * Contact Information: |
| 24 | * James P. Ketrenos <ipw2100-admin@linux.intel.com> |
| 25 | * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 |
| 26 | * |
| 27 | *****************************************************************************/ |
| 28 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 29 | #ifndef __iwl4965_io_h__ |
| 30 | #define __iwl4965_io_h__ |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 31 | |
| 32 | #include <linux/io.h> |
| 33 | |
Christoph Hellwig | 5d08cd1 | 2007-10-25 17:15:50 +0800 | [diff] [blame] | 34 | #include "iwl-4965-debug.h" |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 35 | |
| 36 | /* |
| 37 | * IO, register, and NIC memory access functions |
| 38 | * |
| 39 | * NOTE on naming convention and macro usage for these |
| 40 | * |
| 41 | * A single _ prefix before a an access function means that no state |
| 42 | * check or debug information is printed when that function is called. |
| 43 | * |
| 44 | * A double __ prefix before an access function means that state is checked |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 45 | * and the current line number is printed in addition to any other debug output. |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 46 | * |
| 47 | * The non-prefixed name is the #define that maps the caller into a |
| 48 | * #define that provides the caller's __LINE__ to the double prefix version. |
| 49 | * |
| 50 | * If you wish to call the function without any debug or state checking, |
| 51 | * you should use the single _ prefix version (as is used by dependent IO |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 52 | * routines, for example _iwl4965_read_direct32 calls the non-check version of |
| 53 | * _iwl4965_read32.) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 54 | * |
| 55 | * These declarations are *extremely* useful in quickly isolating code deltas |
| 56 | * which result in misconfiguring of the hardware I/O. In combination with |
| 57 | * git-bisect and the IO debug level you can quickly determine the specific |
| 58 | * commit which breaks the IO sequence to the hardware. |
| 59 | * |
| 60 | */ |
| 61 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 62 | #define _iwl4965_write32(iwl, ofs, val) writel((val), (iwl)->hw_base + (ofs)) |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 63 | #ifdef CONFIG_IWL4965_DEBUG |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 64 | static inline void __iwl4965_write32(const char *f, u32 l, struct iwl4965_priv *iwl, |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 65 | u32 ofs, u32 val) |
| 66 | { |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 67 | IWL_DEBUG_IO("write32(0x%08X, 0x%08X) - %s %d\n", ofs, val, f, l); |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 68 | _iwl4965_write32(iwl, ofs, val); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 69 | } |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 70 | #define iwl4965_write32(iwl, ofs, val) \ |
| 71 | __iwl4965_write32(__FILE__, __LINE__, iwl, ofs, val) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 72 | #else |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 73 | #define iwl4965_write32(iwl, ofs, val) _iwl4965_write32(iwl, ofs, val) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 74 | #endif |
| 75 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 76 | #define _iwl4965_read32(iwl, ofs) readl((iwl)->hw_base + (ofs)) |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 77 | #ifdef CONFIG_IWL4965_DEBUG |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 78 | static inline u32 __iwl4965_read32(char *f, u32 l, struct iwl4965_priv *iwl, u32 ofs) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 79 | { |
| 80 | IWL_DEBUG_IO("read_direct32(0x%08X) - %s %d\n", ofs, f, l); |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 81 | return _iwl4965_read32(iwl, ofs); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 82 | } |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 83 | #define iwl4965_read32(iwl, ofs) __iwl4965_read32(__FILE__, __LINE__, iwl, ofs) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 84 | #else |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 85 | #define iwl4965_read32(p, o) _iwl4965_read32(p, o) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 86 | #endif |
| 87 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 88 | static inline int _iwl4965_poll_bit(struct iwl4965_priv *priv, u32 addr, |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 89 | u32 bits, u32 mask, int timeout) |
| 90 | { |
| 91 | int i = 0; |
| 92 | |
| 93 | do { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 94 | if ((_iwl4965_read32(priv, addr) & mask) == (bits & mask)) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 95 | return i; |
| 96 | mdelay(10); |
| 97 | i += 10; |
| 98 | } while (i < timeout); |
| 99 | |
| 100 | return -ETIMEDOUT; |
| 101 | } |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 102 | #ifdef CONFIG_IWL4965_DEBUG |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 103 | static inline int __iwl4965_poll_bit(const char *f, u32 l, |
| 104 | struct iwl4965_priv *priv, u32 addr, |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 105 | u32 bits, u32 mask, int timeout) |
| 106 | { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 107 | int ret = _iwl4965_poll_bit(priv, addr, bits, mask, timeout); |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 108 | if (unlikely(ret == -ETIMEDOUT)) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 109 | IWL_DEBUG_IO |
| 110 | ("poll_bit(0x%08X, 0x%08X, 0x%08X) - timedout - %s %d\n", |
| 111 | addr, bits, mask, f, l); |
| 112 | else |
| 113 | IWL_DEBUG_IO |
| 114 | ("poll_bit(0x%08X, 0x%08X, 0x%08X) = 0x%08X - %s %d\n", |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 115 | addr, bits, mask, ret, f, l); |
| 116 | return ret; |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 117 | } |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 118 | #define iwl4965_poll_bit(iwl, addr, bits, mask, timeout) \ |
| 119 | __iwl4965_poll_bit(__FILE__, __LINE__, iwl, addr, bits, mask, timeout) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 120 | #else |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 121 | #define iwl4965_poll_bit(p, a, b, m, t) _iwl4965_poll_bit(p, a, b, m, t) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 122 | #endif |
| 123 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 124 | static inline void _iwl4965_set_bit(struct iwl4965_priv *priv, u32 reg, u32 mask) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 125 | { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 126 | _iwl4965_write32(priv, reg, _iwl4965_read32(priv, reg) | mask); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 127 | } |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 128 | #ifdef CONFIG_IWL4965_DEBUG |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 129 | static inline void __iwl4965_set_bit(const char *f, u32 l, |
| 130 | struct iwl4965_priv *priv, u32 reg, u32 mask) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 131 | { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 132 | u32 val = _iwl4965_read32(priv, reg) | mask; |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 133 | IWL_DEBUG_IO("set_bit(0x%08X, 0x%08X) = 0x%08X\n", reg, mask, val); |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 134 | _iwl4965_write32(priv, reg, val); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 135 | } |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 136 | #define iwl4965_set_bit(p, r, m) __iwl4965_set_bit(__FILE__, __LINE__, p, r, m) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 137 | #else |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 138 | #define iwl4965_set_bit(p, r, m) _iwl4965_set_bit(p, r, m) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 139 | #endif |
| 140 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 141 | static inline void _iwl4965_clear_bit(struct iwl4965_priv *priv, u32 reg, u32 mask) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 142 | { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 143 | _iwl4965_write32(priv, reg, _iwl4965_read32(priv, reg) & ~mask); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 144 | } |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 145 | #ifdef CONFIG_IWL4965_DEBUG |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 146 | static inline void __iwl4965_clear_bit(const char *f, u32 l, |
| 147 | struct iwl4965_priv *priv, u32 reg, u32 mask) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 148 | { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 149 | u32 val = _iwl4965_read32(priv, reg) & ~mask; |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 150 | IWL_DEBUG_IO("clear_bit(0x%08X, 0x%08X) = 0x%08X\n", reg, mask, val); |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 151 | _iwl4965_write32(priv, reg, val); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 152 | } |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 153 | #define iwl4965_clear_bit(p, r, m) __iwl4965_clear_bit(__FILE__, __LINE__, p, r, m) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 154 | #else |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 155 | #define iwl4965_clear_bit(p, r, m) _iwl4965_clear_bit(p, r, m) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 156 | #endif |
| 157 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 158 | static inline int _iwl4965_grab_nic_access(struct iwl4965_priv *priv) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 159 | { |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 160 | int ret; |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 161 | u32 gp_ctl; |
| 162 | |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 163 | #ifdef CONFIG_IWL4965_DEBUG |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 164 | if (atomic_read(&priv->restrict_refcnt)) |
| 165 | return 0; |
| 166 | #endif |
| 167 | if (test_bit(STATUS_RF_KILL_HW, &priv->status) || |
| 168 | test_bit(STATUS_RF_KILL_SW, &priv->status)) { |
| 169 | IWL_WARNING("WARNING: Requesting MAC access during RFKILL " |
| 170 | "wakes up NIC\n"); |
| 171 | |
| 172 | /* 10 msec allows time for NIC to complete its data save */ |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 173 | gp_ctl = _iwl4965_read32(priv, CSR_GP_CNTRL); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 174 | if (gp_ctl & CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY) { |
| 175 | IWL_DEBUG_RF_KILL("Wait for complete power-down, " |
| 176 | "gpctl = 0x%08x\n", gp_ctl); |
| 177 | mdelay(10); |
| 178 | } else |
| 179 | IWL_DEBUG_RF_KILL("power-down complete, " |
| 180 | "gpctl = 0x%08x\n", gp_ctl); |
| 181 | } |
| 182 | |
| 183 | /* this bit wakes up the NIC */ |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 184 | _iwl4965_set_bit(priv, CSR_GP_CNTRL, CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ); |
| 185 | ret = _iwl4965_poll_bit(priv, CSR_GP_CNTRL, |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 186 | CSR_GP_CNTRL_REG_VAL_MAC_ACCESS_EN, |
| 187 | (CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY | |
| 188 | CSR_GP_CNTRL_REG_FLAG_GOING_TO_SLEEP), 50); |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 189 | if (ret < 0) { |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 190 | IWL_ERROR("MAC is in deep sleep!\n"); |
| 191 | return -EIO; |
| 192 | } |
| 193 | |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 194 | #ifdef CONFIG_IWL4965_DEBUG |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 195 | atomic_inc(&priv->restrict_refcnt); |
| 196 | #endif |
| 197 | return 0; |
| 198 | } |
| 199 | |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 200 | #ifdef CONFIG_IWL4965_DEBUG |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 201 | static inline int __iwl4965_grab_nic_access(const char *f, u32 l, |
| 202 | struct iwl4965_priv *priv) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 203 | { |
| 204 | if (atomic_read(&priv->restrict_refcnt)) |
| 205 | IWL_DEBUG_INFO("Grabbing access while already held at " |
| 206 | "line %d.\n", l); |
| 207 | |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 208 | IWL_DEBUG_IO("grabbing nic access - %s %d\n", f, l); |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 209 | return _iwl4965_grab_nic_access(priv); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 210 | } |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 211 | #define iwl4965_grab_nic_access(priv) \ |
| 212 | __iwl4965_grab_nic_access(__FILE__, __LINE__, priv) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 213 | #else |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 214 | #define iwl4965_grab_nic_access(priv) \ |
| 215 | _iwl4965_grab_nic_access(priv) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 216 | #endif |
| 217 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 218 | static inline void _iwl4965_release_nic_access(struct iwl4965_priv *priv) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 219 | { |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 220 | #ifdef CONFIG_IWL4965_DEBUG |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 221 | if (atomic_dec_and_test(&priv->restrict_refcnt)) |
| 222 | #endif |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 223 | _iwl4965_clear_bit(priv, CSR_GP_CNTRL, |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 224 | CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ); |
| 225 | } |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 226 | #ifdef CONFIG_IWL4965_DEBUG |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 227 | static inline void __iwl4965_release_nic_access(const char *f, u32 l, |
| 228 | struct iwl4965_priv *priv) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 229 | { |
| 230 | if (atomic_read(&priv->restrict_refcnt) <= 0) |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 231 | IWL_ERROR("Release unheld nic access at line %d.\n", l); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 232 | |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 233 | IWL_DEBUG_IO("releasing nic access - %s %d\n", f, l); |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 234 | _iwl4965_release_nic_access(priv); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 235 | } |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 236 | #define iwl4965_release_nic_access(priv) \ |
| 237 | __iwl4965_release_nic_access(__FILE__, __LINE__, priv) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 238 | #else |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 239 | #define iwl4965_release_nic_access(priv) \ |
| 240 | _iwl4965_release_nic_access(priv) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 241 | #endif |
| 242 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 243 | static inline u32 _iwl4965_read_direct32(struct iwl4965_priv *priv, u32 reg) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 244 | { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 245 | return _iwl4965_read32(priv, reg); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 246 | } |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 247 | #ifdef CONFIG_IWL4965_DEBUG |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 248 | static inline u32 __iwl4965_read_direct32(const char *f, u32 l, |
| 249 | struct iwl4965_priv *priv, u32 reg) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 250 | { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 251 | u32 value = _iwl4965_read_direct32(priv, reg); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 252 | if (!atomic_read(&priv->restrict_refcnt)) |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 253 | IWL_ERROR("Nic access not held from %s %d\n", f, l); |
| 254 | IWL_DEBUG_IO("read_direct32(0x%4X) = 0x%08x - %s %d \n", reg, value, |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 255 | f, l); |
| 256 | return value; |
| 257 | } |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 258 | #define iwl4965_read_direct32(priv, reg) \ |
| 259 | __iwl4965_read_direct32(__FILE__, __LINE__, priv, reg) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 260 | #else |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 261 | #define iwl4965_read_direct32 _iwl4965_read_direct32 |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 262 | #endif |
| 263 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 264 | static inline void _iwl4965_write_direct32(struct iwl4965_priv *priv, |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 265 | u32 reg, u32 value) |
| 266 | { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 267 | _iwl4965_write32(priv, reg, value); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 268 | } |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 269 | #ifdef CONFIG_IWL4965_DEBUG |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 270 | static void __iwl4965_write_direct32(u32 line, |
| 271 | struct iwl4965_priv *priv, u32 reg, u32 value) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 272 | { |
| 273 | if (!atomic_read(&priv->restrict_refcnt)) |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 274 | IWL_ERROR("Nic access not held from line %d\n", line); |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 275 | _iwl4965_write_direct32(priv, reg, value); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 276 | } |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 277 | #define iwl4965_write_direct32(priv, reg, value) \ |
| 278 | __iwl4965_write_direct32(__LINE__, priv, reg, value) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 279 | #else |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 280 | #define iwl4965_write_direct32 _iwl4965_write_direct32 |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 281 | #endif |
| 282 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 283 | static inline void iwl4965_write_reg_buf(struct iwl4965_priv *priv, |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 284 | u32 reg, u32 len, u32 *values) |
| 285 | { |
| 286 | u32 count = sizeof(u32); |
| 287 | |
| 288 | if ((priv != NULL) && (values != NULL)) { |
| 289 | for (; 0 < len; len -= count, reg += count, values++) |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 290 | _iwl4965_write_direct32(priv, reg, *values); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 291 | } |
| 292 | } |
| 293 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 294 | static inline int _iwl4965_poll_direct_bit(struct iwl4965_priv *priv, |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 295 | u32 addr, u32 mask, int timeout) |
| 296 | { |
| 297 | int i = 0; |
| 298 | |
| 299 | do { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 300 | if ((_iwl4965_read_direct32(priv, addr) & mask) == mask) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 301 | return i; |
| 302 | mdelay(10); |
| 303 | i += 10; |
| 304 | } while (i < timeout); |
| 305 | |
| 306 | return -ETIMEDOUT; |
| 307 | } |
| 308 | |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 309 | #ifdef CONFIG_IWL4965_DEBUG |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 310 | static inline int __iwl4965_poll_direct_bit(const char *f, u32 l, |
| 311 | struct iwl4965_priv *priv, |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 312 | u32 addr, u32 mask, int timeout) |
| 313 | { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 314 | int ret = _iwl4965_poll_direct_bit(priv, addr, mask, timeout); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 315 | |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 316 | if (unlikely(ret == -ETIMEDOUT)) |
| 317 | IWL_DEBUG_IO("poll_direct_bit(0x%08X, 0x%08X) - " |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 318 | "timedout - %s %d\n", addr, mask, f, l); |
| 319 | else |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 320 | IWL_DEBUG_IO("poll_direct_bit(0x%08X, 0x%08X) = 0x%08X " |
| 321 | "- %s %d\n", addr, mask, ret, f, l); |
| 322 | return ret; |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 323 | } |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 324 | #define iwl4965_poll_direct_bit(iwl, addr, mask, timeout) \ |
| 325 | __iwl4965_poll_direct_bit(__FILE__, __LINE__, iwl, addr, mask, timeout) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 326 | #else |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 327 | #define iwl4965_poll_direct_bit _iwl4965_poll_direct_bit |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 328 | #endif |
| 329 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 330 | static inline u32 _iwl4965_read_prph(struct iwl4965_priv *priv, u32 reg) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 331 | { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 332 | _iwl4965_write_direct32(priv, HBUS_TARG_PRPH_RADDR, reg | (3 << 24)); |
| 333 | return _iwl4965_read_direct32(priv, HBUS_TARG_PRPH_RDAT); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 334 | } |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 335 | #ifdef CONFIG_IWL4965_DEBUG |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 336 | static inline u32 __iwl4965_read_prph(u32 line, struct iwl4965_priv *priv, u32 reg) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 337 | { |
| 338 | if (!atomic_read(&priv->restrict_refcnt)) |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 339 | IWL_ERROR("Nic access not held from line %d\n", line); |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 340 | return _iwl4965_read_prph(priv, reg); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 341 | } |
| 342 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 343 | #define iwl4965_read_prph(priv, reg) \ |
| 344 | __iwl4965_read_prph(__LINE__, priv, reg) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 345 | #else |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 346 | #define iwl4965_read_prph _iwl4965_read_prph |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 347 | #endif |
| 348 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 349 | static inline void _iwl4965_write_prph(struct iwl4965_priv *priv, |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 350 | u32 addr, u32 val) |
| 351 | { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 352 | _iwl4965_write_direct32(priv, HBUS_TARG_PRPH_WADDR, |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 353 | ((addr & 0x0000FFFF) | (3 << 24))); |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 354 | _iwl4965_write_direct32(priv, HBUS_TARG_PRPH_WDAT, val); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 355 | } |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 356 | #ifdef CONFIG_IWL4965_DEBUG |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 357 | static inline void __iwl4965_write_prph(u32 line, struct iwl4965_priv *priv, |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 358 | u32 addr, u32 val) |
| 359 | { |
| 360 | if (!atomic_read(&priv->restrict_refcnt)) |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 361 | IWL_ERROR("Nic access from line %d\n", line); |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 362 | _iwl4965_write_prph(priv, addr, val); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 363 | } |
| 364 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 365 | #define iwl4965_write_prph(priv, addr, val) \ |
| 366 | __iwl4965_write_prph(__LINE__, priv, addr, val); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 367 | #else |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 368 | #define iwl4965_write_prph _iwl4965_write_prph |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 369 | #endif |
| 370 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 371 | #define _iwl4965_set_bits_prph(priv, reg, mask) \ |
| 372 | _iwl4965_write_prph(priv, reg, (_iwl4965_read_prph(priv, reg) | mask)) |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 373 | #ifdef CONFIG_IWL4965_DEBUG |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 374 | static inline void __iwl4965_set_bits_prph(u32 line, struct iwl4965_priv *priv, |
Tomas Winkler | d860965 | 2007-10-25 17:15:35 +0800 | [diff] [blame] | 375 | u32 reg, u32 mask) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 376 | { |
| 377 | if (!atomic_read(&priv->restrict_refcnt)) |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 378 | IWL_ERROR("Nic access not held from line %d\n", line); |
| 379 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 380 | _iwl4965_set_bits_prph(priv, reg, mask); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 381 | } |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 382 | #define iwl4965_set_bits_prph(priv, reg, mask) \ |
| 383 | __iwl4965_set_bits_prph(__LINE__, priv, reg, mask) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 384 | #else |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 385 | #define iwl4965_set_bits_prph _iwl4965_set_bits_prph |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 386 | #endif |
| 387 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 388 | #define _iwl4965_set_bits_mask_prph(priv, reg, bits, mask) \ |
| 389 | _iwl4965_write_prph(priv, reg, ((_iwl4965_read_prph(priv, reg) & mask) | bits)) |
Tomas Winkler | d860965 | 2007-10-25 17:15:35 +0800 | [diff] [blame] | 390 | |
Christoph Hellwig | c8b0e6e | 2007-10-25 17:15:51 +0800 | [diff] [blame] | 391 | #ifdef CONFIG_IWL4965_DEBUG |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 392 | static inline void __iwl4965_set_bits_mask_prph(u32 line, |
| 393 | struct iwl4965_priv *priv, u32 reg, u32 bits, u32 mask) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 394 | { |
| 395 | if (!atomic_read(&priv->restrict_refcnt)) |
Tomas Winkler | ac17a94 | 2007-10-25 17:15:37 +0800 | [diff] [blame] | 396 | IWL_ERROR("Nic access not held from line %d\n", line); |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 397 | _iwl4965_set_bits_mask_prph(priv, reg, bits, mask); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 398 | } |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 399 | #define iwl4965_set_bits_mask_prph(priv, reg, bits, mask) \ |
| 400 | __iwl4965_set_bits_mask_prph(__LINE__, priv, reg, bits, mask) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 401 | #else |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 402 | #define iwl4965_set_bits_mask_prph _iwl4965_set_bits_mask_prph |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 403 | #endif |
| 404 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 405 | static inline void iwl4965_clear_bits_prph(struct iwl4965_priv |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 406 | *priv, u32 reg, u32 mask) |
| 407 | { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 408 | u32 val = _iwl4965_read_prph(priv, reg); |
| 409 | _iwl4965_write_prph(priv, reg, (val & ~mask)); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 410 | } |
| 411 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 412 | static inline u32 iwl4965_read_targ_mem(struct iwl4965_priv *priv, u32 addr) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 413 | { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 414 | iwl4965_write_direct32(priv, HBUS_TARG_MEM_RADDR, addr); |
| 415 | return iwl4965_read_direct32(priv, HBUS_TARG_MEM_RDAT); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 416 | } |
| 417 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 418 | static inline void iwl4965_write_targ_mem(struct iwl4965_priv *priv, u32 addr, u32 val) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 419 | { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 420 | iwl4965_write_direct32(priv, HBUS_TARG_MEM_WADDR, addr); |
| 421 | iwl4965_write_direct32(priv, HBUS_TARG_MEM_WDAT, val); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 422 | } |
| 423 | |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 424 | static inline void iwl4965_write_targ_mem_buf(struct iwl4965_priv *priv, u32 addr, |
Tomas Winkler | af7cca2 | 2007-10-25 17:15:36 +0800 | [diff] [blame] | 425 | u32 len, u32 *values) |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 426 | { |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 427 | iwl4965_write_direct32(priv, HBUS_TARG_MEM_WADDR, addr); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 428 | for (; 0 < len; len -= sizeof(u32), values++) |
Christoph Hellwig | bb8c093 | 2008-01-27 16:41:47 -0800 | [diff] [blame] | 429 | iwl4965_write_direct32(priv, HBUS_TARG_MEM_WDAT, *values); |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 430 | } |
Zhu Yi | b481de9 | 2007-09-25 17:54:57 -0700 | [diff] [blame] | 431 | #endif |