wmi_unified_roam_tlv.c 111 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239324032413242324332443245324632473248324932503251325232533254325532563257325832593260326132623263326432653266326732683269327032713272327332743275327632773278327932803281328232833284328532863287328832893290329132923293329432953296329732983299330033013302330333043305330633073308330933103311331233133314331533163317331833193320332133223323332433253326332733283329333033313332333333343335333633373338333933403341
  1. /*
  2. * Copyright (c) 2013-2020, The Linux Foundation. All rights reserved.
  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
  11. * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12. * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13. * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14. * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15. */
  16. /**
  17. * DOC: Implement API's specific to roaming component.
  18. */
  19. #include <wmi_unified_priv.h>
  20. #include <wmi_unified_roam_api.h>
  21. #include "wmi.h"
  22. #ifdef FEATURE_LFR_SUBNET_DETECTION
  23. /**
  24. * send_set_gateway_params_cmd_tlv() - set gateway parameters
  25. * @wmi_handle: wmi handle
  26. * @req: gateway parameter update request structure
  27. *
  28. * This function reads the incoming @req and fill in the destination
  29. * WMI structure and sends down the gateway configs down to the firmware
  30. *
  31. * Return: QDF_STATUS
  32. */
  33. static QDF_STATUS send_set_gateway_params_cmd_tlv(wmi_unified_t wmi_handle,
  34. struct gateway_update_req_param *req)
  35. {
  36. wmi_roam_subnet_change_config_fixed_param *cmd;
  37. wmi_buf_t buf;
  38. QDF_STATUS ret;
  39. int len = sizeof(*cmd);
  40. buf = wmi_buf_alloc(wmi_handle, len);
  41. if (!buf)
  42. return QDF_STATUS_E_NOMEM;
  43. cmd = (wmi_roam_subnet_change_config_fixed_param *)wmi_buf_data(buf);
  44. WMITLV_SET_HDR(&cmd->tlv_header,
  45. WMITLV_TAG_STRUC_wmi_roam_subnet_change_config_fixed_param,
  46. WMITLV_GET_STRUCT_TLVLEN(
  47. wmi_roam_subnet_change_config_fixed_param));
  48. cmd->vdev_id = req->vdev_id;
  49. qdf_mem_copy(&cmd->inet_gw_ip_v4_addr, req->ipv4_addr,
  50. QDF_IPV4_ADDR_SIZE);
  51. qdf_mem_copy(&cmd->inet_gw_ip_v6_addr, req->ipv6_addr,
  52. QDF_IPV6_ADDR_SIZE);
  53. WMI_CHAR_ARRAY_TO_MAC_ADDR(req->gw_mac_addr.bytes,
  54. &cmd->inet_gw_mac_addr);
  55. cmd->max_retries = req->max_retries;
  56. cmd->timeout = req->timeout;
  57. cmd->num_skip_subnet_change_detection_bssid_list = 0;
  58. cmd->flag = 0;
  59. if (req->ipv4_addr_type)
  60. WMI_SET_ROAM_SUBNET_CHANGE_FLAG_IP4_ENABLED(cmd->flag);
  61. if (req->ipv6_addr_type)
  62. WMI_SET_ROAM_SUBNET_CHANGE_FLAG_IP6_ENABLED(cmd->flag);
  63. wmi_mtrace(WMI_ROAM_SUBNET_CHANGE_CONFIG_CMDID, cmd->vdev_id, 0);
  64. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  65. WMI_ROAM_SUBNET_CHANGE_CONFIG_CMDID);
  66. if (QDF_IS_STATUS_ERROR(ret)) {
  67. wmi_err("Failed to send gw config parameter to fw, ret: %d",
  68. ret);
  69. wmi_buf_free(buf);
  70. }
  71. return ret;
  72. }
  73. void wmi_lfr_subnet_detection_attach_tlv(struct wmi_unified *wmi_handle)
  74. {
  75. struct wmi_ops *ops = wmi_handle->ops;
  76. ops->send_set_gateway_params_cmd = send_set_gateway_params_cmd_tlv;
  77. }
  78. #endif /* FEATURE_LFR_SUBNET_DETECTION */
  79. #ifdef FEATURE_RSSI_MONITOR
  80. /**
  81. * send_set_rssi_monitoring_cmd_tlv() - set rssi monitoring
  82. * @wmi_handle: wmi handle
  83. * @req: rssi monitoring request structure
  84. *
  85. * This function reads the incoming @req and fill in the destination
  86. * WMI structure and send down the rssi monitoring configs down to the firmware
  87. *
  88. * Return: 0 on success; error number otherwise
  89. */
  90. static QDF_STATUS send_set_rssi_monitoring_cmd_tlv(wmi_unified_t wmi_handle,
  91. struct rssi_monitor_param *req)
  92. {
  93. wmi_rssi_breach_monitor_config_fixed_param *cmd;
  94. wmi_buf_t buf;
  95. QDF_STATUS ret;
  96. uint32_t len = sizeof(*cmd);
  97. buf = wmi_buf_alloc(wmi_handle, len);
  98. if (!buf)
  99. return QDF_STATUS_E_NOMEM;
  100. cmd = (wmi_rssi_breach_monitor_config_fixed_param *)wmi_buf_data(buf);
  101. WMITLV_SET_HDR(&cmd->tlv_header,
  102. WMITLV_TAG_STRUC_wmi_rssi_breach_monitor_config_fixed_param,
  103. WMITLV_GET_STRUCT_TLVLEN(
  104. wmi_rssi_breach_monitor_config_fixed_param));
  105. cmd->vdev_id = req->vdev_id;
  106. cmd->request_id = req->request_id;
  107. cmd->lo_rssi_reenable_hysteresis = 0;
  108. cmd->hi_rssi_reenable_histeresis = 0;
  109. cmd->min_report_interval = 0;
  110. cmd->max_num_report = 1;
  111. if (req->control) {
  112. /* enable one threshold for each min/max */
  113. cmd->enabled_bitmap = 0x09;
  114. cmd->low_rssi_breach_threshold[0] = req->min_rssi;
  115. cmd->hi_rssi_breach_threshold[0] = req->max_rssi;
  116. } else {
  117. cmd->enabled_bitmap = 0;
  118. cmd->low_rssi_breach_threshold[0] = 0;
  119. cmd->hi_rssi_breach_threshold[0] = 0;
  120. }
  121. wmi_mtrace(WMI_RSSI_BREACH_MONITOR_CONFIG_CMDID, cmd->vdev_id, 0);
  122. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  123. WMI_RSSI_BREACH_MONITOR_CONFIG_CMDID);
  124. if (QDF_IS_STATUS_ERROR(ret)) {
  125. wmi_err("Failed to send WMI_RSSI_BREACH_MONITOR_CONFIG_CMDID");
  126. wmi_buf_free(buf);
  127. }
  128. wmi_debug("Sent WMI_RSSI_BREACH_MONITOR_CONFIG_CMDID to FW");
  129. return ret;
  130. }
  131. void wmi_rssi_monitor_attach_tlv(struct wmi_unified *wmi_handle)
  132. {
  133. struct wmi_ops *ops = wmi_handle->ops;
  134. ops->send_set_rssi_monitoring_cmd = send_set_rssi_monitoring_cmd_tlv;
  135. }
  136. #endif /* FEATURE_RSSI_MONITOR */
  137. /**
  138. * send_roam_scan_offload_rssi_thresh_cmd_tlv() - set scan offload
  139. * rssi threashold
  140. * @wmi_handle: wmi handle
  141. * @roam_req: Roaming request buffer
  142. *
  143. * Send WMI_ROAM_SCAN_RSSI_THRESHOLD TLV to firmware
  144. *
  145. * Return: QDF status
  146. */
  147. static QDF_STATUS send_roam_scan_offload_rssi_thresh_cmd_tlv(
  148. wmi_unified_t wmi_handle,
  149. struct wlan_roam_offload_scan_rssi_params *roam_req)
  150. {
  151. wmi_buf_t buf = NULL;
  152. QDF_STATUS status;
  153. int len;
  154. uint8_t *buf_ptr;
  155. wmi_roam_scan_rssi_threshold_fixed_param *rssi_threshold_fp;
  156. wmi_roam_scan_extended_threshold_param *ext_thresholds = NULL;
  157. wmi_roam_earlystop_rssi_thres_param *early_stop_thresholds = NULL;
  158. wmi_roam_dense_thres_param *dense_thresholds = NULL;
  159. wmi_roam_bg_scan_roaming_param *bg_scan_params = NULL;
  160. wmi_roam_data_rssi_roaming_param *data_rssi_param = NULL;
  161. len = sizeof(wmi_roam_scan_rssi_threshold_fixed_param);
  162. len += WMI_TLV_HDR_SIZE; /* TLV for ext_thresholds*/
  163. len += sizeof(wmi_roam_scan_extended_threshold_param);
  164. len += WMI_TLV_HDR_SIZE;
  165. len += sizeof(wmi_roam_earlystop_rssi_thres_param);
  166. len += WMI_TLV_HDR_SIZE; /* TLV for dense thresholds*/
  167. len += sizeof(wmi_roam_dense_thres_param);
  168. len += WMI_TLV_HDR_SIZE; /* TLV for BG Scan*/
  169. len += sizeof(wmi_roam_bg_scan_roaming_param);
  170. len += WMI_TLV_HDR_SIZE; /* TLV for data RSSI*/
  171. len += sizeof(wmi_roam_data_rssi_roaming_param);
  172. buf = wmi_buf_alloc(wmi_handle, len);
  173. if (!buf)
  174. return QDF_STATUS_E_NOMEM;
  175. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  176. rssi_threshold_fp =
  177. (wmi_roam_scan_rssi_threshold_fixed_param *)buf_ptr;
  178. WMITLV_SET_HDR(
  179. &rssi_threshold_fp->tlv_header,
  180. WMITLV_TAG_STRUC_wmi_roam_scan_rssi_threshold_fixed_param,
  181. WMITLV_GET_STRUCT_TLVLEN
  182. (wmi_roam_scan_rssi_threshold_fixed_param));
  183. /* fill in threshold values */
  184. rssi_threshold_fp->vdev_id = roam_req->vdev_id;
  185. rssi_threshold_fp->roam_scan_rssi_thresh = roam_req->rssi_thresh;
  186. rssi_threshold_fp->roam_rssi_thresh_diff = roam_req->rssi_thresh_diff;
  187. rssi_threshold_fp->hirssi_scan_max_count =
  188. roam_req->hi_rssi_scan_max_count;
  189. rssi_threshold_fp->hirssi_scan_delta =
  190. roam_req->hi_rssi_scan_rssi_delta;
  191. rssi_threshold_fp->hirssi_upper_bound = roam_req->hi_rssi_scan_rssi_ub;
  192. rssi_threshold_fp->rssi_thresh_offset_5g =
  193. roam_req->rssi_thresh_offset_5g;
  194. buf_ptr += sizeof(wmi_roam_scan_rssi_threshold_fixed_param);
  195. WMITLV_SET_HDR(buf_ptr,
  196. WMITLV_TAG_ARRAY_STRUC,
  197. sizeof(wmi_roam_scan_extended_threshold_param));
  198. buf_ptr += WMI_TLV_HDR_SIZE;
  199. ext_thresholds = (wmi_roam_scan_extended_threshold_param *)buf_ptr;
  200. ext_thresholds->penalty_threshold_5g = roam_req->penalty_threshold_5g;
  201. if (roam_req->raise_rssi_thresh_5g >= WMI_NOISE_FLOOR_DBM_DEFAULT)
  202. ext_thresholds->boost_threshold_5g =
  203. roam_req->boost_threshold_5g;
  204. ext_thresholds->boost_algorithm_5g =
  205. WMI_ROAM_5G_BOOST_PENALIZE_ALGO_LINEAR;
  206. ext_thresholds->boost_factor_5g = roam_req->raise_factor_5g;
  207. ext_thresholds->penalty_algorithm_5g =
  208. WMI_ROAM_5G_BOOST_PENALIZE_ALGO_LINEAR;
  209. ext_thresholds->penalty_factor_5g = roam_req->drop_factor_5g;
  210. ext_thresholds->max_boost_5g = roam_req->max_raise_rssi_5g;
  211. ext_thresholds->max_penalty_5g = roam_req->max_drop_rssi_5g;
  212. ext_thresholds->good_rssi_threshold = roam_req->good_rssi_threshold;
  213. WMITLV_SET_HDR(&ext_thresholds->tlv_header,
  214. WMITLV_TAG_STRUC_wmi_roam_scan_extended_threshold_param,
  215. WMITLV_GET_STRUCT_TLVLEN
  216. (wmi_roam_scan_extended_threshold_param));
  217. buf_ptr += sizeof(wmi_roam_scan_extended_threshold_param);
  218. WMITLV_SET_HDR(buf_ptr,
  219. WMITLV_TAG_ARRAY_STRUC,
  220. sizeof(wmi_roam_earlystop_rssi_thres_param));
  221. buf_ptr += WMI_TLV_HDR_SIZE;
  222. early_stop_thresholds = (wmi_roam_earlystop_rssi_thres_param *)buf_ptr;
  223. early_stop_thresholds->roam_earlystop_thres_min =
  224. roam_req->roam_earlystop_thres_min;
  225. early_stop_thresholds->roam_earlystop_thres_max =
  226. roam_req->roam_earlystop_thres_max;
  227. WMITLV_SET_HDR(&early_stop_thresholds->tlv_header,
  228. WMITLV_TAG_STRUC_wmi_roam_earlystop_rssi_thres_param,
  229. WMITLV_GET_STRUCT_TLVLEN
  230. (wmi_roam_earlystop_rssi_thres_param));
  231. buf_ptr += sizeof(wmi_roam_earlystop_rssi_thres_param);
  232. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  233. sizeof(wmi_roam_dense_thres_param));
  234. buf_ptr += WMI_TLV_HDR_SIZE;
  235. dense_thresholds = (wmi_roam_dense_thres_param *)buf_ptr;
  236. dense_thresholds->roam_dense_rssi_thres_offset =
  237. roam_req->dense_rssi_thresh_offset;
  238. dense_thresholds->roam_dense_min_aps = roam_req->dense_min_aps_cnt;
  239. dense_thresholds->roam_dense_traffic_thres =
  240. roam_req->traffic_threshold;
  241. dense_thresholds->roam_dense_status = roam_req->initial_dense_status;
  242. WMITLV_SET_HDR(&dense_thresholds->tlv_header,
  243. WMITLV_TAG_STRUC_wmi_roam_dense_thres_param,
  244. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_dense_thres_param));
  245. buf_ptr += sizeof(wmi_roam_dense_thres_param);
  246. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  247. sizeof(wmi_roam_bg_scan_roaming_param));
  248. buf_ptr += WMI_TLV_HDR_SIZE;
  249. bg_scan_params = (wmi_roam_bg_scan_roaming_param *)buf_ptr;
  250. bg_scan_params->roam_bg_scan_bad_rssi_thresh =
  251. roam_req->bg_scan_bad_rssi_thresh;
  252. bg_scan_params->roam_bg_scan_client_bitmap =
  253. roam_req->bg_scan_client_bitmap;
  254. bg_scan_params->bad_rssi_thresh_offset_2g =
  255. roam_req->roam_bad_rssi_thresh_offset_2g;
  256. bg_scan_params->flags = 0;
  257. if (roam_req->roam_bad_rssi_thresh_offset_2g)
  258. bg_scan_params->flags |= WMI_ROAM_BG_SCAN_FLAGS_2G_TO_5G_ONLY;
  259. WMITLV_SET_HDR(&bg_scan_params->tlv_header,
  260. WMITLV_TAG_STRUC_wmi_roam_bg_scan_roaming_param,
  261. WMITLV_GET_STRUCT_TLVLEN
  262. (wmi_roam_bg_scan_roaming_param));
  263. buf_ptr += sizeof(wmi_roam_bg_scan_roaming_param);
  264. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  265. sizeof(wmi_roam_data_rssi_roaming_param));
  266. buf_ptr += WMI_TLV_HDR_SIZE;
  267. data_rssi_param = (wmi_roam_data_rssi_roaming_param *)buf_ptr;
  268. data_rssi_param->flags =
  269. roam_req->roam_data_rssi_threshold_triggers;
  270. data_rssi_param->roam_data_rssi_thres =
  271. roam_req->roam_data_rssi_threshold;
  272. data_rssi_param->rx_inactivity_ms =
  273. roam_req->rx_data_inactivity_time;
  274. WMITLV_SET_HDR(&data_rssi_param->tlv_header,
  275. WMITLV_TAG_STRUC_wmi_roam_data_rssi_roaming_param,
  276. WMITLV_GET_STRUCT_TLVLEN
  277. (wmi_roam_data_rssi_roaming_param));
  278. wmi_debug("vdev %d Data rssi threshold: %d, triggers: 0x%x, rx time: %d",
  279. rssi_threshold_fp->vdev_id,
  280. data_rssi_param->roam_data_rssi_thres,
  281. data_rssi_param->flags,
  282. data_rssi_param->rx_inactivity_ms);
  283. wmi_mtrace(WMI_ROAM_SCAN_RSSI_THRESHOLD, NO_SESSION, 0);
  284. status = wmi_unified_cmd_send(wmi_handle, buf,
  285. len, WMI_ROAM_SCAN_RSSI_THRESHOLD);
  286. if (QDF_IS_STATUS_ERROR(status)) {
  287. wmi_err("cmd WMI_ROAM_SCAN_RSSI_THRESHOLD returned Error %d",
  288. status);
  289. wmi_buf_free(buf);
  290. }
  291. return status;
  292. }
  293. /**
  294. * send_roam_scan_offload_scan_period_cmd_tlv() - set roam offload scan period
  295. * @wmi_handle: wmi handle
  296. * @param: roam scan parameters to be sent to firmware
  297. *
  298. * Send WMI_ROAM_SCAN_PERIOD parameters to fw.
  299. *
  300. * Return: QDF status
  301. */
  302. static QDF_STATUS
  303. send_roam_scan_offload_scan_period_cmd_tlv(
  304. wmi_unified_t wmi_handle,
  305. struct wlan_roam_scan_period_params *param)
  306. {
  307. QDF_STATUS status;
  308. wmi_buf_t buf = NULL;
  309. int len;
  310. uint8_t *buf_ptr;
  311. wmi_roam_scan_period_fixed_param *scan_period_fp;
  312. /* Send scan period values */
  313. len = sizeof(wmi_roam_scan_period_fixed_param);
  314. buf = wmi_buf_alloc(wmi_handle, len);
  315. if (!buf)
  316. return QDF_STATUS_E_NOMEM;
  317. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  318. scan_period_fp = (wmi_roam_scan_period_fixed_param *)buf_ptr;
  319. WMITLV_SET_HDR(&scan_period_fp->tlv_header,
  320. WMITLV_TAG_STRUC_wmi_roam_scan_period_fixed_param,
  321. WMITLV_GET_STRUCT_TLVLEN
  322. (wmi_roam_scan_period_fixed_param));
  323. /* fill in scan period values */
  324. scan_period_fp->vdev_id = param->vdev_id;
  325. scan_period_fp->roam_scan_period = param->scan_period;
  326. scan_period_fp->roam_scan_age = param->scan_age;
  327. scan_period_fp->inactivity_time_period =
  328. param->roam_scan_inactivity_time;
  329. scan_period_fp->roam_inactive_count =
  330. param->roam_inactive_data_packet_count;
  331. scan_period_fp->roam_scan_period_after_inactivity =
  332. param->roam_scan_period_after_inactivity;
  333. /* Firmware expects the full scan preriod in msec whereas host
  334. * provides the same in seconds.
  335. * Convert it to msec and send to firmware
  336. */
  337. scan_period_fp->roam_full_scan_period = param->full_scan_period * 1000;
  338. wmi_debug("roam_scan_period=%d, roam_scan_age=%d, full_scan_period= %u",
  339. scan_period_fp->roam_scan_period,
  340. scan_period_fp->roam_scan_age,
  341. scan_period_fp->roam_full_scan_period);
  342. wmi_debug("inactiviy time:%d inactive cnt:%d time after inactivity:%d",
  343. scan_period_fp->inactivity_time_period,
  344. scan_period_fp->roam_inactive_count,
  345. scan_period_fp->roam_scan_period_after_inactivity);
  346. wmi_mtrace(WMI_ROAM_SCAN_PERIOD, NO_SESSION, 0);
  347. status = wmi_unified_cmd_send(wmi_handle, buf, len,
  348. WMI_ROAM_SCAN_PERIOD);
  349. if (QDF_IS_STATUS_ERROR(status)) {
  350. wmi_buf_free(buf);
  351. return status;
  352. }
  353. return QDF_STATUS_SUCCESS;
  354. }
  355. static QDF_STATUS send_roam_mawc_params_cmd_tlv(
  356. wmi_unified_t wmi_handle,
  357. struct wlan_roam_mawc_params *params)
  358. {
  359. wmi_buf_t buf = NULL;
  360. QDF_STATUS status;
  361. int len;
  362. uint8_t *buf_ptr;
  363. wmi_roam_configure_mawc_cmd_fixed_param *wmi_roam_mawc_params;
  364. len = sizeof(*wmi_roam_mawc_params);
  365. buf = wmi_buf_alloc(wmi_handle, len);
  366. if (!buf)
  367. return QDF_STATUS_E_NOMEM;
  368. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  369. wmi_roam_mawc_params =
  370. (wmi_roam_configure_mawc_cmd_fixed_param *)buf_ptr;
  371. WMITLV_SET_HDR(&wmi_roam_mawc_params->tlv_header,
  372. WMITLV_TAG_STRUC_wmi_roam_configure_mawc_cmd_fixed_param,
  373. WMITLV_GET_STRUCT_TLVLEN
  374. (wmi_roam_configure_mawc_cmd_fixed_param));
  375. wmi_roam_mawc_params->vdev_id = params->vdev_id;
  376. if (params->enable)
  377. wmi_roam_mawc_params->enable = 1;
  378. else
  379. wmi_roam_mawc_params->enable = 0;
  380. wmi_roam_mawc_params->traffic_load_threshold =
  381. params->traffic_load_threshold;
  382. wmi_roam_mawc_params->best_ap_rssi_threshold =
  383. params->best_ap_rssi_threshold;
  384. wmi_roam_mawc_params->rssi_stationary_high_adjust =
  385. params->rssi_stationary_high_adjust;
  386. wmi_roam_mawc_params->rssi_stationary_low_adjust =
  387. params->rssi_stationary_low_adjust;
  388. wmi_debug("MAWC roam en=%d, vdev=%d, tr=%d, ap=%d, high=%d, low=%d",
  389. wmi_roam_mawc_params->enable, wmi_roam_mawc_params->vdev_id,
  390. wmi_roam_mawc_params->traffic_load_threshold,
  391. wmi_roam_mawc_params->best_ap_rssi_threshold,
  392. wmi_roam_mawc_params->rssi_stationary_high_adjust,
  393. wmi_roam_mawc_params->rssi_stationary_low_adjust);
  394. wmi_mtrace(WMI_ROAM_CONFIGURE_MAWC_CMDID, NO_SESSION, 0);
  395. status = wmi_unified_cmd_send(wmi_handle, buf,
  396. len, WMI_ROAM_CONFIGURE_MAWC_CMDID);
  397. if (QDF_IS_STATUS_ERROR(status)) {
  398. wmi_err("WMI_ROAM_CONFIGURE_MAWC_CMDID failed, Error %d",
  399. status);
  400. wmi_buf_free(buf);
  401. return status;
  402. }
  403. return QDF_STATUS_SUCCESS;
  404. }
  405. /**
  406. * send_roam_scan_filter_cmd_tlv() - Filter to be applied while roaming
  407. * @wmi_handle: wmi handle
  408. * @roam_req: Request which contains the filters
  409. *
  410. * There are filters such as whitelist, blacklist and preferred
  411. * list that need to be applied to the scan results to form the
  412. * probable candidates for roaming.
  413. *
  414. * Return: Return success upon successfully passing the
  415. * parameters to the firmware, otherwise failure.
  416. */
  417. static QDF_STATUS send_roam_scan_filter_cmd_tlv(wmi_unified_t wmi_handle,
  418. struct roam_scan_filter_params *roam_req)
  419. {
  420. wmi_buf_t buf = NULL;
  421. QDF_STATUS status;
  422. uint32_t i;
  423. uint32_t len, blist_len = 0;
  424. uint8_t *buf_ptr;
  425. wmi_roam_filter_fixed_param *roam_filter;
  426. uint8_t *bssid_src_ptr = NULL;
  427. wmi_mac_addr *bssid_dst_ptr = NULL;
  428. wmi_ssid *ssid_ptr = NULL;
  429. uint32_t *bssid_preferred_factor_ptr = NULL;
  430. wmi_roam_lca_disallow_config_tlv_param *blist_param;
  431. wmi_roam_rssi_rejection_oce_config_param *rssi_rej;
  432. len = sizeof(wmi_roam_filter_fixed_param);
  433. len += WMI_TLV_HDR_SIZE;
  434. if (roam_req->num_bssid_black_list)
  435. len += roam_req->num_bssid_black_list * sizeof(wmi_mac_addr);
  436. len += WMI_TLV_HDR_SIZE;
  437. if (roam_req->num_ssid_white_list)
  438. len += roam_req->num_ssid_white_list * sizeof(wmi_ssid);
  439. len += 2 * WMI_TLV_HDR_SIZE;
  440. if (roam_req->num_bssid_preferred_list) {
  441. len += (roam_req->num_bssid_preferred_list *
  442. sizeof(wmi_mac_addr));
  443. len += roam_req->num_bssid_preferred_list * sizeof(uint32_t);
  444. }
  445. len += WMI_TLV_HDR_SIZE;
  446. if (roam_req->lca_disallow_config_present) {
  447. len += sizeof(*blist_param);
  448. blist_len = sizeof(*blist_param);
  449. }
  450. len += WMI_TLV_HDR_SIZE;
  451. if (roam_req->num_rssi_rejection_ap)
  452. len += roam_req->num_rssi_rejection_ap * sizeof(*rssi_rej);
  453. buf = wmi_buf_alloc(wmi_handle, len);
  454. if (!buf)
  455. return QDF_STATUS_E_NOMEM;
  456. buf_ptr = (u_int8_t *)wmi_buf_data(buf);
  457. roam_filter = (wmi_roam_filter_fixed_param *)buf_ptr;
  458. WMITLV_SET_HDR(&roam_filter->tlv_header,
  459. WMITLV_TAG_STRUC_wmi_roam_filter_fixed_param,
  460. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_filter_fixed_param));
  461. /* fill in fixed values */
  462. roam_filter->vdev_id = roam_req->vdev_id;
  463. roam_filter->flags = 0;
  464. roam_filter->op_bitmap = roam_req->op_bitmap;
  465. roam_filter->num_bssid_black_list = roam_req->num_bssid_black_list;
  466. roam_filter->num_ssid_white_list = roam_req->num_ssid_white_list;
  467. roam_filter->num_bssid_preferred_list =
  468. roam_req->num_bssid_preferred_list;
  469. roam_filter->num_rssi_rejection_ap =
  470. roam_req->num_rssi_rejection_ap;
  471. roam_filter->delta_rssi = roam_req->delta_rssi;
  472. buf_ptr += sizeof(wmi_roam_filter_fixed_param);
  473. WMITLV_SET_HDR((buf_ptr),
  474. WMITLV_TAG_ARRAY_FIXED_STRUC,
  475. (roam_req->num_bssid_black_list * sizeof(wmi_mac_addr)));
  476. bssid_src_ptr = (uint8_t *)&roam_req->bssid_avoid_list;
  477. bssid_dst_ptr = (wmi_mac_addr *)(buf_ptr + WMI_TLV_HDR_SIZE);
  478. for (i = 0; i < roam_req->num_bssid_black_list; i++) {
  479. WMI_CHAR_ARRAY_TO_MAC_ADDR(bssid_src_ptr, bssid_dst_ptr);
  480. bssid_src_ptr += ATH_MAC_LEN;
  481. bssid_dst_ptr++;
  482. }
  483. buf_ptr += WMI_TLV_HDR_SIZE +
  484. (roam_req->num_bssid_black_list * sizeof(wmi_mac_addr));
  485. WMITLV_SET_HDR((buf_ptr),
  486. WMITLV_TAG_ARRAY_FIXED_STRUC,
  487. (roam_req->num_ssid_white_list * sizeof(wmi_ssid)));
  488. ssid_ptr = (wmi_ssid *)(buf_ptr + WMI_TLV_HDR_SIZE);
  489. for (i = 0; i < roam_req->num_ssid_white_list; i++) {
  490. qdf_mem_copy(&ssid_ptr->ssid,
  491. &roam_req->ssid_allowed_list[i].ssid,
  492. roam_req->ssid_allowed_list[i].length);
  493. ssid_ptr->ssid_len = roam_req->ssid_allowed_list[i].length;
  494. ssid_ptr++;
  495. }
  496. buf_ptr += WMI_TLV_HDR_SIZE + (roam_req->num_ssid_white_list *
  497. sizeof(wmi_ssid));
  498. WMITLV_SET_HDR((buf_ptr),
  499. WMITLV_TAG_ARRAY_FIXED_STRUC,
  500. (roam_req->num_bssid_preferred_list * sizeof(wmi_mac_addr)));
  501. bssid_src_ptr = (uint8_t *)&roam_req->bssid_favored;
  502. bssid_dst_ptr = (wmi_mac_addr *)(buf_ptr + WMI_TLV_HDR_SIZE);
  503. for (i = 0; i < roam_req->num_bssid_preferred_list; i++) {
  504. WMI_CHAR_ARRAY_TO_MAC_ADDR(bssid_src_ptr,
  505. (wmi_mac_addr *)bssid_dst_ptr);
  506. bssid_src_ptr += ATH_MAC_LEN;
  507. bssid_dst_ptr++;
  508. }
  509. buf_ptr += WMI_TLV_HDR_SIZE +
  510. (roam_req->num_bssid_preferred_list * sizeof(wmi_mac_addr));
  511. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32,
  512. (roam_req->num_bssid_preferred_list * sizeof(uint32_t)));
  513. bssid_preferred_factor_ptr = (uint32_t *)(buf_ptr + WMI_TLV_HDR_SIZE);
  514. for (i = 0; i < roam_req->num_bssid_preferred_list; i++) {
  515. *bssid_preferred_factor_ptr =
  516. roam_req->bssid_favored_factor[i];
  517. bssid_preferred_factor_ptr++;
  518. }
  519. buf_ptr += WMI_TLV_HDR_SIZE +
  520. (roam_req->num_bssid_preferred_list * sizeof(uint32_t));
  521. WMITLV_SET_HDR(buf_ptr,
  522. WMITLV_TAG_ARRAY_STRUC, blist_len);
  523. buf_ptr += WMI_TLV_HDR_SIZE;
  524. if (roam_req->lca_disallow_config_present) {
  525. blist_param =
  526. (wmi_roam_lca_disallow_config_tlv_param *)buf_ptr;
  527. WMITLV_SET_HDR(&blist_param->tlv_header,
  528. WMITLV_TAG_STRUC_wmi_roam_lca_disallow_config_tlv_param,
  529. WMITLV_GET_STRUCT_TLVLEN(
  530. wmi_roam_lca_disallow_config_tlv_param));
  531. blist_param->disallow_duration = roam_req->disallow_duration;
  532. blist_param->rssi_channel_penalization =
  533. roam_req->rssi_channel_penalization;
  534. blist_param->num_disallowed_aps = roam_req->num_disallowed_aps;
  535. blist_param->disallow_lca_enable_source_bitmap =
  536. (WMI_ROAM_LCA_DISALLOW_SOURCE_PER |
  537. WMI_ROAM_LCA_DISALLOW_SOURCE_BACKGROUND);
  538. buf_ptr += (sizeof(wmi_roam_lca_disallow_config_tlv_param));
  539. }
  540. WMITLV_SET_HDR(buf_ptr,
  541. WMITLV_TAG_ARRAY_STRUC,
  542. (roam_req->num_rssi_rejection_ap * sizeof(*rssi_rej)));
  543. buf_ptr += WMI_TLV_HDR_SIZE;
  544. for (i = 0; i < roam_req->num_rssi_rejection_ap; i++) {
  545. rssi_rej =
  546. (wmi_roam_rssi_rejection_oce_config_param *)buf_ptr;
  547. WMITLV_SET_HDR(&rssi_rej->tlv_header,
  548. WMITLV_TAG_STRUC_wmi_roam_rssi_rejection_oce_config_param,
  549. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_rssi_rejection_oce_config_param));
  550. WMI_CHAR_ARRAY_TO_MAC_ADDR(
  551. roam_req->rssi_rejection_ap[i].bssid.bytes,
  552. &rssi_rej->bssid);
  553. rssi_rej->remaining_disallow_duration =
  554. roam_req->rssi_rejection_ap[i].reject_duration;
  555. rssi_rej->requested_rssi =
  556. (int32_t)roam_req->rssi_rejection_ap[i].expected_rssi;
  557. buf_ptr +=
  558. (sizeof(wmi_roam_rssi_rejection_oce_config_param));
  559. }
  560. wmi_mtrace(WMI_ROAM_FILTER_CMDID, NO_SESSION, 0);
  561. status = wmi_unified_cmd_send(wmi_handle, buf,
  562. len, WMI_ROAM_FILTER_CMDID);
  563. if (QDF_IS_STATUS_ERROR(status)) {
  564. wmi_err("cmd WMI_ROAM_FILTER_CMDID returned Error %d",
  565. status);
  566. wmi_buf_free(buf);
  567. }
  568. return status;
  569. }
  570. #ifdef FEATURE_WLAN_ESE
  571. /**
  572. * send_plm_stop_cmd_tlv() - plm stop request
  573. * @wmi_handle: wmi handle
  574. * @plm: plm request parameters
  575. *
  576. * This function request FW to stop PLM.
  577. *
  578. * Return: CDF status
  579. */
  580. static QDF_STATUS send_plm_stop_cmd_tlv(wmi_unified_t wmi_handle,
  581. const struct plm_req_params *plm)
  582. {
  583. wmi_vdev_plmreq_stop_cmd_fixed_param *cmd;
  584. int32_t len;
  585. wmi_buf_t buf;
  586. uint8_t *buf_ptr;
  587. int ret;
  588. len = sizeof(*cmd);
  589. buf = wmi_buf_alloc(wmi_handle, len);
  590. if (!buf)
  591. return QDF_STATUS_E_NOMEM;
  592. cmd = (wmi_vdev_plmreq_stop_cmd_fixed_param *)wmi_buf_data(buf);
  593. buf_ptr = (uint8_t *)cmd;
  594. WMITLV_SET_HDR(&cmd->tlv_header,
  595. WMITLV_TAG_STRUC_wmi_vdev_plmreq_stop_cmd_fixed_param,
  596. WMITLV_GET_STRUCT_TLVLEN
  597. (wmi_vdev_plmreq_stop_cmd_fixed_param));
  598. cmd->vdev_id = plm->vdev_id;
  599. cmd->meas_token = plm->meas_token;
  600. wmi_debug("vdev %d meas token %d", cmd->vdev_id, cmd->meas_token);
  601. wmi_mtrace(WMI_VDEV_PLMREQ_STOP_CMDID, cmd->vdev_id, 0);
  602. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  603. WMI_VDEV_PLMREQ_STOP_CMDID);
  604. if (ret) {
  605. wmi_err("Failed to send plm stop wmi cmd");
  606. wmi_buf_free(buf);
  607. return QDF_STATUS_E_FAILURE;
  608. }
  609. return QDF_STATUS_SUCCESS;
  610. }
  611. /**
  612. * send_plm_start_cmd_tlv() - plm start request
  613. * @wmi_handle: wmi handle
  614. * @plm: plm request parameters
  615. *
  616. * This function request FW to start PLM.
  617. *
  618. * Return: CDF status
  619. */
  620. static QDF_STATUS send_plm_start_cmd_tlv(wmi_unified_t wmi_handle,
  621. const struct plm_req_params *plm)
  622. {
  623. wmi_vdev_plmreq_start_cmd_fixed_param *cmd;
  624. uint32_t *channel_list;
  625. int32_t len;
  626. wmi_buf_t buf;
  627. uint8_t *buf_ptr;
  628. uint8_t count;
  629. int ret;
  630. /* TLV place holder for channel_list */
  631. len = sizeof(*cmd) + WMI_TLV_HDR_SIZE;
  632. len += sizeof(uint32_t) * plm->plm_num_ch;
  633. buf = wmi_buf_alloc(wmi_handle, len);
  634. if (!buf)
  635. return QDF_STATUS_E_NOMEM;
  636. cmd = (wmi_vdev_plmreq_start_cmd_fixed_param *)wmi_buf_data(buf);
  637. buf_ptr = (uint8_t *)cmd;
  638. WMITLV_SET_HDR(&cmd->tlv_header,
  639. WMITLV_TAG_STRUC_wmi_vdev_plmreq_start_cmd_fixed_param,
  640. WMITLV_GET_STRUCT_TLVLEN
  641. (wmi_vdev_plmreq_start_cmd_fixed_param));
  642. cmd->vdev_id = plm->vdev_id;
  643. cmd->meas_token = plm->meas_token;
  644. cmd->dialog_token = plm->diag_token;
  645. cmd->number_bursts = plm->num_bursts;
  646. cmd->burst_interval = WMI_SEC_TO_MSEC(plm->burst_int);
  647. cmd->off_duration = plm->meas_duration;
  648. cmd->burst_cycle = plm->burst_len;
  649. cmd->tx_power = plm->desired_tx_pwr;
  650. WMI_CHAR_ARRAY_TO_MAC_ADDR(plm->mac_addr.bytes, &cmd->dest_mac);
  651. cmd->num_chans = plm->plm_num_ch;
  652. buf_ptr += sizeof(wmi_vdev_plmreq_start_cmd_fixed_param);
  653. wmi_debug("vdev: %d measu token: %d dialog_token: %d number_bursts: %d burst_interval: %d off_duration: %d burst_cycle: %d tx_power: %d Number of channels: %d",
  654. cmd->vdev_id, cmd->meas_token, cmd->dialog_token,
  655. cmd->number_bursts, cmd->burst_interval, cmd->off_duration,
  656. cmd->burst_cycle, cmd->tx_power, cmd->num_chans);
  657. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32,
  658. (cmd->num_chans * sizeof(uint32_t)));
  659. buf_ptr += WMI_TLV_HDR_SIZE;
  660. if (cmd->num_chans) {
  661. channel_list = (uint32_t *)buf_ptr;
  662. for (count = 0; count < cmd->num_chans; count++) {
  663. channel_list[count] = plm->plm_ch_freq_list[count];
  664. wmi_debug("Ch[%d]: %d MHz", count, channel_list[count]);
  665. }
  666. buf_ptr += cmd->num_chans * sizeof(uint32_t);
  667. }
  668. wmi_mtrace(WMI_VDEV_PLMREQ_START_CMDID, cmd->vdev_id, 0);
  669. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  670. WMI_VDEV_PLMREQ_START_CMDID);
  671. if (ret) {
  672. wmi_err("Failed to send plm start wmi cmd");
  673. wmi_buf_free(buf);
  674. return QDF_STATUS_E_FAILURE;
  675. }
  676. return QDF_STATUS_SUCCESS;
  677. }
  678. void wmi_ese_attach_tlv(wmi_unified_t wmi_handle)
  679. {
  680. struct wmi_ops *ops = wmi_handle->ops;
  681. ops->send_plm_stop_cmd = send_plm_stop_cmd_tlv;
  682. ops->send_plm_start_cmd = send_plm_start_cmd_tlv;
  683. }
  684. #endif /* FEATURE_WLAN_ESE */
  685. #ifdef WLAN_FEATURE_ROAM_OFFLOAD
  686. /* send_set_ric_req_cmd_tlv() - set ric request element
  687. * @wmi_handle: wmi handle
  688. * @msg: message
  689. * @is_add_ts: is addts required
  690. *
  691. * This function sets ric request element for 11r roaming.
  692. *
  693. * Return: CDF status
  694. */
  695. static QDF_STATUS send_set_ric_req_cmd_tlv(wmi_unified_t wmi_handle,
  696. void *msg, uint8_t is_add_ts)
  697. {
  698. wmi_ric_request_fixed_param *cmd;
  699. wmi_ric_tspec *tspec_param;
  700. wmi_buf_t buf;
  701. uint8_t *buf_ptr;
  702. struct mac_tspec_ie *tspec_ie = NULL;
  703. int32_t len = sizeof(wmi_ric_request_fixed_param) +
  704. WMI_TLV_HDR_SIZE + sizeof(wmi_ric_tspec);
  705. buf = wmi_buf_alloc(wmi_handle, len);
  706. if (!buf)
  707. return QDF_STATUS_E_NOMEM;
  708. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  709. cmd = (wmi_ric_request_fixed_param *)buf_ptr;
  710. WMITLV_SET_HDR(&cmd->tlv_header,
  711. WMITLV_TAG_STRUC_wmi_ric_request_fixed_param,
  712. WMITLV_GET_STRUCT_TLVLEN(wmi_ric_request_fixed_param));
  713. if (is_add_ts)
  714. cmd->vdev_id = ((struct add_ts_param *)msg)->vdev_id;
  715. else
  716. cmd->vdev_id = ((struct del_ts_params *)msg)->sessionId;
  717. cmd->num_ric_request = 1;
  718. cmd->is_add_ric = is_add_ts;
  719. buf_ptr += sizeof(wmi_ric_request_fixed_param);
  720. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, sizeof(wmi_ric_tspec));
  721. buf_ptr += WMI_TLV_HDR_SIZE;
  722. tspec_param = (wmi_ric_tspec *)buf_ptr;
  723. WMITLV_SET_HDR(&tspec_param->tlv_header,
  724. WMITLV_TAG_STRUC_wmi_ric_tspec,
  725. WMITLV_GET_STRUCT_TLVLEN(wmi_ric_tspec));
  726. if (is_add_ts)
  727. tspec_ie = &(((struct add_ts_param *)msg)->tspec);
  728. else
  729. tspec_ie = &(((struct del_ts_params *)msg)->delTsInfo.tspec);
  730. if (tspec_ie) {
  731. /* Fill the tsinfo in the format expected by firmware */
  732. #ifndef ANI_LITTLE_BIT_ENDIAN
  733. qdf_mem_copy(((uint8_t *)&tspec_param->ts_info) + 1,
  734. ((uint8_t *)&tspec_ie->tsinfo) + 1, 2);
  735. #else
  736. qdf_mem_copy(((uint8_t *)&tspec_param->ts_info),
  737. ((uint8_t *)&tspec_ie->tsinfo) + 1, 2);
  738. #endif /* ANI_LITTLE_BIT_ENDIAN */
  739. tspec_param->nominal_msdu_size = tspec_ie->nomMsduSz;
  740. tspec_param->maximum_msdu_size = tspec_ie->maxMsduSz;
  741. tspec_param->min_service_interval = tspec_ie->minSvcInterval;
  742. tspec_param->max_service_interval = tspec_ie->maxSvcInterval;
  743. tspec_param->inactivity_interval = tspec_ie->inactInterval;
  744. tspec_param->suspension_interval = tspec_ie->suspendInterval;
  745. tspec_param->svc_start_time = tspec_ie->svcStartTime;
  746. tspec_param->min_data_rate = tspec_ie->minDataRate;
  747. tspec_param->mean_data_rate = tspec_ie->meanDataRate;
  748. tspec_param->peak_data_rate = tspec_ie->peakDataRate;
  749. tspec_param->max_burst_size = tspec_ie->maxBurstSz;
  750. tspec_param->delay_bound = tspec_ie->delayBound;
  751. tspec_param->min_phy_rate = tspec_ie->minPhyRate;
  752. tspec_param->surplus_bw_allowance = tspec_ie->surplusBw;
  753. tspec_param->medium_time = 0;
  754. }
  755. wmi_debug("Set RIC Req is_add_ts: %d", is_add_ts);
  756. wmi_mtrace(WMI_ROAM_SET_RIC_REQUEST_CMDID, cmd->vdev_id, 0);
  757. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  758. WMI_ROAM_SET_RIC_REQUEST_CMDID)) {
  759. wmi_err("Failed to send vdev Set RIC Req command");
  760. if (is_add_ts)
  761. ((struct add_ts_param *)msg)->status =
  762. QDF_STATUS_E_FAILURE;
  763. wmi_buf_free(buf);
  764. return QDF_STATUS_E_FAILURE;
  765. }
  766. return QDF_STATUS_SUCCESS;
  767. }
  768. /**
  769. * send_process_roam_synch_complete_cmd_tlv() - roam synch complete command to
  770. * fw.
  771. * @wmi_handle: wmi handle
  772. * @vdev_id: vdev id
  773. *
  774. * This function sends roam synch complete event to fw.
  775. *
  776. * Return: QDF STATUS
  777. */
  778. static QDF_STATUS
  779. send_process_roam_synch_complete_cmd_tlv(wmi_unified_t wmi_handle,
  780. uint8_t vdev_id)
  781. {
  782. wmi_roam_synch_complete_fixed_param *cmd;
  783. wmi_buf_t wmi_buf;
  784. uint8_t *buf_ptr;
  785. uint16_t len;
  786. len = sizeof(wmi_roam_synch_complete_fixed_param);
  787. wmi_buf = wmi_buf_alloc(wmi_handle, len);
  788. if (!wmi_buf)
  789. return QDF_STATUS_E_NOMEM;
  790. cmd = (wmi_roam_synch_complete_fixed_param *)wmi_buf_data(wmi_buf);
  791. buf_ptr = (uint8_t *)cmd;
  792. WMITLV_SET_HDR(&cmd->tlv_header,
  793. WMITLV_TAG_STRUC_wmi_roam_synch_complete_fixed_param,
  794. WMITLV_GET_STRUCT_TLVLEN
  795. (wmi_roam_synch_complete_fixed_param));
  796. cmd->vdev_id = vdev_id;
  797. wmi_mtrace(WMI_ROAM_SYNCH_COMPLETE, cmd->vdev_id, 0);
  798. if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len,
  799. WMI_ROAM_SYNCH_COMPLETE)) {
  800. wmi_err("Failed to send roam synch confirmation");
  801. wmi_buf_free(wmi_buf);
  802. return QDF_STATUS_E_FAILURE;
  803. }
  804. return QDF_STATUS_SUCCESS;
  805. }
  806. /**
  807. * send_roam_invoke_cmd_tlv() - send roam invoke command to fw.
  808. * @wmi_handle: wma handle
  809. * @roaminvoke: roam invoke command
  810. *
  811. * Send roam invoke command to fw for fastreassoc.
  812. *
  813. * Return: CDF STATUS
  814. */
  815. static QDF_STATUS send_roam_invoke_cmd_tlv(wmi_unified_t wmi_handle,
  816. struct wmi_roam_invoke_cmd *roaminvoke,
  817. uint32_t ch_hz)
  818. {
  819. wmi_roam_invoke_cmd_fixed_param *cmd;
  820. wmi_buf_t wmi_buf;
  821. u_int8_t *buf_ptr;
  822. u_int16_t len, args_tlv_len;
  823. uint32_t *channel_list;
  824. wmi_mac_addr *bssid_list;
  825. wmi_tlv_buf_len_param *buf_len_tlv;
  826. args_tlv_len = (4 * WMI_TLV_HDR_SIZE) + sizeof(uint32_t) +
  827. sizeof(wmi_mac_addr) + sizeof(wmi_tlv_buf_len_param) +
  828. roundup(roaminvoke->frame_len, sizeof(uint32_t));
  829. len = sizeof(wmi_roam_invoke_cmd_fixed_param) + args_tlv_len;
  830. wmi_buf = wmi_buf_alloc(wmi_handle, len);
  831. if (!wmi_buf)
  832. return QDF_STATUS_E_NOMEM;
  833. cmd = (wmi_roam_invoke_cmd_fixed_param *)wmi_buf_data(wmi_buf);
  834. buf_ptr = (u_int8_t *)cmd;
  835. WMITLV_SET_HDR(&cmd->tlv_header,
  836. WMITLV_TAG_STRUC_wmi_roam_invoke_cmd_fixed_param,
  837. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_invoke_cmd_fixed_param));
  838. cmd->vdev_id = roaminvoke->vdev_id;
  839. cmd->flags |= (1 << WMI_ROAM_INVOKE_FLAG_REPORT_FAILURE);
  840. if (roaminvoke->is_same_bssid)
  841. cmd->flags |= (1 << WMI_ROAM_INVOKE_FLAG_NO_NULL_FRAME_TO_AP);
  842. if (roaminvoke->frame_len) {
  843. cmd->roam_scan_mode = WMI_ROAM_INVOKE_SCAN_MODE_SKIP;
  844. /* packing 1 beacon/probe_rsp frame with WMI cmd */
  845. cmd->num_buf = 1;
  846. } else {
  847. cmd->roam_scan_mode = WMI_ROAM_INVOKE_SCAN_MODE_FIXED_CH;
  848. cmd->num_buf = 0;
  849. }
  850. cmd->roam_ap_sel_mode = 0;
  851. cmd->roam_delay = 0;
  852. cmd->num_chan = 1;
  853. cmd->num_bssid = 1;
  854. if (roaminvoke->forced_roaming) {
  855. cmd->num_chan = 0;
  856. cmd->num_bssid = 0;
  857. cmd->roam_scan_mode = WMI_ROAM_INVOKE_SCAN_MODE_CACHE_MAP;
  858. cmd->flags |=
  859. (1 << WMI_ROAM_INVOKE_FLAG_FULL_SCAN_IF_NO_CANDIDATE);
  860. cmd->reason = ROAM_INVOKE_REASON_NUD_FAILURE;
  861. } else {
  862. cmd->reason = ROAM_INVOKE_REASON_USER_SPACE;
  863. }
  864. buf_ptr += sizeof(wmi_roam_invoke_cmd_fixed_param);
  865. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32,
  866. (sizeof(u_int32_t)));
  867. channel_list = (uint32_t *)(buf_ptr + WMI_TLV_HDR_SIZE);
  868. *channel_list = ch_hz;
  869. buf_ptr += sizeof(uint32_t) + WMI_TLV_HDR_SIZE;
  870. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_FIXED_STRUC,
  871. (sizeof(wmi_mac_addr)));
  872. bssid_list = (wmi_mac_addr *)(buf_ptr + WMI_TLV_HDR_SIZE);
  873. WMI_CHAR_ARRAY_TO_MAC_ADDR(roaminvoke->bssid, bssid_list);
  874. /* move to next tlv i.e. bcn_prb_buf_list */
  875. buf_ptr += WMI_TLV_HDR_SIZE + sizeof(wmi_mac_addr);
  876. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_FIXED_STRUC,
  877. sizeof(wmi_tlv_buf_len_param));
  878. buf_len_tlv = (wmi_tlv_buf_len_param *)(buf_ptr + WMI_TLV_HDR_SIZE);
  879. WMITLV_SET_HDR(&buf_len_tlv->tlv_header,
  880. WMITLV_TAG_STRUC_wmi_tlv_buf_len_param,
  881. WMITLV_GET_STRUCT_TLVLEN(wmi_tlv_buf_len_param));
  882. buf_len_tlv->buf_len = roaminvoke->frame_len;
  883. /* move to next tlv i.e. bcn_prb_frm */
  884. buf_ptr += WMI_TLV_HDR_SIZE + sizeof(wmi_tlv_buf_len_param);
  885. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE,
  886. roundup(roaminvoke->frame_len, sizeof(uint32_t)));
  887. /* copy frame after the header */
  888. qdf_mem_copy(buf_ptr + WMI_TLV_HDR_SIZE,
  889. roaminvoke->frame_buf,
  890. roaminvoke->frame_len);
  891. wmi_debug("flag:%d, MODE:%d, ap:%d, dly:%d, n_ch:%d, n_bssid:%d, ch:%d, is_same_bss:%d",
  892. cmd->flags, cmd->roam_scan_mode,
  893. cmd->roam_ap_sel_mode, cmd->roam_delay,
  894. cmd->num_chan, cmd->num_bssid, ch_hz,
  895. roaminvoke->is_same_bssid);
  896. wmi_mtrace(WMI_ROAM_INVOKE_CMDID, cmd->vdev_id, 0);
  897. if (wmi_unified_cmd_send(wmi_handle, wmi_buf, len,
  898. WMI_ROAM_INVOKE_CMDID)) {
  899. wmi_err("Failed to send roam invoke command");
  900. wmi_buf_free(wmi_buf);
  901. return QDF_STATUS_E_FAILURE;
  902. }
  903. return QDF_STATUS_SUCCESS;
  904. }
  905. /**
  906. * convert_control_roam_trigger_reason_bitmap() - Convert roam trigger bitmap
  907. *
  908. * @trigger_reason_bitmap: Roam trigger reason bitmap received from upper layers
  909. *
  910. * Converts the controlled roam trigger reason bitmap of
  911. * type @roam_control_trigger_reason to firmware trigger
  912. * reason bitmap as defined in
  913. * trigger_reason_bitmask @wmi_roam_enable_disable_trigger_reason_fixed_param
  914. *
  915. * Return: trigger_reason_bitmask as defined in
  916. * wmi_roam_enable_disable_trigger_reason_fixed_param
  917. */
  918. static uint32_t
  919. convert_control_roam_trigger_reason_bitmap(uint32_t trigger_reason_bitmap)
  920. {
  921. uint32_t fw_trigger_bitmap = 0, all_bitmap;
  922. /* Enable the complete trigger bitmap when all bits are set in
  923. * the control config bitmap
  924. */
  925. all_bitmap = BIT(ROAM_TRIGGER_REASON_MAX) - 1;
  926. if (trigger_reason_bitmap == all_bitmap)
  927. return BIT(WMI_ROAM_TRIGGER_EXT_REASON_MAX) - 1;
  928. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_NONE))
  929. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_NONE);
  930. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_PER))
  931. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_PER);
  932. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_BMISS))
  933. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_BMISS);
  934. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_LOW_RSSI))
  935. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_LOW_RSSI);
  936. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_HIGH_RSSI))
  937. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_HIGH_RSSI);
  938. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_PERIODIC))
  939. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_PERIODIC);
  940. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_MAWC))
  941. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_MAWC);
  942. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_DENSE))
  943. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_DENSE);
  944. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_BACKGROUND))
  945. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_BACKGROUND);
  946. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_FORCED))
  947. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_FORCED);
  948. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_BTM))
  949. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_BTM);
  950. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_UNIT_TEST))
  951. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_UNIT_TEST);
  952. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_BSS_LOAD))
  953. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_BSS_LOAD);
  954. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_DEAUTH))
  955. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_DEAUTH);
  956. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_IDLE))
  957. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_IDLE);
  958. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_STA_KICKOUT))
  959. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_STA_KICKOUT);
  960. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_ESS_RSSI))
  961. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_ESS_RSSI);
  962. if (trigger_reason_bitmap & BIT(ROAM_TRIGGER_REASON_WTC_BTM))
  963. fw_trigger_bitmap |= BIT(WMI_ROAM_TRIGGER_REASON_WTC_BTM);
  964. return fw_trigger_bitmap;
  965. }
  966. /**
  967. * get_internal_mandatory_roam_triggers() - Internal triggers to be added
  968. *
  969. * Return: the bitmap of mandatory triggers to be sent to firmware but not given
  970. * by user.
  971. */
  972. static uint32_t
  973. get_internal_mandatory_roam_triggers(void)
  974. {
  975. return BIT(WMI_ROAM_TRIGGER_REASON_FORCED);
  976. }
  977. /**
  978. * convert_roam_trigger_scan_mode() - Function to convert unified Roam trigger
  979. * scan mode enum to TLV specific ROAM_TRIGGER_SCAN_MODE
  980. * @scan_freq_scheme: scan freq scheme coming from userspace
  981. *
  982. * Return: ROAM_TRIGGER_SCAN_MODE
  983. */
  984. static WMI_ROAM_TRIGGER_SCAN_MODE
  985. convert_roam_trigger_scan_mode(enum roam_scan_freq_scheme scan_freq_scheme)
  986. {
  987. switch (scan_freq_scheme) {
  988. case ROAM_SCAN_FREQ_SCHEME_NO_SCAN:
  989. return ROAM_TRIGGER_SCAN_MODE_NO_SCAN_DISCONNECTION;
  990. case ROAM_SCAN_FREQ_SCHEME_PARTIAL_SCAN:
  991. return ROAM_TRIGGER_SCAN_MODE_PARTIAL;
  992. case ROAM_SCAN_FREQ_SCHEME_FULL_SCAN:
  993. return ROAM_TRIGGER_SCAN_MODE_FULL;
  994. default:
  995. return ROAM_TRIGGER_SCAN_MODE_NONE;
  996. }
  997. }
  998. /**
  999. * wmi_fill_default_roam_trigger_parameters() - Fill the default parameters
  1000. * for wmi_configure_roam_trigger_parameters tlv.
  1001. * @roam_trigger_params: pointer to wmi_configure_roam_trigger_parameters tlv
  1002. * to be filled.
  1003. * @roam_trigger: Roam trigger reason
  1004. *
  1005. * Return: None
  1006. */
  1007. static void wmi_fill_default_roam_trigger_parameters(
  1008. wmi_configure_roam_trigger_parameters *roam_trigger_params,
  1009. uint32_t roam_trigger)
  1010. {
  1011. WMITLV_SET_HDR(&roam_trigger_params->tlv_header,
  1012. WMITLV_TAG_STRUC_wmi_configure_roam_trigger_parameters,
  1013. WMITLV_GET_STRUCT_TLVLEN(wmi_configure_roam_trigger_parameters));
  1014. roam_trigger_params->trigger_reason = roam_trigger;
  1015. roam_trigger_params->enable = 1;
  1016. roam_trigger_params->scan_mode = ROAM_TRIGGER_SCAN_MODE_PARTIAL;
  1017. roam_trigger_params->trigger_rssi_threshold =
  1018. ROAM_MAX_CFG_VALUE;
  1019. roam_trigger_params->cand_ap_min_rssi_threshold =
  1020. ROAM_MAX_CFG_VALUE;
  1021. roam_trigger_params->roam_score_delta_percentage =
  1022. ROAM_MAX_CFG_VALUE;
  1023. roam_trigger_params->reason_code = ROAM_MAX_CFG_VALUE;
  1024. }
  1025. /**
  1026. * send_set_roam_trigger_cmd_tlv() - send set roam triggers to fw
  1027. * @wmi_handle: wmi handle
  1028. * @vdev_id: vdev id
  1029. * @trigger_bitmap: roam trigger bitmap to be enabled
  1030. *
  1031. * Send WMI_ROAM_ENABLE_DISABLE_TRIGGER_REASON_CMDID to fw.
  1032. *
  1033. * Return: QDF_STATUS
  1034. */
  1035. static QDF_STATUS send_set_roam_trigger_cmd_tlv(wmi_unified_t wmi_handle,
  1036. struct wlan_roam_triggers *triggers)
  1037. {
  1038. wmi_buf_t buf;
  1039. wmi_roam_enable_disable_trigger_reason_fixed_param *cmd;
  1040. uint32_t len = sizeof(*cmd);
  1041. int ret;
  1042. uint8_t *buf_ptr;
  1043. wmi_configure_roam_trigger_parameters
  1044. *roam_trigger_parameters;
  1045. uint32_t num_triggers_enabled = 0;
  1046. uint32_t roam_scan_scheme_bitmap = triggers->roam_scan_scheme_bitmap;
  1047. uint32_t total_tlv_len;
  1048. if (BIT(ROAM_TRIGGER_REASON_PER) & roam_scan_scheme_bitmap)
  1049. num_triggers_enabled++;
  1050. if (BIT(ROAM_TRIGGER_REASON_BMISS) & roam_scan_scheme_bitmap)
  1051. num_triggers_enabled++;
  1052. if (BIT(ROAM_TRIGGER_REASON_LOW_RSSI) & roam_scan_scheme_bitmap)
  1053. num_triggers_enabled++;
  1054. if (BIT(ROAM_TRIGGER_REASON_BTM) & roam_scan_scheme_bitmap)
  1055. num_triggers_enabled++;
  1056. if (BIT(ROAM_TRIGGER_REASON_BSS_LOAD) & roam_scan_scheme_bitmap)
  1057. num_triggers_enabled++;
  1058. total_tlv_len = sizeof(wmi_configure_roam_trigger_parameters) +
  1059. num_triggers_enabled *
  1060. sizeof(wmi_configure_roam_trigger_parameters);
  1061. len += WMI_TLV_HDR_SIZE + total_tlv_len;
  1062. buf = wmi_buf_alloc(wmi_handle, len);
  1063. if (!buf) {
  1064. wmi_err("Failed to allocate wmi buffer");
  1065. return QDF_STATUS_E_NOMEM;
  1066. }
  1067. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  1068. cmd = (wmi_roam_enable_disable_trigger_reason_fixed_param *)
  1069. wmi_buf_data(buf);
  1070. WMITLV_SET_HDR(&cmd->tlv_header,
  1071. WMITLV_TAG_STRUC_wmi_roam_enable_disable_trigger_reason_fixed_param,
  1072. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_enable_disable_trigger_reason_fixed_param));
  1073. cmd->vdev_id = triggers->vdev_id;
  1074. cmd->trigger_reason_bitmask =
  1075. convert_control_roam_trigger_reason_bitmap(triggers->trigger_bitmap);
  1076. wmi_debug("RSO_CFG: Received trigger bitmap: 0x%x converted trigger_bitmap: 0x%x",
  1077. triggers->trigger_bitmap, cmd->trigger_reason_bitmask);
  1078. cmd->trigger_reason_bitmask |= get_internal_mandatory_roam_triggers();
  1079. wmi_debug("RSO_CFG: vdev id: %d final trigger_bitmap: 0x%x roam_scan_scheme:0x%x num_triggers_enabled:%d",
  1080. cmd->vdev_id, cmd->trigger_reason_bitmask,
  1081. roam_scan_scheme_bitmap, num_triggers_enabled);
  1082. buf_ptr += sizeof(wmi_roam_enable_disable_trigger_reason_fixed_param);
  1083. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC, total_tlv_len);
  1084. buf_ptr += WMI_TLV_HDR_SIZE;
  1085. roam_trigger_parameters =
  1086. (wmi_configure_roam_trigger_parameters *)buf_ptr;
  1087. WMITLV_SET_HDR(&roam_trigger_parameters->tlv_header,
  1088. WMITLV_TAG_STRUC_wmi_configure_roam_trigger_parameters,
  1089. WMITLV_GET_STRUCT_TLVLEN(
  1090. wmi_configure_roam_trigger_parameters));
  1091. roam_trigger_parameters->trigger_reason =
  1092. WMI_ROAM_TRIGGER_REASON_WTC_BTM;
  1093. if (triggers->vendor_btm_param.user_roam_reason == 0)
  1094. roam_trigger_parameters->enable = 1;
  1095. roam_trigger_parameters->scan_mode = convert_roam_trigger_scan_mode(
  1096. triggers->vendor_btm_param.scan_freq_scheme);
  1097. roam_trigger_parameters->trigger_rssi_threshold =
  1098. triggers->vendor_btm_param.connected_rssi_threshold;
  1099. roam_trigger_parameters->cand_ap_min_rssi_threshold =
  1100. triggers->vendor_btm_param.candidate_rssi_threshold;
  1101. roam_trigger_parameters->roam_score_delta_percentage =
  1102. triggers->roam_score_delta;
  1103. roam_trigger_parameters->reason_code =
  1104. triggers->vendor_btm_param.user_roam_reason;
  1105. roam_trigger_parameters++;
  1106. if (num_triggers_enabled == 0)
  1107. goto send;
  1108. if (BIT(ROAM_TRIGGER_REASON_PER) & roam_scan_scheme_bitmap) {
  1109. wmi_fill_default_roam_trigger_parameters(
  1110. roam_trigger_parameters,
  1111. WMI_ROAM_TRIGGER_REASON_PER);
  1112. roam_trigger_parameters++;
  1113. }
  1114. if (BIT(ROAM_TRIGGER_REASON_BMISS) & roam_scan_scheme_bitmap) {
  1115. wmi_fill_default_roam_trigger_parameters(
  1116. roam_trigger_parameters,
  1117. WMI_ROAM_TRIGGER_REASON_BMISS);
  1118. roam_trigger_parameters++;
  1119. }
  1120. if (BIT(ROAM_TRIGGER_REASON_LOW_RSSI) & roam_scan_scheme_bitmap) {
  1121. wmi_fill_default_roam_trigger_parameters(
  1122. roam_trigger_parameters,
  1123. WMI_ROAM_TRIGGER_REASON_LOW_RSSI);
  1124. roam_trigger_parameters++;
  1125. }
  1126. if (BIT(ROAM_TRIGGER_REASON_BTM) & roam_scan_scheme_bitmap) {
  1127. wmi_fill_default_roam_trigger_parameters(
  1128. roam_trigger_parameters,
  1129. WMI_ROAM_TRIGGER_REASON_BTM);
  1130. roam_trigger_parameters++;
  1131. }
  1132. if (BIT(ROAM_TRIGGER_REASON_BSS_LOAD) & roam_scan_scheme_bitmap) {
  1133. wmi_fill_default_roam_trigger_parameters(
  1134. roam_trigger_parameters,
  1135. WMI_ROAM_TRIGGER_REASON_BSS_LOAD);
  1136. roam_trigger_parameters++;
  1137. }
  1138. send:
  1139. wmi_mtrace(WMI_ROAM_ENABLE_DISABLE_TRIGGER_REASON_CMDID,
  1140. triggers->vdev_id, 0);
  1141. ret = wmi_unified_cmd_send(wmi_handle, buf, len,
  1142. WMI_ROAM_ENABLE_DISABLE_TRIGGER_REASON_CMDID);
  1143. if (QDF_IS_STATUS_ERROR(ret)) {
  1144. wmi_err("Failed to send set roam triggers command ret = %d",
  1145. ret);
  1146. wmi_buf_free(buf);
  1147. }
  1148. return ret;
  1149. }
  1150. /**
  1151. * send_vdev_set_pcl_cmd_tlv() - Send WMI_VDEV_SET_PCL_CMDID to FW
  1152. * @wmi_handle: wmi handle
  1153. * @params: Set VDEV PCL params
  1154. *
  1155. * WMI_VDEV_SET_PCL_CMDID provides the Preferred Channel List (PCL) to WLAN
  1156. * firmware. The roaming module is the consumer of this information
  1157. * in the WLAN firmware. The channel list will be used when a VDEV needs
  1158. * to migrate to a new channel without host driver involvement. An example of
  1159. * this behavior is Legacy Fast Roaming (LFR 3.0).
  1160. *
  1161. * WMI_VDEV_SET_PCL_CMDID will carry only the weight list and not the actual
  1162. * channel list. The weights corresponds to the channels sent in
  1163. * WMI_SCAN_CHAN_LIST_CMDID. The channels from PCL would be having a higher
  1164. * weightage compared to the non PCL channels.
  1165. *
  1166. * When roaming is enabled on STA 1, PDEV pcl will be sent. When STA2 is
  1167. * up, VDEV pcl will be sent on STA 1 after calculating pcl again applying
  1168. * the bandmask and VDEV pcl will be sent for STA2. When one of the STA
  1169. * is disconnected, PDEV pcl will be sent on the other STA again.
  1170. *
  1171. * Return: Success if the cmd is sent successfully to the firmware
  1172. */
  1173. static QDF_STATUS
  1174. send_vdev_set_pcl_cmd_tlv(wmi_unified_t wmi_handle,
  1175. struct set_pcl_cmd_params *params)
  1176. {
  1177. wmi_vdev_set_pcl_cmd_fixed_param *cmd;
  1178. wmi_buf_t buf;
  1179. uint8_t *buf_ptr;
  1180. uint32_t *ch_weight, i;
  1181. size_t len;
  1182. uint32_t chan_len;
  1183. chan_len = params->weights->saved_num_chan;
  1184. len = sizeof(*cmd) + WMI_TLV_HDR_SIZE + (chan_len * sizeof(uint32_t));
  1185. buf = wmi_buf_alloc(wmi_handle, len);
  1186. if (!buf)
  1187. return QDF_STATUS_E_NOMEM;
  1188. cmd = (wmi_vdev_set_pcl_cmd_fixed_param *)wmi_buf_data(buf);
  1189. buf_ptr = (uint8_t *)cmd;
  1190. WMITLV_SET_HDR(&cmd->tlv_header,
  1191. WMITLV_TAG_STRUC_wmi_vdev_set_pcl_cmd_fixed_param,
  1192. WMITLV_GET_STRUCT_TLVLEN(wmi_vdev_set_pcl_cmd_fixed_param));
  1193. cmd->vdev_id = params->vdev_id;
  1194. buf_ptr += sizeof(wmi_vdev_set_pcl_cmd_fixed_param);
  1195. /* Channel weights uint32 Array TLV */
  1196. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32,
  1197. (chan_len * sizeof(uint32_t)));
  1198. ch_weight = (uint32_t *)(buf_ptr + WMI_TLV_HDR_SIZE);
  1199. for (i = 0; i < chan_len; i++)
  1200. ch_weight[i] = params->weights->weighed_valid_list[i];
  1201. wmi_mtrace(WMI_VDEV_SET_PCL_CMDID, params->vdev_id, 0);
  1202. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  1203. WMI_VDEV_SET_PCL_CMDID)) {
  1204. wmi_err("Failed to send WMI_VDEV_SET_PCL_CMDID");
  1205. wmi_buf_free(buf);
  1206. return QDF_STATUS_E_FAILURE;
  1207. }
  1208. return QDF_STATUS_SUCCESS;
  1209. }
  1210. /**
  1211. * extract_roam_btm_response_stats_tlv() - Extract the btm rsp stats
  1212. * from the WMI_ROAM_STATS_EVENTID
  1213. * @wmi_handle: wmi handle
  1214. * @evt_buf: Pointer to the event buffer
  1215. * @dst: Pointer to destination structure to fill data
  1216. * @idx: TLV id
  1217. */
  1218. static QDF_STATUS
  1219. extract_roam_btm_response_stats_tlv(wmi_unified_t wmi_handle, void *evt_buf,
  1220. struct roam_btm_response_data *dst,
  1221. uint8_t idx)
  1222. {
  1223. WMI_ROAM_STATS_EVENTID_param_tlvs *param_buf;
  1224. wmi_roam_btm_response_info *src_data = NULL;
  1225. param_buf = (WMI_ROAM_STATS_EVENTID_param_tlvs *)evt_buf;
  1226. if (!param_buf || !param_buf->roam_btm_response_info ||
  1227. !param_buf->num_roam_btm_response_info ||
  1228. idx >= param_buf->num_roam_btm_response_info) {
  1229. wmi_debug("Empty btm response param buf");
  1230. return QDF_STATUS_SUCCESS;
  1231. }
  1232. src_data = &param_buf->roam_btm_response_info[idx];
  1233. dst->present = true;
  1234. dst->btm_status = src_data->btm_status;
  1235. WMI_MAC_ADDR_TO_CHAR_ARRAY(&src_data->target_bssid,
  1236. dst->target_bssid.bytes);
  1237. dst->vsie_reason = src_data->vsie_reason;
  1238. dst->timestamp = src_data->timestamp;
  1239. return QDF_STATUS_SUCCESS;
  1240. }
  1241. /**
  1242. * extract_roam_initial_info_tlv() - Extract the roam initial info
  1243. * from the WMI_ROAM_STATS_EVENTID
  1244. * @wmi_handle: wmi handle
  1245. * @evt_buf: Pointer to the event buffer
  1246. * @dst: Pointer to destination structure to fill data
  1247. * @idx: TLV id
  1248. */
  1249. static QDF_STATUS
  1250. extract_roam_initial_info_tlv(wmi_unified_t wmi_handle, void *evt_buf,
  1251. struct roam_initial_data *dst, uint8_t idx)
  1252. {
  1253. WMI_ROAM_STATS_EVENTID_param_tlvs *param_buf;
  1254. wmi_roam_initial_info *src_data = NULL;
  1255. param_buf = (WMI_ROAM_STATS_EVENTID_param_tlvs *)evt_buf;
  1256. if (!param_buf || !param_buf->roam_initial_info ||
  1257. !param_buf->num_roam_initial_info ||
  1258. idx >= param_buf->num_roam_initial_info) {
  1259. wmi_debug("Empty roam_initial_info param buf");
  1260. return QDF_STATUS_SUCCESS;
  1261. }
  1262. src_data = &param_buf->roam_initial_info[idx];
  1263. dst->present = true;
  1264. dst->roam_full_scan_count = src_data->roam_full_scan_count;
  1265. dst->rssi_th = src_data->rssi_th;
  1266. dst->cu_th = src_data->cu_th;
  1267. dst->fw_cancel_timer_bitmap = src_data->timer_canceled;
  1268. return QDF_STATUS_SUCCESS;
  1269. }
  1270. void wmi_roam_offload_attach_tlv(wmi_unified_t wmi_handle)
  1271. {
  1272. struct wmi_ops *ops = wmi_handle->ops;
  1273. ops->extract_roam_btm_response_stats =
  1274. extract_roam_btm_response_stats_tlv;
  1275. ops->extract_roam_initial_info = extract_roam_initial_info_tlv;
  1276. ops->send_set_ric_req_cmd = send_set_ric_req_cmd_tlv;
  1277. ops->send_process_roam_synch_complete_cmd =
  1278. send_process_roam_synch_complete_cmd_tlv;
  1279. ops->send_roam_invoke_cmd = send_roam_invoke_cmd_tlv;
  1280. ops->send_vdev_set_pcl_cmd = send_vdev_set_pcl_cmd_tlv;
  1281. ops->send_set_roam_trigger_cmd = send_set_roam_trigger_cmd_tlv;
  1282. }
  1283. #else
  1284. static inline QDF_STATUS
  1285. extract_roam_btm_response_stats_tlv(wmi_unified_t wmi_handle, void *evt_buf,
  1286. struct roam_btm_response_data *dst,
  1287. uint8_t idx)
  1288. {
  1289. return QDF_STATUS_E_NOSUPPORT;
  1290. }
  1291. static inline QDF_STATUS
  1292. extract_roam_initial_info_tlv(wmi_unified_t wmi_handle, void *evt_buf,
  1293. struct roam_initial_data *dst, uint8_t idx)
  1294. {
  1295. return QDF_STATUS_E_NOSUPPORT;
  1296. }
  1297. #endif /* WLAN_FEATURE_ROAM_OFFLOAD */
  1298. #define ROAM_OFFLOAD_PMK_EXT_BYTES 16
  1299. #ifdef WLAN_FEATURE_ROAM_OFFLOAD
  1300. /**
  1301. * wmi_fill_roam_offload_11r_params() - Fill roam scan params to send it to fw
  1302. * @akm: Authentication key management type
  1303. * @roam_offload_11r: TLV to be filled with 11r params
  1304. * @roam_req: roam request param
  1305. */
  1306. static void wmi_fill_roam_offload_11r_params(
  1307. uint32_t akm,
  1308. wmi_roam_11r_offload_tlv_param *roam_offload_11r,
  1309. struct wlan_roam_scan_offload_params *roam_req)
  1310. {
  1311. struct wlan_rso_11r_params *src_11r_params;
  1312. uint8_t *psk_msk, len;
  1313. src_11r_params = &roam_req->rso_11r_info;
  1314. if (akm == WMI_AUTH_FT_RSNA_FILS_SHA256 ||
  1315. akm == WMI_AUTH_FT_RSNA_FILS_SHA384) {
  1316. psk_msk = roam_req->fils_roam_config.fils_ft;
  1317. len = roam_req->fils_roam_config.fils_ft_len;
  1318. } else {
  1319. psk_msk = src_11r_params->psk_pmk;
  1320. len = src_11r_params->pmk_len;
  1321. }
  1322. /*
  1323. * For SHA384 based akm, the pmk length is 48 bytes. So fill
  1324. * first 32 bytes in roam_offload_11r->psk_msk and the remaining
  1325. * bytes in roam_offload_11r->psk_msk_ext buffer
  1326. */
  1327. roam_offload_11r->psk_msk_len = len > ROAM_OFFLOAD_PSK_MSK_BYTES ?
  1328. ROAM_OFFLOAD_PSK_MSK_BYTES : len;
  1329. qdf_mem_copy(roam_offload_11r->psk_msk, psk_msk,
  1330. roam_offload_11r->psk_msk_len);
  1331. roam_offload_11r->psk_msk_ext_len = 0;
  1332. if (len > ROAM_OFFLOAD_PSK_MSK_BYTES) {
  1333. roam_offload_11r->psk_msk_ext_len =
  1334. len - roam_offload_11r->psk_msk_len;
  1335. qdf_mem_copy(roam_offload_11r->psk_msk_ext,
  1336. &psk_msk[roam_offload_11r->psk_msk_len],
  1337. roam_offload_11r->psk_msk_ext_len);
  1338. }
  1339. }
  1340. /**
  1341. * wmi_is_ft_akm() - Check if the akm is FT akm. Based on the AKM 11r params
  1342. * will be sent for lfr-3.0 roaming offload
  1343. * @akm: AKM negotiated for the connection
  1344. * @roam_req: roam request sent to firmware
  1345. *
  1346. * Return: true if the akm is 11r based
  1347. */
  1348. static bool wmi_is_ft_akm(int akm,
  1349. struct wlan_roam_scan_offload_params *roam_req)
  1350. {
  1351. switch (akm) {
  1352. case WMI_AUTH_FT_RSNA:
  1353. case WMI_AUTH_FT_RSNA_PSK:
  1354. case WMI_AUTH_FT_RSNA_SAE:
  1355. case WMI_AUTH_FT_RSNA_SUITE_B_8021X_SHA384:
  1356. case WMI_AUTH_FT_RSNA_FILS_SHA256:
  1357. case WMI_AUTH_FT_RSNA_FILS_SHA384:
  1358. return true;
  1359. case WMI_AUTH_OPEN:
  1360. if (roam_req->rso_11r_info.mdid.mdie_present &&
  1361. roam_req->rso_11r_info.is_11r_assoc)
  1362. return true;
  1363. break;
  1364. default:
  1365. return false;
  1366. }
  1367. return false;
  1368. }
  1369. /**
  1370. * wmi_get_rso_cmd_buf_len() - calculate the length needed to allocate buffer
  1371. * for RSO mode command
  1372. * @roam_req: roam request parameters
  1373. */
  1374. static uint32_t
  1375. wmi_get_rso_buf_len(struct wlan_roam_scan_offload_params *roam_req)
  1376. {
  1377. wmi_tlv_buf_len_param *assoc_ies;
  1378. uint32_t buf_len;
  1379. uint32_t fils_tlv_len = 0;
  1380. int akm = roam_req->akm;
  1381. /*
  1382. * Allocate room for wmi_roam_offload_tlv_param and
  1383. * 11i or 11r or ese roam offload tlv param
  1384. * Todo: Test if below headroom of 2 TLV header is needed
  1385. */
  1386. buf_len = (2 * WMI_TLV_HDR_SIZE);
  1387. if (roam_req->is_rso_stop ||
  1388. !roam_req->roam_offload_enabled) {
  1389. buf_len += (4 * WMI_TLV_HDR_SIZE);
  1390. if (!roam_req->is_rso_stop)
  1391. wmi_debug("vdev[%d]: %s roam offload: %d",
  1392. roam_req->vdev_id,
  1393. roam_req->is_rso_stop ? "RSO stop cmd." : "",
  1394. roam_req->roam_offload_enabled);
  1395. return buf_len;
  1396. }
  1397. wmi_debug("wmi akm = %d", akm);
  1398. buf_len += sizeof(wmi_roam_offload_tlv_param);
  1399. buf_len += 2 * WMI_TLV_HDR_SIZE;
  1400. if ((akm != WMI_AUTH_OPEN || roam_req->rso_ese_info.is_ese_assoc ||
  1401. wmi_is_ft_akm(akm, roam_req)) && akm != WMI_AUTH_NONE) {
  1402. if (roam_req->rso_ese_info.is_ese_assoc)
  1403. buf_len += sizeof(wmi_roam_ese_offload_tlv_param);
  1404. else if (wmi_is_ft_akm(akm, roam_req))
  1405. buf_len += sizeof(wmi_roam_11r_offload_tlv_param);
  1406. else
  1407. buf_len += sizeof(wmi_roam_11i_offload_tlv_param);
  1408. }
  1409. buf_len += (sizeof(*assoc_ies) + (2 * WMI_TLV_HDR_SIZE) +
  1410. roundup(roam_req->assoc_ie_length, sizeof(uint32_t)));
  1411. if (roam_req->add_fils_tlv) {
  1412. fils_tlv_len = sizeof(wmi_roam_fils_offload_tlv_param);
  1413. buf_len += WMI_TLV_HDR_SIZE + fils_tlv_len;
  1414. }
  1415. roam_req->rso_mode_info.roam_scan_mode |=
  1416. WMI_ROAM_SCAN_MODE_ROAMOFFLOAD;
  1417. return buf_len;
  1418. }
  1419. #if defined(WLAN_FEATURE_FILS_SK)
  1420. /**
  1421. * wmi_add_fils_tlv() - Add FILS TLV to roam scan offload command
  1422. * @wmi_handle: wmi handle
  1423. * @roam_req: Roam scan offload params
  1424. * @buf_ptr: command buffer to send
  1425. * @fils_tlv_len: fils tlv length
  1426. *
  1427. * Return: Updated buffer pointer
  1428. */
  1429. static uint8_t *wmi_add_fils_tlv(wmi_unified_t wmi_handle,
  1430. struct wlan_roam_scan_offload_params *roam_req,
  1431. uint8_t *buf_ptr, uint32_t fils_tlv_len)
  1432. {
  1433. wmi_roam_fils_offload_tlv_param *fils_tlv;
  1434. wmi_erp_info *erp_info;
  1435. struct wlan_roam_fils_params *roam_fils_params;
  1436. if (!roam_req->add_fils_tlv)
  1437. return buf_ptr;
  1438. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  1439. sizeof(*fils_tlv));
  1440. buf_ptr += WMI_TLV_HDR_SIZE;
  1441. fils_tlv = (wmi_roam_fils_offload_tlv_param *)buf_ptr;
  1442. WMITLV_SET_HDR(&fils_tlv->tlv_header,
  1443. WMITLV_TAG_STRUC_wmi_roam_fils_offload_tlv_param,
  1444. WMITLV_GET_STRUCT_TLVLEN
  1445. (wmi_roam_fils_offload_tlv_param));
  1446. roam_fils_params = &roam_req->fils_roam_config;
  1447. erp_info = (wmi_erp_info *)(&fils_tlv->vdev_erp_info);
  1448. erp_info->username_length = roam_fils_params->username_length;
  1449. qdf_mem_copy(erp_info->username, roam_fils_params->username,
  1450. erp_info->username_length);
  1451. erp_info->next_erp_seq_num = roam_fils_params->next_erp_seq_num;
  1452. erp_info->rRk_length = roam_fils_params->rrk_length;
  1453. qdf_mem_copy(erp_info->rRk, roam_fils_params->rrk,
  1454. erp_info->rRk_length);
  1455. erp_info->rIk_length = roam_fils_params->rik_length;
  1456. qdf_mem_copy(erp_info->rIk, roam_fils_params->rik,
  1457. erp_info->rIk_length);
  1458. erp_info->realm_len = roam_fils_params->realm_len;
  1459. qdf_mem_copy(erp_info->realm, roam_fils_params->realm,
  1460. erp_info->realm_len);
  1461. buf_ptr += sizeof(*fils_tlv);
  1462. wmi_debug("RSO_CFG: ERP: usrname_len:%d next_erp_seq_num:%d rRk_len:%d rIk_len:%d realm_len:%d",
  1463. erp_info->username_length, erp_info->next_erp_seq_num,
  1464. erp_info->rRk_length, erp_info->rIk_length,
  1465. erp_info->realm_len);
  1466. return buf_ptr;
  1467. }
  1468. #else
  1469. static inline
  1470. uint8_t *wmi_add_fils_tlv(wmi_unified_t wmi_handle,
  1471. struct wlan_roam_scan_offload_params *roam_req,
  1472. uint8_t *buf_ptr, uint32_t fils_tlv_len)
  1473. {
  1474. return buf_ptr;
  1475. }
  1476. #endif
  1477. #ifdef WLAN_SAE_SINGLE_PMK
  1478. static inline void
  1479. wmi_fill_sae_single_pmk_param(struct wlan_rso_11i_params *src_11i,
  1480. wmi_roam_11i_offload_tlv_param *roam_offload_11i)
  1481. {
  1482. if (src_11i->is_sae_same_pmk)
  1483. roam_offload_11i->flags |=
  1484. 1 << WMI_ROAM_OFFLOAD_FLAG_SAE_SAME_PMKID;
  1485. }
  1486. #else
  1487. static inline void
  1488. wmi_fill_sae_single_pmk_param(struct wlan_rso_11i_params *src_11i,
  1489. wmi_roam_11i_offload_tlv_param *roam_offload_11i)
  1490. {}
  1491. #endif
  1492. static QDF_STATUS
  1493. wmi_fill_rso_tlvs(wmi_unified_t wmi_handle, uint8_t *buf,
  1494. struct wlan_roam_scan_offload_params *roam_req)
  1495. {
  1496. wmi_roam_offload_tlv_param *roam_offload_params;
  1497. wmi_roam_11i_offload_tlv_param *roam_offload_11i;
  1498. wmi_roam_11r_offload_tlv_param *roam_offload_11r;
  1499. wmi_roam_ese_offload_tlv_param *roam_offload_ese;
  1500. wmi_tlv_buf_len_param *assoc_ies;
  1501. uint32_t fils_tlv_len = 0;
  1502. int akm = roam_req->akm;
  1503. struct wlan_rso_lfr3_params *src_lfr3_params =
  1504. &roam_req->rso_lfr3_params;
  1505. struct wlan_rso_lfr3_caps *src_lfr3_caps =
  1506. &roam_req->rso_lfr3_caps;
  1507. struct wlan_rso_11i_params *src_11i_info =
  1508. &roam_req->rso_11i_info;
  1509. struct wlan_rso_ese_params *src_ese_info =
  1510. &roam_req->rso_ese_info;
  1511. struct wlan_rso_11r_params *src_11r_info =
  1512. &roam_req->rso_11r_info;
  1513. /* For RSO stop command, dont fill 11i, 11r or ese tlv */
  1514. if (roam_req->is_rso_stop || !roam_req->roam_offload_enabled) {
  1515. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  1516. WMITLV_GET_STRUCT_TLVLEN(0));
  1517. buf += WMI_TLV_HDR_SIZE;
  1518. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  1519. WMITLV_GET_STRUCT_TLVLEN(0));
  1520. buf += WMI_TLV_HDR_SIZE;
  1521. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  1522. WMITLV_GET_STRUCT_TLVLEN(0));
  1523. buf += WMI_TLV_HDR_SIZE;
  1524. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  1525. WMITLV_GET_STRUCT_TLVLEN(0));
  1526. buf += WMI_TLV_HDR_SIZE;
  1527. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  1528. WMITLV_GET_STRUCT_TLVLEN(0));
  1529. buf += WMI_TLV_HDR_SIZE;
  1530. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_BYTE,
  1531. WMITLV_GET_STRUCT_TLVLEN(0));
  1532. return QDF_STATUS_SUCCESS;
  1533. }
  1534. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  1535. sizeof(wmi_roam_offload_tlv_param));
  1536. buf += WMI_TLV_HDR_SIZE;
  1537. roam_offload_params = (wmi_roam_offload_tlv_param *)buf;
  1538. WMITLV_SET_HDR(buf,
  1539. WMITLV_TAG_STRUC_wmi_roam_offload_tlv_param,
  1540. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_offload_tlv_param));
  1541. roam_offload_params->prefer_5g = src_lfr3_params->prefer_5ghz;
  1542. roam_offload_params->rssi_cat_gap = src_lfr3_params->roam_rssi_cat_gap;
  1543. roam_offload_params->select_5g_margin =
  1544. src_lfr3_params->select_5ghz_margin;
  1545. roam_offload_params->handoff_delay_for_rx =
  1546. src_lfr3_params->ho_delay_for_rx;
  1547. roam_offload_params->max_mlme_sw_retries =
  1548. src_lfr3_params->roam_retry_count;
  1549. roam_offload_params->no_ack_timeout =
  1550. src_lfr3_params->roam_preauth_no_ack_timeout;
  1551. roam_offload_params->reassoc_failure_timeout =
  1552. src_lfr3_params->reassoc_failure_timeout;
  1553. roam_offload_params->roam_candidate_validity_time =
  1554. src_lfr3_params->rct_validity_timer;
  1555. roam_offload_params->roam_to_current_bss_disable =
  1556. src_lfr3_params->disable_self_roam;
  1557. wmi_debug("RSO_CFG: prefer_5g:%d rssi_cat_gap:%d select_5g_margin:%d ho_delay:%d max_sw_retry:%d no_ack_timeout:%d",
  1558. roam_offload_params->prefer_5g,
  1559. roam_offload_params->rssi_cat_gap,
  1560. roam_offload_params->select_5g_margin,
  1561. roam_offload_params->handoff_delay_for_rx,
  1562. roam_offload_params->max_mlme_sw_retries,
  1563. roam_offload_params->no_ack_timeout);
  1564. wmi_debug("RSO_CFG: reassoc_fail_timeout:%d rct_validity_time:%d disable_self_roam:%d",
  1565. roam_offload_params->reassoc_failure_timeout,
  1566. roam_offload_params->roam_candidate_validity_time,
  1567. roam_offload_params->roam_to_current_bss_disable);
  1568. /* Fill the capabilities */
  1569. roam_offload_params->capability = src_lfr3_caps->capability;
  1570. roam_offload_params->ht_caps_info = src_lfr3_caps->ht_caps_info;
  1571. roam_offload_params->ampdu_param = src_lfr3_caps->ampdu_param;
  1572. roam_offload_params->ht_ext_cap = src_lfr3_caps->ht_ext_cap;
  1573. roam_offload_params->ht_txbf = src_lfr3_caps->ht_txbf;
  1574. roam_offload_params->asel_cap = src_lfr3_caps->asel_cap;
  1575. roam_offload_params->qos_caps = src_lfr3_caps->qos_caps;
  1576. roam_offload_params->qos_enabled = src_lfr3_caps->qos_enabled;
  1577. roam_offload_params->wmm_caps = src_lfr3_caps->wmm_caps;
  1578. qdf_mem_copy((uint8_t *)roam_offload_params->mcsset,
  1579. (uint8_t *)src_lfr3_caps->mcsset,
  1580. ROAM_OFFLOAD_NUM_MCS_SET);
  1581. wmi_debug("RSO_CFG: capability:0x%x ht_caps:0x%x ampdu_param:0%x ht_ext_cap:0x%x ht_txbf:0x%x asel_cap:0x%x qos_caps:0x%x qos_en:%d wmm_caps:0x%x",
  1582. roam_offload_params->capability,
  1583. roam_offload_params->ht_caps_info,
  1584. roam_offload_params->ampdu_param,
  1585. roam_offload_params->ht_ext_cap,
  1586. roam_offload_params->ht_txbf, roam_offload_params->asel_cap,
  1587. roam_offload_params->qos_caps,
  1588. roam_offload_params->qos_enabled,
  1589. roam_offload_params->wmm_caps);
  1590. buf += sizeof(wmi_roam_offload_tlv_param);
  1591. /*
  1592. * The TLV's are in the order of 11i, 11R, ESE. Hence,
  1593. * they are filled in the same order.Depending on the
  1594. * authentication type, the other mode TLV's are nullified
  1595. * and only headers are filled.
  1596. */
  1597. if ((akm != WMI_AUTH_OPEN || roam_req->rso_ese_info.is_ese_assoc ||
  1598. wmi_is_ft_akm(akm, roam_req)) && akm != WMI_AUTH_NONE) {
  1599. if (roam_req->rso_ese_info.is_ese_assoc) {
  1600. /* Fill the length of 11i, 11r TLV as 0 */
  1601. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  1602. buf += WMI_TLV_HDR_SIZE;
  1603. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  1604. buf += WMI_TLV_HDR_SIZE;
  1605. /* Start filling the ESE TLV */
  1606. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  1607. sizeof(wmi_roam_ese_offload_tlv_param));
  1608. buf += WMI_TLV_HDR_SIZE;
  1609. roam_offload_ese =
  1610. (wmi_roam_ese_offload_tlv_param *)buf;
  1611. qdf_mem_copy(roam_offload_ese->krk, src_ese_info->krk,
  1612. sizeof(src_ese_info->krk));
  1613. qdf_mem_copy(roam_offload_ese->btk, src_ese_info->btk,
  1614. sizeof(src_ese_info->btk));
  1615. WMITLV_SET_HDR(&roam_offload_ese->tlv_header,
  1616. WMITLV_TAG_STRUC_wmi_roam_ese_offload_tlv_param,
  1617. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_ese_offload_tlv_param));
  1618. buf += sizeof(wmi_roam_ese_offload_tlv_param);
  1619. } else if (wmi_is_ft_akm(akm, roam_req)) {
  1620. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  1621. buf += WMI_TLV_HDR_SIZE;
  1622. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  1623. sizeof(wmi_roam_11r_offload_tlv_param));
  1624. buf += WMI_TLV_HDR_SIZE;
  1625. roam_offload_11r =
  1626. (wmi_roam_11r_offload_tlv_param *)buf;
  1627. roam_offload_11r->r0kh_id_len =
  1628. src_11r_info->r0kh_id_length;
  1629. qdf_mem_copy(roam_offload_11r->r0kh_id,
  1630. src_11r_info->r0kh_id,
  1631. src_11r_info->r0kh_id_length);
  1632. wmi_fill_roam_offload_11r_params(akm, roam_offload_11r,
  1633. roam_req);
  1634. roam_offload_11r->mdie_present =
  1635. src_11r_info->mdid.mdie_present;
  1636. roam_offload_11r->mdid =
  1637. src_11r_info->mdid.mobility_domain;
  1638. roam_offload_11r->adaptive_11r =
  1639. src_11r_info->is_adaptive_11r;
  1640. roam_offload_11r->ft_im_for_deauth =
  1641. src_11r_info->enable_ft_im_roaming;
  1642. if (akm == WMI_AUTH_OPEN) {
  1643. /*
  1644. * If FT-Open ensure pmk length
  1645. * and r0khid len are zero
  1646. */
  1647. roam_offload_11r->r0kh_id_len = 0;
  1648. roam_offload_11r->psk_msk_len = 0;
  1649. }
  1650. WMITLV_SET_HDR(&roam_offload_11r->tlv_header,
  1651. WMITLV_TAG_STRUC_wmi_roam_11r_offload_tlv_param,
  1652. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_11r_offload_tlv_param));
  1653. buf += sizeof(wmi_roam_11r_offload_tlv_param);
  1654. /* Set ESE TLV len to 0*/
  1655. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  1656. buf += WMI_TLV_HDR_SIZE;
  1657. wmi_debug("RSO_CFG: vdev[%d] 11r TLV psk_msk_len = %d psk_msk_ext:%d md:0x%x",
  1658. roam_req->vdev_id,
  1659. roam_offload_11r->psk_msk_len,
  1660. roam_offload_11r->psk_msk_ext_len,
  1661. roam_offload_11r->mdid);
  1662. } else {
  1663. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC,
  1664. sizeof(wmi_roam_11i_offload_tlv_param));
  1665. buf += WMI_TLV_HDR_SIZE;
  1666. roam_offload_11i =
  1667. (wmi_roam_11i_offload_tlv_param *)buf;
  1668. if (src_11i_info->roam_key_mgmt_offload_enabled &&
  1669. src_11i_info->fw_okc)
  1670. WMI_SET_ROAM_OFFLOAD_OKC_ENABLED(
  1671. roam_offload_11i->flags);
  1672. else
  1673. WMI_SET_ROAM_OFFLOAD_OKC_DISABLED(
  1674. roam_offload_11i->flags);
  1675. if (src_11i_info->roam_key_mgmt_offload_enabled &&
  1676. src_11i_info->fw_pmksa_cache)
  1677. WMI_SET_ROAM_OFFLOAD_PMK_CACHE_ENABLED(
  1678. roam_offload_11i->flags);
  1679. else
  1680. WMI_SET_ROAM_OFFLOAD_PMK_CACHE_DISABLED(
  1681. roam_offload_11i->flags);
  1682. wmi_fill_sae_single_pmk_param(src_11i_info,
  1683. roam_offload_11i);
  1684. roam_offload_11i->pmk_len =
  1685. src_11i_info->pmk_len > ROAM_OFFLOAD_PMK_BYTES ?
  1686. ROAM_OFFLOAD_PMK_BYTES : src_11i_info->pmk_len;
  1687. qdf_mem_copy(roam_offload_11i->pmk,
  1688. src_11i_info->psk_pmk,
  1689. roam_offload_11i->pmk_len);
  1690. roam_offload_11i->pmk_ext_len =
  1691. src_11i_info->pmk_len > ROAM_OFFLOAD_PMK_BYTES ?
  1692. ROAM_OFFLOAD_PMK_EXT_BYTES : 0;
  1693. qdf_mem_copy(
  1694. roam_offload_11i->pmk_ext,
  1695. &src_11i_info->psk_pmk[ROAM_OFFLOAD_PMK_BYTES],
  1696. roam_offload_11i->pmk_ext_len);
  1697. WMITLV_SET_HDR(&roam_offload_11i->tlv_header,
  1698. WMITLV_TAG_STRUC_wmi_roam_11i_offload_tlv_param,
  1699. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_11i_offload_tlv_param));
  1700. buf += sizeof(wmi_roam_11i_offload_tlv_param);
  1701. /*
  1702. * Set 11r TLV len to 0, since security profile is not
  1703. * FT
  1704. */
  1705. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  1706. buf += WMI_TLV_HDR_SIZE;
  1707. /*
  1708. * Set ESE TLV len to 0 since security profile is not
  1709. * ESE
  1710. */
  1711. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  1712. buf += WMI_TLV_HDR_SIZE;
  1713. wmi_info("RSO_CFG: vdev:%d pmk_len = %d pmksa caching:%d OKC:%d sae_same_pmk:%d key_mgmt_offload:%d",
  1714. roam_req->vdev_id, roam_offload_11i->pmk_len,
  1715. src_11i_info->fw_pmksa_cache,
  1716. src_11i_info->fw_okc,
  1717. src_11i_info->is_sae_same_pmk,
  1718. src_11i_info->roam_key_mgmt_offload_enabled);
  1719. if (roam_offload_11i->pmk_len)
  1720. QDF_TRACE_HEX_DUMP(QDF_MODULE_ID_WMI,
  1721. QDF_TRACE_LEVEL_DEBUG,
  1722. roam_offload_11i->pmk,
  1723. WLAN_MAX_PMK_DUMP_BYTES);
  1724. }
  1725. } else {
  1726. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  1727. buf += WMI_TLV_HDR_SIZE;
  1728. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  1729. buf += WMI_TLV_HDR_SIZE;
  1730. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, 0);
  1731. buf += WMI_TLV_HDR_SIZE;
  1732. }
  1733. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_STRUC, sizeof(*assoc_ies));
  1734. buf += WMI_TLV_HDR_SIZE;
  1735. assoc_ies = (wmi_tlv_buf_len_param *)buf;
  1736. WMITLV_SET_HDR(&assoc_ies->tlv_header,
  1737. WMITLV_TAG_STRUC_wmi_tlv_buf_len_param,
  1738. WMITLV_GET_STRUCT_TLVLEN(wmi_tlv_buf_len_param));
  1739. assoc_ies->buf_len = roam_req->assoc_ie_length;
  1740. buf += sizeof(*assoc_ies);
  1741. WMITLV_SET_HDR(buf, WMITLV_TAG_ARRAY_BYTE,
  1742. roundup(assoc_ies->buf_len, sizeof(uint32_t)));
  1743. buf += WMI_TLV_HDR_SIZE;
  1744. wmi_debug("RSO_CFG: akm:%d assoc_ies len:%d", akm, assoc_ies->buf_len);
  1745. if (assoc_ies->buf_len)
  1746. qdf_mem_copy(buf, roam_req->assoc_ie, assoc_ies->buf_len);
  1747. buf += qdf_roundup(assoc_ies->buf_len, sizeof(uint32_t));
  1748. buf = wmi_add_fils_tlv(wmi_handle, roam_req, buf, fils_tlv_len);
  1749. return QDF_STATUS_SUCCESS;
  1750. }
  1751. #else
  1752. static inline
  1753. uint32_t wmi_get_rso_buf_len(struct wlan_roam_scan_offload_params *roam_req)
  1754. {
  1755. return 0;
  1756. }
  1757. static inline QDF_STATUS
  1758. wmi_fill_rso_tlvs(wmi_unified_t wmi_handle, uint8_t *buf_ptr,
  1759. struct wlan_roam_scan_offload_params *roam_req)
  1760. {
  1761. return QDF_STATUS_SUCCESS;
  1762. }
  1763. #endif
  1764. static QDF_STATUS
  1765. wmi_fill_rso_start_scan_tlv(struct wlan_roam_scan_offload_params *rso_req,
  1766. wmi_start_scan_cmd_fixed_param *scan_tlv)
  1767. {
  1768. struct wlan_roam_scan_params *src_scan_params;
  1769. src_scan_params = &rso_req->rso_scan_params;
  1770. scan_tlv->scan_ctrl_flags = WMI_SCAN_ADD_CCK_RATES |
  1771. WMI_SCAN_ADD_OFDM_RATES |
  1772. WMI_SCAN_ADD_DS_IE_IN_PROBE_REQ;
  1773. if (rso_req->is_rso_stop) {
  1774. scan_tlv->dwell_time_active =
  1775. ROAM_SCAN_DWELL_TIME_ACTIVE_DEFAULT;
  1776. scan_tlv->dwell_time_passive =
  1777. ROAM_SCAN_DWELL_TIME_PASSIVE_DEFAULT;
  1778. scan_tlv->min_rest_time = ROAM_SCAN_MIN_REST_TIME_DEFAULT;
  1779. scan_tlv->max_rest_time = ROAM_SCAN_MAX_REST_TIME_DEFAULT;
  1780. scan_tlv->repeat_probe_time = 0;
  1781. scan_tlv->probe_spacing_time = 0;
  1782. scan_tlv->probe_delay = 0;
  1783. scan_tlv->max_scan_time = ROAM_SCAN_HW_DEF_SCAN_MAX_DURATION;
  1784. scan_tlv->idle_time = src_scan_params->min_rest_time;
  1785. scan_tlv->burst_duration = 0;
  1786. return QDF_STATUS_SUCCESS;
  1787. }
  1788. scan_tlv->dwell_time_active = src_scan_params->dwell_time_active;
  1789. scan_tlv->dwell_time_passive = src_scan_params->dwell_time_passive;
  1790. scan_tlv->burst_duration = src_scan_params->burst_duration;
  1791. scan_tlv->min_rest_time = src_scan_params->min_rest_time;
  1792. scan_tlv->max_rest_time = src_scan_params->max_rest_time;
  1793. scan_tlv->repeat_probe_time = src_scan_params->repeat_probe_time;
  1794. scan_tlv->probe_spacing_time = src_scan_params->probe_spacing_time;
  1795. scan_tlv->probe_delay = src_scan_params->probe_delay;
  1796. scan_tlv->max_scan_time = ROAM_SCAN_HW_DEF_SCAN_MAX_DURATION;
  1797. scan_tlv->idle_time = src_scan_params->idle_time;
  1798. scan_tlv->n_probes = src_scan_params->n_probes;
  1799. scan_tlv->scan_ctrl_flags |= src_scan_params->scan_ctrl_flags;
  1800. WMI_SCAN_SET_DWELL_MODE(scan_tlv->scan_ctrl_flags,
  1801. src_scan_params->rso_adaptive_dwell_mode);
  1802. /* Configure roaming scan behavior (DBS/Non-DBS scan) */
  1803. if (rso_req->roaming_scan_policy)
  1804. scan_tlv->scan_ctrl_flags_ext |=
  1805. WMI_SCAN_DBS_POLICY_FORCE_NONDBS;
  1806. else
  1807. scan_tlv->scan_ctrl_flags_ext |=
  1808. WMI_SCAN_DBS_POLICY_DEFAULT;
  1809. wmi_debug("RSO_CFG: dwell time: active %d passive %d, minrest %d max rest %d repeat probe time %d probe_spacing:%d",
  1810. scan_tlv->dwell_time_active, scan_tlv->dwell_time_passive,
  1811. scan_tlv->min_rest_time, scan_tlv->max_rest_time,
  1812. scan_tlv->repeat_probe_time, scan_tlv->probe_spacing_time);
  1813. wmi_debug("RSO_CFG: ctrl_flags:0x%x probe_delay:%d max_scan_time:%d idle_time:%d n_probes:%d",
  1814. scan_tlv->scan_ctrl_flags_ext, scan_tlv->probe_delay,
  1815. scan_tlv->max_scan_time, scan_tlv->idle_time,
  1816. scan_tlv->n_probes);
  1817. return QDF_STATUS_SUCCESS;
  1818. }
  1819. /**
  1820. * send_roam_scan_offload_mode_cmd_tlv() - send roam scan mode request to fw
  1821. * @wmi_handle: wmi handle
  1822. * @scan_cmd_fp: start scan command ptr
  1823. * @roam_req: roam request param
  1824. *
  1825. * send WMI_ROAM_SCAN_MODE TLV to firmware. It has a piggyback
  1826. * of WMI_ROAM_SCAN_MODE.
  1827. *
  1828. * Return: QDF status
  1829. */
  1830. static QDF_STATUS
  1831. send_roam_scan_offload_mode_cmd_tlv(
  1832. wmi_unified_t wmi_handle,
  1833. struct wlan_roam_scan_offload_params *rso_req)
  1834. {
  1835. wmi_buf_t buf = NULL;
  1836. QDF_STATUS status;
  1837. size_t len;
  1838. uint8_t *buf_ptr;
  1839. wmi_roam_scan_mode_fixed_param *roam_scan_mode_fp;
  1840. wmi_start_scan_cmd_fixed_param *scan_cmd_fp;
  1841. struct wlan_roam_scan_mode_params *src_rso_mode_info = NULL;
  1842. /*
  1843. * Need to create a buf with roam_scan command at
  1844. * front and piggyback with scan command
  1845. */
  1846. len = sizeof(wmi_roam_scan_mode_fixed_param) +
  1847. sizeof(wmi_start_scan_cmd_fixed_param);
  1848. len += wmi_get_rso_buf_len(rso_req);
  1849. if (rso_req->rso_mode_info.roam_scan_mode ==
  1850. (WMI_ROAM_SCAN_MODE_NONE | WMI_ROAM_SCAN_MODE_ROAMOFFLOAD))
  1851. len = sizeof(wmi_roam_scan_mode_fixed_param);
  1852. buf = wmi_buf_alloc(wmi_handle, len);
  1853. if (!buf)
  1854. return QDF_STATUS_E_NOMEM;
  1855. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  1856. src_rso_mode_info = &rso_req->rso_mode_info;
  1857. roam_scan_mode_fp = (wmi_roam_scan_mode_fixed_param *)buf_ptr;
  1858. WMITLV_SET_HDR(
  1859. &roam_scan_mode_fp->tlv_header,
  1860. WMITLV_TAG_STRUC_wmi_roam_scan_mode_fixed_param,
  1861. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_scan_mode_fixed_param));
  1862. roam_scan_mode_fp->min_delay_roam_trigger_reason_bitmask =
  1863. src_rso_mode_info->min_delay_roam_trigger_bitmask;
  1864. roam_scan_mode_fp->min_delay_btw_scans =
  1865. WMI_SEC_TO_MSEC(src_rso_mode_info->min_delay_btw_scans);
  1866. roam_scan_mode_fp->roam_scan_mode = src_rso_mode_info->roam_scan_mode;
  1867. roam_scan_mode_fp->vdev_id = rso_req->vdev_id;
  1868. wmi_debug("RSO_CFG: vdev_id:%d roam scan mode:0x%x min_delay_bitmap:0x%x min_delay_btw_scans:%d",
  1869. rso_req->vdev_id,
  1870. roam_scan_mode_fp->roam_scan_mode,
  1871. roam_scan_mode_fp->min_delay_roam_trigger_reason_bitmask,
  1872. roam_scan_mode_fp->min_delay_btw_scans);
  1873. /*
  1874. * For supplicant disabled roaming, all other roam triggers are disabled
  1875. * so send only roam scan mode Fixed param in the command
  1876. */
  1877. if (src_rso_mode_info->roam_scan_mode ==
  1878. (WMI_ROAM_SCAN_MODE_NONE | WMI_ROAM_SCAN_MODE_ROAMOFFLOAD)) {
  1879. roam_scan_mode_fp->flags |=
  1880. WMI_ROAM_SCAN_MODE_FLAG_REPORT_STATUS;
  1881. goto send_roam_scan_mode_cmd;
  1882. }
  1883. /* Fill in scan parameters suitable for roaming scan */
  1884. buf_ptr += sizeof(wmi_roam_scan_mode_fixed_param);
  1885. WMITLV_SET_HDR(
  1886. buf_ptr,
  1887. WMITLV_TAG_STRUC_wmi_start_scan_cmd_fixed_param,
  1888. WMITLV_GET_STRUCT_TLVLEN(wmi_start_scan_cmd_fixed_param));
  1889. scan_cmd_fp = (wmi_start_scan_cmd_fixed_param *)buf_ptr;
  1890. wmi_fill_rso_start_scan_tlv(rso_req, scan_cmd_fp);
  1891. /* Ensure there is no additional IEs */
  1892. scan_cmd_fp->ie_len = 0;
  1893. buf_ptr += sizeof(wmi_start_scan_cmd_fixed_param);
  1894. status = wmi_fill_rso_tlvs(wmi_handle, buf_ptr, rso_req);
  1895. if (QDF_IS_STATUS_ERROR(status)) {
  1896. wmi_buf_free(buf);
  1897. return status;
  1898. }
  1899. send_roam_scan_mode_cmd:
  1900. wmi_mtrace(WMI_ROAM_SCAN_MODE, rso_req->vdev_id, 0);
  1901. status = wmi_unified_cmd_send(wmi_handle, buf,
  1902. len, WMI_ROAM_SCAN_MODE);
  1903. if (QDF_IS_STATUS_ERROR(status))
  1904. wmi_buf_free(buf);
  1905. return status;
  1906. }
  1907. /**
  1908. * convert_roam_trigger_reason() - Function to convert unified Roam trigger
  1909. * enum to TLV specific WMI_ROAM_TRIGGER_REASON_ID
  1910. * @reason: Roam trigger reason
  1911. *
  1912. * Return: WMI_ROAM_TRIGGER_REASON_ID
  1913. */
  1914. static WMI_ROAM_TRIGGER_REASON_ID
  1915. convert_roam_trigger_reason(enum roam_trigger_reason trigger_reason)
  1916. {
  1917. switch (trigger_reason) {
  1918. case ROAM_TRIGGER_REASON_NONE:
  1919. return WMI_ROAM_TRIGGER_REASON_NONE;
  1920. case ROAM_TRIGGER_REASON_PER:
  1921. return WMI_ROAM_TRIGGER_REASON_PER;
  1922. case ROAM_TRIGGER_REASON_BMISS:
  1923. return WMI_ROAM_TRIGGER_REASON_BMISS;
  1924. case ROAM_TRIGGER_REASON_LOW_RSSI:
  1925. return WMI_ROAM_TRIGGER_REASON_LOW_RSSI;
  1926. case ROAM_TRIGGER_REASON_HIGH_RSSI:
  1927. return WMI_ROAM_TRIGGER_REASON_HIGH_RSSI;
  1928. case ROAM_TRIGGER_REASON_PERIODIC:
  1929. return WMI_ROAM_TRIGGER_REASON_PERIODIC;
  1930. case ROAM_TRIGGER_REASON_MAWC:
  1931. return WMI_ROAM_TRIGGER_REASON_MAWC;
  1932. case ROAM_TRIGGER_REASON_DENSE:
  1933. return WMI_ROAM_TRIGGER_REASON_DENSE;
  1934. case ROAM_TRIGGER_REASON_BACKGROUND:
  1935. return WMI_ROAM_TRIGGER_REASON_BACKGROUND;
  1936. case ROAM_TRIGGER_REASON_FORCED:
  1937. return WMI_ROAM_TRIGGER_REASON_FORCED;
  1938. case ROAM_TRIGGER_REASON_BTM:
  1939. return WMI_ROAM_TRIGGER_REASON_BTM;
  1940. case ROAM_TRIGGER_REASON_UNIT_TEST:
  1941. return WMI_ROAM_TRIGGER_REASON_UNIT_TEST;
  1942. case ROAM_TRIGGER_REASON_BSS_LOAD:
  1943. return WMI_ROAM_TRIGGER_REASON_BSS_LOAD;
  1944. case ROAM_TRIGGER_REASON_DEAUTH:
  1945. return WMI_ROAM_TRIGGER_REASON_DEAUTH;
  1946. case ROAM_TRIGGER_REASON_IDLE:
  1947. return WMI_ROAM_TRIGGER_REASON_IDLE;
  1948. case ROAM_TRIGGER_REASON_MAX:
  1949. return WMI_ROAM_TRIGGER_REASON_MAX;
  1950. default:
  1951. return WMI_ROAM_TRIGGER_REASON_NONE;
  1952. }
  1953. }
  1954. /**
  1955. * send_roam_scan_offload_ap_profile_cmd_tlv() - set roam ap profile in fw
  1956. * @wmi_handle: wmi handle
  1957. * @ap_profile_p: ap profile
  1958. *
  1959. * Send WMI_ROAM_AP_PROFILE to firmware
  1960. *
  1961. * Return: CDF status
  1962. */
  1963. static QDF_STATUS
  1964. send_roam_scan_offload_ap_profile_cmd_tlv(wmi_unified_t wmi_handle,
  1965. struct ap_profile_params *ap_profile)
  1966. {
  1967. wmi_buf_t buf = NULL;
  1968. QDF_STATUS status;
  1969. size_t len;
  1970. uint8_t *buf_ptr;
  1971. wmi_roam_ap_profile_fixed_param *roam_ap_profile_fp;
  1972. wmi_roam_cnd_scoring_param *score_param;
  1973. wmi_ap_profile *profile;
  1974. wmi_roam_score_delta_param *score_delta_param;
  1975. wmi_roam_cnd_min_rssi_param *min_rssi_param;
  1976. enum roam_trigger_reason trig_reason;
  1977. len = sizeof(wmi_roam_ap_profile_fixed_param) + sizeof(wmi_ap_profile);
  1978. len += sizeof(*score_param);
  1979. len += WMI_TLV_HDR_SIZE;
  1980. len += NUM_OF_ROAM_TRIGGERS * sizeof(*score_delta_param);
  1981. len += WMI_TLV_HDR_SIZE;
  1982. len += NUM_OF_ROAM_MIN_RSSI * sizeof(*min_rssi_param);
  1983. buf = wmi_buf_alloc(wmi_handle, len);
  1984. if (!buf)
  1985. return QDF_STATUS_E_NOMEM;
  1986. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  1987. roam_ap_profile_fp = (wmi_roam_ap_profile_fixed_param *)buf_ptr;
  1988. WMITLV_SET_HDR(&roam_ap_profile_fp->tlv_header,
  1989. WMITLV_TAG_STRUC_wmi_roam_ap_profile_fixed_param,
  1990. WMITLV_GET_STRUCT_TLVLEN
  1991. (wmi_roam_ap_profile_fixed_param));
  1992. /* fill in threshold values */
  1993. roam_ap_profile_fp->vdev_id = ap_profile->vdev_id;
  1994. roam_ap_profile_fp->id = 0;
  1995. buf_ptr += sizeof(wmi_roam_ap_profile_fixed_param);
  1996. profile = (wmi_ap_profile *)buf_ptr;
  1997. WMITLV_SET_HDR(&profile->tlv_header,
  1998. WMITLV_TAG_STRUC_wmi_ap_profile,
  1999. WMITLV_GET_STRUCT_TLVLEN(wmi_ap_profile));
  2000. profile->flags = ap_profile->profile.flags;
  2001. profile->rssi_threshold = ap_profile->profile.rssi_threshold;
  2002. profile->bg_rssi_threshold = ap_profile->profile.bg_rssi_threshold;
  2003. profile->ssid.ssid_len = ap_profile->profile.ssid.length;
  2004. qdf_mem_copy(profile->ssid.ssid, ap_profile->profile.ssid.ssid,
  2005. profile->ssid.ssid_len);
  2006. profile->rsn_authmode = ap_profile->profile.rsn_authmode;
  2007. profile->rsn_ucastcipherset = ap_profile->profile.rsn_ucastcipherset;
  2008. profile->rsn_mcastcipherset = ap_profile->profile.rsn_mcastcipherset;
  2009. profile->rsn_mcastmgmtcipherset =
  2010. ap_profile->profile.rsn_mcastmgmtcipherset;
  2011. profile->rssi_abs_thresh = ap_profile->profile.rssi_abs_thresh;
  2012. wmi_debug("vdev %d AP PROFILE: flags:%x rssi_thres:%d bg_rssi_thres:%d ssid:%.*s authmode:%d uc cipher:%d mc cipher:%d mc mgmt cipher:%d rssi abs thresh:%d",
  2013. roam_ap_profile_fp->vdev_id,
  2014. profile->flags, profile->rssi_threshold,
  2015. profile->bg_rssi_threshold,
  2016. profile->ssid.ssid_len, ap_profile->profile.ssid.ssid,
  2017. profile->rsn_authmode, profile->rsn_ucastcipherset,
  2018. profile->rsn_mcastcipherset, profile->rsn_mcastmgmtcipherset,
  2019. profile->rssi_abs_thresh);
  2020. buf_ptr += sizeof(wmi_ap_profile);
  2021. score_param = (wmi_roam_cnd_scoring_param *)buf_ptr;
  2022. WMITLV_SET_HDR(&score_param->tlv_header,
  2023. WMITLV_TAG_STRUC_wmi_roam_cnd_scoring_param,
  2024. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_cnd_scoring_param));
  2025. score_param->disable_bitmap = ap_profile->param.disable_bitmap;
  2026. score_param->rssi_weightage_pcnt =
  2027. ap_profile->param.rssi_weightage;
  2028. score_param->ht_weightage_pcnt = ap_profile->param.ht_weightage;
  2029. score_param->vht_weightage_pcnt = ap_profile->param.vht_weightage;
  2030. score_param->he_weightage_pcnt = ap_profile->param.he_weightage;
  2031. score_param->bw_weightage_pcnt = ap_profile->param.bw_weightage;
  2032. score_param->band_weightage_pcnt = ap_profile->param.band_weightage;
  2033. score_param->nss_weightage_pcnt = ap_profile->param.nss_weightage;
  2034. score_param->esp_qbss_weightage_pcnt =
  2035. ap_profile->param.esp_qbss_weightage;
  2036. score_param->beamforming_weightage_pcnt =
  2037. ap_profile->param.beamforming_weightage;
  2038. score_param->pcl_weightage_pcnt = ap_profile->param.pcl_weightage;
  2039. score_param->oce_wan_weightage_pcnt =
  2040. ap_profile->param.oce_wan_weightage;
  2041. score_param->oce_ap_tx_pwr_weightage_pcnt =
  2042. ap_profile->param.oce_ap_tx_pwr_weightage;
  2043. score_param->oce_ap_subnet_id_weightage_pcnt =
  2044. ap_profile->param.oce_subnet_id_weightage;
  2045. score_param->vendor_roam_score_algorithm_id =
  2046. ap_profile->param.vendor_roam_score_algorithm;
  2047. score_param->sae_pk_ap_weightage_pcnt =
  2048. ap_profile->param.sae_pk_ap_weightage;
  2049. wmi_debug("Score params weightage: disable_bitmap %x rssi %d ht %d vht %d he %d BW %d band %d NSS %d ESP %d BF %d PCL %d OCE WAN %d APTX %d roam score algo %d subnet id %d sae-pk %d",
  2050. score_param->disable_bitmap, score_param->rssi_weightage_pcnt,
  2051. score_param->ht_weightage_pcnt,
  2052. score_param->vht_weightage_pcnt,
  2053. score_param->he_weightage_pcnt, score_param->bw_weightage_pcnt,
  2054. score_param->band_weightage_pcnt,
  2055. score_param->nss_weightage_pcnt,
  2056. score_param->esp_qbss_weightage_pcnt,
  2057. score_param->beamforming_weightage_pcnt,
  2058. score_param->pcl_weightage_pcnt,
  2059. score_param->oce_wan_weightage_pcnt,
  2060. score_param->oce_ap_tx_pwr_weightage_pcnt,
  2061. score_param->vendor_roam_score_algorithm_id,
  2062. score_param->oce_ap_subnet_id_weightage_pcnt,
  2063. score_param->sae_pk_ap_weightage_pcnt);
  2064. score_param->bw_scoring.score_pcnt = ap_profile->param.bw_index_score;
  2065. score_param->band_scoring.score_pcnt =
  2066. ap_profile->param.band_index_score;
  2067. score_param->nss_scoring.score_pcnt =
  2068. ap_profile->param.nss_index_score;
  2069. wmi_debug("bw_index_score %x band_index_score %x nss_index_score %x",
  2070. score_param->bw_scoring.score_pcnt,
  2071. score_param->band_scoring.score_pcnt,
  2072. score_param->nss_scoring.score_pcnt);
  2073. score_param->rssi_scoring.best_rssi_threshold =
  2074. (-1) * ap_profile->param.rssi_scoring.best_rssi_threshold;
  2075. score_param->rssi_scoring.good_rssi_threshold =
  2076. (-1) * ap_profile->param.rssi_scoring.good_rssi_threshold;
  2077. score_param->rssi_scoring.bad_rssi_threshold =
  2078. (-1) * ap_profile->param.rssi_scoring.bad_rssi_threshold;
  2079. score_param->rssi_scoring.good_rssi_pcnt =
  2080. ap_profile->param.rssi_scoring.good_rssi_pcnt;
  2081. score_param->rssi_scoring.bad_rssi_pcnt =
  2082. ap_profile->param.rssi_scoring.bad_rssi_pcnt;
  2083. score_param->rssi_scoring.good_bucket_size =
  2084. ap_profile->param.rssi_scoring.good_rssi_bucket_size;
  2085. score_param->rssi_scoring.bad_bucket_size =
  2086. ap_profile->param.rssi_scoring.bad_rssi_bucket_size;
  2087. score_param->rssi_scoring.rssi_pref_5g_rssi_thresh =
  2088. (-1) * ap_profile->param.rssi_scoring.rssi_pref_5g_rssi_thresh;
  2089. wmi_debug("Rssi scoring threshold: best RSSI %d good RSSI %d bad RSSI %d prefer 5g threshold %d",
  2090. score_param->rssi_scoring.best_rssi_threshold,
  2091. score_param->rssi_scoring.good_rssi_threshold,
  2092. score_param->rssi_scoring.bad_rssi_threshold,
  2093. score_param->rssi_scoring.rssi_pref_5g_rssi_thresh);
  2094. wmi_debug("Good RSSI score for each slot %d bad RSSI score for each slot %d good bucket %d bad bucket %d",
  2095. score_param->rssi_scoring.good_rssi_pcnt,
  2096. score_param->rssi_scoring.bad_rssi_pcnt,
  2097. score_param->rssi_scoring.good_bucket_size,
  2098. score_param->rssi_scoring.bad_bucket_size);
  2099. score_param->esp_qbss_scoring.num_slot =
  2100. ap_profile->param.esp_qbss_scoring.num_slot;
  2101. score_param->esp_qbss_scoring.score_pcnt3_to_0 =
  2102. ap_profile->param.esp_qbss_scoring.score_pcnt3_to_0;
  2103. score_param->esp_qbss_scoring.score_pcnt7_to_4 =
  2104. ap_profile->param.esp_qbss_scoring.score_pcnt7_to_4;
  2105. score_param->esp_qbss_scoring.score_pcnt11_to_8 =
  2106. ap_profile->param.esp_qbss_scoring.score_pcnt11_to_8;
  2107. score_param->esp_qbss_scoring.score_pcnt15_to_12 =
  2108. ap_profile->param.esp_qbss_scoring.score_pcnt15_to_12;
  2109. wmi_debug("ESP QBSS index weight: slots %d weight 0to3 %x weight 4to7 %x weight 8to11 %x weight 12to15 %x",
  2110. score_param->esp_qbss_scoring.num_slot,
  2111. score_param->esp_qbss_scoring.score_pcnt3_to_0,
  2112. score_param->esp_qbss_scoring.score_pcnt7_to_4,
  2113. score_param->esp_qbss_scoring.score_pcnt11_to_8,
  2114. score_param->esp_qbss_scoring.score_pcnt15_to_12);
  2115. score_param->oce_wan_scoring.num_slot =
  2116. ap_profile->param.oce_wan_scoring.num_slot;
  2117. score_param->oce_wan_scoring.score_pcnt3_to_0 =
  2118. ap_profile->param.oce_wan_scoring.score_pcnt3_to_0;
  2119. score_param->oce_wan_scoring.score_pcnt7_to_4 =
  2120. ap_profile->param.oce_wan_scoring.score_pcnt7_to_4;
  2121. score_param->oce_wan_scoring.score_pcnt11_to_8 =
  2122. ap_profile->param.oce_wan_scoring.score_pcnt11_to_8;
  2123. score_param->oce_wan_scoring.score_pcnt15_to_12 =
  2124. ap_profile->param.oce_wan_scoring.score_pcnt15_to_12;
  2125. wmi_debug("OCE WAN index weight: slots %d weight 0to3 %x weight 4to7 %x weight 8to11 %x weight 12to15 %x",
  2126. score_param->oce_wan_scoring.num_slot,
  2127. score_param->oce_wan_scoring.score_pcnt3_to_0,
  2128. score_param->oce_wan_scoring.score_pcnt7_to_4,
  2129. score_param->oce_wan_scoring.score_pcnt11_to_8,
  2130. score_param->oce_wan_scoring.score_pcnt15_to_12);
  2131. score_param->roam_score_delta_pcnt = ap_profile->param.roam_score_delta;
  2132. score_param->roam_score_delta_mask =
  2133. ap_profile->param.roam_trigger_bitmap;
  2134. score_param->candidate_min_roam_score_delta =
  2135. ap_profile->param.cand_min_roam_score_delta;
  2136. wmi_debug("Roam score delta:%d Roam_trigger_bitmap:%x cand min score delta = %d",
  2137. score_param->roam_score_delta_pcnt,
  2138. score_param->roam_score_delta_mask,
  2139. score_param->candidate_min_roam_score_delta);
  2140. buf_ptr += sizeof(*score_param);
  2141. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  2142. (NUM_OF_ROAM_TRIGGERS * sizeof(*score_delta_param)));
  2143. buf_ptr += WMI_TLV_HDR_SIZE;
  2144. score_delta_param = (wmi_roam_score_delta_param *)buf_ptr;
  2145. WMITLV_SET_HDR(&score_delta_param->tlv_header,
  2146. WMITLV_TAG_STRUC_wmi_roam_score_delta_param,
  2147. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_score_delta_param));
  2148. trig_reason =
  2149. ap_profile->score_delta_param[IDLE_ROAM_TRIGGER].trigger_reason;
  2150. score_delta_param->roam_trigger_reason =
  2151. convert_roam_trigger_reason(trig_reason);
  2152. score_delta_param->roam_score_delta =
  2153. ap_profile->score_delta_param[IDLE_ROAM_TRIGGER].roam_score_delta;
  2154. buf_ptr += sizeof(*score_delta_param);
  2155. score_delta_param = (wmi_roam_score_delta_param *)buf_ptr;
  2156. WMITLV_SET_HDR(&score_delta_param->tlv_header,
  2157. WMITLV_TAG_STRUC_wmi_roam_score_delta_param,
  2158. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_score_delta_param));
  2159. trig_reason =
  2160. ap_profile->score_delta_param[BTM_ROAM_TRIGGER].trigger_reason;
  2161. score_delta_param->roam_trigger_reason =
  2162. convert_roam_trigger_reason(trig_reason);
  2163. score_delta_param->roam_score_delta =
  2164. ap_profile->score_delta_param[BTM_ROAM_TRIGGER].roam_score_delta;
  2165. buf_ptr += sizeof(*score_delta_param);
  2166. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  2167. (NUM_OF_ROAM_MIN_RSSI * sizeof(*min_rssi_param)));
  2168. buf_ptr += WMI_TLV_HDR_SIZE;
  2169. min_rssi_param = (wmi_roam_cnd_min_rssi_param *)buf_ptr;
  2170. WMITLV_SET_HDR(&min_rssi_param->tlv_header,
  2171. WMITLV_TAG_STRUC_wmi_roam_cnd_min_rssi_param,
  2172. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_cnd_min_rssi_param));
  2173. trig_reason =
  2174. ap_profile->min_rssi_params[DEAUTH_MIN_RSSI].trigger_reason;
  2175. min_rssi_param->roam_trigger_reason =
  2176. convert_roam_trigger_reason(trig_reason);
  2177. min_rssi_param->candidate_min_rssi =
  2178. ap_profile->min_rssi_params[DEAUTH_MIN_RSSI].min_rssi;
  2179. buf_ptr += sizeof(*min_rssi_param);
  2180. min_rssi_param = (wmi_roam_cnd_min_rssi_param *)buf_ptr;
  2181. WMITLV_SET_HDR(&min_rssi_param->tlv_header,
  2182. WMITLV_TAG_STRUC_wmi_roam_cnd_min_rssi_param,
  2183. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_cnd_min_rssi_param));
  2184. trig_reason =
  2185. ap_profile->min_rssi_params[BMISS_MIN_RSSI].trigger_reason;
  2186. min_rssi_param->roam_trigger_reason =
  2187. convert_roam_trigger_reason(trig_reason);
  2188. min_rssi_param->candidate_min_rssi =
  2189. ap_profile->min_rssi_params[BMISS_MIN_RSSI].min_rssi;
  2190. buf_ptr += sizeof(*min_rssi_param);
  2191. min_rssi_param = (wmi_roam_cnd_min_rssi_param *)buf_ptr;
  2192. WMITLV_SET_HDR(&min_rssi_param->tlv_header,
  2193. WMITLV_TAG_STRUC_wmi_roam_cnd_min_rssi_param,
  2194. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_cnd_min_rssi_param));
  2195. trig_reason =
  2196. ap_profile->min_rssi_params[MIN_RSSI_2G_TO_5G_ROAM].trigger_reason;
  2197. min_rssi_param->roam_trigger_reason =
  2198. convert_roam_trigger_reason(trig_reason);
  2199. min_rssi_param->candidate_min_rssi =
  2200. ap_profile->min_rssi_params[MIN_RSSI_2G_TO_5G_ROAM].min_rssi;
  2201. wmi_mtrace(WMI_ROAM_AP_PROFILE, NO_SESSION, 0);
  2202. status = wmi_unified_cmd_send(wmi_handle, buf,
  2203. len, WMI_ROAM_AP_PROFILE);
  2204. if (QDF_IS_STATUS_ERROR(status))
  2205. wmi_buf_free(buf);
  2206. return status;
  2207. }
  2208. /**
  2209. * send_roam_scan_offload_cmd_tlv() - set roam offload command
  2210. * @wmi_handle: wmi handle
  2211. * @command: command
  2212. * @vdev_id: vdev id
  2213. *
  2214. * This function set roam offload command to fw.
  2215. *
  2216. * Return: QDF status
  2217. */
  2218. static QDF_STATUS
  2219. send_roam_scan_offload_cmd_tlv(wmi_unified_t wmi_handle,
  2220. uint32_t command, uint32_t vdev_id)
  2221. {
  2222. QDF_STATUS status;
  2223. wmi_roam_scan_cmd_fixed_param *cmd_fp;
  2224. wmi_buf_t buf = NULL;
  2225. int len;
  2226. uint8_t *buf_ptr;
  2227. len = sizeof(wmi_roam_scan_cmd_fixed_param);
  2228. buf = wmi_buf_alloc(wmi_handle, len);
  2229. if (!buf)
  2230. return QDF_STATUS_E_NOMEM;
  2231. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  2232. cmd_fp = (wmi_roam_scan_cmd_fixed_param *)buf_ptr;
  2233. WMITLV_SET_HDR(&cmd_fp->tlv_header,
  2234. WMITLV_TAG_STRUC_wmi_roam_scan_cmd_fixed_param,
  2235. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_scan_cmd_fixed_param));
  2236. cmd_fp->vdev_id = vdev_id;
  2237. cmd_fp->command_arg = command;
  2238. wmi_mtrace(WMI_ROAM_SCAN_CMD, NO_SESSION, 0);
  2239. status = wmi_unified_cmd_send(wmi_handle, buf,
  2240. len, WMI_ROAM_SCAN_CMD);
  2241. if (QDF_IS_STATUS_ERROR(status))
  2242. goto error;
  2243. wmi_info("WMI --> WMI_ROAM_SCAN_CMD");
  2244. return QDF_STATUS_SUCCESS;
  2245. error:
  2246. wmi_buf_free(buf);
  2247. return status;
  2248. }
  2249. /**
  2250. * send_roam_scan_offload_chan_list_cmd_tlv() - set roam offload channel list
  2251. * @wmi_handle: wmi handle
  2252. *
  2253. * Set roam offload channel list.
  2254. *
  2255. * Return: QDF status
  2256. */
  2257. static QDF_STATUS send_roam_scan_offload_chan_list_cmd_tlv(
  2258. wmi_unified_t wmi_handle,
  2259. struct wlan_roam_scan_channel_list *rso_ch_info)
  2260. {
  2261. wmi_buf_t buf = NULL;
  2262. QDF_STATUS status;
  2263. int len, list_tlv_len;
  2264. int i;
  2265. uint8_t *buf_ptr;
  2266. wmi_roam_chan_list_fixed_param *chan_list_fp;
  2267. uint32_t *roam_chan_list_array;
  2268. uint8_t chan_count = rso_ch_info->chan_count;
  2269. uint32_t *chan_list = rso_ch_info->chan_freq_list;
  2270. /* Channel list is a table of 2 TLV's */
  2271. list_tlv_len = WMI_TLV_HDR_SIZE + chan_count * sizeof(uint32_t);
  2272. len = sizeof(wmi_roam_chan_list_fixed_param) + list_tlv_len;
  2273. buf = wmi_buf_alloc(wmi_handle, len);
  2274. if (!buf)
  2275. return QDF_STATUS_E_NOMEM;
  2276. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  2277. chan_list_fp = (wmi_roam_chan_list_fixed_param *)buf_ptr;
  2278. WMITLV_SET_HDR(&chan_list_fp->tlv_header,
  2279. WMITLV_TAG_STRUC_wmi_roam_chan_list_fixed_param,
  2280. WMITLV_GET_STRUCT_TLVLEN
  2281. (wmi_roam_chan_list_fixed_param));
  2282. chan_list_fp->vdev_id = rso_ch_info->vdev_id;
  2283. chan_list_fp->num_chan = chan_count;
  2284. if (rso_ch_info->chan_cache_type == WMI_CHANNEL_LIST_STATIC)
  2285. /* external app is controlling channel list */
  2286. chan_list_fp->chan_list_type =
  2287. WMI_ROAM_SCAN_CHAN_LIST_TYPE_STATIC;
  2288. else
  2289. /* umac supplied occupied channel list in LFR */
  2290. chan_list_fp->chan_list_type =
  2291. WMI_ROAM_SCAN_CHAN_LIST_TYPE_DYNAMIC;
  2292. buf_ptr += sizeof(wmi_roam_chan_list_fixed_param);
  2293. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_UINT32,
  2294. (chan_list_fp->num_chan * sizeof(uint32_t)));
  2295. roam_chan_list_array = (uint32_t *)(buf_ptr + WMI_TLV_HDR_SIZE);
  2296. for (i = 0; ((i < chan_list_fp->num_chan) &&
  2297. (i < WMI_ROAM_MAX_CHANNELS)); i++)
  2298. roam_chan_list_array[i] = chan_list[i];
  2299. wmi_debug("RSO_CFG: vdev:%d num_chan:%d cache_type:%d",
  2300. chan_list_fp->vdev_id, chan_list_fp->num_chan,
  2301. rso_ch_info->chan_cache_type);
  2302. wmi_mtrace(WMI_ROAM_CHAN_LIST, NO_SESSION, 0);
  2303. status = wmi_unified_cmd_send(wmi_handle, buf,
  2304. len, WMI_ROAM_CHAN_LIST);
  2305. if (QDF_IS_STATUS_ERROR(status))
  2306. goto error;
  2307. return QDF_STATUS_SUCCESS;
  2308. error:
  2309. wmi_buf_free(buf);
  2310. return status;
  2311. }
  2312. /**
  2313. * send_roam_scan_offload_rssi_change_cmd_tlv() - set roam offload RSSI th
  2314. * @wmi_handle: wmi handle
  2315. * @rssi_change_thresh: RSSI Change threshold
  2316. * @bcn_rssi_weight: beacon RSSI weight
  2317. * @vdev_id: vdev id
  2318. *
  2319. * Send WMI_ROAM_SCAN_RSSI_CHANGE_THRESHOLD parameters to fw.
  2320. *
  2321. * Return: CDF status
  2322. */
  2323. static QDF_STATUS send_roam_scan_offload_rssi_change_cmd_tlv(
  2324. wmi_unified_t wmi_handle,
  2325. struct wlan_roam_rssi_change_params *params)
  2326. {
  2327. wmi_buf_t buf = NULL;
  2328. QDF_STATUS status;
  2329. int len;
  2330. uint8_t *buf_ptr;
  2331. wmi_roam_scan_rssi_change_threshold_fixed_param *rssi_change_fp;
  2332. /* Send rssi change parameters */
  2333. len = sizeof(wmi_roam_scan_rssi_change_threshold_fixed_param);
  2334. buf = wmi_buf_alloc(wmi_handle, len);
  2335. if (!buf)
  2336. return QDF_STATUS_E_NOMEM;
  2337. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  2338. rssi_change_fp =
  2339. (wmi_roam_scan_rssi_change_threshold_fixed_param *)buf_ptr;
  2340. WMITLV_SET_HDR(&rssi_change_fp->tlv_header,
  2341. WMITLV_TAG_STRUC_wmi_roam_scan_rssi_change_threshold_fixed_param,
  2342. WMITLV_GET_STRUCT_TLVLEN
  2343. (wmi_roam_scan_rssi_change_threshold_fixed_param));
  2344. /* fill in rssi change threshold (hysteresis) values */
  2345. rssi_change_fp->vdev_id = params->vdev_id;
  2346. rssi_change_fp->roam_scan_rssi_change_thresh =
  2347. params->rssi_change_thresh;
  2348. rssi_change_fp->bcn_rssi_weight = params->bcn_rssi_weight;
  2349. rssi_change_fp->hirssi_delay_btw_scans = params->hirssi_delay_btw_scans;
  2350. wmi_nofl_debug("RSO_CFG: vdev %d rssi_change_thresh:%d bcn_rssi_weight:%d hirssi_delay_btw_scans:%d",
  2351. rssi_change_fp->vdev_id,
  2352. rssi_change_fp->roam_scan_rssi_change_thresh,
  2353. rssi_change_fp->bcn_rssi_weight,
  2354. rssi_change_fp->hirssi_delay_btw_scans);
  2355. wmi_mtrace(WMI_ROAM_SCAN_RSSI_CHANGE_THRESHOLD,
  2356. rssi_change_fp->vdev_id, 0);
  2357. status = wmi_unified_cmd_send(wmi_handle, buf, len,
  2358. WMI_ROAM_SCAN_RSSI_CHANGE_THRESHOLD);
  2359. if (QDF_IS_STATUS_ERROR(status))
  2360. goto error;
  2361. return QDF_STATUS_SUCCESS;
  2362. error:
  2363. wmi_buf_free(buf);
  2364. return status;
  2365. }
  2366. /**
  2367. * send_per_roam_config_cmd_tlv() - set per roaming config to FW
  2368. * @wmi_handle: wmi handle
  2369. * @req_buf: per roam config buffer
  2370. *
  2371. * Return: QDF status
  2372. */
  2373. static QDF_STATUS
  2374. send_per_roam_config_cmd_tlv(wmi_unified_t wmi_handle,
  2375. struct wlan_per_roam_config_req *req_buf)
  2376. {
  2377. wmi_buf_t buf = NULL;
  2378. QDF_STATUS status;
  2379. int len;
  2380. uint8_t *buf_ptr;
  2381. wmi_roam_per_config_fixed_param *wmi_per_config;
  2382. len = sizeof(wmi_roam_per_config_fixed_param);
  2383. buf = wmi_buf_alloc(wmi_handle, len);
  2384. if (!buf)
  2385. return QDF_STATUS_E_NOMEM;
  2386. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  2387. wmi_per_config =
  2388. (wmi_roam_per_config_fixed_param *)buf_ptr;
  2389. WMITLV_SET_HDR(&wmi_per_config->tlv_header,
  2390. WMITLV_TAG_STRUC_wmi_roam_per_config_fixed_param,
  2391. WMITLV_GET_STRUCT_TLVLEN
  2392. (wmi_roam_per_config_fixed_param));
  2393. /* fill in per roam config values */
  2394. wmi_per_config->vdev_id = req_buf->vdev_id;
  2395. wmi_per_config->enable = req_buf->per_config.enable;
  2396. wmi_per_config->high_rate_thresh =
  2397. (req_buf->per_config.tx_high_rate_thresh << 16) |
  2398. (req_buf->per_config.rx_high_rate_thresh & 0x0000ffff);
  2399. wmi_per_config->low_rate_thresh =
  2400. (req_buf->per_config.tx_low_rate_thresh << 16) |
  2401. (req_buf->per_config.rx_low_rate_thresh & 0x0000ffff);
  2402. wmi_per_config->pkt_err_rate_thresh_pct =
  2403. (req_buf->per_config.tx_rate_thresh_percnt << 16) |
  2404. (req_buf->per_config.rx_rate_thresh_percnt & 0x0000ffff);
  2405. wmi_per_config->per_rest_time = req_buf->per_config.per_rest_time;
  2406. wmi_per_config->pkt_err_rate_mon_time =
  2407. (req_buf->per_config.tx_per_mon_time << 16) |
  2408. (req_buf->per_config.rx_per_mon_time & 0x0000ffff);
  2409. wmi_per_config->min_candidate_rssi =
  2410. req_buf->per_config.min_candidate_rssi;
  2411. /* Send per roam config parameters */
  2412. wmi_mtrace(WMI_ROAM_PER_CONFIG_CMDID, NO_SESSION, 0);
  2413. status = wmi_unified_cmd_send(wmi_handle, buf,
  2414. len, WMI_ROAM_PER_CONFIG_CMDID);
  2415. if (QDF_IS_STATUS_ERROR(status)) {
  2416. wmi_err("WMI_ROAM_PER_CONFIG_CMDID failed, Error %d", status);
  2417. wmi_buf_free(buf);
  2418. return status;
  2419. }
  2420. wmi_debug("per roam enable=%d, vdev=%d",
  2421. req_buf->per_config.enable, req_buf->vdev_id);
  2422. return QDF_STATUS_SUCCESS;
  2423. }
  2424. /**
  2425. * send_limit_off_chan_cmd_tlv() - send wmi cmd of limit off chan
  2426. * configuration params
  2427. * @wmi_handle: wmi handler
  2428. * @limit_off_chan_param: pointer to wmi_off_chan_param
  2429. *
  2430. * Return: 0 for success and non zero for failure
  2431. */
  2432. static QDF_STATUS send_limit_off_chan_cmd_tlv(
  2433. wmi_unified_t wmi_handle,
  2434. struct wmi_limit_off_chan_param *limit_off_chan_param)
  2435. {
  2436. wmi_vdev_limit_offchan_cmd_fixed_param *cmd;
  2437. wmi_buf_t buf;
  2438. uint32_t len = sizeof(*cmd);
  2439. int err;
  2440. buf = wmi_buf_alloc(wmi_handle, len);
  2441. if (!buf)
  2442. return QDF_STATUS_E_NOMEM;
  2443. cmd = (wmi_vdev_limit_offchan_cmd_fixed_param *)wmi_buf_data(buf);
  2444. WMITLV_SET_HDR(&cmd->tlv_header,
  2445. WMITLV_TAG_STRUC_wmi_vdev_limit_offchan_cmd_fixed_param,
  2446. WMITLV_GET_STRUCT_TLVLEN(
  2447. wmi_vdev_limit_offchan_cmd_fixed_param));
  2448. cmd->vdev_id = limit_off_chan_param->vdev_id;
  2449. cmd->flags &= 0;
  2450. if (limit_off_chan_param->status)
  2451. cmd->flags |= WMI_VDEV_LIMIT_OFFCHAN_ENABLE;
  2452. if (limit_off_chan_param->skip_dfs_chans)
  2453. cmd->flags |= WMI_VDEV_LIMIT_OFFCHAN_SKIP_DFS;
  2454. cmd->max_offchan_time = limit_off_chan_param->max_offchan_time;
  2455. cmd->rest_time = limit_off_chan_param->rest_time;
  2456. wmi_debug("vdev_id=%d, flags =%x, max_offchan_time=%d, rest_time=%d",
  2457. cmd->vdev_id, cmd->flags, cmd->max_offchan_time,
  2458. cmd->rest_time);
  2459. wmi_mtrace(WMI_VDEV_LIMIT_OFFCHAN_CMDID, cmd->vdev_id, 0);
  2460. err = wmi_unified_cmd_send(wmi_handle, buf,
  2461. len, WMI_VDEV_LIMIT_OFFCHAN_CMDID);
  2462. if (QDF_IS_STATUS_ERROR(err)) {
  2463. wmi_err("Failed to send limit off chan cmd err=%d", err);
  2464. wmi_buf_free(buf);
  2465. return QDF_STATUS_E_FAILURE;
  2466. }
  2467. return QDF_STATUS_SUCCESS;
  2468. }
  2469. #ifdef WLAN_FEATURE_FILS_SK
  2470. static QDF_STATUS send_roam_scan_send_hlp_cmd_tlv(wmi_unified_t wmi_handle,
  2471. struct hlp_params *params)
  2472. {
  2473. uint32_t len;
  2474. uint8_t *buf_ptr;
  2475. wmi_buf_t buf = NULL;
  2476. wmi_pdev_update_fils_hlp_pkt_cmd_fixed_param *hlp_params;
  2477. len = sizeof(wmi_pdev_update_fils_hlp_pkt_cmd_fixed_param);
  2478. len += WMI_TLV_HDR_SIZE;
  2479. len += qdf_roundup(params->hlp_ie_len, sizeof(uint32_t));
  2480. buf = wmi_buf_alloc(wmi_handle, len);
  2481. if (!buf)
  2482. return QDF_STATUS_E_NOMEM;
  2483. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  2484. hlp_params = (wmi_pdev_update_fils_hlp_pkt_cmd_fixed_param *)buf_ptr;
  2485. WMITLV_SET_HDR(&hlp_params->tlv_header,
  2486. WMITLV_TAG_STRUC_wmi_pdev_update_fils_hlp_pkt_cmd_fixed_param,
  2487. WMITLV_GET_STRUCT_TLVLEN(
  2488. wmi_pdev_update_fils_hlp_pkt_cmd_fixed_param));
  2489. hlp_params->vdev_id = params->vdev_id;
  2490. hlp_params->size = params->hlp_ie_len;
  2491. hlp_params->pkt_type = WMI_FILS_HLP_PKT_TYPE_DHCP_DISCOVER;
  2492. buf_ptr += sizeof(*hlp_params);
  2493. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE,
  2494. round_up(params->hlp_ie_len, sizeof(uint32_t)));
  2495. buf_ptr += WMI_TLV_HDR_SIZE;
  2496. qdf_mem_copy(buf_ptr, params->hlp_ie, params->hlp_ie_len);
  2497. wmi_debug("send FILS HLP pkt vdev %d len %d",
  2498. hlp_params->vdev_id, hlp_params->size);
  2499. wmi_mtrace(WMI_PDEV_UPDATE_FILS_HLP_PKT_CMDID, NO_SESSION, 0);
  2500. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  2501. WMI_PDEV_UPDATE_FILS_HLP_PKT_CMDID)) {
  2502. wmi_err("Failed to send FILS HLP pkt cmd");
  2503. wmi_buf_free(buf);
  2504. return QDF_STATUS_E_FAILURE;
  2505. }
  2506. return QDF_STATUS_SUCCESS;
  2507. }
  2508. void wmi_fils_sk_attach_tlv(wmi_unified_t wmi_handle)
  2509. {
  2510. struct wmi_ops *ops = wmi_handle->ops;
  2511. ops->send_roam_scan_hlp_cmd = send_roam_scan_send_hlp_cmd_tlv;
  2512. }
  2513. #endif /* WLAN_FEATURE_FILS_SK */
  2514. /*
  2515. * send_btm_config_cmd_tlv() - Send wmi cmd for BTM config
  2516. * @wmi_handle: wmi handle
  2517. * @params: pointer to wlan_roam_btm_config
  2518. *
  2519. * Return: QDF_STATUS
  2520. */
  2521. static QDF_STATUS send_btm_config_cmd_tlv(wmi_unified_t wmi_handle,
  2522. struct wlan_roam_btm_config *params)
  2523. {
  2524. wmi_btm_config_fixed_param *cmd;
  2525. wmi_buf_t buf;
  2526. uint32_t len;
  2527. len = sizeof(*cmd);
  2528. buf = wmi_buf_alloc(wmi_handle, len);
  2529. if (!buf)
  2530. return QDF_STATUS_E_NOMEM;
  2531. cmd = (wmi_btm_config_fixed_param *)wmi_buf_data(buf);
  2532. WMITLV_SET_HDR(&cmd->tlv_header,
  2533. WMITLV_TAG_STRUC_wmi_btm_config_fixed_param,
  2534. WMITLV_GET_STRUCT_TLVLEN(wmi_btm_config_fixed_param));
  2535. cmd->vdev_id = params->vdev_id;
  2536. cmd->flags = params->btm_offload_config;
  2537. cmd->max_attempt_cnt = params->btm_max_attempt_cnt;
  2538. cmd->solicited_timeout_ms = params->btm_solicited_timeout;
  2539. cmd->stick_time_seconds = params->btm_sticky_time;
  2540. cmd->disassoc_timer_threshold = params->disassoc_timer_threshold;
  2541. cmd->btm_bitmap = params->btm_query_bitmask;
  2542. cmd->btm_candidate_min_score = params->btm_candidate_min_score;
  2543. wmi_debug("RSO_CFG: vdev_id:%u btm_offload:%u btm_query_bitmask:%u btm_candidate_min_score:%u",
  2544. cmd->vdev_id, cmd->flags, cmd->btm_bitmap,
  2545. cmd->btm_candidate_min_score);
  2546. wmi_debug("RSO_CFG: btm_solicited_timeout:%u btm_max_attempt_cnt:%u btm_sticky_time:%u disassoc_timer_threshold:%u",
  2547. cmd->solicited_timeout_ms, cmd->max_attempt_cnt,
  2548. cmd->stick_time_seconds, cmd->disassoc_timer_threshold);
  2549. wmi_mtrace(WMI_ROAM_BTM_CONFIG_CMDID, cmd->vdev_id, 0);
  2550. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  2551. WMI_ROAM_BTM_CONFIG_CMDID)) {
  2552. wmi_err("Failed to send WMI_ROAM_BTM_CONFIG_CMDID");
  2553. wmi_buf_free(buf);
  2554. return QDF_STATUS_E_FAILURE;
  2555. }
  2556. return QDF_STATUS_SUCCESS;
  2557. }
  2558. /**
  2559. * send_roam_bss_load_config_tlv() - send roam load bss trigger configuration
  2560. * @wmi_handle: wmi handle
  2561. * @parms: pointer to wlan_roam_bss_load_config
  2562. *
  2563. * This function sends the roam load bss trigger configuration to fw.
  2564. * the bss_load_threshold parameter is used to configure the maximum
  2565. * bss load percentage, above which the firmware should trigger roaming
  2566. *
  2567. * Return: QDF status
  2568. */
  2569. static QDF_STATUS
  2570. send_roam_bss_load_config_tlv(wmi_unified_t wmi_handle,
  2571. struct wlan_roam_bss_load_config *params)
  2572. {
  2573. wmi_roam_bss_load_config_cmd_fixed_param *cmd;
  2574. wmi_buf_t buf;
  2575. uint32_t len;
  2576. len = sizeof(*cmd);
  2577. buf = wmi_buf_alloc(wmi_handle, len);
  2578. if (!buf)
  2579. return QDF_STATUS_E_NOMEM;
  2580. cmd = (wmi_roam_bss_load_config_cmd_fixed_param *)wmi_buf_data(buf);
  2581. WMITLV_SET_HDR(
  2582. &cmd->tlv_header,
  2583. WMITLV_TAG_STRUC_wmi_roam_bss_load_config_cmd_fixed_param,
  2584. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_bss_load_config_cmd_fixed_param));
  2585. cmd->vdev_id = params->vdev_id;
  2586. cmd->bss_load_threshold = params->bss_load_threshold;
  2587. cmd->monitor_time_window = params->bss_load_sample_time;
  2588. cmd->rssi_2g_threshold = params->rssi_threshold_24ghz;
  2589. cmd->rssi_5g_threshold = params->rssi_threshold_5ghz;
  2590. wmi_debug("RSO_CFG: vdev:%d bss_load_thres:%d monitor_time:%d rssi_2g:%d rssi_5g:%d",
  2591. cmd->vdev_id, cmd->bss_load_threshold,
  2592. cmd->monitor_time_window, cmd->rssi_2g_threshold,
  2593. cmd->rssi_5g_threshold);
  2594. wmi_mtrace(WMI_ROAM_BSS_LOAD_CONFIG_CMDID, cmd->vdev_id, 0);
  2595. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  2596. WMI_ROAM_BSS_LOAD_CONFIG_CMDID)) {
  2597. wmi_err("Failed to send WMI_ROAM_BSS_LOAD_CONFIG_CMDID");
  2598. wmi_buf_free(buf);
  2599. return QDF_STATUS_E_FAILURE;
  2600. }
  2601. return QDF_STATUS_SUCCESS;
  2602. }
  2603. #ifdef WLAN_FEATURE_ROAM_OFFLOAD
  2604. /**
  2605. * send_disconnect_roam_params_tlv() - send disconnect roam trigger parameters
  2606. * @wmi_handle: wmi handle
  2607. * @disconnect_roam: pointer to wlan_roam_disconnect_params which carries the
  2608. * disconnect_roam_trigger parameters from CSR
  2609. *
  2610. * This function sends the disconnect roam trigger parameters to fw.
  2611. *
  2612. * Return: QDF status
  2613. */
  2614. static QDF_STATUS
  2615. send_disconnect_roam_params_tlv(wmi_unified_t wmi_handle,
  2616. struct wlan_roam_disconnect_params *req)
  2617. {
  2618. wmi_roam_deauth_config_cmd_fixed_param *cmd;
  2619. wmi_buf_t buf;
  2620. uint32_t len;
  2621. len = sizeof(*cmd);
  2622. buf = wmi_buf_alloc(wmi_handle, len);
  2623. if (!buf)
  2624. return QDF_STATUS_E_NOMEM;
  2625. cmd = (wmi_roam_deauth_config_cmd_fixed_param *)wmi_buf_data(buf);
  2626. WMITLV_SET_HDR(
  2627. &cmd->tlv_header,
  2628. WMITLV_TAG_STRUC_wmi_roam_deauth_config_cmd_fixed_param,
  2629. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_deauth_config_cmd_fixed_param));
  2630. cmd->vdev_id = req->vdev_id;
  2631. cmd->enable = req->enable;
  2632. wmi_debug("RSO_CFG: vdev_id:%d enable:%d", cmd->vdev_id, cmd->enable);
  2633. wmi_mtrace(WMI_ROAM_DEAUTH_CONFIG_CMDID, cmd->vdev_id, 0);
  2634. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  2635. WMI_ROAM_DEAUTH_CONFIG_CMDID)) {
  2636. wmi_err("Failed to send WMI_ROAM_DEAUTH_CONFIG_CMDID");
  2637. wmi_buf_free(buf);
  2638. return QDF_STATUS_E_FAILURE;
  2639. }
  2640. return QDF_STATUS_SUCCESS;
  2641. }
  2642. /**
  2643. * send_idle_roam_params_tlv() - send idle roam trigger parameters
  2644. * @wmi_handle: wmi handle
  2645. * @idle_roam_params: pointer to wlan_roam_idle_params which carries the
  2646. * idle roam parameters from CSR
  2647. *
  2648. * This function sends the idle roam trigger parameters to fw.
  2649. *
  2650. * Return: QDF status
  2651. */
  2652. static QDF_STATUS
  2653. send_idle_roam_params_tlv(wmi_unified_t wmi_handle,
  2654. struct wlan_roam_idle_params *idle_roam_params)
  2655. {
  2656. wmi_roam_idle_config_cmd_fixed_param *cmd;
  2657. wmi_buf_t buf;
  2658. uint32_t len;
  2659. len = sizeof(*cmd);
  2660. buf = wmi_buf_alloc(wmi_handle, len);
  2661. if (!buf)
  2662. return QDF_STATUS_E_NOMEM;
  2663. cmd = (wmi_roam_idle_config_cmd_fixed_param *)wmi_buf_data(buf);
  2664. WMITLV_SET_HDR(
  2665. &cmd->tlv_header,
  2666. WMITLV_TAG_STRUC_wmi_roam_idle_config_cmd_fixed_param,
  2667. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_idle_config_cmd_fixed_param));
  2668. cmd->vdev_id = idle_roam_params->vdev_id;
  2669. cmd->enable = idle_roam_params->enable;
  2670. cmd->band = idle_roam_params->band;
  2671. cmd->rssi_delta = idle_roam_params->conn_ap_rssi_delta;
  2672. cmd->min_rssi = idle_roam_params->conn_ap_min_rssi;
  2673. cmd->idle_time = idle_roam_params->inactive_time;
  2674. cmd->data_packet_count = idle_roam_params->data_pkt_count;
  2675. wmi_debug("RSO_CFG: vdev_id:%d enable:%d band:%d rssi_delta:%d min_rssi:%d idle_time:%d data_pkt:%d",
  2676. cmd->vdev_id, cmd->enable,
  2677. cmd->band, cmd->rssi_delta, cmd->min_rssi,
  2678. cmd->idle_time, cmd->data_packet_count);
  2679. wmi_mtrace(WMI_ROAM_IDLE_CONFIG_CMDID, cmd->vdev_id, 0);
  2680. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  2681. WMI_ROAM_IDLE_CONFIG_CMDID)) {
  2682. wmi_err("Failed to send WMI_ROAM_IDLE_CONFIG_CMDID");
  2683. wmi_buf_free(buf);
  2684. return QDF_STATUS_E_FAILURE;
  2685. }
  2686. return QDF_STATUS_SUCCESS;
  2687. }
  2688. /**
  2689. * send_roam_preauth_status_tlv() - send roam pre-authentication status
  2690. * @wmi_handle: wmi handle
  2691. * @params: pre-auth status params
  2692. *
  2693. * This function sends the roam pre-authentication status for WPA3 SAE
  2694. * pre-auth to target.
  2695. *
  2696. * Return: QDF status
  2697. */
  2698. static QDF_STATUS
  2699. send_roam_preauth_status_tlv(wmi_unified_t wmi_handle,
  2700. struct wmi_roam_auth_status_params *params)
  2701. {
  2702. wmi_roam_preauth_status_cmd_fixed_param *cmd;
  2703. wmi_buf_t buf;
  2704. uint32_t len;
  2705. uint8_t *buf_ptr;
  2706. len = sizeof(*cmd) + WMI_TLV_HDR_SIZE + PMKID_LEN;
  2707. buf = wmi_buf_alloc(wmi_handle, len);
  2708. if (!buf)
  2709. return QDF_STATUS_E_NOMEM;
  2710. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  2711. cmd = (wmi_roam_preauth_status_cmd_fixed_param *)buf_ptr;
  2712. WMITLV_SET_HDR(
  2713. &cmd->tlv_header,
  2714. WMITLV_TAG_STRUC_wmi_roam_preauth_status_cmd_fixed_param,
  2715. WMITLV_GET_STRUCT_TLVLEN(wmi_roam_preauth_status_cmd_fixed_param));
  2716. cmd->vdev_id = params->vdev_id;
  2717. cmd->preauth_status = params->preauth_status;
  2718. WMI_CHAR_ARRAY_TO_MAC_ADDR(params->bssid.bytes,
  2719. &cmd->candidate_ap_bssid);
  2720. buf_ptr += sizeof(wmi_roam_preauth_status_cmd_fixed_param);
  2721. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_BYTE, PMKID_LEN);
  2722. buf_ptr += WMI_TLV_HDR_SIZE;
  2723. qdf_mem_copy(buf_ptr, params->pmkid, PMKID_LEN);
  2724. wmi_debug("vdev_id:%d status:%d bssid:"QDF_MAC_ADDR_FMT,
  2725. cmd->vdev_id, cmd->preauth_status,
  2726. QDF_MAC_ADDR_REF(params->bssid.bytes));
  2727. wmi_mtrace(WMI_ROAM_PREAUTH_STATUS_CMDID, cmd->vdev_id, 0);
  2728. if (wmi_unified_cmd_send(wmi_handle, buf, len,
  2729. WMI_ROAM_PREAUTH_STATUS_CMDID)) {
  2730. wmi_buf_free(buf);
  2731. return QDF_STATUS_E_FAILURE;
  2732. }
  2733. return QDF_STATUS_SUCCESS;
  2734. }
  2735. #else
  2736. static inline QDF_STATUS
  2737. send_disconnect_roam_params_tlv(wmi_unified_t wmi_handle,
  2738. struct wlan_roam_disconnect_params *req)
  2739. {
  2740. return QDF_STATUS_E_FAILURE;
  2741. }
  2742. static inline QDF_STATUS
  2743. send_idle_roam_params_tlv(wmi_unified_t wmi_handle,
  2744. struct wlan_roam_idle_params *idle_roam_params)
  2745. {
  2746. return QDF_STATUS_E_FAILURE;
  2747. }
  2748. static inline QDF_STATUS
  2749. send_roam_preauth_status_tlv(wmi_unified_t wmi_handle,
  2750. struct wmi_roam_auth_status_params *params)
  2751. {
  2752. return QDF_STATUS_E_FAILURE;
  2753. }
  2754. #endif
  2755. /**
  2756. * send_offload_11k_cmd_tlv() - send wmi cmd with 11k offload params
  2757. * @wmi_handle: wmi handler
  2758. * @params: pointer to 11k offload params
  2759. *
  2760. * Return: 0 for success and non zero for failure
  2761. */
  2762. static QDF_STATUS
  2763. send_offload_11k_cmd_tlv(wmi_unified_t wmi_handle,
  2764. struct wlan_roam_11k_offload_params *params)
  2765. {
  2766. wmi_11k_offload_report_fixed_param *cmd;
  2767. wmi_buf_t buf;
  2768. QDF_STATUS status;
  2769. uint8_t *buf_ptr;
  2770. wmi_neighbor_report_11k_offload_tlv_param
  2771. *neighbor_report_offload_params;
  2772. wmi_neighbor_report_offload *neighbor_report_offload;
  2773. uint32_t len = sizeof(*cmd);
  2774. if (params->offload_11k_bitmask &
  2775. WMI_11K_OFFLOAD_BITMAP_NEIGHBOR_REPORT_REQ)
  2776. len += WMI_TLV_HDR_SIZE +
  2777. sizeof(wmi_neighbor_report_11k_offload_tlv_param);
  2778. buf = wmi_buf_alloc(wmi_handle, len);
  2779. if (!buf)
  2780. return QDF_STATUS_E_NOMEM;
  2781. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  2782. cmd = (wmi_11k_offload_report_fixed_param *)buf_ptr;
  2783. WMITLV_SET_HDR(&cmd->tlv_header,
  2784. WMITLV_TAG_STRUC_wmi_offload_11k_report_fixed_param,
  2785. WMITLV_GET_STRUCT_TLVLEN(
  2786. wmi_11k_offload_report_fixed_param));
  2787. cmd->vdev_id = params->vdev_id;
  2788. cmd->offload_11k = params->offload_11k_bitmask;
  2789. if (params->offload_11k_bitmask &
  2790. WMI_11K_OFFLOAD_BITMAP_NEIGHBOR_REPORT_REQ) {
  2791. buf_ptr += sizeof(wmi_11k_offload_report_fixed_param);
  2792. WMITLV_SET_HDR(buf_ptr, WMITLV_TAG_ARRAY_STRUC,
  2793. sizeof(wmi_neighbor_report_11k_offload_tlv_param));
  2794. buf_ptr += WMI_TLV_HDR_SIZE;
  2795. neighbor_report_offload_params =
  2796. (wmi_neighbor_report_11k_offload_tlv_param *)buf_ptr;
  2797. WMITLV_SET_HDR(&neighbor_report_offload_params->tlv_header,
  2798. WMITLV_TAG_STRUC_wmi_neighbor_report_offload_tlv_param,
  2799. WMITLV_GET_STRUCT_TLVLEN(
  2800. wmi_neighbor_report_11k_offload_tlv_param));
  2801. neighbor_report_offload = &neighbor_report_offload_params->
  2802. neighbor_rep_ofld_params;
  2803. neighbor_report_offload->time_offset =
  2804. params->neighbor_report_params.time_offset;
  2805. neighbor_report_offload->low_rssi_offset =
  2806. params->neighbor_report_params.low_rssi_offset;
  2807. neighbor_report_offload->bmiss_count_trigger =
  2808. params->neighbor_report_params.bmiss_count_trigger;
  2809. neighbor_report_offload->per_threshold_offset =
  2810. params->neighbor_report_params.per_threshold_offset;
  2811. neighbor_report_offload->neighbor_report_cache_timeout =
  2812. params->neighbor_report_params.
  2813. neighbor_report_cache_timeout;
  2814. neighbor_report_offload->max_neighbor_report_req_cap =
  2815. params->neighbor_report_params.
  2816. max_neighbor_report_req_cap;
  2817. neighbor_report_offload->ssid.ssid_len =
  2818. params->neighbor_report_params.ssid.length;
  2819. qdf_mem_copy(neighbor_report_offload->ssid.ssid,
  2820. &params->neighbor_report_params.ssid.ssid,
  2821. neighbor_report_offload->ssid.ssid_len);
  2822. }
  2823. wmi_debug("RSO_CFG: vdev %d 11k_bitmask:%u time_offset:%u low_rssi_offset:%u bmiss_count_trigger:%u per_threshold_offset%u",
  2824. cmd->vdev_id, params->offload_11k_bitmask,
  2825. params->neighbor_report_params.time_offset,
  2826. params->neighbor_report_params.low_rssi_offset,
  2827. params->neighbor_report_params.bmiss_count_trigger,
  2828. params->neighbor_report_params.per_threshold_offset);
  2829. wmi_debug("RSO_CFG: neighbor_report_cache_timeout:%u max_neighbor_report_req_cap:%u SSID:%.*s",
  2830. params->neighbor_report_params.neighbor_report_cache_timeout,
  2831. params->neighbor_report_params.max_neighbor_report_req_cap,
  2832. params->neighbor_report_params.ssid.length,
  2833. params->neighbor_report_params.ssid.ssid);
  2834. wmi_mtrace(WMI_11K_OFFLOAD_REPORT_CMDID, cmd->vdev_id, 0);
  2835. status = wmi_unified_cmd_send(wmi_handle, buf, len,
  2836. WMI_11K_OFFLOAD_REPORT_CMDID);
  2837. if (status != QDF_STATUS_SUCCESS) {
  2838. wmi_err("Failed to send 11k offload command %d", status);
  2839. wmi_buf_free(buf);
  2840. }
  2841. return status;
  2842. }
  2843. /**
  2844. * send_invoke_neighbor_report_cmd_tlv() - send invoke 11k neighbor report
  2845. * command
  2846. * @wmi_handle: wmi handler
  2847. * @params: pointer to neighbor report invoke params
  2848. *
  2849. * Return: 0 for success and non zero for failure
  2850. */
  2851. static QDF_STATUS send_invoke_neighbor_report_cmd_tlv(
  2852. wmi_unified_t wmi_handle,
  2853. struct wmi_invoke_neighbor_report_params *params)
  2854. {
  2855. wmi_11k_offload_invoke_neighbor_report_fixed_param *cmd;
  2856. wmi_buf_t buf;
  2857. QDF_STATUS status;
  2858. uint8_t *buf_ptr;
  2859. uint32_t len = sizeof(*cmd);
  2860. buf = wmi_buf_alloc(wmi_handle, len);
  2861. if (!buf)
  2862. return QDF_STATUS_E_NOMEM;
  2863. buf_ptr = (uint8_t *)wmi_buf_data(buf);
  2864. cmd = (wmi_11k_offload_invoke_neighbor_report_fixed_param *)buf_ptr;
  2865. WMITLV_SET_HDR(&cmd->tlv_header,
  2866. WMITLV_TAG_STRUC_wmi_invoke_neighbor_report_fixed_param,
  2867. WMITLV_GET_STRUCT_TLVLEN(
  2868. wmi_11k_offload_invoke_neighbor_report_fixed_param));
  2869. cmd->vdev_id = params->vdev_id;
  2870. cmd->flags = params->send_resp_to_host;
  2871. cmd->ssid.ssid_len = params->ssid.length;
  2872. qdf_mem_copy(cmd->ssid.ssid, &params->ssid.ssid, cmd->ssid.ssid_len);
  2873. wmi_mtrace(WMI_11K_INVOKE_NEIGHBOR_REPORT_CMDID, cmd->vdev_id, 0);
  2874. status = wmi_unified_cmd_send(wmi_handle, buf, len,
  2875. WMI_11K_INVOKE_NEIGHBOR_REPORT_CMDID);
  2876. if (status != QDF_STATUS_SUCCESS) {
  2877. wmi_err("Failed to send invoke neighbor report command %d",
  2878. status);
  2879. wmi_buf_free(buf);
  2880. }
  2881. return status;
  2882. }
  2883. void wmi_roam_attach_tlv(wmi_unified_t wmi_handle)
  2884. {
  2885. struct wmi_ops *ops = wmi_handle->ops;
  2886. ops->send_roam_scan_offload_rssi_thresh_cmd =
  2887. send_roam_scan_offload_rssi_thresh_cmd_tlv;
  2888. ops->send_roam_mawc_params_cmd = send_roam_mawc_params_cmd_tlv;
  2889. ops->send_roam_scan_filter_cmd =
  2890. send_roam_scan_filter_cmd_tlv;
  2891. ops->send_roam_scan_offload_mode_cmd =
  2892. send_roam_scan_offload_mode_cmd_tlv;
  2893. ops->send_roam_scan_offload_ap_profile_cmd =
  2894. send_roam_scan_offload_ap_profile_cmd_tlv;
  2895. ops->send_roam_scan_offload_cmd = send_roam_scan_offload_cmd_tlv;
  2896. ops->send_roam_scan_offload_scan_period_cmd =
  2897. send_roam_scan_offload_scan_period_cmd_tlv;
  2898. ops->send_roam_scan_offload_chan_list_cmd =
  2899. send_roam_scan_offload_chan_list_cmd_tlv;
  2900. ops->send_roam_scan_offload_rssi_change_cmd =
  2901. send_roam_scan_offload_rssi_change_cmd_tlv;
  2902. ops->send_per_roam_config_cmd = send_per_roam_config_cmd_tlv;
  2903. ops->send_limit_off_chan_cmd = send_limit_off_chan_cmd_tlv;
  2904. ops->send_btm_config = send_btm_config_cmd_tlv;
  2905. ops->send_offload_11k_cmd = send_offload_11k_cmd_tlv;
  2906. ops->send_invoke_neighbor_report_cmd =
  2907. send_invoke_neighbor_report_cmd_tlv;
  2908. ops->send_roam_bss_load_config = send_roam_bss_load_config_tlv;
  2909. ops->send_idle_roam_params = send_idle_roam_params_tlv;
  2910. ops->send_disconnect_roam_params = send_disconnect_roam_params_tlv;
  2911. ops->send_roam_preauth_status = send_roam_preauth_status_tlv;
  2912. wmi_lfr_subnet_detection_attach_tlv(wmi_handle);
  2913. wmi_rssi_monitor_attach_tlv(wmi_handle);
  2914. wmi_ese_attach_tlv(wmi_handle);
  2915. wmi_roam_offload_attach_tlv(wmi_handle);
  2916. wmi_fils_sk_attach_tlv(wmi_handle);
  2917. }