iwlwifi: fix valid chain reading from EEPROM
[linux-2.6.git] / drivers / net / wireless / iwlwifi / iwl-agn-eeprom.c
1 /******************************************************************************
2  *
3  * This file is provided under a dual BSD/GPLv2 license.  When using or
4  * redistributing this file, you may do so under either license.
5  *
6  * GPL LICENSE SUMMARY
7  *
8  * Copyright(c) 2008 - 2010 Intel Corporation. All rights reserved.
9  *
10  * This program is free software; you can redistribute it and/or modify
11  * it under the terms of version 2 of the GNU General Public License as
12  * published by the Free Software Foundation.
13  *
14  * This program is distributed in the hope that it will be useful, but
15  * WITHOUT ANY WARRANTY; without even the implied warranty of
16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
17  * General Public License for more details.
18  *
19  * You should have received a copy of the GNU General Public License
20  * along with this program; if not, write to the Free Software
21  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110,
22  * USA
23  *
24  * The full GNU General Public License is included in this distribution
25  * in the file called LICENSE.GPL.
26  *
27  * Contact Information:
28  *  Intel Linux Wireless <ilw@linux.intel.com>
29  * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
30  *
31  * BSD LICENSE
32  *
33  * Copyright(c) 2005 - 2010 Intel Corporation. All rights reserved.
34  * All rights reserved.
35  *
36  * Redistribution and use in source and binary forms, with or without
37  * modification, are permitted provided that the following conditions
38  * are met:
39  *
40  *  * Redistributions of source code must retain the above copyright
41  *    notice, this list of conditions and the following disclaimer.
42  *  * Redistributions in binary form must reproduce the above copyright
43  *    notice, this list of conditions and the following disclaimer in
44  *    the documentation and/or other materials provided with the
45  *    distribution.
46  *  * Neither the name Intel Corporation nor the names of its
47  *    contributors may be used to endorse or promote products derived
48  *    from this software without specific prior written permission.
49  *
50  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
51  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
52  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
53  * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
54  * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
55  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
56  * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
57  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
58  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
59  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
60  * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
61  *****************************************************************************/
62
63
64 #include <linux/kernel.h>
65 #include <linux/module.h>
66 #include <linux/slab.h>
67 #include <linux/init.h>
68
69 #include <net/mac80211.h>
70
71 #include "iwl-commands.h"
72 #include "iwl-dev.h"
73 #include "iwl-core.h"
74 #include "iwl-debug.h"
75 #include "iwl-agn.h"
76 #include "iwl-io.h"
77
78 /******************************************************************************
79  *
80  * EEPROM related functions
81  *
82 ******************************************************************************/
83
84 /*
85  * The device's EEPROM semaphore prevents conflicts between driver and uCode
86  * when accessing the EEPROM; each access is a series of pulses to/from the
87  * EEPROM chip, not a single event, so even reads could conflict if they
88  * weren't arbitrated by the semaphore.
89  */
90 int iwlcore_eeprom_acquire_semaphore(struct iwl_priv *priv)
91 {
92         u16 count;
93         int ret;
94
95         for (count = 0; count < EEPROM_SEM_RETRY_LIMIT; count++) {
96                 /* Request semaphore */
97                 iwl_set_bit(priv, CSR_HW_IF_CONFIG_REG,
98                             CSR_HW_IF_CONFIG_REG_BIT_EEPROM_OWN_SEM);
99
100                 /* See if we got it */
101                 ret = iwl_poll_bit(priv, CSR_HW_IF_CONFIG_REG,
102                                 CSR_HW_IF_CONFIG_REG_BIT_EEPROM_OWN_SEM,
103                                 CSR_HW_IF_CONFIG_REG_BIT_EEPROM_OWN_SEM,
104                                 EEPROM_SEM_TIMEOUT);
105                 if (ret >= 0) {
106                         IWL_DEBUG_IO(priv,
107                                 "Acquired semaphore after %d tries.\n",
108                                 count+1);
109                         return ret;
110                 }
111         }
112
113         return ret;
114 }
115
116 void iwlcore_eeprom_release_semaphore(struct iwl_priv *priv)
117 {
118         iwl_clear_bit(priv, CSR_HW_IF_CONFIG_REG,
119                 CSR_HW_IF_CONFIG_REG_BIT_EEPROM_OWN_SEM);
120
121 }
122
123 int iwl_eeprom_check_version(struct iwl_priv *priv)
124 {
125         u16 eeprom_ver;
126         u16 calib_ver;
127
128         eeprom_ver = iwl_eeprom_query16(priv, EEPROM_VERSION);
129         calib_ver = priv->cfg->ops->lib->eeprom_ops.calib_version(priv);
130
131         if (eeprom_ver < priv->cfg->eeprom_ver ||
132             calib_ver < priv->cfg->eeprom_calib_ver)
133                 goto err;
134
135         IWL_INFO(priv, "device EEPROM VER=0x%x, CALIB=0x%x\n",
136                  eeprom_ver, calib_ver);
137
138         return 0;
139 err:
140         IWL_ERR(priv, "Unsupported (too old) EEPROM VER=0x%x < 0x%x "
141                   "CALIB=0x%x < 0x%x\n",
142                   eeprom_ver, priv->cfg->eeprom_ver,
143                   calib_ver,  priv->cfg->eeprom_calib_ver);
144         return -EINVAL;
145
146 }
147
148 int iwl_eeprom_check_sku(struct iwl_priv *priv)
149 {
150         u16 eeprom_sku;
151         u16 radio_cfg;
152
153         eeprom_sku = iwl_eeprom_query16(priv, EEPROM_SKU_CAP);
154
155         priv->cfg->sku = ((eeprom_sku & EEPROM_SKU_CAP_BAND_SELECTION) >>
156                         EEPROM_SKU_CAP_BAND_POS);
157         if (eeprom_sku & EEPROM_SKU_CAP_11N_ENABLE)
158                 priv->cfg->sku |= IWL_SKU_N;
159
160         if (!priv->cfg->sku) {
161                 IWL_ERR(priv, "Invalid device sku\n");
162                 return -EINVAL;
163         }
164
165         IWL_INFO(priv, "Device SKU: 0X%x\n", priv->cfg->sku);
166
167         if (!priv->cfg->valid_tx_ant && !priv->cfg->valid_rx_ant) {
168                 /* not using .cfg overwrite */
169                 radio_cfg = iwl_eeprom_query16(priv, EEPROM_RADIO_CONFIG);
170                 priv->cfg->valid_tx_ant = EEPROM_RF_CFG_TX_ANT_MSK(radio_cfg);
171                 priv->cfg->valid_rx_ant = EEPROM_RF_CFG_RX_ANT_MSK(radio_cfg);
172                 if (!priv->cfg->valid_tx_ant || !priv->cfg->valid_rx_ant) {
173                         IWL_ERR(priv, "Invalid chain (0X%x, 0X%x)\n",
174                                 priv->cfg->valid_tx_ant,
175                                 priv->cfg->valid_rx_ant);
176                         return -EINVAL;
177                 }
178                 IWL_INFO(priv, "Valid Tx ant: 0X%x, Valid Rx ant: 0X%x\n",
179                          priv->cfg->valid_tx_ant, priv->cfg->valid_rx_ant);
180         }
181         /*
182          * for some special cases,
183          * EEPROM did not reflect the correct antenna setting
184          * so overwrite the valid tx/rx antenna from .cfg
185          */
186         return 0;
187 }
188
189 void iwl_eeprom_get_mac(const struct iwl_priv *priv, u8 *mac)
190 {
191         const u8 *addr = priv->cfg->ops->lib->eeprom_ops.query_addr(priv,
192                                         EEPROM_MAC_ADDRESS);
193         memcpy(mac, addr, ETH_ALEN);
194 }
195
196 /**
197  * iwl_get_max_txpower_avg - get the highest tx power from all chains.
198  *     find the highest tx power from all chains for the channel
199  */
200 static s8 iwl_get_max_txpower_avg(struct iwl_priv *priv,
201                 struct iwl_eeprom_enhanced_txpwr *enhanced_txpower,
202                 int element, s8 *max_txpower_in_half_dbm)
203 {
204         s8 max_txpower_avg = 0; /* (dBm) */
205
206         /* Take the highest tx power from any valid chains */
207         if ((priv->cfg->valid_tx_ant & ANT_A) &&
208             (enhanced_txpower[element].chain_a_max > max_txpower_avg))
209                 max_txpower_avg = enhanced_txpower[element].chain_a_max;
210         if ((priv->cfg->valid_tx_ant & ANT_B) &&
211             (enhanced_txpower[element].chain_b_max > max_txpower_avg))
212                 max_txpower_avg = enhanced_txpower[element].chain_b_max;
213         if ((priv->cfg->valid_tx_ant & ANT_C) &&
214             (enhanced_txpower[element].chain_c_max > max_txpower_avg))
215                 max_txpower_avg = enhanced_txpower[element].chain_c_max;
216         if (((priv->cfg->valid_tx_ant == ANT_AB) |
217             (priv->cfg->valid_tx_ant == ANT_BC) |
218             (priv->cfg->valid_tx_ant == ANT_AC)) &&
219             (enhanced_txpower[element].mimo2_max > max_txpower_avg))
220                 max_txpower_avg =  enhanced_txpower[element].mimo2_max;
221         if ((priv->cfg->valid_tx_ant == ANT_ABC) &&
222             (enhanced_txpower[element].mimo3_max > max_txpower_avg))
223                 max_txpower_avg = enhanced_txpower[element].mimo3_max;
224
225         /*
226          * max. tx power in EEPROM is in 1/2 dBm format
227          * convert from 1/2 dBm to dBm (round-up convert)
228          * but we also do not want to loss 1/2 dBm resolution which
229          * will impact performance
230          */
231         *max_txpower_in_half_dbm = max_txpower_avg;
232         return (max_txpower_avg & 0x01) + (max_txpower_avg >> 1);
233 }
234
235 static void
236 iwlcore_eeprom_enh_txp_read_element(struct iwl_priv *priv,
237                                     struct iwl_eeprom_enhanced_txpwr *txp,
238                                     s8 max_txpower_avg)
239 {
240         int ch_idx;
241         bool is_ht40 = txp->flags & IWL_EEPROM_ENH_TXP_FL_40MHZ;
242         enum ieee80211_band band;
243
244         band = txp->flags & IWL_EEPROM_ENH_TXP_FL_BAND_52G ?
245                 IEEE80211_BAND_5GHZ : IEEE80211_BAND_2GHZ;
246
247         for (ch_idx = 0; ch_idx < priv->channel_count; ch_idx++) {
248                 struct iwl_channel_info *ch_info = &priv->channel_info[ch_idx];
249
250                 /* update matching channel or from common data only */
251                 if (txp->channel != 0 && ch_info->channel != txp->channel)
252                         continue;
253
254                 /* update matching band only */
255                 if (band != ch_info->band)
256                         continue;
257
258                 if (ch_info->max_power_avg < max_txpower_avg && !is_ht40) {
259                         ch_info->max_power_avg = max_txpower_avg;
260                         ch_info->curr_txpow = max_txpower_avg;
261                         ch_info->scan_power = max_txpower_avg;
262                 }
263
264                 if (is_ht40 && ch_info->ht40_max_power_avg < max_txpower_avg)
265                         ch_info->ht40_max_power_avg = max_txpower_avg;
266         }
267 }
268
269 #define EEPROM_TXP_OFFS (0x00 | INDIRECT_ADDRESS | INDIRECT_TXP_LIMIT)
270 #define EEPROM_TXP_ENTRY_LEN sizeof(struct iwl_eeprom_enhanced_txpwr)
271 #define EEPROM_TXP_SZ_OFFS (0x00 | INDIRECT_ADDRESS | INDIRECT_TXP_LIMIT_SIZE)
272
273 #define TXP_CHECK_AND_PRINT(x) ((txp->flags & IWL_EEPROM_ENH_TXP_FL_##x) \
274                             ? # x " " : "")
275
276 void iwlcore_eeprom_enhanced_txpower(struct iwl_priv *priv)
277 {
278         struct iwl_eeprom_enhanced_txpwr *txp_array, *txp;
279         int idx, entries;
280         __le16 *txp_len;
281         s8 max_txp_avg, max_txp_avg_halfdbm;
282
283         BUILD_BUG_ON(sizeof(struct iwl_eeprom_enhanced_txpwr) != 8);
284
285         /* the length is in 16-bit words, but we want entries */
286         txp_len = (__le16 *) iwlagn_eeprom_query_addr(priv, EEPROM_TXP_SZ_OFFS);
287         entries = le16_to_cpup(txp_len) * 2 / EEPROM_TXP_ENTRY_LEN;
288
289         txp_array = (void *) iwlagn_eeprom_query_addr(priv, EEPROM_TXP_OFFS);
290
291         for (idx = 0; idx < entries; idx++) {
292                 txp = &txp_array[idx];
293                 /* skip invalid entries */
294                 if (!(txp->flags & IWL_EEPROM_ENH_TXP_FL_VALID))
295                         continue;
296
297                 IWL_DEBUG_EEPROM(priv, "%s %d:\t %s%s%s%s%s%s%s%s (0x%02x)\n",
298                                  (txp->channel && (txp->flags &
299                                         IWL_EEPROM_ENH_TXP_FL_COMMON_TYPE)) ?
300                                         "Common " : (txp->channel) ?
301                                         "Channel" : "Common",
302                                  (txp->channel),
303                                  TXP_CHECK_AND_PRINT(VALID),
304                                  TXP_CHECK_AND_PRINT(BAND_52G),
305                                  TXP_CHECK_AND_PRINT(OFDM),
306                                  TXP_CHECK_AND_PRINT(40MHZ),
307                                  TXP_CHECK_AND_PRINT(HT_AP),
308                                  TXP_CHECK_AND_PRINT(RES1),
309                                  TXP_CHECK_AND_PRINT(RES2),
310                                  TXP_CHECK_AND_PRINT(COMMON_TYPE),
311                                  txp->flags);
312                 IWL_DEBUG_EEPROM(priv, "\t\t chain_A: 0x%02x "
313                                  "chain_B: 0X%02x chain_C: 0X%02x\n",
314                                  txp->chain_a_max, txp->chain_b_max,
315                                  txp->chain_c_max);
316                 IWL_DEBUG_EEPROM(priv, "\t\t MIMO2: 0x%02x "
317                                  "MIMO3: 0x%02x High 20_on_40: 0x%02x "
318                                  "Low 20_on_40: 0x%02x\n",
319                                  txp->mimo2_max, txp->mimo3_max,
320                                  ((txp->delta_20_in_40 & 0xf0) >> 4),
321                                  (txp->delta_20_in_40 & 0x0f));
322
323                 max_txp_avg = iwl_get_max_txpower_avg(priv, txp_array, idx,
324                                                       &max_txp_avg_halfdbm);
325
326                 /*
327                  * Update the user limit values values to the highest
328                  * power supported by any channel
329                  */
330                 if (max_txp_avg > priv->tx_power_user_lmt)
331                         priv->tx_power_user_lmt = max_txp_avg;
332                 if (max_txp_avg_halfdbm > priv->tx_power_lmt_in_half_dbm)
333                         priv->tx_power_lmt_in_half_dbm = max_txp_avg_halfdbm;
334
335                 iwlcore_eeprom_enh_txp_read_element(priv, txp, max_txp_avg);
336         }
337 }