drivers/net/wireless/iwlwifi/iwl-helpers.h

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2003 - 2011 Intel Corporation. All rights reserved.
   4  *
   5  * Portions of this file are derived from the ipw3945 project, as well
   6  * as portions of the ieee80211 subsystem header files.
   7  *
   8  * This program is free software; you can redistribute it and/or modify it
   9  * under the terms of version 2 of the GNU General Public License as
  10  * published by the Free Software Foundation.
  11  *
  12  * This program is distributed in the hope that it will be useful, but WITHOUT
  13  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  14  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  15  * more details.
  16  *
  17  * You should have received a copy of the GNU General Public License along with
  18  * this program; if not, write to the Free Software Foundation, Inc.,
  19  * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
  20  *
  21  * The full GNU General Public License is included in this distribution in the
  22  * file called LICENSE.
  23  *
  24  * Contact Information:
  25  *  Intel Linux Wireless <ilw@linux.intel.com>
  26  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  27  *
  28  *****************************************************************************/
  29
  30 #ifndef __iwl_helpers_h__
  31 #define __iwl_helpers_h__
  32
  33 #include <linux/ctype.h>
  34 #include <net/mac80211.h>
  35
  36 #include "iwl-io.h"
  37
  38 #define IWL_MASK(lo, hi) ((1 << (hi)) | ((1 << (hi)) - (1 << (lo))))
  39
  40
  41 static inline struct ieee80211_conf *ieee80211_get_hw_conf(
  42         struct ieee80211_hw *hw)
  43 {
  44         return &hw->conf;
  45 }
  46
  47 /**
  48  * iwl_queue_inc_wrap - increment queue index, wrap back to beginning
  49  * @index -- current index
  50  * @n_bd -- total number of entries in queue (must be power of 2)
  51  */
  52 static inline int iwl_queue_inc_wrap(int index, int n_bd)
  53 {
  54         return ++index & (n_bd - 1);
  55 }
  56
  57 /**
  58  * iwl_queue_dec_wrap - decrement queue index, wrap back to end
  59  * @index -- current index
  60  * @n_bd -- total number of entries in queue (must be power of 2)
  61  */
  62 static inline int iwl_queue_dec_wrap(int index, int n_bd)
  63 {
  64         return --index & (n_bd - 1);
  65 }
  66
  67 /*
  68  * we have 8 bits used like this:
  69  *
  70  * 7 6 5 4 3 2 1 0
  71  * | | | | | | | |
  72  * | | | | | | +-+-------- AC queue (0-3)
  73  * | | | | | |
  74  * | +-+-+-+-+------------ HW queue ID
  75  * |
  76  * +---------------------- unused
  77  */
  78 static inline void iwl_set_swq_id(struct iwl_tx_queue *txq, u8 ac, u8 hwq)
  79 {
  80         BUG_ON(ac > 3);   /* only have 2 bits */
  81         BUG_ON(hwq > 31); /* only use 5 bits */
  82
  83         txq->swq_id = (hwq << 2) | ac;
  84 }
  85
  86 static inline void iwl_wake_queue(struct iwl_priv *priv,
  87                                   struct iwl_tx_queue *txq)
  88 {
  89         u8 queue = txq->swq_id;
  90         u8 ac = queue & 3;
  91         u8 hwq = (queue >> 2) & 0x1f;
  92
  93         if (unlikely(!priv->mac80211_registered))
  94                 return;
  95
  96         if (test_and_clear_bit(hwq, priv->queue_stopped))
  97                 if (atomic_dec_return(&priv->queue_stop_count[ac]) <= 0)
  98                         ieee80211_wake_queue(priv->hw, ac);
  99 }
 100
 101 static inline void iwl_stop_queue(struct iwl_priv *priv,
 102                                   struct iwl_tx_queue *txq)
 103 {
 104         u8 queue = txq->swq_id;
 105         u8 ac = queue & 3;
 106         u8 hwq = (queue >> 2) & 0x1f;
 107
 108         if (unlikely(!priv->mac80211_registered))
 109                 return;
 110
 111         if (!test_and_set_bit(hwq, priv->queue_stopped))
 112                 if (atomic_inc_return(&priv->queue_stop_count[ac]) > 0)
 113                         ieee80211_stop_queue(priv->hw, ac);
 114 }
 115
 116 static inline void iwl_wake_any_queue(struct iwl_priv *priv,
 117                                       struct iwl_rxon_context *ctx)
 118 {
 119         u8 ac;
 120
 121         for (ac = 0; ac < AC_NUM; ac++) {
 122                 IWL_DEBUG_INFO(priv, "Queue Status: Q[%d] %s\n",
 123                         ac, (atomic_read(&priv->queue_stop_count[ac]) > 0)
 124                               ? "stopped" : "awake");
 125                 iwl_wake_queue(priv, &priv->txq[ctx->ac_to_queue[ac]]);
 126         }
 127 }
 128
 129 #ifdef ieee80211_stop_queue
 130 #undef ieee80211_stop_queue
 131 #endif
 132
 133 #define ieee80211_stop_queue DO_NOT_USE_ieee80211_stop_queue
 134
 135 #ifdef ieee80211_wake_queue
 136 #undef ieee80211_wake_queue
 137 #endif
 138
 139 #define ieee80211_wake_queue DO_NOT_USE_ieee80211_wake_queue
 140
 141 static inline void iwl_enable_rfkill_int(struct iwl_priv *priv)
 142 {
 143         IWL_DEBUG_ISR(priv, "Enabling rfkill interrupt\n");
 144         iwl_write32(bus(priv), CSR_INT_MASK, CSR_INT_BIT_RF_KILL);
 145 }
 146
 147 /**
 148  * iwl_beacon_time_mask_low - mask of lower 32 bit of beacon time
 149  * @priv -- pointer to iwl_priv data structure
 150  * @tsf_bits -- number of bits need to shift for masking)
 151  */
 152 static inline u32 iwl_beacon_time_mask_low(struct iwl_priv *priv,
 153                                            u16 tsf_bits)
 154 {
 155         return (1 << tsf_bits) - 1;
 156 }
 157
 158 /**
 159  * iwl_beacon_time_mask_high - mask of higher 32 bit of beacon time
 160  * @priv -- pointer to iwl_priv data structure
 161  * @tsf_bits -- number of bits need to shift for masking)
 162  */
 163 static inline u32 iwl_beacon_time_mask_high(struct iwl_priv *priv,
 164                                             u16 tsf_bits)
 165 {
 166         return ((1 << (32 - tsf_bits)) - 1) << tsf_bits;
 167 }
 168
 169 #endif                          /* __iwl_helpers_h__ */