smd.c 97 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478
  1. /*
  2. * Copyright (c) 2013 Eugene Krasnikov <[email protected]>
  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. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  17. #include <linux/bitfield.h>
  18. #include <linux/etherdevice.h>
  19. #include <linux/firmware.h>
  20. #include <linux/bitops.h>
  21. #include <linux/rpmsg.h>
  22. #include "smd.h"
  23. #include "firmware.h"
  24. struct wcn36xx_cfg_val {
  25. u32 cfg_id;
  26. u32 value;
  27. };
  28. #define WCN36XX_CFG_VAL(id, val) \
  29. { \
  30. .cfg_id = WCN36XX_HAL_CFG_ ## id, \
  31. .value = val \
  32. }
  33. static struct wcn36xx_cfg_val wcn36xx_cfg_vals[] = {
  34. WCN36XX_CFG_VAL(CURRENT_TX_ANTENNA, 1),
  35. WCN36XX_CFG_VAL(CURRENT_RX_ANTENNA, 1),
  36. WCN36XX_CFG_VAL(LOW_GAIN_OVERRIDE, 0),
  37. WCN36XX_CFG_VAL(POWER_STATE_PER_CHAIN, 785),
  38. WCN36XX_CFG_VAL(CAL_PERIOD, 5),
  39. WCN36XX_CFG_VAL(CAL_CONTROL, 1),
  40. WCN36XX_CFG_VAL(PROXIMITY, 0),
  41. WCN36XX_CFG_VAL(NETWORK_DENSITY, 3),
  42. WCN36XX_CFG_VAL(MAX_MEDIUM_TIME, 6000),
  43. WCN36XX_CFG_VAL(MAX_MPDUS_IN_AMPDU, 64),
  44. WCN36XX_CFG_VAL(RTS_THRESHOLD, 2347),
  45. WCN36XX_CFG_VAL(SHORT_RETRY_LIMIT, 15),
  46. WCN36XX_CFG_VAL(LONG_RETRY_LIMIT, 15),
  47. WCN36XX_CFG_VAL(FRAGMENTATION_THRESHOLD, 8000),
  48. WCN36XX_CFG_VAL(DYNAMIC_THRESHOLD_ZERO, 5),
  49. WCN36XX_CFG_VAL(DYNAMIC_THRESHOLD_ONE, 10),
  50. WCN36XX_CFG_VAL(DYNAMIC_THRESHOLD_TWO, 15),
  51. WCN36XX_CFG_VAL(FIXED_RATE, 0),
  52. WCN36XX_CFG_VAL(RETRYRATE_POLICY, 4),
  53. WCN36XX_CFG_VAL(RETRYRATE_SECONDARY, 0),
  54. WCN36XX_CFG_VAL(RETRYRATE_TERTIARY, 0),
  55. WCN36XX_CFG_VAL(FORCE_POLICY_PROTECTION, 5),
  56. WCN36XX_CFG_VAL(FIXED_RATE_MULTICAST_24GHZ, 1),
  57. WCN36XX_CFG_VAL(FIXED_RATE_MULTICAST_5GHZ, 5),
  58. WCN36XX_CFG_VAL(DEFAULT_RATE_INDEX_5GHZ, 5),
  59. WCN36XX_CFG_VAL(MAX_BA_SESSIONS, 40),
  60. WCN36XX_CFG_VAL(PS_DATA_INACTIVITY_TIMEOUT, 200),
  61. WCN36XX_CFG_VAL(PS_ENABLE_BCN_FILTER, 1),
  62. WCN36XX_CFG_VAL(PS_ENABLE_RSSI_MONITOR, 1),
  63. WCN36XX_CFG_VAL(NUM_BEACON_PER_RSSI_AVERAGE, 20),
  64. WCN36XX_CFG_VAL(STATS_PERIOD, 10),
  65. WCN36XX_CFG_VAL(CFP_MAX_DURATION, 30000),
  66. WCN36XX_CFG_VAL(FRAME_TRANS_ENABLED, 0),
  67. WCN36XX_CFG_VAL(BA_THRESHOLD_HIGH, 128),
  68. WCN36XX_CFG_VAL(MAX_BA_BUFFERS, 2560),
  69. WCN36XX_CFG_VAL(DYNAMIC_PS_POLL_VALUE, 0),
  70. WCN36XX_CFG_VAL(TX_PWR_CTRL_ENABLE, 1),
  71. WCN36XX_CFG_VAL(ENABLE_CLOSE_LOOP, 1),
  72. WCN36XX_CFG_VAL(ENABLE_LPWR_IMG_TRANSITION, 0),
  73. WCN36XX_CFG_VAL(BTC_STATIC_LEN_LE_BT, 120000),
  74. WCN36XX_CFG_VAL(BTC_STATIC_LEN_LE_WLAN, 30000),
  75. WCN36XX_CFG_VAL(MAX_ASSOC_LIMIT, 10),
  76. WCN36XX_CFG_VAL(ENABLE_MCC_ADAPTIVE_SCHEDULER, 0),
  77. WCN36XX_CFG_VAL(ENABLE_DYNAMIC_RA_START_RATE, 133), /* MCS 5 */
  78. WCN36XX_CFG_VAL(LINK_FAIL_TX_CNT, 1000),
  79. };
  80. static struct wcn36xx_cfg_val wcn3680_cfg_vals[] = {
  81. WCN36XX_CFG_VAL(CURRENT_TX_ANTENNA, 1),
  82. WCN36XX_CFG_VAL(CURRENT_RX_ANTENNA, 1),
  83. WCN36XX_CFG_VAL(LOW_GAIN_OVERRIDE, 0),
  84. WCN36XX_CFG_VAL(POWER_STATE_PER_CHAIN, 785),
  85. WCN36XX_CFG_VAL(CAL_PERIOD, 5),
  86. WCN36XX_CFG_VAL(CAL_CONTROL, 1),
  87. WCN36XX_CFG_VAL(PROXIMITY, 0),
  88. WCN36XX_CFG_VAL(NETWORK_DENSITY, 3),
  89. WCN36XX_CFG_VAL(MAX_MEDIUM_TIME, 4096),
  90. WCN36XX_CFG_VAL(MAX_MPDUS_IN_AMPDU, 64),
  91. WCN36XX_CFG_VAL(RTS_THRESHOLD, 2347),
  92. WCN36XX_CFG_VAL(SHORT_RETRY_LIMIT, 15),
  93. WCN36XX_CFG_VAL(LONG_RETRY_LIMIT, 15),
  94. WCN36XX_CFG_VAL(FRAGMENTATION_THRESHOLD, 8000),
  95. WCN36XX_CFG_VAL(DYNAMIC_THRESHOLD_ZERO, 5),
  96. WCN36XX_CFG_VAL(DYNAMIC_THRESHOLD_ONE, 10),
  97. WCN36XX_CFG_VAL(DYNAMIC_THRESHOLD_TWO, 15),
  98. WCN36XX_CFG_VAL(FIXED_RATE, 0),
  99. WCN36XX_CFG_VAL(RETRYRATE_POLICY, 4),
  100. WCN36XX_CFG_VAL(RETRYRATE_SECONDARY, 0),
  101. WCN36XX_CFG_VAL(RETRYRATE_TERTIARY, 0),
  102. WCN36XX_CFG_VAL(FORCE_POLICY_PROTECTION, 5),
  103. WCN36XX_CFG_VAL(FIXED_RATE_MULTICAST_24GHZ, 1),
  104. WCN36XX_CFG_VAL(FIXED_RATE_MULTICAST_5GHZ, 5),
  105. WCN36XX_CFG_VAL(DEFAULT_RATE_INDEX_24GHZ, 1),
  106. WCN36XX_CFG_VAL(DEFAULT_RATE_INDEX_5GHZ, 5),
  107. WCN36XX_CFG_VAL(MAX_BA_SESSIONS, 40),
  108. WCN36XX_CFG_VAL(PS_DATA_INACTIVITY_TIMEOUT, 200),
  109. WCN36XX_CFG_VAL(PS_ENABLE_BCN_FILTER, 1),
  110. WCN36XX_CFG_VAL(PS_ENABLE_RSSI_MONITOR, 1),
  111. WCN36XX_CFG_VAL(NUM_BEACON_PER_RSSI_AVERAGE, 20),
  112. WCN36XX_CFG_VAL(STATS_PERIOD, 10),
  113. WCN36XX_CFG_VAL(CFP_MAX_DURATION, 30000),
  114. WCN36XX_CFG_VAL(FRAME_TRANS_ENABLED, 0),
  115. WCN36XX_CFG_VAL(BA_THRESHOLD_HIGH, 128),
  116. WCN36XX_CFG_VAL(MAX_BA_BUFFERS, 2560),
  117. WCN36XX_CFG_VAL(DYNAMIC_PS_POLL_VALUE, 0),
  118. WCN36XX_CFG_VAL(TX_PWR_CTRL_ENABLE, 1),
  119. WCN36XX_CFG_VAL(ENABLE_CLOSE_LOOP, 1),
  120. WCN36XX_CFG_VAL(ENABLE_LPWR_IMG_TRANSITION, 0),
  121. WCN36XX_CFG_VAL(BTC_STATIC_LEN_LE_BT, 120000),
  122. WCN36XX_CFG_VAL(BTC_STATIC_LEN_LE_WLAN, 30000),
  123. WCN36XX_CFG_VAL(MAX_ASSOC_LIMIT, 10),
  124. WCN36XX_CFG_VAL(ENABLE_MCC_ADAPTIVE_SCHEDULER, 0),
  125. WCN36XX_CFG_VAL(TDLS_PUAPSD_MASK, 0),
  126. WCN36XX_CFG_VAL(TDLS_PUAPSD_BUFFER_STA_CAPABLE, 1),
  127. WCN36XX_CFG_VAL(TDLS_PUAPSD_INACTIVITY_TIME, 0),
  128. WCN36XX_CFG_VAL(TDLS_PUAPSD_RX_FRAME_THRESHOLD, 10),
  129. WCN36XX_CFG_VAL(TDLS_OFF_CHANNEL_CAPABLE, 1),
  130. WCN36XX_CFG_VAL(ENABLE_ADAPTIVE_RX_DRAIN, 1),
  131. WCN36XX_CFG_VAL(FLEXCONNECT_POWER_FACTOR, 0),
  132. WCN36XX_CFG_VAL(ANTENNA_DIVERSITY, 3),
  133. WCN36XX_CFG_VAL(ATH_DISABLE, 0),
  134. WCN36XX_CFG_VAL(BTC_STATIC_OPP_WLAN_ACTIVE_WLAN_LEN, 60000),
  135. WCN36XX_CFG_VAL(BTC_STATIC_OPP_WLAN_ACTIVE_BT_LEN, 90000),
  136. WCN36XX_CFG_VAL(BTC_SAP_STATIC_OPP_ACTIVE_WLAN_LEN, 30000),
  137. WCN36XX_CFG_VAL(BTC_SAP_STATIC_OPP_ACTIVE_BT_LEN, 30000),
  138. WCN36XX_CFG_VAL(ASD_PROBE_INTERVAL, 50),
  139. WCN36XX_CFG_VAL(ASD_TRIGGER_THRESHOLD, -60),
  140. WCN36XX_CFG_VAL(ASD_RTT_RSSI_HYST_THRESHOLD, 3),
  141. WCN36XX_CFG_VAL(BTC_CTS2S_ON_STA_DURING_SCO, 0),
  142. WCN36XX_CFG_VAL(RA_FILTER_ENABLE, 0),
  143. WCN36XX_CFG_VAL(RA_RATE_LIMIT_INTERVAL, 60),
  144. WCN36XX_CFG_VAL(BTC_FATAL_HID_NSNIFF_BLK, 2),
  145. WCN36XX_CFG_VAL(BTC_CRITICAL_HID_NSNIFF_BLK, 1),
  146. WCN36XX_CFG_VAL(BTC_DYN_A2DP_TX_QUEUE_THOLD, 0),
  147. WCN36XX_CFG_VAL(BTC_DYN_OPP_TX_QUEUE_THOLD, 1),
  148. WCN36XX_CFG_VAL(MAX_UAPSD_CONSEC_SP, 10),
  149. WCN36XX_CFG_VAL(MAX_UAPSD_CONSEC_RX_CNT, 50),
  150. WCN36XX_CFG_VAL(MAX_UAPSD_CONSEC_TX_CNT, 50),
  151. WCN36XX_CFG_VAL(MAX_UAPSD_CONSEC_TX_CNT_MEAS_WINDOW, 500),
  152. WCN36XX_CFG_VAL(MAX_UAPSD_CONSEC_RX_CNT_MEAS_WINDOW, 500),
  153. WCN36XX_CFG_VAL(MAX_PSPOLL_IN_WMM_UAPSD_PS_MODE, 0),
  154. WCN36XX_CFG_VAL(MAX_UAPSD_INACTIVITY_INTERVALS, 10),
  155. WCN36XX_CFG_VAL(ENABLE_DYNAMIC_WMMPS, 1),
  156. WCN36XX_CFG_VAL(BURST_MODE_BE_TXOP_VALUE, 0),
  157. WCN36XX_CFG_VAL(ENABLE_DYNAMIC_RA_START_RATE, 136),
  158. WCN36XX_CFG_VAL(BTC_FAST_WLAN_CONN_PREF, 1),
  159. WCN36XX_CFG_VAL(ENABLE_RTSCTS_HTVHT, 0),
  160. WCN36XX_CFG_VAL(BTC_STATIC_OPP_WLAN_IDLE_WLAN_LEN, 30000),
  161. WCN36XX_CFG_VAL(BTC_STATIC_OPP_WLAN_IDLE_BT_LEN, 120000),
  162. WCN36XX_CFG_VAL(LINK_FAIL_TX_CNT, 1000),
  163. WCN36XX_CFG_VAL(TOGGLE_ARP_BDRATES, 0),
  164. WCN36XX_CFG_VAL(OPTIMIZE_CA_EVENT, 0),
  165. WCN36XX_CFG_VAL(EXT_SCAN_CONC_MODE, 0),
  166. WCN36XX_CFG_VAL(BAR_WAKEUP_HOST_DISABLE, 0),
  167. WCN36XX_CFG_VAL(SAR_BOFFSET_CORRECTION_ENABLE, 0),
  168. WCN36XX_CFG_VAL(BTC_DISABLE_WLAN_LINK_CRITICAL, 5),
  169. WCN36XX_CFG_VAL(DISABLE_SCAN_DURING_SCO, 2),
  170. WCN36XX_CFG_VAL(CONS_BCNMISS_COUNT, 0),
  171. WCN36XX_CFG_VAL(UNITS_OF_BCN_WAIT_TIME, 0),
  172. WCN36XX_CFG_VAL(TRIGGER_NULLFRAME_BEFORE_HB, 0),
  173. WCN36XX_CFG_VAL(ENABLE_POWERSAVE_OFFLOAD, 0),
  174. };
  175. static int put_cfg_tlv_u32(struct wcn36xx *wcn, size_t *len, u32 id, u32 value)
  176. {
  177. struct wcn36xx_hal_cfg *entry;
  178. u32 *val;
  179. if (*len + sizeof(*entry) + sizeof(u32) >= WCN36XX_HAL_BUF_SIZE) {
  180. wcn36xx_err("Not enough room for TLV entry\n");
  181. return -ENOMEM;
  182. }
  183. entry = (struct wcn36xx_hal_cfg *) (wcn->hal_buf + *len);
  184. entry->id = id;
  185. entry->len = sizeof(u32);
  186. entry->pad_bytes = 0;
  187. entry->reserve = 0;
  188. val = (u32 *) (entry + 1);
  189. *val = value;
  190. *len += sizeof(*entry) + sizeof(u32);
  191. return 0;
  192. }
  193. static void wcn36xx_smd_set_bss_nw_type(struct wcn36xx *wcn,
  194. struct ieee80211_sta *sta,
  195. struct wcn36xx_hal_config_bss_params *bss_params)
  196. {
  197. if (NL80211_BAND_5GHZ == WCN36XX_BAND(wcn))
  198. bss_params->nw_type = WCN36XX_HAL_11A_NW_TYPE;
  199. else if (sta && sta->deflink.ht_cap.ht_supported)
  200. bss_params->nw_type = WCN36XX_HAL_11N_NW_TYPE;
  201. else if (sta && (sta->deflink.supp_rates[NL80211_BAND_2GHZ] & 0x7f))
  202. bss_params->nw_type = WCN36XX_HAL_11G_NW_TYPE;
  203. else
  204. bss_params->nw_type = WCN36XX_HAL_11B_NW_TYPE;
  205. }
  206. static inline u8 is_cap_supported(unsigned long caps, unsigned long flag)
  207. {
  208. return caps & flag ? 1 : 0;
  209. }
  210. static void wcn36xx_smd_set_bss_ht_params(struct ieee80211_vif *vif,
  211. struct ieee80211_sta *sta,
  212. struct wcn36xx_hal_config_bss_params *bss_params)
  213. {
  214. if (sta && sta->deflink.ht_cap.ht_supported) {
  215. unsigned long caps = sta->deflink.ht_cap.cap;
  216. bss_params->ht = sta->deflink.ht_cap.ht_supported;
  217. bss_params->tx_channel_width_set = is_cap_supported(caps,
  218. IEEE80211_HT_CAP_SUP_WIDTH_20_40);
  219. bss_params->lsig_tx_op_protection_full_support =
  220. is_cap_supported(caps,
  221. IEEE80211_HT_CAP_LSIG_TXOP_PROT);
  222. bss_params->ht_oper_mode = vif->bss_conf.ht_operation_mode;
  223. bss_params->lln_non_gf_coexist =
  224. !!(vif->bss_conf.ht_operation_mode &
  225. IEEE80211_HT_OP_MODE_NON_GF_STA_PRSNT);
  226. /* IEEE80211_HT_STBC_PARAM_DUAL_CTS_PROT */
  227. bss_params->dual_cts_protection = 0;
  228. /* IEEE80211_HT_OP_MODE_PROTECTION_20MHZ */
  229. bss_params->ht20_coexist = 0;
  230. }
  231. }
  232. static void
  233. wcn36xx_smd_set_bss_vht_params(struct ieee80211_vif *vif,
  234. struct ieee80211_sta *sta,
  235. struct wcn36xx_hal_config_bss_params_v1 *bss)
  236. {
  237. if (sta && sta->deflink.vht_cap.vht_supported)
  238. bss->vht_capable = 1;
  239. }
  240. static void wcn36xx_smd_set_sta_ht_params(struct ieee80211_sta *sta,
  241. struct wcn36xx_hal_config_sta_params *sta_params)
  242. {
  243. if (sta->deflink.ht_cap.ht_supported) {
  244. unsigned long caps = sta->deflink.ht_cap.cap;
  245. sta_params->ht_capable = sta->deflink.ht_cap.ht_supported;
  246. sta_params->tx_channel_width_set = is_cap_supported(caps,
  247. IEEE80211_HT_CAP_SUP_WIDTH_20_40);
  248. sta_params->lsig_txop_protection = is_cap_supported(caps,
  249. IEEE80211_HT_CAP_LSIG_TXOP_PROT);
  250. sta_params->max_ampdu_size = sta->deflink.ht_cap.ampdu_factor;
  251. sta_params->max_ampdu_density = sta->deflink.ht_cap.ampdu_density;
  252. /* max_amsdu_size: 1 : 3839 bytes, 0 : 7935 bytes (max) */
  253. sta_params->max_amsdu_size = !is_cap_supported(caps,
  254. IEEE80211_HT_CAP_MAX_AMSDU);
  255. sta_params->sgi_20Mhz = is_cap_supported(caps,
  256. IEEE80211_HT_CAP_SGI_20);
  257. sta_params->sgi_40mhz = is_cap_supported(caps,
  258. IEEE80211_HT_CAP_SGI_40);
  259. sta_params->green_field_capable = is_cap_supported(caps,
  260. IEEE80211_HT_CAP_GRN_FLD);
  261. sta_params->delayed_ba_support = is_cap_supported(caps,
  262. IEEE80211_HT_CAP_DELAY_BA);
  263. sta_params->dsss_cck_mode_40mhz = is_cap_supported(caps,
  264. IEEE80211_HT_CAP_DSSSCCK40);
  265. }
  266. }
  267. static void wcn36xx_smd_set_sta_vht_params(struct wcn36xx *wcn,
  268. struct ieee80211_sta *sta,
  269. struct wcn36xx_hal_config_sta_params_v1 *sta_params)
  270. {
  271. if (sta->deflink.vht_cap.vht_supported) {
  272. unsigned long caps = sta->deflink.vht_cap.cap;
  273. sta_params->vht_capable = sta->deflink.vht_cap.vht_supported;
  274. sta_params->vht_ldpc_enabled =
  275. is_cap_supported(caps, IEEE80211_VHT_CAP_RXLDPC);
  276. if (wcn36xx_firmware_get_feat_caps(wcn->fw_feat_caps, MU_MIMO)) {
  277. sta_params->vht_tx_mu_beamformee_capable =
  278. is_cap_supported(caps, IEEE80211_VHT_CAP_MU_BEAMFORMER_CAPABLE);
  279. if (sta_params->vht_tx_mu_beamformee_capable)
  280. sta_params->vht_tx_bf_enabled = 1;
  281. } else {
  282. sta_params->vht_tx_mu_beamformee_capable = 0;
  283. }
  284. sta_params->vht_tx_channel_width_set = 0;
  285. }
  286. }
  287. static void wcn36xx_smd_set_sta_ht_ldpc_params(struct ieee80211_sta *sta,
  288. struct wcn36xx_hal_config_sta_params_v1 *sta_params)
  289. {
  290. if (sta->deflink.ht_cap.ht_supported) {
  291. sta_params->ht_ldpc_enabled =
  292. is_cap_supported(sta->deflink.ht_cap.cap,
  293. IEEE80211_HT_CAP_LDPC_CODING);
  294. }
  295. }
  296. static void wcn36xx_smd_set_sta_default_ht_params(
  297. struct wcn36xx_hal_config_sta_params *sta_params)
  298. {
  299. sta_params->ht_capable = 1;
  300. sta_params->tx_channel_width_set = 1;
  301. sta_params->lsig_txop_protection = 1;
  302. sta_params->max_ampdu_size = 3;
  303. sta_params->max_ampdu_density = 5;
  304. sta_params->max_amsdu_size = 0;
  305. sta_params->sgi_20Mhz = 1;
  306. sta_params->sgi_40mhz = 1;
  307. sta_params->green_field_capable = 1;
  308. sta_params->delayed_ba_support = 0;
  309. sta_params->dsss_cck_mode_40mhz = 1;
  310. }
  311. static void wcn36xx_smd_set_sta_default_vht_params(struct wcn36xx *wcn,
  312. struct wcn36xx_hal_config_sta_params_v1 *sta_params)
  313. {
  314. if (wcn->rf_id == RF_IRIS_WCN3680) {
  315. sta_params->vht_capable = 1;
  316. sta_params->vht_tx_mu_beamformee_capable = 1;
  317. } else {
  318. sta_params->vht_capable = 0;
  319. sta_params->vht_tx_mu_beamformee_capable = 0;
  320. }
  321. sta_params->vht_ldpc_enabled = 0;
  322. sta_params->vht_tx_channel_width_set = 0;
  323. sta_params->vht_tx_bf_enabled = 0;
  324. }
  325. static void wcn36xx_smd_set_sta_default_ht_ldpc_params(struct wcn36xx *wcn,
  326. struct wcn36xx_hal_config_sta_params_v1 *sta_params)
  327. {
  328. if (wcn->rf_id == RF_IRIS_WCN3680)
  329. sta_params->ht_ldpc_enabled = 1;
  330. else
  331. sta_params->ht_ldpc_enabled = 0;
  332. }
  333. static void wcn36xx_smd_set_sta_params(struct wcn36xx *wcn,
  334. struct ieee80211_vif *vif,
  335. struct ieee80211_sta *sta,
  336. struct wcn36xx_hal_config_sta_params *sta_params)
  337. {
  338. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  339. struct wcn36xx_sta *sta_priv = NULL;
  340. if (vif->type == NL80211_IFTYPE_ADHOC ||
  341. vif->type == NL80211_IFTYPE_AP ||
  342. vif->type == NL80211_IFTYPE_MESH_POINT) {
  343. sta_params->type = 1;
  344. sta_params->sta_index = WCN36XX_HAL_STA_INVALID_IDX;
  345. } else {
  346. sta_params->type = 0;
  347. sta_params->sta_index = vif_priv->self_sta_index;
  348. }
  349. sta_params->listen_interval = WCN36XX_LISTEN_INTERVAL(wcn);
  350. /*
  351. * In STA mode ieee80211_sta contains bssid and ieee80211_vif
  352. * contains our mac address. In AP mode we are bssid so vif
  353. * contains bssid and ieee80211_sta contains mac.
  354. */
  355. if (NL80211_IFTYPE_STATION == vif->type)
  356. memcpy(&sta_params->mac, vif->addr, ETH_ALEN);
  357. else
  358. memcpy(&sta_params->bssid, vif->addr, ETH_ALEN);
  359. sta_params->encrypt_type = vif_priv->encrypt_type;
  360. sta_params->short_preamble_supported = true;
  361. sta_params->rifs_mode = 0;
  362. sta_params->rmf = 0;
  363. sta_params->action = 0;
  364. sta_params->uapsd = 0;
  365. sta_params->mimo_ps = WCN36XX_HAL_HT_MIMO_PS_STATIC;
  366. sta_params->max_ampdu_duration = 0;
  367. sta_params->bssid_index = vif_priv->bss_index;
  368. sta_params->p2p = 0;
  369. if (sta) {
  370. sta_priv = wcn36xx_sta_to_priv(sta);
  371. if (NL80211_IFTYPE_STATION == vif->type)
  372. memcpy(&sta_params->bssid, sta->addr, ETH_ALEN);
  373. else
  374. memcpy(&sta_params->mac, sta->addr, ETH_ALEN);
  375. sta_params->wmm_enabled = sta->wme;
  376. sta_params->max_sp_len = sta->max_sp;
  377. sta_params->aid = sta_priv->aid;
  378. wcn36xx_smd_set_sta_ht_params(sta, sta_params);
  379. memcpy(&sta_params->supported_rates, &sta_priv->supported_rates,
  380. sizeof(struct wcn36xx_hal_supported_rates));
  381. } else {
  382. wcn36xx_set_default_rates((struct wcn36xx_hal_supported_rates *)
  383. &sta_params->supported_rates);
  384. wcn36xx_smd_set_sta_default_ht_params(sta_params);
  385. }
  386. }
  387. static int wcn36xx_smd_send_and_wait(struct wcn36xx *wcn, size_t len)
  388. {
  389. int ret;
  390. unsigned long start;
  391. struct wcn36xx_hal_msg_header *hdr =
  392. (struct wcn36xx_hal_msg_header *)wcn->hal_buf;
  393. u16 req_type = hdr->msg_type;
  394. wcn36xx_dbg_dump(WCN36XX_DBG_SMD_DUMP, "HAL >>> ", wcn->hal_buf, len);
  395. init_completion(&wcn->hal_rsp_compl);
  396. start = jiffies;
  397. ret = rpmsg_send(wcn->smd_channel, wcn->hal_buf, len);
  398. if (ret) {
  399. wcn36xx_err("HAL TX failed for req %d\n", req_type);
  400. goto out;
  401. }
  402. if (wait_for_completion_timeout(&wcn->hal_rsp_compl,
  403. msecs_to_jiffies(HAL_MSG_TIMEOUT)) <= 0) {
  404. wcn36xx_err("Timeout! No SMD response to req %d in %dms\n",
  405. req_type, HAL_MSG_TIMEOUT);
  406. ret = -ETIME;
  407. goto out;
  408. }
  409. wcn36xx_dbg(WCN36XX_DBG_SMD,
  410. "SMD command (req %d, rsp %d) completed in %dms\n",
  411. req_type, hdr->msg_type,
  412. jiffies_to_msecs(jiffies - start));
  413. out:
  414. return ret;
  415. }
  416. #define __INIT_HAL_MSG(msg_body, type, version) \
  417. do { \
  418. memset(&(msg_body), 0, sizeof(msg_body)); \
  419. (msg_body).header.msg_type = type; \
  420. (msg_body).header.msg_version = version; \
  421. (msg_body).header.len = sizeof(msg_body); \
  422. } while (0) \
  423. #define INIT_HAL_MSG(msg_body, type) \
  424. __INIT_HAL_MSG(msg_body, type, WCN36XX_HAL_MSG_VERSION0)
  425. #define INIT_HAL_MSG_V1(msg_body, type) \
  426. __INIT_HAL_MSG(msg_body, type, WCN36XX_HAL_MSG_VERSION1)
  427. #define INIT_HAL_PTT_MSG(p_msg_body, ppt_msg_len) \
  428. do { \
  429. memset(p_msg_body, 0, sizeof(*p_msg_body) + ppt_msg_len); \
  430. p_msg_body->header.msg_type = WCN36XX_HAL_PROCESS_PTT_REQ; \
  431. p_msg_body->header.msg_version = WCN36XX_HAL_MSG_VERSION0; \
  432. p_msg_body->header.len = sizeof(*p_msg_body) + ppt_msg_len; \
  433. } while (0)
  434. #define PREPARE_HAL_BUF(send_buf, msg_body) \
  435. do { \
  436. memset(send_buf, 0, msg_body.header.len); \
  437. memcpy(send_buf, &msg_body, sizeof(msg_body)); \
  438. } while (0) \
  439. #define PREPARE_HAL_PTT_MSG_BUF(send_buf, p_msg_body) \
  440. do { \
  441. memcpy(send_buf, p_msg_body, p_msg_body->header.len); \
  442. } while (0)
  443. static int wcn36xx_smd_rsp_status_check(void *buf, size_t len)
  444. {
  445. struct wcn36xx_fw_msg_status_rsp *rsp;
  446. if (len < sizeof(struct wcn36xx_hal_msg_header) +
  447. sizeof(struct wcn36xx_fw_msg_status_rsp))
  448. return -EIO;
  449. rsp = (struct wcn36xx_fw_msg_status_rsp *)
  450. (buf + sizeof(struct wcn36xx_hal_msg_header));
  451. if (WCN36XX_FW_MSG_RESULT_SUCCESS != rsp->status)
  452. return rsp->status;
  453. return 0;
  454. }
  455. int wcn36xx_smd_load_nv(struct wcn36xx *wcn)
  456. {
  457. struct nv_data *nv_d;
  458. struct wcn36xx_hal_nv_img_download_req_msg msg_body;
  459. int fw_bytes_left;
  460. int ret;
  461. u16 fm_offset = 0;
  462. if (!wcn->nv) {
  463. ret = request_firmware(&wcn->nv, wcn->nv_file, wcn->dev);
  464. if (ret) {
  465. wcn36xx_err("Failed to load nv file %s: %d\n",
  466. wcn->nv_file, ret);
  467. goto out;
  468. }
  469. }
  470. nv_d = (struct nv_data *)wcn->nv->data;
  471. INIT_HAL_MSG(msg_body, WCN36XX_HAL_DOWNLOAD_NV_REQ);
  472. msg_body.header.len += WCN36XX_NV_FRAGMENT_SIZE;
  473. msg_body.frag_number = 0;
  474. /* hal_buf must be protected with mutex */
  475. mutex_lock(&wcn->hal_mutex);
  476. do {
  477. fw_bytes_left = wcn->nv->size - fm_offset - 4;
  478. if (fw_bytes_left > WCN36XX_NV_FRAGMENT_SIZE) {
  479. msg_body.last_fragment = 0;
  480. msg_body.nv_img_buffer_size = WCN36XX_NV_FRAGMENT_SIZE;
  481. } else {
  482. msg_body.last_fragment = 1;
  483. msg_body.nv_img_buffer_size = fw_bytes_left;
  484. /* Do not forget update general message len */
  485. msg_body.header.len = sizeof(msg_body) + fw_bytes_left;
  486. }
  487. /* Add load NV request message header */
  488. memcpy(wcn->hal_buf, &msg_body, sizeof(msg_body));
  489. /* Add NV body itself */
  490. memcpy(wcn->hal_buf + sizeof(msg_body),
  491. &nv_d->table + fm_offset,
  492. msg_body.nv_img_buffer_size);
  493. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  494. if (ret)
  495. goto out_unlock;
  496. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf,
  497. wcn->hal_rsp_len);
  498. if (ret) {
  499. wcn36xx_err("hal_load_nv response failed err=%d\n",
  500. ret);
  501. goto out_unlock;
  502. }
  503. msg_body.frag_number++;
  504. fm_offset += WCN36XX_NV_FRAGMENT_SIZE;
  505. } while (msg_body.last_fragment != 1);
  506. out_unlock:
  507. mutex_unlock(&wcn->hal_mutex);
  508. out: return ret;
  509. }
  510. static int wcn36xx_smd_start_rsp(struct wcn36xx *wcn, void *buf, size_t len)
  511. {
  512. struct wcn36xx_hal_mac_start_rsp_msg *rsp;
  513. if (len < sizeof(*rsp))
  514. return -EIO;
  515. rsp = (struct wcn36xx_hal_mac_start_rsp_msg *)buf;
  516. if (WCN36XX_FW_MSG_RESULT_SUCCESS != rsp->start_rsp_params.status)
  517. return -EIO;
  518. memcpy(wcn->crm_version, rsp->start_rsp_params.crm_version,
  519. WCN36XX_HAL_VERSION_LENGTH);
  520. memcpy(wcn->wlan_version, rsp->start_rsp_params.wlan_version,
  521. WCN36XX_HAL_VERSION_LENGTH);
  522. /* null terminate the strings, just in case */
  523. wcn->crm_version[WCN36XX_HAL_VERSION_LENGTH] = '\0';
  524. wcn->wlan_version[WCN36XX_HAL_VERSION_LENGTH] = '\0';
  525. wcn->fw_revision = rsp->start_rsp_params.version.revision;
  526. wcn->fw_version = rsp->start_rsp_params.version.version;
  527. wcn->fw_minor = rsp->start_rsp_params.version.minor;
  528. wcn->fw_major = rsp->start_rsp_params.version.major;
  529. if (wcn->first_boot) {
  530. wcn->first_boot = false;
  531. wcn36xx_info("firmware WLAN version '%s' and CRM version '%s'\n",
  532. wcn->wlan_version, wcn->crm_version);
  533. wcn36xx_info("firmware API %u.%u.%u.%u, %u stations, %u bssids\n",
  534. wcn->fw_major, wcn->fw_minor,
  535. wcn->fw_version, wcn->fw_revision,
  536. rsp->start_rsp_params.stations,
  537. rsp->start_rsp_params.bssids);
  538. }
  539. return 0;
  540. }
  541. int wcn36xx_smd_start(struct wcn36xx *wcn)
  542. {
  543. struct wcn36xx_hal_mac_start_req_msg msg_body, *body;
  544. int ret;
  545. int i;
  546. size_t len;
  547. int cfg_elements;
  548. static struct wcn36xx_cfg_val *cfg_vals;
  549. mutex_lock(&wcn->hal_mutex);
  550. INIT_HAL_MSG(msg_body, WCN36XX_HAL_START_REQ);
  551. msg_body.params.type = DRIVER_TYPE_PRODUCTION;
  552. msg_body.params.len = 0;
  553. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  554. body = (struct wcn36xx_hal_mac_start_req_msg *)wcn->hal_buf;
  555. len = body->header.len;
  556. if (wcn->rf_id == RF_IRIS_WCN3680) {
  557. cfg_vals = wcn3680_cfg_vals;
  558. cfg_elements = ARRAY_SIZE(wcn3680_cfg_vals);
  559. } else {
  560. cfg_vals = wcn36xx_cfg_vals;
  561. cfg_elements = ARRAY_SIZE(wcn36xx_cfg_vals);
  562. }
  563. for (i = 0; i < cfg_elements; i++) {
  564. ret = put_cfg_tlv_u32(wcn, &len, cfg_vals[i].cfg_id,
  565. cfg_vals[i].value);
  566. if (ret)
  567. goto out;
  568. }
  569. body->header.len = len;
  570. body->params.len = len - sizeof(*body);
  571. wcn36xx_dbg(WCN36XX_DBG_HAL, "hal start type %d\n",
  572. msg_body.params.type);
  573. ret = wcn36xx_smd_send_and_wait(wcn, body->header.len);
  574. if (ret) {
  575. wcn36xx_err("Sending hal_start failed\n");
  576. goto out;
  577. }
  578. ret = wcn36xx_smd_start_rsp(wcn, wcn->hal_buf, wcn->hal_rsp_len);
  579. if (ret) {
  580. wcn36xx_err("hal_start response failed err=%d\n", ret);
  581. goto out;
  582. }
  583. out:
  584. mutex_unlock(&wcn->hal_mutex);
  585. return ret;
  586. }
  587. int wcn36xx_smd_stop(struct wcn36xx *wcn)
  588. {
  589. struct wcn36xx_hal_mac_stop_req_msg msg_body;
  590. int ret;
  591. mutex_lock(&wcn->hal_mutex);
  592. INIT_HAL_MSG(msg_body, WCN36XX_HAL_STOP_REQ);
  593. msg_body.stop_req_params.reason = HAL_STOP_TYPE_RF_KILL;
  594. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  595. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  596. if (ret) {
  597. wcn36xx_err("Sending hal_stop failed\n");
  598. goto out;
  599. }
  600. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  601. if (ret) {
  602. wcn36xx_err("hal_stop response failed err=%d\n", ret);
  603. goto out;
  604. }
  605. out:
  606. mutex_unlock(&wcn->hal_mutex);
  607. return ret;
  608. }
  609. int wcn36xx_smd_init_scan(struct wcn36xx *wcn, enum wcn36xx_hal_sys_mode mode,
  610. struct ieee80211_vif *vif)
  611. {
  612. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  613. struct wcn36xx_hal_init_scan_req_msg msg_body;
  614. int ret;
  615. mutex_lock(&wcn->hal_mutex);
  616. INIT_HAL_MSG(msg_body, WCN36XX_HAL_INIT_SCAN_REQ);
  617. msg_body.mode = mode;
  618. if (vif_priv->bss_index != WCN36XX_HAL_BSS_INVALID_IDX) {
  619. /* Notify BSSID with null DATA packet */
  620. msg_body.frame_type = 2;
  621. msg_body.notify = 1;
  622. msg_body.scan_entry.bss_index[0] = vif_priv->bss_index;
  623. msg_body.scan_entry.active_bss_count = 1;
  624. }
  625. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  626. wcn36xx_dbg(WCN36XX_DBG_HAL, "hal init scan mode %d\n", msg_body.mode);
  627. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  628. if (ret) {
  629. wcn36xx_err("Sending hal_init_scan failed\n");
  630. goto out;
  631. }
  632. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  633. if (ret) {
  634. wcn36xx_err("hal_init_scan response failed err=%d\n", ret);
  635. goto out;
  636. }
  637. wcn->sw_scan_init = true;
  638. out:
  639. mutex_unlock(&wcn->hal_mutex);
  640. return ret;
  641. }
  642. int wcn36xx_smd_start_scan(struct wcn36xx *wcn, u8 scan_channel)
  643. {
  644. struct wcn36xx_hal_start_scan_req_msg msg_body;
  645. int ret;
  646. mutex_lock(&wcn->hal_mutex);
  647. INIT_HAL_MSG(msg_body, WCN36XX_HAL_START_SCAN_REQ);
  648. msg_body.scan_channel = scan_channel;
  649. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  650. wcn36xx_dbg(WCN36XX_DBG_HAL, "hal start scan channel %d\n",
  651. msg_body.scan_channel);
  652. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  653. if (ret) {
  654. wcn36xx_err("Sending hal_start_scan failed\n");
  655. goto out;
  656. }
  657. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  658. if (ret) {
  659. wcn36xx_err("hal_start_scan response failed err=%d\n", ret);
  660. goto out;
  661. }
  662. wcn->sw_scan_channel = scan_channel;
  663. out:
  664. mutex_unlock(&wcn->hal_mutex);
  665. return ret;
  666. }
  667. int wcn36xx_smd_end_scan(struct wcn36xx *wcn, u8 scan_channel)
  668. {
  669. struct wcn36xx_hal_end_scan_req_msg msg_body;
  670. int ret;
  671. mutex_lock(&wcn->hal_mutex);
  672. INIT_HAL_MSG(msg_body, WCN36XX_HAL_END_SCAN_REQ);
  673. msg_body.scan_channel = scan_channel;
  674. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  675. wcn36xx_dbg(WCN36XX_DBG_HAL, "hal end scan channel %d\n",
  676. msg_body.scan_channel);
  677. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  678. if (ret) {
  679. wcn36xx_err("Sending hal_end_scan failed\n");
  680. goto out;
  681. }
  682. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  683. if (ret) {
  684. wcn36xx_err("hal_end_scan response failed err=%d\n", ret);
  685. goto out;
  686. }
  687. wcn->sw_scan_channel = 0;
  688. out:
  689. mutex_unlock(&wcn->hal_mutex);
  690. return ret;
  691. }
  692. int wcn36xx_smd_finish_scan(struct wcn36xx *wcn,
  693. enum wcn36xx_hal_sys_mode mode,
  694. struct ieee80211_vif *vif)
  695. {
  696. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  697. struct wcn36xx_hal_finish_scan_req_msg msg_body;
  698. int ret;
  699. mutex_lock(&wcn->hal_mutex);
  700. INIT_HAL_MSG(msg_body, WCN36XX_HAL_FINISH_SCAN_REQ);
  701. msg_body.mode = mode;
  702. msg_body.oper_channel = WCN36XX_HW_CHANNEL(wcn);
  703. if (vif_priv->bss_index != WCN36XX_HAL_BSS_INVALID_IDX) {
  704. /* Notify BSSID with null data packet */
  705. msg_body.notify = 1;
  706. msg_body.frame_type = 2;
  707. msg_body.scan_entry.bss_index[0] = vif_priv->bss_index;
  708. msg_body.scan_entry.active_bss_count = 1;
  709. }
  710. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  711. wcn36xx_dbg(WCN36XX_DBG_HAL, "hal finish scan mode %d\n",
  712. msg_body.mode);
  713. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  714. if (ret) {
  715. wcn36xx_err("Sending hal_finish_scan failed\n");
  716. goto out;
  717. }
  718. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  719. if (ret) {
  720. wcn36xx_err("hal_finish_scan response failed err=%d\n", ret);
  721. goto out;
  722. }
  723. wcn->sw_scan_init = false;
  724. out:
  725. mutex_unlock(&wcn->hal_mutex);
  726. return ret;
  727. }
  728. int wcn36xx_smd_start_hw_scan(struct wcn36xx *wcn, struct ieee80211_vif *vif,
  729. struct cfg80211_scan_request *req)
  730. {
  731. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  732. struct wcn36xx_hal_start_scan_offload_req_msg *msg_body;
  733. int ret, i;
  734. if (req->ie_len > WCN36XX_MAX_SCAN_IE_LEN)
  735. return -EINVAL;
  736. mutex_lock(&wcn->hal_mutex);
  737. msg_body = kzalloc(sizeof(*msg_body), GFP_KERNEL);
  738. if (!msg_body) {
  739. ret = -ENOMEM;
  740. goto out;
  741. }
  742. INIT_HAL_MSG((*msg_body), WCN36XX_HAL_START_SCAN_OFFLOAD_REQ);
  743. msg_body->scan_type = WCN36XX_HAL_SCAN_TYPE_ACTIVE;
  744. msg_body->min_ch_time = 30;
  745. msg_body->max_ch_time = 100;
  746. msg_body->scan_hidden = 1;
  747. memcpy(msg_body->mac, vif->addr, ETH_ALEN);
  748. msg_body->bss_type = vif_priv->bss_type;
  749. msg_body->p2p_search = vif->p2p;
  750. msg_body->num_ssid = min_t(u8, req->n_ssids, ARRAY_SIZE(msg_body->ssids));
  751. for (i = 0; i < msg_body->num_ssid; i++) {
  752. msg_body->ssids[i].length = min_t(u8, req->ssids[i].ssid_len,
  753. sizeof(msg_body->ssids[i].ssid));
  754. memcpy(msg_body->ssids[i].ssid, req->ssids[i].ssid,
  755. msg_body->ssids[i].length);
  756. }
  757. msg_body->num_channel = min_t(u8, req->n_channels,
  758. sizeof(msg_body->channels));
  759. for (i = 0; i < msg_body->num_channel; i++) {
  760. msg_body->channels[i] =
  761. HW_VALUE_CHANNEL(req->channels[i]->hw_value);
  762. }
  763. msg_body->header.len -= WCN36XX_MAX_SCAN_IE_LEN;
  764. if (req->ie_len > 0) {
  765. msg_body->ie_len = req->ie_len;
  766. msg_body->header.len += req->ie_len;
  767. memcpy(msg_body->ie, req->ie, req->ie_len);
  768. }
  769. PREPARE_HAL_BUF(wcn->hal_buf, (*msg_body));
  770. wcn36xx_dbg(WCN36XX_DBG_HAL,
  771. "hal start hw-scan (channels: %u; ssids: %u; p2p: %s)\n",
  772. msg_body->num_channel, msg_body->num_ssid,
  773. msg_body->p2p_search ? "yes" : "no");
  774. ret = wcn36xx_smd_send_and_wait(wcn, msg_body->header.len);
  775. if (ret) {
  776. wcn36xx_err("Sending hal_start_scan_offload failed\n");
  777. goto out;
  778. }
  779. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  780. if (ret) {
  781. wcn36xx_err("hal_start_scan_offload response failed err=%d\n",
  782. ret);
  783. goto out;
  784. }
  785. out:
  786. kfree(msg_body);
  787. mutex_unlock(&wcn->hal_mutex);
  788. return ret;
  789. }
  790. int wcn36xx_smd_stop_hw_scan(struct wcn36xx *wcn)
  791. {
  792. struct wcn36xx_hal_stop_scan_offload_req_msg msg_body;
  793. int ret;
  794. mutex_lock(&wcn->hal_mutex);
  795. INIT_HAL_MSG(msg_body, WCN36XX_HAL_STOP_SCAN_OFFLOAD_REQ);
  796. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  797. wcn36xx_dbg(WCN36XX_DBG_HAL, "hal stop hw-scan\n");
  798. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  799. if (ret) {
  800. wcn36xx_err("Sending hal_stop_scan_offload failed\n");
  801. goto out;
  802. }
  803. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  804. if (ret) {
  805. wcn36xx_err("hal_stop_scan_offload response failed err=%d\n",
  806. ret);
  807. goto out;
  808. }
  809. out:
  810. mutex_unlock(&wcn->hal_mutex);
  811. return ret;
  812. }
  813. int wcn36xx_smd_update_channel_list(struct wcn36xx *wcn, struct cfg80211_scan_request *req)
  814. {
  815. struct wcn36xx_hal_update_channel_list_req_msg *msg_body;
  816. int ret, i;
  817. msg_body = kzalloc(sizeof(*msg_body), GFP_KERNEL);
  818. if (!msg_body)
  819. return -ENOMEM;
  820. INIT_HAL_MSG((*msg_body), WCN36XX_HAL_UPDATE_CHANNEL_LIST_REQ);
  821. msg_body->num_channel = min_t(u8, req->n_channels, ARRAY_SIZE(msg_body->channels));
  822. for (i = 0; i < msg_body->num_channel; i++) {
  823. struct wcn36xx_hal_channel_param *param = &msg_body->channels[i];
  824. u32 min_power = WCN36XX_HAL_DEFAULT_MIN_POWER;
  825. u32 ant_gain = WCN36XX_HAL_DEFAULT_ANT_GAIN;
  826. param->mhz = req->channels[i]->center_freq;
  827. param->band_center_freq1 = req->channels[i]->center_freq;
  828. param->band_center_freq2 = 0;
  829. if (req->channels[i]->flags & IEEE80211_CHAN_NO_IR)
  830. param->channel_info |= WCN36XX_HAL_CHAN_INFO_FLAG_PASSIVE;
  831. if (req->channels[i]->flags & IEEE80211_CHAN_RADAR)
  832. param->channel_info |= WCN36XX_HAL_CHAN_INFO_FLAG_DFS;
  833. if (req->channels[i]->band == NL80211_BAND_5GHZ) {
  834. param->channel_info |= WCN36XX_HAL_CHAN_INFO_FLAG_HT;
  835. param->channel_info |= WCN36XX_HAL_CHAN_INFO_FLAG_VHT;
  836. param->channel_info |= WCN36XX_HAL_CHAN_INFO_PHY_11A;
  837. } else {
  838. param->channel_info |= WCN36XX_HAL_CHAN_INFO_PHY_11BG;
  839. }
  840. if (min_power > req->channels[i]->max_power)
  841. min_power = req->channels[i]->max_power;
  842. if (req->channels[i]->max_antenna_gain)
  843. ant_gain = req->channels[i]->max_antenna_gain;
  844. u32p_replace_bits(&param->reg_info_1, min_power,
  845. WCN36XX_HAL_CHAN_REG1_MIN_PWR_MASK);
  846. u32p_replace_bits(&param->reg_info_1, req->channels[i]->max_power,
  847. WCN36XX_HAL_CHAN_REG1_MAX_PWR_MASK);
  848. u32p_replace_bits(&param->reg_info_1, req->channels[i]->max_reg_power,
  849. WCN36XX_HAL_CHAN_REG1_REG_PWR_MASK);
  850. u32p_replace_bits(&param->reg_info_1, 0,
  851. WCN36XX_HAL_CHAN_REG1_CLASS_ID_MASK);
  852. u32p_replace_bits(&param->reg_info_2, ant_gain,
  853. WCN36XX_HAL_CHAN_REG2_ANT_GAIN_MASK);
  854. wcn36xx_dbg(WCN36XX_DBG_HAL,
  855. "%s: freq=%u, channel_info=%08x, reg_info1=%08x, reg_info2=%08x\n",
  856. __func__, param->mhz, param->channel_info, param->reg_info_1,
  857. param->reg_info_2);
  858. }
  859. mutex_lock(&wcn->hal_mutex);
  860. PREPARE_HAL_BUF(wcn->hal_buf, (*msg_body));
  861. ret = wcn36xx_smd_send_and_wait(wcn, msg_body->header.len);
  862. if (ret) {
  863. wcn36xx_err("Sending hal_update_channel_list failed\n");
  864. goto out;
  865. }
  866. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  867. if (ret) {
  868. wcn36xx_err("hal_update_channel_list response failed err=%d\n", ret);
  869. goto out;
  870. }
  871. out:
  872. kfree(msg_body);
  873. mutex_unlock(&wcn->hal_mutex);
  874. return ret;
  875. }
  876. static int wcn36xx_smd_switch_channel_rsp(void *buf, size_t len)
  877. {
  878. struct wcn36xx_hal_switch_channel_rsp_msg *rsp;
  879. int ret;
  880. ret = wcn36xx_smd_rsp_status_check(buf, len);
  881. if (ret)
  882. return ret;
  883. rsp = (struct wcn36xx_hal_switch_channel_rsp_msg *)buf;
  884. wcn36xx_dbg(WCN36XX_DBG_HAL, "channel switched to: %d, status: %d\n",
  885. rsp->channel_number, rsp->status);
  886. return ret;
  887. }
  888. int wcn36xx_smd_switch_channel(struct wcn36xx *wcn,
  889. struct ieee80211_vif *vif, int ch)
  890. {
  891. struct wcn36xx_hal_switch_channel_req_msg msg_body;
  892. int ret;
  893. mutex_lock(&wcn->hal_mutex);
  894. INIT_HAL_MSG(msg_body, WCN36XX_HAL_CH_SWITCH_REQ);
  895. msg_body.channel_number = (u8)ch;
  896. msg_body.tx_mgmt_power = 0xbf;
  897. msg_body.max_tx_power = 0xbf;
  898. memcpy(msg_body.self_sta_mac_addr, vif->addr, ETH_ALEN);
  899. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  900. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  901. if (ret) {
  902. wcn36xx_err("Sending hal_switch_channel failed\n");
  903. goto out;
  904. }
  905. ret = wcn36xx_smd_switch_channel_rsp(wcn->hal_buf, wcn->hal_rsp_len);
  906. if (ret) {
  907. wcn36xx_err("hal_switch_channel response failed err=%d\n", ret);
  908. goto out;
  909. }
  910. out:
  911. mutex_unlock(&wcn->hal_mutex);
  912. return ret;
  913. }
  914. static int wcn36xx_smd_process_ptt_msg_rsp(void *buf, size_t len,
  915. void **p_ptt_rsp_msg)
  916. {
  917. struct wcn36xx_hal_process_ptt_msg_rsp_msg *rsp;
  918. int ret;
  919. ret = wcn36xx_smd_rsp_status_check(buf, len);
  920. if (ret)
  921. return ret;
  922. rsp = (struct wcn36xx_hal_process_ptt_msg_rsp_msg *)buf;
  923. wcn36xx_dbg(WCN36XX_DBG_HAL, "process ptt msg responded with length %d\n",
  924. rsp->header.len);
  925. wcn36xx_dbg_dump(WCN36XX_DBG_HAL_DUMP, "HAL_PTT_MSG_RSP:", rsp->ptt_msg,
  926. rsp->header.len - sizeof(rsp->ptt_msg_resp_status));
  927. if (rsp->header.len > 0) {
  928. *p_ptt_rsp_msg = kmemdup(rsp->ptt_msg, rsp->header.len,
  929. GFP_ATOMIC);
  930. if (!*p_ptt_rsp_msg)
  931. return -ENOMEM;
  932. }
  933. return ret;
  934. }
  935. int wcn36xx_smd_process_ptt_msg(struct wcn36xx *wcn,
  936. struct ieee80211_vif *vif, void *ptt_msg, size_t len,
  937. void **ptt_rsp_msg)
  938. {
  939. struct wcn36xx_hal_process_ptt_msg_req_msg *p_msg_body;
  940. int ret;
  941. mutex_lock(&wcn->hal_mutex);
  942. p_msg_body = kmalloc(
  943. sizeof(struct wcn36xx_hal_process_ptt_msg_req_msg) + len,
  944. GFP_ATOMIC);
  945. if (!p_msg_body) {
  946. ret = -ENOMEM;
  947. goto out_nomem;
  948. }
  949. INIT_HAL_PTT_MSG(p_msg_body, len);
  950. memcpy(&p_msg_body->ptt_msg, ptt_msg, len);
  951. PREPARE_HAL_PTT_MSG_BUF(wcn->hal_buf, p_msg_body);
  952. ret = wcn36xx_smd_send_and_wait(wcn, p_msg_body->header.len);
  953. if (ret) {
  954. wcn36xx_err("Sending hal_process_ptt_msg failed\n");
  955. goto out;
  956. }
  957. ret = wcn36xx_smd_process_ptt_msg_rsp(wcn->hal_buf, wcn->hal_rsp_len,
  958. ptt_rsp_msg);
  959. if (ret) {
  960. wcn36xx_err("process_ptt_msg response failed err=%d\n", ret);
  961. goto out;
  962. }
  963. out:
  964. kfree(p_msg_body);
  965. out_nomem:
  966. mutex_unlock(&wcn->hal_mutex);
  967. return ret;
  968. }
  969. static int wcn36xx_smd_update_scan_params_rsp(void *buf, size_t len)
  970. {
  971. struct wcn36xx_hal_update_scan_params_resp *rsp;
  972. rsp = (struct wcn36xx_hal_update_scan_params_resp *)buf;
  973. /* Remove the PNO version bit */
  974. rsp->status &= (~(WCN36XX_FW_MSG_PNO_VERSION_MASK));
  975. if (WCN36XX_FW_MSG_RESULT_SUCCESS != rsp->status) {
  976. wcn36xx_warn("error response from update scan\n");
  977. return rsp->status;
  978. }
  979. return 0;
  980. }
  981. int wcn36xx_smd_update_scan_params(struct wcn36xx *wcn,
  982. u8 *channels, size_t channel_count)
  983. {
  984. struct wcn36xx_hal_update_scan_params_req_ex msg_body;
  985. int ret;
  986. mutex_lock(&wcn->hal_mutex);
  987. INIT_HAL_MSG(msg_body, WCN36XX_HAL_UPDATE_SCAN_PARAM_REQ);
  988. msg_body.dot11d_enabled = false;
  989. msg_body.dot11d_resolved = true;
  990. msg_body.channel_count = channel_count;
  991. memcpy(msg_body.channels, channels, channel_count);
  992. msg_body.active_min_ch_time = 60;
  993. msg_body.active_max_ch_time = 120;
  994. msg_body.passive_min_ch_time = 60;
  995. msg_body.passive_max_ch_time = 110;
  996. msg_body.state = PHY_SINGLE_CHANNEL_CENTERED;
  997. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  998. wcn36xx_dbg(WCN36XX_DBG_HAL,
  999. "hal update scan params channel_count %d\n",
  1000. msg_body.channel_count);
  1001. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1002. if (ret) {
  1003. wcn36xx_err("Sending hal_update_scan_params failed\n");
  1004. goto out;
  1005. }
  1006. ret = wcn36xx_smd_update_scan_params_rsp(wcn->hal_buf,
  1007. wcn->hal_rsp_len);
  1008. if (ret) {
  1009. wcn36xx_err("hal_update_scan_params response failed err=%d\n",
  1010. ret);
  1011. goto out;
  1012. }
  1013. out:
  1014. mutex_unlock(&wcn->hal_mutex);
  1015. return ret;
  1016. }
  1017. static int wcn36xx_smd_add_sta_self_rsp(struct wcn36xx *wcn,
  1018. struct ieee80211_vif *vif,
  1019. void *buf,
  1020. size_t len)
  1021. {
  1022. struct wcn36xx_hal_add_sta_self_rsp_msg *rsp;
  1023. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  1024. if (len < sizeof(*rsp))
  1025. return -EINVAL;
  1026. rsp = (struct wcn36xx_hal_add_sta_self_rsp_msg *)buf;
  1027. if (rsp->status != WCN36XX_FW_MSG_RESULT_SUCCESS) {
  1028. wcn36xx_warn("hal add sta self failure: %d\n",
  1029. rsp->status);
  1030. return rsp->status;
  1031. }
  1032. wcn36xx_dbg(WCN36XX_DBG_HAL,
  1033. "hal add sta self status %d self_sta_index %d dpu_index %d\n",
  1034. rsp->status, rsp->self_sta_index, rsp->dpu_index);
  1035. vif_priv->self_sta_index = rsp->self_sta_index;
  1036. vif_priv->self_dpu_desc_index = rsp->dpu_index;
  1037. return 0;
  1038. }
  1039. int wcn36xx_smd_add_sta_self(struct wcn36xx *wcn, struct ieee80211_vif *vif)
  1040. {
  1041. struct wcn36xx_hal_add_sta_self_req msg_body;
  1042. int ret;
  1043. mutex_lock(&wcn->hal_mutex);
  1044. INIT_HAL_MSG(msg_body, WCN36XX_HAL_ADD_STA_SELF_REQ);
  1045. memcpy(&msg_body.self_addr, vif->addr, ETH_ALEN);
  1046. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1047. wcn36xx_dbg(WCN36XX_DBG_HAL,
  1048. "hal add sta self self_addr %pM status %d\n",
  1049. msg_body.self_addr, msg_body.status);
  1050. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1051. if (ret) {
  1052. wcn36xx_err("Sending hal_add_sta_self failed\n");
  1053. goto out;
  1054. }
  1055. ret = wcn36xx_smd_add_sta_self_rsp(wcn,
  1056. vif,
  1057. wcn->hal_buf,
  1058. wcn->hal_rsp_len);
  1059. if (ret) {
  1060. wcn36xx_err("hal_add_sta_self response failed err=%d\n", ret);
  1061. goto out;
  1062. }
  1063. out:
  1064. mutex_unlock(&wcn->hal_mutex);
  1065. return ret;
  1066. }
  1067. int wcn36xx_smd_delete_sta_self(struct wcn36xx *wcn, u8 *addr)
  1068. {
  1069. struct wcn36xx_hal_del_sta_self_req_msg msg_body;
  1070. int ret;
  1071. mutex_lock(&wcn->hal_mutex);
  1072. INIT_HAL_MSG(msg_body, WCN36XX_HAL_DEL_STA_SELF_REQ);
  1073. memcpy(&msg_body.self_addr, addr, ETH_ALEN);
  1074. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1075. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1076. if (ret) {
  1077. wcn36xx_err("Sending hal_delete_sta_self failed\n");
  1078. goto out;
  1079. }
  1080. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  1081. if (ret) {
  1082. wcn36xx_err("hal_delete_sta_self response failed err=%d\n",
  1083. ret);
  1084. goto out;
  1085. }
  1086. out:
  1087. mutex_unlock(&wcn->hal_mutex);
  1088. return ret;
  1089. }
  1090. int wcn36xx_smd_delete_sta(struct wcn36xx *wcn, u8 sta_index)
  1091. {
  1092. struct wcn36xx_hal_delete_sta_req_msg msg_body;
  1093. int ret;
  1094. mutex_lock(&wcn->hal_mutex);
  1095. INIT_HAL_MSG(msg_body, WCN36XX_HAL_DELETE_STA_REQ);
  1096. msg_body.sta_index = sta_index;
  1097. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1098. wcn36xx_dbg(WCN36XX_DBG_HAL,
  1099. "hal delete sta sta_index %d\n",
  1100. msg_body.sta_index);
  1101. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1102. if (ret) {
  1103. wcn36xx_err("Sending hal_delete_sta failed\n");
  1104. goto out;
  1105. }
  1106. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  1107. if (ret) {
  1108. wcn36xx_err("hal_delete_sta response failed err=%d\n", ret);
  1109. goto out;
  1110. }
  1111. out:
  1112. mutex_unlock(&wcn->hal_mutex);
  1113. return ret;
  1114. }
  1115. static int wcn36xx_smd_join_rsp(void *buf, size_t len)
  1116. {
  1117. struct wcn36xx_hal_join_rsp_msg *rsp;
  1118. if (wcn36xx_smd_rsp_status_check(buf, len))
  1119. return -EIO;
  1120. rsp = (struct wcn36xx_hal_join_rsp_msg *)buf;
  1121. wcn36xx_dbg(WCN36XX_DBG_HAL,
  1122. "hal rsp join status %d tx_mgmt_power %d\n",
  1123. rsp->status, rsp->tx_mgmt_power);
  1124. return 0;
  1125. }
  1126. int wcn36xx_smd_join(struct wcn36xx *wcn, const u8 *bssid, u8 *vif, u8 ch)
  1127. {
  1128. struct wcn36xx_hal_join_req_msg msg_body;
  1129. int ret;
  1130. mutex_lock(&wcn->hal_mutex);
  1131. INIT_HAL_MSG(msg_body, WCN36XX_HAL_JOIN_REQ);
  1132. memcpy(&msg_body.bssid, bssid, ETH_ALEN);
  1133. memcpy(&msg_body.self_sta_mac_addr, vif, ETH_ALEN);
  1134. msg_body.channel = ch;
  1135. if (conf_is_ht40_minus(&wcn->hw->conf))
  1136. msg_body.secondary_channel_offset =
  1137. PHY_DOUBLE_CHANNEL_HIGH_PRIMARY;
  1138. else if (conf_is_ht40_plus(&wcn->hw->conf))
  1139. msg_body.secondary_channel_offset =
  1140. PHY_DOUBLE_CHANNEL_LOW_PRIMARY;
  1141. else
  1142. msg_body.secondary_channel_offset =
  1143. PHY_SINGLE_CHANNEL_CENTERED;
  1144. msg_body.link_state = WCN36XX_HAL_LINK_PREASSOC_STATE;
  1145. msg_body.max_tx_power = 0xbf;
  1146. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1147. wcn36xx_dbg(WCN36XX_DBG_HAL,
  1148. "hal join req bssid %pM self_sta_mac_addr %pM channel %d link_state %d\n",
  1149. msg_body.bssid, msg_body.self_sta_mac_addr,
  1150. msg_body.channel, msg_body.link_state);
  1151. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1152. if (ret) {
  1153. wcn36xx_err("Sending hal_join failed\n");
  1154. goto out;
  1155. }
  1156. ret = wcn36xx_smd_join_rsp(wcn->hal_buf, wcn->hal_rsp_len);
  1157. if (ret) {
  1158. wcn36xx_err("hal_join response failed err=%d\n", ret);
  1159. goto out;
  1160. }
  1161. out:
  1162. mutex_unlock(&wcn->hal_mutex);
  1163. return ret;
  1164. }
  1165. int wcn36xx_smd_set_link_st(struct wcn36xx *wcn, const u8 *bssid,
  1166. const u8 *sta_mac,
  1167. enum wcn36xx_hal_link_state state)
  1168. {
  1169. struct wcn36xx_hal_set_link_state_req_msg msg_body;
  1170. int ret;
  1171. mutex_lock(&wcn->hal_mutex);
  1172. INIT_HAL_MSG(msg_body, WCN36XX_HAL_SET_LINK_ST_REQ);
  1173. memcpy(&msg_body.bssid, bssid, ETH_ALEN);
  1174. memcpy(&msg_body.self_mac_addr, sta_mac, ETH_ALEN);
  1175. msg_body.state = state;
  1176. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1177. wcn36xx_dbg(WCN36XX_DBG_HAL,
  1178. "hal set link state bssid %pM self_mac_addr %pM state %d\n",
  1179. msg_body.bssid, msg_body.self_mac_addr, msg_body.state);
  1180. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1181. if (ret) {
  1182. wcn36xx_err("Sending hal_set_link_st failed\n");
  1183. goto out;
  1184. }
  1185. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  1186. if (ret) {
  1187. wcn36xx_err("hal_set_link_st response failed err=%d\n", ret);
  1188. goto out;
  1189. }
  1190. out:
  1191. mutex_unlock(&wcn->hal_mutex);
  1192. return ret;
  1193. }
  1194. static void wcn36xx_smd_convert_sta_to_v1(struct wcn36xx *wcn,
  1195. const struct wcn36xx_hal_config_sta_params *orig,
  1196. struct wcn36xx_hal_config_sta_params_v1 *v1)
  1197. {
  1198. /* convert orig to v1 format */
  1199. memcpy(&v1->bssid, orig->bssid, ETH_ALEN);
  1200. memcpy(&v1->mac, orig->mac, ETH_ALEN);
  1201. v1->aid = orig->aid;
  1202. v1->type = orig->type;
  1203. v1->short_preamble_supported = orig->short_preamble_supported;
  1204. v1->listen_interval = orig->listen_interval;
  1205. v1->wmm_enabled = orig->wmm_enabled;
  1206. v1->ht_capable = orig->ht_capable;
  1207. v1->tx_channel_width_set = orig->tx_channel_width_set;
  1208. v1->rifs_mode = orig->rifs_mode;
  1209. v1->lsig_txop_protection = orig->lsig_txop_protection;
  1210. v1->max_ampdu_size = orig->max_ampdu_size;
  1211. v1->max_ampdu_density = orig->max_ampdu_density;
  1212. v1->sgi_40mhz = orig->sgi_40mhz;
  1213. v1->sgi_20Mhz = orig->sgi_20Mhz;
  1214. v1->rmf = orig->rmf;
  1215. v1->encrypt_type = orig->encrypt_type;
  1216. v1->action = orig->action;
  1217. v1->uapsd = orig->uapsd;
  1218. v1->max_sp_len = orig->max_sp_len;
  1219. v1->green_field_capable = orig->green_field_capable;
  1220. v1->mimo_ps = orig->mimo_ps;
  1221. v1->delayed_ba_support = orig->delayed_ba_support;
  1222. v1->max_ampdu_duration = orig->max_ampdu_duration;
  1223. v1->dsss_cck_mode_40mhz = orig->dsss_cck_mode_40mhz;
  1224. memcpy(&v1->supported_rates, &orig->supported_rates,
  1225. sizeof(orig->supported_rates));
  1226. v1->sta_index = orig->sta_index;
  1227. v1->bssid_index = orig->bssid_index;
  1228. v1->p2p = orig->p2p;
  1229. }
  1230. static void
  1231. wcn36xx_smd_set_sta_params_v1(struct wcn36xx *wcn,
  1232. struct ieee80211_vif *vif,
  1233. struct ieee80211_sta *sta,
  1234. struct wcn36xx_hal_config_sta_params_v1 *sta_par)
  1235. {
  1236. struct wcn36xx_sta *sta_priv = NULL;
  1237. struct wcn36xx_hal_config_sta_params sta_par_v0;
  1238. wcn36xx_smd_set_sta_params(wcn, vif, sta, &sta_par_v0);
  1239. wcn36xx_smd_convert_sta_to_v1(wcn, &sta_par_v0, sta_par);
  1240. if (sta) {
  1241. sta_priv = wcn36xx_sta_to_priv(sta);
  1242. wcn36xx_smd_set_sta_vht_params(wcn, sta, sta_par);
  1243. wcn36xx_smd_set_sta_ht_ldpc_params(sta, sta_par);
  1244. memcpy(&sta_par->supported_rates, &sta_priv->supported_rates,
  1245. sizeof(sta_par->supported_rates));
  1246. } else {
  1247. wcn36xx_set_default_rates_v1(&sta_par->supported_rates);
  1248. wcn36xx_smd_set_sta_default_vht_params(wcn, sta_par);
  1249. wcn36xx_smd_set_sta_default_ht_ldpc_params(wcn, sta_par);
  1250. }
  1251. }
  1252. static int wcn36xx_smd_config_sta_rsp(struct wcn36xx *wcn,
  1253. struct ieee80211_sta *sta,
  1254. void *buf,
  1255. size_t len)
  1256. {
  1257. struct wcn36xx_hal_config_sta_rsp_msg *rsp;
  1258. struct config_sta_rsp_params *params;
  1259. struct wcn36xx_sta *sta_priv = wcn36xx_sta_to_priv(sta);
  1260. if (len < sizeof(*rsp))
  1261. return -EINVAL;
  1262. rsp = (struct wcn36xx_hal_config_sta_rsp_msg *)buf;
  1263. params = &rsp->params;
  1264. if (params->status != WCN36XX_FW_MSG_RESULT_SUCCESS) {
  1265. wcn36xx_warn("hal config sta response failure: %d\n",
  1266. params->status);
  1267. return -EIO;
  1268. }
  1269. sta_priv->sta_index = params->sta_index;
  1270. sta_priv->dpu_desc_index = params->dpu_index;
  1271. sta_priv->ucast_dpu_sign = params->uc_ucast_sig;
  1272. wcn36xx_dbg(WCN36XX_DBG_HAL,
  1273. "hal config sta rsp status %d sta_index %d bssid_index %d uc_ucast_sig %d p2p %d\n",
  1274. params->status, params->sta_index, params->bssid_index,
  1275. params->uc_ucast_sig, params->p2p);
  1276. return 0;
  1277. }
  1278. static int wcn36xx_smd_config_sta_v1(struct wcn36xx *wcn,
  1279. struct ieee80211_vif *vif,
  1280. struct ieee80211_sta *sta)
  1281. {
  1282. struct wcn36xx_hal_config_sta_req_msg_v1 msg_body;
  1283. struct wcn36xx_hal_config_sta_params_v1 *sta_params;
  1284. if (wcn->rf_id == RF_IRIS_WCN3680) {
  1285. INIT_HAL_MSG_V1(msg_body, WCN36XX_HAL_CONFIG_STA_REQ);
  1286. } else {
  1287. INIT_HAL_MSG(msg_body, WCN36XX_HAL_CONFIG_STA_REQ);
  1288. msg_body.header.len -= WCN36XX_DIFF_STA_PARAMS_V1_NOVHT;
  1289. }
  1290. sta_params = &msg_body.sta_params;
  1291. wcn36xx_smd_set_sta_params_v1(wcn, vif, sta, sta_params);
  1292. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1293. wcn36xx_dbg(WCN36XX_DBG_HAL,
  1294. "hal config sta v1 action %d sta_index %d bssid_index %d bssid %pM type %d mac %pM aid %d\n",
  1295. sta_params->action, sta_params->sta_index, sta_params->bssid_index,
  1296. sta_params->bssid, sta_params->type, sta_params->mac, sta_params->aid);
  1297. return wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1298. }
  1299. static int wcn36xx_smd_config_sta_v0(struct wcn36xx *wcn,
  1300. struct ieee80211_vif *vif,
  1301. struct ieee80211_sta *sta)
  1302. {
  1303. struct wcn36xx_hal_config_sta_req_msg msg;
  1304. struct wcn36xx_hal_config_sta_params *sta_params;
  1305. INIT_HAL_MSG(msg, WCN36XX_HAL_CONFIG_STA_REQ);
  1306. sta_params = &msg.sta_params;
  1307. wcn36xx_smd_set_sta_params(wcn, vif, sta, sta_params);
  1308. PREPARE_HAL_BUF(wcn->hal_buf, msg);
  1309. wcn36xx_dbg(WCN36XX_DBG_HAL,
  1310. "hal config sta action %d sta_index %d bssid_index %d bssid %pM type %d mac %pM aid %d\n",
  1311. sta_params->action, sta_params->sta_index,
  1312. sta_params->bssid_index, sta_params->bssid,
  1313. sta_params->type, sta_params->mac, sta_params->aid);
  1314. return wcn36xx_smd_send_and_wait(wcn, msg.header.len);
  1315. }
  1316. int wcn36xx_smd_config_sta(struct wcn36xx *wcn, struct ieee80211_vif *vif,
  1317. struct ieee80211_sta *sta)
  1318. {
  1319. int ret;
  1320. mutex_lock(&wcn->hal_mutex);
  1321. if (!wcn36xx_is_fw_version(wcn, 1, 2, 2, 24))
  1322. ret = wcn36xx_smd_config_sta_v1(wcn, vif, sta);
  1323. else
  1324. ret = wcn36xx_smd_config_sta_v0(wcn, vif, sta);
  1325. if (ret) {
  1326. wcn36xx_err("Sending hal_config_sta failed\n");
  1327. goto out;
  1328. }
  1329. ret = wcn36xx_smd_config_sta_rsp(wcn,
  1330. sta,
  1331. wcn->hal_buf,
  1332. wcn->hal_rsp_len);
  1333. if (ret) {
  1334. wcn36xx_err("hal_config_sta response failed err=%d\n", ret);
  1335. goto out;
  1336. }
  1337. out:
  1338. mutex_unlock(&wcn->hal_mutex);
  1339. return ret;
  1340. }
  1341. static void wcn36xx_smd_set_bss_params(struct wcn36xx *wcn,
  1342. struct ieee80211_vif *vif,
  1343. struct ieee80211_sta *sta,
  1344. const u8 *bssid,
  1345. bool update,
  1346. struct wcn36xx_hal_config_bss_params *bss)
  1347. {
  1348. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  1349. WARN_ON(is_zero_ether_addr(bssid));
  1350. memcpy(&bss->bssid, bssid, ETH_ALEN);
  1351. memcpy(bss->self_mac_addr, vif->addr, ETH_ALEN);
  1352. if (vif->type == NL80211_IFTYPE_STATION) {
  1353. bss->bss_type = WCN36XX_HAL_INFRASTRUCTURE_MODE;
  1354. /* STA */
  1355. bss->oper_mode = 1;
  1356. bss->wcn36xx_hal_persona = WCN36XX_HAL_STA_MODE;
  1357. } else if (vif->type == NL80211_IFTYPE_AP ||
  1358. vif->type == NL80211_IFTYPE_MESH_POINT) {
  1359. bss->bss_type = WCN36XX_HAL_INFRA_AP_MODE;
  1360. /* AP */
  1361. bss->oper_mode = 0;
  1362. bss->wcn36xx_hal_persona = WCN36XX_HAL_STA_SAP_MODE;
  1363. } else if (vif->type == NL80211_IFTYPE_ADHOC) {
  1364. bss->bss_type = WCN36XX_HAL_IBSS_MODE;
  1365. /* STA */
  1366. bss->oper_mode = 1;
  1367. } else {
  1368. wcn36xx_warn("Unknown type for bss config: %d\n", vif->type);
  1369. }
  1370. if (vif->type == NL80211_IFTYPE_STATION)
  1371. wcn36xx_smd_set_bss_nw_type(wcn, sta, bss);
  1372. else
  1373. bss->nw_type = WCN36XX_HAL_11N_NW_TYPE;
  1374. bss->short_slot_time_supported = vif->bss_conf.use_short_slot;
  1375. bss->lla_coexist = 0;
  1376. bss->llb_coexist = 0;
  1377. bss->llg_coexist = 0;
  1378. bss->rifs_mode = 0;
  1379. bss->beacon_interval = vif->bss_conf.beacon_int;
  1380. bss->dtim_period = vif_priv->dtim_period;
  1381. wcn36xx_smd_set_bss_ht_params(vif, sta, bss);
  1382. bss->oper_channel = WCN36XX_HW_CHANNEL(wcn);
  1383. if (conf_is_ht40_minus(&wcn->hw->conf))
  1384. bss->ext_channel = IEEE80211_HT_PARAM_CHA_SEC_BELOW;
  1385. else if (conf_is_ht40_plus(&wcn->hw->conf))
  1386. bss->ext_channel = IEEE80211_HT_PARAM_CHA_SEC_ABOVE;
  1387. else
  1388. bss->ext_channel = IEEE80211_HT_PARAM_CHA_SEC_NONE;
  1389. bss->reserved = 0;
  1390. /* wcn->ssid is only valid in AP and IBSS mode */
  1391. bss->ssid.length = vif_priv->ssid.length;
  1392. memcpy(bss->ssid.ssid, vif_priv->ssid.ssid, vif_priv->ssid.length);
  1393. bss->obss_prot_enabled = 0;
  1394. bss->rmf = 0;
  1395. bss->max_probe_resp_retry_limit = 0;
  1396. bss->hidden_ssid = vif->bss_conf.hidden_ssid;
  1397. bss->proxy_probe_resp = 0;
  1398. bss->edca_params_valid = 0;
  1399. /* FIXME: set acbe, acbk, acvi and acvo */
  1400. bss->ext_set_sta_key_param_valid = 0;
  1401. /* FIXME: set ext_set_sta_key_param */
  1402. bss->spectrum_mgt_enable = 0;
  1403. bss->tx_mgmt_power = 0;
  1404. bss->max_tx_power = WCN36XX_MAX_POWER(wcn);
  1405. bss->action = update;
  1406. vif_priv->bss_type = bss->bss_type;
  1407. }
  1408. static int wcn36xx_smd_config_bss_v1(struct wcn36xx *wcn,
  1409. struct ieee80211_vif *vif,
  1410. struct ieee80211_sta *sta_80211,
  1411. const u8 *bssid,
  1412. bool update)
  1413. {
  1414. struct wcn36xx_hal_config_bss_req_msg_v1 *msg_body;
  1415. struct wcn36xx_hal_config_bss_params_v1 *bss;
  1416. struct wcn36xx_hal_config_bss_params bss_v0;
  1417. struct wcn36xx_hal_config_sta_params_v1 *sta;
  1418. struct cfg80211_chan_def *chandef;
  1419. int ret;
  1420. msg_body = kzalloc(sizeof(*msg_body), GFP_KERNEL);
  1421. if (!msg_body)
  1422. return -ENOMEM;
  1423. if (wcn->rf_id == RF_IRIS_WCN3680) {
  1424. INIT_HAL_MSG_V1((*msg_body), WCN36XX_HAL_CONFIG_BSS_REQ);
  1425. } else {
  1426. INIT_HAL_MSG((*msg_body), WCN36XX_HAL_CONFIG_BSS_REQ);
  1427. msg_body->header.len -= WCN36XX_DIFF_BSS_PARAMS_V1_NOVHT;
  1428. }
  1429. bss = &msg_body->bss_params;
  1430. sta = &bss->sta;
  1431. memset(&bss_v0, 0x00, sizeof(bss_v0));
  1432. wcn36xx_smd_set_bss_params(wcn, vif, sta_80211, bssid, update, &bss_v0);
  1433. wcn36xx_smd_set_sta_params_v1(wcn, vif, sta_80211, sta);
  1434. /* convert orig to v1 */
  1435. memcpy(bss->bssid, &bss_v0.bssid, ETH_ALEN);
  1436. memcpy(bss->self_mac_addr, &bss_v0.self_mac_addr, ETH_ALEN);
  1437. bss->bss_type = bss_v0.bss_type;
  1438. bss->oper_mode = bss_v0.oper_mode;
  1439. bss->nw_type = bss_v0.nw_type;
  1440. bss->short_slot_time_supported =
  1441. bss_v0.short_slot_time_supported;
  1442. bss->lla_coexist = bss_v0.lla_coexist;
  1443. bss->llb_coexist = bss_v0.llb_coexist;
  1444. bss->llg_coexist = bss_v0.llg_coexist;
  1445. bss->ht20_coexist = bss_v0.ht20_coexist;
  1446. bss->lln_non_gf_coexist = bss_v0.lln_non_gf_coexist;
  1447. bss->lsig_tx_op_protection_full_support =
  1448. bss_v0.lsig_tx_op_protection_full_support;
  1449. bss->rifs_mode = bss_v0.rifs_mode;
  1450. bss->beacon_interval = bss_v0.beacon_interval;
  1451. bss->dtim_period = bss_v0.dtim_period;
  1452. bss->tx_channel_width_set = bss_v0.tx_channel_width_set;
  1453. bss->oper_channel = bss_v0.oper_channel;
  1454. if (wcn->hw->conf.chandef.width == NL80211_CHAN_WIDTH_80) {
  1455. chandef = &wcn->hw->conf.chandef;
  1456. bss->ext_channel = HW_VALUE_PHY(chandef->chan->hw_value);
  1457. } else {
  1458. bss->ext_channel = bss_v0.ext_channel;
  1459. }
  1460. bss->reserved = bss_v0.reserved;
  1461. memcpy(&bss->ssid, &bss_v0.ssid,
  1462. sizeof(bss_v0.ssid));
  1463. bss->action = bss_v0.action;
  1464. bss->rateset = bss_v0.rateset;
  1465. bss->ht = bss_v0.ht;
  1466. bss->obss_prot_enabled = bss_v0.obss_prot_enabled;
  1467. bss->rmf = bss_v0.rmf;
  1468. bss->ht_oper_mode = bss_v0.ht_oper_mode;
  1469. bss->dual_cts_protection = bss_v0.dual_cts_protection;
  1470. bss->max_probe_resp_retry_limit =
  1471. bss_v0.max_probe_resp_retry_limit;
  1472. bss->hidden_ssid = bss_v0.hidden_ssid;
  1473. bss->proxy_probe_resp = bss_v0.proxy_probe_resp;
  1474. bss->edca_params_valid = bss_v0.edca_params_valid;
  1475. memcpy(&bss->acbe, &bss_v0.acbe,
  1476. sizeof(bss_v0.acbe));
  1477. memcpy(&bss->acbk, &bss_v0.acbk,
  1478. sizeof(bss_v0.acbk));
  1479. memcpy(&bss->acvi, &bss_v0.acvi,
  1480. sizeof(bss_v0.acvi));
  1481. memcpy(&bss->acvo, &bss_v0.acvo,
  1482. sizeof(bss_v0.acvo));
  1483. bss->ext_set_sta_key_param_valid =
  1484. bss_v0.ext_set_sta_key_param_valid;
  1485. memcpy(&bss->ext_set_sta_key_param,
  1486. &bss_v0.ext_set_sta_key_param,
  1487. sizeof(bss_v0.acvo));
  1488. bss->wcn36xx_hal_persona = bss_v0.wcn36xx_hal_persona;
  1489. bss->spectrum_mgt_enable = bss_v0.spectrum_mgt_enable;
  1490. bss->tx_mgmt_power = bss_v0.tx_mgmt_power;
  1491. bss->max_tx_power = bss_v0.max_tx_power;
  1492. wcn36xx_smd_set_bss_vht_params(vif, sta_80211, bss);
  1493. PREPARE_HAL_BUF(wcn->hal_buf, (*msg_body));
  1494. wcn36xx_dbg(WCN36XX_DBG_HAL,
  1495. "hal config bss v1 bssid %pM self_mac_addr %pM bss_type %d oper_mode %d nw_type %d\n",
  1496. bss->bssid, bss->self_mac_addr, bss->bss_type,
  1497. bss->oper_mode, bss->nw_type);
  1498. wcn36xx_dbg(WCN36XX_DBG_HAL,
  1499. "- sta bssid %pM action %d sta_index %d bssid_index %d aid %d type %d mac %pM\n",
  1500. sta->bssid, sta->action, sta->sta_index,
  1501. sta->bssid_index, sta->aid, sta->type, sta->mac);
  1502. ret = wcn36xx_smd_send_and_wait(wcn, msg_body->header.len);
  1503. kfree(msg_body);
  1504. return ret;
  1505. }
  1506. static int wcn36xx_smd_config_bss_v0(struct wcn36xx *wcn,
  1507. struct ieee80211_vif *vif,
  1508. struct ieee80211_sta *sta,
  1509. const u8 *bssid,
  1510. bool update)
  1511. {
  1512. struct wcn36xx_hal_config_bss_req_msg *msg;
  1513. struct wcn36xx_hal_config_bss_params *bss;
  1514. struct wcn36xx_hal_config_sta_params *sta_params;
  1515. int ret;
  1516. msg = kzalloc(sizeof(*msg), GFP_KERNEL);
  1517. if (!msg)
  1518. return -ENOMEM;
  1519. INIT_HAL_MSG((*msg), WCN36XX_HAL_CONFIG_BSS_REQ);
  1520. bss = &msg->bss_params;
  1521. sta_params = &bss->sta;
  1522. wcn36xx_smd_set_bss_params(wcn, vif, sta, bssid, update, bss);
  1523. wcn36xx_smd_set_sta_params(wcn, vif, sta, sta_params);
  1524. PREPARE_HAL_BUF(wcn->hal_buf, (*msg));
  1525. wcn36xx_dbg(WCN36XX_DBG_HAL,
  1526. "hal config bss bssid %pM self_mac_addr %pM bss_type %d oper_mode %d nw_type %d\n",
  1527. bss->bssid, bss->self_mac_addr, bss->bss_type,
  1528. bss->oper_mode, bss->nw_type);
  1529. wcn36xx_dbg(WCN36XX_DBG_HAL,
  1530. "- sta bssid %pM action %d sta_index %d bssid_index %d aid %d type %d mac %pM\n",
  1531. sta_params->bssid, sta_params->action,
  1532. sta_params->sta_index, sta_params->bssid_index,
  1533. sta_params->aid, sta_params->type,
  1534. sta_params->mac);
  1535. ret = wcn36xx_smd_send_and_wait(wcn, msg->header.len);
  1536. kfree(msg);
  1537. return ret;
  1538. }
  1539. static int wcn36xx_smd_config_bss_rsp(struct wcn36xx *wcn,
  1540. struct ieee80211_vif *vif,
  1541. struct ieee80211_sta *sta,
  1542. void *buf,
  1543. size_t len)
  1544. {
  1545. struct wcn36xx_hal_config_bss_rsp_msg *rsp;
  1546. struct wcn36xx_hal_config_bss_rsp_params *params;
  1547. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  1548. if (len < sizeof(*rsp))
  1549. return -EINVAL;
  1550. rsp = (struct wcn36xx_hal_config_bss_rsp_msg *)buf;
  1551. params = &rsp->bss_rsp_params;
  1552. if (params->status != WCN36XX_FW_MSG_RESULT_SUCCESS) {
  1553. wcn36xx_warn("hal config bss response failure: %d\n",
  1554. params->status);
  1555. return -EIO;
  1556. }
  1557. wcn36xx_dbg(WCN36XX_DBG_HAL,
  1558. "hal config bss rsp status %d bss_idx %d dpu_desc_index %d"
  1559. " sta_idx %d self_idx %d bcast_idx %d mac %pM"
  1560. " power %d ucast_dpu_signature %d\n",
  1561. params->status, params->bss_index, params->dpu_desc_index,
  1562. params->bss_sta_index, params->bss_self_sta_index,
  1563. params->bss_bcast_sta_idx, params->mac,
  1564. params->tx_mgmt_power, params->ucast_dpu_signature);
  1565. vif_priv->bss_index = params->bss_index;
  1566. if (sta) {
  1567. struct wcn36xx_sta *sta_priv = wcn36xx_sta_to_priv(sta);
  1568. sta_priv->bss_sta_index = params->bss_sta_index;
  1569. sta_priv->bss_dpu_desc_index = params->dpu_desc_index;
  1570. }
  1571. vif_priv->self_ucast_dpu_sign = params->ucast_dpu_signature;
  1572. return 0;
  1573. }
  1574. int wcn36xx_smd_config_bss(struct wcn36xx *wcn, struct ieee80211_vif *vif,
  1575. struct ieee80211_sta *sta, const u8 *bssid,
  1576. bool update)
  1577. {
  1578. int ret;
  1579. mutex_lock(&wcn->hal_mutex);
  1580. if (!wcn36xx_is_fw_version(wcn, 1, 2, 2, 24))
  1581. ret = wcn36xx_smd_config_bss_v1(wcn, vif, sta, bssid, update);
  1582. else
  1583. ret = wcn36xx_smd_config_bss_v0(wcn, vif, sta, bssid, update);
  1584. if (ret) {
  1585. wcn36xx_err("Sending hal_config_bss failed\n");
  1586. goto out;
  1587. }
  1588. ret = wcn36xx_smd_config_bss_rsp(wcn,
  1589. vif,
  1590. sta,
  1591. wcn->hal_buf,
  1592. wcn->hal_rsp_len);
  1593. if (ret)
  1594. wcn36xx_err("hal_config_bss response failed err=%d\n", ret);
  1595. out:
  1596. mutex_unlock(&wcn->hal_mutex);
  1597. return ret;
  1598. }
  1599. int wcn36xx_smd_delete_bss(struct wcn36xx *wcn, struct ieee80211_vif *vif)
  1600. {
  1601. struct wcn36xx_hal_delete_bss_req_msg msg_body;
  1602. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  1603. int ret = 0;
  1604. mutex_lock(&wcn->hal_mutex);
  1605. if (vif_priv->bss_index == WCN36XX_HAL_BSS_INVALID_IDX)
  1606. goto out;
  1607. INIT_HAL_MSG(msg_body, WCN36XX_HAL_DELETE_BSS_REQ);
  1608. msg_body.bss_index = vif_priv->bss_index;
  1609. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1610. wcn36xx_dbg(WCN36XX_DBG_HAL, "hal delete bss %d\n", msg_body.bss_index);
  1611. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1612. if (ret) {
  1613. wcn36xx_err("Sending hal_delete_bss failed\n");
  1614. goto out;
  1615. }
  1616. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  1617. if (ret) {
  1618. wcn36xx_err("hal_delete_bss response failed err=%d\n", ret);
  1619. goto out;
  1620. }
  1621. vif_priv->bss_index = WCN36XX_HAL_BSS_INVALID_IDX;
  1622. out:
  1623. mutex_unlock(&wcn->hal_mutex);
  1624. return ret;
  1625. }
  1626. int wcn36xx_smd_send_beacon(struct wcn36xx *wcn, struct ieee80211_vif *vif,
  1627. struct sk_buff *skb_beacon, u16 tim_off,
  1628. u16 p2p_off)
  1629. {
  1630. struct wcn36xx_hal_send_beacon_req_msg msg_body;
  1631. int ret, pad, pvm_len;
  1632. mutex_lock(&wcn->hal_mutex);
  1633. INIT_HAL_MSG(msg_body, WCN36XX_HAL_SEND_BEACON_REQ);
  1634. pvm_len = skb_beacon->data[tim_off + 1] - 3;
  1635. pad = TIM_MIN_PVM_SIZE - pvm_len;
  1636. /* Padding is irrelevant to mesh mode since tim_off is always 0. */
  1637. if (vif->type == NL80211_IFTYPE_MESH_POINT)
  1638. pad = 0;
  1639. msg_body.beacon_length = skb_beacon->len + pad;
  1640. /* TODO need to find out why + 6 is needed */
  1641. msg_body.beacon_length6 = msg_body.beacon_length + 6;
  1642. if (msg_body.beacon_length > BEACON_TEMPLATE_SIZE) {
  1643. wcn36xx_err("Beacon is too big: beacon size=%d\n",
  1644. msg_body.beacon_length);
  1645. ret = -ENOMEM;
  1646. goto out;
  1647. }
  1648. memcpy(msg_body.beacon, skb_beacon->data, skb_beacon->len);
  1649. memcpy(msg_body.bssid, vif->addr, ETH_ALEN);
  1650. if (pad > 0) {
  1651. /*
  1652. * The wcn36xx FW has a fixed size for the PVM in the TIM. If
  1653. * given the beacon template from mac80211 with a PVM shorter
  1654. * than the FW expectes it will overwrite the data after the
  1655. * TIM.
  1656. */
  1657. wcn36xx_dbg(WCN36XX_DBG_HAL, "Pad TIM PVM. %d bytes at %d\n",
  1658. pad, pvm_len);
  1659. memmove(&msg_body.beacon[tim_off + 5 + pvm_len + pad],
  1660. &msg_body.beacon[tim_off + 5 + pvm_len],
  1661. skb_beacon->len - (tim_off + 5 + pvm_len));
  1662. memset(&msg_body.beacon[tim_off + 5 + pvm_len], 0, pad);
  1663. msg_body.beacon[tim_off + 1] += pad;
  1664. }
  1665. /* TODO need to find out why this is needed? */
  1666. if (vif->type == NL80211_IFTYPE_MESH_POINT)
  1667. /* mesh beacon don't need this, so push further down */
  1668. msg_body.tim_ie_offset = 256;
  1669. else
  1670. msg_body.tim_ie_offset = tim_off+4;
  1671. msg_body.p2p_ie_offset = p2p_off;
  1672. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1673. wcn36xx_dbg(WCN36XX_DBG_HAL,
  1674. "hal send beacon beacon_length %d\n",
  1675. msg_body.beacon_length);
  1676. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1677. if (ret) {
  1678. wcn36xx_err("Sending hal_send_beacon failed\n");
  1679. goto out;
  1680. }
  1681. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  1682. if (ret) {
  1683. wcn36xx_err("hal_send_beacon response failed err=%d\n", ret);
  1684. goto out;
  1685. }
  1686. out:
  1687. mutex_unlock(&wcn->hal_mutex);
  1688. return ret;
  1689. }
  1690. int wcn36xx_smd_update_proberesp_tmpl(struct wcn36xx *wcn,
  1691. struct ieee80211_vif *vif,
  1692. struct sk_buff *skb)
  1693. {
  1694. struct wcn36xx_hal_send_probe_resp_req_msg msg;
  1695. int ret;
  1696. mutex_lock(&wcn->hal_mutex);
  1697. INIT_HAL_MSG(msg, WCN36XX_HAL_UPDATE_PROBE_RSP_TEMPLATE_REQ);
  1698. if (skb->len > BEACON_TEMPLATE_SIZE) {
  1699. wcn36xx_warn("probe response template is too big: %d\n",
  1700. skb->len);
  1701. ret = -E2BIG;
  1702. goto out;
  1703. }
  1704. msg.probe_resp_template_len = skb->len;
  1705. memcpy(&msg.probe_resp_template, skb->data, skb->len);
  1706. memcpy(msg.bssid, vif->addr, ETH_ALEN);
  1707. PREPARE_HAL_BUF(wcn->hal_buf, msg);
  1708. wcn36xx_dbg(WCN36XX_DBG_HAL,
  1709. "hal update probe rsp len %d bssid %pM\n",
  1710. msg.probe_resp_template_len, msg.bssid);
  1711. ret = wcn36xx_smd_send_and_wait(wcn, msg.header.len);
  1712. if (ret) {
  1713. wcn36xx_err("Sending hal_update_proberesp_tmpl failed\n");
  1714. goto out;
  1715. }
  1716. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  1717. if (ret) {
  1718. wcn36xx_err("hal_update_proberesp_tmpl response failed err=%d\n",
  1719. ret);
  1720. goto out;
  1721. }
  1722. out:
  1723. mutex_unlock(&wcn->hal_mutex);
  1724. return ret;
  1725. }
  1726. int wcn36xx_smd_set_stakey(struct wcn36xx *wcn,
  1727. enum ani_ed_type enc_type,
  1728. u8 keyidx,
  1729. u8 keylen,
  1730. u8 *key,
  1731. u8 sta_index)
  1732. {
  1733. struct wcn36xx_hal_set_sta_key_req_msg msg_body;
  1734. int ret;
  1735. mutex_lock(&wcn->hal_mutex);
  1736. INIT_HAL_MSG(msg_body, WCN36XX_HAL_SET_STAKEY_REQ);
  1737. msg_body.set_sta_key_params.sta_index = sta_index;
  1738. msg_body.set_sta_key_params.enc_type = enc_type;
  1739. if (enc_type == WCN36XX_HAL_ED_WEP104 ||
  1740. enc_type == WCN36XX_HAL_ED_WEP40) {
  1741. /* Use bss key for wep (static) */
  1742. msg_body.set_sta_key_params.def_wep_idx = keyidx;
  1743. msg_body.set_sta_key_params.wep_type = 0;
  1744. } else {
  1745. msg_body.set_sta_key_params.key[0].id = keyidx;
  1746. msg_body.set_sta_key_params.key[0].unicast = 1;
  1747. msg_body.set_sta_key_params.key[0].direction = WCN36XX_HAL_TX_RX;
  1748. msg_body.set_sta_key_params.key[0].pae_role = 0;
  1749. msg_body.set_sta_key_params.key[0].length = keylen;
  1750. memcpy(msg_body.set_sta_key_params.key[0].key, key, keylen);
  1751. }
  1752. msg_body.set_sta_key_params.single_tid_rc = 1;
  1753. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1754. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1755. if (ret) {
  1756. wcn36xx_err("Sending hal_set_stakey failed\n");
  1757. goto out;
  1758. }
  1759. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  1760. if (ret) {
  1761. wcn36xx_err("hal_set_stakey response failed err=%d\n", ret);
  1762. goto out;
  1763. }
  1764. out:
  1765. mutex_unlock(&wcn->hal_mutex);
  1766. return ret;
  1767. }
  1768. int wcn36xx_smd_set_bsskey(struct wcn36xx *wcn,
  1769. enum ani_ed_type enc_type,
  1770. u8 bssidx,
  1771. u8 keyidx,
  1772. u8 keylen,
  1773. u8 *key)
  1774. {
  1775. struct wcn36xx_hal_set_bss_key_req_msg msg_body;
  1776. int ret;
  1777. mutex_lock(&wcn->hal_mutex);
  1778. INIT_HAL_MSG(msg_body, WCN36XX_HAL_SET_BSSKEY_REQ);
  1779. msg_body.bss_idx = bssidx;
  1780. msg_body.enc_type = enc_type;
  1781. msg_body.num_keys = 1;
  1782. msg_body.keys[0].id = keyidx;
  1783. msg_body.keys[0].unicast = 0;
  1784. msg_body.keys[0].direction = WCN36XX_HAL_RX_ONLY;
  1785. msg_body.keys[0].pae_role = 0;
  1786. msg_body.keys[0].length = keylen;
  1787. memcpy(msg_body.keys[0].key, key, keylen);
  1788. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1789. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1790. if (ret) {
  1791. wcn36xx_err("Sending hal_set_bsskey failed\n");
  1792. goto out;
  1793. }
  1794. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  1795. if (ret) {
  1796. wcn36xx_err("hal_set_bsskey response failed err=%d\n", ret);
  1797. goto out;
  1798. }
  1799. out:
  1800. mutex_unlock(&wcn->hal_mutex);
  1801. return ret;
  1802. }
  1803. int wcn36xx_smd_remove_stakey(struct wcn36xx *wcn,
  1804. enum ani_ed_type enc_type,
  1805. u8 keyidx,
  1806. u8 sta_index)
  1807. {
  1808. struct wcn36xx_hal_remove_sta_key_req_msg msg_body;
  1809. int ret;
  1810. mutex_lock(&wcn->hal_mutex);
  1811. INIT_HAL_MSG(msg_body, WCN36XX_HAL_RMV_STAKEY_REQ);
  1812. msg_body.sta_idx = sta_index;
  1813. msg_body.enc_type = enc_type;
  1814. msg_body.key_id = keyidx;
  1815. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1816. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1817. if (ret) {
  1818. wcn36xx_err("Sending hal_remove_stakey failed\n");
  1819. goto out;
  1820. }
  1821. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  1822. if (ret) {
  1823. wcn36xx_err("hal_remove_stakey response failed err=%d\n", ret);
  1824. goto out;
  1825. }
  1826. out:
  1827. mutex_unlock(&wcn->hal_mutex);
  1828. return ret;
  1829. }
  1830. int wcn36xx_smd_remove_bsskey(struct wcn36xx *wcn,
  1831. enum ani_ed_type enc_type,
  1832. u8 bssidx,
  1833. u8 keyidx)
  1834. {
  1835. struct wcn36xx_hal_remove_bss_key_req_msg msg_body;
  1836. int ret;
  1837. mutex_lock(&wcn->hal_mutex);
  1838. INIT_HAL_MSG(msg_body, WCN36XX_HAL_RMV_BSSKEY_REQ);
  1839. msg_body.bss_idx = bssidx;
  1840. msg_body.enc_type = enc_type;
  1841. msg_body.key_id = keyidx;
  1842. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1843. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1844. if (ret) {
  1845. wcn36xx_err("Sending hal_remove_bsskey failed\n");
  1846. goto out;
  1847. }
  1848. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  1849. if (ret) {
  1850. wcn36xx_err("hal_remove_bsskey response failed err=%d\n", ret);
  1851. goto out;
  1852. }
  1853. out:
  1854. mutex_unlock(&wcn->hal_mutex);
  1855. return ret;
  1856. }
  1857. int wcn36xx_smd_enter_bmps(struct wcn36xx *wcn, struct ieee80211_vif *vif)
  1858. {
  1859. struct wcn36xx_hal_enter_bmps_req_msg msg_body;
  1860. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  1861. int ret;
  1862. mutex_lock(&wcn->hal_mutex);
  1863. INIT_HAL_MSG(msg_body, WCN36XX_HAL_ENTER_BMPS_REQ);
  1864. msg_body.bss_index = vif_priv->bss_index;
  1865. msg_body.tbtt = vif->bss_conf.sync_tsf;
  1866. msg_body.dtim_period = vif_priv->dtim_period;
  1867. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1868. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1869. if (ret) {
  1870. wcn36xx_err("Sending hal_enter_bmps failed\n");
  1871. goto out;
  1872. }
  1873. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  1874. if (ret) {
  1875. wcn36xx_err("hal_enter_bmps response failed err=%d\n", ret);
  1876. goto out;
  1877. }
  1878. out:
  1879. mutex_unlock(&wcn->hal_mutex);
  1880. return ret;
  1881. }
  1882. int wcn36xx_smd_exit_bmps(struct wcn36xx *wcn, struct ieee80211_vif *vif)
  1883. {
  1884. struct wcn36xx_hal_exit_bmps_req_msg msg_body;
  1885. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  1886. int ret;
  1887. mutex_lock(&wcn->hal_mutex);
  1888. INIT_HAL_MSG(msg_body, WCN36XX_HAL_EXIT_BMPS_REQ);
  1889. msg_body.bss_index = vif_priv->bss_index;
  1890. msg_body.send_data_null = 1;
  1891. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1892. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1893. if (ret) {
  1894. wcn36xx_err("Sending hal_exit_bmps failed\n");
  1895. goto out;
  1896. }
  1897. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  1898. if (ret) {
  1899. wcn36xx_err("hal_exit_bmps response failed err=%d\n", ret);
  1900. goto out;
  1901. }
  1902. out:
  1903. mutex_unlock(&wcn->hal_mutex);
  1904. return ret;
  1905. }
  1906. int wcn36xx_smd_enter_imps(struct wcn36xx *wcn)
  1907. {
  1908. struct wcn36xx_hal_enter_imps_req_msg msg_body;
  1909. int ret;
  1910. mutex_lock(&wcn->hal_mutex);
  1911. INIT_HAL_MSG(msg_body, WCN36XX_HAL_ENTER_IMPS_REQ);
  1912. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1913. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1914. if (ret) {
  1915. wcn36xx_err("Sending hal_enter_imps failed\n");
  1916. goto out;
  1917. }
  1918. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  1919. if (ret) {
  1920. wcn36xx_err("hal_enter_imps response failed err=%d\n", ret);
  1921. goto out;
  1922. }
  1923. wcn36xx_dbg(WCN36XX_DBG_HAL, "Entered idle mode\n");
  1924. out:
  1925. mutex_unlock(&wcn->hal_mutex);
  1926. return ret;
  1927. }
  1928. int wcn36xx_smd_exit_imps(struct wcn36xx *wcn)
  1929. {
  1930. struct wcn36xx_hal_exit_imps_req_msg msg_body;
  1931. int ret;
  1932. mutex_lock(&wcn->hal_mutex);
  1933. INIT_HAL_MSG(msg_body, WCN36XX_HAL_EXIT_IMPS_REQ);
  1934. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1935. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1936. if (ret) {
  1937. wcn36xx_err("Sending hal_exit_imps failed\n");
  1938. goto out;
  1939. }
  1940. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  1941. if (ret) {
  1942. wcn36xx_err("hal_exit_imps response failed err=%d\n", ret);
  1943. goto out;
  1944. }
  1945. wcn36xx_dbg(WCN36XX_DBG_HAL, "Exited idle mode\n");
  1946. out:
  1947. mutex_unlock(&wcn->hal_mutex);
  1948. return ret;
  1949. }
  1950. int wcn36xx_smd_set_power_params(struct wcn36xx *wcn, bool ignore_dtim)
  1951. {
  1952. struct wcn36xx_hal_set_power_params_req_msg msg_body;
  1953. int ret;
  1954. mutex_lock(&wcn->hal_mutex);
  1955. INIT_HAL_MSG(msg_body, WCN36XX_HAL_SET_POWER_PARAMS_REQ);
  1956. /*
  1957. * When host is down ignore every second dtim
  1958. */
  1959. if (ignore_dtim) {
  1960. msg_body.ignore_dtim = 1;
  1961. msg_body.dtim_period = 2;
  1962. }
  1963. msg_body.listen_interval = WCN36XX_LISTEN_INTERVAL(wcn);
  1964. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1965. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1966. if (ret) {
  1967. wcn36xx_err("Sending hal_set_power_params failed\n");
  1968. goto out;
  1969. }
  1970. out:
  1971. mutex_unlock(&wcn->hal_mutex);
  1972. return ret;
  1973. }
  1974. /* Notice: This function should be called after associated, or else it
  1975. * will be invalid
  1976. */
  1977. int wcn36xx_smd_keep_alive_req(struct wcn36xx *wcn,
  1978. struct ieee80211_vif *vif,
  1979. int packet_type)
  1980. {
  1981. struct wcn36xx_hal_keep_alive_req_msg msg_body;
  1982. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  1983. int ret;
  1984. mutex_lock(&wcn->hal_mutex);
  1985. INIT_HAL_MSG(msg_body, WCN36XX_HAL_KEEP_ALIVE_REQ);
  1986. if (packet_type == WCN36XX_HAL_KEEP_ALIVE_NULL_PKT) {
  1987. msg_body.bss_index = vif_priv->bss_index;
  1988. msg_body.packet_type = WCN36XX_HAL_KEEP_ALIVE_NULL_PKT;
  1989. msg_body.time_period = WCN36XX_KEEP_ALIVE_TIME_PERIOD;
  1990. } else if (packet_type == WCN36XX_HAL_KEEP_ALIVE_UNSOLICIT_ARP_RSP) {
  1991. /* TODO: it also support ARP response type */
  1992. } else {
  1993. wcn36xx_warn("unknown keep alive packet type %d\n", packet_type);
  1994. ret = -EINVAL;
  1995. goto out;
  1996. }
  1997. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  1998. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  1999. if (ret) {
  2000. wcn36xx_err("Sending hal_keep_alive failed\n");
  2001. goto out;
  2002. }
  2003. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  2004. if (ret) {
  2005. wcn36xx_err("hal_keep_alive response failed err=%d\n", ret);
  2006. goto out;
  2007. }
  2008. out:
  2009. mutex_unlock(&wcn->hal_mutex);
  2010. return ret;
  2011. }
  2012. int wcn36xx_smd_dump_cmd_req(struct wcn36xx *wcn, u32 arg1, u32 arg2,
  2013. u32 arg3, u32 arg4, u32 arg5)
  2014. {
  2015. struct wcn36xx_hal_dump_cmd_req_msg msg_body;
  2016. int ret;
  2017. mutex_lock(&wcn->hal_mutex);
  2018. INIT_HAL_MSG(msg_body, WCN36XX_HAL_DUMP_COMMAND_REQ);
  2019. msg_body.arg1 = arg1;
  2020. msg_body.arg2 = arg2;
  2021. msg_body.arg3 = arg3;
  2022. msg_body.arg4 = arg4;
  2023. msg_body.arg5 = arg5;
  2024. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  2025. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  2026. if (ret) {
  2027. wcn36xx_err("Sending hal_dump_cmd failed\n");
  2028. goto out;
  2029. }
  2030. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  2031. if (ret) {
  2032. wcn36xx_err("hal_dump_cmd response failed err=%d\n", ret);
  2033. goto out;
  2034. }
  2035. out:
  2036. mutex_unlock(&wcn->hal_mutex);
  2037. return ret;
  2038. }
  2039. int wcn36xx_smd_feature_caps_exchange(struct wcn36xx *wcn)
  2040. {
  2041. struct wcn36xx_hal_feat_caps_msg msg_body, *rsp;
  2042. int ret, i;
  2043. mutex_lock(&wcn->hal_mutex);
  2044. INIT_HAL_MSG(msg_body, WCN36XX_HAL_FEATURE_CAPS_EXCHANGE_REQ);
  2045. wcn36xx_firmware_set_feat_caps(msg_body.feat_caps, STA_POWERSAVE);
  2046. if (wcn->rf_id == RF_IRIS_WCN3680) {
  2047. wcn36xx_firmware_set_feat_caps(msg_body.feat_caps, DOT11AC);
  2048. wcn36xx_firmware_set_feat_caps(msg_body.feat_caps, WLAN_CH144);
  2049. wcn36xx_firmware_set_feat_caps(msg_body.feat_caps,
  2050. ANTENNA_DIVERSITY_SELECTION);
  2051. }
  2052. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  2053. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  2054. if (ret) {
  2055. wcn36xx_err("Sending hal_feature_caps_exchange failed\n");
  2056. goto out;
  2057. }
  2058. if (wcn->hal_rsp_len != sizeof(*rsp)) {
  2059. wcn36xx_err("Invalid hal_feature_caps_exchange response");
  2060. goto out;
  2061. }
  2062. rsp = (struct wcn36xx_hal_feat_caps_msg *) wcn->hal_buf;
  2063. for (i = 0; i < WCN36XX_HAL_CAPS_SIZE; i++)
  2064. wcn->fw_feat_caps[i] = rsp->feat_caps[i];
  2065. out:
  2066. mutex_unlock(&wcn->hal_mutex);
  2067. return ret;
  2068. }
  2069. static int wcn36xx_smd_add_ba_session_rsp(void *buf, int len, u8 *session)
  2070. {
  2071. struct wcn36xx_hal_add_ba_session_rsp_msg *rsp;
  2072. if (len < sizeof(*rsp))
  2073. return -EINVAL;
  2074. rsp = (struct wcn36xx_hal_add_ba_session_rsp_msg *)buf;
  2075. if (rsp->status != WCN36XX_FW_MSG_RESULT_SUCCESS)
  2076. return rsp->status;
  2077. *session = rsp->ba_session_id;
  2078. return 0;
  2079. }
  2080. int wcn36xx_smd_add_ba_session(struct wcn36xx *wcn,
  2081. struct ieee80211_sta *sta,
  2082. u16 tid,
  2083. u16 *ssn,
  2084. u8 direction,
  2085. u8 sta_index)
  2086. {
  2087. struct wcn36xx_hal_add_ba_session_req_msg msg_body;
  2088. u8 session_id;
  2089. int ret;
  2090. mutex_lock(&wcn->hal_mutex);
  2091. INIT_HAL_MSG(msg_body, WCN36XX_HAL_ADD_BA_SESSION_REQ);
  2092. msg_body.sta_index = sta_index;
  2093. memcpy(&msg_body.mac_addr, sta->addr, ETH_ALEN);
  2094. msg_body.dialog_token = 0x10;
  2095. msg_body.tid = tid;
  2096. /* Immediate BA because Delayed BA is not supported */
  2097. msg_body.policy = 1;
  2098. msg_body.buffer_size = WCN36XX_AGGR_BUFFER_SIZE;
  2099. msg_body.timeout = 0;
  2100. if (ssn)
  2101. msg_body.ssn = *ssn;
  2102. msg_body.direction = direction;
  2103. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  2104. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  2105. if (ret) {
  2106. wcn36xx_err("Sending hal_add_ba_session failed\n");
  2107. goto out;
  2108. }
  2109. ret = wcn36xx_smd_add_ba_session_rsp(wcn->hal_buf, wcn->hal_rsp_len,
  2110. &session_id);
  2111. if (ret) {
  2112. wcn36xx_err("hal_add_ba_session response failed err=%d\n", ret);
  2113. ret = -EINVAL;
  2114. goto out;
  2115. }
  2116. ret = session_id;
  2117. out:
  2118. mutex_unlock(&wcn->hal_mutex);
  2119. return ret;
  2120. }
  2121. int wcn36xx_smd_add_ba(struct wcn36xx *wcn, u8 session_id)
  2122. {
  2123. struct wcn36xx_hal_add_ba_req_msg msg_body;
  2124. int ret;
  2125. mutex_lock(&wcn->hal_mutex);
  2126. INIT_HAL_MSG(msg_body, WCN36XX_HAL_ADD_BA_REQ);
  2127. msg_body.session_id = session_id;
  2128. msg_body.win_size = WCN36XX_AGGR_BUFFER_SIZE;
  2129. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  2130. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  2131. if (ret) {
  2132. wcn36xx_err("Sending hal_add_ba failed\n");
  2133. goto out;
  2134. }
  2135. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  2136. if (ret) {
  2137. wcn36xx_err("hal_add_ba response failed err=%d\n", ret);
  2138. goto out;
  2139. }
  2140. out:
  2141. mutex_unlock(&wcn->hal_mutex);
  2142. return ret;
  2143. }
  2144. int wcn36xx_smd_del_ba(struct wcn36xx *wcn, u16 tid, u8 direction, u8 sta_index)
  2145. {
  2146. struct wcn36xx_hal_del_ba_req_msg msg_body;
  2147. int ret;
  2148. mutex_lock(&wcn->hal_mutex);
  2149. INIT_HAL_MSG(msg_body, WCN36XX_HAL_DEL_BA_REQ);
  2150. msg_body.sta_index = sta_index;
  2151. msg_body.tid = tid;
  2152. msg_body.direction = direction;
  2153. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  2154. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  2155. if (ret) {
  2156. wcn36xx_err("Sending hal_del_ba failed\n");
  2157. goto out;
  2158. }
  2159. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  2160. if (ret) {
  2161. wcn36xx_err("hal_del_ba response failed err=%d\n", ret);
  2162. goto out;
  2163. }
  2164. out:
  2165. mutex_unlock(&wcn->hal_mutex);
  2166. return ret;
  2167. }
  2168. int wcn36xx_smd_get_stats(struct wcn36xx *wcn, u8 sta_index, u32 stats_mask,
  2169. struct station_info *sinfo)
  2170. {
  2171. struct wcn36xx_hal_stats_req_msg msg_body;
  2172. struct wcn36xx_hal_stats_rsp_msg *rsp;
  2173. void *rsp_body;
  2174. int ret;
  2175. if (stats_mask & ~HAL_GLOBAL_CLASS_A_STATS_INFO) {
  2176. wcn36xx_err("stats_mask 0x%x contains unimplemented types\n",
  2177. stats_mask);
  2178. return -EINVAL;
  2179. }
  2180. mutex_lock(&wcn->hal_mutex);
  2181. INIT_HAL_MSG(msg_body, WCN36XX_HAL_GET_STATS_REQ);
  2182. msg_body.sta_id = sta_index;
  2183. msg_body.stats_mask = stats_mask;
  2184. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  2185. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  2186. if (ret) {
  2187. wcn36xx_err("sending hal_get_stats failed\n");
  2188. goto out;
  2189. }
  2190. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  2191. if (ret) {
  2192. wcn36xx_err("hal_get_stats response failed err=%d\n", ret);
  2193. goto out;
  2194. }
  2195. rsp = (struct wcn36xx_hal_stats_rsp_msg *)wcn->hal_buf;
  2196. rsp_body = (wcn->hal_buf + sizeof(struct wcn36xx_hal_stats_rsp_msg));
  2197. if (rsp->stats_mask != stats_mask) {
  2198. wcn36xx_err("stats_mask 0x%x differs from requested 0x%x\n",
  2199. rsp->stats_mask, stats_mask);
  2200. goto out;
  2201. }
  2202. if (rsp->stats_mask & HAL_GLOBAL_CLASS_A_STATS_INFO) {
  2203. struct ani_global_class_a_stats_info *stats_info = rsp_body;
  2204. wcn36xx_process_tx_rate(stats_info, &sinfo->txrate);
  2205. sinfo->filled |= BIT_ULL(NL80211_STA_INFO_TX_BITRATE);
  2206. rsp_body += sizeof(struct ani_global_class_a_stats_info);
  2207. }
  2208. out:
  2209. mutex_unlock(&wcn->hal_mutex);
  2210. return ret;
  2211. }
  2212. static int wcn36xx_smd_trigger_ba_rsp(void *buf, int len, struct add_ba_info *ba_info)
  2213. {
  2214. struct wcn36xx_hal_trigger_ba_rsp_candidate *candidate;
  2215. struct wcn36xx_hal_trigger_ba_rsp_msg *rsp;
  2216. int i;
  2217. if (len < sizeof(*rsp))
  2218. return -EINVAL;
  2219. rsp = (struct wcn36xx_hal_trigger_ba_rsp_msg *) buf;
  2220. if (rsp->candidate_cnt < 1)
  2221. return rsp->status ? rsp->status : -EINVAL;
  2222. candidate = (struct wcn36xx_hal_trigger_ba_rsp_candidate *)(buf + sizeof(*rsp));
  2223. for (i = 0; i < STACFG_MAX_TC; i++) {
  2224. ba_info[i] = candidate->ba_info[i];
  2225. }
  2226. return rsp->status;
  2227. }
  2228. int wcn36xx_smd_trigger_ba(struct wcn36xx *wcn, u8 sta_index, u16 tid, u16 *ssn)
  2229. {
  2230. struct wcn36xx_hal_trigger_ba_req_msg msg_body;
  2231. struct wcn36xx_hal_trigger_ba_req_candidate *candidate;
  2232. struct add_ba_info ba_info[STACFG_MAX_TC];
  2233. int ret;
  2234. if (tid >= STACFG_MAX_TC)
  2235. return -EINVAL;
  2236. mutex_lock(&wcn->hal_mutex);
  2237. INIT_HAL_MSG(msg_body, WCN36XX_HAL_TRIGGER_BA_REQ);
  2238. msg_body.session_id = 0; /* not really used */
  2239. msg_body.candidate_cnt = 1;
  2240. msg_body.header.len += sizeof(*candidate);
  2241. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  2242. candidate = (struct wcn36xx_hal_trigger_ba_req_candidate *)
  2243. (wcn->hal_buf + sizeof(msg_body));
  2244. candidate->sta_index = sta_index;
  2245. candidate->tid_bitmap = 1 << tid;
  2246. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  2247. if (ret) {
  2248. wcn36xx_err("Sending hal_trigger_ba failed\n");
  2249. goto out;
  2250. }
  2251. ret = wcn36xx_smd_trigger_ba_rsp(wcn->hal_buf, wcn->hal_rsp_len, ba_info);
  2252. if (ret) {
  2253. wcn36xx_err("hal_trigger_ba response failed err=%d\n", ret);
  2254. goto out;
  2255. }
  2256. out:
  2257. mutex_unlock(&wcn->hal_mutex);
  2258. if (ssn)
  2259. *ssn = ba_info[tid].starting_seq_num;
  2260. return ret;
  2261. }
  2262. static int wcn36xx_smd_tx_compl_ind(struct wcn36xx *wcn, void *buf, size_t len)
  2263. {
  2264. struct wcn36xx_hal_tx_compl_ind_msg *rsp = buf;
  2265. if (len != sizeof(*rsp)) {
  2266. wcn36xx_warn("Bad TX complete indication\n");
  2267. return -EIO;
  2268. }
  2269. wcn36xx_dxe_tx_ack_ind(wcn, rsp->status);
  2270. return 0;
  2271. }
  2272. static int wcn36xx_smd_hw_scan_ind(struct wcn36xx *wcn, void *buf, size_t len)
  2273. {
  2274. struct wcn36xx_hal_scan_offload_ind *rsp = buf;
  2275. struct cfg80211_scan_info scan_info = {};
  2276. if (len != sizeof(*rsp)) {
  2277. wcn36xx_warn("Corrupted delete scan indication\n");
  2278. return -EIO;
  2279. }
  2280. wcn36xx_dbg(WCN36XX_DBG_HAL, "scan indication (type %x)\n", rsp->type);
  2281. switch (rsp->type) {
  2282. case WCN36XX_HAL_SCAN_IND_FAILED:
  2283. case WCN36XX_HAL_SCAN_IND_DEQUEUED:
  2284. scan_info.aborted = true;
  2285. fallthrough;
  2286. case WCN36XX_HAL_SCAN_IND_COMPLETED:
  2287. mutex_lock(&wcn->scan_lock);
  2288. wcn->scan_req = NULL;
  2289. if (wcn->scan_aborted)
  2290. scan_info.aborted = true;
  2291. mutex_unlock(&wcn->scan_lock);
  2292. ieee80211_scan_completed(wcn->hw, &scan_info);
  2293. break;
  2294. case WCN36XX_HAL_SCAN_IND_STARTED:
  2295. case WCN36XX_HAL_SCAN_IND_FOREIGN_CHANNEL:
  2296. case WCN36XX_HAL_SCAN_IND_PREEMPTED:
  2297. case WCN36XX_HAL_SCAN_IND_RESTARTED:
  2298. break;
  2299. default:
  2300. wcn36xx_warn("Unknown scan indication type %x\n", rsp->type);
  2301. }
  2302. return 0;
  2303. }
  2304. static int wcn36xx_smd_missed_beacon_ind(struct wcn36xx *wcn,
  2305. void *buf,
  2306. size_t len)
  2307. {
  2308. struct wcn36xx_hal_missed_beacon_ind_msg *rsp = buf;
  2309. struct ieee80211_vif *vif = NULL;
  2310. struct wcn36xx_vif *tmp;
  2311. /* Old FW does not have bss index */
  2312. if (wcn36xx_is_fw_version(wcn, 1, 2, 2, 24)) {
  2313. list_for_each_entry(tmp, &wcn->vif_list, list) {
  2314. wcn36xx_dbg(WCN36XX_DBG_HAL, "beacon missed bss_index %d\n",
  2315. tmp->bss_index);
  2316. vif = wcn36xx_priv_to_vif(tmp);
  2317. ieee80211_beacon_loss(vif);
  2318. }
  2319. return 0;
  2320. }
  2321. if (len != sizeof(*rsp)) {
  2322. wcn36xx_warn("Corrupted missed beacon indication\n");
  2323. return -EIO;
  2324. }
  2325. list_for_each_entry(tmp, &wcn->vif_list, list) {
  2326. if (tmp->bss_index == rsp->bss_index) {
  2327. wcn36xx_dbg(WCN36XX_DBG_HAL, "beacon missed bss_index %d\n",
  2328. rsp->bss_index);
  2329. vif = wcn36xx_priv_to_vif(tmp);
  2330. ieee80211_beacon_loss(vif);
  2331. return 0;
  2332. }
  2333. }
  2334. wcn36xx_warn("BSS index %d not found\n", rsp->bss_index);
  2335. return -ENOENT;
  2336. }
  2337. static int wcn36xx_smd_delete_sta_context_ind(struct wcn36xx *wcn,
  2338. void *buf,
  2339. size_t len)
  2340. {
  2341. struct wcn36xx_hal_delete_sta_context_ind_msg *rsp = buf;
  2342. struct wcn36xx_vif *vif_priv;
  2343. struct ieee80211_vif *vif;
  2344. struct ieee80211_bss_conf *bss_conf;
  2345. struct ieee80211_sta *sta;
  2346. bool found = false;
  2347. if (len != sizeof(*rsp)) {
  2348. wcn36xx_warn("Corrupted delete sta indication\n");
  2349. return -EIO;
  2350. }
  2351. wcn36xx_dbg(WCN36XX_DBG_HAL,
  2352. "delete station indication %pM index %d reason %d\n",
  2353. rsp->addr2, rsp->sta_id, rsp->reason_code);
  2354. list_for_each_entry(vif_priv, &wcn->vif_list, list) {
  2355. rcu_read_lock();
  2356. vif = wcn36xx_priv_to_vif(vif_priv);
  2357. if (vif->type == NL80211_IFTYPE_STATION) {
  2358. /* We could call ieee80211_find_sta too, but checking
  2359. * bss_conf is clearer.
  2360. */
  2361. bss_conf = &vif->bss_conf;
  2362. if (vif_priv->sta_assoc &&
  2363. !memcmp(bss_conf->bssid, rsp->addr2, ETH_ALEN)) {
  2364. found = true;
  2365. wcn36xx_dbg(WCN36XX_DBG_HAL,
  2366. "connection loss bss_index %d\n",
  2367. vif_priv->bss_index);
  2368. ieee80211_connection_loss(vif);
  2369. }
  2370. } else {
  2371. sta = ieee80211_find_sta(vif, rsp->addr2);
  2372. if (sta) {
  2373. found = true;
  2374. ieee80211_report_low_ack(sta, 0);
  2375. }
  2376. }
  2377. rcu_read_unlock();
  2378. if (found)
  2379. return 0;
  2380. }
  2381. wcn36xx_warn("BSS or STA with addr %pM not found\n", rsp->addr2);
  2382. return -ENOENT;
  2383. }
  2384. static int wcn36xx_smd_print_reg_info_ind(struct wcn36xx *wcn,
  2385. void *buf,
  2386. size_t len)
  2387. {
  2388. struct wcn36xx_hal_print_reg_info_ind *rsp = buf;
  2389. int i;
  2390. if (len < sizeof(*rsp)) {
  2391. wcn36xx_warn("Corrupted print reg info indication\n");
  2392. return -EIO;
  2393. }
  2394. wcn36xx_dbg(WCN36XX_DBG_HAL,
  2395. "reginfo indication, scenario: 0x%x reason: 0x%x\n",
  2396. rsp->scenario, rsp->reason);
  2397. for (i = 0; i < rsp->count; i++) {
  2398. wcn36xx_dbg(WCN36XX_DBG_HAL, "\t0x%x: 0x%x\n",
  2399. rsp->regs[i].addr, rsp->regs[i].value);
  2400. }
  2401. return 0;
  2402. }
  2403. int wcn36xx_smd_update_cfg(struct wcn36xx *wcn, u32 cfg_id, u32 value)
  2404. {
  2405. struct wcn36xx_hal_update_cfg_req_msg msg_body, *body;
  2406. size_t len;
  2407. int ret;
  2408. mutex_lock(&wcn->hal_mutex);
  2409. INIT_HAL_MSG(msg_body, WCN36XX_HAL_UPDATE_CFG_REQ);
  2410. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  2411. body = (struct wcn36xx_hal_update_cfg_req_msg *) wcn->hal_buf;
  2412. len = msg_body.header.len;
  2413. put_cfg_tlv_u32(wcn, &len, cfg_id, value);
  2414. body->header.len = len;
  2415. body->len = len - sizeof(*body);
  2416. ret = wcn36xx_smd_send_and_wait(wcn, body->header.len);
  2417. if (ret) {
  2418. wcn36xx_err("Sending hal_update_cfg failed\n");
  2419. goto out;
  2420. }
  2421. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  2422. if (ret) {
  2423. wcn36xx_err("hal_update_cfg response failed err=%d\n", ret);
  2424. goto out;
  2425. }
  2426. out:
  2427. mutex_unlock(&wcn->hal_mutex);
  2428. return ret;
  2429. }
  2430. int wcn36xx_smd_set_mc_list(struct wcn36xx *wcn,
  2431. struct ieee80211_vif *vif,
  2432. struct wcn36xx_hal_rcv_flt_mc_addr_list_type *fp)
  2433. {
  2434. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  2435. struct wcn36xx_hal_rcv_flt_pkt_set_mc_list_req_msg *msg_body = NULL;
  2436. int ret;
  2437. mutex_lock(&wcn->hal_mutex);
  2438. msg_body = (struct wcn36xx_hal_rcv_flt_pkt_set_mc_list_req_msg *)
  2439. wcn->hal_buf;
  2440. INIT_HAL_MSG(*msg_body, WCN36XX_HAL_8023_MULTICAST_LIST_REQ);
  2441. /* An empty list means all mc traffic will be received */
  2442. if (fp)
  2443. memcpy(&msg_body->mc_addr_list, fp,
  2444. sizeof(msg_body->mc_addr_list));
  2445. else
  2446. msg_body->mc_addr_list.mc_addr_count = 0;
  2447. msg_body->mc_addr_list.bss_index = vif_priv->bss_index;
  2448. ret = wcn36xx_smd_send_and_wait(wcn, msg_body->header.len);
  2449. if (ret) {
  2450. wcn36xx_err("Sending HAL_8023_MULTICAST_LIST failed\n");
  2451. goto out;
  2452. }
  2453. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  2454. if (ret) {
  2455. wcn36xx_err("HAL_8023_MULTICAST_LIST rsp failed err=%d\n", ret);
  2456. goto out;
  2457. }
  2458. out:
  2459. mutex_unlock(&wcn->hal_mutex);
  2460. return ret;
  2461. }
  2462. int wcn36xx_smd_arp_offload(struct wcn36xx *wcn, struct ieee80211_vif *vif,
  2463. bool enable)
  2464. {
  2465. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  2466. struct wcn36xx_hal_host_offload_req_msg msg_body;
  2467. int ret;
  2468. mutex_lock(&wcn->hal_mutex);
  2469. INIT_HAL_MSG(msg_body, WCN36XX_HAL_HOST_OFFLOAD_REQ);
  2470. msg_body.host_offload_params.offload_type =
  2471. WCN36XX_HAL_IPV4_ARP_REPLY_OFFLOAD;
  2472. if (enable) {
  2473. msg_body.host_offload_params.enable =
  2474. WCN36XX_HAL_OFFLOAD_ARP_AND_BCAST_FILTER_ENABLE;
  2475. memcpy(&msg_body.host_offload_params.u,
  2476. &vif->cfg.arp_addr_list[0], sizeof(__be32));
  2477. }
  2478. msg_body.ns_offload_params.bss_index = vif_priv->bss_index;
  2479. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  2480. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  2481. if (ret) {
  2482. wcn36xx_err("Sending host_offload_arp failed\n");
  2483. goto out;
  2484. }
  2485. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  2486. if (ret) {
  2487. wcn36xx_err("host_offload_arp failed err=%d\n", ret);
  2488. goto out;
  2489. }
  2490. out:
  2491. mutex_unlock(&wcn->hal_mutex);
  2492. return ret;
  2493. }
  2494. #if IS_ENABLED(CONFIG_IPV6)
  2495. int wcn36xx_smd_ipv6_ns_offload(struct wcn36xx *wcn, struct ieee80211_vif *vif,
  2496. bool enable)
  2497. {
  2498. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  2499. struct wcn36xx_hal_host_offload_req_msg msg_body;
  2500. struct wcn36xx_hal_ns_offload_params *ns_params;
  2501. struct wcn36xx_hal_host_offload_req *ho_params;
  2502. int ret;
  2503. mutex_lock(&wcn->hal_mutex);
  2504. INIT_HAL_MSG(msg_body, WCN36XX_HAL_HOST_OFFLOAD_REQ);
  2505. ho_params = &msg_body.host_offload_params;
  2506. ns_params = &msg_body.ns_offload_params;
  2507. ho_params->offload_type = WCN36XX_HAL_IPV6_NS_OFFLOAD;
  2508. if (enable) {
  2509. ho_params->enable =
  2510. WCN36XX_HAL_OFFLOAD_NS_AND_MCAST_FILTER_ENABLE;
  2511. if (vif_priv->num_target_ipv6_addrs) {
  2512. memcpy(&ho_params->u,
  2513. &vif_priv->target_ipv6_addrs[0].in6_u,
  2514. sizeof(struct in6_addr));
  2515. memcpy(&ns_params->target_ipv6_addr1,
  2516. &vif_priv->target_ipv6_addrs[0].in6_u,
  2517. sizeof(struct in6_addr));
  2518. ns_params->target_ipv6_addr1_valid = 1;
  2519. }
  2520. if (vif_priv->num_target_ipv6_addrs > 1) {
  2521. memcpy(&ns_params->target_ipv6_addr2,
  2522. &vif_priv->target_ipv6_addrs[1].in6_u,
  2523. sizeof(struct in6_addr));
  2524. ns_params->target_ipv6_addr2_valid = 1;
  2525. }
  2526. }
  2527. memcpy(&ns_params->self_addr, vif->addr, ETH_ALEN);
  2528. ns_params->bss_index = vif_priv->bss_index;
  2529. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  2530. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  2531. if (ret) {
  2532. wcn36xx_err("Sending host_offload_arp failed\n");
  2533. goto out;
  2534. }
  2535. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  2536. if (ret) {
  2537. wcn36xx_err("host_offload_arp failed err=%d\n", ret);
  2538. goto out;
  2539. }
  2540. out:
  2541. mutex_unlock(&wcn->hal_mutex);
  2542. return ret;
  2543. }
  2544. #else
  2545. int wcn36xx_smd_ipv6_ns_offload(struct wcn36xx *wcn, struct ieee80211_vif *vif,
  2546. bool enable)
  2547. {
  2548. return 0;
  2549. }
  2550. #endif
  2551. int wcn36xx_smd_gtk_offload(struct wcn36xx *wcn, struct ieee80211_vif *vif,
  2552. bool enable)
  2553. {
  2554. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  2555. struct wcn36xx_hal_gtk_offload_req_msg msg_body;
  2556. int ret;
  2557. mutex_lock(&wcn->hal_mutex);
  2558. INIT_HAL_MSG(msg_body, WCN36XX_HAL_GTK_OFFLOAD_REQ);
  2559. if (enable) {
  2560. memcpy(&msg_body.kek, vif_priv->rekey_data.kek, NL80211_KEK_LEN);
  2561. memcpy(&msg_body.kck, vif_priv->rekey_data.kck, NL80211_KCK_LEN);
  2562. msg_body.key_replay_counter =
  2563. le64_to_cpu(vif_priv->rekey_data.replay_ctr);
  2564. msg_body.bss_index = vif_priv->bss_index;
  2565. } else {
  2566. msg_body.flags = WCN36XX_HAL_GTK_OFFLOAD_FLAGS_DISABLE;
  2567. }
  2568. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  2569. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  2570. if (ret) {
  2571. wcn36xx_err("Sending host_offload_arp failed\n");
  2572. goto out;
  2573. }
  2574. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  2575. if (ret) {
  2576. wcn36xx_err("host_offload_arp failed err=%d\n", ret);
  2577. goto out;
  2578. }
  2579. out:
  2580. mutex_unlock(&wcn->hal_mutex);
  2581. return ret;
  2582. }
  2583. static int wcn36xx_smd_gtk_offload_get_info_rsp(struct wcn36xx *wcn,
  2584. struct ieee80211_vif *vif)
  2585. {
  2586. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  2587. struct wcn36xx_hal_gtk_offload_get_info_rsp_msg *rsp;
  2588. __be64 replay_ctr;
  2589. if (wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len))
  2590. return -EIO;
  2591. rsp = (struct wcn36xx_hal_gtk_offload_get_info_rsp_msg *)wcn->hal_buf;
  2592. if (rsp->bss_index != vif_priv->bss_index) {
  2593. wcn36xx_err("gtk_offload_info invalid response bss index %d\n",
  2594. rsp->bss_index);
  2595. return -ENOENT;
  2596. }
  2597. if (vif_priv->rekey_data.replay_ctr != cpu_to_le64(rsp->key_replay_counter)) {
  2598. replay_ctr = cpu_to_be64(rsp->key_replay_counter);
  2599. vif_priv->rekey_data.replay_ctr =
  2600. cpu_to_le64(rsp->key_replay_counter);
  2601. ieee80211_gtk_rekey_notify(vif, vif->bss_conf.bssid,
  2602. (void *)&replay_ctr, GFP_KERNEL);
  2603. wcn36xx_dbg(WCN36XX_DBG_HAL,
  2604. "GTK replay counter increment %llu\n",
  2605. rsp->key_replay_counter);
  2606. }
  2607. wcn36xx_dbg(WCN36XX_DBG_HAL,
  2608. "gtk offload info status %d last_rekey_status %d "
  2609. "replay_counter %llu total_rekey_count %d gtk_rekey_count %d "
  2610. "igtk_rekey_count %d bss_index %d\n",
  2611. rsp->status, rsp->last_rekey_status,
  2612. rsp->key_replay_counter, rsp->total_rekey_count,
  2613. rsp->gtk_rekey_count, rsp->igtk_rekey_count,
  2614. rsp->bss_index);
  2615. return 0;
  2616. }
  2617. int wcn36xx_smd_gtk_offload_get_info(struct wcn36xx *wcn,
  2618. struct ieee80211_vif *vif)
  2619. {
  2620. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  2621. struct wcn36xx_hal_gtk_offload_get_info_req_msg msg_body;
  2622. int ret;
  2623. mutex_lock(&wcn->hal_mutex);
  2624. INIT_HAL_MSG(msg_body, WCN36XX_HAL_GTK_OFFLOAD_GETINFO_REQ);
  2625. msg_body.bss_index = vif_priv->bss_index;
  2626. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  2627. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  2628. if (ret) {
  2629. wcn36xx_err("Sending gtk_offload_get_info failed\n");
  2630. goto out;
  2631. }
  2632. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  2633. if (ret) {
  2634. wcn36xx_err("gtk_offload_get_info failed err=%d\n", ret);
  2635. goto out;
  2636. }
  2637. ret = wcn36xx_smd_gtk_offload_get_info_rsp(wcn, vif);
  2638. out:
  2639. mutex_unlock(&wcn->hal_mutex);
  2640. return ret;
  2641. }
  2642. int wcn36xx_smd_wlan_host_suspend_ind(struct wcn36xx *wcn)
  2643. {
  2644. struct wcn36xx_hal_wlan_host_suspend_ind_msg msg_body;
  2645. int ret;
  2646. mutex_lock(&wcn->hal_mutex);
  2647. INIT_HAL_MSG(msg_body, WCN36XX_HAL_HOST_SUSPEND_IND);
  2648. msg_body.configured_mcst_bcst_filter_setting = 0;
  2649. msg_body.active_session_count = 1;
  2650. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  2651. ret = rpmsg_send(wcn->smd_channel, wcn->hal_buf, msg_body.header.len);
  2652. mutex_unlock(&wcn->hal_mutex);
  2653. return ret;
  2654. }
  2655. int wcn36xx_smd_host_resume(struct wcn36xx *wcn)
  2656. {
  2657. struct wcn36xx_hal_wlan_host_resume_req_msg msg_body;
  2658. struct wcn36xx_hal_host_resume_rsp_msg *rsp;
  2659. int ret;
  2660. mutex_lock(&wcn->hal_mutex);
  2661. INIT_HAL_MSG(msg_body, WCN36XX_HAL_HOST_RESUME_REQ);
  2662. msg_body.configured_mcst_bcst_filter_setting = 0;
  2663. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  2664. ret = wcn36xx_smd_send_and_wait(wcn, msg_body.header.len);
  2665. if (ret) {
  2666. wcn36xx_err("Sending wlan_host_resume failed\n");
  2667. goto out;
  2668. }
  2669. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  2670. if (ret) {
  2671. wcn36xx_err("wlan_host_resume err=%d\n", ret);
  2672. goto out;
  2673. }
  2674. rsp = (struct wcn36xx_hal_host_resume_rsp_msg *)wcn->hal_buf;
  2675. if (rsp->status)
  2676. wcn36xx_warn("wlan_host_resume status=%d\n", rsp->status);
  2677. out:
  2678. mutex_unlock(&wcn->hal_mutex);
  2679. return ret;
  2680. }
  2681. #define BEACON_FILTER(eid, presence, offs, val, mask, ref_val) \
  2682. { \
  2683. .element_id = eid, \
  2684. .check_ie_presence = presence, \
  2685. .offset = offs, \
  2686. .value = val, \
  2687. .bitmask = mask, \
  2688. .ref = ref_val, \
  2689. }
  2690. static const struct beacon_filter_ie bcn_filter_ies[] = {
  2691. BEACON_FILTER(WLAN_EID_DS_PARAMS, 0, 0, 0,
  2692. WCN36XX_FILTER_IE_DS_CHANNEL_MASK, 0),
  2693. BEACON_FILTER(WLAN_EID_ERP_INFO, 0, 0, 0,
  2694. WCN36XX_FILTER_IE_ERP_FILTER_MASK, 0),
  2695. BEACON_FILTER(WLAN_EID_EDCA_PARAM_SET, 0, 0, 0,
  2696. WCN36XX_FILTER_IE_EDCA_FILTER_MASK, 0),
  2697. BEACON_FILTER(WLAN_EID_QOS_CAPA, 0, 0, 0,
  2698. WCN36XX_FILTER_IE_QOS_FILTER_MASK, 0),
  2699. BEACON_FILTER(WLAN_EID_CHANNEL_SWITCH, 1, 0, 0,
  2700. WCN36XX_FILTER_IE_CHANNEL_SWITCH_MASK, 0),
  2701. BEACON_FILTER(WLAN_EID_HT_OPERATION, 0, 0, 0,
  2702. WCN36XX_FILTER_IE_HT_BYTE0_FILTER_MASK, 0),
  2703. BEACON_FILTER(WLAN_EID_HT_OPERATION, 0, 2, 0,
  2704. WCN36XX_FILTER_IE_HT_BYTE2_FILTER_MASK, 0),
  2705. BEACON_FILTER(WLAN_EID_HT_OPERATION, 0, 5, 0,
  2706. WCN36XX_FILTER_IE_HT_BYTE5_FILTER_MASK, 0),
  2707. BEACON_FILTER(WLAN_EID_PWR_CONSTRAINT, 0, 0, 0,
  2708. WCN36XX_FILTER_IE_PWR_CONSTRAINT_MASK, 0),
  2709. BEACON_FILTER(WLAN_EID_OPMODE_NOTIF, 0, 0, 0,
  2710. WCN36XX_FILTER_IE_OPMODE_NOTIF_MASK, 0),
  2711. BEACON_FILTER(WLAN_EID_VHT_OPERATION, 0, 0, 0,
  2712. WCN36XX_FILTER_IE_VHTOP_CHWIDTH_MASK, 0),
  2713. BEACON_FILTER(WLAN_EID_RSN, 1, 0, 0,
  2714. WCN36XX_FILTER_IE_RSN_MASK, 0),
  2715. BEACON_FILTER(WLAN_EID_VENDOR_SPECIFIC, 1, 0, 0,
  2716. WCN36XX_FILTER_IE_VENDOR_MASK, 0),
  2717. };
  2718. int wcn36xx_smd_add_beacon_filter(struct wcn36xx *wcn,
  2719. struct ieee80211_vif *vif)
  2720. {
  2721. struct wcn36xx_hal_add_bcn_filter_req_msg msg_body, *body;
  2722. struct wcn36xx_vif *vif_priv = wcn36xx_vif_to_priv(vif);
  2723. u8 *payload;
  2724. size_t payload_size;
  2725. int ret;
  2726. if (!wcn36xx_firmware_get_feat_caps(wcn->fw_feat_caps, BCN_FILTER))
  2727. return -EOPNOTSUPP;
  2728. mutex_lock(&wcn->hal_mutex);
  2729. INIT_HAL_MSG(msg_body, WCN36XX_HAL_ADD_BCN_FILTER_REQ);
  2730. PREPARE_HAL_BUF(wcn->hal_buf, msg_body);
  2731. body = (struct wcn36xx_hal_add_bcn_filter_req_msg *)wcn->hal_buf;
  2732. body->capability_info = vif->bss_conf.assoc_capability;
  2733. body->capability_mask = WCN36XX_FILTER_CAPABILITY_MASK;
  2734. body->beacon_interval = vif->bss_conf.beacon_int;
  2735. body->ie_num = ARRAY_SIZE(bcn_filter_ies);
  2736. body->bss_index = vif_priv->bss_index;
  2737. payload = ((u8 *)body) + body->header.len;
  2738. payload_size = sizeof(bcn_filter_ies);
  2739. memcpy(payload, &bcn_filter_ies, payload_size);
  2740. body->header.len += payload_size;
  2741. ret = wcn36xx_smd_send_and_wait(wcn, body->header.len);
  2742. if (ret) {
  2743. wcn36xx_err("Sending add bcn_filter failed\n");
  2744. goto out;
  2745. }
  2746. ret = wcn36xx_smd_rsp_status_check(wcn->hal_buf, wcn->hal_rsp_len);
  2747. if (ret) {
  2748. wcn36xx_err("add bcn filter response failed err=%d\n", ret);
  2749. goto out;
  2750. }
  2751. out:
  2752. mutex_unlock(&wcn->hal_mutex);
  2753. return ret;
  2754. }
  2755. int wcn36xx_smd_rsp_process(struct rpmsg_device *rpdev,
  2756. void *buf, int len, void *priv, u32 addr)
  2757. {
  2758. const struct wcn36xx_hal_msg_header *msg_header = buf;
  2759. struct ieee80211_hw *hw = priv;
  2760. struct wcn36xx *wcn = hw->priv;
  2761. struct wcn36xx_hal_ind_msg *msg_ind;
  2762. wcn36xx_dbg_dump(WCN36XX_DBG_SMD_DUMP, "SMD <<< ", buf, len);
  2763. switch (msg_header->msg_type) {
  2764. case WCN36XX_HAL_START_RSP:
  2765. case WCN36XX_HAL_CONFIG_STA_RSP:
  2766. case WCN36XX_HAL_CONFIG_BSS_RSP:
  2767. case WCN36XX_HAL_ADD_STA_SELF_RSP:
  2768. case WCN36XX_HAL_STOP_RSP:
  2769. case WCN36XX_HAL_DEL_STA_SELF_RSP:
  2770. case WCN36XX_HAL_DELETE_STA_RSP:
  2771. case WCN36XX_HAL_INIT_SCAN_RSP:
  2772. case WCN36XX_HAL_START_SCAN_RSP:
  2773. case WCN36XX_HAL_END_SCAN_RSP:
  2774. case WCN36XX_HAL_FINISH_SCAN_RSP:
  2775. case WCN36XX_HAL_DOWNLOAD_NV_RSP:
  2776. case WCN36XX_HAL_DELETE_BSS_RSP:
  2777. case WCN36XX_HAL_SEND_BEACON_RSP:
  2778. case WCN36XX_HAL_SET_LINK_ST_RSP:
  2779. case WCN36XX_HAL_UPDATE_PROBE_RSP_TEMPLATE_RSP:
  2780. case WCN36XX_HAL_SET_BSSKEY_RSP:
  2781. case WCN36XX_HAL_SET_STAKEY_RSP:
  2782. case WCN36XX_HAL_RMV_STAKEY_RSP:
  2783. case WCN36XX_HAL_RMV_BSSKEY_RSP:
  2784. case WCN36XX_HAL_ENTER_BMPS_RSP:
  2785. case WCN36XX_HAL_SET_POWER_PARAMS_RSP:
  2786. case WCN36XX_HAL_EXIT_BMPS_RSP:
  2787. case WCN36XX_HAL_KEEP_ALIVE_RSP:
  2788. case WCN36XX_HAL_DUMP_COMMAND_RSP:
  2789. case WCN36XX_HAL_ADD_BA_SESSION_RSP:
  2790. case WCN36XX_HAL_ADD_BA_RSP:
  2791. case WCN36XX_HAL_DEL_BA_RSP:
  2792. case WCN36XX_HAL_GET_STATS_RSP:
  2793. case WCN36XX_HAL_TRIGGER_BA_RSP:
  2794. case WCN36XX_HAL_UPDATE_CFG_RSP:
  2795. case WCN36XX_HAL_JOIN_RSP:
  2796. case WCN36XX_HAL_UPDATE_SCAN_PARAM_RSP:
  2797. case WCN36XX_HAL_CH_SWITCH_RSP:
  2798. case WCN36XX_HAL_PROCESS_PTT_RSP:
  2799. case WCN36XX_HAL_FEATURE_CAPS_EXCHANGE_RSP:
  2800. case WCN36XX_HAL_8023_MULTICAST_LIST_RSP:
  2801. case WCN36XX_HAL_START_SCAN_OFFLOAD_RSP:
  2802. case WCN36XX_HAL_STOP_SCAN_OFFLOAD_RSP:
  2803. case WCN36XX_HAL_HOST_OFFLOAD_RSP:
  2804. case WCN36XX_HAL_GTK_OFFLOAD_RSP:
  2805. case WCN36XX_HAL_GTK_OFFLOAD_GETINFO_RSP:
  2806. case WCN36XX_HAL_HOST_RESUME_RSP:
  2807. case WCN36XX_HAL_ENTER_IMPS_RSP:
  2808. case WCN36XX_HAL_EXIT_IMPS_RSP:
  2809. case WCN36XX_HAL_UPDATE_CHANNEL_LIST_RSP:
  2810. case WCN36XX_HAL_ADD_BCN_FILTER_RSP:
  2811. memcpy(wcn->hal_buf, buf, len);
  2812. wcn->hal_rsp_len = len;
  2813. complete(&wcn->hal_rsp_compl);
  2814. break;
  2815. case WCN36XX_HAL_COEX_IND:
  2816. case WCN36XX_HAL_AVOID_FREQ_RANGE_IND:
  2817. case WCN36XX_HAL_DEL_BA_IND:
  2818. case WCN36XX_HAL_OTA_TX_COMPL_IND:
  2819. case WCN36XX_HAL_MISSED_BEACON_IND:
  2820. case WCN36XX_HAL_DELETE_STA_CONTEXT_IND:
  2821. case WCN36XX_HAL_PRINT_REG_INFO_IND:
  2822. case WCN36XX_HAL_SCAN_OFFLOAD_IND:
  2823. msg_ind = kmalloc(struct_size(msg_ind, msg, len), GFP_ATOMIC);
  2824. if (!msg_ind) {
  2825. wcn36xx_err("Run out of memory while handling SMD_EVENT (%d)\n",
  2826. msg_header->msg_type);
  2827. return -ENOMEM;
  2828. }
  2829. msg_ind->msg_len = len;
  2830. memcpy(msg_ind->msg, buf, len);
  2831. spin_lock(&wcn->hal_ind_lock);
  2832. list_add_tail(&msg_ind->list, &wcn->hal_ind_queue);
  2833. queue_work(wcn->hal_ind_wq, &wcn->hal_ind_work);
  2834. spin_unlock(&wcn->hal_ind_lock);
  2835. wcn36xx_dbg(WCN36XX_DBG_HAL, "indication arrived\n");
  2836. break;
  2837. default:
  2838. wcn36xx_err("SMD_EVENT (%d) not supported\n",
  2839. msg_header->msg_type);
  2840. }
  2841. return 0;
  2842. }
  2843. static void wcn36xx_ind_smd_work(struct work_struct *work)
  2844. {
  2845. struct wcn36xx *wcn =
  2846. container_of(work, struct wcn36xx, hal_ind_work);
  2847. for (;;) {
  2848. struct wcn36xx_hal_msg_header *msg_header;
  2849. struct wcn36xx_hal_ind_msg *hal_ind_msg;
  2850. unsigned long flags;
  2851. spin_lock_irqsave(&wcn->hal_ind_lock, flags);
  2852. if (list_empty(&wcn->hal_ind_queue)) {
  2853. spin_unlock_irqrestore(&wcn->hal_ind_lock, flags);
  2854. return;
  2855. }
  2856. hal_ind_msg = list_first_entry(&wcn->hal_ind_queue,
  2857. struct wcn36xx_hal_ind_msg,
  2858. list);
  2859. list_del(&hal_ind_msg->list);
  2860. spin_unlock_irqrestore(&wcn->hal_ind_lock, flags);
  2861. msg_header = (struct wcn36xx_hal_msg_header *)hal_ind_msg->msg;
  2862. switch (msg_header->msg_type) {
  2863. case WCN36XX_HAL_COEX_IND:
  2864. case WCN36XX_HAL_DEL_BA_IND:
  2865. case WCN36XX_HAL_AVOID_FREQ_RANGE_IND:
  2866. break;
  2867. case WCN36XX_HAL_OTA_TX_COMPL_IND:
  2868. wcn36xx_smd_tx_compl_ind(wcn,
  2869. hal_ind_msg->msg,
  2870. hal_ind_msg->msg_len);
  2871. break;
  2872. case WCN36XX_HAL_MISSED_BEACON_IND:
  2873. wcn36xx_smd_missed_beacon_ind(wcn,
  2874. hal_ind_msg->msg,
  2875. hal_ind_msg->msg_len);
  2876. break;
  2877. case WCN36XX_HAL_DELETE_STA_CONTEXT_IND:
  2878. wcn36xx_smd_delete_sta_context_ind(wcn,
  2879. hal_ind_msg->msg,
  2880. hal_ind_msg->msg_len);
  2881. break;
  2882. case WCN36XX_HAL_PRINT_REG_INFO_IND:
  2883. wcn36xx_smd_print_reg_info_ind(wcn,
  2884. hal_ind_msg->msg,
  2885. hal_ind_msg->msg_len);
  2886. break;
  2887. case WCN36XX_HAL_SCAN_OFFLOAD_IND:
  2888. wcn36xx_smd_hw_scan_ind(wcn, hal_ind_msg->msg,
  2889. hal_ind_msg->msg_len);
  2890. break;
  2891. default:
  2892. wcn36xx_err("SMD_EVENT (%d) not supported\n",
  2893. msg_header->msg_type);
  2894. }
  2895. kfree(hal_ind_msg);
  2896. }
  2897. }
  2898. int wcn36xx_smd_open(struct wcn36xx *wcn)
  2899. {
  2900. wcn->hal_ind_wq = create_freezable_workqueue("wcn36xx_smd_ind");
  2901. if (!wcn->hal_ind_wq)
  2902. return -ENOMEM;
  2903. INIT_WORK(&wcn->hal_ind_work, wcn36xx_ind_smd_work);
  2904. INIT_LIST_HEAD(&wcn->hal_ind_queue);
  2905. spin_lock_init(&wcn->hal_ind_lock);
  2906. return 0;
  2907. }
  2908. void wcn36xx_smd_close(struct wcn36xx *wcn)
  2909. {
  2910. struct wcn36xx_hal_ind_msg *msg, *tmp;
  2911. cancel_work_sync(&wcn->hal_ind_work);
  2912. destroy_workqueue(wcn->hal_ind_wq);
  2913. list_for_each_entry_safe(msg, tmp, &wcn->hal_ind_queue, list)
  2914. kfree(msg);
  2915. }