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

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2003 - 2013 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-drv.h"
  33 #include "iwl-io.h"
  34 #include "iwl-csr.h"
  35 #include "iwl-debug.h"
  36
  37 #define IWL_POLL_INTERVAL 10    /* microseconds */
  38
  39 int iwl_poll_bit(struct iwl_trans *trans, u32 addr,
  40                  u32 bits, u32 mask, int timeout)
  41 {
  42         int t = 0;
  43
  44         do {
  45                 if ((iwl_read32(trans, addr) & mask) == (bits & mask))
  46                         return t;
  47                 udelay(IWL_POLL_INTERVAL);
  48                 t += IWL_POLL_INTERVAL;
  49         } while (t < timeout);
  50
  51         return -ETIMEDOUT;
  52 }
  53 IWL_EXPORT_SYMBOL(iwl_poll_bit);
  54
  55 u32 iwl_read_direct32(struct iwl_trans *trans, u32 reg)
  56 {
  57         u32 value = 0x5a5a5a5a;
  58         unsigned long flags;
  59         if (iwl_trans_grab_nic_access(trans, false, &flags)) {
  60                 value = iwl_read32(trans, reg);
  61                 iwl_trans_release_nic_access(trans, &flags);
  62         }
  63
  64         return value;
  65 }
  66 IWL_EXPORT_SYMBOL(iwl_read_direct32);
  67
  68 void iwl_write_direct32(struct iwl_trans *trans, u32 reg, u32 value)
  69 {
  70         unsigned long flags;
  71
  72         if (iwl_trans_grab_nic_access(trans, false, &flags)) {
  73                 iwl_write32(trans, reg, value);
  74                 iwl_trans_release_nic_access(trans, &flags);
  75         }
  76 }
  77 IWL_EXPORT_SYMBOL(iwl_write_direct32);
  78
  79 int iwl_poll_direct_bit(struct iwl_trans *trans, u32 addr, u32 mask,
  80                         int timeout)
  81 {
  82         int t = 0;
  83
  84         do {
  85                 if ((iwl_read_direct32(trans, addr) & mask) == mask)
  86                         return t;
  87                 udelay(IWL_POLL_INTERVAL);
  88                 t += IWL_POLL_INTERVAL;
  89         } while (t < timeout);
  90
  91         return -ETIMEDOUT;
  92 }
  93 IWL_EXPORT_SYMBOL(iwl_poll_direct_bit);
  94
  95 static inline u32 __iwl_read_prph(struct iwl_trans *trans, u32 ofs)
  96 {
  97         u32 val = iwl_trans_read_prph(trans, ofs);
  98         trace_iwlwifi_dev_ioread_prph32(trans->dev, ofs, val);
  99         return val;
 100 }
 101
 102 static inline void __iwl_write_prph(struct iwl_trans *trans, u32 ofs, u32 val)
 103 {
 104         trace_iwlwifi_dev_iowrite_prph32(trans->dev, ofs, val);
 105         iwl_trans_write_prph(trans, ofs, val);
 106 }
 107
 108 u32 iwl_read_prph(struct iwl_trans *trans, u32 ofs)
 109 {
 110         unsigned long flags;
 111         u32 val = 0x5a5a5a5a;
 112
 113         if (iwl_trans_grab_nic_access(trans, false, &flags)) {
 114                 val = __iwl_read_prph(trans, ofs);
 115                 iwl_trans_release_nic_access(trans, &flags);
 116         }
 117         return val;
 118 }
 119 IWL_EXPORT_SYMBOL(iwl_read_prph);
 120
 121 void iwl_write_prph(struct iwl_trans *trans, u32 ofs, u32 val)
 122 {
 123         unsigned long flags;
 124
 125         if (iwl_trans_grab_nic_access(trans, false, &flags)) {
 126                 __iwl_write_prph(trans, ofs, val);
 127                 iwl_trans_release_nic_access(trans, &flags);
 128         }
 129 }
 130 IWL_EXPORT_SYMBOL(iwl_write_prph);
 131
 132 void iwl_set_bits_prph(struct iwl_trans *trans, u32 ofs, u32 mask)
 133 {
 134         unsigned long flags;
 135
 136         if (iwl_trans_grab_nic_access(trans, false, &flags)) {
 137                 __iwl_write_prph(trans, ofs,
 138                                  __iwl_read_prph(trans, ofs) | mask);
 139                 iwl_trans_release_nic_access(trans, &flags);
 140         }
 141 }
 142 IWL_EXPORT_SYMBOL(iwl_set_bits_prph);
 143
 144 void iwl_set_bits_mask_prph(struct iwl_trans *trans, u32 ofs,
 145                             u32 bits, u32 mask)
 146 {
 147         unsigned long flags;
 148
 149         if (iwl_trans_grab_nic_access(trans, false, &flags)) {
 150                 __iwl_write_prph(trans, ofs,
 151                                  (__iwl_read_prph(trans, ofs) & mask) | bits);
 152                 iwl_trans_release_nic_access(trans, &flags);
 153         }
 154 }
 155 IWL_EXPORT_SYMBOL(iwl_set_bits_mask_prph);
 156
 157 void iwl_clear_bits_prph(struct iwl_trans *trans, u32 ofs, u32 mask)
 158 {
 159         unsigned long flags;
 160         u32 val;
 161
 162         if (iwl_trans_grab_nic_access(trans, false, &flags)) {
 163                 val = __iwl_read_prph(trans, ofs);
 164                 __iwl_write_prph(trans, ofs, (val & ~mask));
 165                 iwl_trans_release_nic_access(trans, &flags);
 166         }
 167 }
 168 IWL_EXPORT_SYMBOL(iwl_clear_bits_prph);