wext.c 63 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731
  1. /**
  2. * This file contains ioctl functions
  3. */
  4. #include <linux/ctype.h>
  5. #include <linux/delay.h>
  6. #include <linux/if.h>
  7. #include <linux/if_arp.h>
  8. #include <linux/wireless.h>
  9. #include <linux/bitops.h>
  10. #include <net/ieee80211.h>
  11. #include <net/iw_handler.h>
  12. #include "host.h"
  13. #include "radiotap.h"
  14. #include "decl.h"
  15. #include "defs.h"
  16. #include "dev.h"
  17. #include "join.h"
  18. #include "version.h"
  19. #include "wext.h"
  20. #include "assoc.h"
  21. /**
  22. * @brief Convert mw value to dbm value
  23. *
  24. * @param mw the value of mw
  25. * @return the value of dbm
  26. */
  27. static int mw_to_dbm(int mw)
  28. {
  29. if (mw < 2)
  30. return 0;
  31. else if (mw < 3)
  32. return 3;
  33. else if (mw < 4)
  34. return 5;
  35. else if (mw < 6)
  36. return 7;
  37. else if (mw < 7)
  38. return 8;
  39. else if (mw < 8)
  40. return 9;
  41. else if (mw < 10)
  42. return 10;
  43. else if (mw < 13)
  44. return 11;
  45. else if (mw < 16)
  46. return 12;
  47. else if (mw < 20)
  48. return 13;
  49. else if (mw < 25)
  50. return 14;
  51. else if (mw < 32)
  52. return 15;
  53. else if (mw < 40)
  54. return 16;
  55. else if (mw < 50)
  56. return 17;
  57. else if (mw < 63)
  58. return 18;
  59. else if (mw < 79)
  60. return 19;
  61. else if (mw < 100)
  62. return 20;
  63. else
  64. return 21;
  65. }
  66. /**
  67. * @brief Find the channel frequency power info with specific channel
  68. *
  69. * @param adapter A pointer to wlan_adapter structure
  70. * @param band it can be BAND_A, BAND_G or BAND_B
  71. * @param channel the channel for looking
  72. * @return A pointer to struct chan_freq_power structure or NULL if not find.
  73. */
  74. struct chan_freq_power *libertas_find_cfp_by_band_and_channel(wlan_adapter * adapter,
  75. u8 band, u16 channel)
  76. {
  77. struct chan_freq_power *cfp = NULL;
  78. struct region_channel *rc;
  79. int count = sizeof(adapter->region_channel) /
  80. sizeof(adapter->region_channel[0]);
  81. int i, j;
  82. for (j = 0; !cfp && (j < count); j++) {
  83. rc = &adapter->region_channel[j];
  84. if (adapter->enable11d)
  85. rc = &adapter->universal_channel[j];
  86. if (!rc->valid || !rc->CFP)
  87. continue;
  88. if (rc->band != band)
  89. continue;
  90. for (i = 0; i < rc->nrcfp; i++) {
  91. if (rc->CFP[i].channel == channel) {
  92. cfp = &rc->CFP[i];
  93. break;
  94. }
  95. }
  96. }
  97. if (!cfp && channel)
  98. lbs_pr_debug(1, "libertas_find_cfp_by_band_and_channel(): cannot find "
  99. "cfp by band %d & channel %d\n", band, channel);
  100. return cfp;
  101. }
  102. /**
  103. * @brief Find the channel frequency power info with specific frequency
  104. *
  105. * @param adapter A pointer to wlan_adapter structure
  106. * @param band it can be BAND_A, BAND_G or BAND_B
  107. * @param freq the frequency for looking
  108. * @return A pointer to struct chan_freq_power structure or NULL if not find.
  109. */
  110. static struct chan_freq_power *find_cfp_by_band_and_freq(wlan_adapter * adapter,
  111. u8 band, u32 freq)
  112. {
  113. struct chan_freq_power *cfp = NULL;
  114. struct region_channel *rc;
  115. int count = sizeof(adapter->region_channel) /
  116. sizeof(adapter->region_channel[0]);
  117. int i, j;
  118. for (j = 0; !cfp && (j < count); j++) {
  119. rc = &adapter->region_channel[j];
  120. if (adapter->enable11d)
  121. rc = &adapter->universal_channel[j];
  122. if (!rc->valid || !rc->CFP)
  123. continue;
  124. if (rc->band != band)
  125. continue;
  126. for (i = 0; i < rc->nrcfp; i++) {
  127. if (rc->CFP[i].freq == freq) {
  128. cfp = &rc->CFP[i];
  129. break;
  130. }
  131. }
  132. }
  133. if (!cfp && freq)
  134. lbs_pr_debug(1, "find_cfp_by_band_and_freql(): cannot find cfp by "
  135. "band %d & freq %d\n", band, freq);
  136. return cfp;
  137. }
  138. static int updatecurrentchannel(wlan_private * priv)
  139. {
  140. int ret;
  141. /*
  142. ** the channel in f/w could be out of sync, get the current channel
  143. */
  144. ret = libertas_prepare_and_send_command(priv, cmd_802_11_rf_channel,
  145. cmd_opt_802_11_rf_channel_get,
  146. cmd_option_waitforrsp, 0, NULL);
  147. lbs_pr_debug(1, "Current channel = %d\n",
  148. priv->adapter->curbssparams.channel);
  149. return ret;
  150. }
  151. static int setcurrentchannel(wlan_private * priv, int channel)
  152. {
  153. lbs_pr_debug(1, "Set channel = %d\n", channel);
  154. /*
  155. ** Current channel is not set to adhocchannel requested, set channel
  156. */
  157. return (libertas_prepare_and_send_command(priv, cmd_802_11_rf_channel,
  158. cmd_opt_802_11_rf_channel_set,
  159. cmd_option_waitforrsp, 0, &channel));
  160. }
  161. static int changeadhocchannel(wlan_private * priv, int channel)
  162. {
  163. int ret = 0;
  164. wlan_adapter *adapter = priv->adapter;
  165. adapter->adhocchannel = channel;
  166. updatecurrentchannel(priv);
  167. if (adapter->curbssparams.channel == adapter->adhocchannel) {
  168. /* adhocchannel is set to the current channel already */
  169. LEAVE();
  170. return 0;
  171. }
  172. lbs_pr_debug(1, "Updating channel from %d to %d\n",
  173. adapter->curbssparams.channel, adapter->adhocchannel);
  174. setcurrentchannel(priv, adapter->adhocchannel);
  175. updatecurrentchannel(priv);
  176. if (adapter->curbssparams.channel != adapter->adhocchannel) {
  177. lbs_pr_debug(1, "failed to updated channel to %d, channel = %d\n",
  178. adapter->adhocchannel, adapter->curbssparams.channel);
  179. LEAVE();
  180. return -1;
  181. }
  182. if (adapter->connect_status == libertas_connected) {
  183. int i;
  184. struct WLAN_802_11_SSID curadhocssid;
  185. lbs_pr_debug(1, "channel Changed while in an IBSS\n");
  186. /* Copy the current ssid */
  187. memcpy(&curadhocssid, &adapter->curbssparams.ssid,
  188. sizeof(struct WLAN_802_11_SSID));
  189. /* Exit Adhoc mode */
  190. lbs_pr_debug(1, "In changeadhocchannel(): Sending Adhoc Stop\n");
  191. ret = libertas_stop_adhoc_network(priv);
  192. if (ret) {
  193. LEAVE();
  194. return ret;
  195. }
  196. /* Scan for the network, do not save previous results. Stale
  197. * scan data will cause us to join a non-existant adhoc network
  198. */
  199. libertas_send_specific_SSID_scan(priv, &curadhocssid, 0);
  200. // find out the BSSID that matches the current SSID
  201. i = libertas_find_SSID_in_list(adapter, &curadhocssid, NULL,
  202. wlan802_11ibss);
  203. if (i >= 0) {
  204. lbs_pr_debug(1, "SSID found at %d in List,"
  205. "so join\n", i);
  206. libertas_join_adhoc_network(priv, &adapter->scantable[i]);
  207. } else {
  208. // else send START command
  209. lbs_pr_debug(1, "SSID not found in list, "
  210. "so creating adhoc with ssid = %s\n",
  211. curadhocssid.ssid);
  212. libertas_start_adhoc_network(priv, &curadhocssid);
  213. } // end of else (START command)
  214. }
  215. LEAVE();
  216. return 0;
  217. }
  218. /**
  219. * @brief Set Radio On/OFF
  220. *
  221. * @param priv A pointer to wlan_private structure
  222. * @option Radio Option
  223. * @return 0 --success, otherwise fail
  224. */
  225. int wlan_radio_ioctl(wlan_private * priv, u8 option)
  226. {
  227. int ret = 0;
  228. wlan_adapter *adapter = priv->adapter;
  229. ENTER();
  230. if (adapter->radioon != option) {
  231. lbs_pr_debug(1, "Switching %s the Radio\n", option ? "On" : "Off");
  232. adapter->radioon = option;
  233. ret = libertas_prepare_and_send_command(priv,
  234. cmd_802_11_radio_control,
  235. cmd_act_set,
  236. cmd_option_waitforrsp, 0, NULL);
  237. }
  238. LEAVE();
  239. return ret;
  240. }
  241. /**
  242. * @brief Copy rates
  243. *
  244. * @param dest A pointer to Dest Buf
  245. * @param src A pointer to Src Buf
  246. * @param len The len of Src Buf
  247. * @return Number of rates copyed
  248. */
  249. static inline int copyrates(u8 * dest, int pos, u8 * src, int len)
  250. {
  251. int i;
  252. for (i = 0; i < len && src[i]; i++, pos++) {
  253. if (pos >= sizeof(u8) * WLAN_SUPPORTED_RATES)
  254. break;
  255. dest[pos] = src[i];
  256. }
  257. return pos;
  258. }
  259. /**
  260. * @brief Get active data rates
  261. *
  262. * @param adapter A pointer to wlan_adapter structure
  263. * @param rate The buf to return the active rates
  264. * @return The number of rates
  265. */
  266. static int get_active_data_rates(wlan_adapter * adapter,
  267. u8* rates)
  268. {
  269. int k = 0;
  270. ENTER();
  271. if (adapter->connect_status != libertas_connected) {
  272. if (adapter->inframode == wlan802_11infrastructure) {
  273. //Infra. mode
  274. lbs_pr_debug(1, "Infra\n");
  275. k = copyrates(rates, k, libertas_supported_rates,
  276. sizeof(libertas_supported_rates));
  277. } else {
  278. //ad-hoc mode
  279. lbs_pr_debug(1, "Adhoc G\n");
  280. k = copyrates(rates, k, libertas_adhoc_rates_g,
  281. sizeof(libertas_adhoc_rates_g));
  282. }
  283. } else {
  284. k = copyrates(rates, 0, adapter->curbssparams.datarates,
  285. adapter->curbssparams.numofrates);
  286. }
  287. LEAVE();
  288. return k;
  289. }
  290. static int wlan_get_name(struct net_device *dev, struct iw_request_info *info,
  291. char *cwrq, char *extra)
  292. {
  293. const char *cp;
  294. char comm[6] = { "COMM-" };
  295. char mrvl[6] = { "MRVL-" };
  296. int cnt;
  297. ENTER();
  298. strcpy(cwrq, mrvl);
  299. cp = strstr(libertas_driver_version, comm);
  300. if (cp == libertas_driver_version) //skip leading "COMM-"
  301. cp = libertas_driver_version + strlen(comm);
  302. else
  303. cp = libertas_driver_version;
  304. cnt = strlen(mrvl);
  305. cwrq += cnt;
  306. while (cnt < 16 && (*cp != '-')) {
  307. *cwrq++ = toupper(*cp++);
  308. cnt++;
  309. }
  310. *cwrq = '\0';
  311. LEAVE();
  312. return 0;
  313. }
  314. static int wlan_get_freq(struct net_device *dev, struct iw_request_info *info,
  315. struct iw_freq *fwrq, char *extra)
  316. {
  317. wlan_private *priv = dev->priv;
  318. wlan_adapter *adapter = priv->adapter;
  319. struct chan_freq_power *cfp;
  320. ENTER();
  321. cfp = libertas_find_cfp_by_band_and_channel(adapter, 0,
  322. adapter->curbssparams.channel);
  323. if (!cfp) {
  324. if (adapter->curbssparams.channel)
  325. lbs_pr_debug(1, "Invalid channel=%d\n",
  326. adapter->curbssparams.channel);
  327. return -EINVAL;
  328. }
  329. fwrq->m = (long)cfp->freq * 100000;
  330. fwrq->e = 1;
  331. lbs_pr_debug(1, "freq=%u\n", fwrq->m);
  332. LEAVE();
  333. return 0;
  334. }
  335. static int wlan_get_wap(struct net_device *dev, struct iw_request_info *info,
  336. struct sockaddr *awrq, char *extra)
  337. {
  338. wlan_private *priv = dev->priv;
  339. wlan_adapter *adapter = priv->adapter;
  340. ENTER();
  341. if (adapter->connect_status == libertas_connected) {
  342. memcpy(awrq->sa_data, adapter->curbssparams.bssid, ETH_ALEN);
  343. } else {
  344. memset(awrq->sa_data, 0, ETH_ALEN);
  345. }
  346. awrq->sa_family = ARPHRD_ETHER;
  347. LEAVE();
  348. return 0;
  349. }
  350. static int wlan_set_nick(struct net_device *dev, struct iw_request_info *info,
  351. struct iw_point *dwrq, char *extra)
  352. {
  353. wlan_private *priv = dev->priv;
  354. wlan_adapter *adapter = priv->adapter;
  355. ENTER();
  356. /*
  357. * Check the size of the string
  358. */
  359. if (dwrq->length > 16) {
  360. return -E2BIG;
  361. }
  362. mutex_lock(&adapter->lock);
  363. memset(adapter->nodename, 0, sizeof(adapter->nodename));
  364. memcpy(adapter->nodename, extra, dwrq->length);
  365. mutex_unlock(&adapter->lock);
  366. LEAVE();
  367. return 0;
  368. }
  369. static int wlan_get_nick(struct net_device *dev, struct iw_request_info *info,
  370. struct iw_point *dwrq, char *extra)
  371. {
  372. wlan_private *priv = dev->priv;
  373. wlan_adapter *adapter = priv->adapter;
  374. ENTER();
  375. /*
  376. * Get the Nick Name saved
  377. */
  378. mutex_lock(&adapter->lock);
  379. strncpy(extra, adapter->nodename, 16);
  380. mutex_unlock(&adapter->lock);
  381. extra[16] = '\0';
  382. /*
  383. * If none, we may want to get the one that was set
  384. */
  385. /*
  386. * Push it out !
  387. */
  388. dwrq->length = strlen(extra) + 1;
  389. LEAVE();
  390. return 0;
  391. }
  392. static int wlan_set_rts(struct net_device *dev, struct iw_request_info *info,
  393. struct iw_param *vwrq, char *extra)
  394. {
  395. int ret = 0;
  396. wlan_private *priv = dev->priv;
  397. wlan_adapter *adapter = priv->adapter;
  398. int rthr = vwrq->value;
  399. ENTER();
  400. if (vwrq->disabled) {
  401. adapter->rtsthsd = rthr = MRVDRV_RTS_MAX_VALUE;
  402. } else {
  403. if (rthr < MRVDRV_RTS_MIN_VALUE || rthr > MRVDRV_RTS_MAX_VALUE)
  404. return -EINVAL;
  405. adapter->rtsthsd = rthr;
  406. }
  407. ret = libertas_prepare_and_send_command(priv, cmd_802_11_snmp_mib,
  408. cmd_act_set, cmd_option_waitforrsp,
  409. OID_802_11_RTS_THRESHOLD, &rthr);
  410. LEAVE();
  411. return ret;
  412. }
  413. static int wlan_get_rts(struct net_device *dev, struct iw_request_info *info,
  414. struct iw_param *vwrq, char *extra)
  415. {
  416. int ret = 0;
  417. wlan_private *priv = dev->priv;
  418. wlan_adapter *adapter = priv->adapter;
  419. ENTER();
  420. adapter->rtsthsd = 0;
  421. ret = libertas_prepare_and_send_command(priv, cmd_802_11_snmp_mib,
  422. cmd_act_get, cmd_option_waitforrsp,
  423. OID_802_11_RTS_THRESHOLD, NULL);
  424. if (ret) {
  425. LEAVE();
  426. return ret;
  427. }
  428. vwrq->value = adapter->rtsthsd;
  429. vwrq->disabled = ((vwrq->value < MRVDRV_RTS_MIN_VALUE)
  430. || (vwrq->value > MRVDRV_RTS_MAX_VALUE));
  431. vwrq->fixed = 1;
  432. LEAVE();
  433. return 0;
  434. }
  435. static int wlan_set_frag(struct net_device *dev, struct iw_request_info *info,
  436. struct iw_param *vwrq, char *extra)
  437. {
  438. int ret = 0;
  439. int fthr = vwrq->value;
  440. wlan_private *priv = dev->priv;
  441. wlan_adapter *adapter = priv->adapter;
  442. ENTER();
  443. if (vwrq->disabled) {
  444. adapter->fragthsd = fthr = MRVDRV_FRAG_MAX_VALUE;
  445. } else {
  446. if (fthr < MRVDRV_FRAG_MIN_VALUE
  447. || fthr > MRVDRV_FRAG_MAX_VALUE)
  448. return -EINVAL;
  449. adapter->fragthsd = fthr;
  450. }
  451. ret = libertas_prepare_and_send_command(priv, cmd_802_11_snmp_mib,
  452. cmd_act_set, cmd_option_waitforrsp,
  453. OID_802_11_FRAGMENTATION_THRESHOLD, &fthr);
  454. LEAVE();
  455. return ret;
  456. }
  457. static int wlan_get_frag(struct net_device *dev, struct iw_request_info *info,
  458. struct iw_param *vwrq, char *extra)
  459. {
  460. int ret = 0;
  461. wlan_private *priv = dev->priv;
  462. wlan_adapter *adapter = priv->adapter;
  463. ENTER();
  464. adapter->fragthsd = 0;
  465. ret = libertas_prepare_and_send_command(priv,
  466. cmd_802_11_snmp_mib,
  467. cmd_act_get, cmd_option_waitforrsp,
  468. OID_802_11_FRAGMENTATION_THRESHOLD, NULL);
  469. if (ret) {
  470. LEAVE();
  471. return ret;
  472. }
  473. vwrq->value = adapter->fragthsd;
  474. vwrq->disabled = ((vwrq->value < MRVDRV_FRAG_MIN_VALUE)
  475. || (vwrq->value > MRVDRV_FRAG_MAX_VALUE));
  476. vwrq->fixed = 1;
  477. LEAVE();
  478. return ret;
  479. }
  480. static int wlan_get_mode(struct net_device *dev,
  481. struct iw_request_info *info, u32 * uwrq, char *extra)
  482. {
  483. wlan_private *priv = dev->priv;
  484. wlan_adapter *adapter = priv->adapter;
  485. ENTER();
  486. switch (adapter->inframode) {
  487. case wlan802_11ibss:
  488. *uwrq = IW_MODE_ADHOC;
  489. break;
  490. case wlan802_11infrastructure:
  491. *uwrq = IW_MODE_INFRA;
  492. break;
  493. default:
  494. case wlan802_11autounknown:
  495. *uwrq = IW_MODE_AUTO;
  496. break;
  497. }
  498. LEAVE();
  499. return 0;
  500. }
  501. static int wlan_get_txpow(struct net_device *dev,
  502. struct iw_request_info *info,
  503. struct iw_param *vwrq, char *extra)
  504. {
  505. int ret = 0;
  506. wlan_private *priv = dev->priv;
  507. wlan_adapter *adapter = priv->adapter;
  508. ENTER();
  509. ret = libertas_prepare_and_send_command(priv,
  510. cmd_802_11_rf_tx_power,
  511. cmd_act_tx_power_opt_get,
  512. cmd_option_waitforrsp, 0, NULL);
  513. if (ret) {
  514. LEAVE();
  515. return ret;
  516. }
  517. lbs_pr_debug(1, "TXPOWER GET %d dbm.\n", adapter->txpowerlevel);
  518. vwrq->value = adapter->txpowerlevel;
  519. vwrq->fixed = 1;
  520. if (adapter->radioon) {
  521. vwrq->disabled = 0;
  522. vwrq->flags = IW_TXPOW_DBM;
  523. } else {
  524. vwrq->disabled = 1;
  525. }
  526. LEAVE();
  527. return 0;
  528. }
  529. static int wlan_set_retry(struct net_device *dev, struct iw_request_info *info,
  530. struct iw_param *vwrq, char *extra)
  531. {
  532. int ret = 0;
  533. wlan_private *priv = dev->priv;
  534. wlan_adapter *adapter = priv->adapter;
  535. ENTER();
  536. if (vwrq->flags == IW_RETRY_LIMIT) {
  537. /* The MAC has a 4-bit Total_Tx_Count register
  538. Total_Tx_Count = 1 + Tx_Retry_Count */
  539. #define TX_RETRY_MIN 0
  540. #define TX_RETRY_MAX 14
  541. if (vwrq->value < TX_RETRY_MIN || vwrq->value > TX_RETRY_MAX)
  542. return -EINVAL;
  543. /* Adding 1 to convert retry count to try count */
  544. adapter->txretrycount = vwrq->value + 1;
  545. ret = libertas_prepare_and_send_command(priv, cmd_802_11_snmp_mib,
  546. cmd_act_set,
  547. cmd_option_waitforrsp,
  548. OID_802_11_TX_RETRYCOUNT, NULL);
  549. if (ret) {
  550. LEAVE();
  551. return ret;
  552. }
  553. } else {
  554. return -EOPNOTSUPP;
  555. }
  556. LEAVE();
  557. return 0;
  558. }
  559. static int wlan_get_retry(struct net_device *dev, struct iw_request_info *info,
  560. struct iw_param *vwrq, char *extra)
  561. {
  562. wlan_private *priv = dev->priv;
  563. wlan_adapter *adapter = priv->adapter;
  564. int ret = 0;
  565. ENTER();
  566. adapter->txretrycount = 0;
  567. ret = libertas_prepare_and_send_command(priv,
  568. cmd_802_11_snmp_mib,
  569. cmd_act_get, cmd_option_waitforrsp,
  570. OID_802_11_TX_RETRYCOUNT, NULL);
  571. if (ret) {
  572. LEAVE();
  573. return ret;
  574. }
  575. vwrq->disabled = 0;
  576. if (!vwrq->flags) {
  577. vwrq->flags = IW_RETRY_LIMIT;
  578. /* Subtract 1 to convert try count to retry count */
  579. vwrq->value = adapter->txretrycount - 1;
  580. }
  581. LEAVE();
  582. return 0;
  583. }
  584. static inline void sort_channels(struct iw_freq *freq, int num)
  585. {
  586. int i, j;
  587. struct iw_freq temp;
  588. for (i = 0; i < num; i++)
  589. for (j = i + 1; j < num; j++)
  590. if (freq[i].i > freq[j].i) {
  591. temp.i = freq[i].i;
  592. temp.m = freq[i].m;
  593. freq[i].i = freq[j].i;
  594. freq[i].m = freq[j].m;
  595. freq[j].i = temp.i;
  596. freq[j].m = temp.m;
  597. }
  598. }
  599. /* data rate listing
  600. MULTI_BANDS:
  601. abg a b b/g
  602. Infra G(12) A(8) B(4) G(12)
  603. Adhoc A+B(12) A(8) B(4) B(4)
  604. non-MULTI_BANDS:
  605. b b/g
  606. Infra B(4) G(12)
  607. Adhoc B(4) B(4)
  608. */
  609. /**
  610. * @brief Get Range Info
  611. *
  612. * @param dev A pointer to net_device structure
  613. * @param info A pointer to iw_request_info structure
  614. * @param vwrq A pointer to iw_param structure
  615. * @param extra A pointer to extra data buf
  616. * @return 0 --success, otherwise fail
  617. */
  618. static int wlan_get_range(struct net_device *dev, struct iw_request_info *info,
  619. struct iw_point *dwrq, char *extra)
  620. {
  621. int i, j;
  622. wlan_private *priv = dev->priv;
  623. wlan_adapter *adapter = priv->adapter;
  624. struct iw_range *range = (struct iw_range *)extra;
  625. struct chan_freq_power *cfp;
  626. u8 rates[WLAN_SUPPORTED_RATES];
  627. u8 flag = 0;
  628. ENTER();
  629. dwrq->length = sizeof(struct iw_range);
  630. memset(range, 0, sizeof(struct iw_range));
  631. range->min_nwid = 0;
  632. range->max_nwid = 0;
  633. memset(rates, 0, sizeof(rates));
  634. range->num_bitrates = get_active_data_rates(adapter, rates);
  635. for (i = 0; i < min_t(__u8, range->num_bitrates, IW_MAX_BITRATES) && rates[i];
  636. i++) {
  637. range->bitrate[i] = (rates[i] & 0x7f) * 500000;
  638. }
  639. range->num_bitrates = i;
  640. lbs_pr_debug(1, "IW_MAX_BITRATES=%d num_bitrates=%d\n", IW_MAX_BITRATES,
  641. range->num_bitrates);
  642. range->num_frequency = 0;
  643. if (priv->adapter->enable11d &&
  644. adapter->connect_status == libertas_connected) {
  645. u8 chan_no;
  646. u8 band;
  647. struct parsed_region_chan_11d *parsed_region_chan =
  648. &adapter->parsed_region_chan;
  649. if (parsed_region_chan == NULL) {
  650. lbs_pr_debug(1, "11D:parsed_region_chan is NULL\n");
  651. LEAVE();
  652. return 0;
  653. }
  654. band = parsed_region_chan->band;
  655. lbs_pr_debug(1, "band=%d NoOfChan=%d\n", band,
  656. parsed_region_chan->nr_chan);
  657. for (i = 0; (range->num_frequency < IW_MAX_FREQUENCIES)
  658. && (i < parsed_region_chan->nr_chan); i++) {
  659. chan_no = parsed_region_chan->chanpwr[i].chan;
  660. lbs_pr_debug(1, "chan_no=%d\n", chan_no);
  661. range->freq[range->num_frequency].i = (long)chan_no;
  662. range->freq[range->num_frequency].m =
  663. (long)libertas_chan_2_freq(chan_no, band) * 100000;
  664. range->freq[range->num_frequency].e = 1;
  665. range->num_frequency++;
  666. }
  667. flag = 1;
  668. }
  669. if (!flag) {
  670. for (j = 0; (range->num_frequency < IW_MAX_FREQUENCIES)
  671. && (j < sizeof(adapter->region_channel)
  672. / sizeof(adapter->region_channel[0])); j++) {
  673. cfp = adapter->region_channel[j].CFP;
  674. for (i = 0; (range->num_frequency < IW_MAX_FREQUENCIES)
  675. && adapter->region_channel[j].valid
  676. && cfp
  677. && (i < adapter->region_channel[j].nrcfp); i++) {
  678. range->freq[range->num_frequency].i =
  679. (long)cfp->channel;
  680. range->freq[range->num_frequency].m =
  681. (long)cfp->freq * 100000;
  682. range->freq[range->num_frequency].e = 1;
  683. cfp++;
  684. range->num_frequency++;
  685. }
  686. }
  687. }
  688. lbs_pr_debug(1, "IW_MAX_FREQUENCIES=%d num_frequency=%d\n",
  689. IW_MAX_FREQUENCIES, range->num_frequency);
  690. range->num_channels = range->num_frequency;
  691. sort_channels(&range->freq[0], range->num_frequency);
  692. /*
  693. * Set an indication of the max TCP throughput in bit/s that we can
  694. * expect using this interface
  695. */
  696. if (i > 2)
  697. range->throughput = 5000 * 1000;
  698. else
  699. range->throughput = 1500 * 1000;
  700. range->min_rts = MRVDRV_RTS_MIN_VALUE;
  701. range->max_rts = MRVDRV_RTS_MAX_VALUE;
  702. range->min_frag = MRVDRV_FRAG_MIN_VALUE;
  703. range->max_frag = MRVDRV_FRAG_MAX_VALUE;
  704. range->encoding_size[0] = 5;
  705. range->encoding_size[1] = 13;
  706. range->num_encoding_sizes = 2;
  707. range->max_encoding_tokens = 4;
  708. range->min_pmp = 1000000;
  709. range->max_pmp = 120000000;
  710. range->min_pmt = 1000;
  711. range->max_pmt = 1000000;
  712. range->pmp_flags = IW_POWER_PERIOD;
  713. range->pmt_flags = IW_POWER_TIMEOUT;
  714. range->pm_capa = IW_POWER_PERIOD | IW_POWER_TIMEOUT | IW_POWER_ALL_R;
  715. /*
  716. * Minimum version we recommend
  717. */
  718. range->we_version_source = 15;
  719. /*
  720. * Version we are compiled with
  721. */
  722. range->we_version_compiled = WIRELESS_EXT;
  723. range->retry_capa = IW_RETRY_LIMIT;
  724. range->retry_flags = IW_RETRY_LIMIT | IW_RETRY_MAX;
  725. range->min_retry = TX_RETRY_MIN;
  726. range->max_retry = TX_RETRY_MAX;
  727. /*
  728. * Set the qual, level and noise range values
  729. */
  730. range->max_qual.qual = 100;
  731. range->max_qual.level = 0;
  732. range->max_qual.noise = 0;
  733. range->max_qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
  734. range->avg_qual.qual = 70;
  735. /* TODO: Find real 'good' to 'bad' threshold value for RSSI */
  736. range->avg_qual.level = 0;
  737. range->avg_qual.noise = 0;
  738. range->avg_qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
  739. range->sensitivity = 0;
  740. /*
  741. * Setup the supported power level ranges
  742. */
  743. memset(range->txpower, 0, sizeof(range->txpower));
  744. range->txpower[0] = 5;
  745. range->txpower[1] = 7;
  746. range->txpower[2] = 9;
  747. range->txpower[3] = 11;
  748. range->txpower[4] = 13;
  749. range->txpower[5] = 15;
  750. range->txpower[6] = 17;
  751. range->txpower[7] = 19;
  752. range->num_txpower = 8;
  753. range->txpower_capa = IW_TXPOW_DBM;
  754. range->txpower_capa |= IW_TXPOW_RANGE;
  755. range->event_capa[0] = (IW_EVENT_CAPA_K_0 |
  756. IW_EVENT_CAPA_MASK(SIOCGIWAP) |
  757. IW_EVENT_CAPA_MASK(SIOCGIWSCAN));
  758. range->event_capa[1] = IW_EVENT_CAPA_K_1;
  759. if (adapter->fwcapinfo & FW_CAPINFO_WPA) {
  760. range->enc_capa = IW_ENC_CAPA_WPA
  761. | IW_ENC_CAPA_WPA2
  762. | IW_ENC_CAPA_CIPHER_TKIP
  763. | IW_ENC_CAPA_CIPHER_CCMP;
  764. }
  765. LEAVE();
  766. return 0;
  767. }
  768. static int wlan_set_power(struct net_device *dev, struct iw_request_info *info,
  769. struct iw_param *vwrq, char *extra)
  770. {
  771. wlan_private *priv = dev->priv;
  772. wlan_adapter *adapter = priv->adapter;
  773. ENTER();
  774. /* PS is currently supported only in Infrastructure mode
  775. * Remove this check if it is to be supported in IBSS mode also
  776. */
  777. if (vwrq->disabled) {
  778. adapter->psmode = wlan802_11powermodecam;
  779. if (adapter->psstate != PS_STATE_FULL_POWER) {
  780. libertas_ps_wakeup(priv, cmd_option_waitforrsp);
  781. }
  782. return 0;
  783. }
  784. if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_TIMEOUT) {
  785. lbs_pr_debug(1,
  786. "Setting power timeout command is not supported\n");
  787. return -EINVAL;
  788. } else if ((vwrq->flags & IW_POWER_TYPE) == IW_POWER_PERIOD) {
  789. lbs_pr_debug(1, "Setting power period command is not supported\n");
  790. return -EINVAL;
  791. }
  792. if (adapter->psmode != wlan802_11powermodecam) {
  793. return 0;
  794. }
  795. adapter->psmode = wlan802_11powermodemax_psp;
  796. if (adapter->connect_status == libertas_connected) {
  797. libertas_ps_sleep(priv, cmd_option_waitforrsp);
  798. }
  799. LEAVE();
  800. return 0;
  801. }
  802. static int wlan_get_power(struct net_device *dev, struct iw_request_info *info,
  803. struct iw_param *vwrq, char *extra)
  804. {
  805. wlan_private *priv = dev->priv;
  806. wlan_adapter *adapter = priv->adapter;
  807. int mode;
  808. ENTER();
  809. mode = adapter->psmode;
  810. if ((vwrq->disabled = (mode == wlan802_11powermodecam))
  811. || adapter->connect_status == libertas_disconnected) {
  812. LEAVE();
  813. return 0;
  814. }
  815. vwrq->value = 0;
  816. LEAVE();
  817. return 0;
  818. }
  819. /*
  820. * iwpriv settable callbacks
  821. */
  822. static const iw_handler wlan_private_handler[] = {
  823. NULL, /* SIOCIWFIRSTPRIV */
  824. };
  825. static const struct iw_priv_args wlan_private_args[] = {
  826. /*
  827. * { cmd, set_args, get_args, name }
  828. */
  829. {
  830. WLANSCAN_TYPE,
  831. IW_PRIV_TYPE_CHAR | 8,
  832. IW_PRIV_TYPE_CHAR | 8,
  833. "scantype"},
  834. {
  835. WLAN_SETINT_GETINT,
  836. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  837. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  838. ""},
  839. {
  840. WLANNF,
  841. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  842. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  843. "getNF"},
  844. {
  845. WLANRSSI,
  846. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  847. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  848. "getRSSI"},
  849. {
  850. WLANENABLE11D,
  851. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  852. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  853. "enable11d"},
  854. {
  855. WLANADHOCGRATE,
  856. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  857. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  858. "adhocgrate"},
  859. {
  860. WLAN_SUBCMD_SET_PRESCAN,
  861. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  862. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  863. "prescan"},
  864. {
  865. WLAN_SETONEINT_GETONEINT,
  866. IW_PRIV_TYPE_INT | 1,
  867. IW_PRIV_TYPE_INT | 1,
  868. ""},
  869. {
  870. WLAN_BEACON_INTERVAL,
  871. IW_PRIV_TYPE_INT | 1,
  872. IW_PRIV_TYPE_INT | 1,
  873. "bcninterval"},
  874. {
  875. WLAN_LISTENINTRVL,
  876. IW_PRIV_TYPE_INT | 1,
  877. IW_PRIV_TYPE_INT | 1,
  878. "lolisteninter"},
  879. {
  880. WLAN_TXCONTROL,
  881. IW_PRIV_TYPE_INT | 1,
  882. IW_PRIV_TYPE_INT | 1,
  883. "txcontrol"},
  884. {
  885. WLAN_NULLPKTINTERVAL,
  886. IW_PRIV_TYPE_INT | 1,
  887. IW_PRIV_TYPE_INT | 1,
  888. "psnullinterval"},
  889. /* Using iwpriv sub-command feature */
  890. {
  891. WLAN_SETONEINT_GETNONE, /* IOCTL: 24 */
  892. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  893. IW_PRIV_TYPE_NONE,
  894. ""},
  895. {
  896. WLAN_SUBCMD_SETRXANTENNA,
  897. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  898. IW_PRIV_TYPE_NONE,
  899. "setrxant"},
  900. {
  901. WLAN_SUBCMD_SETTXANTENNA,
  902. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  903. IW_PRIV_TYPE_NONE,
  904. "settxant"},
  905. {
  906. WLANSETENCRYPTIONMODE,
  907. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  908. IW_PRIV_TYPE_NONE,
  909. "encryptionmode",
  910. },
  911. {
  912. WLANSETREGION,
  913. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  914. IW_PRIV_TYPE_NONE,
  915. "setregioncode"},
  916. {
  917. WLAN_SET_LISTEN_INTERVAL,
  918. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  919. IW_PRIV_TYPE_NONE,
  920. "setlisteninter"},
  921. {
  922. WLAN_SET_MULTIPLE_DTIM,
  923. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  924. IW_PRIV_TYPE_NONE,
  925. "setmultipledtim"},
  926. {
  927. WLAN_SET_ATIM_WINDOW,
  928. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  929. IW_PRIV_TYPE_NONE,
  930. "atimwindow"},
  931. {
  932. WLANSETBCNAVG,
  933. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  934. IW_PRIV_TYPE_NONE,
  935. "setbcnavg"},
  936. {
  937. WLANSETDATAAVG,
  938. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  939. IW_PRIV_TYPE_NONE,
  940. "setdataavg"},
  941. {
  942. WLAN_SET_LINKMODE,
  943. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  944. IW_PRIV_TYPE_NONE,
  945. "linkmode"},
  946. {
  947. WLAN_SET_RADIOMODE,
  948. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  949. IW_PRIV_TYPE_NONE,
  950. "radiomode"},
  951. {
  952. WLAN_SET_DEBUGMODE,
  953. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  954. IW_PRIV_TYPE_NONE,
  955. "debugmode"},
  956. {
  957. WLAN_SUBCMD_MESH_SET_TTL,
  958. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  959. IW_PRIV_TYPE_NONE,
  960. "mesh_set_ttl"},
  961. {
  962. WLAN_SETNONE_GETONEINT,
  963. IW_PRIV_TYPE_NONE,
  964. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  965. ""},
  966. {
  967. WLANGETREGION,
  968. IW_PRIV_TYPE_NONE,
  969. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  970. "getregioncode"},
  971. {
  972. WLAN_GET_LISTEN_INTERVAL,
  973. IW_PRIV_TYPE_NONE,
  974. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  975. "getlisteninter"},
  976. {
  977. WLAN_GET_MULTIPLE_DTIM,
  978. IW_PRIV_TYPE_NONE,
  979. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  980. "getmultipledtim"},
  981. {
  982. WLAN_GET_TX_RATE,
  983. IW_PRIV_TYPE_NONE,
  984. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  985. "gettxrate"},
  986. {
  987. WLANGETBCNAVG,
  988. IW_PRIV_TYPE_NONE,
  989. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  990. "getbcnavg"},
  991. {
  992. WLAN_GET_LINKMODE,
  993. IW_PRIV_TYPE_NONE,
  994. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  995. "get_linkmode"},
  996. {
  997. WLAN_GET_RADIOMODE,
  998. IW_PRIV_TYPE_NONE,
  999. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  1000. "get_radiomode"},
  1001. {
  1002. WLAN_GET_DEBUGMODE,
  1003. IW_PRIV_TYPE_NONE,
  1004. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  1005. "get_debugmode"},
  1006. {
  1007. WLAN_SUBCMD_FWT_CLEANUP,
  1008. IW_PRIV_TYPE_NONE,
  1009. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  1010. "fwt_cleanup"},
  1011. {
  1012. WLAN_SUBCMD_FWT_TIME,
  1013. IW_PRIV_TYPE_NONE,
  1014. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  1015. "fwt_time"},
  1016. {
  1017. WLAN_SUBCMD_MESH_GET_TTL,
  1018. IW_PRIV_TYPE_NONE,
  1019. IW_PRIV_TYPE_INT | IW_PRIV_SIZE_FIXED | 1,
  1020. "mesh_get_ttl"},
  1021. {
  1022. WLAN_SETNONE_GETTWELVE_CHAR,
  1023. IW_PRIV_TYPE_NONE,
  1024. IW_PRIV_TYPE_CHAR | 12,
  1025. ""},
  1026. {
  1027. WLAN_SUBCMD_GETRXANTENNA,
  1028. IW_PRIV_TYPE_NONE,
  1029. IW_PRIV_TYPE_CHAR | 12,
  1030. "getrxant"},
  1031. {
  1032. WLAN_SUBCMD_GETTXANTENNA,
  1033. IW_PRIV_TYPE_NONE,
  1034. IW_PRIV_TYPE_CHAR | 12,
  1035. "gettxant"},
  1036. {
  1037. WLAN_GET_TSF,
  1038. IW_PRIV_TYPE_NONE,
  1039. IW_PRIV_TYPE_CHAR | 12,
  1040. "gettsf"},
  1041. {
  1042. WLAN_SETNONE_GETNONE,
  1043. IW_PRIV_TYPE_NONE,
  1044. IW_PRIV_TYPE_NONE,
  1045. ""},
  1046. {
  1047. WLANDEAUTH,
  1048. IW_PRIV_TYPE_NONE,
  1049. IW_PRIV_TYPE_NONE,
  1050. "deauth"},
  1051. {
  1052. WLANADHOCSTOP,
  1053. IW_PRIV_TYPE_NONE,
  1054. IW_PRIV_TYPE_NONE,
  1055. "adhocstop"},
  1056. {
  1057. WLANRADIOON,
  1058. IW_PRIV_TYPE_NONE,
  1059. IW_PRIV_TYPE_NONE,
  1060. "radioon"},
  1061. {
  1062. WLANRADIOOFF,
  1063. IW_PRIV_TYPE_NONE,
  1064. IW_PRIV_TYPE_NONE,
  1065. "radiooff"},
  1066. {
  1067. WLANWLANIDLEON,
  1068. IW_PRIV_TYPE_NONE,
  1069. IW_PRIV_TYPE_NONE,
  1070. "wlanidle-on"},
  1071. {
  1072. WLANWLANIDLEOFF,
  1073. IW_PRIV_TYPE_NONE,
  1074. IW_PRIV_TYPE_NONE,
  1075. "wlanidle-off"},
  1076. {
  1077. WLAN_SUBCMD_FWT_RESET,
  1078. IW_PRIV_TYPE_NONE,
  1079. IW_PRIV_TYPE_NONE,
  1080. "fwt_reset"},
  1081. {
  1082. WLAN_SUBCMD_BT_RESET,
  1083. IW_PRIV_TYPE_NONE,
  1084. IW_PRIV_TYPE_NONE,
  1085. "bt_reset"},
  1086. {
  1087. WLAN_SET128CHAR_GET128CHAR,
  1088. IW_PRIV_TYPE_CHAR | 128,
  1089. IW_PRIV_TYPE_CHAR | 128,
  1090. ""},
  1091. /* BT Management */
  1092. {
  1093. WLAN_SUBCMD_BT_ADD,
  1094. IW_PRIV_TYPE_CHAR | 128,
  1095. IW_PRIV_TYPE_CHAR | 128,
  1096. "bt_add"},
  1097. {
  1098. WLAN_SUBCMD_BT_DEL,
  1099. IW_PRIV_TYPE_CHAR | 128,
  1100. IW_PRIV_TYPE_CHAR | 128,
  1101. "bt_del"},
  1102. {
  1103. WLAN_SUBCMD_BT_LIST,
  1104. IW_PRIV_TYPE_CHAR | 128,
  1105. IW_PRIV_TYPE_CHAR | 128,
  1106. "bt_list"},
  1107. /* FWT Management */
  1108. {
  1109. WLAN_SUBCMD_FWT_ADD,
  1110. IW_PRIV_TYPE_CHAR | 128,
  1111. IW_PRIV_TYPE_CHAR | 128,
  1112. "fwt_add"},
  1113. {
  1114. WLAN_SUBCMD_FWT_DEL,
  1115. IW_PRIV_TYPE_CHAR | 128,
  1116. IW_PRIV_TYPE_CHAR | 128,
  1117. "fwt_del"},
  1118. {
  1119. WLAN_SUBCMD_FWT_LOOKUP,
  1120. IW_PRIV_TYPE_CHAR | 128,
  1121. IW_PRIV_TYPE_CHAR | 128,
  1122. "fwt_lookup"},
  1123. {
  1124. WLAN_SUBCMD_FWT_LIST_NEIGHBOR,
  1125. IW_PRIV_TYPE_CHAR | 128,
  1126. IW_PRIV_TYPE_CHAR | 128,
  1127. "fwt_list_neigh"},
  1128. {
  1129. WLAN_SUBCMD_FWT_LIST,
  1130. IW_PRIV_TYPE_CHAR | 128,
  1131. IW_PRIV_TYPE_CHAR | 128,
  1132. "fwt_list"},
  1133. {
  1134. WLAN_SUBCMD_FWT_LIST_ROUTE,
  1135. IW_PRIV_TYPE_CHAR | 128,
  1136. IW_PRIV_TYPE_CHAR | 128,
  1137. "fwt_list_route"},
  1138. {
  1139. WLANSCAN_MODE,
  1140. IW_PRIV_TYPE_CHAR | 128,
  1141. IW_PRIV_TYPE_CHAR | 128,
  1142. "scanmode"},
  1143. {
  1144. WLAN_GET_ADHOC_STATUS,
  1145. IW_PRIV_TYPE_CHAR | 128,
  1146. IW_PRIV_TYPE_CHAR | 128,
  1147. "getadhocstatus"},
  1148. {
  1149. WLAN_SETNONE_GETWORDCHAR,
  1150. IW_PRIV_TYPE_NONE,
  1151. IW_PRIV_TYPE_CHAR | 128,
  1152. ""},
  1153. {
  1154. WLANGETLOG,
  1155. IW_PRIV_TYPE_NONE,
  1156. IW_PRIV_TYPE_CHAR | GETLOG_BUFSIZE,
  1157. "getlog"},
  1158. {
  1159. WLAN_SET_GET_SIXTEEN_INT,
  1160. IW_PRIV_TYPE_INT | 16,
  1161. IW_PRIV_TYPE_INT | 16,
  1162. ""},
  1163. {
  1164. WLAN_TPCCFG,
  1165. IW_PRIV_TYPE_INT | 16,
  1166. IW_PRIV_TYPE_INT | 16,
  1167. "tpccfg"},
  1168. {
  1169. WLAN_POWERCFG,
  1170. IW_PRIV_TYPE_INT | 16,
  1171. IW_PRIV_TYPE_INT | 16,
  1172. "powercfg"},
  1173. {
  1174. WLAN_AUTO_FREQ_SET,
  1175. IW_PRIV_TYPE_INT | 16,
  1176. IW_PRIV_TYPE_INT | 16,
  1177. "setafc"},
  1178. {
  1179. WLAN_AUTO_FREQ_GET,
  1180. IW_PRIV_TYPE_INT | 16,
  1181. IW_PRIV_TYPE_INT | 16,
  1182. "getafc"},
  1183. {
  1184. WLAN_SCANPROBES,
  1185. IW_PRIV_TYPE_INT | 16,
  1186. IW_PRIV_TYPE_INT | 16,
  1187. "scanprobes"},
  1188. {
  1189. WLAN_LED_GPIO_CTRL,
  1190. IW_PRIV_TYPE_INT | 16,
  1191. IW_PRIV_TYPE_INT | 16,
  1192. "ledgpio"},
  1193. {
  1194. WLAN_ADAPT_RATESET,
  1195. IW_PRIV_TYPE_INT | 16,
  1196. IW_PRIV_TYPE_INT | 16,
  1197. "rateadapt"},
  1198. {
  1199. WLAN_INACTIVITY_TIMEOUT,
  1200. IW_PRIV_TYPE_INT | 16,
  1201. IW_PRIV_TYPE_INT | 16,
  1202. "inactivityto"},
  1203. {
  1204. WLANSNR,
  1205. IW_PRIV_TYPE_INT | 16,
  1206. IW_PRIV_TYPE_INT | 16,
  1207. "getSNR"},
  1208. {
  1209. WLAN_GET_RATE,
  1210. IW_PRIV_TYPE_INT | 16,
  1211. IW_PRIV_TYPE_INT | 16,
  1212. "getrate"},
  1213. {
  1214. WLAN_GET_RXINFO,
  1215. IW_PRIV_TYPE_INT | 16,
  1216. IW_PRIV_TYPE_INT | 16,
  1217. "getrxinfo"},
  1218. };
  1219. static struct iw_statistics *wlan_get_wireless_stats(struct net_device *dev)
  1220. {
  1221. enum {
  1222. POOR = 30,
  1223. FAIR = 60,
  1224. GOOD = 80,
  1225. VERY_GOOD = 90,
  1226. EXCELLENT = 95,
  1227. PERFECT = 100
  1228. };
  1229. wlan_private *priv = dev->priv;
  1230. wlan_adapter *adapter = priv->adapter;
  1231. u32 rssi_qual;
  1232. u32 tx_qual;
  1233. u32 quality = 0;
  1234. int stats_valid = 0;
  1235. u8 rssi;
  1236. u32 tx_retries;
  1237. ENTER();
  1238. priv->wstats.status = adapter->inframode;
  1239. /* If we're not associated, all quality values are meaningless */
  1240. if (adapter->connect_status != libertas_connected)
  1241. goto out;
  1242. /* Quality by RSSI */
  1243. priv->wstats.qual.level =
  1244. CAL_RSSI(adapter->SNR[TYPE_BEACON][TYPE_NOAVG],
  1245. adapter->NF[TYPE_BEACON][TYPE_NOAVG]);
  1246. if (adapter->NF[TYPE_BEACON][TYPE_NOAVG] == 0) {
  1247. priv->wstats.qual.noise = MRVDRV_NF_DEFAULT_SCAN_VALUE;
  1248. } else {
  1249. priv->wstats.qual.noise =
  1250. CAL_NF(adapter->NF[TYPE_BEACON][TYPE_NOAVG]);
  1251. }
  1252. lbs_pr_debug(1, "Signal Level = %#x\n", priv->wstats.qual.level);
  1253. lbs_pr_debug(1, "Noise = %#x\n", priv->wstats.qual.noise);
  1254. rssi = priv->wstats.qual.level - priv->wstats.qual.noise;
  1255. if (rssi < 15)
  1256. rssi_qual = rssi * POOR / 10;
  1257. else if (rssi < 20)
  1258. rssi_qual = (rssi - 15) * (FAIR - POOR) / 5 + POOR;
  1259. else if (rssi < 30)
  1260. rssi_qual = (rssi - 20) * (GOOD - FAIR) / 5 + FAIR;
  1261. else if (rssi < 40)
  1262. rssi_qual = (rssi - 30) * (VERY_GOOD - GOOD) /
  1263. 10 + GOOD;
  1264. else
  1265. rssi_qual = (rssi - 40) * (PERFECT - VERY_GOOD) /
  1266. 10 + VERY_GOOD;
  1267. quality = rssi_qual;
  1268. /* Quality by TX errors */
  1269. priv->wstats.discard.retries = priv->stats.tx_errors;
  1270. tx_retries = adapter->logmsg.retry;
  1271. if (tx_retries > 75)
  1272. tx_qual = (90 - tx_retries) * POOR / 15;
  1273. else if (tx_retries > 70)
  1274. tx_qual = (75 - tx_retries) * (FAIR - POOR) / 5 + POOR;
  1275. else if (tx_retries > 65)
  1276. tx_qual = (70 - tx_retries) * (GOOD - FAIR) / 5 + FAIR;
  1277. else if (tx_retries > 50)
  1278. tx_qual = (65 - tx_retries) * (VERY_GOOD - GOOD) /
  1279. 15 + GOOD;
  1280. else
  1281. tx_qual = (50 - tx_retries) *
  1282. (PERFECT - VERY_GOOD) / 50 + VERY_GOOD;
  1283. quality = min(quality, tx_qual);
  1284. priv->wstats.discard.code = adapter->logmsg.wepundecryptable;
  1285. priv->wstats.discard.fragment = adapter->logmsg.fcserror;
  1286. priv->wstats.discard.retries = tx_retries;
  1287. priv->wstats.discard.misc = adapter->logmsg.ackfailure;
  1288. /* Calculate quality */
  1289. priv->wstats.qual.qual = max(quality, (u32)100);
  1290. priv->wstats.qual.updated = IW_QUAL_ALL_UPDATED | IW_QUAL_DBM;
  1291. stats_valid = 1;
  1292. /* update stats asynchronously for future calls */
  1293. libertas_prepare_and_send_command(priv, cmd_802_11_rssi, 0,
  1294. 0, 0, NULL);
  1295. libertas_prepare_and_send_command(priv, cmd_802_11_get_log, 0,
  1296. 0, 0, NULL);
  1297. out:
  1298. if (!stats_valid) {
  1299. priv->wstats.miss.beacon = 0;
  1300. priv->wstats.discard.retries = 0;
  1301. priv->wstats.qual.qual = 0;
  1302. priv->wstats.qual.level = 0;
  1303. priv->wstats.qual.noise = 0;
  1304. priv->wstats.qual.updated = IW_QUAL_ALL_UPDATED;
  1305. priv->wstats.qual.updated |= IW_QUAL_NOISE_INVALID |
  1306. IW_QUAL_QUAL_INVALID | IW_QUAL_LEVEL_INVALID;
  1307. }
  1308. LEAVE ();
  1309. return &priv->wstats;
  1310. }
  1311. static int wlan_set_freq(struct net_device *dev, struct iw_request_info *info,
  1312. struct iw_freq *fwrq, char *extra)
  1313. {
  1314. int ret = 0;
  1315. wlan_private *priv = dev->priv;
  1316. wlan_adapter *adapter = priv->adapter;
  1317. int rc = -EINPROGRESS; /* Call commit handler */
  1318. struct chan_freq_power *cfp;
  1319. ENTER();
  1320. /*
  1321. * If setting by frequency, convert to a channel
  1322. */
  1323. if (fwrq->e == 1) {
  1324. long f = fwrq->m / 100000;
  1325. int c = 0;
  1326. cfp = find_cfp_by_band_and_freq(adapter, 0, f);
  1327. if (!cfp) {
  1328. lbs_pr_debug(1, "Invalid freq=%ld\n", f);
  1329. return -EINVAL;
  1330. }
  1331. c = (int)cfp->channel;
  1332. if (c < 0)
  1333. return -EINVAL;
  1334. fwrq->e = 0;
  1335. fwrq->m = c;
  1336. }
  1337. /*
  1338. * Setting by channel number
  1339. */
  1340. if (fwrq->m > 1000 || fwrq->e > 0) {
  1341. rc = -EOPNOTSUPP;
  1342. } else {
  1343. int channel = fwrq->m;
  1344. cfp = libertas_find_cfp_by_band_and_channel(adapter, 0, channel);
  1345. if (!cfp) {
  1346. rc = -EINVAL;
  1347. } else {
  1348. if (adapter->inframode == wlan802_11ibss) {
  1349. rc = changeadhocchannel(priv, channel);
  1350. /* If station is WEP enabled, send the
  1351. * command to set WEP in firmware
  1352. */
  1353. if (adapter->secinfo.wep_enabled) {
  1354. lbs_pr_debug(1, "set_freq: WEP enabled\n");
  1355. ret = libertas_prepare_and_send_command(priv,
  1356. cmd_802_11_set_wep,
  1357. cmd_act_add,
  1358. cmd_option_waitforrsp,
  1359. 0,
  1360. NULL);
  1361. if (ret) {
  1362. LEAVE();
  1363. return ret;
  1364. }
  1365. adapter->currentpacketfilter |=
  1366. cmd_act_mac_wep_enable;
  1367. libertas_set_mac_packet_filter(priv);
  1368. }
  1369. } else {
  1370. rc = -EOPNOTSUPP;
  1371. }
  1372. }
  1373. }
  1374. LEAVE();
  1375. return rc;
  1376. }
  1377. /**
  1378. * @brief use index to get the data rate
  1379. *
  1380. * @param index The index of data rate
  1381. * @return data rate or 0
  1382. */
  1383. u32 libertas_index_to_data_rate(u8 index)
  1384. {
  1385. if (index >= sizeof(libertas_wlan_data_rates))
  1386. index = 0;
  1387. return libertas_wlan_data_rates[index];
  1388. }
  1389. /**
  1390. * @brief use rate to get the index
  1391. *
  1392. * @param rate data rate
  1393. * @return index or 0
  1394. */
  1395. u8 libertas_data_rate_to_index(u32 rate)
  1396. {
  1397. u8 *ptr;
  1398. if (rate)
  1399. if ((ptr = memchr(libertas_wlan_data_rates, (u8) rate,
  1400. sizeof(libertas_wlan_data_rates))))
  1401. return (ptr - libertas_wlan_data_rates);
  1402. return 0;
  1403. }
  1404. static int wlan_set_rate(struct net_device *dev, struct iw_request_info *info,
  1405. struct iw_param *vwrq, char *extra)
  1406. {
  1407. wlan_private *priv = dev->priv;
  1408. wlan_adapter *adapter = priv->adapter;
  1409. u32 data_rate;
  1410. u16 action;
  1411. int ret = 0;
  1412. u8 rates[WLAN_SUPPORTED_RATES];
  1413. u8 *rate;
  1414. ENTER();
  1415. lbs_pr_debug(1, "Vwrq->value = %d\n", vwrq->value);
  1416. if (vwrq->value == -1) {
  1417. action = cmd_act_set_tx_auto; // Auto
  1418. adapter->is_datarate_auto = 1;
  1419. adapter->datarate = 0;
  1420. } else {
  1421. if (vwrq->value % 100000) {
  1422. return -EINVAL;
  1423. }
  1424. data_rate = vwrq->value / 500000;
  1425. memset(rates, 0, sizeof(rates));
  1426. get_active_data_rates(adapter, rates);
  1427. rate = rates;
  1428. while (*rate) {
  1429. lbs_pr_debug(1, "Rate=0x%X Wanted=0x%X\n", *rate,
  1430. data_rate);
  1431. if ((*rate & 0x7f) == (data_rate & 0x7f))
  1432. break;
  1433. rate++;
  1434. }
  1435. if (!*rate) {
  1436. lbs_pr_alert( "The fixed data rate 0x%X is out "
  1437. "of range.\n", data_rate);
  1438. return -EINVAL;
  1439. }
  1440. adapter->datarate = data_rate;
  1441. action = cmd_act_set_tx_fix_rate;
  1442. adapter->is_datarate_auto = 0;
  1443. }
  1444. ret = libertas_prepare_and_send_command(priv, cmd_802_11_data_rate,
  1445. action, cmd_option_waitforrsp, 0, NULL);
  1446. LEAVE();
  1447. return ret;
  1448. }
  1449. static int wlan_get_rate(struct net_device *dev, struct iw_request_info *info,
  1450. struct iw_param *vwrq, char *extra)
  1451. {
  1452. wlan_private *priv = dev->priv;
  1453. wlan_adapter *adapter = priv->adapter;
  1454. ENTER();
  1455. if (adapter->is_datarate_auto) {
  1456. vwrq->fixed = 0;
  1457. } else {
  1458. vwrq->fixed = 1;
  1459. }
  1460. vwrq->value = adapter->datarate * 500000;
  1461. LEAVE();
  1462. return 0;
  1463. }
  1464. static int wlan_set_mode(struct net_device *dev,
  1465. struct iw_request_info *info, u32 * uwrq, char *extra)
  1466. {
  1467. int ret = 0;
  1468. wlan_private *priv = dev->priv;
  1469. wlan_adapter *adapter = priv->adapter;
  1470. struct assoc_request * assoc_req;
  1471. enum WLAN_802_11_NETWORK_INFRASTRUCTURE new_mode;
  1472. ENTER();
  1473. switch (*uwrq) {
  1474. case IW_MODE_ADHOC:
  1475. lbs_pr_debug(1, "Wanted mode is ad-hoc: current datarate=%#x\n",
  1476. adapter->datarate);
  1477. new_mode = wlan802_11ibss;
  1478. adapter->adhocchannel = DEFAULT_AD_HOC_CHANNEL;
  1479. break;
  1480. case IW_MODE_INFRA:
  1481. lbs_pr_debug(1, "Wanted mode is Infrastructure\n");
  1482. new_mode = wlan802_11infrastructure;
  1483. break;
  1484. case IW_MODE_AUTO:
  1485. lbs_pr_debug(1, "Wanted mode is Auto\n");
  1486. new_mode = wlan802_11autounknown;
  1487. break;
  1488. default:
  1489. lbs_pr_debug(1, "Wanted mode is Unknown: 0x%x\n", *uwrq);
  1490. return -EINVAL;
  1491. }
  1492. mutex_lock(&adapter->lock);
  1493. assoc_req = wlan_get_association_request(adapter);
  1494. if (!assoc_req) {
  1495. ret = -ENOMEM;
  1496. } else {
  1497. assoc_req->mode = new_mode;
  1498. }
  1499. if (ret == 0) {
  1500. set_bit(ASSOC_FLAG_MODE, &assoc_req->flags);
  1501. wlan_postpone_association_work(priv);
  1502. } else {
  1503. wlan_cancel_association_work(priv);
  1504. }
  1505. mutex_unlock(&adapter->lock);
  1506. LEAVE();
  1507. return ret;
  1508. }
  1509. /**
  1510. * @brief Get Encryption key
  1511. *
  1512. * @param dev A pointer to net_device structure
  1513. * @param info A pointer to iw_request_info structure
  1514. * @param vwrq A pointer to iw_param structure
  1515. * @param extra A pointer to extra data buf
  1516. * @return 0 --success, otherwise fail
  1517. */
  1518. static int wlan_get_encode(struct net_device *dev,
  1519. struct iw_request_info *info,
  1520. struct iw_point *dwrq, u8 * extra)
  1521. {
  1522. wlan_private *priv = dev->priv;
  1523. wlan_adapter *adapter = priv->adapter;
  1524. int index = (dwrq->flags & IW_ENCODE_INDEX) - 1;
  1525. ENTER();
  1526. lbs_pr_debug(1, "flags=0x%x index=%d length=%d wep_tx_keyidx=%d\n",
  1527. dwrq->flags, index, dwrq->length, adapter->wep_tx_keyidx);
  1528. dwrq->flags = 0;
  1529. /* Authentication method */
  1530. switch (adapter->secinfo.auth_mode) {
  1531. case IW_AUTH_ALG_OPEN_SYSTEM:
  1532. dwrq->flags = IW_ENCODE_OPEN;
  1533. break;
  1534. case IW_AUTH_ALG_SHARED_KEY:
  1535. case IW_AUTH_ALG_LEAP:
  1536. dwrq->flags = IW_ENCODE_RESTRICTED;
  1537. break;
  1538. default:
  1539. dwrq->flags = IW_ENCODE_DISABLED | IW_ENCODE_OPEN;
  1540. break;
  1541. }
  1542. if ( adapter->secinfo.wep_enabled
  1543. || adapter->secinfo.WPAenabled
  1544. || adapter->secinfo.WPA2enabled) {
  1545. dwrq->flags &= ~IW_ENCODE_DISABLED;
  1546. } else {
  1547. dwrq->flags |= IW_ENCODE_DISABLED;
  1548. }
  1549. memset(extra, 0, 16);
  1550. mutex_lock(&adapter->lock);
  1551. /* Default to returning current transmit key */
  1552. if (index < 0)
  1553. index = adapter->wep_tx_keyidx;
  1554. if ((adapter->wep_keys[index].len) && adapter->secinfo.wep_enabled) {
  1555. memcpy(extra, adapter->wep_keys[index].key,
  1556. adapter->wep_keys[index].len);
  1557. dwrq->length = adapter->wep_keys[index].len;
  1558. dwrq->flags |= (index + 1);
  1559. /* Return WEP enabled */
  1560. dwrq->flags &= ~IW_ENCODE_DISABLED;
  1561. } else if ((adapter->secinfo.WPAenabled)
  1562. || (adapter->secinfo.WPA2enabled)) {
  1563. /* return WPA enabled */
  1564. dwrq->flags &= ~IW_ENCODE_DISABLED;
  1565. } else {
  1566. dwrq->flags |= IW_ENCODE_DISABLED;
  1567. }
  1568. mutex_unlock(&adapter->lock);
  1569. dwrq->flags |= IW_ENCODE_NOKEY;
  1570. lbs_pr_debug(1, "key:%02x:%02x:%02x:%02x:%02x:%02x keylen=%d\n",
  1571. extra[0], extra[1], extra[2],
  1572. extra[3], extra[4], extra[5], dwrq->length);
  1573. lbs_pr_debug(1, "Return flags=0x%x\n", dwrq->flags);
  1574. LEAVE();
  1575. return 0;
  1576. }
  1577. /**
  1578. * @brief Set Encryption key (internal)
  1579. *
  1580. * @param priv A pointer to private card structure
  1581. * @param key_material A pointer to key material
  1582. * @param key_length length of key material
  1583. * @param index key index to set
  1584. * @param set_tx_key Force set TX key (1 = yes, 0 = no)
  1585. * @return 0 --success, otherwise fail
  1586. */
  1587. static int wlan_set_wep_key(struct assoc_request *assoc_req,
  1588. const char *key_material,
  1589. u16 key_length,
  1590. u16 index,
  1591. int set_tx_key)
  1592. {
  1593. struct WLAN_802_11_KEY *pkey;
  1594. ENTER();
  1595. /* Paranoid validation of key index */
  1596. if (index > 3) {
  1597. LEAVE();
  1598. return -EINVAL;
  1599. }
  1600. /* validate max key length */
  1601. if (key_length > KEY_LEN_WEP_104) {
  1602. LEAVE();
  1603. return -EINVAL;
  1604. }
  1605. pkey = &assoc_req->wep_keys[index];
  1606. if (key_length > 0) {
  1607. memset(pkey, 0, sizeof(struct WLAN_802_11_KEY));
  1608. pkey->type = KEY_TYPE_ID_WEP;
  1609. /* Standardize the key length */
  1610. pkey->len = (key_length > KEY_LEN_WEP_40) ?
  1611. KEY_LEN_WEP_104 : KEY_LEN_WEP_40;
  1612. memcpy(pkey->key, key_material, key_length);
  1613. }
  1614. if (set_tx_key) {
  1615. /* Ensure the chosen key is valid */
  1616. if (!pkey->len) {
  1617. lbs_pr_debug(1, "key not set, so cannot enable it\n");
  1618. LEAVE();
  1619. return -EINVAL;
  1620. }
  1621. assoc_req->wep_tx_keyidx = index;
  1622. }
  1623. assoc_req->secinfo.wep_enabled = 1;
  1624. LEAVE();
  1625. return 0;
  1626. }
  1627. static int validate_key_index(u16 def_index, u16 raw_index,
  1628. u16 *out_index, u16 *is_default)
  1629. {
  1630. if (!out_index || !is_default)
  1631. return -EINVAL;
  1632. /* Verify index if present, otherwise use default TX key index */
  1633. if (raw_index > 0) {
  1634. if (raw_index > 4)
  1635. return -EINVAL;
  1636. *out_index = raw_index - 1;
  1637. } else {
  1638. *out_index = def_index;
  1639. *is_default = 1;
  1640. }
  1641. return 0;
  1642. }
  1643. static void disable_wep(struct assoc_request *assoc_req)
  1644. {
  1645. int i;
  1646. /* Set Open System auth mode */
  1647. assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
  1648. /* Clear WEP keys and mark WEP as disabled */
  1649. assoc_req->secinfo.wep_enabled = 0;
  1650. for (i = 0; i < 4; i++)
  1651. assoc_req->wep_keys[i].len = 0;
  1652. set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
  1653. set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags);
  1654. }
  1655. /**
  1656. * @brief Set Encryption key
  1657. *
  1658. * @param dev A pointer to net_device structure
  1659. * @param info A pointer to iw_request_info structure
  1660. * @param vwrq A pointer to iw_param structure
  1661. * @param extra A pointer to extra data buf
  1662. * @return 0 --success, otherwise fail
  1663. */
  1664. static int wlan_set_encode(struct net_device *dev,
  1665. struct iw_request_info *info,
  1666. struct iw_point *dwrq, char *extra)
  1667. {
  1668. int ret = 0;
  1669. wlan_private *priv = dev->priv;
  1670. wlan_adapter *adapter = priv->adapter;
  1671. struct assoc_request * assoc_req;
  1672. u16 is_default = 0, index = 0, set_tx_key = 0;
  1673. ENTER();
  1674. mutex_lock(&adapter->lock);
  1675. assoc_req = wlan_get_association_request(adapter);
  1676. if (!assoc_req) {
  1677. ret = -ENOMEM;
  1678. goto out;
  1679. }
  1680. if (dwrq->flags & IW_ENCODE_DISABLED) {
  1681. disable_wep (assoc_req);
  1682. goto out;
  1683. }
  1684. ret = validate_key_index(assoc_req->wep_tx_keyidx,
  1685. (dwrq->flags & IW_ENCODE_INDEX),
  1686. &index, &is_default);
  1687. if (ret) {
  1688. ret = -EINVAL;
  1689. goto out;
  1690. }
  1691. /* If WEP isn't enabled, or if there is no key data but a valid
  1692. * index, set the TX key.
  1693. */
  1694. if (!assoc_req->secinfo.wep_enabled || (dwrq->length == 0 && !is_default))
  1695. set_tx_key = 1;
  1696. ret = wlan_set_wep_key(assoc_req, extra, dwrq->length, index, set_tx_key);
  1697. if (ret)
  1698. goto out;
  1699. if (dwrq->length)
  1700. set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags);
  1701. if (set_tx_key)
  1702. set_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags);
  1703. if (dwrq->flags & IW_ENCODE_RESTRICTED) {
  1704. assoc_req->secinfo.auth_mode = IW_AUTH_ALG_SHARED_KEY;
  1705. } else if (dwrq->flags & IW_ENCODE_OPEN) {
  1706. assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
  1707. }
  1708. out:
  1709. if (ret == 0) {
  1710. set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
  1711. wlan_postpone_association_work(priv);
  1712. } else {
  1713. wlan_cancel_association_work(priv);
  1714. }
  1715. mutex_unlock(&adapter->lock);
  1716. LEAVE();
  1717. return ret;
  1718. }
  1719. /**
  1720. * @brief Get Extended Encryption key (WPA/802.1x and WEP)
  1721. *
  1722. * @param dev A pointer to net_device structure
  1723. * @param info A pointer to iw_request_info structure
  1724. * @param vwrq A pointer to iw_param structure
  1725. * @param extra A pointer to extra data buf
  1726. * @return 0 on success, otherwise failure
  1727. */
  1728. static int wlan_get_encodeext(struct net_device *dev,
  1729. struct iw_request_info *info,
  1730. struct iw_point *dwrq,
  1731. char *extra)
  1732. {
  1733. int ret = -EINVAL;
  1734. wlan_private *priv = dev->priv;
  1735. wlan_adapter *adapter = priv->adapter;
  1736. struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
  1737. int index, max_key_len;
  1738. ENTER();
  1739. max_key_len = dwrq->length - sizeof(*ext);
  1740. if (max_key_len < 0)
  1741. goto out;
  1742. index = dwrq->flags & IW_ENCODE_INDEX;
  1743. if (index) {
  1744. if (index < 1 || index > 4)
  1745. goto out;
  1746. index--;
  1747. } else {
  1748. index = adapter->wep_tx_keyidx;
  1749. }
  1750. if (!ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY &&
  1751. ext->alg != IW_ENCODE_ALG_WEP) {
  1752. if (index != 0 || adapter->inframode != wlan802_11infrastructure)
  1753. goto out;
  1754. }
  1755. dwrq->flags = index + 1;
  1756. memset(ext, 0, sizeof(*ext));
  1757. if ( !adapter->secinfo.wep_enabled
  1758. && !adapter->secinfo.WPAenabled
  1759. && !adapter->secinfo.WPA2enabled) {
  1760. ext->alg = IW_ENCODE_ALG_NONE;
  1761. ext->key_len = 0;
  1762. dwrq->flags |= IW_ENCODE_DISABLED;
  1763. } else {
  1764. u8 *key = NULL;
  1765. if ( adapter->secinfo.wep_enabled
  1766. && !adapter->secinfo.WPAenabled
  1767. && !adapter->secinfo.WPA2enabled) {
  1768. ext->alg = IW_ENCODE_ALG_WEP;
  1769. ext->key_len = adapter->wep_keys[index].len;
  1770. key = &adapter->wep_keys[index].key[0];
  1771. } else if ( !adapter->secinfo.wep_enabled
  1772. && (adapter->secinfo.WPAenabled ||
  1773. adapter->secinfo.WPA2enabled)) {
  1774. /* WPA */
  1775. ext->alg = IW_ENCODE_ALG_TKIP;
  1776. ext->key_len = 0;
  1777. } else {
  1778. goto out;
  1779. }
  1780. if (ext->key_len > max_key_len) {
  1781. ret = -E2BIG;
  1782. goto out;
  1783. }
  1784. if (ext->key_len)
  1785. memcpy(ext->key, key, ext->key_len);
  1786. else
  1787. dwrq->flags |= IW_ENCODE_NOKEY;
  1788. dwrq->flags |= IW_ENCODE_ENABLED;
  1789. }
  1790. ret = 0;
  1791. out:
  1792. LEAVE();
  1793. return ret;
  1794. }
  1795. /**
  1796. * @brief Set Encryption key Extended (WPA/802.1x and WEP)
  1797. *
  1798. * @param dev A pointer to net_device structure
  1799. * @param info A pointer to iw_request_info structure
  1800. * @param vwrq A pointer to iw_param structure
  1801. * @param extra A pointer to extra data buf
  1802. * @return 0 --success, otherwise fail
  1803. */
  1804. static int wlan_set_encodeext(struct net_device *dev,
  1805. struct iw_request_info *info,
  1806. struct iw_point *dwrq,
  1807. char *extra)
  1808. {
  1809. int ret = 0;
  1810. wlan_private *priv = dev->priv;
  1811. wlan_adapter *adapter = priv->adapter;
  1812. struct iw_encode_ext *ext = (struct iw_encode_ext *)extra;
  1813. int alg = ext->alg;
  1814. struct assoc_request * assoc_req;
  1815. ENTER();
  1816. mutex_lock(&adapter->lock);
  1817. assoc_req = wlan_get_association_request(adapter);
  1818. if (!assoc_req) {
  1819. ret = -ENOMEM;
  1820. goto out;
  1821. }
  1822. if ((alg == IW_ENCODE_ALG_NONE) || (dwrq->flags & IW_ENCODE_DISABLED)) {
  1823. disable_wep (assoc_req);
  1824. } else if (alg == IW_ENCODE_ALG_WEP) {
  1825. u16 is_default = 0, index, set_tx_key = 0;
  1826. ret = validate_key_index(assoc_req->wep_tx_keyidx,
  1827. (dwrq->flags & IW_ENCODE_INDEX),
  1828. &index, &is_default);
  1829. if (ret)
  1830. goto out;
  1831. /* If WEP isn't enabled, or if there is no key data but a valid
  1832. * index, or if the set-TX-key flag was passed, set the TX key.
  1833. */
  1834. if ( !assoc_req->secinfo.wep_enabled
  1835. || (dwrq->length == 0 && !is_default)
  1836. || (ext->ext_flags & IW_ENCODE_EXT_SET_TX_KEY))
  1837. set_tx_key = 1;
  1838. /* Copy key to driver */
  1839. ret = wlan_set_wep_key (assoc_req, ext->key, ext->key_len, index,
  1840. set_tx_key);
  1841. if (ret)
  1842. goto out;
  1843. if (dwrq->flags & IW_ENCODE_RESTRICTED) {
  1844. assoc_req->secinfo.auth_mode = IW_AUTH_ALG_SHARED_KEY;
  1845. } else if (dwrq->flags & IW_ENCODE_OPEN) {
  1846. assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
  1847. }
  1848. /* Mark the various WEP bits as modified */
  1849. set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
  1850. if (dwrq->length)
  1851. set_bit(ASSOC_FLAG_WEP_KEYS, &assoc_req->flags);
  1852. if (set_tx_key)
  1853. set_bit(ASSOC_FLAG_WEP_TX_KEYIDX, &assoc_req->flags);
  1854. } else if ((alg == IW_ENCODE_ALG_TKIP) || (alg == IW_ENCODE_ALG_CCMP)) {
  1855. struct WLAN_802_11_KEY * pkey;
  1856. /* validate key length */
  1857. if (((alg == IW_ENCODE_ALG_TKIP)
  1858. && (ext->key_len != KEY_LEN_WPA_TKIP))
  1859. || ((alg == IW_ENCODE_ALG_CCMP)
  1860. && (ext->key_len != KEY_LEN_WPA_AES))) {
  1861. lbs_pr_debug(1, "Invalid size %d for key of alg"
  1862. "type %d.\n",
  1863. ext->key_len,
  1864. alg);
  1865. ret = -EINVAL;
  1866. goto out;
  1867. }
  1868. if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY)
  1869. pkey = &assoc_req->wpa_mcast_key;
  1870. else
  1871. pkey = &assoc_req->wpa_unicast_key;
  1872. memset(pkey, 0, sizeof (struct WLAN_802_11_KEY));
  1873. memcpy(pkey->key, ext->key, ext->key_len);
  1874. pkey->len = ext->key_len;
  1875. pkey->flags = KEY_INFO_WPA_ENABLED;
  1876. if (ext->ext_flags & IW_ENCODE_EXT_GROUP_KEY) {
  1877. pkey->flags |= KEY_INFO_WPA_MCAST;
  1878. set_bit(ASSOC_FLAG_WPA_MCAST_KEY, &assoc_req->flags);
  1879. } else {
  1880. pkey->flags |= KEY_INFO_WPA_UNICAST;
  1881. set_bit(ASSOC_FLAG_WPA_UCAST_KEY, &assoc_req->flags);
  1882. }
  1883. if (alg == IW_ENCODE_ALG_TKIP)
  1884. pkey->type = KEY_TYPE_ID_TKIP;
  1885. else if (alg == IW_ENCODE_ALG_CCMP)
  1886. pkey->type = KEY_TYPE_ID_AES;
  1887. /* If WPA isn't enabled yet, do that now */
  1888. if ( assoc_req->secinfo.WPAenabled == 0
  1889. && assoc_req->secinfo.WPA2enabled == 0) {
  1890. assoc_req->secinfo.WPAenabled = 1;
  1891. assoc_req->secinfo.WPA2enabled = 1;
  1892. set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
  1893. }
  1894. disable_wep (assoc_req);
  1895. }
  1896. out:
  1897. if (ret == 0) {
  1898. wlan_postpone_association_work(priv);
  1899. } else {
  1900. wlan_cancel_association_work(priv);
  1901. }
  1902. mutex_unlock(&adapter->lock);
  1903. LEAVE();
  1904. return ret;
  1905. }
  1906. static int wlan_set_genie(struct net_device *dev,
  1907. struct iw_request_info *info,
  1908. struct iw_point *dwrq,
  1909. char *extra)
  1910. {
  1911. wlan_private *priv = dev->priv;
  1912. wlan_adapter *adapter = priv->adapter;
  1913. int ret = 0;
  1914. struct assoc_request * assoc_req;
  1915. ENTER();
  1916. mutex_lock(&adapter->lock);
  1917. assoc_req = wlan_get_association_request(adapter);
  1918. if (!assoc_req) {
  1919. ret = -ENOMEM;
  1920. goto out;
  1921. }
  1922. if (dwrq->length > MAX_WPA_IE_LEN ||
  1923. (dwrq->length && extra == NULL)) {
  1924. ret = -EINVAL;
  1925. goto out;
  1926. }
  1927. if (dwrq->length) {
  1928. memcpy(&assoc_req->wpa_ie[0], extra, dwrq->length);
  1929. assoc_req->wpa_ie_len = dwrq->length;
  1930. } else {
  1931. memset(&assoc_req->wpa_ie[0], 0, sizeof(adapter->wpa_ie));
  1932. assoc_req->wpa_ie_len = 0;
  1933. }
  1934. out:
  1935. if (ret == 0) {
  1936. set_bit(ASSOC_FLAG_WPA_IE, &assoc_req->flags);
  1937. wlan_postpone_association_work(priv);
  1938. } else {
  1939. wlan_cancel_association_work(priv);
  1940. }
  1941. mutex_unlock(&adapter->lock);
  1942. LEAVE();
  1943. return ret;
  1944. }
  1945. static int wlan_get_genie(struct net_device *dev,
  1946. struct iw_request_info *info,
  1947. struct iw_point *dwrq,
  1948. char *extra)
  1949. {
  1950. wlan_private *priv = dev->priv;
  1951. wlan_adapter *adapter = priv->adapter;
  1952. ENTER();
  1953. if (adapter->wpa_ie_len == 0) {
  1954. dwrq->length = 0;
  1955. LEAVE();
  1956. return 0;
  1957. }
  1958. if (dwrq->length < adapter->wpa_ie_len) {
  1959. LEAVE();
  1960. return -E2BIG;
  1961. }
  1962. dwrq->length = adapter->wpa_ie_len;
  1963. memcpy(extra, &adapter->wpa_ie[0], adapter->wpa_ie_len);
  1964. LEAVE();
  1965. return 0;
  1966. }
  1967. static int wlan_set_auth(struct net_device *dev,
  1968. struct iw_request_info *info,
  1969. struct iw_param *dwrq,
  1970. char *extra)
  1971. {
  1972. wlan_private *priv = dev->priv;
  1973. wlan_adapter *adapter = priv->adapter;
  1974. struct assoc_request * assoc_req;
  1975. int ret = 0;
  1976. int updated = 0;
  1977. ENTER();
  1978. mutex_lock(&adapter->lock);
  1979. assoc_req = wlan_get_association_request(adapter);
  1980. if (!assoc_req) {
  1981. ret = -ENOMEM;
  1982. goto out;
  1983. }
  1984. switch (dwrq->flags & IW_AUTH_INDEX) {
  1985. case IW_AUTH_TKIP_COUNTERMEASURES:
  1986. case IW_AUTH_CIPHER_PAIRWISE:
  1987. case IW_AUTH_CIPHER_GROUP:
  1988. case IW_AUTH_KEY_MGMT:
  1989. /*
  1990. * libertas does not use these parameters
  1991. */
  1992. break;
  1993. case IW_AUTH_WPA_VERSION:
  1994. if (dwrq->value & IW_AUTH_WPA_VERSION_DISABLED) {
  1995. assoc_req->secinfo.WPAenabled = 0;
  1996. assoc_req->secinfo.WPA2enabled = 0;
  1997. }
  1998. if (dwrq->value & IW_AUTH_WPA_VERSION_WPA) {
  1999. assoc_req->secinfo.WPAenabled = 1;
  2000. assoc_req->secinfo.wep_enabled = 0;
  2001. assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
  2002. }
  2003. if (dwrq->value & IW_AUTH_WPA_VERSION_WPA2) {
  2004. assoc_req->secinfo.WPA2enabled = 1;
  2005. assoc_req->secinfo.wep_enabled = 0;
  2006. assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
  2007. }
  2008. updated = 1;
  2009. break;
  2010. case IW_AUTH_DROP_UNENCRYPTED:
  2011. if (dwrq->value) {
  2012. adapter->currentpacketfilter |=
  2013. cmd_act_mac_strict_protection_enable;
  2014. } else {
  2015. adapter->currentpacketfilter &=
  2016. ~cmd_act_mac_strict_protection_enable;
  2017. }
  2018. updated = 1;
  2019. break;
  2020. case IW_AUTH_80211_AUTH_ALG:
  2021. if (dwrq->value & IW_AUTH_ALG_SHARED_KEY) {
  2022. assoc_req->secinfo.auth_mode = IW_AUTH_ALG_SHARED_KEY;
  2023. } else if (dwrq->value & IW_AUTH_ALG_OPEN_SYSTEM) {
  2024. assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
  2025. } else if (dwrq->value & IW_AUTH_ALG_LEAP) {
  2026. assoc_req->secinfo.auth_mode = IW_AUTH_ALG_LEAP;
  2027. } else {
  2028. ret = -EINVAL;
  2029. }
  2030. updated = 1;
  2031. break;
  2032. case IW_AUTH_WPA_ENABLED:
  2033. if (dwrq->value) {
  2034. if (!assoc_req->secinfo.WPAenabled &&
  2035. !assoc_req->secinfo.WPA2enabled) {
  2036. assoc_req->secinfo.WPAenabled = 1;
  2037. assoc_req->secinfo.WPA2enabled = 1;
  2038. assoc_req->secinfo.wep_enabled = 0;
  2039. assoc_req->secinfo.auth_mode = IW_AUTH_ALG_OPEN_SYSTEM;
  2040. }
  2041. } else {
  2042. assoc_req->secinfo.WPAenabled = 0;
  2043. assoc_req->secinfo.WPA2enabled = 0;
  2044. }
  2045. updated = 1;
  2046. break;
  2047. default:
  2048. ret = -EOPNOTSUPP;
  2049. break;
  2050. }
  2051. out:
  2052. if (ret == 0) {
  2053. if (updated)
  2054. set_bit(ASSOC_FLAG_SECINFO, &assoc_req->flags);
  2055. wlan_postpone_association_work(priv);
  2056. } else if (ret != -EOPNOTSUPP) {
  2057. wlan_cancel_association_work(priv);
  2058. }
  2059. mutex_unlock(&adapter->lock);
  2060. LEAVE();
  2061. return ret;
  2062. }
  2063. static int wlan_get_auth(struct net_device *dev,
  2064. struct iw_request_info *info,
  2065. struct iw_param *dwrq,
  2066. char *extra)
  2067. {
  2068. wlan_private *priv = dev->priv;
  2069. wlan_adapter *adapter = priv->adapter;
  2070. ENTER();
  2071. switch (dwrq->flags & IW_AUTH_INDEX) {
  2072. case IW_AUTH_WPA_VERSION:
  2073. dwrq->value = 0;
  2074. if (adapter->secinfo.WPAenabled)
  2075. dwrq->value |= IW_AUTH_WPA_VERSION_WPA;
  2076. if (adapter->secinfo.WPA2enabled)
  2077. dwrq->value |= IW_AUTH_WPA_VERSION_WPA2;
  2078. if (!dwrq->value)
  2079. dwrq->value |= IW_AUTH_WPA_VERSION_DISABLED;
  2080. break;
  2081. case IW_AUTH_DROP_UNENCRYPTED:
  2082. dwrq->value = 0;
  2083. if (adapter->currentpacketfilter &
  2084. cmd_act_mac_strict_protection_enable)
  2085. dwrq->value = 1;
  2086. break;
  2087. case IW_AUTH_80211_AUTH_ALG:
  2088. dwrq->value = adapter->secinfo.auth_mode;
  2089. break;
  2090. case IW_AUTH_WPA_ENABLED:
  2091. if (adapter->secinfo.WPAenabled && adapter->secinfo.WPA2enabled)
  2092. dwrq->value = 1;
  2093. break;
  2094. default:
  2095. LEAVE();
  2096. return -EOPNOTSUPP;
  2097. }
  2098. LEAVE();
  2099. return 0;
  2100. }
  2101. static int wlan_set_txpow(struct net_device *dev, struct iw_request_info *info,
  2102. struct iw_param *vwrq, char *extra)
  2103. {
  2104. int ret = 0;
  2105. wlan_private *priv = dev->priv;
  2106. wlan_adapter *adapter = priv->adapter;
  2107. u16 dbm;
  2108. ENTER();
  2109. if (vwrq->disabled) {
  2110. wlan_radio_ioctl(priv, RADIO_OFF);
  2111. return 0;
  2112. }
  2113. adapter->preamble = cmd_type_auto_preamble;
  2114. wlan_radio_ioctl(priv, RADIO_ON);
  2115. if ((vwrq->flags & IW_TXPOW_TYPE) == IW_TXPOW_MWATT) {
  2116. dbm = (u16) mw_to_dbm(vwrq->value);
  2117. } else
  2118. dbm = (u16) vwrq->value;
  2119. /* auto tx power control */
  2120. if (vwrq->fixed == 0)
  2121. dbm = 0xffff;
  2122. lbs_pr_debug(1, "<1>TXPOWER SET %d dbm.\n", dbm);
  2123. ret = libertas_prepare_and_send_command(priv,
  2124. cmd_802_11_rf_tx_power,
  2125. cmd_act_tx_power_opt_set_low,
  2126. cmd_option_waitforrsp, 0, (void *)&dbm);
  2127. LEAVE();
  2128. return ret;
  2129. }
  2130. static int wlan_get_essid(struct net_device *dev, struct iw_request_info *info,
  2131. struct iw_point *dwrq, char *extra)
  2132. {
  2133. wlan_private *priv = dev->priv;
  2134. wlan_adapter *adapter = priv->adapter;
  2135. ENTER();
  2136. /*
  2137. * Note : if dwrq->flags != 0, we should get the relevant SSID from
  2138. * the SSID list...
  2139. */
  2140. /*
  2141. * Get the current SSID
  2142. */
  2143. if (adapter->connect_status == libertas_connected) {
  2144. memcpy(extra, adapter->curbssparams.ssid.ssid,
  2145. adapter->curbssparams.ssid.ssidlength);
  2146. extra[adapter->curbssparams.ssid.ssidlength] = '\0';
  2147. } else {
  2148. memset(extra, 0, 32);
  2149. extra[adapter->curbssparams.ssid.ssidlength] = '\0';
  2150. }
  2151. /*
  2152. * If none, we may want to get the one that was set
  2153. */
  2154. /* To make the driver backward compatible with WPA supplicant v0.2.4 */
  2155. if (dwrq->length == 32) /* check with WPA supplicant buffer size */
  2156. dwrq->length = min_t(size_t, adapter->curbssparams.ssid.ssidlength,
  2157. IW_ESSID_MAX_SIZE);
  2158. else
  2159. dwrq->length = adapter->curbssparams.ssid.ssidlength + 1;
  2160. dwrq->flags = 1; /* active */
  2161. LEAVE();
  2162. return 0;
  2163. }
  2164. static int wlan_set_essid(struct net_device *dev, struct iw_request_info *info,
  2165. struct iw_point *dwrq, char *extra)
  2166. {
  2167. wlan_private *priv = dev->priv;
  2168. wlan_adapter *adapter = priv->adapter;
  2169. int ret = 0;
  2170. struct WLAN_802_11_SSID ssid;
  2171. struct assoc_request * assoc_req;
  2172. int ssid_len = dwrq->length;
  2173. ENTER();
  2174. /*
  2175. * WE-20 and earlier NULL pad the end of the SSID and increment
  2176. * SSID length so it can be used like a string. WE-21 and later don't,
  2177. * but some userspace tools aren't able to cope with the change.
  2178. */
  2179. if ((ssid_len > 0) && (extra[ssid_len - 1] == '\0'))
  2180. ssid_len--;
  2181. /* Check the size of the string */
  2182. if (ssid_len > IW_ESSID_MAX_SIZE) {
  2183. ret = -E2BIG;
  2184. goto out;
  2185. }
  2186. memset(&ssid, 0, sizeof(struct WLAN_802_11_SSID));
  2187. if (!dwrq->flags || !ssid_len) {
  2188. /* "any" SSID requested; leave SSID blank */
  2189. } else {
  2190. /* Specific SSID requested */
  2191. memcpy(&ssid.ssid, extra, ssid_len);
  2192. ssid.ssidlength = ssid_len;
  2193. }
  2194. lbs_pr_debug(1, "Requested new SSID = %s\n",
  2195. (ssid.ssidlength > 0) ? (char *)ssid.ssid : "any");
  2196. out:
  2197. mutex_lock(&adapter->lock);
  2198. if (ret == 0) {
  2199. /* Get or create the current association request */
  2200. assoc_req = wlan_get_association_request(adapter);
  2201. if (!assoc_req) {
  2202. ret = -ENOMEM;
  2203. } else {
  2204. /* Copy the SSID to the association request */
  2205. memcpy(&assoc_req->ssid, &ssid, sizeof(struct WLAN_802_11_SSID));
  2206. set_bit(ASSOC_FLAG_SSID, &assoc_req->flags);
  2207. wlan_postpone_association_work(priv);
  2208. }
  2209. }
  2210. /* Cancel the association request if there was an error */
  2211. if (ret != 0) {
  2212. wlan_cancel_association_work(priv);
  2213. }
  2214. mutex_unlock(&adapter->lock);
  2215. LEAVE();
  2216. return ret;
  2217. }
  2218. /**
  2219. * @brief Connect to the AP or Ad-hoc Network with specific bssid
  2220. *
  2221. * @param dev A pointer to net_device structure
  2222. * @param info A pointer to iw_request_info structure
  2223. * @param awrq A pointer to iw_param structure
  2224. * @param extra A pointer to extra data buf
  2225. * @return 0 --success, otherwise fail
  2226. */
  2227. static int wlan_set_wap(struct net_device *dev, struct iw_request_info *info,
  2228. struct sockaddr *awrq, char *extra)
  2229. {
  2230. wlan_private *priv = dev->priv;
  2231. wlan_adapter *adapter = priv->adapter;
  2232. struct assoc_request * assoc_req;
  2233. int ret = 0;
  2234. ENTER();
  2235. if (awrq->sa_family != ARPHRD_ETHER)
  2236. return -EINVAL;
  2237. lbs_pr_debug(1, "ASSOC: WAP: sa_data: " MAC_FMT "\n", MAC_ARG(awrq->sa_data));
  2238. mutex_lock(&adapter->lock);
  2239. /* Get or create the current association request */
  2240. assoc_req = wlan_get_association_request(adapter);
  2241. if (!assoc_req) {
  2242. wlan_cancel_association_work(priv);
  2243. ret = -ENOMEM;
  2244. } else {
  2245. /* Copy the BSSID to the association request */
  2246. memcpy(&assoc_req->bssid, awrq->sa_data, ETH_ALEN);
  2247. set_bit(ASSOC_FLAG_BSSID, &assoc_req->flags);
  2248. wlan_postpone_association_work(priv);
  2249. }
  2250. mutex_unlock(&adapter->lock);
  2251. return ret;
  2252. }
  2253. void libertas_get_fwversion(wlan_adapter * adapter, char *fwversion, int maxlen)
  2254. {
  2255. union {
  2256. u32 l;
  2257. u8 c[4];
  2258. } ver;
  2259. char fwver[32];
  2260. mutex_lock(&adapter->lock);
  2261. ver.l = adapter->fwreleasenumber;
  2262. mutex_unlock(&adapter->lock);
  2263. if (ver.c[3] == 0)
  2264. sprintf(fwver, "%u.%u.%u", ver.c[2], ver.c[1], ver.c[0]);
  2265. else
  2266. sprintf(fwver, "%u.%u.%u.p%u",
  2267. ver.c[2], ver.c[1], ver.c[0], ver.c[3]);
  2268. snprintf(fwversion, maxlen, fwver);
  2269. }
  2270. /*
  2271. * iwconfig settable callbacks
  2272. */
  2273. static const iw_handler wlan_handler[] = {
  2274. (iw_handler) NULL, /* SIOCSIWCOMMIT */
  2275. (iw_handler) wlan_get_name, /* SIOCGIWNAME */
  2276. (iw_handler) NULL, /* SIOCSIWNWID */
  2277. (iw_handler) NULL, /* SIOCGIWNWID */
  2278. (iw_handler) wlan_set_freq, /* SIOCSIWFREQ */
  2279. (iw_handler) wlan_get_freq, /* SIOCGIWFREQ */
  2280. (iw_handler) wlan_set_mode, /* SIOCSIWMODE */
  2281. (iw_handler) wlan_get_mode, /* SIOCGIWMODE */
  2282. (iw_handler) NULL, /* SIOCSIWSENS */
  2283. (iw_handler) NULL, /* SIOCGIWSENS */
  2284. (iw_handler) NULL, /* SIOCSIWRANGE */
  2285. (iw_handler) wlan_get_range, /* SIOCGIWRANGE */
  2286. (iw_handler) NULL, /* SIOCSIWPRIV */
  2287. (iw_handler) NULL, /* SIOCGIWPRIV */
  2288. (iw_handler) NULL, /* SIOCSIWSTATS */
  2289. (iw_handler) NULL, /* SIOCGIWSTATS */
  2290. iw_handler_set_spy, /* SIOCSIWSPY */
  2291. iw_handler_get_spy, /* SIOCGIWSPY */
  2292. iw_handler_set_thrspy, /* SIOCSIWTHRSPY */
  2293. iw_handler_get_thrspy, /* SIOCGIWTHRSPY */
  2294. (iw_handler) wlan_set_wap, /* SIOCSIWAP */
  2295. (iw_handler) wlan_get_wap, /* SIOCGIWAP */
  2296. (iw_handler) NULL, /* SIOCSIWMLME */
  2297. (iw_handler) NULL, /* SIOCGIWAPLIST - deprecated */
  2298. (iw_handler) libertas_set_scan, /* SIOCSIWSCAN */
  2299. (iw_handler) libertas_get_scan, /* SIOCGIWSCAN */
  2300. (iw_handler) wlan_set_essid, /* SIOCSIWESSID */
  2301. (iw_handler) wlan_get_essid, /* SIOCGIWESSID */
  2302. (iw_handler) wlan_set_nick, /* SIOCSIWNICKN */
  2303. (iw_handler) wlan_get_nick, /* SIOCGIWNICKN */
  2304. (iw_handler) NULL, /* -- hole -- */
  2305. (iw_handler) NULL, /* -- hole -- */
  2306. (iw_handler) wlan_set_rate, /* SIOCSIWRATE */
  2307. (iw_handler) wlan_get_rate, /* SIOCGIWRATE */
  2308. (iw_handler) wlan_set_rts, /* SIOCSIWRTS */
  2309. (iw_handler) wlan_get_rts, /* SIOCGIWRTS */
  2310. (iw_handler) wlan_set_frag, /* SIOCSIWFRAG */
  2311. (iw_handler) wlan_get_frag, /* SIOCGIWFRAG */
  2312. (iw_handler) wlan_set_txpow, /* SIOCSIWTXPOW */
  2313. (iw_handler) wlan_get_txpow, /* SIOCGIWTXPOW */
  2314. (iw_handler) wlan_set_retry, /* SIOCSIWRETRY */
  2315. (iw_handler) wlan_get_retry, /* SIOCGIWRETRY */
  2316. (iw_handler) wlan_set_encode, /* SIOCSIWENCODE */
  2317. (iw_handler) wlan_get_encode, /* SIOCGIWENCODE */
  2318. (iw_handler) wlan_set_power, /* SIOCSIWPOWER */
  2319. (iw_handler) wlan_get_power, /* SIOCGIWPOWER */
  2320. (iw_handler) NULL, /* -- hole -- */
  2321. (iw_handler) NULL, /* -- hole -- */
  2322. (iw_handler) wlan_set_genie, /* SIOCSIWGENIE */
  2323. (iw_handler) wlan_get_genie, /* SIOCGIWGENIE */
  2324. (iw_handler) wlan_set_auth, /* SIOCSIWAUTH */
  2325. (iw_handler) wlan_get_auth, /* SIOCGIWAUTH */
  2326. (iw_handler) wlan_set_encodeext,/* SIOCSIWENCODEEXT */
  2327. (iw_handler) wlan_get_encodeext,/* SIOCGIWENCODEEXT */
  2328. (iw_handler) NULL, /* SIOCSIWPMKSA */
  2329. };
  2330. struct iw_handler_def libertas_handler_def = {
  2331. .num_standard = sizeof(wlan_handler) / sizeof(iw_handler),
  2332. .num_private = sizeof(wlan_private_handler) / sizeof(iw_handler),
  2333. .num_private_args = sizeof(wlan_private_args) /
  2334. sizeof(struct iw_priv_args),
  2335. .standard = (iw_handler *) wlan_handler,
  2336. .private = (iw_handler *) wlan_private_handler,
  2337. .private_args = (struct iw_priv_args *)wlan_private_args,
  2338. .get_wireless_stats = wlan_get_wireless_stats,
  2339. };