cmd.c 7.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254
  1. /*
  2. * This file is part of wl12xx
  3. *
  4. * Copyright (C) 2009-2010 Nokia Corporation
  5. * Copyright (C) 2011 Texas Instruments Inc.
  6. *
  7. * This program is free software; you can redistribute it and/or
  8. * modify it under the terms of the GNU General Public License
  9. * version 2 as published by the Free Software Foundation.
  10. *
  11. * This program is distributed in the hope that it will be useful, but
  12. * WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  14. * General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU General Public License
  17. * along with this program; if not, write to the Free Software
  18. * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  19. * 02110-1301 USA
  20. *
  21. */
  22. #include "../wlcore/cmd.h"
  23. #include "../wlcore/debug.h"
  24. #include "wl12xx.h"
  25. #include "cmd.h"
  26. int wl1271_cmd_ext_radio_parms(struct wl1271 *wl)
  27. {
  28. struct wl1271_ext_radio_parms_cmd *ext_radio_parms;
  29. struct wl12xx_priv *priv = wl->priv;
  30. struct wl12xx_conf_rf *rf = &priv->conf.rf;
  31. int ret;
  32. if (!wl->nvs)
  33. return -ENODEV;
  34. ext_radio_parms = kzalloc(sizeof(*ext_radio_parms), GFP_KERNEL);
  35. if (!ext_radio_parms)
  36. return -ENOMEM;
  37. ext_radio_parms->test.id = TEST_CMD_INI_FILE_RF_EXTENDED_PARAM;
  38. memcpy(ext_radio_parms->tx_per_channel_power_compensation_2,
  39. rf->tx_per_channel_power_compensation_2,
  40. CONF_TX_PWR_COMPENSATION_LEN_2);
  41. memcpy(ext_radio_parms->tx_per_channel_power_compensation_5,
  42. rf->tx_per_channel_power_compensation_5,
  43. CONF_TX_PWR_COMPENSATION_LEN_5);
  44. wl1271_dump(DEBUG_CMD, "TEST_CMD_INI_FILE_EXT_RADIO_PARAM: ",
  45. ext_radio_parms, sizeof(*ext_radio_parms));
  46. ret = wl1271_cmd_test(wl, ext_radio_parms, sizeof(*ext_radio_parms), 0);
  47. if (ret < 0)
  48. wl1271_warning("TEST_CMD_INI_FILE_RF_EXTENDED_PARAM failed");
  49. kfree(ext_radio_parms);
  50. return ret;
  51. }
  52. int wl1271_cmd_general_parms(struct wl1271 *wl)
  53. {
  54. struct wl1271_general_parms_cmd *gen_parms;
  55. struct wl1271_ini_general_params *gp =
  56. &((struct wl1271_nvs_file *)wl->nvs)->general_params;
  57. bool answer = false;
  58. int ret;
  59. if (!wl->nvs)
  60. return -ENODEV;
  61. if (gp->tx_bip_fem_manufacturer >= WL1271_INI_FEM_MODULE_COUNT) {
  62. wl1271_warning("FEM index from INI out of bounds");
  63. return -EINVAL;
  64. }
  65. gen_parms = kzalloc(sizeof(*gen_parms), GFP_KERNEL);
  66. if (!gen_parms)
  67. return -ENOMEM;
  68. gen_parms->test.id = TEST_CMD_INI_FILE_GENERAL_PARAM;
  69. memcpy(&gen_parms->general_params, gp, sizeof(*gp));
  70. if (gp->tx_bip_fem_auto_detect)
  71. answer = true;
  72. /* Override the REF CLK from the NVS with the one from platform data */
  73. gen_parms->general_params.ref_clock = wl->ref_clock;
  74. ret = wl1271_cmd_test(wl, gen_parms, sizeof(*gen_parms), answer);
  75. if (ret < 0) {
  76. wl1271_warning("CMD_INI_FILE_GENERAL_PARAM failed");
  77. goto out;
  78. }
  79. gp->tx_bip_fem_manufacturer =
  80. gen_parms->general_params.tx_bip_fem_manufacturer;
  81. if (gp->tx_bip_fem_manufacturer >= WL1271_INI_FEM_MODULE_COUNT) {
  82. wl1271_warning("FEM index from FW out of bounds");
  83. ret = -EINVAL;
  84. goto out;
  85. }
  86. wl1271_debug(DEBUG_CMD, "FEM autodetect: %s, manufacturer: %d\n",
  87. answer ? "auto" : "manual", gp->tx_bip_fem_manufacturer);
  88. out:
  89. kfree(gen_parms);
  90. return ret;
  91. }
  92. int wl128x_cmd_general_parms(struct wl1271 *wl)
  93. {
  94. struct wl128x_general_parms_cmd *gen_parms;
  95. struct wl128x_ini_general_params *gp =
  96. &((struct wl128x_nvs_file *)wl->nvs)->general_params;
  97. bool answer = false;
  98. int ret;
  99. if (!wl->nvs)
  100. return -ENODEV;
  101. if (gp->tx_bip_fem_manufacturer >= WL1271_INI_FEM_MODULE_COUNT) {
  102. wl1271_warning("FEM index from ini out of bounds");
  103. return -EINVAL;
  104. }
  105. gen_parms = kzalloc(sizeof(*gen_parms), GFP_KERNEL);
  106. if (!gen_parms)
  107. return -ENOMEM;
  108. gen_parms->test.id = TEST_CMD_INI_FILE_GENERAL_PARAM;
  109. memcpy(&gen_parms->general_params, gp, sizeof(*gp));
  110. if (gp->tx_bip_fem_auto_detect)
  111. answer = true;
  112. /* Replace REF and TCXO CLKs with the ones from platform data */
  113. gen_parms->general_params.ref_clock = wl->ref_clock;
  114. gen_parms->general_params.tcxo_ref_clock = wl->tcxo_clock;
  115. ret = wl1271_cmd_test(wl, gen_parms, sizeof(*gen_parms), answer);
  116. if (ret < 0) {
  117. wl1271_warning("CMD_INI_FILE_GENERAL_PARAM failed");
  118. goto out;
  119. }
  120. gp->tx_bip_fem_manufacturer =
  121. gen_parms->general_params.tx_bip_fem_manufacturer;
  122. if (gp->tx_bip_fem_manufacturer >= WL1271_INI_FEM_MODULE_COUNT) {
  123. wl1271_warning("FEM index from FW out of bounds");
  124. ret = -EINVAL;
  125. goto out;
  126. }
  127. wl1271_debug(DEBUG_CMD, "FEM autodetect: %s, manufacturer: %d\n",
  128. answer ? "auto" : "manual", gp->tx_bip_fem_manufacturer);
  129. out:
  130. kfree(gen_parms);
  131. return ret;
  132. }
  133. int wl1271_cmd_radio_parms(struct wl1271 *wl)
  134. {
  135. struct wl1271_nvs_file *nvs = (struct wl1271_nvs_file *)wl->nvs;
  136. struct wl1271_radio_parms_cmd *radio_parms;
  137. struct wl1271_ini_general_params *gp = &nvs->general_params;
  138. int ret;
  139. if (!wl->nvs)
  140. return -ENODEV;
  141. radio_parms = kzalloc(sizeof(*radio_parms), GFP_KERNEL);
  142. if (!radio_parms)
  143. return -ENOMEM;
  144. radio_parms->test.id = TEST_CMD_INI_FILE_RADIO_PARAM;
  145. /* 2.4GHz parameters */
  146. memcpy(&radio_parms->static_params_2, &nvs->stat_radio_params_2,
  147. sizeof(struct wl1271_ini_band_params_2));
  148. memcpy(&radio_parms->dyn_params_2,
  149. &nvs->dyn_radio_params_2[gp->tx_bip_fem_manufacturer].params,
  150. sizeof(struct wl1271_ini_fem_params_2));
  151. /* 5GHz parameters */
  152. memcpy(&radio_parms->static_params_5,
  153. &nvs->stat_radio_params_5,
  154. sizeof(struct wl1271_ini_band_params_5));
  155. memcpy(&radio_parms->dyn_params_5,
  156. &nvs->dyn_radio_params_5[gp->tx_bip_fem_manufacturer].params,
  157. sizeof(struct wl1271_ini_fem_params_5));
  158. wl1271_dump(DEBUG_CMD, "TEST_CMD_INI_FILE_RADIO_PARAM: ",
  159. radio_parms, sizeof(*radio_parms));
  160. ret = wl1271_cmd_test(wl, radio_parms, sizeof(*radio_parms), 0);
  161. if (ret < 0)
  162. wl1271_warning("CMD_INI_FILE_RADIO_PARAM failed");
  163. kfree(radio_parms);
  164. return ret;
  165. }
  166. int wl128x_cmd_radio_parms(struct wl1271 *wl)
  167. {
  168. struct wl128x_nvs_file *nvs = (struct wl128x_nvs_file *)wl->nvs;
  169. struct wl128x_radio_parms_cmd *radio_parms;
  170. struct wl128x_ini_general_params *gp = &nvs->general_params;
  171. int ret;
  172. if (!wl->nvs)
  173. return -ENODEV;
  174. radio_parms = kzalloc(sizeof(*radio_parms), GFP_KERNEL);
  175. if (!radio_parms)
  176. return -ENOMEM;
  177. radio_parms->test.id = TEST_CMD_INI_FILE_RADIO_PARAM;
  178. /* 2.4GHz parameters */
  179. memcpy(&radio_parms->static_params_2, &nvs->stat_radio_params_2,
  180. sizeof(struct wl128x_ini_band_params_2));
  181. memcpy(&radio_parms->dyn_params_2,
  182. &nvs->dyn_radio_params_2[gp->tx_bip_fem_manufacturer].params,
  183. sizeof(struct wl128x_ini_fem_params_2));
  184. /* 5GHz parameters */
  185. memcpy(&radio_parms->static_params_5,
  186. &nvs->stat_radio_params_5,
  187. sizeof(struct wl128x_ini_band_params_5));
  188. memcpy(&radio_parms->dyn_params_5,
  189. &nvs->dyn_radio_params_5[gp->tx_bip_fem_manufacturer].params,
  190. sizeof(struct wl128x_ini_fem_params_5));
  191. radio_parms->fem_vendor_and_options = nvs->fem_vendor_and_options;
  192. wl1271_dump(DEBUG_CMD, "TEST_CMD_INI_FILE_RADIO_PARAM: ",
  193. radio_parms, sizeof(*radio_parms));
  194. ret = wl1271_cmd_test(wl, radio_parms, sizeof(*radio_parms), 0);
  195. if (ret < 0)
  196. wl1271_warning("CMD_INI_FILE_RADIO_PARAM failed");
  197. kfree(radio_parms);
  198. return ret;
  199. }