iwl-eeprom.c 22 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733
  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 - 2009 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 - 2009 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. #include <linux/kernel.h>
  63. #include <linux/module.h>
  64. #include <linux/init.h>
  65. #include <net/mac80211.h>
  66. #include "iwl-commands.h"
  67. #include "iwl-dev.h"
  68. #include "iwl-core.h"
  69. #include "iwl-debug.h"
  70. #include "iwl-eeprom.h"
  71. #include "iwl-io.h"
  72. /************************** EEPROM BANDS ****************************
  73. *
  74. * The iwl_eeprom_band definitions below provide the mapping from the
  75. * EEPROM contents to the specific channel number supported for each
  76. * band.
  77. *
  78. * For example, iwl_priv->eeprom.band_3_channels[4] from the band_3
  79. * definition below maps to physical channel 42 in the 5.2GHz spectrum.
  80. * The specific geography and calibration information for that channel
  81. * is contained in the eeprom map itself.
  82. *
  83. * During init, we copy the eeprom information and channel map
  84. * information into priv->channel_info_24/52 and priv->channel_map_24/52
  85. *
  86. * channel_map_24/52 provides the index in the channel_info array for a
  87. * given channel. We have to have two separate maps as there is channel
  88. * overlap with the 2.4GHz and 5.2GHz spectrum as seen in band_1 and
  89. * band_2
  90. *
  91. * A value of 0xff stored in the channel_map indicates that the channel
  92. * is not supported by the hardware at all.
  93. *
  94. * A value of 0xfe in the channel_map indicates that the channel is not
  95. * valid for Tx with the current hardware. This means that
  96. * while the system can tune and receive on a given channel, it may not
  97. * be able to associate or transmit any frames on that
  98. * channel. There is no corresponding channel information for that
  99. * entry.
  100. *
  101. *********************************************************************/
  102. /* 2.4 GHz */
  103. const u8 iwl_eeprom_band_1[14] = {
  104. 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14
  105. };
  106. /* 5.2 GHz bands */
  107. static const u8 iwl_eeprom_band_2[] = { /* 4915-5080MHz */
  108. 183, 184, 185, 187, 188, 189, 192, 196, 7, 8, 11, 12, 16
  109. };
  110. static const u8 iwl_eeprom_band_3[] = { /* 5170-5320MHz */
  111. 34, 36, 38, 40, 42, 44, 46, 48, 52, 56, 60, 64
  112. };
  113. static const u8 iwl_eeprom_band_4[] = { /* 5500-5700MHz */
  114. 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140
  115. };
  116. static const u8 iwl_eeprom_band_5[] = { /* 5725-5825MHz */
  117. 145, 149, 153, 157, 161, 165
  118. };
  119. static const u8 iwl_eeprom_band_6[] = { /* 2.4 FAT channel */
  120. 1, 2, 3, 4, 5, 6, 7
  121. };
  122. static const u8 iwl_eeprom_band_7[] = { /* 5.2 FAT channel */
  123. 36, 44, 52, 60, 100, 108, 116, 124, 132, 149, 157
  124. };
  125. /******************************************************************************
  126. *
  127. * EEPROM related functions
  128. *
  129. ******************************************************************************/
  130. int iwlcore_eeprom_verify_signature(struct iwl_priv *priv)
  131. {
  132. u32 gp = iwl_read32(priv, CSR_EEPROM_GP);
  133. if ((gp & CSR_EEPROM_GP_VALID_MSK) == CSR_EEPROM_GP_BAD_SIGNATURE) {
  134. IWL_ERR(priv, "EEPROM not found, EEPROM_GP=0x%08x\n", gp);
  135. return -ENOENT;
  136. }
  137. return 0;
  138. }
  139. EXPORT_SYMBOL(iwlcore_eeprom_verify_signature);
  140. static int iwlcore_get_nvm_type(struct iwl_priv *priv)
  141. {
  142. u32 otpgp;
  143. int nvm_type;
  144. /* OTP only valid for CP/PP and after */
  145. switch (priv->hw_rev & CSR_HW_REV_TYPE_MSK) {
  146. case CSR_HW_REV_TYPE_3945:
  147. case CSR_HW_REV_TYPE_4965:
  148. case CSR_HW_REV_TYPE_5300:
  149. case CSR_HW_REV_TYPE_5350:
  150. case CSR_HW_REV_TYPE_5100:
  151. case CSR_HW_REV_TYPE_5150:
  152. nvm_type = NVM_DEVICE_TYPE_EEPROM;
  153. break;
  154. default:
  155. otpgp = iwl_read32(priv, CSR_OTP_GP_REG);
  156. if (otpgp & CSR_OTP_GP_REG_DEVICE_SELECT)
  157. nvm_type = NVM_DEVICE_TYPE_OTP;
  158. else
  159. nvm_type = NVM_DEVICE_TYPE_EEPROM;
  160. break;
  161. }
  162. return nvm_type;
  163. }
  164. /*
  165. * The device's EEPROM semaphore prevents conflicts between driver and uCode
  166. * when accessing the EEPROM; each access is a series of pulses to/from the
  167. * EEPROM chip, not a single event, so even reads could conflict if they
  168. * weren't arbitrated by the semaphore.
  169. */
  170. int iwlcore_eeprom_acquire_semaphore(struct iwl_priv *priv)
  171. {
  172. u16 count;
  173. int ret;
  174. for (count = 0; count < EEPROM_SEM_RETRY_LIMIT; count++) {
  175. /* Request semaphore */
  176. iwl_set_bit(priv, CSR_HW_IF_CONFIG_REG,
  177. CSR_HW_IF_CONFIG_REG_BIT_EEPROM_OWN_SEM);
  178. /* See if we got it */
  179. ret = iwl_poll_direct_bit(priv, CSR_HW_IF_CONFIG_REG,
  180. CSR_HW_IF_CONFIG_REG_BIT_EEPROM_OWN_SEM,
  181. EEPROM_SEM_TIMEOUT);
  182. if (ret >= 0) {
  183. IWL_DEBUG_IO(priv, "Acquired semaphore after %d tries.\n",
  184. count+1);
  185. return ret;
  186. }
  187. }
  188. return ret;
  189. }
  190. EXPORT_SYMBOL(iwlcore_eeprom_acquire_semaphore);
  191. void iwlcore_eeprom_release_semaphore(struct iwl_priv *priv)
  192. {
  193. iwl_clear_bit(priv, CSR_HW_IF_CONFIG_REG,
  194. CSR_HW_IF_CONFIG_REG_BIT_EEPROM_OWN_SEM);
  195. }
  196. EXPORT_SYMBOL(iwlcore_eeprom_release_semaphore);
  197. const u8 *iwlcore_eeprom_query_addr(const struct iwl_priv *priv, size_t offset)
  198. {
  199. BUG_ON(offset >= priv->cfg->eeprom_size);
  200. return &priv->eeprom[offset];
  201. }
  202. EXPORT_SYMBOL(iwlcore_eeprom_query_addr);
  203. static int iwl_init_otp_access(struct iwl_priv *priv)
  204. {
  205. int ret;
  206. /* Enable 40MHz radio clock */
  207. _iwl_write32(priv, CSR_GP_CNTRL,
  208. _iwl_read32(priv, CSR_GP_CNTRL) |
  209. CSR_GP_CNTRL_REG_FLAG_INIT_DONE);
  210. /* wait for clock to be ready */
  211. ret = iwl_poll_direct_bit(priv, CSR_GP_CNTRL,
  212. CSR_GP_CNTRL_REG_FLAG_MAC_CLOCK_READY,
  213. 25000);
  214. if (ret < 0)
  215. IWL_ERR(priv, "Time out access OTP\n");
  216. else {
  217. ret = iwl_grab_nic_access(priv);
  218. if (!ret) {
  219. iwl_set_bits_prph(priv, APMG_PS_CTRL_REG,
  220. APMG_PS_CTRL_VAL_RESET_REQ);
  221. udelay(5);
  222. iwl_clear_bits_prph(priv, APMG_PS_CTRL_REG,
  223. APMG_PS_CTRL_VAL_RESET_REQ);
  224. iwl_release_nic_access(priv);
  225. }
  226. }
  227. return ret;
  228. }
  229. /**
  230. * iwl_eeprom_init - read EEPROM contents
  231. *
  232. * Load the EEPROM contents from adapter into priv->eeprom
  233. *
  234. * NOTE: This routine uses the non-debug IO access functions.
  235. */
  236. int iwl_eeprom_init(struct iwl_priv *priv)
  237. {
  238. u16 *e;
  239. u32 gp = iwl_read32(priv, CSR_EEPROM_GP);
  240. int sz;
  241. int ret;
  242. u16 addr;
  243. u32 otpgp;
  244. priv->nvm_device_type = iwlcore_get_nvm_type(priv);
  245. /* allocate eeprom */
  246. if (priv->nvm_device_type == NVM_DEVICE_TYPE_OTP)
  247. priv->cfg->eeprom_size =
  248. OTP_BLOCK_SIZE * OTP_LOWER_BLOCKS_TOTAL;
  249. sz = priv->cfg->eeprom_size;
  250. priv->eeprom = kzalloc(sz, GFP_KERNEL);
  251. if (!priv->eeprom) {
  252. ret = -ENOMEM;
  253. goto alloc_err;
  254. }
  255. e = (u16 *)priv->eeprom;
  256. ret = priv->cfg->ops->lib->eeprom_ops.verify_signature(priv);
  257. if (ret < 0) {
  258. IWL_ERR(priv, "EEPROM not found, EEPROM_GP=0x%08x\n", gp);
  259. ret = -ENOENT;
  260. goto err;
  261. }
  262. /* Make sure driver (instead of uCode) is allowed to read EEPROM */
  263. ret = priv->cfg->ops->lib->eeprom_ops.acquire_semaphore(priv);
  264. if (ret < 0) {
  265. IWL_ERR(priv, "Failed to acquire EEPROM semaphore.\n");
  266. ret = -ENOENT;
  267. goto err;
  268. }
  269. if (priv->nvm_device_type == NVM_DEVICE_TYPE_OTP) {
  270. ret = iwl_init_otp_access(priv);
  271. if (ret) {
  272. IWL_ERR(priv, "Failed to initialize OTP access.\n");
  273. ret = -ENOENT;
  274. goto err;
  275. }
  276. _iwl_write32(priv, CSR_EEPROM_GP,
  277. iwl_read32(priv, CSR_EEPROM_GP) &
  278. ~CSR_EEPROM_GP_IF_OWNER_MSK);
  279. /* clear */
  280. _iwl_write32(priv, CSR_OTP_GP_REG,
  281. iwl_read32(priv, CSR_OTP_GP_REG) |
  282. CSR_OTP_GP_REG_ECC_CORR_STATUS_MSK |
  283. CSR_OTP_GP_REG_ECC_UNCORR_STATUS_MSK);
  284. for (addr = 0; addr < sz; addr += sizeof(u16)) {
  285. u32 r;
  286. _iwl_write32(priv, CSR_EEPROM_REG,
  287. CSR_EEPROM_REG_MSK_ADDR & (addr << 1));
  288. ret = iwl_poll_direct_bit(priv, CSR_EEPROM_REG,
  289. CSR_EEPROM_REG_READ_VALID_MSK,
  290. IWL_EEPROM_ACCESS_TIMEOUT);
  291. if (ret < 0) {
  292. IWL_ERR(priv, "Time out reading OTP[%d]\n", addr);
  293. goto done;
  294. }
  295. r = _iwl_read_direct32(priv, CSR_EEPROM_REG);
  296. /* check for ECC errors: */
  297. otpgp = iwl_read32(priv, CSR_OTP_GP_REG);
  298. if (otpgp & CSR_OTP_GP_REG_ECC_UNCORR_STATUS_MSK) {
  299. /* stop in this case */
  300. IWL_ERR(priv, "Uncorrectable OTP ECC error, Abort OTP read\n");
  301. goto done;
  302. }
  303. if (otpgp & CSR_OTP_GP_REG_ECC_CORR_STATUS_MSK) {
  304. /* continue in this case */
  305. _iwl_write32(priv, CSR_OTP_GP_REG,
  306. iwl_read32(priv, CSR_OTP_GP_REG) |
  307. CSR_OTP_GP_REG_ECC_CORR_STATUS_MSK);
  308. IWL_ERR(priv, "Correctable OTP ECC error, continue read\n");
  309. }
  310. e[addr / 2] = le16_to_cpu((__force __le16)(r >> 16));
  311. }
  312. } else {
  313. /* eeprom is an array of 16bit values */
  314. for (addr = 0; addr < sz; addr += sizeof(u16)) {
  315. u32 r;
  316. _iwl_write32(priv, CSR_EEPROM_REG,
  317. CSR_EEPROM_REG_MSK_ADDR & (addr << 1));
  318. ret = iwl_poll_direct_bit(priv, CSR_EEPROM_REG,
  319. CSR_EEPROM_REG_READ_VALID_MSK,
  320. IWL_EEPROM_ACCESS_TIMEOUT);
  321. if (ret < 0) {
  322. IWL_ERR(priv, "Time out reading EEPROM[%d]\n", addr);
  323. goto done;
  324. }
  325. r = _iwl_read_direct32(priv, CSR_EEPROM_REG);
  326. e[addr / 2] = le16_to_cpu((__force __le16)(r >> 16));
  327. }
  328. }
  329. ret = 0;
  330. done:
  331. priv->cfg->ops->lib->eeprom_ops.release_semaphore(priv);
  332. err:
  333. if (ret)
  334. iwl_eeprom_free(priv);
  335. alloc_err:
  336. return ret;
  337. }
  338. EXPORT_SYMBOL(iwl_eeprom_init);
  339. void iwl_eeprom_free(struct iwl_priv *priv)
  340. {
  341. kfree(priv->eeprom);
  342. priv->eeprom = NULL;
  343. }
  344. EXPORT_SYMBOL(iwl_eeprom_free);
  345. int iwl_eeprom_check_version(struct iwl_priv *priv)
  346. {
  347. u16 eeprom_ver;
  348. u16 calib_ver;
  349. eeprom_ver = iwl_eeprom_query16(priv, EEPROM_VERSION);
  350. calib_ver = priv->cfg->ops->lib->eeprom_ops.calib_version(priv);
  351. if (eeprom_ver < priv->cfg->eeprom_ver ||
  352. calib_ver < priv->cfg->eeprom_calib_ver)
  353. goto err;
  354. return 0;
  355. err:
  356. IWL_ERR(priv, "Unsupported (too old) EEPROM VER=0x%x < 0x%x CALIB=0x%x < 0x%x\n",
  357. eeprom_ver, priv->cfg->eeprom_ver,
  358. calib_ver, priv->cfg->eeprom_calib_ver);
  359. return -EINVAL;
  360. }
  361. EXPORT_SYMBOL(iwl_eeprom_check_version);
  362. const u8 *iwl_eeprom_query_addr(const struct iwl_priv *priv, size_t offset)
  363. {
  364. return priv->cfg->ops->lib->eeprom_ops.query_addr(priv, offset);
  365. }
  366. EXPORT_SYMBOL(iwl_eeprom_query_addr);
  367. u16 iwl_eeprom_query16(const struct iwl_priv *priv, size_t offset)
  368. {
  369. if (!priv->eeprom)
  370. return 0;
  371. return (u16)priv->eeprom[offset] | ((u16)priv->eeprom[offset + 1] << 8);
  372. }
  373. EXPORT_SYMBOL(iwl_eeprom_query16);
  374. void iwl_eeprom_get_mac(const struct iwl_priv *priv, u8 *mac)
  375. {
  376. const u8 *addr = priv->cfg->ops->lib->eeprom_ops.query_addr(priv,
  377. EEPROM_MAC_ADDRESS);
  378. memcpy(mac, addr, ETH_ALEN);
  379. }
  380. EXPORT_SYMBOL(iwl_eeprom_get_mac);
  381. static void iwl_init_band_reference(const struct iwl_priv *priv,
  382. int eep_band, int *eeprom_ch_count,
  383. const struct iwl_eeprom_channel **eeprom_ch_info,
  384. const u8 **eeprom_ch_index)
  385. {
  386. u32 offset = priv->cfg->ops->lib->
  387. eeprom_ops.regulatory_bands[eep_band - 1];
  388. switch (eep_band) {
  389. case 1: /* 2.4GHz band */
  390. *eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_1);
  391. *eeprom_ch_info = (struct iwl_eeprom_channel *)
  392. iwl_eeprom_query_addr(priv, offset);
  393. *eeprom_ch_index = iwl_eeprom_band_1;
  394. break;
  395. case 2: /* 4.9GHz band */
  396. *eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_2);
  397. *eeprom_ch_info = (struct iwl_eeprom_channel *)
  398. iwl_eeprom_query_addr(priv, offset);
  399. *eeprom_ch_index = iwl_eeprom_band_2;
  400. break;
  401. case 3: /* 5.2GHz band */
  402. *eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_3);
  403. *eeprom_ch_info = (struct iwl_eeprom_channel *)
  404. iwl_eeprom_query_addr(priv, offset);
  405. *eeprom_ch_index = iwl_eeprom_band_3;
  406. break;
  407. case 4: /* 5.5GHz band */
  408. *eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_4);
  409. *eeprom_ch_info = (struct iwl_eeprom_channel *)
  410. iwl_eeprom_query_addr(priv, offset);
  411. *eeprom_ch_index = iwl_eeprom_band_4;
  412. break;
  413. case 5: /* 5.7GHz band */
  414. *eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_5);
  415. *eeprom_ch_info = (struct iwl_eeprom_channel *)
  416. iwl_eeprom_query_addr(priv, offset);
  417. *eeprom_ch_index = iwl_eeprom_band_5;
  418. break;
  419. case 6: /* 2.4GHz FAT channels */
  420. *eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_6);
  421. *eeprom_ch_info = (struct iwl_eeprom_channel *)
  422. iwl_eeprom_query_addr(priv, offset);
  423. *eeprom_ch_index = iwl_eeprom_band_6;
  424. break;
  425. case 7: /* 5 GHz FAT channels */
  426. *eeprom_ch_count = ARRAY_SIZE(iwl_eeprom_band_7);
  427. *eeprom_ch_info = (struct iwl_eeprom_channel *)
  428. iwl_eeprom_query_addr(priv, offset);
  429. *eeprom_ch_index = iwl_eeprom_band_7;
  430. break;
  431. default:
  432. BUG();
  433. return;
  434. }
  435. }
  436. #define CHECK_AND_PRINT(x) ((eeprom_ch->flags & EEPROM_CHANNEL_##x) \
  437. ? # x " " : "")
  438. /**
  439. * iwl_set_fat_chan_info - Copy fat channel info into driver's priv.
  440. *
  441. * Does not set up a command, or touch hardware.
  442. */
  443. static int iwl_set_fat_chan_info(struct iwl_priv *priv,
  444. enum ieee80211_band band, u16 channel,
  445. const struct iwl_eeprom_channel *eeprom_ch,
  446. u8 fat_extension_channel)
  447. {
  448. struct iwl_channel_info *ch_info;
  449. ch_info = (struct iwl_channel_info *)
  450. iwl_get_channel_info(priv, band, channel);
  451. if (!is_channel_valid(ch_info))
  452. return -1;
  453. IWL_DEBUG_INFO(priv, "FAT Ch. %d [%sGHz] %s%s%s%s%s(0x%02x %ddBm):"
  454. " Ad-Hoc %ssupported\n",
  455. ch_info->channel,
  456. is_channel_a_band(ch_info) ?
  457. "5.2" : "2.4",
  458. CHECK_AND_PRINT(IBSS),
  459. CHECK_AND_PRINT(ACTIVE),
  460. CHECK_AND_PRINT(RADAR),
  461. CHECK_AND_PRINT(WIDE),
  462. CHECK_AND_PRINT(DFS),
  463. eeprom_ch->flags,
  464. eeprom_ch->max_power_avg,
  465. ((eeprom_ch->flags & EEPROM_CHANNEL_IBSS)
  466. && !(eeprom_ch->flags & EEPROM_CHANNEL_RADAR)) ?
  467. "" : "not ");
  468. ch_info->fat_eeprom = *eeprom_ch;
  469. ch_info->fat_max_power_avg = eeprom_ch->max_power_avg;
  470. ch_info->fat_curr_txpow = eeprom_ch->max_power_avg;
  471. ch_info->fat_min_power = 0;
  472. ch_info->fat_scan_power = eeprom_ch->max_power_avg;
  473. ch_info->fat_flags = eeprom_ch->flags;
  474. ch_info->fat_extension_channel = fat_extension_channel;
  475. return 0;
  476. }
  477. #define CHECK_AND_PRINT_I(x) ((eeprom_ch_info[ch].flags & EEPROM_CHANNEL_##x) \
  478. ? # x " " : "")
  479. /**
  480. * iwl_init_channel_map - Set up driver's info for all possible channels
  481. */
  482. int iwl_init_channel_map(struct iwl_priv *priv)
  483. {
  484. int eeprom_ch_count = 0;
  485. const u8 *eeprom_ch_index = NULL;
  486. const struct iwl_eeprom_channel *eeprom_ch_info = NULL;
  487. int band, ch;
  488. struct iwl_channel_info *ch_info;
  489. if (priv->channel_count) {
  490. IWL_DEBUG_INFO(priv, "Channel map already initialized.\n");
  491. return 0;
  492. }
  493. IWL_DEBUG_INFO(priv, "Initializing regulatory info from EEPROM\n");
  494. priv->channel_count =
  495. ARRAY_SIZE(iwl_eeprom_band_1) +
  496. ARRAY_SIZE(iwl_eeprom_band_2) +
  497. ARRAY_SIZE(iwl_eeprom_band_3) +
  498. ARRAY_SIZE(iwl_eeprom_band_4) +
  499. ARRAY_SIZE(iwl_eeprom_band_5);
  500. IWL_DEBUG_INFO(priv, "Parsing data for %d channels.\n", priv->channel_count);
  501. priv->channel_info = kzalloc(sizeof(struct iwl_channel_info) *
  502. priv->channel_count, GFP_KERNEL);
  503. if (!priv->channel_info) {
  504. IWL_ERR(priv, "Could not allocate channel_info\n");
  505. priv->channel_count = 0;
  506. return -ENOMEM;
  507. }
  508. ch_info = priv->channel_info;
  509. /* Loop through the 5 EEPROM bands adding them in order to the
  510. * channel map we maintain (that contains additional information than
  511. * what just in the EEPROM) */
  512. for (band = 1; band <= 5; band++) {
  513. iwl_init_band_reference(priv, band, &eeprom_ch_count,
  514. &eeprom_ch_info, &eeprom_ch_index);
  515. /* Loop through each band adding each of the channels */
  516. for (ch = 0; ch < eeprom_ch_count; ch++) {
  517. ch_info->channel = eeprom_ch_index[ch];
  518. ch_info->band = (band == 1) ? IEEE80211_BAND_2GHZ :
  519. IEEE80211_BAND_5GHZ;
  520. /* permanently store EEPROM's channel regulatory flags
  521. * and max power in channel info database. */
  522. ch_info->eeprom = eeprom_ch_info[ch];
  523. /* Copy the run-time flags so they are there even on
  524. * invalid channels */
  525. ch_info->flags = eeprom_ch_info[ch].flags;
  526. /* First write that fat is not enabled, and then enable
  527. * one by one */
  528. ch_info->fat_extension_channel =
  529. (IEEE80211_CHAN_NO_HT40PLUS |
  530. IEEE80211_CHAN_NO_HT40MINUS);
  531. if (!(is_channel_valid(ch_info))) {
  532. IWL_DEBUG_INFO(priv, "Ch. %d Flags %x [%sGHz] - "
  533. "No traffic\n",
  534. ch_info->channel,
  535. ch_info->flags,
  536. is_channel_a_band(ch_info) ?
  537. "5.2" : "2.4");
  538. ch_info++;
  539. continue;
  540. }
  541. /* Initialize regulatory-based run-time data */
  542. ch_info->max_power_avg = ch_info->curr_txpow =
  543. eeprom_ch_info[ch].max_power_avg;
  544. ch_info->scan_power = eeprom_ch_info[ch].max_power_avg;
  545. ch_info->min_power = 0;
  546. IWL_DEBUG_INFO(priv, "Ch. %d [%sGHz] %s%s%s%s%s%s(0x%02x %ddBm):"
  547. " Ad-Hoc %ssupported\n",
  548. ch_info->channel,
  549. is_channel_a_band(ch_info) ?
  550. "5.2" : "2.4",
  551. CHECK_AND_PRINT_I(VALID),
  552. CHECK_AND_PRINT_I(IBSS),
  553. CHECK_AND_PRINT_I(ACTIVE),
  554. CHECK_AND_PRINT_I(RADAR),
  555. CHECK_AND_PRINT_I(WIDE),
  556. CHECK_AND_PRINT_I(DFS),
  557. eeprom_ch_info[ch].flags,
  558. eeprom_ch_info[ch].max_power_avg,
  559. ((eeprom_ch_info[ch].
  560. flags & EEPROM_CHANNEL_IBSS)
  561. && !(eeprom_ch_info[ch].
  562. flags & EEPROM_CHANNEL_RADAR))
  563. ? "" : "not ");
  564. /* Set the tx_power_user_lmt to the highest power
  565. * supported by any channel */
  566. if (eeprom_ch_info[ch].max_power_avg >
  567. priv->tx_power_user_lmt)
  568. priv->tx_power_user_lmt =
  569. eeprom_ch_info[ch].max_power_avg;
  570. ch_info++;
  571. }
  572. }
  573. /* Check if we do have FAT channels */
  574. if (priv->cfg->ops->lib->eeprom_ops.regulatory_bands[5] ==
  575. EEPROM_REGULATORY_BAND_NO_FAT &&
  576. priv->cfg->ops->lib->eeprom_ops.regulatory_bands[6] ==
  577. EEPROM_REGULATORY_BAND_NO_FAT)
  578. return 0;
  579. /* Two additional EEPROM bands for 2.4 and 5 GHz FAT channels */
  580. for (band = 6; band <= 7; band++) {
  581. enum ieee80211_band ieeeband;
  582. u8 fat_extension_chan;
  583. iwl_init_band_reference(priv, band, &eeprom_ch_count,
  584. &eeprom_ch_info, &eeprom_ch_index);
  585. /* EEPROM band 6 is 2.4, band 7 is 5 GHz */
  586. ieeeband =
  587. (band == 6) ? IEEE80211_BAND_2GHZ : IEEE80211_BAND_5GHZ;
  588. /* Loop through each band adding each of the channels */
  589. for (ch = 0; ch < eeprom_ch_count; ch++) {
  590. if ((band == 6) &&
  591. ((eeprom_ch_index[ch] == 5) ||
  592. (eeprom_ch_index[ch] == 6) ||
  593. (eeprom_ch_index[ch] == 7)))
  594. /* both are allowed: above and below */
  595. fat_extension_chan = 0;
  596. else
  597. fat_extension_chan =
  598. IEEE80211_CHAN_NO_HT40MINUS;
  599. /* Set up driver's info for lower half */
  600. iwl_set_fat_chan_info(priv, ieeeband,
  601. eeprom_ch_index[ch],
  602. &(eeprom_ch_info[ch]),
  603. fat_extension_chan);
  604. /* Set up driver's info for upper half */
  605. iwl_set_fat_chan_info(priv, ieeeband,
  606. (eeprom_ch_index[ch] + 4),
  607. &(eeprom_ch_info[ch]),
  608. IEEE80211_CHAN_NO_HT40PLUS);
  609. }
  610. }
  611. return 0;
  612. }
  613. EXPORT_SYMBOL(iwl_init_channel_map);
  614. /*
  615. * iwl_free_channel_map - undo allocations in iwl_init_channel_map
  616. */
  617. void iwl_free_channel_map(struct iwl_priv *priv)
  618. {
  619. kfree(priv->channel_info);
  620. priv->channel_count = 0;
  621. }
  622. EXPORT_SYMBOL(iwl_free_channel_map);
  623. /**
  624. * iwl_get_channel_info - Find driver's private channel info
  625. *
  626. * Based on band and channel number.
  627. */
  628. const struct iwl_channel_info *iwl_get_channel_info(const struct iwl_priv *priv,
  629. enum ieee80211_band band, u16 channel)
  630. {
  631. int i;
  632. switch (band) {
  633. case IEEE80211_BAND_5GHZ:
  634. for (i = 14; i < priv->channel_count; i++) {
  635. if (priv->channel_info[i].channel == channel)
  636. return &priv->channel_info[i];
  637. }
  638. break;
  639. case IEEE80211_BAND_2GHZ:
  640. if (channel >= 1 && channel <= 14)
  641. return &priv->channel_info[channel - 1];
  642. break;
  643. default:
  644. BUG();
  645. }
  646. return NULL;
  647. }
  648. EXPORT_SYMBOL(iwl_get_channel_info);