wl_cfg80211.c 94 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183318431853186318731883189319031913192319331943195319631973198319932003201320232033204320532063207320832093210321132123213321432153216321732183219322032213222322332243225322632273228322932303231323232333234323532363237323832393240324132423243324432453246324732483249325032513252325332543255325632573258325932603261326232633264326532663267326832693270327132723273327432753276327732783279328032813282328332843285328632873288328932903291329232933294329532963297329832993300330133023303330433053306330733083309331033113312331333143315331633173318331933203321332233233324332533263327332833293330333133323333333433353336333733383339334033413342334333443345334633473348334933503351335233533354335533563357335833593360336133623363336433653366336733683369337033713372337333743375337633773378337933803381338233833384338533863387338833893390339133923393339433953396339733983399340034013402340334043405340634073408340934103411341234133414341534163417341834193420342134223423342434253426342734283429343034313432343334343435343634373438343934403441344234433444344534463447344834493450345134523453345434553456345734583459346034613462346334643465346634673468346934703471347234733474347534763477347834793480348134823483348434853486348734883489349034913492349334943495349634973498349935003501350235033504350535063507350835093510351135123513351435153516351735183519352035213522352335243525352635273528352935303531353235333534353535363537353835393540354135423543354435453546354735483549355035513552355335543555355635573558355935603561356235633564356535663567356835693570357135723573357435753576357735783579358035813582358335843585358635873588358935903591359235933594359535963597359835993600360136023603360436053606360736083609361036113612361336143615361636173618361936203621362236233624362536263627362836293630363136323633363436353636363736383639364036413642364336443645364636473648364936503651365236533654365536563657365836593660366136623663366436653666366736683669367036713672367336743675367636773678367936803681368236833684368536863687368836893690369136923693369436953696369736983699370037013702370337043705370637073708370937103711371237133714371537163717371837193720372137223723372437253726372737283729373037313732373337343735373637373738
  1. /*
  2. * Copyright (c) 2010 Broadcom Corporation
  3. *
  4. * Permission to use, copy, modify, and/or distribute this software for any
  5. * purpose with or without fee is hereby granted, provided that the above
  6. * copyright notice and this permission notice appear in all copies.
  7. *
  8. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
  9. * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10. * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
  11. * SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
  13. * OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
  14. * CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15. */
  16. /* Toplevel file. Relies on dhd_linux.c to send commands to the dongle. */
  17. #include <linux/kernel.h>
  18. #include <linux/if_arp.h>
  19. #include <linux/sched.h>
  20. #include <linux/kthread.h>
  21. #include <linux/netdevice.h>
  22. #include <linux/bitops.h>
  23. #include <linux/etherdevice.h>
  24. #include <linux/ieee80211.h>
  25. #include <linux/uaccess.h>
  26. #include <net/cfg80211.h>
  27. #include <brcmu_utils.h>
  28. #include <defs.h>
  29. #include <brcmu_wifi.h>
  30. #include "dhd.h"
  31. #include "wl_cfg80211.h"
  32. #define BRCMF_ASSOC_PARAMS_FIXED_SIZE \
  33. (sizeof(struct brcmf_assoc_params_le) - sizeof(u16))
  34. static const u8 ether_bcast[ETH_ALEN] = {255, 255, 255, 255, 255, 255};
  35. static u32 brcmf_dbg_level = WL_DBG_ERR;
  36. static void brcmf_set_drvdata(struct brcmf_cfg80211_dev *dev, void *data)
  37. {
  38. dev->driver_data = data;
  39. }
  40. static void *brcmf_get_drvdata(struct brcmf_cfg80211_dev *dev)
  41. {
  42. void *data = NULL;
  43. if (dev)
  44. data = dev->driver_data;
  45. return data;
  46. }
  47. static
  48. struct brcmf_cfg80211_priv *brcmf_priv_get(struct brcmf_cfg80211_dev *cfg_dev)
  49. {
  50. struct brcmf_cfg80211_iface *ci = brcmf_get_drvdata(cfg_dev);
  51. return ci->cfg_priv;
  52. }
  53. static bool check_sys_up(struct wiphy *wiphy)
  54. {
  55. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  56. if (!test_bit(WL_STATUS_READY, &cfg_priv->status)) {
  57. WL_INFO("device is not ready : status (%d)\n",
  58. (int)cfg_priv->status);
  59. return false;
  60. }
  61. return true;
  62. }
  63. #define CHAN2G(_channel, _freq, _flags) { \
  64. .band = IEEE80211_BAND_2GHZ, \
  65. .center_freq = (_freq), \
  66. .hw_value = (_channel), \
  67. .flags = (_flags), \
  68. .max_antenna_gain = 0, \
  69. .max_power = 30, \
  70. }
  71. #define CHAN5G(_channel, _flags) { \
  72. .band = IEEE80211_BAND_5GHZ, \
  73. .center_freq = 5000 + (5 * (_channel)), \
  74. .hw_value = (_channel), \
  75. .flags = (_flags), \
  76. .max_antenna_gain = 0, \
  77. .max_power = 30, \
  78. }
  79. #define RATE_TO_BASE100KBPS(rate) (((rate) * 10) / 2)
  80. #define RATETAB_ENT(_rateid, _flags) \
  81. { \
  82. .bitrate = RATE_TO_BASE100KBPS(_rateid), \
  83. .hw_value = (_rateid), \
  84. .flags = (_flags), \
  85. }
  86. static struct ieee80211_rate __wl_rates[] = {
  87. RATETAB_ENT(BRCM_RATE_1M, 0),
  88. RATETAB_ENT(BRCM_RATE_2M, IEEE80211_RATE_SHORT_PREAMBLE),
  89. RATETAB_ENT(BRCM_RATE_5M5, IEEE80211_RATE_SHORT_PREAMBLE),
  90. RATETAB_ENT(BRCM_RATE_11M, IEEE80211_RATE_SHORT_PREAMBLE),
  91. RATETAB_ENT(BRCM_RATE_6M, 0),
  92. RATETAB_ENT(BRCM_RATE_9M, 0),
  93. RATETAB_ENT(BRCM_RATE_12M, 0),
  94. RATETAB_ENT(BRCM_RATE_18M, 0),
  95. RATETAB_ENT(BRCM_RATE_24M, 0),
  96. RATETAB_ENT(BRCM_RATE_36M, 0),
  97. RATETAB_ENT(BRCM_RATE_48M, 0),
  98. RATETAB_ENT(BRCM_RATE_54M, 0),
  99. };
  100. #define wl_a_rates (__wl_rates + 4)
  101. #define wl_a_rates_size 8
  102. #define wl_g_rates (__wl_rates + 0)
  103. #define wl_g_rates_size 12
  104. static struct ieee80211_channel __wl_2ghz_channels[] = {
  105. CHAN2G(1, 2412, 0),
  106. CHAN2G(2, 2417, 0),
  107. CHAN2G(3, 2422, 0),
  108. CHAN2G(4, 2427, 0),
  109. CHAN2G(5, 2432, 0),
  110. CHAN2G(6, 2437, 0),
  111. CHAN2G(7, 2442, 0),
  112. CHAN2G(8, 2447, 0),
  113. CHAN2G(9, 2452, 0),
  114. CHAN2G(10, 2457, 0),
  115. CHAN2G(11, 2462, 0),
  116. CHAN2G(12, 2467, 0),
  117. CHAN2G(13, 2472, 0),
  118. CHAN2G(14, 2484, 0),
  119. };
  120. static struct ieee80211_channel __wl_5ghz_a_channels[] = {
  121. CHAN5G(34, 0), CHAN5G(36, 0),
  122. CHAN5G(38, 0), CHAN5G(40, 0),
  123. CHAN5G(42, 0), CHAN5G(44, 0),
  124. CHAN5G(46, 0), CHAN5G(48, 0),
  125. CHAN5G(52, 0), CHAN5G(56, 0),
  126. CHAN5G(60, 0), CHAN5G(64, 0),
  127. CHAN5G(100, 0), CHAN5G(104, 0),
  128. CHAN5G(108, 0), CHAN5G(112, 0),
  129. CHAN5G(116, 0), CHAN5G(120, 0),
  130. CHAN5G(124, 0), CHAN5G(128, 0),
  131. CHAN5G(132, 0), CHAN5G(136, 0),
  132. CHAN5G(140, 0), CHAN5G(149, 0),
  133. CHAN5G(153, 0), CHAN5G(157, 0),
  134. CHAN5G(161, 0), CHAN5G(165, 0),
  135. CHAN5G(184, 0), CHAN5G(188, 0),
  136. CHAN5G(192, 0), CHAN5G(196, 0),
  137. CHAN5G(200, 0), CHAN5G(204, 0),
  138. CHAN5G(208, 0), CHAN5G(212, 0),
  139. CHAN5G(216, 0),
  140. };
  141. static struct ieee80211_channel __wl_5ghz_n_channels[] = {
  142. CHAN5G(32, 0), CHAN5G(34, 0),
  143. CHAN5G(36, 0), CHAN5G(38, 0),
  144. CHAN5G(40, 0), CHAN5G(42, 0),
  145. CHAN5G(44, 0), CHAN5G(46, 0),
  146. CHAN5G(48, 0), CHAN5G(50, 0),
  147. CHAN5G(52, 0), CHAN5G(54, 0),
  148. CHAN5G(56, 0), CHAN5G(58, 0),
  149. CHAN5G(60, 0), CHAN5G(62, 0),
  150. CHAN5G(64, 0), CHAN5G(66, 0),
  151. CHAN5G(68, 0), CHAN5G(70, 0),
  152. CHAN5G(72, 0), CHAN5G(74, 0),
  153. CHAN5G(76, 0), CHAN5G(78, 0),
  154. CHAN5G(80, 0), CHAN5G(82, 0),
  155. CHAN5G(84, 0), CHAN5G(86, 0),
  156. CHAN5G(88, 0), CHAN5G(90, 0),
  157. CHAN5G(92, 0), CHAN5G(94, 0),
  158. CHAN5G(96, 0), CHAN5G(98, 0),
  159. CHAN5G(100, 0), CHAN5G(102, 0),
  160. CHAN5G(104, 0), CHAN5G(106, 0),
  161. CHAN5G(108, 0), CHAN5G(110, 0),
  162. CHAN5G(112, 0), CHAN5G(114, 0),
  163. CHAN5G(116, 0), CHAN5G(118, 0),
  164. CHAN5G(120, 0), CHAN5G(122, 0),
  165. CHAN5G(124, 0), CHAN5G(126, 0),
  166. CHAN5G(128, 0), CHAN5G(130, 0),
  167. CHAN5G(132, 0), CHAN5G(134, 0),
  168. CHAN5G(136, 0), CHAN5G(138, 0),
  169. CHAN5G(140, 0), CHAN5G(142, 0),
  170. CHAN5G(144, 0), CHAN5G(145, 0),
  171. CHAN5G(146, 0), CHAN5G(147, 0),
  172. CHAN5G(148, 0), CHAN5G(149, 0),
  173. CHAN5G(150, 0), CHAN5G(151, 0),
  174. CHAN5G(152, 0), CHAN5G(153, 0),
  175. CHAN5G(154, 0), CHAN5G(155, 0),
  176. CHAN5G(156, 0), CHAN5G(157, 0),
  177. CHAN5G(158, 0), CHAN5G(159, 0),
  178. CHAN5G(160, 0), CHAN5G(161, 0),
  179. CHAN5G(162, 0), CHAN5G(163, 0),
  180. CHAN5G(164, 0), CHAN5G(165, 0),
  181. CHAN5G(166, 0), CHAN5G(168, 0),
  182. CHAN5G(170, 0), CHAN5G(172, 0),
  183. CHAN5G(174, 0), CHAN5G(176, 0),
  184. CHAN5G(178, 0), CHAN5G(180, 0),
  185. CHAN5G(182, 0), CHAN5G(184, 0),
  186. CHAN5G(186, 0), CHAN5G(188, 0),
  187. CHAN5G(190, 0), CHAN5G(192, 0),
  188. CHAN5G(194, 0), CHAN5G(196, 0),
  189. CHAN5G(198, 0), CHAN5G(200, 0),
  190. CHAN5G(202, 0), CHAN5G(204, 0),
  191. CHAN5G(206, 0), CHAN5G(208, 0),
  192. CHAN5G(210, 0), CHAN5G(212, 0),
  193. CHAN5G(214, 0), CHAN5G(216, 0),
  194. CHAN5G(218, 0), CHAN5G(220, 0),
  195. CHAN5G(222, 0), CHAN5G(224, 0),
  196. CHAN5G(226, 0), CHAN5G(228, 0),
  197. };
  198. static struct ieee80211_supported_band __wl_band_2ghz = {
  199. .band = IEEE80211_BAND_2GHZ,
  200. .channels = __wl_2ghz_channels,
  201. .n_channels = ARRAY_SIZE(__wl_2ghz_channels),
  202. .bitrates = wl_g_rates,
  203. .n_bitrates = wl_g_rates_size,
  204. };
  205. static struct ieee80211_supported_band __wl_band_5ghz_a = {
  206. .band = IEEE80211_BAND_5GHZ,
  207. .channels = __wl_5ghz_a_channels,
  208. .n_channels = ARRAY_SIZE(__wl_5ghz_a_channels),
  209. .bitrates = wl_a_rates,
  210. .n_bitrates = wl_a_rates_size,
  211. };
  212. static struct ieee80211_supported_band __wl_band_5ghz_n = {
  213. .band = IEEE80211_BAND_5GHZ,
  214. .channels = __wl_5ghz_n_channels,
  215. .n_channels = ARRAY_SIZE(__wl_5ghz_n_channels),
  216. .bitrates = wl_a_rates,
  217. .n_bitrates = wl_a_rates_size,
  218. };
  219. static const u32 __wl_cipher_suites[] = {
  220. WLAN_CIPHER_SUITE_WEP40,
  221. WLAN_CIPHER_SUITE_WEP104,
  222. WLAN_CIPHER_SUITE_TKIP,
  223. WLAN_CIPHER_SUITE_CCMP,
  224. WLAN_CIPHER_SUITE_AES_CMAC,
  225. };
  226. /* function for reading/writing a single u32 from/to the dongle */
  227. static int
  228. brcmf_exec_dcmd_u32(struct net_device *ndev, u32 cmd, u32 *par)
  229. {
  230. int err;
  231. __le32 par_le = cpu_to_le32(*par);
  232. err = brcmf_exec_dcmd(ndev, cmd, &par_le, sizeof(__le32));
  233. *par = le32_to_cpu(par_le);
  234. return err;
  235. }
  236. static void convert_key_from_CPU(struct brcmf_wsec_key *key,
  237. struct brcmf_wsec_key_le *key_le)
  238. {
  239. key_le->index = cpu_to_le32(key->index);
  240. key_le->len = cpu_to_le32(key->len);
  241. key_le->algo = cpu_to_le32(key->algo);
  242. key_le->flags = cpu_to_le32(key->flags);
  243. key_le->rxiv.hi = cpu_to_le32(key->rxiv.hi);
  244. key_le->rxiv.lo = cpu_to_le16(key->rxiv.lo);
  245. key_le->iv_initialized = cpu_to_le32(key->iv_initialized);
  246. memcpy(key_le->data, key->data, sizeof(key->data));
  247. memcpy(key_le->ea, key->ea, sizeof(key->ea));
  248. }
  249. static int send_key_to_dongle(struct net_device *ndev,
  250. struct brcmf_wsec_key *key)
  251. {
  252. int err;
  253. struct brcmf_wsec_key_le key_le;
  254. convert_key_from_CPU(key, &key_le);
  255. err = brcmf_exec_dcmd(ndev, BRCMF_C_SET_KEY, &key_le, sizeof(key_le));
  256. if (err)
  257. WL_ERR("WLC_SET_KEY error (%d)\n", err);
  258. return err;
  259. }
  260. static s32
  261. brcmf_cfg80211_change_iface(struct wiphy *wiphy, struct net_device *ndev,
  262. enum nl80211_iftype type, u32 *flags,
  263. struct vif_params *params)
  264. {
  265. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  266. struct wireless_dev *wdev;
  267. s32 infra = 0;
  268. s32 err = 0;
  269. WL_TRACE("Enter\n");
  270. if (!check_sys_up(wiphy))
  271. return -EIO;
  272. switch (type) {
  273. case NL80211_IFTYPE_MONITOR:
  274. case NL80211_IFTYPE_WDS:
  275. WL_ERR("type (%d) : currently we do not support this type\n",
  276. type);
  277. return -EOPNOTSUPP;
  278. case NL80211_IFTYPE_ADHOC:
  279. cfg_priv->conf->mode = WL_MODE_IBSS;
  280. infra = 0;
  281. break;
  282. case NL80211_IFTYPE_STATION:
  283. cfg_priv->conf->mode = WL_MODE_BSS;
  284. infra = 1;
  285. break;
  286. default:
  287. err = -EINVAL;
  288. goto done;
  289. }
  290. err = brcmf_exec_dcmd_u32(ndev, BRCMF_C_SET_INFRA, &infra);
  291. if (err) {
  292. WL_ERR("WLC_SET_INFRA error (%d)\n", err);
  293. err = -EAGAIN;
  294. } else {
  295. wdev = ndev->ieee80211_ptr;
  296. wdev->iftype = type;
  297. }
  298. WL_INFO("IF Type = %s\n",
  299. (cfg_priv->conf->mode == WL_MODE_IBSS) ? "Adhoc" : "Infra");
  300. done:
  301. WL_TRACE("Exit\n");
  302. return err;
  303. }
  304. static s32 brcmf_dev_intvar_set(struct net_device *ndev, s8 *name, s32 val)
  305. {
  306. s8 buf[BRCMF_DCMD_SMLEN];
  307. u32 len;
  308. s32 err = 0;
  309. __le32 val_le;
  310. val_le = cpu_to_le32(val);
  311. len = brcmu_mkiovar(name, (char *)(&val_le), sizeof(val_le), buf,
  312. sizeof(buf));
  313. BUG_ON(!len);
  314. err = brcmf_exec_dcmd(ndev, BRCMF_C_SET_VAR, buf, len);
  315. if (err)
  316. WL_ERR("error (%d)\n", err);
  317. return err;
  318. }
  319. static s32
  320. brcmf_dev_intvar_get(struct net_device *ndev, s8 *name, s32 *retval)
  321. {
  322. union {
  323. s8 buf[BRCMF_DCMD_SMLEN];
  324. __le32 val;
  325. } var;
  326. u32 len;
  327. u32 data_null;
  328. s32 err = 0;
  329. len =
  330. brcmu_mkiovar(name, (char *)(&data_null), 0, (char *)(&var),
  331. sizeof(var.buf));
  332. BUG_ON(!len);
  333. err = brcmf_exec_dcmd(ndev, BRCMF_C_GET_VAR, &var, len);
  334. if (err)
  335. WL_ERR("error (%d)\n", err);
  336. *retval = le32_to_cpu(var.val);
  337. return err;
  338. }
  339. static void brcmf_set_mpc(struct net_device *ndev, int mpc)
  340. {
  341. s32 err = 0;
  342. struct brcmf_cfg80211_priv *cfg_priv = ndev_to_cfg(ndev);
  343. if (test_bit(WL_STATUS_READY, &cfg_priv->status)) {
  344. err = brcmf_dev_intvar_set(ndev, "mpc", mpc);
  345. if (err) {
  346. WL_ERR("fail to set mpc\n");
  347. return;
  348. }
  349. WL_INFO("MPC : %d\n", mpc);
  350. }
  351. }
  352. static void wl_iscan_prep(struct brcmf_scan_params_le *params_le,
  353. struct brcmf_ssid *ssid)
  354. {
  355. memcpy(params_le->bssid, ether_bcast, ETH_ALEN);
  356. params_le->bss_type = DOT11_BSSTYPE_ANY;
  357. params_le->scan_type = 0;
  358. params_le->channel_num = 0;
  359. params_le->nprobes = cpu_to_le32(-1);
  360. params_le->active_time = cpu_to_le32(-1);
  361. params_le->passive_time = cpu_to_le32(-1);
  362. params_le->home_time = cpu_to_le32(-1);
  363. if (ssid && ssid->SSID_len)
  364. memcpy(&params_le->ssid_le, ssid, sizeof(struct brcmf_ssid));
  365. }
  366. static s32
  367. brcmf_dev_iovar_setbuf(struct net_device *ndev, s8 * iovar, void *param,
  368. s32 paramlen, void *bufptr, s32 buflen)
  369. {
  370. s32 iolen;
  371. iolen = brcmu_mkiovar(iovar, param, paramlen, bufptr, buflen);
  372. BUG_ON(!iolen);
  373. return brcmf_exec_dcmd(ndev, BRCMF_C_SET_VAR, bufptr, iolen);
  374. }
  375. static s32
  376. brcmf_dev_iovar_getbuf(struct net_device *ndev, s8 * iovar, void *param,
  377. s32 paramlen, void *bufptr, s32 buflen)
  378. {
  379. s32 iolen;
  380. iolen = brcmu_mkiovar(iovar, param, paramlen, bufptr, buflen);
  381. BUG_ON(!iolen);
  382. return brcmf_exec_dcmd(ndev, BRCMF_C_GET_VAR, bufptr, buflen);
  383. }
  384. static s32
  385. brcmf_run_iscan(struct brcmf_cfg80211_iscan_ctrl *iscan,
  386. struct brcmf_ssid *ssid, u16 action)
  387. {
  388. s32 params_size = BRCMF_SCAN_PARAMS_FIXED_SIZE +
  389. offsetof(struct brcmf_iscan_params_le, params_le);
  390. struct brcmf_iscan_params_le *params;
  391. s32 err = 0;
  392. if (ssid && ssid->SSID_len)
  393. params_size += sizeof(struct brcmf_ssid);
  394. params = kzalloc(params_size, GFP_KERNEL);
  395. if (!params)
  396. return -ENOMEM;
  397. BUG_ON(params_size >= BRCMF_DCMD_SMLEN);
  398. wl_iscan_prep(&params->params_le, ssid);
  399. params->version = cpu_to_le32(BRCMF_ISCAN_REQ_VERSION);
  400. params->action = cpu_to_le16(action);
  401. params->scan_duration = cpu_to_le16(0);
  402. err = brcmf_dev_iovar_setbuf(iscan->ndev, "iscan", params, params_size,
  403. iscan->dcmd_buf, BRCMF_DCMD_SMLEN);
  404. if (err) {
  405. if (err == -EBUSY)
  406. WL_INFO("system busy : iscan canceled\n");
  407. else
  408. WL_ERR("error (%d)\n", err);
  409. }
  410. kfree(params);
  411. return err;
  412. }
  413. static s32 brcmf_do_iscan(struct brcmf_cfg80211_priv *cfg_priv)
  414. {
  415. struct brcmf_cfg80211_iscan_ctrl *iscan = cfg_to_iscan(cfg_priv);
  416. struct net_device *ndev = cfg_to_ndev(cfg_priv);
  417. struct brcmf_ssid ssid;
  418. __le32 passive_scan;
  419. s32 err = 0;
  420. /* Broadcast scan by default */
  421. memset(&ssid, 0, sizeof(ssid));
  422. iscan->state = WL_ISCAN_STATE_SCANING;
  423. passive_scan = cfg_priv->active_scan ? 0 : cpu_to_le32(1);
  424. err = brcmf_exec_dcmd(cfg_to_ndev(cfg_priv), BRCMF_C_SET_PASSIVE_SCAN,
  425. &passive_scan, sizeof(passive_scan));
  426. if (err) {
  427. WL_ERR("error (%d)\n", err);
  428. return err;
  429. }
  430. brcmf_set_mpc(ndev, 0);
  431. cfg_priv->iscan_kickstart = true;
  432. err = brcmf_run_iscan(iscan, &ssid, BRCMF_SCAN_ACTION_START);
  433. if (err) {
  434. brcmf_set_mpc(ndev, 1);
  435. cfg_priv->iscan_kickstart = false;
  436. return err;
  437. }
  438. mod_timer(&iscan->timer, jiffies + iscan->timer_ms * HZ / 1000);
  439. iscan->timer_on = 1;
  440. return err;
  441. }
  442. static s32
  443. __brcmf_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev,
  444. struct cfg80211_scan_request *request,
  445. struct cfg80211_ssid *this_ssid)
  446. {
  447. struct brcmf_cfg80211_priv *cfg_priv = ndev_to_cfg(ndev);
  448. struct cfg80211_ssid *ssids;
  449. struct brcmf_cfg80211_scan_req *sr = cfg_priv->scan_req_int;
  450. __le32 passive_scan;
  451. bool iscan_req;
  452. bool spec_scan;
  453. s32 err = 0;
  454. u32 SSID_len;
  455. if (test_bit(WL_STATUS_SCANNING, &cfg_priv->status)) {
  456. WL_ERR("Scanning already : status (%lu)\n", cfg_priv->status);
  457. return -EAGAIN;
  458. }
  459. if (test_bit(WL_STATUS_SCAN_ABORTING, &cfg_priv->status)) {
  460. WL_ERR("Scanning being aborted : status (%lu)\n",
  461. cfg_priv->status);
  462. return -EAGAIN;
  463. }
  464. if (test_bit(WL_STATUS_CONNECTING, &cfg_priv->status)) {
  465. WL_ERR("Connecting : status (%lu)\n",
  466. cfg_priv->status);
  467. return -EAGAIN;
  468. }
  469. iscan_req = false;
  470. spec_scan = false;
  471. if (request) {
  472. /* scan bss */
  473. ssids = request->ssids;
  474. if (cfg_priv->iscan_on && (!ssids || !ssids->ssid_len))
  475. iscan_req = true;
  476. } else {
  477. /* scan in ibss */
  478. /* we don't do iscan in ibss */
  479. ssids = this_ssid;
  480. }
  481. cfg_priv->scan_request = request;
  482. set_bit(WL_STATUS_SCANNING, &cfg_priv->status);
  483. if (iscan_req) {
  484. err = brcmf_do_iscan(cfg_priv);
  485. if (!err)
  486. return err;
  487. else
  488. goto scan_out;
  489. } else {
  490. WL_SCAN("ssid \"%s\", ssid_len (%d)\n",
  491. ssids->ssid, ssids->ssid_len);
  492. memset(&sr->ssid_le, 0, sizeof(sr->ssid_le));
  493. SSID_len = min_t(u8, sizeof(sr->ssid_le.SSID), ssids->ssid_len);
  494. sr->ssid_le.SSID_len = cpu_to_le32(0);
  495. if (SSID_len) {
  496. memcpy(sr->ssid_le.SSID, ssids->ssid, SSID_len);
  497. sr->ssid_le.SSID_len = cpu_to_le32(SSID_len);
  498. spec_scan = true;
  499. } else {
  500. WL_SCAN("Broadcast scan\n");
  501. }
  502. passive_scan = cfg_priv->active_scan ? 0 : cpu_to_le32(1);
  503. err = brcmf_exec_dcmd(ndev, BRCMF_C_SET_PASSIVE_SCAN,
  504. &passive_scan, sizeof(passive_scan));
  505. if (err) {
  506. WL_ERR("WLC_SET_PASSIVE_SCAN error (%d)\n", err);
  507. goto scan_out;
  508. }
  509. brcmf_set_mpc(ndev, 0);
  510. err = brcmf_exec_dcmd(ndev, BRCMF_C_SCAN, &sr->ssid_le,
  511. sizeof(sr->ssid_le));
  512. if (err) {
  513. if (err == -EBUSY)
  514. WL_INFO("system busy : scan for \"%s\" "
  515. "canceled\n", sr->ssid_le.SSID);
  516. else
  517. WL_ERR("WLC_SCAN error (%d)\n", err);
  518. brcmf_set_mpc(ndev, 1);
  519. goto scan_out;
  520. }
  521. }
  522. return 0;
  523. scan_out:
  524. clear_bit(WL_STATUS_SCANNING, &cfg_priv->status);
  525. cfg_priv->scan_request = NULL;
  526. return err;
  527. }
  528. static s32
  529. brcmf_cfg80211_scan(struct wiphy *wiphy, struct net_device *ndev,
  530. struct cfg80211_scan_request *request)
  531. {
  532. s32 err = 0;
  533. WL_TRACE("Enter\n");
  534. if (!check_sys_up(wiphy))
  535. return -EIO;
  536. err = __brcmf_cfg80211_scan(wiphy, ndev, request, NULL);
  537. if (err)
  538. WL_ERR("scan error (%d)\n", err);
  539. WL_TRACE("Exit\n");
  540. return err;
  541. }
  542. static s32 brcmf_set_rts(struct net_device *ndev, u32 rts_threshold)
  543. {
  544. s32 err = 0;
  545. err = brcmf_dev_intvar_set(ndev, "rtsthresh", rts_threshold);
  546. if (err)
  547. WL_ERR("Error (%d)\n", err);
  548. return err;
  549. }
  550. static s32 brcmf_set_frag(struct net_device *ndev, u32 frag_threshold)
  551. {
  552. s32 err = 0;
  553. err = brcmf_dev_intvar_set(ndev, "fragthresh", frag_threshold);
  554. if (err)
  555. WL_ERR("Error (%d)\n", err);
  556. return err;
  557. }
  558. static s32 brcmf_set_retry(struct net_device *ndev, u32 retry, bool l)
  559. {
  560. s32 err = 0;
  561. u32 cmd = (l ? BRCM_SET_LRL : BRCM_SET_SRL);
  562. err = brcmf_exec_dcmd_u32(ndev, cmd, &retry);
  563. if (err) {
  564. WL_ERR("cmd (%d) , error (%d)\n", cmd, err);
  565. return err;
  566. }
  567. return err;
  568. }
  569. static s32 brcmf_cfg80211_set_wiphy_params(struct wiphy *wiphy, u32 changed)
  570. {
  571. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  572. struct net_device *ndev = cfg_to_ndev(cfg_priv);
  573. s32 err = 0;
  574. WL_TRACE("Enter\n");
  575. if (!check_sys_up(wiphy))
  576. return -EIO;
  577. if (changed & WIPHY_PARAM_RTS_THRESHOLD &&
  578. (cfg_priv->conf->rts_threshold != wiphy->rts_threshold)) {
  579. cfg_priv->conf->rts_threshold = wiphy->rts_threshold;
  580. err = brcmf_set_rts(ndev, cfg_priv->conf->rts_threshold);
  581. if (!err)
  582. goto done;
  583. }
  584. if (changed & WIPHY_PARAM_FRAG_THRESHOLD &&
  585. (cfg_priv->conf->frag_threshold != wiphy->frag_threshold)) {
  586. cfg_priv->conf->frag_threshold = wiphy->frag_threshold;
  587. err = brcmf_set_frag(ndev, cfg_priv->conf->frag_threshold);
  588. if (!err)
  589. goto done;
  590. }
  591. if (changed & WIPHY_PARAM_RETRY_LONG
  592. && (cfg_priv->conf->retry_long != wiphy->retry_long)) {
  593. cfg_priv->conf->retry_long = wiphy->retry_long;
  594. err = brcmf_set_retry(ndev, cfg_priv->conf->retry_long, true);
  595. if (!err)
  596. goto done;
  597. }
  598. if (changed & WIPHY_PARAM_RETRY_SHORT
  599. && (cfg_priv->conf->retry_short != wiphy->retry_short)) {
  600. cfg_priv->conf->retry_short = wiphy->retry_short;
  601. err = brcmf_set_retry(ndev, cfg_priv->conf->retry_short, false);
  602. if (!err)
  603. goto done;
  604. }
  605. done:
  606. WL_TRACE("Exit\n");
  607. return err;
  608. }
  609. static void *brcmf_read_prof(struct brcmf_cfg80211_priv *cfg_priv, s32 item)
  610. {
  611. switch (item) {
  612. case WL_PROF_SEC:
  613. return &cfg_priv->profile->sec;
  614. case WL_PROF_BSSID:
  615. return &cfg_priv->profile->bssid;
  616. case WL_PROF_SSID:
  617. return &cfg_priv->profile->ssid;
  618. }
  619. WL_ERR("invalid item (%d)\n", item);
  620. return NULL;
  621. }
  622. static s32
  623. brcmf_update_prof(struct brcmf_cfg80211_priv *cfg_priv,
  624. const struct brcmf_event_msg *e, void *data, s32 item)
  625. {
  626. s32 err = 0;
  627. struct brcmf_ssid *ssid;
  628. switch (item) {
  629. case WL_PROF_SSID:
  630. ssid = (struct brcmf_ssid *) data;
  631. memset(cfg_priv->profile->ssid.SSID, 0,
  632. sizeof(cfg_priv->profile->ssid.SSID));
  633. memcpy(cfg_priv->profile->ssid.SSID,
  634. ssid->SSID, ssid->SSID_len);
  635. cfg_priv->profile->ssid.SSID_len = ssid->SSID_len;
  636. break;
  637. case WL_PROF_BSSID:
  638. if (data)
  639. memcpy(cfg_priv->profile->bssid, data, ETH_ALEN);
  640. else
  641. memset(cfg_priv->profile->bssid, 0, ETH_ALEN);
  642. break;
  643. case WL_PROF_SEC:
  644. memcpy(&cfg_priv->profile->sec, data,
  645. sizeof(cfg_priv->profile->sec));
  646. break;
  647. case WL_PROF_BEACONINT:
  648. cfg_priv->profile->beacon_interval = *(u16 *)data;
  649. break;
  650. case WL_PROF_DTIMPERIOD:
  651. cfg_priv->profile->dtim_period = *(u8 *)data;
  652. break;
  653. default:
  654. WL_ERR("unsupported item (%d)\n", item);
  655. err = -EOPNOTSUPP;
  656. break;
  657. }
  658. return err;
  659. }
  660. static void brcmf_init_prof(struct brcmf_cfg80211_profile *prof)
  661. {
  662. memset(prof, 0, sizeof(*prof));
  663. }
  664. static void brcmf_ch_to_chanspec(int ch, struct brcmf_join_params *join_params,
  665. size_t *join_params_size)
  666. {
  667. u16 chanspec = 0;
  668. if (ch != 0) {
  669. if (ch <= CH_MAX_2G_CHANNEL)
  670. chanspec |= WL_CHANSPEC_BAND_2G;
  671. else
  672. chanspec |= WL_CHANSPEC_BAND_5G;
  673. chanspec |= WL_CHANSPEC_BW_20;
  674. chanspec |= WL_CHANSPEC_CTL_SB_NONE;
  675. *join_params_size += BRCMF_ASSOC_PARAMS_FIXED_SIZE +
  676. sizeof(u16);
  677. chanspec |= (ch & WL_CHANSPEC_CHAN_MASK);
  678. join_params->params_le.chanspec_list[0] = cpu_to_le16(chanspec);
  679. join_params->params_le.chanspec_num = cpu_to_le32(1);
  680. WL_CONN("join_params->params.chanspec_list[0]= %#X,"
  681. "channel %d, chanspec %#X\n",
  682. chanspec, ch, chanspec);
  683. }
  684. }
  685. static void brcmf_link_down(struct brcmf_cfg80211_priv *cfg_priv)
  686. {
  687. struct net_device *ndev = NULL;
  688. s32 err = 0;
  689. WL_TRACE("Enter\n");
  690. if (cfg_priv->link_up) {
  691. ndev = cfg_to_ndev(cfg_priv);
  692. WL_INFO("Call WLC_DISASSOC to stop excess roaming\n ");
  693. err = brcmf_exec_dcmd(ndev, BRCMF_C_DISASSOC, NULL, 0);
  694. if (err)
  695. WL_ERR("WLC_DISASSOC failed (%d)\n", err);
  696. cfg_priv->link_up = false;
  697. }
  698. WL_TRACE("Exit\n");
  699. }
  700. static s32
  701. brcmf_cfg80211_join_ibss(struct wiphy *wiphy, struct net_device *ndev,
  702. struct cfg80211_ibss_params *params)
  703. {
  704. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  705. struct brcmf_join_params join_params;
  706. size_t join_params_size = 0;
  707. s32 err = 0;
  708. s32 wsec = 0;
  709. s32 bcnprd;
  710. struct brcmf_ssid ssid;
  711. WL_TRACE("Enter\n");
  712. if (!check_sys_up(wiphy))
  713. return -EIO;
  714. if (params->ssid)
  715. WL_CONN("SSID: %s\n", params->ssid);
  716. else {
  717. WL_CONN("SSID: NULL, Not supported\n");
  718. return -EOPNOTSUPP;
  719. }
  720. set_bit(WL_STATUS_CONNECTING, &cfg_priv->status);
  721. if (params->bssid)
  722. WL_CONN("BSSID: %02X %02X %02X %02X %02X %02X\n",
  723. params->bssid[0], params->bssid[1], params->bssid[2],
  724. params->bssid[3], params->bssid[4], params->bssid[5]);
  725. else
  726. WL_CONN("No BSSID specified\n");
  727. if (params->channel)
  728. WL_CONN("channel: %d\n", params->channel->center_freq);
  729. else
  730. WL_CONN("no channel specified\n");
  731. if (params->channel_fixed)
  732. WL_CONN("fixed channel required\n");
  733. else
  734. WL_CONN("no fixed channel required\n");
  735. if (params->ie && params->ie_len)
  736. WL_CONN("ie len: %d\n", params->ie_len);
  737. else
  738. WL_CONN("no ie specified\n");
  739. if (params->beacon_interval)
  740. WL_CONN("beacon interval: %d\n", params->beacon_interval);
  741. else
  742. WL_CONN("no beacon interval specified\n");
  743. if (params->basic_rates)
  744. WL_CONN("basic rates: %08X\n", params->basic_rates);
  745. else
  746. WL_CONN("no basic rates specified\n");
  747. if (params->privacy)
  748. WL_CONN("privacy required\n");
  749. else
  750. WL_CONN("no privacy required\n");
  751. /* Configure Privacy for starter */
  752. if (params->privacy)
  753. wsec |= WEP_ENABLED;
  754. err = brcmf_dev_intvar_set(ndev, "wsec", wsec);
  755. if (err) {
  756. WL_ERR("wsec failed (%d)\n", err);
  757. goto done;
  758. }
  759. /* Configure Beacon Interval for starter */
  760. if (params->beacon_interval)
  761. bcnprd = params->beacon_interval;
  762. else
  763. bcnprd = 100;
  764. err = brcmf_exec_dcmd_u32(ndev, BRCM_SET_BCNPRD, &bcnprd);
  765. if (err) {
  766. WL_ERR("WLC_SET_BCNPRD failed (%d)\n", err);
  767. goto done;
  768. }
  769. /* Configure required join parameter */
  770. memset(&join_params, 0, sizeof(struct brcmf_join_params));
  771. /* SSID */
  772. ssid.SSID_len = min_t(u32, params->ssid_len, 32);
  773. memcpy(ssid.SSID, params->ssid, ssid.SSID_len);
  774. memcpy(join_params.ssid_le.SSID, params->ssid, ssid.SSID_len);
  775. join_params.ssid_le.SSID_len = cpu_to_le32(ssid.SSID_len);
  776. join_params_size = sizeof(join_params.ssid_le);
  777. brcmf_update_prof(cfg_priv, NULL, &ssid, WL_PROF_SSID);
  778. /* BSSID */
  779. if (params->bssid) {
  780. memcpy(join_params.params_le.bssid, params->bssid, ETH_ALEN);
  781. join_params_size = sizeof(join_params.ssid_le) +
  782. BRCMF_ASSOC_PARAMS_FIXED_SIZE;
  783. } else {
  784. memcpy(join_params.params_le.bssid, ether_bcast, ETH_ALEN);
  785. }
  786. brcmf_update_prof(cfg_priv, NULL,
  787. &join_params.params_le.bssid, WL_PROF_BSSID);
  788. /* Channel */
  789. if (params->channel) {
  790. u32 target_channel;
  791. cfg_priv->channel =
  792. ieee80211_frequency_to_channel(
  793. params->channel->center_freq);
  794. if (params->channel_fixed) {
  795. /* adding chanspec */
  796. brcmf_ch_to_chanspec(cfg_priv->channel,
  797. &join_params, &join_params_size);
  798. }
  799. /* set channel for starter */
  800. target_channel = cfg_priv->channel;
  801. err = brcmf_exec_dcmd_u32(ndev, BRCM_SET_CHANNEL,
  802. &target_channel);
  803. if (err) {
  804. WL_ERR("WLC_SET_CHANNEL failed (%d)\n", err);
  805. goto done;
  806. }
  807. } else
  808. cfg_priv->channel = 0;
  809. cfg_priv->ibss_starter = false;
  810. err = brcmf_exec_dcmd(ndev, BRCMF_C_SET_SSID,
  811. &join_params, join_params_size);
  812. if (err) {
  813. WL_ERR("WLC_SET_SSID failed (%d)\n", err);
  814. goto done;
  815. }
  816. done:
  817. if (err)
  818. clear_bit(WL_STATUS_CONNECTING, &cfg_priv->status);
  819. WL_TRACE("Exit\n");
  820. return err;
  821. }
  822. static s32
  823. brcmf_cfg80211_leave_ibss(struct wiphy *wiphy, struct net_device *ndev)
  824. {
  825. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  826. s32 err = 0;
  827. WL_TRACE("Enter\n");
  828. if (!check_sys_up(wiphy))
  829. return -EIO;
  830. brcmf_link_down(cfg_priv);
  831. WL_TRACE("Exit\n");
  832. return err;
  833. }
  834. static s32 brcmf_set_wpa_version(struct net_device *ndev,
  835. struct cfg80211_connect_params *sme)
  836. {
  837. struct brcmf_cfg80211_priv *cfg_priv = ndev_to_cfg(ndev);
  838. struct brcmf_cfg80211_security *sec;
  839. s32 val = 0;
  840. s32 err = 0;
  841. if (sme->crypto.wpa_versions & NL80211_WPA_VERSION_1)
  842. val = WPA_AUTH_PSK | WPA_AUTH_UNSPECIFIED;
  843. else if (sme->crypto.wpa_versions & NL80211_WPA_VERSION_2)
  844. val = WPA2_AUTH_PSK | WPA2_AUTH_UNSPECIFIED;
  845. else
  846. val = WPA_AUTH_DISABLED;
  847. WL_CONN("setting wpa_auth to 0x%0x\n", val);
  848. err = brcmf_dev_intvar_set(ndev, "wpa_auth", val);
  849. if (err) {
  850. WL_ERR("set wpa_auth failed (%d)\n", err);
  851. return err;
  852. }
  853. sec = brcmf_read_prof(cfg_priv, WL_PROF_SEC);
  854. sec->wpa_versions = sme->crypto.wpa_versions;
  855. return err;
  856. }
  857. static s32 brcmf_set_auth_type(struct net_device *ndev,
  858. struct cfg80211_connect_params *sme)
  859. {
  860. struct brcmf_cfg80211_priv *cfg_priv = ndev_to_cfg(ndev);
  861. struct brcmf_cfg80211_security *sec;
  862. s32 val = 0;
  863. s32 err = 0;
  864. switch (sme->auth_type) {
  865. case NL80211_AUTHTYPE_OPEN_SYSTEM:
  866. val = 0;
  867. WL_CONN("open system\n");
  868. break;
  869. case NL80211_AUTHTYPE_SHARED_KEY:
  870. val = 1;
  871. WL_CONN("shared key\n");
  872. break;
  873. case NL80211_AUTHTYPE_AUTOMATIC:
  874. val = 2;
  875. WL_CONN("automatic\n");
  876. break;
  877. case NL80211_AUTHTYPE_NETWORK_EAP:
  878. WL_CONN("network eap\n");
  879. default:
  880. val = 2;
  881. WL_ERR("invalid auth type (%d)\n", sme->auth_type);
  882. break;
  883. }
  884. err = brcmf_dev_intvar_set(ndev, "auth", val);
  885. if (err) {
  886. WL_ERR("set auth failed (%d)\n", err);
  887. return err;
  888. }
  889. sec = brcmf_read_prof(cfg_priv, WL_PROF_SEC);
  890. sec->auth_type = sme->auth_type;
  891. return err;
  892. }
  893. static s32
  894. brcmf_set_set_cipher(struct net_device *ndev,
  895. struct cfg80211_connect_params *sme)
  896. {
  897. struct brcmf_cfg80211_priv *cfg_priv = ndev_to_cfg(ndev);
  898. struct brcmf_cfg80211_security *sec;
  899. s32 pval = 0;
  900. s32 gval = 0;
  901. s32 err = 0;
  902. if (sme->crypto.n_ciphers_pairwise) {
  903. switch (sme->crypto.ciphers_pairwise[0]) {
  904. case WLAN_CIPHER_SUITE_WEP40:
  905. case WLAN_CIPHER_SUITE_WEP104:
  906. pval = WEP_ENABLED;
  907. break;
  908. case WLAN_CIPHER_SUITE_TKIP:
  909. pval = TKIP_ENABLED;
  910. break;
  911. case WLAN_CIPHER_SUITE_CCMP:
  912. pval = AES_ENABLED;
  913. break;
  914. case WLAN_CIPHER_SUITE_AES_CMAC:
  915. pval = AES_ENABLED;
  916. break;
  917. default:
  918. WL_ERR("invalid cipher pairwise (%d)\n",
  919. sme->crypto.ciphers_pairwise[0]);
  920. return -EINVAL;
  921. }
  922. }
  923. if (sme->crypto.cipher_group) {
  924. switch (sme->crypto.cipher_group) {
  925. case WLAN_CIPHER_SUITE_WEP40:
  926. case WLAN_CIPHER_SUITE_WEP104:
  927. gval = WEP_ENABLED;
  928. break;
  929. case WLAN_CIPHER_SUITE_TKIP:
  930. gval = TKIP_ENABLED;
  931. break;
  932. case WLAN_CIPHER_SUITE_CCMP:
  933. gval = AES_ENABLED;
  934. break;
  935. case WLAN_CIPHER_SUITE_AES_CMAC:
  936. gval = AES_ENABLED;
  937. break;
  938. default:
  939. WL_ERR("invalid cipher group (%d)\n",
  940. sme->crypto.cipher_group);
  941. return -EINVAL;
  942. }
  943. }
  944. WL_CONN("pval (%d) gval (%d)\n", pval, gval);
  945. err = brcmf_dev_intvar_set(ndev, "wsec", pval | gval);
  946. if (err) {
  947. WL_ERR("error (%d)\n", err);
  948. return err;
  949. }
  950. sec = brcmf_read_prof(cfg_priv, WL_PROF_SEC);
  951. sec->cipher_pairwise = sme->crypto.ciphers_pairwise[0];
  952. sec->cipher_group = sme->crypto.cipher_group;
  953. return err;
  954. }
  955. static s32
  956. brcmf_set_key_mgmt(struct net_device *ndev, struct cfg80211_connect_params *sme)
  957. {
  958. struct brcmf_cfg80211_priv *cfg_priv = ndev_to_cfg(ndev);
  959. struct brcmf_cfg80211_security *sec;
  960. s32 val = 0;
  961. s32 err = 0;
  962. if (sme->crypto.n_akm_suites) {
  963. err = brcmf_dev_intvar_get(ndev, "wpa_auth", &val);
  964. if (err) {
  965. WL_ERR("could not get wpa_auth (%d)\n", err);
  966. return err;
  967. }
  968. if (val & (WPA_AUTH_PSK | WPA_AUTH_UNSPECIFIED)) {
  969. switch (sme->crypto.akm_suites[0]) {
  970. case WLAN_AKM_SUITE_8021X:
  971. val = WPA_AUTH_UNSPECIFIED;
  972. break;
  973. case WLAN_AKM_SUITE_PSK:
  974. val = WPA_AUTH_PSK;
  975. break;
  976. default:
  977. WL_ERR("invalid cipher group (%d)\n",
  978. sme->crypto.cipher_group);
  979. return -EINVAL;
  980. }
  981. } else if (val & (WPA2_AUTH_PSK | WPA2_AUTH_UNSPECIFIED)) {
  982. switch (sme->crypto.akm_suites[0]) {
  983. case WLAN_AKM_SUITE_8021X:
  984. val = WPA2_AUTH_UNSPECIFIED;
  985. break;
  986. case WLAN_AKM_SUITE_PSK:
  987. val = WPA2_AUTH_PSK;
  988. break;
  989. default:
  990. WL_ERR("invalid cipher group (%d)\n",
  991. sme->crypto.cipher_group);
  992. return -EINVAL;
  993. }
  994. }
  995. WL_CONN("setting wpa_auth to %d\n", val);
  996. err = brcmf_dev_intvar_set(ndev, "wpa_auth", val);
  997. if (err) {
  998. WL_ERR("could not set wpa_auth (%d)\n", err);
  999. return err;
  1000. }
  1001. }
  1002. sec = brcmf_read_prof(cfg_priv, WL_PROF_SEC);
  1003. sec->wpa_auth = sme->crypto.akm_suites[0];
  1004. return err;
  1005. }
  1006. static s32
  1007. brcmf_set_set_sharedkey(struct net_device *ndev,
  1008. struct cfg80211_connect_params *sme)
  1009. {
  1010. struct brcmf_cfg80211_priv *cfg_priv = ndev_to_cfg(ndev);
  1011. struct brcmf_cfg80211_security *sec;
  1012. struct brcmf_wsec_key key;
  1013. s32 val;
  1014. s32 err = 0;
  1015. WL_CONN("key len (%d)\n", sme->key_len);
  1016. if (sme->key_len) {
  1017. sec = brcmf_read_prof(cfg_priv, WL_PROF_SEC);
  1018. WL_CONN("wpa_versions 0x%x cipher_pairwise 0x%x\n",
  1019. sec->wpa_versions, sec->cipher_pairwise);
  1020. if (!
  1021. (sec->wpa_versions & (NL80211_WPA_VERSION_1 |
  1022. NL80211_WPA_VERSION_2))
  1023. && (sec->cipher_pairwise & (WLAN_CIPHER_SUITE_WEP40 |
  1024. WLAN_CIPHER_SUITE_WEP104))) {
  1025. memset(&key, 0, sizeof(key));
  1026. key.len = (u32) sme->key_len;
  1027. key.index = (u32) sme->key_idx;
  1028. if (key.len > sizeof(key.data)) {
  1029. WL_ERR("Too long key length (%u)\n", key.len);
  1030. return -EINVAL;
  1031. }
  1032. memcpy(key.data, sme->key, key.len);
  1033. key.flags = BRCMF_PRIMARY_KEY;
  1034. switch (sec->cipher_pairwise) {
  1035. case WLAN_CIPHER_SUITE_WEP40:
  1036. key.algo = CRYPTO_ALGO_WEP1;
  1037. break;
  1038. case WLAN_CIPHER_SUITE_WEP104:
  1039. key.algo = CRYPTO_ALGO_WEP128;
  1040. break;
  1041. default:
  1042. WL_ERR("Invalid algorithm (%d)\n",
  1043. sme->crypto.ciphers_pairwise[0]);
  1044. return -EINVAL;
  1045. }
  1046. /* Set the new key/index */
  1047. WL_CONN("key length (%d) key index (%d) algo (%d)\n",
  1048. key.len, key.index, key.algo);
  1049. WL_CONN("key \"%s\"\n", key.data);
  1050. err = send_key_to_dongle(ndev, &key);
  1051. if (err)
  1052. return err;
  1053. if (sec->auth_type == NL80211_AUTHTYPE_OPEN_SYSTEM) {
  1054. WL_CONN("set auth_type to shared key\n");
  1055. val = 1; /* shared key */
  1056. err = brcmf_dev_intvar_set(ndev, "auth", val);
  1057. if (err) {
  1058. WL_ERR("set auth failed (%d)\n", err);
  1059. return err;
  1060. }
  1061. }
  1062. }
  1063. }
  1064. return err;
  1065. }
  1066. static s32
  1067. brcmf_cfg80211_connect(struct wiphy *wiphy, struct net_device *ndev,
  1068. struct cfg80211_connect_params *sme)
  1069. {
  1070. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  1071. struct ieee80211_channel *chan = sme->channel;
  1072. struct brcmf_join_params join_params;
  1073. size_t join_params_size;
  1074. struct brcmf_ssid ssid;
  1075. s32 err = 0;
  1076. WL_TRACE("Enter\n");
  1077. if (!check_sys_up(wiphy))
  1078. return -EIO;
  1079. if (!sme->ssid) {
  1080. WL_ERR("Invalid ssid\n");
  1081. return -EOPNOTSUPP;
  1082. }
  1083. set_bit(WL_STATUS_CONNECTING, &cfg_priv->status);
  1084. if (chan) {
  1085. cfg_priv->channel =
  1086. ieee80211_frequency_to_channel(chan->center_freq);
  1087. WL_CONN("channel (%d), center_req (%d)\n",
  1088. cfg_priv->channel, chan->center_freq);
  1089. } else
  1090. cfg_priv->channel = 0;
  1091. WL_INFO("ie (%p), ie_len (%zd)\n", sme->ie, sme->ie_len);
  1092. err = brcmf_set_wpa_version(ndev, sme);
  1093. if (err) {
  1094. WL_ERR("wl_set_wpa_version failed (%d)\n", err);
  1095. goto done;
  1096. }
  1097. err = brcmf_set_auth_type(ndev, sme);
  1098. if (err) {
  1099. WL_ERR("wl_set_auth_type failed (%d)\n", err);
  1100. goto done;
  1101. }
  1102. err = brcmf_set_set_cipher(ndev, sme);
  1103. if (err) {
  1104. WL_ERR("wl_set_set_cipher failed (%d)\n", err);
  1105. goto done;
  1106. }
  1107. err = brcmf_set_key_mgmt(ndev, sme);
  1108. if (err) {
  1109. WL_ERR("wl_set_key_mgmt failed (%d)\n", err);
  1110. goto done;
  1111. }
  1112. err = brcmf_set_set_sharedkey(ndev, sme);
  1113. if (err) {
  1114. WL_ERR("wl_set_set_sharedkey failed (%d)\n", err);
  1115. goto done;
  1116. }
  1117. memset(&join_params, 0, sizeof(join_params));
  1118. join_params_size = sizeof(join_params.ssid_le);
  1119. ssid.SSID_len = min_t(u32, sizeof(ssid.SSID), sme->ssid_len);
  1120. memcpy(&join_params.ssid_le.SSID, sme->ssid, ssid.SSID_len);
  1121. memcpy(&ssid.SSID, sme->ssid, ssid.SSID_len);
  1122. join_params.ssid_le.SSID_len = cpu_to_le32(ssid.SSID_len);
  1123. brcmf_update_prof(cfg_priv, NULL, &ssid, WL_PROF_SSID);
  1124. memcpy(join_params.params_le.bssid, ether_bcast, ETH_ALEN);
  1125. if (ssid.SSID_len < IEEE80211_MAX_SSID_LEN)
  1126. WL_CONN("ssid \"%s\", len (%d)\n",
  1127. ssid.SSID, ssid.SSID_len);
  1128. brcmf_ch_to_chanspec(cfg_priv->channel,
  1129. &join_params, &join_params_size);
  1130. err = brcmf_exec_dcmd(ndev, BRCMF_C_SET_SSID,
  1131. &join_params, join_params_size);
  1132. if (err)
  1133. WL_ERR("WLC_SET_SSID failed (%d)\n", err);
  1134. done:
  1135. if (err)
  1136. clear_bit(WL_STATUS_CONNECTING, &cfg_priv->status);
  1137. WL_TRACE("Exit\n");
  1138. return err;
  1139. }
  1140. static s32
  1141. brcmf_cfg80211_disconnect(struct wiphy *wiphy, struct net_device *ndev,
  1142. u16 reason_code)
  1143. {
  1144. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  1145. struct brcmf_scb_val_le scbval;
  1146. s32 err = 0;
  1147. WL_TRACE("Enter. Reason code = %d\n", reason_code);
  1148. if (!check_sys_up(wiphy))
  1149. return -EIO;
  1150. clear_bit(WL_STATUS_CONNECTED, &cfg_priv->status);
  1151. memcpy(&scbval.ea, brcmf_read_prof(cfg_priv, WL_PROF_BSSID), ETH_ALEN);
  1152. scbval.val = cpu_to_le32(reason_code);
  1153. err = brcmf_exec_dcmd(ndev, BRCMF_C_DISASSOC, &scbval,
  1154. sizeof(struct brcmf_scb_val_le));
  1155. if (err)
  1156. WL_ERR("error (%d)\n", err);
  1157. cfg_priv->link_up = false;
  1158. WL_TRACE("Exit\n");
  1159. return err;
  1160. }
  1161. static s32
  1162. brcmf_cfg80211_set_tx_power(struct wiphy *wiphy,
  1163. enum nl80211_tx_power_setting type, s32 dbm)
  1164. {
  1165. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  1166. struct net_device *ndev = cfg_to_ndev(cfg_priv);
  1167. u16 txpwrmw;
  1168. s32 err = 0;
  1169. s32 disable = 0;
  1170. WL_TRACE("Enter\n");
  1171. if (!check_sys_up(wiphy))
  1172. return -EIO;
  1173. switch (type) {
  1174. case NL80211_TX_POWER_AUTOMATIC:
  1175. break;
  1176. case NL80211_TX_POWER_LIMITED:
  1177. if (dbm < 0) {
  1178. WL_ERR("TX_POWER_LIMITED - dbm is negative\n");
  1179. err = -EINVAL;
  1180. goto done;
  1181. }
  1182. break;
  1183. case NL80211_TX_POWER_FIXED:
  1184. if (dbm < 0) {
  1185. WL_ERR("TX_POWER_FIXED - dbm is negative\n");
  1186. err = -EINVAL;
  1187. goto done;
  1188. }
  1189. break;
  1190. }
  1191. /* Make sure radio is off or on as far as software is concerned */
  1192. disable = WL_RADIO_SW_DISABLE << 16;
  1193. err = brcmf_exec_dcmd_u32(ndev, BRCMF_C_SET_RADIO, &disable);
  1194. if (err)
  1195. WL_ERR("WLC_SET_RADIO error (%d)\n", err);
  1196. if (dbm > 0xffff)
  1197. txpwrmw = 0xffff;
  1198. else
  1199. txpwrmw = (u16) dbm;
  1200. err = brcmf_dev_intvar_set(ndev, "qtxpower",
  1201. (s32) (brcmu_mw_to_qdbm(txpwrmw)));
  1202. if (err)
  1203. WL_ERR("qtxpower error (%d)\n", err);
  1204. cfg_priv->conf->tx_power = dbm;
  1205. done:
  1206. WL_TRACE("Exit\n");
  1207. return err;
  1208. }
  1209. static s32 brcmf_cfg80211_get_tx_power(struct wiphy *wiphy, s32 *dbm)
  1210. {
  1211. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  1212. struct net_device *ndev = cfg_to_ndev(cfg_priv);
  1213. s32 txpwrdbm;
  1214. u8 result;
  1215. s32 err = 0;
  1216. WL_TRACE("Enter\n");
  1217. if (!check_sys_up(wiphy))
  1218. return -EIO;
  1219. err = brcmf_dev_intvar_get(ndev, "qtxpower", &txpwrdbm);
  1220. if (err) {
  1221. WL_ERR("error (%d)\n", err);
  1222. goto done;
  1223. }
  1224. result = (u8) (txpwrdbm & ~WL_TXPWR_OVERRIDE);
  1225. *dbm = (s32) brcmu_qdbm_to_mw(result);
  1226. done:
  1227. WL_TRACE("Exit\n");
  1228. return err;
  1229. }
  1230. static s32
  1231. brcmf_cfg80211_config_default_key(struct wiphy *wiphy, struct net_device *ndev,
  1232. u8 key_idx, bool unicast, bool multicast)
  1233. {
  1234. u32 index;
  1235. u32 wsec;
  1236. s32 err = 0;
  1237. WL_TRACE("Enter\n");
  1238. WL_CONN("key index (%d)\n", key_idx);
  1239. if (!check_sys_up(wiphy))
  1240. return -EIO;
  1241. err = brcmf_exec_dcmd_u32(ndev, BRCMF_C_GET_WSEC, &wsec);
  1242. if (err) {
  1243. WL_ERR("WLC_GET_WSEC error (%d)\n", err);
  1244. goto done;
  1245. }
  1246. if (wsec & WEP_ENABLED) {
  1247. /* Just select a new current key */
  1248. index = key_idx;
  1249. err = brcmf_exec_dcmd_u32(ndev, BRCMF_C_SET_KEY_PRIMARY,
  1250. &index);
  1251. if (err)
  1252. WL_ERR("error (%d)\n", err);
  1253. }
  1254. done:
  1255. WL_TRACE("Exit\n");
  1256. return err;
  1257. }
  1258. static s32
  1259. brcmf_add_keyext(struct wiphy *wiphy, struct net_device *ndev,
  1260. u8 key_idx, const u8 *mac_addr, struct key_params *params)
  1261. {
  1262. struct brcmf_wsec_key key;
  1263. struct brcmf_wsec_key_le key_le;
  1264. s32 err = 0;
  1265. memset(&key, 0, sizeof(key));
  1266. key.index = (u32) key_idx;
  1267. /* Instead of bcast for ea address for default wep keys,
  1268. driver needs it to be Null */
  1269. if (!is_multicast_ether_addr(mac_addr))
  1270. memcpy((char *)&key.ea, (void *)mac_addr, ETH_ALEN);
  1271. key.len = (u32) params->key_len;
  1272. /* check for key index change */
  1273. if (key.len == 0) {
  1274. /* key delete */
  1275. err = send_key_to_dongle(ndev, &key);
  1276. if (err)
  1277. return err;
  1278. } else {
  1279. if (key.len > sizeof(key.data)) {
  1280. WL_ERR("Invalid key length (%d)\n", key.len);
  1281. return -EINVAL;
  1282. }
  1283. WL_CONN("Setting the key index %d\n", key.index);
  1284. memcpy(key.data, params->key, key.len);
  1285. if (params->cipher == WLAN_CIPHER_SUITE_TKIP) {
  1286. u8 keybuf[8];
  1287. memcpy(keybuf, &key.data[24], sizeof(keybuf));
  1288. memcpy(&key.data[24], &key.data[16], sizeof(keybuf));
  1289. memcpy(&key.data[16], keybuf, sizeof(keybuf));
  1290. }
  1291. /* if IW_ENCODE_EXT_RX_SEQ_VALID set */
  1292. if (params->seq && params->seq_len == 6) {
  1293. /* rx iv */
  1294. u8 *ivptr;
  1295. ivptr = (u8 *) params->seq;
  1296. key.rxiv.hi = (ivptr[5] << 24) | (ivptr[4] << 16) |
  1297. (ivptr[3] << 8) | ivptr[2];
  1298. key.rxiv.lo = (ivptr[1] << 8) | ivptr[0];
  1299. key.iv_initialized = true;
  1300. }
  1301. switch (params->cipher) {
  1302. case WLAN_CIPHER_SUITE_WEP40:
  1303. key.algo = CRYPTO_ALGO_WEP1;
  1304. WL_CONN("WLAN_CIPHER_SUITE_WEP40\n");
  1305. break;
  1306. case WLAN_CIPHER_SUITE_WEP104:
  1307. key.algo = CRYPTO_ALGO_WEP128;
  1308. WL_CONN("WLAN_CIPHER_SUITE_WEP104\n");
  1309. break;
  1310. case WLAN_CIPHER_SUITE_TKIP:
  1311. key.algo = CRYPTO_ALGO_TKIP;
  1312. WL_CONN("WLAN_CIPHER_SUITE_TKIP\n");
  1313. break;
  1314. case WLAN_CIPHER_SUITE_AES_CMAC:
  1315. key.algo = CRYPTO_ALGO_AES_CCM;
  1316. WL_CONN("WLAN_CIPHER_SUITE_AES_CMAC\n");
  1317. break;
  1318. case WLAN_CIPHER_SUITE_CCMP:
  1319. key.algo = CRYPTO_ALGO_AES_CCM;
  1320. WL_CONN("WLAN_CIPHER_SUITE_CCMP\n");
  1321. break;
  1322. default:
  1323. WL_ERR("Invalid cipher (0x%x)\n", params->cipher);
  1324. return -EINVAL;
  1325. }
  1326. convert_key_from_CPU(&key, &key_le);
  1327. brcmf_netdev_wait_pend8021x(ndev);
  1328. err = brcmf_exec_dcmd(ndev, BRCMF_C_SET_KEY, &key_le,
  1329. sizeof(key_le));
  1330. if (err) {
  1331. WL_ERR("WLC_SET_KEY error (%d)\n", err);
  1332. return err;
  1333. }
  1334. }
  1335. return err;
  1336. }
  1337. static s32
  1338. brcmf_cfg80211_add_key(struct wiphy *wiphy, struct net_device *ndev,
  1339. u8 key_idx, bool pairwise, const u8 *mac_addr,
  1340. struct key_params *params)
  1341. {
  1342. struct brcmf_wsec_key key;
  1343. s32 val;
  1344. s32 wsec;
  1345. s32 err = 0;
  1346. u8 keybuf[8];
  1347. WL_TRACE("Enter\n");
  1348. WL_CONN("key index (%d)\n", key_idx);
  1349. if (!check_sys_up(wiphy))
  1350. return -EIO;
  1351. if (mac_addr) {
  1352. WL_TRACE("Exit");
  1353. return brcmf_add_keyext(wiphy, ndev, key_idx, mac_addr, params);
  1354. }
  1355. memset(&key, 0, sizeof(key));
  1356. key.len = (u32) params->key_len;
  1357. key.index = (u32) key_idx;
  1358. if (key.len > sizeof(key.data)) {
  1359. WL_ERR("Too long key length (%u)\n", key.len);
  1360. err = -EINVAL;
  1361. goto done;
  1362. }
  1363. memcpy(key.data, params->key, key.len);
  1364. key.flags = BRCMF_PRIMARY_KEY;
  1365. switch (params->cipher) {
  1366. case WLAN_CIPHER_SUITE_WEP40:
  1367. key.algo = CRYPTO_ALGO_WEP1;
  1368. WL_CONN("WLAN_CIPHER_SUITE_WEP40\n");
  1369. break;
  1370. case WLAN_CIPHER_SUITE_WEP104:
  1371. key.algo = CRYPTO_ALGO_WEP128;
  1372. WL_CONN("WLAN_CIPHER_SUITE_WEP104\n");
  1373. break;
  1374. case WLAN_CIPHER_SUITE_TKIP:
  1375. memcpy(keybuf, &key.data[24], sizeof(keybuf));
  1376. memcpy(&key.data[24], &key.data[16], sizeof(keybuf));
  1377. memcpy(&key.data[16], keybuf, sizeof(keybuf));
  1378. key.algo = CRYPTO_ALGO_TKIP;
  1379. WL_CONN("WLAN_CIPHER_SUITE_TKIP\n");
  1380. break;
  1381. case WLAN_CIPHER_SUITE_AES_CMAC:
  1382. key.algo = CRYPTO_ALGO_AES_CCM;
  1383. WL_CONN("WLAN_CIPHER_SUITE_AES_CMAC\n");
  1384. break;
  1385. case WLAN_CIPHER_SUITE_CCMP:
  1386. key.algo = CRYPTO_ALGO_AES_CCM;
  1387. WL_CONN("WLAN_CIPHER_SUITE_CCMP\n");
  1388. break;
  1389. default:
  1390. WL_ERR("Invalid cipher (0x%x)\n", params->cipher);
  1391. err = -EINVAL;
  1392. goto done;
  1393. }
  1394. err = send_key_to_dongle(ndev, &key); /* Set the new key/index */
  1395. if (err)
  1396. goto done;
  1397. val = WEP_ENABLED;
  1398. err = brcmf_dev_intvar_get(ndev, "wsec", &wsec);
  1399. if (err) {
  1400. WL_ERR("get wsec error (%d)\n", err);
  1401. goto done;
  1402. }
  1403. wsec &= ~(WEP_ENABLED);
  1404. wsec |= val;
  1405. err = brcmf_dev_intvar_set(ndev, "wsec", wsec);
  1406. if (err) {
  1407. WL_ERR("set wsec error (%d)\n", err);
  1408. goto done;
  1409. }
  1410. val = 1; /* assume shared key. otherwise 0 */
  1411. err = brcmf_exec_dcmd_u32(ndev, BRCMF_C_SET_AUTH, &val);
  1412. if (err)
  1413. WL_ERR("WLC_SET_AUTH error (%d)\n", err);
  1414. done:
  1415. WL_TRACE("Exit\n");
  1416. return err;
  1417. }
  1418. static s32
  1419. brcmf_cfg80211_del_key(struct wiphy *wiphy, struct net_device *ndev,
  1420. u8 key_idx, bool pairwise, const u8 *mac_addr)
  1421. {
  1422. struct brcmf_wsec_key key;
  1423. s32 err = 0;
  1424. s32 val;
  1425. s32 wsec;
  1426. WL_TRACE("Enter\n");
  1427. if (!check_sys_up(wiphy))
  1428. return -EIO;
  1429. memset(&key, 0, sizeof(key));
  1430. key.index = (u32) key_idx;
  1431. key.flags = BRCMF_PRIMARY_KEY;
  1432. key.algo = CRYPTO_ALGO_OFF;
  1433. WL_CONN("key index (%d)\n", key_idx);
  1434. /* Set the new key/index */
  1435. err = send_key_to_dongle(ndev, &key);
  1436. if (err) {
  1437. if (err == -EINVAL) {
  1438. if (key.index >= DOT11_MAX_DEFAULT_KEYS)
  1439. /* we ignore this key index in this case */
  1440. WL_ERR("invalid key index (%d)\n", key_idx);
  1441. }
  1442. /* Ignore this error, may happen during DISASSOC */
  1443. err = -EAGAIN;
  1444. goto done;
  1445. }
  1446. val = 0;
  1447. err = brcmf_dev_intvar_get(ndev, "wsec", &wsec);
  1448. if (err) {
  1449. WL_ERR("get wsec error (%d)\n", err);
  1450. /* Ignore this error, may happen during DISASSOC */
  1451. err = -EAGAIN;
  1452. goto done;
  1453. }
  1454. wsec &= ~(WEP_ENABLED);
  1455. wsec |= val;
  1456. err = brcmf_dev_intvar_set(ndev, "wsec", wsec);
  1457. if (err) {
  1458. WL_ERR("set wsec error (%d)\n", err);
  1459. /* Ignore this error, may happen during DISASSOC */
  1460. err = -EAGAIN;
  1461. goto done;
  1462. }
  1463. val = 0; /* assume open key. otherwise 1 */
  1464. err = brcmf_exec_dcmd_u32(ndev, BRCMF_C_SET_AUTH, &val);
  1465. if (err) {
  1466. WL_ERR("WLC_SET_AUTH error (%d)\n", err);
  1467. /* Ignore this error, may happen during DISASSOC */
  1468. err = -EAGAIN;
  1469. }
  1470. done:
  1471. WL_TRACE("Exit\n");
  1472. return err;
  1473. }
  1474. static s32
  1475. brcmf_cfg80211_get_key(struct wiphy *wiphy, struct net_device *ndev,
  1476. u8 key_idx, bool pairwise, const u8 *mac_addr, void *cookie,
  1477. void (*callback) (void *cookie, struct key_params * params))
  1478. {
  1479. struct key_params params;
  1480. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  1481. struct brcmf_cfg80211_security *sec;
  1482. s32 wsec;
  1483. s32 err = 0;
  1484. WL_TRACE("Enter\n");
  1485. WL_CONN("key index (%d)\n", key_idx);
  1486. if (!check_sys_up(wiphy))
  1487. return -EIO;
  1488. memset(&params, 0, sizeof(params));
  1489. err = brcmf_exec_dcmd_u32(ndev, BRCMF_C_GET_WSEC, &wsec);
  1490. if (err) {
  1491. WL_ERR("WLC_GET_WSEC error (%d)\n", err);
  1492. /* Ignore this error, may happen during DISASSOC */
  1493. err = -EAGAIN;
  1494. goto done;
  1495. }
  1496. switch (wsec) {
  1497. case WEP_ENABLED:
  1498. sec = brcmf_read_prof(cfg_priv, WL_PROF_SEC);
  1499. if (sec->cipher_pairwise & WLAN_CIPHER_SUITE_WEP40) {
  1500. params.cipher = WLAN_CIPHER_SUITE_WEP40;
  1501. WL_CONN("WLAN_CIPHER_SUITE_WEP40\n");
  1502. } else if (sec->cipher_pairwise & WLAN_CIPHER_SUITE_WEP104) {
  1503. params.cipher = WLAN_CIPHER_SUITE_WEP104;
  1504. WL_CONN("WLAN_CIPHER_SUITE_WEP104\n");
  1505. }
  1506. break;
  1507. case TKIP_ENABLED:
  1508. params.cipher = WLAN_CIPHER_SUITE_TKIP;
  1509. WL_CONN("WLAN_CIPHER_SUITE_TKIP\n");
  1510. break;
  1511. case AES_ENABLED:
  1512. params.cipher = WLAN_CIPHER_SUITE_AES_CMAC;
  1513. WL_CONN("WLAN_CIPHER_SUITE_AES_CMAC\n");
  1514. break;
  1515. default:
  1516. WL_ERR("Invalid algo (0x%x)\n", wsec);
  1517. err = -EINVAL;
  1518. goto done;
  1519. }
  1520. callback(cookie, &params);
  1521. done:
  1522. WL_TRACE("Exit\n");
  1523. return err;
  1524. }
  1525. static s32
  1526. brcmf_cfg80211_config_default_mgmt_key(struct wiphy *wiphy,
  1527. struct net_device *ndev, u8 key_idx)
  1528. {
  1529. WL_INFO("Not supported\n");
  1530. return -EOPNOTSUPP;
  1531. }
  1532. static s32
  1533. brcmf_cfg80211_get_station(struct wiphy *wiphy, struct net_device *ndev,
  1534. u8 *mac, struct station_info *sinfo)
  1535. {
  1536. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  1537. struct brcmf_scb_val_le scb_val;
  1538. int rssi;
  1539. s32 rate;
  1540. s32 err = 0;
  1541. u8 *bssid = brcmf_read_prof(cfg_priv, WL_PROF_BSSID);
  1542. WL_TRACE("Enter\n");
  1543. if (!check_sys_up(wiphy))
  1544. return -EIO;
  1545. if (memcmp(mac, bssid, ETH_ALEN)) {
  1546. WL_ERR("Wrong Mac address cfg_mac-%X:%X:%X:%X:%X:%X"
  1547. "wl_bssid-%X:%X:%X:%X:%X:%X\n",
  1548. mac[0], mac[1], mac[2], mac[3], mac[4], mac[5],
  1549. bssid[0], bssid[1], bssid[2], bssid[3],
  1550. bssid[4], bssid[5]);
  1551. err = -ENOENT;
  1552. goto done;
  1553. }
  1554. /* Report the current tx rate */
  1555. err = brcmf_exec_dcmd_u32(ndev, BRCMF_C_GET_RATE, &rate);
  1556. if (err) {
  1557. WL_ERR("Could not get rate (%d)\n", err);
  1558. } else {
  1559. sinfo->filled |= STATION_INFO_TX_BITRATE;
  1560. sinfo->txrate.legacy = rate * 5;
  1561. WL_CONN("Rate %d Mbps\n", rate / 2);
  1562. }
  1563. if (test_bit(WL_STATUS_CONNECTED, &cfg_priv->status)) {
  1564. scb_val.val = cpu_to_le32(0);
  1565. err = brcmf_exec_dcmd(ndev, BRCMF_C_GET_RSSI, &scb_val,
  1566. sizeof(struct brcmf_scb_val_le));
  1567. if (err)
  1568. WL_ERR("Could not get rssi (%d)\n", err);
  1569. rssi = le32_to_cpu(scb_val.val);
  1570. sinfo->filled |= STATION_INFO_SIGNAL;
  1571. sinfo->signal = rssi;
  1572. WL_CONN("RSSI %d dBm\n", rssi);
  1573. }
  1574. done:
  1575. WL_TRACE("Exit\n");
  1576. return err;
  1577. }
  1578. static s32
  1579. brcmf_cfg80211_set_power_mgmt(struct wiphy *wiphy, struct net_device *ndev,
  1580. bool enabled, s32 timeout)
  1581. {
  1582. s32 pm;
  1583. s32 err = 0;
  1584. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  1585. WL_TRACE("Enter\n");
  1586. /*
  1587. * Powersave enable/disable request is coming from the
  1588. * cfg80211 even before the interface is up. In that
  1589. * scenario, driver will be storing the power save
  1590. * preference in cfg_priv struct to apply this to
  1591. * FW later while initializing the dongle
  1592. */
  1593. cfg_priv->pwr_save = enabled;
  1594. if (!test_bit(WL_STATUS_READY, &cfg_priv->status)) {
  1595. WL_INFO("Device is not ready,"
  1596. "storing the value in cfg_priv struct\n");
  1597. goto done;
  1598. }
  1599. pm = enabled ? PM_FAST : PM_OFF;
  1600. WL_INFO("power save %s\n", (pm ? "enabled" : "disabled"));
  1601. err = brcmf_exec_dcmd_u32(ndev, BRCMF_C_SET_PM, &pm);
  1602. if (err) {
  1603. if (err == -ENODEV)
  1604. WL_ERR("net_device is not ready yet\n");
  1605. else
  1606. WL_ERR("error (%d)\n", err);
  1607. }
  1608. done:
  1609. WL_TRACE("Exit\n");
  1610. return err;
  1611. }
  1612. static s32
  1613. brcmf_cfg80211_set_bitrate_mask(struct wiphy *wiphy, struct net_device *ndev,
  1614. const u8 *addr,
  1615. const struct cfg80211_bitrate_mask *mask)
  1616. {
  1617. struct brcm_rateset_le rateset_le;
  1618. s32 rate;
  1619. s32 val;
  1620. s32 err_bg;
  1621. s32 err_a;
  1622. u32 legacy;
  1623. s32 err = 0;
  1624. WL_TRACE("Enter\n");
  1625. if (!check_sys_up(wiphy))
  1626. return -EIO;
  1627. /* addr param is always NULL. ignore it */
  1628. /* Get current rateset */
  1629. err = brcmf_exec_dcmd(ndev, BRCM_GET_CURR_RATESET, &rateset_le,
  1630. sizeof(rateset_le));
  1631. if (err) {
  1632. WL_ERR("could not get current rateset (%d)\n", err);
  1633. goto done;
  1634. }
  1635. legacy = ffs(mask->control[IEEE80211_BAND_2GHZ].legacy & 0xFFFF);
  1636. if (!legacy)
  1637. legacy = ffs(mask->control[IEEE80211_BAND_5GHZ].legacy &
  1638. 0xFFFF);
  1639. val = wl_g_rates[legacy - 1].bitrate * 100000;
  1640. if (val < le32_to_cpu(rateset_le.count))
  1641. /* Select rate by rateset index */
  1642. rate = rateset_le.rates[val] & 0x7f;
  1643. else
  1644. /* Specified rate in bps */
  1645. rate = val / 500000;
  1646. WL_CONN("rate %d mbps\n", rate / 2);
  1647. /*
  1648. *
  1649. * Set rate override,
  1650. * Since the is a/b/g-blind, both a/bg_rate are enforced.
  1651. */
  1652. err_bg = brcmf_dev_intvar_set(ndev, "bg_rate", rate);
  1653. err_a = brcmf_dev_intvar_set(ndev, "a_rate", rate);
  1654. if (err_bg && err_a) {
  1655. WL_ERR("could not set fixed rate (%d) (%d)\n", err_bg, err_a);
  1656. err = err_bg | err_a;
  1657. }
  1658. done:
  1659. WL_TRACE("Exit\n");
  1660. return err;
  1661. }
  1662. static s32 brcmf_inform_single_bss(struct brcmf_cfg80211_priv *cfg_priv,
  1663. struct brcmf_bss_info *bi)
  1664. {
  1665. struct wiphy *wiphy = cfg_to_wiphy(cfg_priv);
  1666. struct ieee80211_channel *notify_channel;
  1667. struct cfg80211_bss *bss;
  1668. struct ieee80211_supported_band *band;
  1669. s32 err = 0;
  1670. u16 channel;
  1671. u32 freq;
  1672. u64 notify_timestamp;
  1673. u16 notify_capability;
  1674. u16 notify_interval;
  1675. u8 *notify_ie;
  1676. size_t notify_ielen;
  1677. s32 notify_signal;
  1678. if (le32_to_cpu(bi->length) > WL_BSS_INFO_MAX) {
  1679. WL_ERR("Bss info is larger than buffer. Discarding\n");
  1680. return 0;
  1681. }
  1682. channel = bi->ctl_ch ? bi->ctl_ch :
  1683. CHSPEC_CHANNEL(le16_to_cpu(bi->chanspec));
  1684. if (channel <= CH_MAX_2G_CHANNEL)
  1685. band = wiphy->bands[IEEE80211_BAND_2GHZ];
  1686. else
  1687. band = wiphy->bands[IEEE80211_BAND_5GHZ];
  1688. freq = ieee80211_channel_to_frequency(channel, band->band);
  1689. notify_channel = ieee80211_get_channel(wiphy, freq);
  1690. notify_timestamp = jiffies_to_msecs(jiffies)*1000; /* uSec */
  1691. notify_capability = le16_to_cpu(bi->capability);
  1692. notify_interval = le16_to_cpu(bi->beacon_period);
  1693. notify_ie = (u8 *)bi + le16_to_cpu(bi->ie_offset);
  1694. notify_ielen = le32_to_cpu(bi->ie_length);
  1695. notify_signal = (s16)le16_to_cpu(bi->RSSI) * 100;
  1696. WL_CONN("bssid: %2.2X:%2.2X:%2.2X:%2.2X:%2.2X:%2.2X\n",
  1697. bi->BSSID[0], bi->BSSID[1], bi->BSSID[2],
  1698. bi->BSSID[3], bi->BSSID[4], bi->BSSID[5]);
  1699. WL_CONN("Channel: %d(%d)\n", channel, freq);
  1700. WL_CONN("Capability: %X\n", notify_capability);
  1701. WL_CONN("Beacon interval: %d\n", notify_interval);
  1702. WL_CONN("Signal: %d\n", notify_signal);
  1703. WL_CONN("notify_timestamp: %#018llx\n", notify_timestamp);
  1704. bss = cfg80211_inform_bss(wiphy, notify_channel, (const u8 *)bi->BSSID,
  1705. notify_timestamp, notify_capability, notify_interval, notify_ie,
  1706. notify_ielen, notify_signal, GFP_KERNEL);
  1707. if (!bss) {
  1708. WL_ERR("cfg80211_inform_bss_frame error\n");
  1709. return -EINVAL;
  1710. }
  1711. return err;
  1712. }
  1713. static s32 brcmf_inform_bss(struct brcmf_cfg80211_priv *cfg_priv)
  1714. {
  1715. struct brcmf_scan_results *bss_list;
  1716. struct brcmf_bss_info *bi = NULL; /* must be initialized */
  1717. s32 err = 0;
  1718. int i;
  1719. bss_list = cfg_priv->bss_list;
  1720. if (bss_list->version != BRCMF_BSS_INFO_VERSION) {
  1721. WL_ERR("Version %d != WL_BSS_INFO_VERSION\n",
  1722. bss_list->version);
  1723. return -EOPNOTSUPP;
  1724. }
  1725. WL_SCAN("scanned AP count (%d)\n", bss_list->count);
  1726. for (i = 0; i < bss_list->count && i < WL_AP_MAX; i++) {
  1727. bi = next_bss(bss_list, bi);
  1728. err = brcmf_inform_single_bss(cfg_priv, bi);
  1729. if (err)
  1730. break;
  1731. }
  1732. return err;
  1733. }
  1734. static s32 wl_inform_ibss(struct brcmf_cfg80211_priv *cfg_priv,
  1735. struct net_device *ndev, const u8 *bssid)
  1736. {
  1737. struct wiphy *wiphy = cfg_to_wiphy(cfg_priv);
  1738. struct ieee80211_channel *notify_channel;
  1739. struct brcmf_bss_info *bi = NULL;
  1740. struct ieee80211_supported_band *band;
  1741. u8 *buf = NULL;
  1742. s32 err = 0;
  1743. u16 channel;
  1744. u32 freq;
  1745. u64 notify_timestamp;
  1746. u16 notify_capability;
  1747. u16 notify_interval;
  1748. u8 *notify_ie;
  1749. size_t notify_ielen;
  1750. s32 notify_signal;
  1751. WL_TRACE("Enter\n");
  1752. buf = kzalloc(WL_BSS_INFO_MAX, GFP_KERNEL);
  1753. if (buf == NULL) {
  1754. err = -ENOMEM;
  1755. goto CleanUp;
  1756. }
  1757. *(__le32 *)buf = cpu_to_le32(WL_BSS_INFO_MAX);
  1758. err = brcmf_exec_dcmd(ndev, BRCMF_C_GET_BSS_INFO, buf, WL_BSS_INFO_MAX);
  1759. if (err) {
  1760. WL_ERR("WLC_GET_BSS_INFO failed: %d\n", err);
  1761. goto CleanUp;
  1762. }
  1763. bi = (struct brcmf_bss_info *)(buf + 4);
  1764. channel = bi->ctl_ch ? bi->ctl_ch :
  1765. CHSPEC_CHANNEL(le16_to_cpu(bi->chanspec));
  1766. if (channel <= CH_MAX_2G_CHANNEL)
  1767. band = wiphy->bands[IEEE80211_BAND_2GHZ];
  1768. else
  1769. band = wiphy->bands[IEEE80211_BAND_5GHZ];
  1770. freq = ieee80211_channel_to_frequency(channel, band->band);
  1771. notify_channel = ieee80211_get_channel(wiphy, freq);
  1772. notify_timestamp = jiffies_to_msecs(jiffies)*1000; /* uSec */
  1773. notify_capability = le16_to_cpu(bi->capability);
  1774. notify_interval = le16_to_cpu(bi->beacon_period);
  1775. notify_ie = (u8 *)bi + le16_to_cpu(bi->ie_offset);
  1776. notify_ielen = le32_to_cpu(bi->ie_length);
  1777. notify_signal = (s16)le16_to_cpu(bi->RSSI) * 100;
  1778. WL_CONN("channel: %d(%d)\n", channel, freq);
  1779. WL_CONN("capability: %X\n", notify_capability);
  1780. WL_CONN("beacon interval: %d\n", notify_interval);
  1781. WL_CONN("signal: %d\n", notify_signal);
  1782. WL_CONN("notify_timestamp: %#018llx\n", notify_timestamp);
  1783. cfg80211_inform_bss(wiphy, notify_channel, bssid,
  1784. notify_timestamp, notify_capability, notify_interval,
  1785. notify_ie, notify_ielen, notify_signal, GFP_KERNEL);
  1786. CleanUp:
  1787. kfree(buf);
  1788. WL_TRACE("Exit\n");
  1789. return err;
  1790. }
  1791. static bool brcmf_is_ibssmode(struct brcmf_cfg80211_priv *cfg_priv)
  1792. {
  1793. return cfg_priv->conf->mode == WL_MODE_IBSS;
  1794. }
  1795. static s32 brcmf_update_bss_info(struct brcmf_cfg80211_priv *cfg_priv)
  1796. {
  1797. struct brcmf_bss_info *bi;
  1798. struct brcmf_ssid *ssid;
  1799. struct brcmu_tlv *tim;
  1800. u16 beacon_interval;
  1801. u8 dtim_period;
  1802. size_t ie_len;
  1803. u8 *ie;
  1804. s32 err = 0;
  1805. WL_TRACE("Enter\n");
  1806. if (brcmf_is_ibssmode(cfg_priv))
  1807. return err;
  1808. ssid = (struct brcmf_ssid *)brcmf_read_prof(cfg_priv, WL_PROF_SSID);
  1809. *(__le32 *)cfg_priv->extra_buf = cpu_to_le32(WL_EXTRA_BUF_MAX);
  1810. err = brcmf_exec_dcmd(cfg_to_ndev(cfg_priv), BRCMF_C_GET_BSS_INFO,
  1811. cfg_priv->extra_buf, WL_EXTRA_BUF_MAX);
  1812. if (err) {
  1813. WL_ERR("Could not get bss info %d\n", err);
  1814. goto update_bss_info_out;
  1815. }
  1816. bi = (struct brcmf_bss_info *)(cfg_priv->extra_buf + 4);
  1817. err = brcmf_inform_single_bss(cfg_priv, bi);
  1818. if (err)
  1819. goto update_bss_info_out;
  1820. ie = ((u8 *)bi) + le16_to_cpu(bi->ie_offset);
  1821. ie_len = le32_to_cpu(bi->ie_length);
  1822. beacon_interval = le16_to_cpu(bi->beacon_period);
  1823. tim = brcmu_parse_tlvs(ie, ie_len, WLAN_EID_TIM);
  1824. if (tim)
  1825. dtim_period = tim->data[1];
  1826. else {
  1827. /*
  1828. * active scan was done so we could not get dtim
  1829. * information out of probe response.
  1830. * so we speficially query dtim information to dongle.
  1831. */
  1832. u32 var;
  1833. err = brcmf_dev_intvar_get(cfg_to_ndev(cfg_priv),
  1834. "dtim_assoc", &var);
  1835. if (err) {
  1836. WL_ERR("wl dtim_assoc failed (%d)\n", err);
  1837. goto update_bss_info_out;
  1838. }
  1839. dtim_period = (u8)var;
  1840. }
  1841. brcmf_update_prof(cfg_priv, NULL, &beacon_interval, WL_PROF_BEACONINT);
  1842. brcmf_update_prof(cfg_priv, NULL, &dtim_period, WL_PROF_DTIMPERIOD);
  1843. update_bss_info_out:
  1844. WL_TRACE("Exit");
  1845. return err;
  1846. }
  1847. static void brcmf_term_iscan(struct brcmf_cfg80211_priv *cfg_priv)
  1848. {
  1849. struct brcmf_cfg80211_iscan_ctrl *iscan = cfg_to_iscan(cfg_priv);
  1850. struct brcmf_ssid ssid;
  1851. if (cfg_priv->iscan_on) {
  1852. iscan->state = WL_ISCAN_STATE_IDLE;
  1853. if (iscan->timer_on) {
  1854. del_timer_sync(&iscan->timer);
  1855. iscan->timer_on = 0;
  1856. }
  1857. cancel_work_sync(&iscan->work);
  1858. /* Abort iscan running in FW */
  1859. memset(&ssid, 0, sizeof(ssid));
  1860. brcmf_run_iscan(iscan, &ssid, WL_SCAN_ACTION_ABORT);
  1861. }
  1862. }
  1863. static void brcmf_notify_iscan_complete(struct brcmf_cfg80211_iscan_ctrl *iscan,
  1864. bool aborted)
  1865. {
  1866. struct brcmf_cfg80211_priv *cfg_priv = iscan_to_cfg(iscan);
  1867. struct net_device *ndev = cfg_to_ndev(cfg_priv);
  1868. if (!test_and_clear_bit(WL_STATUS_SCANNING, &cfg_priv->status)) {
  1869. WL_ERR("Scan complete while device not scanning\n");
  1870. return;
  1871. }
  1872. if (cfg_priv->scan_request) {
  1873. WL_SCAN("ISCAN Completed scan: %s\n",
  1874. aborted ? "Aborted" : "Done");
  1875. cfg80211_scan_done(cfg_priv->scan_request, aborted);
  1876. brcmf_set_mpc(ndev, 1);
  1877. cfg_priv->scan_request = NULL;
  1878. }
  1879. cfg_priv->iscan_kickstart = false;
  1880. }
  1881. static s32 brcmf_wakeup_iscan(struct brcmf_cfg80211_iscan_ctrl *iscan)
  1882. {
  1883. if (iscan->state != WL_ISCAN_STATE_IDLE) {
  1884. WL_SCAN("wake up iscan\n");
  1885. schedule_work(&iscan->work);
  1886. return 0;
  1887. }
  1888. return -EIO;
  1889. }
  1890. static s32
  1891. brcmf_get_iscan_results(struct brcmf_cfg80211_iscan_ctrl *iscan, u32 *status,
  1892. struct brcmf_scan_results **bss_list)
  1893. {
  1894. struct brcmf_iscan_results list;
  1895. struct brcmf_scan_results *results;
  1896. struct brcmf_scan_results_le *results_le;
  1897. struct brcmf_iscan_results *list_buf;
  1898. s32 err = 0;
  1899. memset(iscan->scan_buf, 0, WL_ISCAN_BUF_MAX);
  1900. list_buf = (struct brcmf_iscan_results *)iscan->scan_buf;
  1901. results = &list_buf->results;
  1902. results_le = &list_buf->results_le;
  1903. results->buflen = BRCMF_ISCAN_RESULTS_FIXED_SIZE;
  1904. results->version = 0;
  1905. results->count = 0;
  1906. memset(&list, 0, sizeof(list));
  1907. list.results_le.buflen = cpu_to_le32(WL_ISCAN_BUF_MAX);
  1908. err = brcmf_dev_iovar_getbuf(iscan->ndev, "iscanresults", &list,
  1909. BRCMF_ISCAN_RESULTS_FIXED_SIZE,
  1910. iscan->scan_buf, WL_ISCAN_BUF_MAX);
  1911. if (err) {
  1912. WL_ERR("error (%d)\n", err);
  1913. return err;
  1914. }
  1915. results->buflen = le32_to_cpu(results_le->buflen);
  1916. results->version = le32_to_cpu(results_le->version);
  1917. results->count = le32_to_cpu(results_le->count);
  1918. WL_SCAN("results->count = %d\n", results_le->count);
  1919. WL_SCAN("results->buflen = %d\n", results_le->buflen);
  1920. *status = le32_to_cpu(list_buf->status_le);
  1921. WL_SCAN("status = %d\n", *status);
  1922. *bss_list = results;
  1923. return err;
  1924. }
  1925. static s32 brcmf_iscan_done(struct brcmf_cfg80211_priv *cfg_priv)
  1926. {
  1927. struct brcmf_cfg80211_iscan_ctrl *iscan = cfg_priv->iscan;
  1928. s32 err = 0;
  1929. iscan->state = WL_ISCAN_STATE_IDLE;
  1930. brcmf_inform_bss(cfg_priv);
  1931. brcmf_notify_iscan_complete(iscan, false);
  1932. return err;
  1933. }
  1934. static s32 brcmf_iscan_pending(struct brcmf_cfg80211_priv *cfg_priv)
  1935. {
  1936. struct brcmf_cfg80211_iscan_ctrl *iscan = cfg_priv->iscan;
  1937. s32 err = 0;
  1938. /* Reschedule the timer */
  1939. mod_timer(&iscan->timer, jiffies + iscan->timer_ms * HZ / 1000);
  1940. iscan->timer_on = 1;
  1941. return err;
  1942. }
  1943. static s32 brcmf_iscan_inprogress(struct brcmf_cfg80211_priv *cfg_priv)
  1944. {
  1945. struct brcmf_cfg80211_iscan_ctrl *iscan = cfg_priv->iscan;
  1946. s32 err = 0;
  1947. brcmf_inform_bss(cfg_priv);
  1948. brcmf_run_iscan(iscan, NULL, BRCMF_SCAN_ACTION_CONTINUE);
  1949. /* Reschedule the timer */
  1950. mod_timer(&iscan->timer, jiffies + iscan->timer_ms * HZ / 1000);
  1951. iscan->timer_on = 1;
  1952. return err;
  1953. }
  1954. static s32 brcmf_iscan_aborted(struct brcmf_cfg80211_priv *cfg_priv)
  1955. {
  1956. struct brcmf_cfg80211_iscan_ctrl *iscan = cfg_priv->iscan;
  1957. s32 err = 0;
  1958. iscan->state = WL_ISCAN_STATE_IDLE;
  1959. brcmf_notify_iscan_complete(iscan, true);
  1960. return err;
  1961. }
  1962. static void brcmf_cfg80211_iscan_handler(struct work_struct *work)
  1963. {
  1964. struct brcmf_cfg80211_iscan_ctrl *iscan =
  1965. container_of(work, struct brcmf_cfg80211_iscan_ctrl,
  1966. work);
  1967. struct brcmf_cfg80211_priv *cfg_priv = iscan_to_cfg(iscan);
  1968. struct brcmf_cfg80211_iscan_eloop *el = &iscan->el;
  1969. u32 status = BRCMF_SCAN_RESULTS_PARTIAL;
  1970. if (iscan->timer_on) {
  1971. del_timer_sync(&iscan->timer);
  1972. iscan->timer_on = 0;
  1973. }
  1974. if (brcmf_get_iscan_results(iscan, &status, &cfg_priv->bss_list)) {
  1975. status = BRCMF_SCAN_RESULTS_ABORTED;
  1976. WL_ERR("Abort iscan\n");
  1977. }
  1978. el->handler[status](cfg_priv);
  1979. }
  1980. static void brcmf_iscan_timer(unsigned long data)
  1981. {
  1982. struct brcmf_cfg80211_iscan_ctrl *iscan =
  1983. (struct brcmf_cfg80211_iscan_ctrl *)data;
  1984. if (iscan) {
  1985. iscan->timer_on = 0;
  1986. WL_SCAN("timer expired\n");
  1987. brcmf_wakeup_iscan(iscan);
  1988. }
  1989. }
  1990. static s32 brcmf_invoke_iscan(struct brcmf_cfg80211_priv *cfg_priv)
  1991. {
  1992. struct brcmf_cfg80211_iscan_ctrl *iscan = cfg_to_iscan(cfg_priv);
  1993. if (cfg_priv->iscan_on) {
  1994. iscan->state = WL_ISCAN_STATE_IDLE;
  1995. INIT_WORK(&iscan->work, brcmf_cfg80211_iscan_handler);
  1996. }
  1997. return 0;
  1998. }
  1999. static void brcmf_init_iscan_eloop(struct brcmf_cfg80211_iscan_eloop *el)
  2000. {
  2001. memset(el, 0, sizeof(*el));
  2002. el->handler[BRCMF_SCAN_RESULTS_SUCCESS] = brcmf_iscan_done;
  2003. el->handler[BRCMF_SCAN_RESULTS_PARTIAL] = brcmf_iscan_inprogress;
  2004. el->handler[BRCMF_SCAN_RESULTS_PENDING] = brcmf_iscan_pending;
  2005. el->handler[BRCMF_SCAN_RESULTS_ABORTED] = brcmf_iscan_aborted;
  2006. el->handler[BRCMF_SCAN_RESULTS_NO_MEM] = brcmf_iscan_aborted;
  2007. }
  2008. static s32 brcmf_init_iscan(struct brcmf_cfg80211_priv *cfg_priv)
  2009. {
  2010. struct brcmf_cfg80211_iscan_ctrl *iscan = cfg_to_iscan(cfg_priv);
  2011. int err = 0;
  2012. if (cfg_priv->iscan_on) {
  2013. iscan->ndev = cfg_to_ndev(cfg_priv);
  2014. brcmf_init_iscan_eloop(&iscan->el);
  2015. iscan->timer_ms = WL_ISCAN_TIMER_INTERVAL_MS;
  2016. init_timer(&iscan->timer);
  2017. iscan->timer.data = (unsigned long) iscan;
  2018. iscan->timer.function = brcmf_iscan_timer;
  2019. err = brcmf_invoke_iscan(cfg_priv);
  2020. if (!err)
  2021. iscan->data = cfg_priv;
  2022. }
  2023. return err;
  2024. }
  2025. static void brcmf_delay(u32 ms)
  2026. {
  2027. if (ms < 1000 / HZ) {
  2028. cond_resched();
  2029. mdelay(ms);
  2030. } else {
  2031. msleep(ms);
  2032. }
  2033. }
  2034. static s32 brcmf_cfg80211_resume(struct wiphy *wiphy)
  2035. {
  2036. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  2037. /*
  2038. * Check for WL_STATUS_READY before any function call which
  2039. * could result is bus access. Don't block the resume for
  2040. * any driver error conditions
  2041. */
  2042. WL_TRACE("Enter\n");
  2043. if (test_bit(WL_STATUS_READY, &cfg_priv->status))
  2044. brcmf_invoke_iscan(wiphy_to_cfg(wiphy));
  2045. WL_TRACE("Exit\n");
  2046. return 0;
  2047. }
  2048. static s32 brcmf_cfg80211_suspend(struct wiphy *wiphy,
  2049. struct cfg80211_wowlan *wow)
  2050. {
  2051. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  2052. struct net_device *ndev = cfg_to_ndev(cfg_priv);
  2053. WL_TRACE("Enter\n");
  2054. /*
  2055. * Check for WL_STATUS_READY before any function call which
  2056. * could result is bus access. Don't block the suspend for
  2057. * any driver error conditions
  2058. */
  2059. /*
  2060. * While going to suspend if associated with AP disassociate
  2061. * from AP to save power while system is in suspended state
  2062. */
  2063. if ((test_bit(WL_STATUS_CONNECTED, &cfg_priv->status) ||
  2064. test_bit(WL_STATUS_CONNECTING, &cfg_priv->status)) &&
  2065. test_bit(WL_STATUS_READY, &cfg_priv->status)) {
  2066. WL_INFO("Disassociating from AP"
  2067. " while entering suspend state\n");
  2068. brcmf_link_down(cfg_priv);
  2069. /*
  2070. * Make sure WPA_Supplicant receives all the event
  2071. * generated due to DISASSOC call to the fw to keep
  2072. * the state fw and WPA_Supplicant state consistent
  2073. */
  2074. brcmf_delay(500);
  2075. }
  2076. set_bit(WL_STATUS_SCAN_ABORTING, &cfg_priv->status);
  2077. if (test_bit(WL_STATUS_READY, &cfg_priv->status))
  2078. brcmf_term_iscan(cfg_priv);
  2079. if (cfg_priv->scan_request) {
  2080. /* Indidate scan abort to cfg80211 layer */
  2081. WL_INFO("Terminating scan in progress\n");
  2082. cfg80211_scan_done(cfg_priv->scan_request, true);
  2083. cfg_priv->scan_request = NULL;
  2084. }
  2085. clear_bit(WL_STATUS_SCANNING, &cfg_priv->status);
  2086. clear_bit(WL_STATUS_SCAN_ABORTING, &cfg_priv->status);
  2087. /* Turn off watchdog timer */
  2088. if (test_bit(WL_STATUS_READY, &cfg_priv->status)) {
  2089. WL_INFO("Enable MPC\n");
  2090. brcmf_set_mpc(ndev, 1);
  2091. }
  2092. WL_TRACE("Exit\n");
  2093. return 0;
  2094. }
  2095. static __used s32
  2096. brcmf_dev_bufvar_set(struct net_device *ndev, s8 *name, s8 *buf, s32 len)
  2097. {
  2098. struct brcmf_cfg80211_priv *cfg_priv = ndev_to_cfg(ndev);
  2099. u32 buflen;
  2100. buflen = brcmu_mkiovar(name, buf, len, cfg_priv->dcmd_buf,
  2101. WL_DCMD_LEN_MAX);
  2102. BUG_ON(!buflen);
  2103. return brcmf_exec_dcmd(ndev, BRCMF_C_SET_VAR, cfg_priv->dcmd_buf,
  2104. buflen);
  2105. }
  2106. static s32
  2107. brcmf_dev_bufvar_get(struct net_device *ndev, s8 *name, s8 *buf,
  2108. s32 buf_len)
  2109. {
  2110. struct brcmf_cfg80211_priv *cfg_priv = ndev_to_cfg(ndev);
  2111. u32 len;
  2112. s32 err = 0;
  2113. len = brcmu_mkiovar(name, NULL, 0, cfg_priv->dcmd_buf,
  2114. WL_DCMD_LEN_MAX);
  2115. BUG_ON(!len);
  2116. err = brcmf_exec_dcmd(ndev, BRCMF_C_GET_VAR, cfg_priv->dcmd_buf,
  2117. WL_DCMD_LEN_MAX);
  2118. if (err) {
  2119. WL_ERR("error (%d)\n", err);
  2120. return err;
  2121. }
  2122. memcpy(buf, cfg_priv->dcmd_buf, buf_len);
  2123. return err;
  2124. }
  2125. static __used s32
  2126. brcmf_update_pmklist(struct net_device *ndev,
  2127. struct brcmf_cfg80211_pmk_list *pmk_list, s32 err)
  2128. {
  2129. int i, j;
  2130. int pmkid_len;
  2131. pmkid_len = le32_to_cpu(pmk_list->pmkids.npmkid);
  2132. WL_CONN("No of elements %d\n", pmkid_len);
  2133. for (i = 0; i < pmkid_len; i++) {
  2134. WL_CONN("PMKID[%d]: %pM =\n", i,
  2135. &pmk_list->pmkids.pmkid[i].BSSID);
  2136. for (j = 0; j < WLAN_PMKID_LEN; j++)
  2137. WL_CONN("%02x\n", pmk_list->pmkids.pmkid[i].PMKID[j]);
  2138. }
  2139. if (!err)
  2140. brcmf_dev_bufvar_set(ndev, "pmkid_info", (char *)pmk_list,
  2141. sizeof(*pmk_list));
  2142. return err;
  2143. }
  2144. static s32
  2145. brcmf_cfg80211_set_pmksa(struct wiphy *wiphy, struct net_device *ndev,
  2146. struct cfg80211_pmksa *pmksa)
  2147. {
  2148. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  2149. struct pmkid_list *pmkids = &cfg_priv->pmk_list->pmkids;
  2150. s32 err = 0;
  2151. int i;
  2152. int pmkid_len;
  2153. WL_TRACE("Enter\n");
  2154. if (!check_sys_up(wiphy))
  2155. return -EIO;
  2156. pmkid_len = le32_to_cpu(pmkids->npmkid);
  2157. for (i = 0; i < pmkid_len; i++)
  2158. if (!memcmp(pmksa->bssid, pmkids->pmkid[i].BSSID, ETH_ALEN))
  2159. break;
  2160. if (i < WL_NUM_PMKIDS_MAX) {
  2161. memcpy(pmkids->pmkid[i].BSSID, pmksa->bssid, ETH_ALEN);
  2162. memcpy(pmkids->pmkid[i].PMKID, pmksa->pmkid, WLAN_PMKID_LEN);
  2163. if (i == pmkid_len) {
  2164. pmkid_len++;
  2165. pmkids->npmkid = cpu_to_le32(pmkid_len);
  2166. }
  2167. } else
  2168. err = -EINVAL;
  2169. WL_CONN("set_pmksa,IW_PMKSA_ADD - PMKID: %pM =\n",
  2170. pmkids->pmkid[pmkid_len].BSSID);
  2171. for (i = 0; i < WLAN_PMKID_LEN; i++)
  2172. WL_CONN("%02x\n", pmkids->pmkid[pmkid_len].PMKID[i]);
  2173. err = brcmf_update_pmklist(ndev, cfg_priv->pmk_list, err);
  2174. WL_TRACE("Exit\n");
  2175. return err;
  2176. }
  2177. static s32
  2178. brcmf_cfg80211_del_pmksa(struct wiphy *wiphy, struct net_device *ndev,
  2179. struct cfg80211_pmksa *pmksa)
  2180. {
  2181. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  2182. struct pmkid_list pmkid;
  2183. s32 err = 0;
  2184. int i, pmkid_len;
  2185. WL_TRACE("Enter\n");
  2186. if (!check_sys_up(wiphy))
  2187. return -EIO;
  2188. memcpy(&pmkid.pmkid[0].BSSID, pmksa->bssid, ETH_ALEN);
  2189. memcpy(&pmkid.pmkid[0].PMKID, pmksa->pmkid, WLAN_PMKID_LEN);
  2190. WL_CONN("del_pmksa,IW_PMKSA_REMOVE - PMKID: %pM =\n",
  2191. &pmkid.pmkid[0].BSSID);
  2192. for (i = 0; i < WLAN_PMKID_LEN; i++)
  2193. WL_CONN("%02x\n", pmkid.pmkid[0].PMKID[i]);
  2194. pmkid_len = le32_to_cpu(cfg_priv->pmk_list->pmkids.npmkid);
  2195. for (i = 0; i < pmkid_len; i++)
  2196. if (!memcmp
  2197. (pmksa->bssid, &cfg_priv->pmk_list->pmkids.pmkid[i].BSSID,
  2198. ETH_ALEN))
  2199. break;
  2200. if ((pmkid_len > 0)
  2201. && (i < pmkid_len)) {
  2202. memset(&cfg_priv->pmk_list->pmkids.pmkid[i], 0,
  2203. sizeof(struct pmkid));
  2204. for (; i < (pmkid_len - 1); i++) {
  2205. memcpy(&cfg_priv->pmk_list->pmkids.pmkid[i].BSSID,
  2206. &cfg_priv->pmk_list->pmkids.pmkid[i + 1].BSSID,
  2207. ETH_ALEN);
  2208. memcpy(&cfg_priv->pmk_list->pmkids.pmkid[i].PMKID,
  2209. &cfg_priv->pmk_list->pmkids.pmkid[i + 1].PMKID,
  2210. WLAN_PMKID_LEN);
  2211. }
  2212. cfg_priv->pmk_list->pmkids.npmkid = cpu_to_le32(pmkid_len - 1);
  2213. } else
  2214. err = -EINVAL;
  2215. err = brcmf_update_pmklist(ndev, cfg_priv->pmk_list, err);
  2216. WL_TRACE("Exit\n");
  2217. return err;
  2218. }
  2219. static s32
  2220. brcmf_cfg80211_flush_pmksa(struct wiphy *wiphy, struct net_device *ndev)
  2221. {
  2222. struct brcmf_cfg80211_priv *cfg_priv = wiphy_to_cfg(wiphy);
  2223. s32 err = 0;
  2224. WL_TRACE("Enter\n");
  2225. if (!check_sys_up(wiphy))
  2226. return -EIO;
  2227. memset(cfg_priv->pmk_list, 0, sizeof(*cfg_priv->pmk_list));
  2228. err = brcmf_update_pmklist(ndev, cfg_priv->pmk_list, err);
  2229. WL_TRACE("Exit\n");
  2230. return err;
  2231. }
  2232. static struct cfg80211_ops wl_cfg80211_ops = {
  2233. .change_virtual_intf = brcmf_cfg80211_change_iface,
  2234. .scan = brcmf_cfg80211_scan,
  2235. .set_wiphy_params = brcmf_cfg80211_set_wiphy_params,
  2236. .join_ibss = brcmf_cfg80211_join_ibss,
  2237. .leave_ibss = brcmf_cfg80211_leave_ibss,
  2238. .get_station = brcmf_cfg80211_get_station,
  2239. .set_tx_power = brcmf_cfg80211_set_tx_power,
  2240. .get_tx_power = brcmf_cfg80211_get_tx_power,
  2241. .add_key = brcmf_cfg80211_add_key,
  2242. .del_key = brcmf_cfg80211_del_key,
  2243. .get_key = brcmf_cfg80211_get_key,
  2244. .set_default_key = brcmf_cfg80211_config_default_key,
  2245. .set_default_mgmt_key = brcmf_cfg80211_config_default_mgmt_key,
  2246. .set_power_mgmt = brcmf_cfg80211_set_power_mgmt,
  2247. .set_bitrate_mask = brcmf_cfg80211_set_bitrate_mask,
  2248. .connect = brcmf_cfg80211_connect,
  2249. .disconnect = brcmf_cfg80211_disconnect,
  2250. .suspend = brcmf_cfg80211_suspend,
  2251. .resume = brcmf_cfg80211_resume,
  2252. .set_pmksa = brcmf_cfg80211_set_pmksa,
  2253. .del_pmksa = brcmf_cfg80211_del_pmksa,
  2254. .flush_pmksa = brcmf_cfg80211_flush_pmksa
  2255. };
  2256. static s32 brcmf_mode_to_nl80211_iftype(s32 mode)
  2257. {
  2258. s32 err = 0;
  2259. switch (mode) {
  2260. case WL_MODE_BSS:
  2261. return NL80211_IFTYPE_STATION;
  2262. case WL_MODE_IBSS:
  2263. return NL80211_IFTYPE_ADHOC;
  2264. default:
  2265. return NL80211_IFTYPE_UNSPECIFIED;
  2266. }
  2267. return err;
  2268. }
  2269. static struct wireless_dev *brcmf_alloc_wdev(s32 sizeof_iface,
  2270. struct device *ndev)
  2271. {
  2272. struct wireless_dev *wdev;
  2273. s32 err = 0;
  2274. wdev = kzalloc(sizeof(*wdev), GFP_KERNEL);
  2275. if (!wdev)
  2276. return ERR_PTR(-ENOMEM);
  2277. wdev->wiphy =
  2278. wiphy_new(&wl_cfg80211_ops,
  2279. sizeof(struct brcmf_cfg80211_priv) + sizeof_iface);
  2280. if (!wdev->wiphy) {
  2281. WL_ERR("Couldn not allocate wiphy device\n");
  2282. err = -ENOMEM;
  2283. goto wiphy_new_out;
  2284. }
  2285. set_wiphy_dev(wdev->wiphy, ndev);
  2286. wdev->wiphy->max_scan_ssids = WL_NUM_SCAN_MAX;
  2287. wdev->wiphy->max_num_pmkids = WL_NUM_PMKIDS_MAX;
  2288. wdev->wiphy->interface_modes =
  2289. BIT(NL80211_IFTYPE_STATION) | BIT(NL80211_IFTYPE_ADHOC);
  2290. wdev->wiphy->bands[IEEE80211_BAND_2GHZ] = &__wl_band_2ghz;
  2291. wdev->wiphy->bands[IEEE80211_BAND_5GHZ] = &__wl_band_5ghz_a; /* Set
  2292. * it as 11a by default.
  2293. * This will be updated with
  2294. * 11n phy tables in
  2295. * "ifconfig up"
  2296. * if phy has 11n capability
  2297. */
  2298. wdev->wiphy->signal_type = CFG80211_SIGNAL_TYPE_MBM;
  2299. wdev->wiphy->cipher_suites = __wl_cipher_suites;
  2300. wdev->wiphy->n_cipher_suites = ARRAY_SIZE(__wl_cipher_suites);
  2301. wdev->wiphy->flags |= WIPHY_FLAG_PS_ON_BY_DEFAULT; /* enable power
  2302. * save mode
  2303. * by default
  2304. */
  2305. err = wiphy_register(wdev->wiphy);
  2306. if (err < 0) {
  2307. WL_ERR("Couldn not register wiphy device (%d)\n", err);
  2308. goto wiphy_register_out;
  2309. }
  2310. return wdev;
  2311. wiphy_register_out:
  2312. wiphy_free(wdev->wiphy);
  2313. wiphy_new_out:
  2314. kfree(wdev);
  2315. return ERR_PTR(err);
  2316. }
  2317. static void brcmf_free_wdev(struct brcmf_cfg80211_priv *cfg_priv)
  2318. {
  2319. struct wireless_dev *wdev = cfg_priv->wdev;
  2320. if (!wdev) {
  2321. WL_ERR("wdev is invalid\n");
  2322. return;
  2323. }
  2324. wiphy_unregister(wdev->wiphy);
  2325. wiphy_free(wdev->wiphy);
  2326. kfree(wdev);
  2327. cfg_priv->wdev = NULL;
  2328. }
  2329. static bool brcmf_is_linkup(struct brcmf_cfg80211_priv *cfg_priv,
  2330. const struct brcmf_event_msg *e)
  2331. {
  2332. u32 event = be32_to_cpu(e->event_type);
  2333. u32 status = be32_to_cpu(e->status);
  2334. if (event == BRCMF_E_SET_SSID && status == BRCMF_E_STATUS_SUCCESS) {
  2335. WL_CONN("Processing set ssid\n");
  2336. cfg_priv->link_up = true;
  2337. return true;
  2338. }
  2339. return false;
  2340. }
  2341. static bool brcmf_is_linkdown(struct brcmf_cfg80211_priv *cfg_priv,
  2342. const struct brcmf_event_msg *e)
  2343. {
  2344. u32 event = be32_to_cpu(e->event_type);
  2345. u16 flags = be16_to_cpu(e->flags);
  2346. if (event == BRCMF_E_LINK && (!(flags & BRCMF_EVENT_MSG_LINK))) {
  2347. WL_CONN("Processing link down\n");
  2348. return true;
  2349. }
  2350. return false;
  2351. }
  2352. static bool brcmf_is_nonetwork(struct brcmf_cfg80211_priv *cfg_priv,
  2353. const struct brcmf_event_msg *e)
  2354. {
  2355. u32 event = be32_to_cpu(e->event_type);
  2356. u32 status = be32_to_cpu(e->status);
  2357. if (event == BRCMF_E_LINK && status == BRCMF_E_STATUS_NO_NETWORKS) {
  2358. WL_CONN("Processing Link %s & no network found\n",
  2359. be16_to_cpu(e->flags) & BRCMF_EVENT_MSG_LINK ?
  2360. "up" : "down");
  2361. return true;
  2362. }
  2363. if (event == BRCMF_E_SET_SSID && status != BRCMF_E_STATUS_SUCCESS) {
  2364. WL_CONN("Processing connecting & no network found\n");
  2365. return true;
  2366. }
  2367. return false;
  2368. }
  2369. static void brcmf_clear_assoc_ies(struct brcmf_cfg80211_priv *cfg_priv)
  2370. {
  2371. struct brcmf_cfg80211_connect_info *conn_info = cfg_to_conn(cfg_priv);
  2372. kfree(conn_info->req_ie);
  2373. conn_info->req_ie = NULL;
  2374. conn_info->req_ie_len = 0;
  2375. kfree(conn_info->resp_ie);
  2376. conn_info->resp_ie = NULL;
  2377. conn_info->resp_ie_len = 0;
  2378. }
  2379. static s32 brcmf_get_assoc_ies(struct brcmf_cfg80211_priv *cfg_priv)
  2380. {
  2381. struct net_device *ndev = cfg_to_ndev(cfg_priv);
  2382. struct brcmf_cfg80211_assoc_ielen *assoc_info;
  2383. struct brcmf_cfg80211_connect_info *conn_info = cfg_to_conn(cfg_priv);
  2384. u32 req_len;
  2385. u32 resp_len;
  2386. s32 err = 0;
  2387. brcmf_clear_assoc_ies(cfg_priv);
  2388. err = brcmf_dev_bufvar_get(ndev, "assoc_info", cfg_priv->extra_buf,
  2389. WL_ASSOC_INFO_MAX);
  2390. if (err) {
  2391. WL_ERR("could not get assoc info (%d)\n", err);
  2392. return err;
  2393. }
  2394. assoc_info = (struct brcmf_cfg80211_assoc_ielen *)cfg_priv->extra_buf;
  2395. req_len = assoc_info->req_len;
  2396. resp_len = assoc_info->resp_len;
  2397. if (req_len) {
  2398. err = brcmf_dev_bufvar_get(ndev, "assoc_req_ies",
  2399. cfg_priv->extra_buf,
  2400. WL_ASSOC_INFO_MAX);
  2401. if (err) {
  2402. WL_ERR("could not get assoc req (%d)\n", err);
  2403. return err;
  2404. }
  2405. conn_info->req_ie_len = req_len;
  2406. conn_info->req_ie =
  2407. kmemdup(cfg_priv->extra_buf, conn_info->req_ie_len,
  2408. GFP_KERNEL);
  2409. } else {
  2410. conn_info->req_ie_len = 0;
  2411. conn_info->req_ie = NULL;
  2412. }
  2413. if (resp_len) {
  2414. err = brcmf_dev_bufvar_get(ndev, "assoc_resp_ies",
  2415. cfg_priv->extra_buf,
  2416. WL_ASSOC_INFO_MAX);
  2417. if (err) {
  2418. WL_ERR("could not get assoc resp (%d)\n", err);
  2419. return err;
  2420. }
  2421. conn_info->resp_ie_len = resp_len;
  2422. conn_info->resp_ie =
  2423. kmemdup(cfg_priv->extra_buf, conn_info->resp_ie_len,
  2424. GFP_KERNEL);
  2425. } else {
  2426. conn_info->resp_ie_len = 0;
  2427. conn_info->resp_ie = NULL;
  2428. }
  2429. WL_CONN("req len (%d) resp len (%d)\n",
  2430. conn_info->req_ie_len, conn_info->resp_ie_len);
  2431. return err;
  2432. }
  2433. static s32
  2434. brcmf_bss_roaming_done(struct brcmf_cfg80211_priv *cfg_priv,
  2435. struct net_device *ndev,
  2436. const struct brcmf_event_msg *e)
  2437. {
  2438. struct brcmf_cfg80211_connect_info *conn_info = cfg_to_conn(cfg_priv);
  2439. struct wiphy *wiphy = cfg_to_wiphy(cfg_priv);
  2440. struct brcmf_channel_info_le channel_le;
  2441. struct ieee80211_channel *notify_channel;
  2442. struct ieee80211_supported_band *band;
  2443. u32 freq;
  2444. s32 err = 0;
  2445. u32 target_channel;
  2446. WL_TRACE("Enter\n");
  2447. brcmf_get_assoc_ies(cfg_priv);
  2448. brcmf_update_prof(cfg_priv, NULL, &e->addr, WL_PROF_BSSID);
  2449. brcmf_update_bss_info(cfg_priv);
  2450. brcmf_exec_dcmd(ndev, BRCMF_C_GET_CHANNEL, &channel_le,
  2451. sizeof(channel_le));
  2452. target_channel = le32_to_cpu(channel_le.target_channel);
  2453. WL_CONN("Roamed to channel %d\n", target_channel);
  2454. if (target_channel <= CH_MAX_2G_CHANNEL)
  2455. band = wiphy->bands[IEEE80211_BAND_2GHZ];
  2456. else
  2457. band = wiphy->bands[IEEE80211_BAND_5GHZ];
  2458. freq = ieee80211_channel_to_frequency(target_channel, band->band);
  2459. notify_channel = ieee80211_get_channel(wiphy, freq);
  2460. cfg80211_roamed(ndev, notify_channel,
  2461. (u8 *)brcmf_read_prof(cfg_priv, WL_PROF_BSSID),
  2462. conn_info->req_ie, conn_info->req_ie_len,
  2463. conn_info->resp_ie, conn_info->resp_ie_len, GFP_KERNEL);
  2464. WL_CONN("Report roaming result\n");
  2465. set_bit(WL_STATUS_CONNECTED, &cfg_priv->status);
  2466. WL_TRACE("Exit\n");
  2467. return err;
  2468. }
  2469. static s32
  2470. brcmf_bss_connect_done(struct brcmf_cfg80211_priv *cfg_priv,
  2471. struct net_device *ndev, const struct brcmf_event_msg *e,
  2472. bool completed)
  2473. {
  2474. struct brcmf_cfg80211_connect_info *conn_info = cfg_to_conn(cfg_priv);
  2475. s32 err = 0;
  2476. WL_TRACE("Enter\n");
  2477. if (test_and_clear_bit(WL_STATUS_CONNECTING, &cfg_priv->status)) {
  2478. if (completed) {
  2479. brcmf_get_assoc_ies(cfg_priv);
  2480. brcmf_update_prof(cfg_priv, NULL, &e->addr,
  2481. WL_PROF_BSSID);
  2482. brcmf_update_bss_info(cfg_priv);
  2483. }
  2484. cfg80211_connect_result(ndev,
  2485. (u8 *)brcmf_read_prof(cfg_priv,
  2486. WL_PROF_BSSID),
  2487. conn_info->req_ie,
  2488. conn_info->req_ie_len,
  2489. conn_info->resp_ie,
  2490. conn_info->resp_ie_len,
  2491. completed ? WLAN_STATUS_SUCCESS :
  2492. WLAN_STATUS_AUTH_TIMEOUT,
  2493. GFP_KERNEL);
  2494. if (completed)
  2495. set_bit(WL_STATUS_CONNECTED, &cfg_priv->status);
  2496. WL_CONN("Report connect result - connection %s\n",
  2497. completed ? "succeeded" : "failed");
  2498. }
  2499. WL_TRACE("Exit\n");
  2500. return err;
  2501. }
  2502. static s32
  2503. brcmf_notify_connect_status(struct brcmf_cfg80211_priv *cfg_priv,
  2504. struct net_device *ndev,
  2505. const struct brcmf_event_msg *e, void *data)
  2506. {
  2507. s32 err = 0;
  2508. if (brcmf_is_linkup(cfg_priv, e)) {
  2509. WL_CONN("Linkup\n");
  2510. if (brcmf_is_ibssmode(cfg_priv)) {
  2511. brcmf_update_prof(cfg_priv, NULL, (void *)e->addr,
  2512. WL_PROF_BSSID);
  2513. wl_inform_ibss(cfg_priv, ndev, e->addr);
  2514. cfg80211_ibss_joined(ndev, e->addr, GFP_KERNEL);
  2515. clear_bit(WL_STATUS_CONNECTING, &cfg_priv->status);
  2516. set_bit(WL_STATUS_CONNECTED, &cfg_priv->status);
  2517. } else
  2518. brcmf_bss_connect_done(cfg_priv, ndev, e, true);
  2519. } else if (brcmf_is_linkdown(cfg_priv, e)) {
  2520. WL_CONN("Linkdown\n");
  2521. if (brcmf_is_ibssmode(cfg_priv)) {
  2522. clear_bit(WL_STATUS_CONNECTING, &cfg_priv->status);
  2523. if (test_and_clear_bit(WL_STATUS_CONNECTED,
  2524. &cfg_priv->status))
  2525. brcmf_link_down(cfg_priv);
  2526. } else {
  2527. brcmf_bss_connect_done(cfg_priv, ndev, e, false);
  2528. if (test_and_clear_bit(WL_STATUS_CONNECTED,
  2529. &cfg_priv->status)) {
  2530. cfg80211_disconnected(ndev, 0, NULL, 0,
  2531. GFP_KERNEL);
  2532. brcmf_link_down(cfg_priv);
  2533. }
  2534. }
  2535. brcmf_init_prof(cfg_priv->profile);
  2536. } else if (brcmf_is_nonetwork(cfg_priv, e)) {
  2537. if (brcmf_is_ibssmode(cfg_priv))
  2538. clear_bit(WL_STATUS_CONNECTING, &cfg_priv->status);
  2539. else
  2540. brcmf_bss_connect_done(cfg_priv, ndev, e, false);
  2541. }
  2542. return err;
  2543. }
  2544. static s32
  2545. brcmf_notify_roaming_status(struct brcmf_cfg80211_priv *cfg_priv,
  2546. struct net_device *ndev,
  2547. const struct brcmf_event_msg *e, void *data)
  2548. {
  2549. s32 err = 0;
  2550. u32 event = be32_to_cpu(e->event_type);
  2551. u32 status = be32_to_cpu(e->status);
  2552. if (event == BRCMF_E_ROAM && status == BRCMF_E_STATUS_SUCCESS) {
  2553. if (test_bit(WL_STATUS_CONNECTED, &cfg_priv->status))
  2554. brcmf_bss_roaming_done(cfg_priv, ndev, e);
  2555. else
  2556. brcmf_bss_connect_done(cfg_priv, ndev, e, true);
  2557. }
  2558. return err;
  2559. }
  2560. static s32
  2561. brcmf_notify_mic_status(struct brcmf_cfg80211_priv *cfg_priv,
  2562. struct net_device *ndev,
  2563. const struct brcmf_event_msg *e, void *data)
  2564. {
  2565. u16 flags = be16_to_cpu(e->flags);
  2566. enum nl80211_key_type key_type;
  2567. if (flags & BRCMF_EVENT_MSG_GROUP)
  2568. key_type = NL80211_KEYTYPE_GROUP;
  2569. else
  2570. key_type = NL80211_KEYTYPE_PAIRWISE;
  2571. cfg80211_michael_mic_failure(ndev, (u8 *)&e->addr, key_type, -1,
  2572. NULL, GFP_KERNEL);
  2573. return 0;
  2574. }
  2575. static s32
  2576. brcmf_notify_scan_status(struct brcmf_cfg80211_priv *cfg_priv,
  2577. struct net_device *ndev,
  2578. const struct brcmf_event_msg *e, void *data)
  2579. {
  2580. struct brcmf_channel_info_le channel_inform_le;
  2581. struct brcmf_scan_results_le *bss_list_le;
  2582. u32 len = WL_SCAN_BUF_MAX;
  2583. s32 err = 0;
  2584. bool scan_abort = false;
  2585. u32 scan_channel;
  2586. WL_TRACE("Enter\n");
  2587. if (cfg_priv->iscan_on && cfg_priv->iscan_kickstart) {
  2588. WL_TRACE("Exit\n");
  2589. return brcmf_wakeup_iscan(cfg_to_iscan(cfg_priv));
  2590. }
  2591. if (!test_and_clear_bit(WL_STATUS_SCANNING, &cfg_priv->status)) {
  2592. WL_ERR("Scan complete while device not scanning\n");
  2593. scan_abort = true;
  2594. err = -EINVAL;
  2595. goto scan_done_out;
  2596. }
  2597. err = brcmf_exec_dcmd(ndev, BRCMF_C_GET_CHANNEL, &channel_inform_le,
  2598. sizeof(channel_inform_le));
  2599. if (err) {
  2600. WL_ERR("scan busy (%d)\n", err);
  2601. scan_abort = true;
  2602. goto scan_done_out;
  2603. }
  2604. scan_channel = le32_to_cpu(channel_inform_le.scan_channel);
  2605. if (scan_channel)
  2606. WL_CONN("channel_inform.scan_channel (%d)\n", scan_channel);
  2607. cfg_priv->bss_list = cfg_priv->scan_results;
  2608. bss_list_le = (struct brcmf_scan_results_le *) cfg_priv->bss_list;
  2609. memset(cfg_priv->scan_results, 0, len);
  2610. bss_list_le->buflen = cpu_to_le32(len);
  2611. err = brcmf_exec_dcmd(ndev, BRCMF_C_SCAN_RESULTS,
  2612. cfg_priv->scan_results, len);
  2613. if (err) {
  2614. WL_ERR("%s Scan_results error (%d)\n", ndev->name, err);
  2615. err = -EINVAL;
  2616. scan_abort = true;
  2617. goto scan_done_out;
  2618. }
  2619. cfg_priv->scan_results->buflen = le32_to_cpu(bss_list_le->buflen);
  2620. cfg_priv->scan_results->version = le32_to_cpu(bss_list_le->version);
  2621. cfg_priv->scan_results->count = le32_to_cpu(bss_list_le->count);
  2622. err = brcmf_inform_bss(cfg_priv);
  2623. if (err) {
  2624. scan_abort = true;
  2625. goto scan_done_out;
  2626. }
  2627. scan_done_out:
  2628. if (cfg_priv->scan_request) {
  2629. WL_SCAN("calling cfg80211_scan_done\n");
  2630. cfg80211_scan_done(cfg_priv->scan_request, scan_abort);
  2631. brcmf_set_mpc(ndev, 1);
  2632. cfg_priv->scan_request = NULL;
  2633. }
  2634. WL_TRACE("Exit\n");
  2635. return err;
  2636. }
  2637. static void brcmf_init_conf(struct brcmf_cfg80211_conf *conf)
  2638. {
  2639. conf->mode = (u32)-1;
  2640. conf->frag_threshold = (u32)-1;
  2641. conf->rts_threshold = (u32)-1;
  2642. conf->retry_short = (u32)-1;
  2643. conf->retry_long = (u32)-1;
  2644. conf->tx_power = -1;
  2645. }
  2646. static void brcmf_init_eloop_handler(struct brcmf_cfg80211_event_loop *el)
  2647. {
  2648. memset(el, 0, sizeof(*el));
  2649. el->handler[BRCMF_E_SCAN_COMPLETE] = brcmf_notify_scan_status;
  2650. el->handler[BRCMF_E_LINK] = brcmf_notify_connect_status;
  2651. el->handler[BRCMF_E_ROAM] = brcmf_notify_roaming_status;
  2652. el->handler[BRCMF_E_MIC_ERROR] = brcmf_notify_mic_status;
  2653. el->handler[BRCMF_E_SET_SSID] = brcmf_notify_connect_status;
  2654. }
  2655. static void brcmf_deinit_priv_mem(struct brcmf_cfg80211_priv *cfg_priv)
  2656. {
  2657. kfree(cfg_priv->scan_results);
  2658. cfg_priv->scan_results = NULL;
  2659. kfree(cfg_priv->bss_info);
  2660. cfg_priv->bss_info = NULL;
  2661. kfree(cfg_priv->conf);
  2662. cfg_priv->conf = NULL;
  2663. kfree(cfg_priv->profile);
  2664. cfg_priv->profile = NULL;
  2665. kfree(cfg_priv->scan_req_int);
  2666. cfg_priv->scan_req_int = NULL;
  2667. kfree(cfg_priv->dcmd_buf);
  2668. cfg_priv->dcmd_buf = NULL;
  2669. kfree(cfg_priv->extra_buf);
  2670. cfg_priv->extra_buf = NULL;
  2671. kfree(cfg_priv->iscan);
  2672. cfg_priv->iscan = NULL;
  2673. kfree(cfg_priv->pmk_list);
  2674. cfg_priv->pmk_list = NULL;
  2675. }
  2676. static s32 brcmf_init_priv_mem(struct brcmf_cfg80211_priv *cfg_priv)
  2677. {
  2678. cfg_priv->scan_results = kzalloc(WL_SCAN_BUF_MAX, GFP_KERNEL);
  2679. if (!cfg_priv->scan_results)
  2680. goto init_priv_mem_out;
  2681. cfg_priv->conf = kzalloc(sizeof(*cfg_priv->conf), GFP_KERNEL);
  2682. if (!cfg_priv->conf)
  2683. goto init_priv_mem_out;
  2684. cfg_priv->profile = kzalloc(sizeof(*cfg_priv->profile), GFP_KERNEL);
  2685. if (!cfg_priv->profile)
  2686. goto init_priv_mem_out;
  2687. cfg_priv->bss_info = kzalloc(WL_BSS_INFO_MAX, GFP_KERNEL);
  2688. if (!cfg_priv->bss_info)
  2689. goto init_priv_mem_out;
  2690. cfg_priv->scan_req_int = kzalloc(sizeof(*cfg_priv->scan_req_int),
  2691. GFP_KERNEL);
  2692. if (!cfg_priv->scan_req_int)
  2693. goto init_priv_mem_out;
  2694. cfg_priv->dcmd_buf = kzalloc(WL_DCMD_LEN_MAX, GFP_KERNEL);
  2695. if (!cfg_priv->dcmd_buf)
  2696. goto init_priv_mem_out;
  2697. cfg_priv->extra_buf = kzalloc(WL_EXTRA_BUF_MAX, GFP_KERNEL);
  2698. if (!cfg_priv->extra_buf)
  2699. goto init_priv_mem_out;
  2700. cfg_priv->iscan = kzalloc(sizeof(*cfg_priv->iscan), GFP_KERNEL);
  2701. if (!cfg_priv->iscan)
  2702. goto init_priv_mem_out;
  2703. cfg_priv->pmk_list = kzalloc(sizeof(*cfg_priv->pmk_list), GFP_KERNEL);
  2704. if (!cfg_priv->pmk_list)
  2705. goto init_priv_mem_out;
  2706. return 0;
  2707. init_priv_mem_out:
  2708. brcmf_deinit_priv_mem(cfg_priv);
  2709. return -ENOMEM;
  2710. }
  2711. /*
  2712. * retrieve first queued event from head
  2713. */
  2714. static struct brcmf_cfg80211_event_q *brcmf_deq_event(
  2715. struct brcmf_cfg80211_priv *cfg_priv)
  2716. {
  2717. struct brcmf_cfg80211_event_q *e = NULL;
  2718. spin_lock_irq(&cfg_priv->evt_q_lock);
  2719. if (!list_empty(&cfg_priv->evt_q_list)) {
  2720. e = list_first_entry(&cfg_priv->evt_q_list,
  2721. struct brcmf_cfg80211_event_q, evt_q_list);
  2722. list_del(&e->evt_q_list);
  2723. }
  2724. spin_unlock_irq(&cfg_priv->evt_q_lock);
  2725. return e;
  2726. }
  2727. /*
  2728. ** push event to tail of the queue
  2729. */
  2730. static s32
  2731. brcmf_enq_event(struct brcmf_cfg80211_priv *cfg_priv, u32 event,
  2732. const struct brcmf_event_msg *msg)
  2733. {
  2734. struct brcmf_cfg80211_event_q *e;
  2735. s32 err = 0;
  2736. e = kzalloc(sizeof(struct brcmf_cfg80211_event_q), GFP_KERNEL);
  2737. if (!e)
  2738. return -ENOMEM;
  2739. e->etype = event;
  2740. memcpy(&e->emsg, msg, sizeof(struct brcmf_event_msg));
  2741. spin_lock_irq(&cfg_priv->evt_q_lock);
  2742. list_add_tail(&e->evt_q_list, &cfg_priv->evt_q_list);
  2743. spin_unlock_irq(&cfg_priv->evt_q_lock);
  2744. return err;
  2745. }
  2746. static void brcmf_put_event(struct brcmf_cfg80211_event_q *e)
  2747. {
  2748. kfree(e);
  2749. }
  2750. static void brcmf_cfg80211_event_handler(struct work_struct *work)
  2751. {
  2752. struct brcmf_cfg80211_priv *cfg_priv =
  2753. container_of(work, struct brcmf_cfg80211_priv,
  2754. event_work);
  2755. struct brcmf_cfg80211_event_q *e;
  2756. e = brcmf_deq_event(cfg_priv);
  2757. if (unlikely(!e)) {
  2758. WL_ERR("event queue empty...\n");
  2759. return;
  2760. }
  2761. do {
  2762. WL_INFO("event type (%d)\n", e->etype);
  2763. if (cfg_priv->el.handler[e->etype])
  2764. cfg_priv->el.handler[e->etype](cfg_priv,
  2765. cfg_to_ndev(cfg_priv),
  2766. &e->emsg, e->edata);
  2767. else
  2768. WL_INFO("Unknown Event (%d): ignoring\n", e->etype);
  2769. brcmf_put_event(e);
  2770. } while ((e = brcmf_deq_event(cfg_priv)));
  2771. }
  2772. static void brcmf_init_eq(struct brcmf_cfg80211_priv *cfg_priv)
  2773. {
  2774. spin_lock_init(&cfg_priv->evt_q_lock);
  2775. INIT_LIST_HEAD(&cfg_priv->evt_q_list);
  2776. }
  2777. static void brcmf_flush_eq(struct brcmf_cfg80211_priv *cfg_priv)
  2778. {
  2779. struct brcmf_cfg80211_event_q *e;
  2780. spin_lock_irq(&cfg_priv->evt_q_lock);
  2781. while (!list_empty(&cfg_priv->evt_q_list)) {
  2782. e = list_first_entry(&cfg_priv->evt_q_list,
  2783. struct brcmf_cfg80211_event_q, evt_q_list);
  2784. list_del(&e->evt_q_list);
  2785. kfree(e);
  2786. }
  2787. spin_unlock_irq(&cfg_priv->evt_q_lock);
  2788. }
  2789. static s32 wl_init_priv(struct brcmf_cfg80211_priv *cfg_priv)
  2790. {
  2791. s32 err = 0;
  2792. cfg_priv->scan_request = NULL;
  2793. cfg_priv->pwr_save = true;
  2794. cfg_priv->iscan_on = true; /* iscan on & off switch.
  2795. we enable iscan per default */
  2796. cfg_priv->roam_on = true; /* roam on & off switch.
  2797. we enable roam per default */
  2798. cfg_priv->iscan_kickstart = false;
  2799. cfg_priv->active_scan = true; /* we do active scan for
  2800. specific scan per default */
  2801. cfg_priv->dongle_up = false; /* dongle is not up yet */
  2802. brcmf_init_eq(cfg_priv);
  2803. err = brcmf_init_priv_mem(cfg_priv);
  2804. if (err)
  2805. return err;
  2806. INIT_WORK(&cfg_priv->event_work, brcmf_cfg80211_event_handler);
  2807. brcmf_init_eloop_handler(&cfg_priv->el);
  2808. mutex_init(&cfg_priv->usr_sync);
  2809. err = brcmf_init_iscan(cfg_priv);
  2810. if (err)
  2811. return err;
  2812. brcmf_init_conf(cfg_priv->conf);
  2813. brcmf_init_prof(cfg_priv->profile);
  2814. brcmf_link_down(cfg_priv);
  2815. return err;
  2816. }
  2817. static void wl_deinit_priv(struct brcmf_cfg80211_priv *cfg_priv)
  2818. {
  2819. cancel_work_sync(&cfg_priv->event_work);
  2820. cfg_priv->dongle_up = false; /* dongle down */
  2821. brcmf_flush_eq(cfg_priv);
  2822. brcmf_link_down(cfg_priv);
  2823. brcmf_term_iscan(cfg_priv);
  2824. brcmf_deinit_priv_mem(cfg_priv);
  2825. }
  2826. struct brcmf_cfg80211_dev *brcmf_cfg80211_attach(struct net_device *ndev,
  2827. struct device *busdev,
  2828. void *data)
  2829. {
  2830. struct wireless_dev *wdev;
  2831. struct brcmf_cfg80211_priv *cfg_priv;
  2832. struct brcmf_cfg80211_iface *ci;
  2833. struct brcmf_cfg80211_dev *cfg_dev;
  2834. s32 err = 0;
  2835. if (!ndev) {
  2836. WL_ERR("ndev is invalid\n");
  2837. return NULL;
  2838. }
  2839. cfg_dev = kzalloc(sizeof(struct brcmf_cfg80211_dev), GFP_KERNEL);
  2840. if (!cfg_dev)
  2841. return NULL;
  2842. wdev = brcmf_alloc_wdev(sizeof(struct brcmf_cfg80211_iface), busdev);
  2843. if (IS_ERR(wdev)) {
  2844. kfree(cfg_dev);
  2845. return NULL;
  2846. }
  2847. wdev->iftype = brcmf_mode_to_nl80211_iftype(WL_MODE_BSS);
  2848. cfg_priv = wdev_to_cfg(wdev);
  2849. cfg_priv->wdev = wdev;
  2850. cfg_priv->pub = data;
  2851. ci = (struct brcmf_cfg80211_iface *)&cfg_priv->ci;
  2852. ci->cfg_priv = cfg_priv;
  2853. ndev->ieee80211_ptr = wdev;
  2854. SET_NETDEV_DEV(ndev, wiphy_dev(wdev->wiphy));
  2855. wdev->netdev = ndev;
  2856. err = wl_init_priv(cfg_priv);
  2857. if (err) {
  2858. WL_ERR("Failed to init iwm_priv (%d)\n", err);
  2859. goto cfg80211_attach_out;
  2860. }
  2861. brcmf_set_drvdata(cfg_dev, ci);
  2862. return cfg_dev;
  2863. cfg80211_attach_out:
  2864. brcmf_free_wdev(cfg_priv);
  2865. kfree(cfg_dev);
  2866. return NULL;
  2867. }
  2868. void brcmf_cfg80211_detach(struct brcmf_cfg80211_dev *cfg_dev)
  2869. {
  2870. struct brcmf_cfg80211_priv *cfg_priv;
  2871. cfg_priv = brcmf_priv_get(cfg_dev);
  2872. wl_deinit_priv(cfg_priv);
  2873. brcmf_free_wdev(cfg_priv);
  2874. brcmf_set_drvdata(cfg_dev, NULL);
  2875. kfree(cfg_dev);
  2876. }
  2877. void
  2878. brcmf_cfg80211_event(struct net_device *ndev,
  2879. const struct brcmf_event_msg *e, void *data)
  2880. {
  2881. u32 event_type = be32_to_cpu(e->event_type);
  2882. struct brcmf_cfg80211_priv *cfg_priv = ndev_to_cfg(ndev);
  2883. if (!brcmf_enq_event(cfg_priv, event_type, e))
  2884. schedule_work(&cfg_priv->event_work);
  2885. }
  2886. static s32 brcmf_dongle_mode(struct net_device *ndev, s32 iftype)
  2887. {
  2888. s32 infra = 0;
  2889. s32 err = 0;
  2890. switch (iftype) {
  2891. case NL80211_IFTYPE_MONITOR:
  2892. case NL80211_IFTYPE_WDS:
  2893. WL_ERR("type (%d) : currently we do not support this mode\n",
  2894. iftype);
  2895. err = -EINVAL;
  2896. return err;
  2897. case NL80211_IFTYPE_ADHOC:
  2898. infra = 0;
  2899. break;
  2900. case NL80211_IFTYPE_STATION:
  2901. infra = 1;
  2902. break;
  2903. default:
  2904. err = -EINVAL;
  2905. WL_ERR("invalid type (%d)\n", iftype);
  2906. return err;
  2907. }
  2908. err = brcmf_exec_dcmd_u32(ndev, BRCMF_C_SET_INFRA, &infra);
  2909. if (err) {
  2910. WL_ERR("WLC_SET_INFRA error (%d)\n", err);
  2911. return err;
  2912. }
  2913. return 0;
  2914. }
  2915. static s32 brcmf_dongle_eventmsg(struct net_device *ndev)
  2916. {
  2917. /* Room for "event_msgs" + '\0' + bitvec */
  2918. s8 iovbuf[BRCMF_EVENTING_MASK_LEN + 12];
  2919. s8 eventmask[BRCMF_EVENTING_MASK_LEN];
  2920. s32 err = 0;
  2921. WL_TRACE("Enter\n");
  2922. /* Setup event_msgs */
  2923. brcmu_mkiovar("event_msgs", eventmask, BRCMF_EVENTING_MASK_LEN, iovbuf,
  2924. sizeof(iovbuf));
  2925. err = brcmf_exec_dcmd(ndev, BRCMF_C_GET_VAR, iovbuf, sizeof(iovbuf));
  2926. if (err) {
  2927. WL_ERR("Get event_msgs error (%d)\n", err);
  2928. goto dongle_eventmsg_out;
  2929. }
  2930. memcpy(eventmask, iovbuf, BRCMF_EVENTING_MASK_LEN);
  2931. setbit(eventmask, BRCMF_E_SET_SSID);
  2932. setbit(eventmask, BRCMF_E_ROAM);
  2933. setbit(eventmask, BRCMF_E_PRUNE);
  2934. setbit(eventmask, BRCMF_E_AUTH);
  2935. setbit(eventmask, BRCMF_E_REASSOC);
  2936. setbit(eventmask, BRCMF_E_REASSOC_IND);
  2937. setbit(eventmask, BRCMF_E_DEAUTH_IND);
  2938. setbit(eventmask, BRCMF_E_DISASSOC_IND);
  2939. setbit(eventmask, BRCMF_E_DISASSOC);
  2940. setbit(eventmask, BRCMF_E_JOIN);
  2941. setbit(eventmask, BRCMF_E_ASSOC_IND);
  2942. setbit(eventmask, BRCMF_E_PSK_SUP);
  2943. setbit(eventmask, BRCMF_E_LINK);
  2944. setbit(eventmask, BRCMF_E_NDIS_LINK);
  2945. setbit(eventmask, BRCMF_E_MIC_ERROR);
  2946. setbit(eventmask, BRCMF_E_PMKID_CACHE);
  2947. setbit(eventmask, BRCMF_E_TXFAIL);
  2948. setbit(eventmask, BRCMF_E_JOIN_START);
  2949. setbit(eventmask, BRCMF_E_SCAN_COMPLETE);
  2950. brcmu_mkiovar("event_msgs", eventmask, BRCMF_EVENTING_MASK_LEN, iovbuf,
  2951. sizeof(iovbuf));
  2952. err = brcmf_exec_dcmd(ndev, BRCMF_C_SET_VAR, iovbuf, sizeof(iovbuf));
  2953. if (err) {
  2954. WL_ERR("Set event_msgs error (%d)\n", err);
  2955. goto dongle_eventmsg_out;
  2956. }
  2957. dongle_eventmsg_out:
  2958. WL_TRACE("Exit\n");
  2959. return err;
  2960. }
  2961. static s32
  2962. brcmf_dongle_roam(struct net_device *ndev, u32 roamvar, u32 bcn_timeout)
  2963. {
  2964. s8 iovbuf[32];
  2965. s32 roamtrigger[2];
  2966. s32 roam_delta[2];
  2967. s32 err = 0;
  2968. /*
  2969. * Setup timeout if Beacons are lost and roam is
  2970. * off to report link down
  2971. */
  2972. if (roamvar) {
  2973. brcmu_mkiovar("bcn_timeout", (char *)&bcn_timeout,
  2974. sizeof(bcn_timeout), iovbuf, sizeof(iovbuf));
  2975. err = brcmf_exec_dcmd(ndev, BRCMF_C_SET_VAR,
  2976. iovbuf, sizeof(iovbuf));
  2977. if (err) {
  2978. WL_ERR("bcn_timeout error (%d)\n", err);
  2979. goto dongle_rom_out;
  2980. }
  2981. }
  2982. /*
  2983. * Enable/Disable built-in roaming to allow supplicant
  2984. * to take care of roaming
  2985. */
  2986. WL_INFO("Internal Roaming = %s\n", roamvar ? "Off" : "On");
  2987. brcmu_mkiovar("roam_off", (char *)&roamvar,
  2988. sizeof(roamvar), iovbuf, sizeof(iovbuf));
  2989. err = brcmf_exec_dcmd(ndev, BRCMF_C_SET_VAR, iovbuf, sizeof(iovbuf));
  2990. if (err) {
  2991. WL_ERR("roam_off error (%d)\n", err);
  2992. goto dongle_rom_out;
  2993. }
  2994. roamtrigger[0] = WL_ROAM_TRIGGER_LEVEL;
  2995. roamtrigger[1] = BRCM_BAND_ALL;
  2996. err = brcmf_exec_dcmd(ndev, BRCMF_C_SET_ROAM_TRIGGER,
  2997. (void *)roamtrigger, sizeof(roamtrigger));
  2998. if (err) {
  2999. WL_ERR("WLC_SET_ROAM_TRIGGER error (%d)\n", err);
  3000. goto dongle_rom_out;
  3001. }
  3002. roam_delta[0] = WL_ROAM_DELTA;
  3003. roam_delta[1] = BRCM_BAND_ALL;
  3004. err = brcmf_exec_dcmd(ndev, BRCMF_C_SET_ROAM_DELTA,
  3005. (void *)roam_delta, sizeof(roam_delta));
  3006. if (err) {
  3007. WL_ERR("WLC_SET_ROAM_DELTA error (%d)\n", err);
  3008. goto dongle_rom_out;
  3009. }
  3010. dongle_rom_out:
  3011. return err;
  3012. }
  3013. static s32
  3014. brcmf_dongle_scantime(struct net_device *ndev, s32 scan_assoc_time,
  3015. s32 scan_unassoc_time, s32 scan_passive_time)
  3016. {
  3017. s32 err = 0;
  3018. err = brcmf_exec_dcmd(ndev, BRCMF_C_SET_SCAN_CHANNEL_TIME,
  3019. &scan_assoc_time, sizeof(scan_assoc_time));
  3020. if (err) {
  3021. if (err == -EOPNOTSUPP)
  3022. WL_INFO("Scan assoc time is not supported\n");
  3023. else
  3024. WL_ERR("Scan assoc time error (%d)\n", err);
  3025. goto dongle_scantime_out;
  3026. }
  3027. err = brcmf_exec_dcmd(ndev, BRCMF_C_SET_SCAN_UNASSOC_TIME,
  3028. &scan_unassoc_time, sizeof(scan_unassoc_time));
  3029. if (err) {
  3030. if (err == -EOPNOTSUPP)
  3031. WL_INFO("Scan unassoc time is not supported\n");
  3032. else
  3033. WL_ERR("Scan unassoc time error (%d)\n", err);
  3034. goto dongle_scantime_out;
  3035. }
  3036. err = brcmf_exec_dcmd(ndev, BRCMF_C_SET_SCAN_PASSIVE_TIME,
  3037. &scan_passive_time, sizeof(scan_passive_time));
  3038. if (err) {
  3039. if (err == -EOPNOTSUPP)
  3040. WL_INFO("Scan passive time is not supported\n");
  3041. else
  3042. WL_ERR("Scan passive time error (%d)\n", err);
  3043. goto dongle_scantime_out;
  3044. }
  3045. dongle_scantime_out:
  3046. return err;
  3047. }
  3048. static s32 wl_update_wiphybands(struct brcmf_cfg80211_priv *cfg_priv)
  3049. {
  3050. struct wiphy *wiphy;
  3051. s32 phy_list;
  3052. s8 phy;
  3053. s32 err = 0;
  3054. err = brcmf_exec_dcmd(cfg_to_ndev(cfg_priv), BRCM_GET_PHYLIST,
  3055. &phy_list, sizeof(phy_list));
  3056. if (err) {
  3057. WL_ERR("error (%d)\n", err);
  3058. return err;
  3059. }
  3060. phy = ((char *)&phy_list)[1];
  3061. WL_INFO("%c phy\n", phy);
  3062. if (phy == 'n' || phy == 'a') {
  3063. wiphy = cfg_to_wiphy(cfg_priv);
  3064. wiphy->bands[IEEE80211_BAND_5GHZ] = &__wl_band_5ghz_n;
  3065. }
  3066. return err;
  3067. }
  3068. static s32 brcmf_dongle_probecap(struct brcmf_cfg80211_priv *cfg_priv)
  3069. {
  3070. return wl_update_wiphybands(cfg_priv);
  3071. }
  3072. static s32 brcmf_config_dongle(struct brcmf_cfg80211_priv *cfg_priv)
  3073. {
  3074. struct net_device *ndev;
  3075. struct wireless_dev *wdev;
  3076. s32 power_mode;
  3077. s32 err = 0;
  3078. if (cfg_priv->dongle_up)
  3079. return err;
  3080. ndev = cfg_to_ndev(cfg_priv);
  3081. wdev = ndev->ieee80211_ptr;
  3082. brcmf_dongle_scantime(ndev, WL_SCAN_CHANNEL_TIME,
  3083. WL_SCAN_UNASSOC_TIME, WL_SCAN_PASSIVE_TIME);
  3084. err = brcmf_dongle_eventmsg(ndev);
  3085. if (err)
  3086. goto default_conf_out;
  3087. power_mode = cfg_priv->pwr_save ? PM_FAST : PM_OFF;
  3088. err = brcmf_exec_dcmd_u32(ndev, BRCMF_C_SET_PM, &power_mode);
  3089. if (err)
  3090. goto default_conf_out;
  3091. WL_INFO("power save set to %s\n",
  3092. (power_mode ? "enabled" : "disabled"));
  3093. err = brcmf_dongle_roam(ndev, (cfg_priv->roam_on ? 0 : 1),
  3094. WL_BEACON_TIMEOUT);
  3095. if (err)
  3096. goto default_conf_out;
  3097. err = brcmf_dongle_mode(ndev, wdev->iftype);
  3098. if (err && err != -EINPROGRESS)
  3099. goto default_conf_out;
  3100. err = brcmf_dongle_probecap(cfg_priv);
  3101. if (err)
  3102. goto default_conf_out;
  3103. /* -EINPROGRESS: Call commit handler */
  3104. default_conf_out:
  3105. cfg_priv->dongle_up = true;
  3106. return err;
  3107. }
  3108. static int brcmf_debugfs_add_netdev_params(struct brcmf_cfg80211_priv *cfg_priv)
  3109. {
  3110. char buf[10+IFNAMSIZ];
  3111. struct dentry *fd;
  3112. s32 err = 0;
  3113. sprintf(buf, "netdev:%s", cfg_to_ndev(cfg_priv)->name);
  3114. cfg_priv->debugfsdir = debugfs_create_dir(buf,
  3115. cfg_to_wiphy(cfg_priv)->debugfsdir);
  3116. fd = debugfs_create_u16("beacon_int", S_IRUGO, cfg_priv->debugfsdir,
  3117. (u16 *)&cfg_priv->profile->beacon_interval);
  3118. if (!fd) {
  3119. err = -ENOMEM;
  3120. goto err_out;
  3121. }
  3122. fd = debugfs_create_u8("dtim_period", S_IRUGO, cfg_priv->debugfsdir,
  3123. (u8 *)&cfg_priv->profile->dtim_period);
  3124. if (!fd) {
  3125. err = -ENOMEM;
  3126. goto err_out;
  3127. }
  3128. err_out:
  3129. return err;
  3130. }
  3131. static void brcmf_debugfs_remove_netdev(struct brcmf_cfg80211_priv *cfg_priv)
  3132. {
  3133. debugfs_remove_recursive(cfg_priv->debugfsdir);
  3134. cfg_priv->debugfsdir = NULL;
  3135. }
  3136. static s32 __brcmf_cfg80211_up(struct brcmf_cfg80211_priv *cfg_priv)
  3137. {
  3138. s32 err = 0;
  3139. set_bit(WL_STATUS_READY, &cfg_priv->status);
  3140. brcmf_debugfs_add_netdev_params(cfg_priv);
  3141. err = brcmf_config_dongle(cfg_priv);
  3142. if (err)
  3143. return err;
  3144. brcmf_invoke_iscan(cfg_priv);
  3145. return err;
  3146. }
  3147. static s32 __brcmf_cfg80211_down(struct brcmf_cfg80211_priv *cfg_priv)
  3148. {
  3149. /*
  3150. * While going down, if associated with AP disassociate
  3151. * from AP to save power
  3152. */
  3153. if ((test_bit(WL_STATUS_CONNECTED, &cfg_priv->status) ||
  3154. test_bit(WL_STATUS_CONNECTING, &cfg_priv->status)) &&
  3155. test_bit(WL_STATUS_READY, &cfg_priv->status)) {
  3156. WL_INFO("Disassociating from AP");
  3157. brcmf_link_down(cfg_priv);
  3158. /* Make sure WPA_Supplicant receives all the event
  3159. generated due to DISASSOC call to the fw to keep
  3160. the state fw and WPA_Supplicant state consistent
  3161. */
  3162. brcmf_delay(500);
  3163. }
  3164. set_bit(WL_STATUS_SCAN_ABORTING, &cfg_priv->status);
  3165. brcmf_term_iscan(cfg_priv);
  3166. if (cfg_priv->scan_request) {
  3167. cfg80211_scan_done(cfg_priv->scan_request, true);
  3168. /* May need to perform this to cover rmmod */
  3169. /* wl_set_mpc(cfg_to_ndev(wl), 1); */
  3170. cfg_priv->scan_request = NULL;
  3171. }
  3172. clear_bit(WL_STATUS_READY, &cfg_priv->status);
  3173. clear_bit(WL_STATUS_SCANNING, &cfg_priv->status);
  3174. clear_bit(WL_STATUS_SCAN_ABORTING, &cfg_priv->status);
  3175. brcmf_debugfs_remove_netdev(cfg_priv);
  3176. return 0;
  3177. }
  3178. s32 brcmf_cfg80211_up(struct brcmf_cfg80211_dev *cfg_dev)
  3179. {
  3180. struct brcmf_cfg80211_priv *cfg_priv;
  3181. s32 err = 0;
  3182. cfg_priv = brcmf_priv_get(cfg_dev);
  3183. mutex_lock(&cfg_priv->usr_sync);
  3184. err = __brcmf_cfg80211_up(cfg_priv);
  3185. mutex_unlock(&cfg_priv->usr_sync);
  3186. return err;
  3187. }
  3188. s32 brcmf_cfg80211_down(struct brcmf_cfg80211_dev *cfg_dev)
  3189. {
  3190. struct brcmf_cfg80211_priv *cfg_priv;
  3191. s32 err = 0;
  3192. cfg_priv = brcmf_priv_get(cfg_dev);
  3193. mutex_lock(&cfg_priv->usr_sync);
  3194. err = __brcmf_cfg80211_down(cfg_priv);
  3195. mutex_unlock(&cfg_priv->usr_sync);
  3196. return err;
  3197. }
  3198. static __used s32 brcmf_add_ie(struct brcmf_cfg80211_priv *cfg_priv,
  3199. u8 t, u8 l, u8 *v)
  3200. {
  3201. struct brcmf_cfg80211_ie *ie = &cfg_priv->ie;
  3202. s32 err = 0;
  3203. if (ie->offset + l + 2 > WL_TLV_INFO_MAX) {
  3204. WL_ERR("ei crosses buffer boundary\n");
  3205. return -ENOSPC;
  3206. }
  3207. ie->buf[ie->offset] = t;
  3208. ie->buf[ie->offset + 1] = l;
  3209. memcpy(&ie->buf[ie->offset + 2], v, l);
  3210. ie->offset += l + 2;
  3211. return err;
  3212. }