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

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2003 - 2010 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
  35 #define IWL_MASK(lo, hi) ((1 << (hi)) | ((1 << (hi)) - (1 << (lo))))
  36
  37
  38 static inline struct ieee80211_conf *ieee80211_get_hw_conf(
  39         struct ieee80211_hw *hw)
  40 {
  41         return &hw->conf;
  42 }
  43
  44 static inline int iwl_check_bits(unsigned long field, unsigned long mask)
  45 {
  46         return ((field & mask) == mask) ? 1 : 0;
  47 }
  48
  49 static inline unsigned long elapsed_jiffies(unsigned long start,
  50                                             unsigned long end)
  51 {
  52         if (end >= start)
  53                 return end - start;
  54
  55         return end + (MAX_JIFFY_OFFSET - start) + 1;
  56 }
  57
  58 /**
  59  * iwl_queue_inc_wrap - increment queue index, wrap back to beginning
  60  * @index -- current index
  61  * @n_bd -- total number of entries in queue (must be power of 2)
  62  */
  63 static inline int iwl_queue_inc_wrap(int index, int n_bd)
  64 {
  65         return ++index & (n_bd - 1);
  66 }
  67
  68 /**
  69  * iwl_queue_dec_wrap - decrement queue index, wrap back to end
  70  * @index -- current index
  71  * @n_bd -- total number of entries in queue (must be power of 2)
  72  */
  73 static inline int iwl_queue_dec_wrap(int index, int n_bd)
  74 {
  75         return --index & (n_bd - 1);
  76 }
  77
  78 /* TODO: Move fw_desc functions to iwl-pci.ko */
  79 static inline void iwl_free_fw_desc(struct pci_dev *pci_dev,
  80                                     struct fw_desc *desc)
  81 {
  82         if (desc->v_addr)
  83                 pci_free_consistent(pci_dev, desc->len,
  84                                     desc->v_addr, desc->p_addr);
  85         desc->v_addr = NULL;
  86         desc->len = 0;
  87 }
  88
  89 static inline int iwl_alloc_fw_desc(struct pci_dev *pci_dev,
  90                                     struct fw_desc *desc)
  91 {
  92         desc->v_addr = pci_alloc_consistent(pci_dev, desc->len, &desc->p_addr);
  93         return (desc->v_addr != NULL) ? 0 : -ENOMEM;
  94 }
  95
  96 /*
  97  * we have 8 bits used like this:
  98  *
  99  * 7 6 5 4 3 2 1 0
 100  * | | | | | | | |
 101  * | | | | | | +-+-------- AC queue (0-3)
 102  * | | | | | |
 103  * | +-+-+-+-+------------ HW A-MPDU queue
 104  * |
 105  * +---------------------- indicates agg queue
 106  */
 107 static inline u8 iwl_virtual_agg_queue_num(u8 ac, u8 hwq)
 108 {
 109         BUG_ON(ac > 3);   /* only have 2 bits */
 110         BUG_ON(hwq > 31); /* only have 5 bits */
 111
 112         return 0x80 | (hwq << 2) | ac;
 113 }
 114
 115 static inline void iwl_wake_queue(struct iwl_priv *priv, u8 queue)
 116 {
 117         u8 ac = queue;
 118         u8 hwq = queue;
 119
 120         if (queue & 0x80) {
 121                 ac = queue & 3;
 122                 hwq = (queue >> 2) & 0x1f;
 123         }
 124
 125         if (test_and_clear_bit(hwq, priv->queue_stopped))
 126                 if (atomic_dec_return(&priv->queue_stop_count[ac]) <= 0)
 127                         ieee80211_wake_queue(priv->hw, ac);
 128 }
 129
 130 static inline void iwl_stop_queue(struct iwl_priv *priv, u8 queue)
 131 {
 132         u8 ac = queue;
 133         u8 hwq = queue;
 134
 135         if (queue & 0x80) {
 136                 ac = queue & 3;
 137                 hwq = (queue >> 2) & 0x1f;
 138         }
 139
 140         if (!test_and_set_bit(hwq, priv->queue_stopped))
 141                 if (atomic_inc_return(&priv->queue_stop_count[ac]) > 0)
 142                         ieee80211_stop_queue(priv->hw, ac);
 143 }
 144
 145 #define ieee80211_stop_queue DO_NOT_USE_ieee80211_stop_queue
 146 #define ieee80211_wake_queue DO_NOT_USE_ieee80211_wake_queue
 147
 148 static inline void iwl_disable_interrupts(struct iwl_priv *priv)
 149 {
 150         clear_bit(STATUS_INT_ENABLED, &priv->status);
 151
 152         /* disable interrupts from uCode/NIC to host */
 153         iwl_write32(priv, CSR_INT_MASK, 0x00000000);
 154
 155         /* acknowledge/clear/reset any interrupts still pending
 156          * from uCode or flow handler (Rx/Tx DMA) */
 157         iwl_write32(priv, CSR_INT, 0xffffffff);
 158         iwl_write32(priv, CSR_FH_INT_STATUS, 0xffffffff);
 159         IWL_DEBUG_ISR(priv, "Disabled interrupts\n");
 160 }
 161
 162 static inline void iwl_enable_interrupts(struct iwl_priv *priv)
 163 {
 164         IWL_DEBUG_ISR(priv, "Enabling interrupts\n");
 165         set_bit(STATUS_INT_ENABLED, &priv->status);
 166         iwl_write32(priv, CSR_INT_MASK, priv->inta_mask);
 167 }
 168
 169 #endif                          /* __iwl_helpers_h__ */