uap_cmd.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552
  1. /*
  2. * Marvell Wireless LAN device driver: AP specific command handling
  3. *
  4. * Copyright (C) 2012, Marvell International Ltd.
  5. *
  6. * This software file (the "File") is distributed by Marvell International
  7. * Ltd. under the terms of the GNU General Public License Version 2, June 1991
  8. * (the "License"). You may use, redistribute and/or modify this File in
  9. * accordance with the terms and conditions of the License, a copy of which
  10. * is available by writing to the Free Software Foundation, Inc.,
  11. * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
  12. * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
  13. *
  14. * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
  15. * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
  16. * ARE EXPRESSLY DISCLAIMED. The License provides additional details about
  17. * this warranty disclaimer.
  18. */
  19. #include "main.h"
  20. /* This function parses security related parameters from cfg80211_ap_settings
  21. * and sets into FW understandable bss_config structure.
  22. */
  23. int mwifiex_set_secure_params(struct mwifiex_private *priv,
  24. struct mwifiex_uap_bss_param *bss_config,
  25. struct cfg80211_ap_settings *params) {
  26. int i;
  27. struct mwifiex_wep_key wep_key;
  28. if (!params->privacy) {
  29. bss_config->protocol = PROTOCOL_NO_SECURITY;
  30. bss_config->key_mgmt = KEY_MGMT_NONE;
  31. bss_config->wpa_cfg.length = 0;
  32. priv->sec_info.wep_enabled = 0;
  33. priv->sec_info.wpa_enabled = 0;
  34. priv->sec_info.wpa2_enabled = 0;
  35. return 0;
  36. }
  37. switch (params->auth_type) {
  38. case NL80211_AUTHTYPE_OPEN_SYSTEM:
  39. bss_config->auth_mode = WLAN_AUTH_OPEN;
  40. break;
  41. case NL80211_AUTHTYPE_SHARED_KEY:
  42. bss_config->auth_mode = WLAN_AUTH_SHARED_KEY;
  43. break;
  44. case NL80211_AUTHTYPE_NETWORK_EAP:
  45. bss_config->auth_mode = WLAN_AUTH_LEAP;
  46. break;
  47. default:
  48. bss_config->auth_mode = MWIFIEX_AUTH_MODE_AUTO;
  49. break;
  50. }
  51. bss_config->key_mgmt_operation |= KEY_MGMT_ON_HOST;
  52. for (i = 0; i < params->crypto.n_akm_suites; i++) {
  53. switch (params->crypto.akm_suites[i]) {
  54. case WLAN_AKM_SUITE_8021X:
  55. if (params->crypto.wpa_versions &
  56. NL80211_WPA_VERSION_1) {
  57. bss_config->protocol = PROTOCOL_WPA;
  58. bss_config->key_mgmt = KEY_MGMT_EAP;
  59. }
  60. if (params->crypto.wpa_versions &
  61. NL80211_WPA_VERSION_2) {
  62. bss_config->protocol |= PROTOCOL_WPA2;
  63. bss_config->key_mgmt = KEY_MGMT_EAP;
  64. }
  65. break;
  66. case WLAN_AKM_SUITE_PSK:
  67. if (params->crypto.wpa_versions &
  68. NL80211_WPA_VERSION_1) {
  69. bss_config->protocol = PROTOCOL_WPA;
  70. bss_config->key_mgmt = KEY_MGMT_PSK;
  71. }
  72. if (params->crypto.wpa_versions &
  73. NL80211_WPA_VERSION_2) {
  74. bss_config->protocol |= PROTOCOL_WPA2;
  75. bss_config->key_mgmt = KEY_MGMT_PSK;
  76. }
  77. break;
  78. default:
  79. break;
  80. }
  81. }
  82. for (i = 0; i < params->crypto.n_ciphers_pairwise; i++) {
  83. switch (params->crypto.ciphers_pairwise[i]) {
  84. case WLAN_CIPHER_SUITE_WEP40:
  85. case WLAN_CIPHER_SUITE_WEP104:
  86. break;
  87. case WLAN_CIPHER_SUITE_TKIP:
  88. if (params->crypto.wpa_versions & NL80211_WPA_VERSION_1)
  89. bss_config->wpa_cfg.pairwise_cipher_wpa |=
  90. CIPHER_TKIP;
  91. if (params->crypto.wpa_versions & NL80211_WPA_VERSION_2)
  92. bss_config->wpa_cfg.pairwise_cipher_wpa2 |=
  93. CIPHER_TKIP;
  94. break;
  95. case WLAN_CIPHER_SUITE_CCMP:
  96. if (params->crypto.wpa_versions & NL80211_WPA_VERSION_1)
  97. bss_config->wpa_cfg.pairwise_cipher_wpa |=
  98. CIPHER_AES_CCMP;
  99. if (params->crypto.wpa_versions & NL80211_WPA_VERSION_2)
  100. bss_config->wpa_cfg.pairwise_cipher_wpa2 |=
  101. CIPHER_AES_CCMP;
  102. default:
  103. break;
  104. }
  105. }
  106. switch (params->crypto.cipher_group) {
  107. case WLAN_CIPHER_SUITE_WEP40:
  108. case WLAN_CIPHER_SUITE_WEP104:
  109. if (priv->sec_info.wep_enabled) {
  110. bss_config->protocol = PROTOCOL_STATIC_WEP;
  111. bss_config->key_mgmt = KEY_MGMT_NONE;
  112. bss_config->wpa_cfg.length = 0;
  113. for (i = 0; i < NUM_WEP_KEYS; i++) {
  114. wep_key = priv->wep_key[i];
  115. bss_config->wep_cfg[i].key_index = i;
  116. if (priv->wep_key_curr_index == i)
  117. bss_config->wep_cfg[i].is_default = 1;
  118. else
  119. bss_config->wep_cfg[i].is_default = 0;
  120. bss_config->wep_cfg[i].length =
  121. wep_key.key_length;
  122. memcpy(&bss_config->wep_cfg[i].key,
  123. &wep_key.key_material,
  124. wep_key.key_length);
  125. }
  126. }
  127. break;
  128. case WLAN_CIPHER_SUITE_TKIP:
  129. bss_config->wpa_cfg.group_cipher = CIPHER_TKIP;
  130. break;
  131. case WLAN_CIPHER_SUITE_CCMP:
  132. bss_config->wpa_cfg.group_cipher = CIPHER_AES_CCMP;
  133. break;
  134. default:
  135. break;
  136. }
  137. return 0;
  138. }
  139. /* This function updates 11n related parameters from IE and sets them into
  140. * bss_config structure.
  141. */
  142. void
  143. mwifiex_set_ht_params(struct mwifiex_private *priv,
  144. struct mwifiex_uap_bss_param *bss_cfg,
  145. struct cfg80211_ap_settings *params)
  146. {
  147. const u8 *ht_ie;
  148. if (!ISSUPP_11NENABLED(priv->adapter->fw_cap_info))
  149. return;
  150. ht_ie = cfg80211_find_ie(WLAN_EID_HT_CAPABILITY, params->beacon.tail,
  151. params->beacon.tail_len);
  152. if (ht_ie) {
  153. memcpy(&bss_cfg->ht_cap, ht_ie + 2,
  154. sizeof(struct ieee80211_ht_cap));
  155. } else {
  156. memset(&bss_cfg->ht_cap , 0, sizeof(struct ieee80211_ht_cap));
  157. bss_cfg->ht_cap.cap_info = cpu_to_le16(MWIFIEX_DEF_HT_CAP);
  158. bss_cfg->ht_cap.ampdu_params_info = MWIFIEX_DEF_AMPDU;
  159. }
  160. return;
  161. }
  162. /* This function initializes some of mwifiex_uap_bss_param variables.
  163. * This helps FW in ignoring invalid values. These values may or may not
  164. * be get updated to valid ones at later stage.
  165. */
  166. void mwifiex_set_sys_config_invalid_data(struct mwifiex_uap_bss_param *config)
  167. {
  168. config->bcast_ssid_ctl = 0x7F;
  169. config->radio_ctl = 0x7F;
  170. config->dtim_period = 0x7F;
  171. config->beacon_period = 0x7FFF;
  172. config->auth_mode = 0x7F;
  173. config->rts_threshold = 0x7FFF;
  174. config->frag_threshold = 0x7FFF;
  175. config->retry_limit = 0x7F;
  176. }
  177. /* This function parses BSS related parameters from structure
  178. * and prepares TLVs specific to WPA/WPA2 security.
  179. * These TLVs are appended to command buffer.
  180. */
  181. static void
  182. mwifiex_uap_bss_wpa(u8 **tlv_buf, void *cmd_buf, u16 *param_size)
  183. {
  184. struct host_cmd_tlv_pwk_cipher *pwk_cipher;
  185. struct host_cmd_tlv_gwk_cipher *gwk_cipher;
  186. struct host_cmd_tlv_passphrase *passphrase;
  187. struct host_cmd_tlv_akmp *tlv_akmp;
  188. struct mwifiex_uap_bss_param *bss_cfg = cmd_buf;
  189. u16 cmd_size = *param_size;
  190. u8 *tlv = *tlv_buf;
  191. tlv_akmp = (struct host_cmd_tlv_akmp *)tlv;
  192. tlv_akmp->tlv.type = cpu_to_le16(TLV_TYPE_UAP_AKMP);
  193. tlv_akmp->tlv.len = cpu_to_le16(sizeof(struct host_cmd_tlv_akmp) -
  194. sizeof(struct host_cmd_tlv));
  195. tlv_akmp->key_mgmt_operation = cpu_to_le16(bss_cfg->key_mgmt_operation);
  196. tlv_akmp->key_mgmt = cpu_to_le16(bss_cfg->key_mgmt);
  197. cmd_size += sizeof(struct host_cmd_tlv_akmp);
  198. tlv += sizeof(struct host_cmd_tlv_akmp);
  199. if (bss_cfg->wpa_cfg.pairwise_cipher_wpa & VALID_CIPHER_BITMAP) {
  200. pwk_cipher = (struct host_cmd_tlv_pwk_cipher *)tlv;
  201. pwk_cipher->tlv.type = cpu_to_le16(TLV_TYPE_PWK_CIPHER);
  202. pwk_cipher->tlv.len =
  203. cpu_to_le16(sizeof(struct host_cmd_tlv_pwk_cipher) -
  204. sizeof(struct host_cmd_tlv));
  205. pwk_cipher->proto = cpu_to_le16(PROTOCOL_WPA);
  206. pwk_cipher->cipher = bss_cfg->wpa_cfg.pairwise_cipher_wpa;
  207. cmd_size += sizeof(struct host_cmd_tlv_pwk_cipher);
  208. tlv += sizeof(struct host_cmd_tlv_pwk_cipher);
  209. }
  210. if (bss_cfg->wpa_cfg.pairwise_cipher_wpa2 & VALID_CIPHER_BITMAP) {
  211. pwk_cipher = (struct host_cmd_tlv_pwk_cipher *)tlv;
  212. pwk_cipher->tlv.type = cpu_to_le16(TLV_TYPE_PWK_CIPHER);
  213. pwk_cipher->tlv.len =
  214. cpu_to_le16(sizeof(struct host_cmd_tlv_pwk_cipher) -
  215. sizeof(struct host_cmd_tlv));
  216. pwk_cipher->proto = cpu_to_le16(PROTOCOL_WPA2);
  217. pwk_cipher->cipher = bss_cfg->wpa_cfg.pairwise_cipher_wpa2;
  218. cmd_size += sizeof(struct host_cmd_tlv_pwk_cipher);
  219. tlv += sizeof(struct host_cmd_tlv_pwk_cipher);
  220. }
  221. if (bss_cfg->wpa_cfg.group_cipher & VALID_CIPHER_BITMAP) {
  222. gwk_cipher = (struct host_cmd_tlv_gwk_cipher *)tlv;
  223. gwk_cipher->tlv.type = cpu_to_le16(TLV_TYPE_GWK_CIPHER);
  224. gwk_cipher->tlv.len =
  225. cpu_to_le16(sizeof(struct host_cmd_tlv_gwk_cipher) -
  226. sizeof(struct host_cmd_tlv));
  227. gwk_cipher->cipher = bss_cfg->wpa_cfg.group_cipher;
  228. cmd_size += sizeof(struct host_cmd_tlv_gwk_cipher);
  229. tlv += sizeof(struct host_cmd_tlv_gwk_cipher);
  230. }
  231. if (bss_cfg->wpa_cfg.length) {
  232. passphrase = (struct host_cmd_tlv_passphrase *)tlv;
  233. passphrase->tlv.type = cpu_to_le16(TLV_TYPE_UAP_WPA_PASSPHRASE);
  234. passphrase->tlv.len = cpu_to_le16(bss_cfg->wpa_cfg.length);
  235. memcpy(passphrase->passphrase, bss_cfg->wpa_cfg.passphrase,
  236. bss_cfg->wpa_cfg.length);
  237. cmd_size += sizeof(struct host_cmd_tlv) +
  238. bss_cfg->wpa_cfg.length;
  239. tlv += sizeof(struct host_cmd_tlv) + bss_cfg->wpa_cfg.length;
  240. }
  241. *param_size = cmd_size;
  242. *tlv_buf = tlv;
  243. return;
  244. }
  245. /* This function parses BSS related parameters from structure
  246. * and prepares TLVs specific to WEP encryption.
  247. * These TLVs are appended to command buffer.
  248. */
  249. static void
  250. mwifiex_uap_bss_wep(u8 **tlv_buf, void *cmd_buf, u16 *param_size)
  251. {
  252. struct host_cmd_tlv_wep_key *wep_key;
  253. u16 cmd_size = *param_size;
  254. int i;
  255. u8 *tlv = *tlv_buf;
  256. struct mwifiex_uap_bss_param *bss_cfg = cmd_buf;
  257. for (i = 0; i < NUM_WEP_KEYS; i++) {
  258. if (bss_cfg->wep_cfg[i].length &&
  259. (bss_cfg->wep_cfg[i].length == WLAN_KEY_LEN_WEP40 ||
  260. bss_cfg->wep_cfg[i].length == WLAN_KEY_LEN_WEP104)) {
  261. wep_key = (struct host_cmd_tlv_wep_key *)tlv;
  262. wep_key->tlv.type = cpu_to_le16(TLV_TYPE_UAP_WEP_KEY);
  263. wep_key->tlv.len =
  264. cpu_to_le16(bss_cfg->wep_cfg[i].length + 2);
  265. wep_key->key_index = bss_cfg->wep_cfg[i].key_index;
  266. wep_key->is_default = bss_cfg->wep_cfg[i].is_default;
  267. memcpy(wep_key->key, bss_cfg->wep_cfg[i].key,
  268. bss_cfg->wep_cfg[i].length);
  269. cmd_size += sizeof(struct host_cmd_tlv) + 2 +
  270. bss_cfg->wep_cfg[i].length;
  271. tlv += sizeof(struct host_cmd_tlv) + 2 +
  272. bss_cfg->wep_cfg[i].length;
  273. }
  274. }
  275. *param_size = cmd_size;
  276. *tlv_buf = tlv;
  277. return;
  278. }
  279. /* This function parses BSS related parameters from structure
  280. * and prepares TLVs. These TLVs are appended to command buffer.
  281. */
  282. static int
  283. mwifiex_uap_bss_param_prepare(u8 *tlv, void *cmd_buf, u16 *param_size)
  284. {
  285. struct host_cmd_tlv_dtim_period *dtim_period;
  286. struct host_cmd_tlv_beacon_period *beacon_period;
  287. struct host_cmd_tlv_ssid *ssid;
  288. struct host_cmd_tlv_bcast_ssid *bcast_ssid;
  289. struct host_cmd_tlv_channel_band *chan_band;
  290. struct host_cmd_tlv_frag_threshold *frag_threshold;
  291. struct host_cmd_tlv_rts_threshold *rts_threshold;
  292. struct host_cmd_tlv_retry_limit *retry_limit;
  293. struct host_cmd_tlv_encrypt_protocol *encrypt_protocol;
  294. struct host_cmd_tlv_auth_type *auth_type;
  295. struct mwifiex_ie_types_htcap *htcap;
  296. struct mwifiex_uap_bss_param *bss_cfg = cmd_buf;
  297. u16 cmd_size = *param_size;
  298. if (bss_cfg->ssid.ssid_len) {
  299. ssid = (struct host_cmd_tlv_ssid *)tlv;
  300. ssid->tlv.type = cpu_to_le16(TLV_TYPE_UAP_SSID);
  301. ssid->tlv.len = cpu_to_le16((u16)bss_cfg->ssid.ssid_len);
  302. memcpy(ssid->ssid, bss_cfg->ssid.ssid, bss_cfg->ssid.ssid_len);
  303. cmd_size += sizeof(struct host_cmd_tlv) +
  304. bss_cfg->ssid.ssid_len;
  305. tlv += sizeof(struct host_cmd_tlv) + bss_cfg->ssid.ssid_len;
  306. bcast_ssid = (struct host_cmd_tlv_bcast_ssid *)tlv;
  307. bcast_ssid->tlv.type = cpu_to_le16(TLV_TYPE_UAP_BCAST_SSID);
  308. bcast_ssid->tlv.len =
  309. cpu_to_le16(sizeof(bcast_ssid->bcast_ctl));
  310. bcast_ssid->bcast_ctl = bss_cfg->bcast_ssid_ctl;
  311. cmd_size += sizeof(struct host_cmd_tlv_bcast_ssid);
  312. tlv += sizeof(struct host_cmd_tlv_bcast_ssid);
  313. }
  314. if (bss_cfg->channel && bss_cfg->channel <= MAX_CHANNEL_BAND_BG) {
  315. chan_band = (struct host_cmd_tlv_channel_band *)tlv;
  316. chan_band->tlv.type = cpu_to_le16(TLV_TYPE_CHANNELBANDLIST);
  317. chan_band->tlv.len =
  318. cpu_to_le16(sizeof(struct host_cmd_tlv_channel_band) -
  319. sizeof(struct host_cmd_tlv));
  320. chan_band->band_config = bss_cfg->band_cfg;
  321. chan_band->channel = bss_cfg->channel;
  322. cmd_size += sizeof(struct host_cmd_tlv_channel_band);
  323. tlv += sizeof(struct host_cmd_tlv_channel_band);
  324. }
  325. if (bss_cfg->beacon_period >= MIN_BEACON_PERIOD &&
  326. bss_cfg->beacon_period <= MAX_BEACON_PERIOD) {
  327. beacon_period = (struct host_cmd_tlv_beacon_period *)tlv;
  328. beacon_period->tlv.type =
  329. cpu_to_le16(TLV_TYPE_UAP_BEACON_PERIOD);
  330. beacon_period->tlv.len =
  331. cpu_to_le16(sizeof(struct host_cmd_tlv_beacon_period) -
  332. sizeof(struct host_cmd_tlv));
  333. beacon_period->period = cpu_to_le16(bss_cfg->beacon_period);
  334. cmd_size += sizeof(struct host_cmd_tlv_beacon_period);
  335. tlv += sizeof(struct host_cmd_tlv_beacon_period);
  336. }
  337. if (bss_cfg->dtim_period >= MIN_DTIM_PERIOD &&
  338. bss_cfg->dtim_period <= MAX_DTIM_PERIOD) {
  339. dtim_period = (struct host_cmd_tlv_dtim_period *)tlv;
  340. dtim_period->tlv.type = cpu_to_le16(TLV_TYPE_UAP_DTIM_PERIOD);
  341. dtim_period->tlv.len =
  342. cpu_to_le16(sizeof(struct host_cmd_tlv_dtim_period) -
  343. sizeof(struct host_cmd_tlv));
  344. dtim_period->period = bss_cfg->dtim_period;
  345. cmd_size += sizeof(struct host_cmd_tlv_dtim_period);
  346. tlv += sizeof(struct host_cmd_tlv_dtim_period);
  347. }
  348. if (bss_cfg->rts_threshold <= MWIFIEX_RTS_MAX_VALUE) {
  349. rts_threshold = (struct host_cmd_tlv_rts_threshold *)tlv;
  350. rts_threshold->tlv.type =
  351. cpu_to_le16(TLV_TYPE_UAP_RTS_THRESHOLD);
  352. rts_threshold->tlv.len =
  353. cpu_to_le16(sizeof(struct host_cmd_tlv_rts_threshold) -
  354. sizeof(struct host_cmd_tlv));
  355. rts_threshold->rts_thr = cpu_to_le16(bss_cfg->rts_threshold);
  356. cmd_size += sizeof(struct host_cmd_tlv_frag_threshold);
  357. tlv += sizeof(struct host_cmd_tlv_frag_threshold);
  358. }
  359. if ((bss_cfg->frag_threshold >= MWIFIEX_FRAG_MIN_VALUE) &&
  360. (bss_cfg->frag_threshold <= MWIFIEX_FRAG_MAX_VALUE)) {
  361. frag_threshold = (struct host_cmd_tlv_frag_threshold *)tlv;
  362. frag_threshold->tlv.type =
  363. cpu_to_le16(TLV_TYPE_UAP_FRAG_THRESHOLD);
  364. frag_threshold->tlv.len =
  365. cpu_to_le16(sizeof(struct host_cmd_tlv_frag_threshold) -
  366. sizeof(struct host_cmd_tlv));
  367. frag_threshold->frag_thr = cpu_to_le16(bss_cfg->frag_threshold);
  368. cmd_size += sizeof(struct host_cmd_tlv_frag_threshold);
  369. tlv += sizeof(struct host_cmd_tlv_frag_threshold);
  370. }
  371. if (bss_cfg->retry_limit <= MWIFIEX_RETRY_LIMIT) {
  372. retry_limit = (struct host_cmd_tlv_retry_limit *)tlv;
  373. retry_limit->tlv.type = cpu_to_le16(TLV_TYPE_UAP_RETRY_LIMIT);
  374. retry_limit->tlv.len =
  375. cpu_to_le16(sizeof(struct host_cmd_tlv_retry_limit) -
  376. sizeof(struct host_cmd_tlv));
  377. retry_limit->limit = (u8)bss_cfg->retry_limit;
  378. cmd_size += sizeof(struct host_cmd_tlv_retry_limit);
  379. tlv += sizeof(struct host_cmd_tlv_retry_limit);
  380. }
  381. if ((bss_cfg->protocol & PROTOCOL_WPA) ||
  382. (bss_cfg->protocol & PROTOCOL_WPA2) ||
  383. (bss_cfg->protocol & PROTOCOL_EAP))
  384. mwifiex_uap_bss_wpa(&tlv, cmd_buf, &cmd_size);
  385. else
  386. mwifiex_uap_bss_wep(&tlv, cmd_buf, &cmd_size);
  387. if ((bss_cfg->auth_mode <= WLAN_AUTH_SHARED_KEY) ||
  388. (bss_cfg->auth_mode == MWIFIEX_AUTH_MODE_AUTO)) {
  389. auth_type = (struct host_cmd_tlv_auth_type *)tlv;
  390. auth_type->tlv.type = cpu_to_le16(TLV_TYPE_AUTH_TYPE);
  391. auth_type->tlv.len =
  392. cpu_to_le16(sizeof(struct host_cmd_tlv_auth_type) -
  393. sizeof(struct host_cmd_tlv));
  394. auth_type->auth_type = (u8)bss_cfg->auth_mode;
  395. cmd_size += sizeof(struct host_cmd_tlv_auth_type);
  396. tlv += sizeof(struct host_cmd_tlv_auth_type);
  397. }
  398. if (bss_cfg->protocol) {
  399. encrypt_protocol = (struct host_cmd_tlv_encrypt_protocol *)tlv;
  400. encrypt_protocol->tlv.type =
  401. cpu_to_le16(TLV_TYPE_UAP_ENCRY_PROTOCOL);
  402. encrypt_protocol->tlv.len =
  403. cpu_to_le16(sizeof(struct host_cmd_tlv_encrypt_protocol)
  404. - sizeof(struct host_cmd_tlv));
  405. encrypt_protocol->proto = cpu_to_le16(bss_cfg->protocol);
  406. cmd_size += sizeof(struct host_cmd_tlv_encrypt_protocol);
  407. tlv += sizeof(struct host_cmd_tlv_encrypt_protocol);
  408. }
  409. if (bss_cfg->ht_cap.cap_info) {
  410. htcap = (struct mwifiex_ie_types_htcap *)tlv;
  411. htcap->header.type = cpu_to_le16(WLAN_EID_HT_CAPABILITY);
  412. htcap->header.len =
  413. cpu_to_le16(sizeof(struct ieee80211_ht_cap));
  414. htcap->ht_cap.cap_info = bss_cfg->ht_cap.cap_info;
  415. htcap->ht_cap.ampdu_params_info =
  416. bss_cfg->ht_cap.ampdu_params_info;
  417. memcpy(&htcap->ht_cap.mcs, &bss_cfg->ht_cap.mcs,
  418. sizeof(struct ieee80211_mcs_info));
  419. htcap->ht_cap.extended_ht_cap_info =
  420. bss_cfg->ht_cap.extended_ht_cap_info;
  421. htcap->ht_cap.tx_BF_cap_info = bss_cfg->ht_cap.tx_BF_cap_info;
  422. htcap->ht_cap.antenna_selection_info =
  423. bss_cfg->ht_cap.antenna_selection_info;
  424. cmd_size += sizeof(struct mwifiex_ie_types_htcap);
  425. tlv += sizeof(struct mwifiex_ie_types_htcap);
  426. }
  427. *param_size = cmd_size;
  428. return 0;
  429. }
  430. /* This function parses custom IEs from IE list and prepares command buffer */
  431. static int mwifiex_uap_custom_ie_prepare(u8 *tlv, void *cmd_buf, u16 *ie_size)
  432. {
  433. struct mwifiex_ie_list *ap_ie = cmd_buf;
  434. struct host_cmd_tlv *tlv_ie = (struct host_cmd_tlv *)tlv;
  435. if (!ap_ie || !ap_ie->len || !ap_ie->ie_list)
  436. return -1;
  437. *ie_size += le16_to_cpu(ap_ie->len) + sizeof(struct host_cmd_tlv);
  438. tlv_ie->type = cpu_to_le16(TLV_TYPE_MGMT_IE);
  439. tlv_ie->len = ap_ie->len;
  440. tlv += sizeof(struct host_cmd_tlv);
  441. memcpy(tlv, ap_ie->ie_list, le16_to_cpu(ap_ie->len));
  442. return 0;
  443. }
  444. /* Parse AP config structure and prepare TLV based command structure
  445. * to be sent to FW for uAP configuration
  446. */
  447. static int
  448. mwifiex_cmd_uap_sys_config(struct host_cmd_ds_command *cmd, u16 cmd_action,
  449. u32 type, void *cmd_buf)
  450. {
  451. u8 *tlv;
  452. u16 cmd_size, param_size, ie_size;
  453. struct host_cmd_ds_sys_config *sys_cfg;
  454. cmd->command = cpu_to_le16(HostCmd_CMD_UAP_SYS_CONFIG);
  455. cmd_size = (u16)(sizeof(struct host_cmd_ds_sys_config) + S_DS_GEN);
  456. sys_cfg = (struct host_cmd_ds_sys_config *)&cmd->params.uap_sys_config;
  457. sys_cfg->action = cpu_to_le16(cmd_action);
  458. tlv = sys_cfg->tlv;
  459. switch (type) {
  460. case UAP_BSS_PARAMS_I:
  461. param_size = cmd_size;
  462. if (mwifiex_uap_bss_param_prepare(tlv, cmd_buf, &param_size))
  463. return -1;
  464. cmd->size = cpu_to_le16(param_size);
  465. break;
  466. case UAP_CUSTOM_IE_I:
  467. ie_size = cmd_size;
  468. if (mwifiex_uap_custom_ie_prepare(tlv, cmd_buf, &ie_size))
  469. return -1;
  470. cmd->size = cpu_to_le16(ie_size);
  471. break;
  472. default:
  473. return -1;
  474. }
  475. return 0;
  476. }
  477. /* This function prepares the AP specific commands before sending them
  478. * to the firmware.
  479. * This is a generic function which calls specific command preparation
  480. * routines based upon the command number.
  481. */
  482. int mwifiex_uap_prepare_cmd(struct mwifiex_private *priv, u16 cmd_no,
  483. u16 cmd_action, u32 type,
  484. void *data_buf, void *cmd_buf)
  485. {
  486. struct host_cmd_ds_command *cmd = cmd_buf;
  487. switch (cmd_no) {
  488. case HostCmd_CMD_UAP_SYS_CONFIG:
  489. if (mwifiex_cmd_uap_sys_config(cmd, cmd_action, type, data_buf))
  490. return -1;
  491. break;
  492. case HostCmd_CMD_UAP_BSS_START:
  493. case HostCmd_CMD_UAP_BSS_STOP:
  494. cmd->command = cpu_to_le16(cmd_no);
  495. cmd->size = cpu_to_le16(S_DS_GEN);
  496. break;
  497. default:
  498. dev_err(priv->adapter->dev,
  499. "PREP_CMD: unknown cmd %#x\n", cmd_no);
  500. return -1;
  501. }
  502. return 0;
  503. }