wl_cfg80211.c 98 KB

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