ioctl.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658
  1. /*
  2. * Copyright (c) 1996, 2003 VIA Networking Technologies, Inc.
  3. * All rights reserved.
  4. *
  5. * This program is free software; you can redistribute it and/or modify
  6. * it under the terms of the GNU General Public License as published by
  7. * the Free Software Foundation; either version 2 of the License, or
  8. * (at your option) any later version.
  9. *
  10. * This program is distributed in the hope that it will be useful,
  11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. * GNU General Public License for more details.
  14. *
  15. * You should have received a copy of the GNU General Public License along
  16. * with this program; if not, write to the Free Software Foundation, Inc.,
  17. * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  18. *
  19. * File: ioctl.c
  20. *
  21. * Purpose: private ioctl functions
  22. *
  23. * Author: Lyndon Chen
  24. *
  25. * Date: Auguest 20, 2003
  26. *
  27. * Functions:
  28. *
  29. * Revision History:
  30. *
  31. */
  32. #include "ioctl.h"
  33. #include "iocmd.h"
  34. #include "mac.h"
  35. #include "card.h"
  36. #include "hostap.h"
  37. #include "wpactl.h"
  38. #include "rf.h"
  39. #ifdef WPA_SM_Transtatus
  40. SWPAResult wpa_Result;
  41. #endif
  42. int private_ioctl(struct vnt_private *pDevice, struct ifreq *rq)
  43. {
  44. PSCmdRequest pReq = (PSCmdRequest)rq;
  45. PSMgmtObject pMgmt = pDevice->pMgmt;
  46. int result = 0;
  47. PWLAN_IE_SSID pItemSSID;
  48. SCmdBSSJoin sJoinCmd;
  49. SCmdZoneTypeSet sZoneTypeCmd;
  50. SCmdScan sScanCmd;
  51. SCmdStartAP sStartAPCmd;
  52. SCmdSetWEP sWEPCmd;
  53. SCmdValue sValue;
  54. SBSSIDList sList;
  55. SNodeList sNodeList;
  56. PSBSSIDList pList;
  57. PSNodeList pNodeList;
  58. unsigned int cbListCount;
  59. PKnownBSS pBSS;
  60. PKnownNodeDB pNode;
  61. unsigned int ii, jj;
  62. unsigned char abySuppRates[] = {WLAN_EID_SUPP_RATES, 4, 0x02, 0x04, 0x0B, 0x16};
  63. unsigned char abyNullAddr[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
  64. unsigned long dwKeyIndex = 0;
  65. unsigned char abyScanSSID[WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1];
  66. long ldBm;
  67. pReq->wResult = 0;
  68. switch (pReq->wCmdCode) {
  69. case WLAN_CMD_BSS_SCAN:
  70. pr_debug("WLAN_CMD_BSS_SCAN..begin\n");
  71. if (copy_from_user(&sScanCmd, pReq->data, sizeof(SCmdScan))) {
  72. result = -EFAULT;
  73. break;
  74. }
  75. pItemSSID = (PWLAN_IE_SSID)sScanCmd.ssid;
  76. if (pItemSSID->len > WLAN_SSID_MAXLEN + 1)
  77. return -EINVAL;
  78. if (pItemSSID->len != 0) {
  79. memset(abyScanSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
  80. memcpy(abyScanSSID, pItemSSID, pItemSSID->len + WLAN_IEHDR_LEN);
  81. }
  82. if (pDevice->bMACSuspend == true) {
  83. if (pDevice->bRadioOff == true)
  84. CARDbRadioPowerOn(pDevice);
  85. vMgrTimerInit(pDevice);
  86. MACvIntEnable(pDevice->PortOffset, IMR_MASK_VALUE);
  87. add_timer(&pMgmt->sTimerSecondCallback);
  88. pDevice->bMACSuspend = false;
  89. }
  90. spin_lock_irq(&pDevice->lock);
  91. if (memcmp(pMgmt->abyCurrBSSID, &abyNullAddr[0], 6) == 0)
  92. BSSvClearBSSList((void *)pDevice, false);
  93. else
  94. BSSvClearBSSList((void *)pDevice, pDevice->bLinkPass);
  95. if (pItemSSID->len != 0)
  96. bScheduleCommand((void *)pDevice, WLAN_CMD_BSSID_SCAN, abyScanSSID);
  97. else
  98. bScheduleCommand((void *)pDevice, WLAN_CMD_BSSID_SCAN, NULL);
  99. spin_unlock_irq(&pDevice->lock);
  100. break;
  101. case WLAN_CMD_ZONETYPE_SET:
  102. /* mike add :can't support. */
  103. result = -EOPNOTSUPP;
  104. break;
  105. if (copy_from_user(&sZoneTypeCmd, pReq->data, sizeof(SCmdZoneTypeSet))) {
  106. result = -EFAULT;
  107. break;
  108. }
  109. if (sZoneTypeCmd.bWrite == true) {
  110. /* write zonetype */
  111. if (sZoneTypeCmd.ZoneType == ZoneType_USA) {
  112. /* set to USA */
  113. pr_debug("set_ZoneType:USA\n");
  114. } else if (sZoneTypeCmd.ZoneType == ZoneType_Japan) {
  115. /* set to Japan */
  116. pr_debug("set_ZoneType:Japan\n");
  117. } else if (sZoneTypeCmd.ZoneType == ZoneType_Europe) {
  118. /* set to Europe */
  119. pr_debug("set_ZoneType:Europe\n");
  120. }
  121. } else {
  122. /* read zonetype */
  123. unsigned char zonetype = 0;
  124. if (zonetype == 0x00) { /* USA */
  125. sZoneTypeCmd.ZoneType = ZoneType_USA;
  126. } else if (zonetype == 0x01) { /* Japan */
  127. sZoneTypeCmd.ZoneType = ZoneType_Japan;
  128. } else if (zonetype == 0x02) { /* Europe */
  129. sZoneTypeCmd.ZoneType = ZoneType_Europe;
  130. } else { /* Unknown ZoneType */
  131. pr_err("Error:ZoneType[%x] Unknown ???\n", zonetype);
  132. result = -EFAULT;
  133. break;
  134. }
  135. if (copy_to_user(pReq->data, &sZoneTypeCmd, sizeof(SCmdZoneTypeSet))) {
  136. result = -EFAULT;
  137. break;
  138. }
  139. }
  140. break;
  141. case WLAN_CMD_BSS_JOIN:
  142. if (pDevice->bMACSuspend == true) {
  143. if (pDevice->bRadioOff == true)
  144. CARDbRadioPowerOn(pDevice);
  145. vMgrTimerInit(pDevice);
  146. MACvIntEnable(pDevice->PortOffset, IMR_MASK_VALUE);
  147. add_timer(&pMgmt->sTimerSecondCallback);
  148. pDevice->bMACSuspend = false;
  149. }
  150. if (copy_from_user(&sJoinCmd, pReq->data, sizeof(SCmdBSSJoin))) {
  151. result = -EFAULT;
  152. break;
  153. }
  154. pItemSSID = (PWLAN_IE_SSID)sJoinCmd.ssid;
  155. if (pItemSSID->len > WLAN_SSID_MAXLEN + 1)
  156. return -EINVAL;
  157. memset(pMgmt->abyDesireSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
  158. memcpy(pMgmt->abyDesireSSID, pItemSSID, pItemSSID->len + WLAN_IEHDR_LEN);
  159. if (sJoinCmd.wBSSType == ADHOC) {
  160. pMgmt->eConfigMode = WMAC_CONFIG_IBSS_STA;
  161. pr_debug("ioct set to adhoc mode\n");
  162. } else {
  163. pMgmt->eConfigMode = WMAC_CONFIG_ESS_STA;
  164. pr_debug("ioct set to STA mode\n");
  165. }
  166. if (sJoinCmd.bPSEnable == true) {
  167. pDevice->ePSMode = WMAC_POWER_FAST;
  168. pMgmt->wListenInterval = 2;
  169. pr_debug("Power Saving On\n");
  170. } else {
  171. pDevice->ePSMode = WMAC_POWER_CAM;
  172. pMgmt->wListenInterval = 1;
  173. pr_debug("Power Saving Off\n");
  174. }
  175. if (sJoinCmd.bShareKeyAuth == true) {
  176. pMgmt->bShareKeyAlgorithm = true;
  177. pr_debug("Share Key\n");
  178. } else {
  179. pMgmt->bShareKeyAlgorithm = false;
  180. pr_debug("Open System\n");
  181. }
  182. pDevice->uChannel = sJoinCmd.uChannel;
  183. netif_stop_queue(pDevice->dev);
  184. spin_lock_irq(&pDevice->lock);
  185. pMgmt->eCurrState = WMAC_STATE_IDLE;
  186. bScheduleCommand((void *)pDevice, WLAN_CMD_BSSID_SCAN, pMgmt->abyDesireSSID);
  187. bScheduleCommand((void *)pDevice, WLAN_CMD_SSID, NULL);
  188. spin_unlock_irq(&pDevice->lock);
  189. break;
  190. case WLAN_CMD_SET_WEP:
  191. pr_debug("WLAN_CMD_SET_WEP Key\n");
  192. memset(&sWEPCmd, 0, sizeof(SCmdSetWEP));
  193. if (copy_from_user(&sWEPCmd, pReq->data, sizeof(SCmdSetWEP))) {
  194. result = -EFAULT;
  195. break;
  196. }
  197. if (sWEPCmd.bEnableWep != true) {
  198. pDevice->bEncryptionEnable = false;
  199. pDevice->eEncryptionStatus = Ndis802_11EncryptionDisabled;
  200. MACvDisableDefaultKey(pDevice->PortOffset);
  201. pr_debug("WEP function disable\n");
  202. break;
  203. }
  204. for (ii = 0; ii < WLAN_WEP_NKEYS; ii++) {
  205. if (sWEPCmd.bWepKeyAvailable[ii]) {
  206. if (ii == sWEPCmd.byKeyIndex)
  207. dwKeyIndex = ii | (1 << 31);
  208. else
  209. dwKeyIndex = ii;
  210. KeybSetDefaultKey(&(pDevice->sKey),
  211. dwKeyIndex,
  212. sWEPCmd.auWepKeyLength[ii],
  213. NULL,
  214. (unsigned char *)&sWEPCmd.abyWepKey[ii][0],
  215. KEY_CTL_WEP,
  216. pDevice->PortOffset,
  217. pDevice->byLocalID);
  218. }
  219. }
  220. pDevice->byKeyIndex = sWEPCmd.byKeyIndex;
  221. pDevice->bTransmitKey = true;
  222. pDevice->bEncryptionEnable = true;
  223. pDevice->eEncryptionStatus = Ndis802_11Encryption1Enabled;
  224. break;
  225. case WLAN_CMD_GET_LINK: {
  226. SCmdLinkStatus sLinkStatus;
  227. pr_debug("WLAN_CMD_GET_LINK status\n");
  228. memset(&sLinkStatus, 0, sizeof(sLinkStatus));
  229. if (pMgmt->eCurrMode == WMAC_MODE_IBSS_STA)
  230. sLinkStatus.wBSSType = ADHOC;
  231. else
  232. sLinkStatus.wBSSType = INFRA;
  233. if (pMgmt->eCurrState == WMAC_STATE_JOINTED)
  234. sLinkStatus.byState = ADHOC_JOINTED;
  235. else
  236. sLinkStatus.byState = ADHOC_STARTED;
  237. sLinkStatus.uChannel = pMgmt->uCurrChannel;
  238. if (pDevice->bLinkPass == true) {
  239. sLinkStatus.bLink = true;
  240. pItemSSID = (PWLAN_IE_SSID)pMgmt->abyCurrSSID;
  241. memcpy(sLinkStatus.abySSID, pItemSSID->abySSID, pItemSSID->len);
  242. memcpy(sLinkStatus.abyBSSID, pMgmt->abyCurrBSSID, WLAN_BSSID_LEN);
  243. sLinkStatus.uLinkRate = pMgmt->sNodeDBTable[0].wTxDataRate;
  244. pr_debug(" Link Success!\n");
  245. } else {
  246. sLinkStatus.bLink = false;
  247. sLinkStatus.uLinkRate = 0;
  248. }
  249. if (copy_to_user(pReq->data, &sLinkStatus, sizeof(SCmdLinkStatus))) {
  250. result = -EFAULT;
  251. break;
  252. }
  253. break;
  254. }
  255. case WLAN_CMD_GET_LISTLEN:
  256. cbListCount = 0;
  257. pBSS = &(pMgmt->sBSSList[0]);
  258. for (ii = 0; ii < MAX_BSS_NUM; ii++) {
  259. pBSS = &(pMgmt->sBSSList[ii]);
  260. if (!pBSS->bActive)
  261. continue;
  262. cbListCount++;
  263. }
  264. sList.uItem = cbListCount;
  265. if (copy_to_user(pReq->data, &sList, sizeof(SBSSIDList))) {
  266. result = -EFAULT;
  267. break;
  268. }
  269. pReq->wResult = 0;
  270. break;
  271. case WLAN_CMD_GET_LIST:
  272. if (copy_from_user(&sList, pReq->data, sizeof(SBSSIDList))) {
  273. result = -EFAULT;
  274. break;
  275. }
  276. if (sList.uItem > (ULONG_MAX - sizeof(SBSSIDList)) / sizeof(SBSSIDItem)) {
  277. result = -EINVAL;
  278. break;
  279. }
  280. pList = (PSBSSIDList)kmalloc(sizeof(SBSSIDList) + (sList.uItem * sizeof(SBSSIDItem)),
  281. GFP_ATOMIC);
  282. if (pList == NULL) {
  283. result = -ENOMEM;
  284. break;
  285. }
  286. pList->uItem = sList.uItem;
  287. pBSS = &(pMgmt->sBSSList[0]);
  288. for (ii = 0, jj = 0; jj < MAX_BSS_NUM; jj++) {
  289. pBSS = &(pMgmt->sBSSList[jj]);
  290. if (pBSS->bActive) {
  291. pList->sBSSIDList[ii].uChannel = pBSS->uChannel;
  292. pList->sBSSIDList[ii].wBeaconInterval = pBSS->wBeaconInterval;
  293. pList->sBSSIDList[ii].wCapInfo = pBSS->wCapInfo;
  294. RFvRSSITodBm(pDevice, (unsigned char)(pBSS->uRSSI), &ldBm);
  295. pList->sBSSIDList[ii].uRSSI = (unsigned int)ldBm;
  296. memcpy(pList->sBSSIDList[ii].abyBSSID, pBSS->abyBSSID, WLAN_BSSID_LEN);
  297. pItemSSID = (PWLAN_IE_SSID)pBSS->abySSID;
  298. memset(pList->sBSSIDList[ii].abySSID, 0, WLAN_SSID_MAXLEN + 1);
  299. memcpy(pList->sBSSIDList[ii].abySSID, pItemSSID->abySSID, pItemSSID->len);
  300. if (WLAN_GET_CAP_INFO_ESS(pBSS->wCapInfo))
  301. pList->sBSSIDList[ii].byNetType = INFRA;
  302. else
  303. pList->sBSSIDList[ii].byNetType = ADHOC;
  304. if (WLAN_GET_CAP_INFO_PRIVACY(pBSS->wCapInfo))
  305. pList->sBSSIDList[ii].bWEPOn = true;
  306. else
  307. pList->sBSSIDList[ii].bWEPOn = false;
  308. ii++;
  309. if (ii >= pList->uItem)
  310. break;
  311. }
  312. }
  313. if (copy_to_user(pReq->data, pList, sizeof(SBSSIDList) + (sList.uItem * sizeof(SBSSIDItem)))) {
  314. result = -EFAULT;
  315. break;
  316. }
  317. kfree(pList);
  318. pReq->wResult = 0;
  319. break;
  320. case WLAN_CMD_GET_MIB:
  321. if (copy_to_user(pReq->data, &(pDevice->s802_11Counter), sizeof(SDot11MIBCount))) {
  322. result = -EFAULT;
  323. break;
  324. }
  325. break;
  326. case WLAN_CMD_GET_STAT:
  327. if (copy_to_user(pReq->data, &(pDevice->scStatistic), sizeof(SStatCounter))) {
  328. result = -EFAULT;
  329. break;
  330. }
  331. break;
  332. case WLAN_CMD_STOP_MAC:
  333. pr_debug("WLAN_CMD_STOP_MAC\n");
  334. netif_stop_queue(pDevice->dev);
  335. spin_lock_irq(&pDevice->lock);
  336. if (pDevice->bRadioOff == false)
  337. CARDbRadioPowerOff(pDevice);
  338. pDevice->bLinkPass = false;
  339. memset(pMgmt->abyCurrBSSID, 0, 6);
  340. pMgmt->eCurrState = WMAC_STATE_IDLE;
  341. del_timer(&pDevice->sTimerCommand);
  342. del_timer(&pMgmt->sTimerSecondCallback);
  343. pDevice->bCmdRunning = false;
  344. pDevice->bMACSuspend = true;
  345. MACvIntDisable(pDevice->PortOffset);
  346. spin_unlock_irq(&pDevice->lock);
  347. break;
  348. case WLAN_CMD_START_MAC:
  349. pr_debug("WLAN_CMD_START_MAC\n");
  350. if (pDevice->bMACSuspend == true) {
  351. if (pDevice->bRadioOff == true)
  352. CARDbRadioPowerOn(pDevice);
  353. vMgrTimerInit(pDevice);
  354. MACvIntEnable(pDevice->PortOffset, IMR_MASK_VALUE);
  355. add_timer(&pMgmt->sTimerSecondCallback);
  356. pDevice->bMACSuspend = false;
  357. }
  358. break;
  359. case WLAN_CMD_SET_HOSTAPD:
  360. pr_debug("WLAN_CMD_SET_HOSTAPD\n");
  361. if (copy_from_user(&sValue, pReq->data, sizeof(SCmdValue))) {
  362. result = -EFAULT;
  363. break;
  364. }
  365. if (sValue.dwValue == 1) {
  366. if (vt6655_hostap_set_hostapd(pDevice, 1, 1) == 0) {
  367. pr_debug("Enable HOSTAP\n");
  368. } else {
  369. result = -EFAULT;
  370. break;
  371. }
  372. } else {
  373. vt6655_hostap_set_hostapd(pDevice, 0, 1);
  374. pr_debug("Disable HOSTAP\n");
  375. }
  376. break;
  377. case WLAN_CMD_SET_HOSTAPD_STA:
  378. pr_debug("WLAN_CMD_SET_HOSTAPD_STA\n");
  379. break;
  380. case WLAN_CMD_SET_802_1X:
  381. pr_debug("WLAN_CMD_SET_802_1X\n");
  382. if (copy_from_user(&sValue, pReq->data, sizeof(SCmdValue))) {
  383. result = -EFAULT;
  384. break;
  385. }
  386. if (sValue.dwValue == 1) {
  387. pDevice->bEnable8021x = true;
  388. pr_debug("Enable 802.1x\n");
  389. } else {
  390. pDevice->bEnable8021x = false;
  391. pr_debug("Disable 802.1x\n");
  392. }
  393. break;
  394. case WLAN_CMD_SET_HOST_WEP:
  395. pr_debug("WLAN_CMD_SET_HOST_WEP\n");
  396. if (copy_from_user(&sValue, pReq->data, sizeof(SCmdValue))) {
  397. result = -EFAULT;
  398. break;
  399. }
  400. if (sValue.dwValue == 1) {
  401. pDevice->bEnableHostWEP = true;
  402. pr_debug("Enable HostWEP\n");
  403. } else {
  404. pDevice->bEnableHostWEP = false;
  405. pr_debug("Disable HostWEP\n");
  406. }
  407. break;
  408. case WLAN_CMD_SET_WPA:
  409. pr_debug("WLAN_CMD_SET_WPA\n");
  410. if (copy_from_user(&sValue, pReq->data, sizeof(SCmdValue))) {
  411. result = -EFAULT;
  412. break;
  413. }
  414. if (sValue.dwValue == 1) {
  415. pr_debug("up wpadev\n");
  416. eth_hw_addr_inherit(pDevice->wpadev, pDevice->dev);
  417. pDevice->bWPADEVUp = true;
  418. } else {
  419. pr_debug("close wpadev\n");
  420. pDevice->bWPADEVUp = false;
  421. }
  422. break;
  423. case WLAN_CMD_AP_START:
  424. pr_debug("WLAN_CMD_AP_START\n");
  425. if (pDevice->bRadioOff == true) {
  426. CARDbRadioPowerOn(pDevice);
  427. vMgrTimerInit(pDevice);
  428. MACvIntEnable(pDevice->PortOffset, IMR_MASK_VALUE);
  429. add_timer(&pMgmt->sTimerSecondCallback);
  430. }
  431. if (copy_from_user(&sStartAPCmd, pReq->data, sizeof(SCmdStartAP))) {
  432. result = -EFAULT;
  433. break;
  434. }
  435. if (sStartAPCmd.wBSSType == AP) {
  436. pMgmt->eConfigMode = WMAC_CONFIG_AP;
  437. pr_debug("ioct set to AP mode\n");
  438. } else {
  439. pr_debug("ioct BSS type not set to AP mode\n");
  440. result = -EFAULT;
  441. break;
  442. }
  443. if (sStartAPCmd.wBBPType == PHY80211g)
  444. pMgmt->byAPBBType = PHY_TYPE_11G;
  445. else if (sStartAPCmd.wBBPType == PHY80211a)
  446. pMgmt->byAPBBType = PHY_TYPE_11A;
  447. else
  448. pMgmt->byAPBBType = PHY_TYPE_11B;
  449. pItemSSID = (PWLAN_IE_SSID)sStartAPCmd.ssid;
  450. if (pItemSSID->len > WLAN_SSID_MAXLEN + 1)
  451. return -EINVAL;
  452. memset(pMgmt->abyDesireSSID, 0, WLAN_IEHDR_LEN + WLAN_SSID_MAXLEN + 1);
  453. memcpy(pMgmt->abyDesireSSID, pItemSSID, pItemSSID->len + WLAN_IEHDR_LEN);
  454. if ((sStartAPCmd.uChannel > 0) && (sStartAPCmd.uChannel <= 14))
  455. pDevice->uChannel = sStartAPCmd.uChannel;
  456. if ((sStartAPCmd.uBeaconInt >= 20) && (sStartAPCmd.uBeaconInt <= 1000))
  457. pMgmt->wIBSSBeaconPeriod = sStartAPCmd.uBeaconInt;
  458. else
  459. pMgmt->wIBSSBeaconPeriod = 100;
  460. if (sStartAPCmd.bShareKeyAuth == true) {
  461. pMgmt->bShareKeyAlgorithm = true;
  462. pr_debug("Share Key\n");
  463. } else {
  464. pMgmt->bShareKeyAlgorithm = false;
  465. pr_debug("Open System\n");
  466. }
  467. memcpy(pMgmt->abyIBSSSuppRates, abySuppRates, 6);
  468. if (sStartAPCmd.byBasicRate & BIT3) {
  469. pMgmt->abyIBSSSuppRates[2] |= BIT7;
  470. pMgmt->abyIBSSSuppRates[3] |= BIT7;
  471. pMgmt->abyIBSSSuppRates[4] |= BIT7;
  472. pMgmt->abyIBSSSuppRates[5] |= BIT7;
  473. } else if (sStartAPCmd.byBasicRate & BIT2) {
  474. pMgmt->abyIBSSSuppRates[2] |= BIT7;
  475. pMgmt->abyIBSSSuppRates[3] |= BIT7;
  476. pMgmt->abyIBSSSuppRates[4] |= BIT7;
  477. } else if (sStartAPCmd.byBasicRate & BIT1) {
  478. pMgmt->abyIBSSSuppRates[2] |= BIT7;
  479. pMgmt->abyIBSSSuppRates[3] |= BIT7;
  480. } else if (sStartAPCmd.byBasicRate & BIT1) {
  481. pMgmt->abyIBSSSuppRates[2] |= BIT7;
  482. } else {
  483. /* default 1,2M */
  484. pMgmt->abyIBSSSuppRates[2] |= BIT7;
  485. pMgmt->abyIBSSSuppRates[3] |= BIT7;
  486. }
  487. pr_debug("Support Rate= %*ph\n",
  488. 4, pMgmt->abyIBSSSuppRates + 2);
  489. netif_stop_queue(pDevice->dev);
  490. spin_lock_irq(&pDevice->lock);
  491. bScheduleCommand((void *)pDevice, WLAN_CMD_RUN_AP, NULL);
  492. spin_unlock_irq(&pDevice->lock);
  493. break;
  494. case WLAN_CMD_GET_NODE_CNT:
  495. cbListCount = 0;
  496. pNode = &(pMgmt->sNodeDBTable[0]);
  497. for (ii = 0; ii < (MAX_NODE_NUM + 1); ii++) {
  498. pNode = &(pMgmt->sNodeDBTable[ii]);
  499. if (!pNode->bActive)
  500. continue;
  501. cbListCount++;
  502. }
  503. sNodeList.uItem = cbListCount;
  504. if (copy_to_user(pReq->data, &sNodeList, sizeof(SNodeList))) {
  505. result = -EFAULT;
  506. break;
  507. }
  508. pReq->wResult = 0;
  509. break;
  510. case WLAN_CMD_GET_NODE_LIST:
  511. if (copy_from_user(&sNodeList, pReq->data, sizeof(SNodeList))) {
  512. result = -EFAULT;
  513. break;
  514. }
  515. if (sNodeList.uItem > (ULONG_MAX - sizeof(SNodeList)) / sizeof(SNodeItem)) {
  516. result = -EINVAL;
  517. break;
  518. }
  519. pNodeList = (PSNodeList)kmalloc(sizeof(SNodeList) + (sNodeList.uItem * sizeof(SNodeItem)),
  520. GFP_ATOMIC);
  521. if (pNodeList == NULL) {
  522. result = -ENOMEM;
  523. break;
  524. }
  525. pNodeList->uItem = sNodeList.uItem;
  526. pNode = &(pMgmt->sNodeDBTable[0]);
  527. for (ii = 0, jj = 0; ii < (MAX_NODE_NUM + 1); ii++) {
  528. pNode = &(pMgmt->sNodeDBTable[ii]);
  529. if (pNode->bActive) {
  530. pNodeList->sNodeList[jj].wAID = pNode->wAID;
  531. memcpy(pNodeList->sNodeList[jj].abyMACAddr, pNode->abyMACAddr, WLAN_ADDR_LEN);
  532. pNodeList->sNodeList[jj].wTxDataRate = pNode->wTxDataRate;
  533. pNodeList->sNodeList[jj].wInActiveCount = (unsigned short)pNode->uInActiveCount;
  534. pNodeList->sNodeList[jj].wEnQueueCnt = (unsigned short)pNode->wEnQueueCnt;
  535. pNodeList->sNodeList[jj].wFlags = (unsigned short)pNode->dwFlags;
  536. pNodeList->sNodeList[jj].bPWBitOn = pNode->bPSEnable;
  537. pNodeList->sNodeList[jj].byKeyIndex = pNode->byKeyIndex;
  538. pNodeList->sNodeList[jj].wWepKeyLength = pNode->uWepKeyLength;
  539. memcpy(&(pNodeList->sNodeList[jj].abyWepKey[0]), &(pNode->abyWepKey[0]), WEP_KEYMAXLEN);
  540. pr_debug("key= %2.2X:%2.2X:%2.2X:%2.2X:%2.2X\n",
  541. pNodeList->sNodeList[jj].abyWepKey[0],
  542. pNodeList->sNodeList[jj].abyWepKey[1],
  543. pNodeList->sNodeList[jj].abyWepKey[2],
  544. pNodeList->sNodeList[jj].abyWepKey[3],
  545. pNodeList->sNodeList[jj].abyWepKey[4]);
  546. pNodeList->sNodeList[jj].bIsInFallback = pNode->bIsInFallback;
  547. pNodeList->sNodeList[jj].uTxFailures = pNode->uTxFailures;
  548. pNodeList->sNodeList[jj].uTxAttempts = pNode->uTxAttempts;
  549. pNodeList->sNodeList[jj].wFailureRatio = (unsigned short)pNode->uFailureRatio;
  550. jj++;
  551. if (jj >= pNodeList->uItem)
  552. break;
  553. }
  554. }
  555. if (copy_to_user(pReq->data, pNodeList, sizeof(SNodeList) + (sNodeList.uItem * sizeof(SNodeItem)))) {
  556. result = -EFAULT;
  557. break;
  558. }
  559. kfree(pNodeList);
  560. pReq->wResult = 0;
  561. break;
  562. #ifdef WPA_SM_Transtatus
  563. case 0xFF:
  564. memset(wpa_Result.ifname, 0, sizeof(wpa_Result.ifname));
  565. wpa_Result.proto = 0;
  566. wpa_Result.key_mgmt = 0;
  567. wpa_Result.eap_type = 0;
  568. wpa_Result.authenticated = false;
  569. pDevice->fWPA_Authened = false;
  570. if (copy_from_user(&wpa_Result, pReq->data, sizeof(wpa_Result))) {
  571. result = -EFAULT;
  572. break;
  573. }
  574. if (wpa_Result.authenticated == true) {
  575. #ifdef SndEvt_ToAPI
  576. {
  577. union iwreq_data wrqu;
  578. pItemSSID = (PWLAN_IE_SSID)pMgmt->abyCurrSSID;
  579. memset(&wrqu, 0, sizeof(wrqu));
  580. wrqu.data.flags = RT_WPACONNECTED_EVENT_FLAG;
  581. wrqu.data.length = pItemSSID->len;
  582. wireless_send_event(pDevice->dev, IWEVCUSTOM, &wrqu, pItemSSID->abySSID);
  583. }
  584. #endif
  585. pDevice->fWPA_Authened = true; /* is successful peer to wpa_Result.authenticated? */
  586. }
  587. pReq->wResult = 0;
  588. break;
  589. #endif
  590. default:
  591. pr_debug("Private command not support..\n");
  592. }
  593. return result;
  594. }