drivers/net/wireless/iwlwifi/iwl-io.c

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2003 - 2012 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  *  Intel Linux Wireless <ilw@linux.intel.com>
  25  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  26  *
  27  *****************************************************************************/
  28 #include <linux/delay.h>
  29 #include <linux/device.h>
  30 #include <linux/export.h>
  31
  32 #include "iwl-io.h"
  33 #include "iwl-csr.h"
  34 #include "iwl-debug.h"
  35
  36 #define IWL_POLL_INTERVAL 10    /* microseconds */
  37
  38 void __iwl_set_bit(struct iwl_trans *trans, u32 reg, u32 mask)
  39 {
  40         iwl_write32(trans, reg, iwl_read32(trans, reg) | mask);
  41 }
  42
  43 void __iwl_clear_bit(struct iwl_trans *trans, u32 reg, u32 mask)
  44 {
  45         iwl_write32(trans, reg, iwl_read32(trans, reg) & ~mask);
  46 }
  47
  48 void iwl_set_bit(struct iwl_trans *trans, u32 reg, u32 mask)
  49 {
  50         unsigned long flags;
  51
  52         spin_lock_irqsave(&trans->reg_lock, flags);
  53         __iwl_set_bit(trans, reg, mask);
  54         spin_unlock_irqrestore(&trans->reg_lock, flags);
  55 }
  56 EXPORT_SYMBOL_GPL(iwl_set_bit);
  57
  58 void iwl_clear_bit(struct iwl_trans *trans, u32 reg, u32 mask)
  59 {
  60         unsigned long flags;
  61
  62         spin_lock_irqsave(&trans->reg_lock, flags);
  63         __iwl_clear_bit(trans, reg, mask);
  64         spin_unlock_irqrestore(&trans->reg_lock, flags);
  65 }
  66 EXPORT_SYMBOL_GPL(iwl_clear_bit);
  67
  68 void iwl_set_bits_mask(struct iwl_trans *trans, u32 reg, u32 mask, u32 value)
  69 {
  70         unsigned long flags;
  71         u32 v;
  72
  73 #ifdef CONFIG_IWLWIFI_DEBUG
  74         WARN_ON_ONCE(value & ~mask);
  75 #endif
  76
  77         spin_lock_irqsave(&trans->reg_lock, flags);
  78         v = iwl_read32(trans, reg);
  79         v &= ~mask;
  80         v |= value;
  81         iwl_write32(trans, reg, v);
  82         spin_unlock_irqrestore(&trans->reg_lock, flags);
  83 }
  84 EXPORT_SYMBOL_GPL(iwl_set_bits_mask);
  85
  86 int iwl_poll_bit(struct iwl_trans *trans, u32 addr,
  87                  u32 bits, u32 mask, int timeout)
  88 {
  89         int t = 0;
  90
  91         do {
  92                 if ((iwl_read32(trans, addr) & mask) == (bits & mask))
  93                         return t;
  94                 udelay(IWL_POLL_INTERVAL);
  95                 t += IWL_POLL_INTERVAL;
  96         } while (t < timeout);
  97
  98         return -ETIMEDOUT;
  99 }
 100 EXPORT_SYMBOL_GPL(iwl_poll_bit);
 101
 102 u32 iwl_read_direct32(struct iwl_trans *trans, u32 reg)
 103 {
 104         u32 value;
 105         unsigned long flags;
 106
 107         spin_lock_irqsave(&trans->reg_lock, flags);
 108         iwl_trans_grab_nic_access(trans, false);
 109         value = iwl_read32(trans, reg);
 110         iwl_trans_release_nic_access(trans);
 111         spin_unlock_irqrestore(&trans->reg_lock, flags);
 112
 113         return value;
 114 }
 115 EXPORT_SYMBOL_GPL(iwl_read_direct32);
 116
 117 void iwl_write_direct32(struct iwl_trans *trans, u32 reg, u32 value)
 118 {
 119         unsigned long flags;
 120
 121         spin_lock_irqsave(&trans->reg_lock, flags);
 122         if (likely(iwl_trans_grab_nic_access(trans, false))) {
 123                 iwl_write32(trans, reg, value);
 124                 iwl_trans_release_nic_access(trans);
 125         }
 126         spin_unlock_irqrestore(&trans->reg_lock, flags);
 127 }
 128 EXPORT_SYMBOL_GPL(iwl_write_direct32);
 129
 130 int iwl_poll_direct_bit(struct iwl_trans *trans, u32 addr, u32 mask,
 131                         int timeout)
 132 {
 133         int t = 0;
 134
 135         do {
 136                 if ((iwl_read_direct32(trans, addr) & mask) == mask)
 137                         return t;
 138                 udelay(IWL_POLL_INTERVAL);
 139                 t += IWL_POLL_INTERVAL;
 140         } while (t < timeout);
 141
 142         return -ETIMEDOUT;
 143 }
 144 EXPORT_SYMBOL_GPL(iwl_poll_direct_bit);
 145
 146 static inline u32 __iwl_read_prph(struct iwl_trans *trans, u32 ofs)
 147 {
 148         u32 val = iwl_trans_read_prph(trans, ofs);
 149         trace_iwlwifi_dev_ioread_prph32(trans->dev, ofs, val);
 150         return val;
 151 }
 152
 153 static inline void __iwl_write_prph(struct iwl_trans *trans, u32 ofs, u32 val)
 154 {
 155         trace_iwlwifi_dev_iowrite_prph32(trans->dev, ofs, val);
 156         iwl_trans_write_prph(trans, ofs, val);
 157 }
 158
 159 u32 iwl_read_prph(struct iwl_trans *trans, u32 ofs)
 160 {
 161         unsigned long flags;
 162         u32 val;
 163
 164         spin_lock_irqsave(&trans->reg_lock, flags);
 165         iwl_trans_grab_nic_access(trans, false);
 166         val = __iwl_read_prph(trans, ofs);
 167         iwl_trans_release_nic_access(trans);
 168         spin_unlock_irqrestore(&trans->reg_lock, flags);
 169         return val;
 170 }
 171 EXPORT_SYMBOL_GPL(iwl_read_prph);
 172
 173 void iwl_write_prph(struct iwl_trans *trans, u32 ofs, u32 val)
 174 {
 175         unsigned long flags;
 176
 177         spin_lock_irqsave(&trans->reg_lock, flags);
 178         if (likely(iwl_trans_grab_nic_access(trans, false))) {
 179                 __iwl_write_prph(trans, ofs, val);
 180                 iwl_trans_release_nic_access(trans);
 181         }
 182         spin_unlock_irqrestore(&trans->reg_lock, flags);
 183 }
 184 EXPORT_SYMBOL_GPL(iwl_write_prph);
 185
 186 void iwl_set_bits_prph(struct iwl_trans *trans, u32 ofs, u32 mask)
 187 {
 188         unsigned long flags;
 189
 190         spin_lock_irqsave(&trans->reg_lock, flags);
 191         if (likely(iwl_trans_grab_nic_access(trans, false))) {
 192                 __iwl_write_prph(trans, ofs,
 193                                  __iwl_read_prph(trans, ofs) | mask);
 194                 iwl_trans_release_nic_access(trans);
 195         }
 196         spin_unlock_irqrestore(&trans->reg_lock, flags);
 197 }
 198 EXPORT_SYMBOL_GPL(iwl_set_bits_prph);
 199
 200 void iwl_set_bits_mask_prph(struct iwl_trans *trans, u32 ofs,
 201                             u32 bits, u32 mask)
 202 {
 203         unsigned long flags;
 204
 205         spin_lock_irqsave(&trans->reg_lock, flags);
 206         if (likely(iwl_trans_grab_nic_access(trans, false))) {
 207                 __iwl_write_prph(trans, ofs,
 208                                  (__iwl_read_prph(trans, ofs) & mask) | bits);
 209                 iwl_trans_release_nic_access(trans);
 210         }
 211         spin_unlock_irqrestore(&trans->reg_lock, flags);
 212 }
 213 EXPORT_SYMBOL_GPL(iwl_set_bits_mask_prph);
 214
 215 void iwl_clear_bits_prph(struct iwl_trans *trans, u32 ofs, u32 mask)
 216 {
 217         unsigned long flags;
 218         u32 val;
 219
 220         spin_lock_irqsave(&trans->reg_lock, flags);
 221         if (likely(iwl_trans_grab_nic_access(trans, false))) {
 222                 val = __iwl_read_prph(trans, ofs);
 223                 __iwl_write_prph(trans, ofs, (val & ~mask));
 224                 iwl_trans_release_nic_access(trans);
 225         }
 226         spin_unlock_irqrestore(&trans->reg_lock, flags);
 227 }
 228 EXPORT_SYMBOL_GPL(iwl_clear_bits_prph);
 229
 230 void _iwl_read_targ_mem_dwords(struct iwl_trans *trans, u32 addr,
 231                                void *buf, int dwords)
 232 {
 233         unsigned long flags;
 234         int offs;
 235         u32 *vals = buf;
 236
 237         spin_lock_irqsave(&trans->reg_lock, flags);
 238         if (likely(iwl_trans_grab_nic_access(trans, false))) {
 239                 iwl_write32(trans, HBUS_TARG_MEM_RADDR, addr);
 240                 for (offs = 0; offs < dwords; offs++)
 241                         vals[offs] = iwl_read32(trans, HBUS_TARG_MEM_RDAT);
 242                 iwl_trans_release_nic_access(trans);
 243         }
 244         spin_unlock_irqrestore(&trans->reg_lock, flags);
 245 }
 246 EXPORT_SYMBOL_GPL(_iwl_read_targ_mem_dwords);
 247
 248 u32 iwl_read_targ_mem(struct iwl_trans *trans, u32 addr)
 249 {
 250         u32 value;
 251
 252         _iwl_read_targ_mem_dwords(trans, addr, &value, 1);
 253
 254         return value;
 255 }
 256 EXPORT_SYMBOL_GPL(iwl_read_targ_mem);
 257
 258 int _iwl_write_targ_mem_dwords(struct iwl_trans *trans, u32 addr,
 259                                const void *buf, int dwords)
 260 {
 261         unsigned long flags;
 262         int offs, result = 0;
 263         const u32 *vals = buf;
 264
 265         spin_lock_irqsave(&trans->reg_lock, flags);
 266         if (likely(iwl_trans_grab_nic_access(trans, false))) {
 267                 iwl_write32(trans, HBUS_TARG_MEM_WADDR, addr);
 268                 for (offs = 0; offs < dwords; offs++)
 269                         iwl_write32(trans, HBUS_TARG_MEM_WDAT, vals[offs]);
 270                 iwl_trans_release_nic_access(trans);
 271         } else {
 272                 result = -EBUSY;
 273         }
 274         spin_unlock_irqrestore(&trans->reg_lock, flags);
 275
 276         return result;
 277 }
 278 EXPORT_SYMBOL_GPL(_iwl_write_targ_mem_dwords);
 279
 280 int iwl_write_targ_mem(struct iwl_trans *trans, u32 addr, u32 val)
 281 {
 282         return _iwl_write_targ_mem_dwords(trans, addr, &val, 1);
 283 }
 284 EXPORT_SYMBOL_GPL(iwl_write_targ_mem);