nan_ucfg_api.c 36 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422
  1. /*
  2. * Copyright (c) 2017-2021 The Linux Foundation. All rights reserved.
  3. * Copyright (c) 2021-2022 Qualcomm Innovation Center, Inc. All rights reserved.
  4. *
  5. * Permission to use, copy, modify, and/or distribute this software for
  6. * any purpose with or without fee is hereby granted, provided that the
  7. * above copyright notice and this permission notice appear in all
  8. * copies.
  9. *
  10. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
  11. * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
  12. * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
  13. * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
  14. * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
  15. * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
  16. * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
  17. * PERFORMANCE OF THIS SOFTWARE.
  18. */
  19. /**
  20. * DOC: contains interface definitions for OS_IF layer
  21. */
  22. #include "nan_ucfg_api.h"
  23. #include "nan_public_structs.h"
  24. #include "wlan_nan_api.h"
  25. #include "../../core/src/nan_main_i.h"
  26. #include "scheduler_api.h"
  27. #include "wlan_objmgr_psoc_obj.h"
  28. #include "wlan_objmgr_pdev_obj.h"
  29. #include "wlan_objmgr_vdev_obj.h"
  30. #include "wlan_osif_request_manager.h"
  31. #include "wlan_policy_mgr_api.h"
  32. #include "cfg_ucfg_api.h"
  33. #include "cfg_nan.h"
  34. #include "wlan_mlme_api.h"
  35. #include "cfg_nan_api.h"
  36. struct wlan_objmgr_psoc;
  37. struct wlan_objmgr_vdev;
  38. #ifdef WLAN_FEATURE_NAN
  39. /**
  40. * nan_cfg_init() - Initialize NAN config params
  41. * @psoc: Pointer to PSOC Object
  42. * @nan_obj: Pointer to NAN private object
  43. *
  44. * This function initialize NAN config params
  45. */
  46. static void nan_cfg_init(struct wlan_objmgr_psoc *psoc,
  47. struct nan_psoc_priv_obj *nan_obj)
  48. {
  49. nan_obj->cfg_param.enable = cfg_get(psoc, CFG_NAN_ENABLE);
  50. nan_obj->cfg_param.support_mp0_discovery =
  51. cfg_get(psoc,
  52. CFG_SUPPORT_MP0_DISCOVERY);
  53. nan_obj->cfg_param.ndp_keep_alive_period =
  54. cfg_get(psoc,
  55. CFG_NDP_KEEP_ALIVE_PERIOD);
  56. nan_obj->cfg_param.max_ndp_sessions = cfg_get(psoc,
  57. CFG_NDP_MAX_SESSIONS);
  58. nan_obj->cfg_param.max_ndi = cfg_get(psoc, CFG_NDI_MAX_SUPPORT);
  59. nan_obj->cfg_param.nan_feature_config =
  60. cfg_get(psoc, CFG_NAN_FEATURE_CONFIG);
  61. nan_obj->cfg_param.disable_6g_nan = cfg_get(psoc, CFG_DISABLE_6G_NAN);
  62. }
  63. /**
  64. * nan_cfg_dp_init() - Initialize NAN Datapath config params
  65. * @psoc: Pointer to PSOC Object
  66. * @nan_obj: Pointer to NAN private object
  67. *
  68. * This function initialize NAN config params
  69. */
  70. static void nan_cfg_dp_init(struct wlan_objmgr_psoc *psoc,
  71. struct nan_psoc_priv_obj *nan_obj)
  72. {
  73. nan_obj->cfg_param.dp_enable = cfg_get(psoc,
  74. CFG_NAN_DATAPATH_ENABLE);
  75. nan_obj->cfg_param.ndi_mac_randomize =
  76. cfg_get(psoc, CFG_NAN_RANDOMIZE_NDI_MAC);
  77. nan_obj->cfg_param.ndp_inactivity_timeout =
  78. cfg_get(psoc, CFG_NAN_NDP_INACTIVITY_TIMEOUT);
  79. nan_obj->cfg_param.nan_separate_iface_support =
  80. cfg_get(psoc, CFG_NAN_SEPARATE_IFACE_SUPP);
  81. }
  82. #else
  83. static void nan_cfg_init(struct wlan_objmgr_psoc *psoc,
  84. struct nan_psoc_priv_obj *nan_obj)
  85. {
  86. }
  87. static void nan_cfg_dp_init(struct wlan_objmgr_psoc *psoc,
  88. struct nan_psoc_priv_obj *nan_obj)
  89. {
  90. }
  91. #endif
  92. bool ucfg_get_disable_6g_nan(struct wlan_objmgr_psoc *psoc)
  93. {
  94. struct nan_psoc_priv_obj *nan_obj = nan_get_psoc_priv_obj(psoc);
  95. if (!nan_obj) {
  96. nan_err("nan psoc priv object is NULL");
  97. return cfg_default(CFG_DISABLE_6G_NAN);
  98. }
  99. return nan_obj->cfg_param.disable_6g_nan;
  100. }
  101. QDF_STATUS ucfg_nan_psoc_open(struct wlan_objmgr_psoc *psoc)
  102. {
  103. struct nan_psoc_priv_obj *nan_obj = nan_get_psoc_priv_obj(psoc);
  104. if (!nan_obj) {
  105. nan_err("nan psoc priv object is NULL");
  106. return QDF_STATUS_E_NULL_VALUE;
  107. }
  108. nan_cfg_init(psoc, nan_obj);
  109. nan_cfg_dp_init(psoc, nan_obj);
  110. return QDF_STATUS_SUCCESS;
  111. }
  112. void ucfg_nan_psoc_close(struct wlan_objmgr_psoc *psoc)
  113. {
  114. /* No cleanup required on psoc close for NAN */
  115. }
  116. inline QDF_STATUS __ucfg_nan_set_ndi_state(struct wlan_objmgr_vdev *vdev,
  117. enum nan_datapath_state state,
  118. const char *func)
  119. {
  120. struct nan_vdev_priv_obj *priv_obj = nan_get_vdev_priv_obj(vdev);
  121. enum nan_datapath_state current_state;
  122. if (!priv_obj) {
  123. nan_err("priv_obj is null");
  124. return QDF_STATUS_E_NULL_VALUE;
  125. }
  126. qdf_spin_lock_bh(&priv_obj->lock);
  127. current_state = priv_obj->state;
  128. priv_obj->state = state;
  129. qdf_spin_unlock_bh(&priv_obj->lock);
  130. nan_nofl_debug("%s: ndi state: current: %u, new: %u", func,
  131. current_state, state);
  132. return QDF_STATUS_SUCCESS;
  133. }
  134. inline enum nan_datapath_state ucfg_nan_get_ndi_state(
  135. struct wlan_objmgr_vdev *vdev)
  136. {
  137. enum nan_datapath_state val;
  138. struct nan_vdev_priv_obj *priv_obj = nan_get_vdev_priv_obj(vdev);
  139. if (!priv_obj) {
  140. nan_err("priv_obj is null");
  141. return NAN_DATA_INVALID_STATE;
  142. }
  143. qdf_spin_lock_bh(&priv_obj->lock);
  144. val = priv_obj->state;
  145. qdf_spin_unlock_bh(&priv_obj->lock);
  146. return val;
  147. }
  148. inline QDF_STATUS ucfg_nan_set_active_peers(struct wlan_objmgr_vdev *vdev,
  149. uint32_t val)
  150. {
  151. struct nan_vdev_priv_obj *priv_obj = nan_get_vdev_priv_obj(vdev);
  152. if (!priv_obj) {
  153. nan_err("priv_obj is null");
  154. return QDF_STATUS_E_NULL_VALUE;
  155. }
  156. qdf_spin_lock_bh(&priv_obj->lock);
  157. priv_obj->active_ndp_peers = val;
  158. qdf_spin_unlock_bh(&priv_obj->lock);
  159. return QDF_STATUS_SUCCESS;
  160. }
  161. inline void ucfg_nan_set_peer_mc_list(struct wlan_objmgr_vdev *vdev,
  162. struct qdf_mac_addr peer_mac_addr)
  163. {
  164. struct nan_vdev_priv_obj *priv_obj = nan_get_vdev_priv_obj(vdev);
  165. uint32_t max_ndp_sessions = 0;
  166. struct wlan_objmgr_psoc *psoc = wlan_vdev_get_psoc(vdev);
  167. int i, list_idx = 0;
  168. if (!priv_obj) {
  169. nan_err("priv_obj is null");
  170. return;
  171. }
  172. if (!psoc) {
  173. nan_err("psoc is null");
  174. return;
  175. }
  176. cfg_nan_get_ndp_max_sessions(psoc, &max_ndp_sessions);
  177. qdf_spin_lock_bh(&priv_obj->lock);
  178. for (i = 0; i < max_ndp_sessions; i++) {
  179. if (qdf_is_macaddr_zero(&priv_obj->peer_mc_addr_list[i])) {
  180. list_idx = i;
  181. break;
  182. }
  183. }
  184. if (list_idx == max_ndp_sessions) {
  185. nan_err("Peer multicast address list is full");
  186. goto end;
  187. }
  188. /* Derive peer multicast addr */
  189. peer_mac_addr.bytes[0] = 0x33;
  190. peer_mac_addr.bytes[1] = 0x33;
  191. peer_mac_addr.bytes[2] = 0xff;
  192. priv_obj->peer_mc_addr_list[list_idx] = peer_mac_addr;
  193. end:
  194. qdf_spin_unlock_bh(&priv_obj->lock);
  195. }
  196. inline void ucfg_nan_get_peer_mc_list(
  197. struct wlan_objmgr_vdev *vdev,
  198. struct qdf_mac_addr **peer_mc_addr_list)
  199. {
  200. struct nan_vdev_priv_obj *priv_obj = nan_get_vdev_priv_obj(vdev);
  201. if (!priv_obj) {
  202. nan_err("priv_obj is null");
  203. return;
  204. }
  205. *peer_mc_addr_list = priv_obj->peer_mc_addr_list;
  206. }
  207. inline void ucfg_nan_clear_peer_mc_list(struct wlan_objmgr_psoc *psoc,
  208. struct wlan_objmgr_vdev *vdev,
  209. struct qdf_mac_addr *peer_mac_addr)
  210. {
  211. struct nan_vdev_priv_obj *priv_obj = nan_get_vdev_priv_obj(vdev);
  212. int i;
  213. uint32_t max_ndp_sessions = 0;
  214. struct qdf_mac_addr derived_peer_mc_addr;
  215. if (!priv_obj) {
  216. nan_err("priv_obj is null");
  217. return;
  218. }
  219. /* Derive peer multicast addr */
  220. derived_peer_mc_addr = *peer_mac_addr;
  221. derived_peer_mc_addr.bytes[0] = 0x33;
  222. derived_peer_mc_addr.bytes[1] = 0x33;
  223. derived_peer_mc_addr.bytes[2] = 0xff;
  224. qdf_spin_lock_bh(&priv_obj->lock);
  225. cfg_nan_get_ndp_max_sessions(psoc, &max_ndp_sessions);
  226. for (i = 0; i < max_ndp_sessions; i++) {
  227. if (qdf_is_macaddr_equal(&priv_obj->peer_mc_addr_list[i],
  228. &derived_peer_mc_addr)) {
  229. qdf_zero_macaddr(&priv_obj->peer_mc_addr_list[i]);
  230. break;
  231. }
  232. }
  233. qdf_spin_unlock_bh(&priv_obj->lock);
  234. }
  235. inline uint32_t ucfg_nan_get_active_peers(struct wlan_objmgr_vdev *vdev)
  236. {
  237. uint32_t val;
  238. struct nan_vdev_priv_obj *priv_obj = nan_get_vdev_priv_obj(vdev);
  239. if (!priv_obj) {
  240. nan_err("priv_obj is null");
  241. return 0;
  242. }
  243. qdf_spin_lock_bh(&priv_obj->lock);
  244. val = priv_obj->active_ndp_peers;
  245. qdf_spin_unlock_bh(&priv_obj->lock);
  246. return val;
  247. }
  248. inline QDF_STATUS ucfg_nan_set_ndp_create_transaction_id(
  249. struct wlan_objmgr_vdev *vdev, uint16_t val)
  250. {
  251. struct nan_vdev_priv_obj *priv_obj = nan_get_vdev_priv_obj(vdev);
  252. if (!priv_obj) {
  253. nan_err("priv_obj is null");
  254. return QDF_STATUS_E_NULL_VALUE;
  255. }
  256. qdf_spin_lock_bh(&priv_obj->lock);
  257. priv_obj->ndp_create_transaction_id = val;
  258. qdf_spin_unlock_bh(&priv_obj->lock);
  259. return QDF_STATUS_SUCCESS;
  260. }
  261. inline uint16_t ucfg_nan_get_ndp_create_transaction_id(
  262. struct wlan_objmgr_vdev *vdev)
  263. {
  264. uint16_t val;
  265. struct nan_vdev_priv_obj *priv_obj = nan_get_vdev_priv_obj(vdev);
  266. if (!priv_obj) {
  267. nan_err("priv_obj is null");
  268. return 0;
  269. }
  270. qdf_spin_lock_bh(&priv_obj->lock);
  271. val = priv_obj->ndp_create_transaction_id;
  272. qdf_spin_unlock_bh(&priv_obj->lock);
  273. return val;
  274. }
  275. inline QDF_STATUS ucfg_nan_set_ndp_delete_transaction_id(
  276. struct wlan_objmgr_vdev *vdev, uint16_t val)
  277. {
  278. struct nan_vdev_priv_obj *priv_obj = nan_get_vdev_priv_obj(vdev);
  279. if (!priv_obj) {
  280. nan_err("priv_obj is null");
  281. return QDF_STATUS_E_NULL_VALUE;
  282. }
  283. qdf_spin_lock_bh(&priv_obj->lock);
  284. priv_obj->ndp_delete_transaction_id = val;
  285. qdf_spin_unlock_bh(&priv_obj->lock);
  286. return QDF_STATUS_SUCCESS;
  287. }
  288. inline uint16_t ucfg_nan_get_ndp_delete_transaction_id(
  289. struct wlan_objmgr_vdev *vdev)
  290. {
  291. uint16_t val;
  292. struct nan_vdev_priv_obj *priv_obj = nan_get_vdev_priv_obj(vdev);
  293. if (!priv_obj) {
  294. nan_err("priv_obj is null");
  295. return 0;
  296. }
  297. qdf_spin_lock_bh(&priv_obj->lock);
  298. val = priv_obj->ndp_delete_transaction_id;
  299. qdf_spin_unlock_bh(&priv_obj->lock);
  300. return val;
  301. }
  302. inline QDF_STATUS ucfg_nan_set_ndi_delete_rsp_reason(
  303. struct wlan_objmgr_vdev *vdev, uint32_t val)
  304. {
  305. struct nan_vdev_priv_obj *priv_obj = nan_get_vdev_priv_obj(vdev);
  306. if (!priv_obj) {
  307. nan_err("priv_obj is null");
  308. return QDF_STATUS_E_NULL_VALUE;
  309. }
  310. qdf_spin_lock_bh(&priv_obj->lock);
  311. priv_obj->ndi_delete_rsp_reason = val;
  312. qdf_spin_unlock_bh(&priv_obj->lock);
  313. return QDF_STATUS_SUCCESS;
  314. }
  315. inline uint32_t ucfg_nan_get_ndi_delete_rsp_reason(
  316. struct wlan_objmgr_vdev *vdev)
  317. {
  318. uint32_t val;
  319. struct nan_vdev_priv_obj *priv_obj = nan_get_vdev_priv_obj(vdev);
  320. if (!priv_obj) {
  321. nan_err("priv_obj is null");
  322. return 0;
  323. }
  324. qdf_spin_lock_bh(&priv_obj->lock);
  325. val = priv_obj->ndi_delete_rsp_reason;
  326. qdf_spin_unlock_bh(&priv_obj->lock);
  327. return val;
  328. }
  329. inline QDF_STATUS ucfg_nan_set_ndi_delete_rsp_status(
  330. struct wlan_objmgr_vdev *vdev, uint32_t val)
  331. {
  332. struct nan_vdev_priv_obj *priv_obj = nan_get_vdev_priv_obj(vdev);
  333. if (!priv_obj) {
  334. nan_err("priv_obj is null");
  335. return QDF_STATUS_E_NULL_VALUE;
  336. }
  337. qdf_spin_lock_bh(&priv_obj->lock);
  338. priv_obj->ndi_delete_rsp_status = val;
  339. qdf_spin_unlock_bh(&priv_obj->lock);
  340. return QDF_STATUS_SUCCESS;
  341. }
  342. inline uint32_t ucfg_nan_get_ndi_delete_rsp_status(
  343. struct wlan_objmgr_vdev *vdev)
  344. {
  345. uint32_t val;
  346. struct nan_vdev_priv_obj *priv_obj = nan_get_vdev_priv_obj(vdev);
  347. if (!priv_obj) {
  348. nan_err("priv_obj is null");
  349. return QDF_STATUS_E_NULL_VALUE;
  350. }
  351. qdf_spin_lock_bh(&priv_obj->lock);
  352. val = priv_obj->ndi_delete_rsp_status;
  353. qdf_spin_unlock_bh(&priv_obj->lock);
  354. return val;
  355. }
  356. inline QDF_STATUS ucfg_nan_get_callbacks(struct wlan_objmgr_psoc *psoc,
  357. struct nan_callbacks *cb_obj)
  358. {
  359. struct nan_psoc_priv_obj *psoc_obj = nan_get_psoc_priv_obj(psoc);
  360. if (!psoc_obj) {
  361. nan_err("nan psoc priv object is NULL");
  362. return QDF_STATUS_E_NULL_VALUE;
  363. }
  364. qdf_spin_lock_bh(&psoc_obj->lock);
  365. qdf_mem_copy(cb_obj, &psoc_obj->cb_obj, sizeof(*cb_obj));
  366. qdf_spin_unlock_bh(&psoc_obj->lock);
  367. return QDF_STATUS_SUCCESS;
  368. }
  369. static QDF_STATUS ucfg_nan_sch_msg_flush_cb(struct scheduler_msg *msg)
  370. {
  371. struct wlan_objmgr_vdev *vdev = NULL;
  372. if (!msg || !msg->bodyptr)
  373. return QDF_STATUS_E_NULL_VALUE;
  374. switch (msg->type) {
  375. case NDP_INITIATOR_REQ:
  376. vdev = ((struct nan_datapath_initiator_req *)
  377. msg->bodyptr)->vdev;
  378. break;
  379. case NDP_RESPONDER_REQ:
  380. vdev = ((struct nan_datapath_responder_req *)
  381. msg->bodyptr)->vdev;
  382. break;
  383. case NDP_END_REQ:
  384. vdev = ((struct nan_datapath_end_req *)msg->bodyptr)->vdev;
  385. break;
  386. case NDP_END_ALL:
  387. vdev = ((struct nan_datapath_end_all_ndps *)msg->bodyptr)->vdev;
  388. break;
  389. default:
  390. nan_err("Invalid NAN msg type during sch flush");
  391. return QDF_STATUS_E_INVAL;
  392. }
  393. if (vdev) {
  394. wlan_objmgr_vdev_release_ref(vdev, WLAN_NAN_ID);
  395. qdf_mem_free(msg->bodyptr);
  396. }
  397. return QDF_STATUS_SUCCESS;
  398. }
  399. QDF_STATUS ucfg_nan_req_processor(struct wlan_objmgr_vdev *vdev,
  400. void *in_req, uint32_t req_type)
  401. {
  402. uint32_t len;
  403. QDF_STATUS status;
  404. struct scheduler_msg msg = {0};
  405. int err;
  406. struct nan_psoc_priv_obj *psoc_obj = NULL;
  407. struct osif_request *request = NULL;
  408. static const struct osif_request_params params = {
  409. .priv_size = 0,
  410. .timeout_ms = WLAN_WAIT_TIME_NDP_END,
  411. };
  412. if (!in_req) {
  413. nan_alert("req is null");
  414. return QDF_STATUS_E_NULL_VALUE;
  415. }
  416. switch (req_type) {
  417. case NDP_INITIATOR_REQ:
  418. len = sizeof(struct nan_datapath_initiator_req);
  419. break;
  420. case NDP_RESPONDER_REQ:
  421. len = sizeof(struct nan_datapath_responder_req);
  422. break;
  423. case NDP_END_REQ:
  424. len = sizeof(struct nan_datapath_end_req);
  425. psoc_obj = nan_get_psoc_priv_obj(wlan_vdev_get_psoc(vdev));
  426. if (!psoc_obj) {
  427. nan_err("nan psoc priv object is NULL");
  428. return QDF_STATUS_E_INVAL;
  429. }
  430. request = osif_request_alloc(&params);
  431. if (!request) {
  432. nan_err("Request allocation failure");
  433. return QDF_STATUS_E_NOMEM;
  434. }
  435. psoc_obj->ndp_request_ctx = osif_request_cookie(request);
  436. break;
  437. case NDP_END_ALL:
  438. len = sizeof(struct nan_datapath_end_all_ndps);
  439. break;
  440. default:
  441. nan_err("in correct message req type: %d", req_type);
  442. return QDF_STATUS_E_INVAL;
  443. }
  444. msg.bodyptr = qdf_mem_malloc(len);
  445. if (!msg.bodyptr) {
  446. status = QDF_STATUS_E_NOMEM;
  447. goto fail;
  448. }
  449. qdf_mem_copy(msg.bodyptr, in_req, len);
  450. msg.type = req_type;
  451. msg.callback = nan_scheduled_msg_handler;
  452. msg.flush_callback = ucfg_nan_sch_msg_flush_cb;
  453. status = scheduler_post_message(QDF_MODULE_ID_HDD,
  454. QDF_MODULE_ID_NAN,
  455. QDF_MODULE_ID_OS_IF, &msg);
  456. if (QDF_IS_STATUS_ERROR(status)) {
  457. nan_err("failed to post msg to NAN component, status: %d",
  458. status);
  459. goto fail;
  460. }
  461. if (req_type == NDP_END_REQ) {
  462. nan_debug("Wait for NDP END indication");
  463. err = osif_request_wait_for_response(request);
  464. if (err)
  465. nan_debug("NAN request timed out: %d", err);
  466. osif_request_put(request);
  467. psoc_obj->ndp_request_ctx = NULL;
  468. }
  469. return QDF_STATUS_SUCCESS;
  470. fail:
  471. qdf_mem_free(msg.bodyptr);
  472. if (req_type == NDP_END_REQ) {
  473. osif_request_put(request);
  474. psoc_obj->ndp_request_ctx = NULL;
  475. }
  476. return status;
  477. }
  478. void ucfg_nan_datapath_event_handler(struct wlan_objmgr_psoc *psoc,
  479. struct wlan_objmgr_vdev *vdev,
  480. uint32_t type, void *msg)
  481. {
  482. struct nan_psoc_priv_obj *psoc_obj = nan_get_psoc_priv_obj(psoc);
  483. if (!psoc_obj) {
  484. nan_err("nan psoc priv object is NULL");
  485. return;
  486. }
  487. psoc_obj->cb_obj.os_if_ndp_event_handler(psoc, vdev, type, msg);
  488. }
  489. static void ucfg_nan_request_process_cb(void *cookie)
  490. {
  491. struct osif_request *request;
  492. request = osif_request_get(cookie);
  493. if (request) {
  494. osif_request_complete(request);
  495. osif_request_put(request);
  496. } else {
  497. nan_debug("Obsolete request (cookie:0x%pK), do nothing",
  498. cookie);
  499. }
  500. }
  501. int ucfg_nan_register_hdd_callbacks(struct wlan_objmgr_psoc *psoc,
  502. struct nan_callbacks *cb_obj)
  503. {
  504. struct nan_psoc_priv_obj *psoc_obj = nan_get_psoc_priv_obj(psoc);
  505. if (!psoc_obj) {
  506. nan_err("nan psoc priv object is NULL");
  507. return -EINVAL;
  508. }
  509. psoc_obj->cb_obj.ndi_open = cb_obj->ndi_open;
  510. psoc_obj->cb_obj.ndi_set_mode = cb_obj->ndi_set_mode;
  511. psoc_obj->cb_obj.ndi_start = cb_obj->ndi_start;
  512. psoc_obj->cb_obj.ndi_delete = cb_obj->ndi_delete;
  513. psoc_obj->cb_obj.ndi_close = cb_obj->ndi_close;
  514. psoc_obj->cb_obj.drv_ndi_create_rsp_handler =
  515. cb_obj->drv_ndi_create_rsp_handler;
  516. psoc_obj->cb_obj.drv_ndi_delete_rsp_handler =
  517. cb_obj->drv_ndi_delete_rsp_handler;
  518. psoc_obj->cb_obj.new_peer_ind = cb_obj->new_peer_ind;
  519. psoc_obj->cb_obj.peer_departed_ind = cb_obj->peer_departed_ind;
  520. psoc_obj->cb_obj.os_if_ndp_event_handler =
  521. cb_obj->os_if_ndp_event_handler;
  522. psoc_obj->cb_obj.os_if_nan_event_handler =
  523. cb_obj->os_if_nan_event_handler;
  524. psoc_obj->cb_obj.ucfg_nan_request_process_cb =
  525. ucfg_nan_request_process_cb;
  526. psoc_obj->cb_obj.nan_concurrency_update =
  527. cb_obj->nan_concurrency_update;
  528. return 0;
  529. }
  530. int ucfg_nan_register_lim_callbacks(struct wlan_objmgr_psoc *psoc,
  531. struct nan_callbacks *cb_obj)
  532. {
  533. struct nan_psoc_priv_obj *psoc_obj = nan_get_psoc_priv_obj(psoc);
  534. if (!psoc_obj) {
  535. nan_err("nan psoc priv object is NULL");
  536. return -EINVAL;
  537. }
  538. psoc_obj->cb_obj.add_ndi_peer = cb_obj->add_ndi_peer;
  539. psoc_obj->cb_obj.ndp_delete_peers = cb_obj->ndp_delete_peers;
  540. psoc_obj->cb_obj.delete_peers_by_addr = cb_obj->delete_peers_by_addr;
  541. return 0;
  542. }
  543. int ucfg_nan_register_wma_callbacks(struct wlan_objmgr_psoc *psoc,
  544. struct nan_callbacks *cb_obj)
  545. {
  546. struct nan_psoc_priv_obj *psoc_obj = nan_get_psoc_priv_obj(psoc);
  547. if (!psoc_obj) {
  548. nan_err("nan psoc priv object is NULL");
  549. return -EINVAL;
  550. }
  551. psoc_obj->cb_obj.update_ndi_conn = cb_obj->update_ndi_conn;
  552. return 0;
  553. }
  554. void ucfg_nan_set_tgt_caps(struct wlan_objmgr_psoc *psoc,
  555. struct nan_tgt_caps *nan_caps)
  556. {
  557. struct nan_psoc_priv_obj *psoc_priv = nan_get_psoc_priv_obj(psoc);
  558. if (!psoc_priv) {
  559. nan_err("nan psoc priv object is NULL");
  560. return;
  561. }
  562. psoc_priv->nan_caps = *nan_caps;
  563. }
  564. bool ucfg_is_nan_conc_control_supported(struct wlan_objmgr_psoc *psoc)
  565. {
  566. struct nan_psoc_priv_obj *psoc_priv;
  567. psoc_priv = nan_get_psoc_priv_obj(psoc);
  568. if (!psoc_priv) {
  569. nan_err("nan psoc priv object is NULL");
  570. return false;
  571. }
  572. return (psoc_priv->nan_caps.nan_conc_control == 1);
  573. }
  574. bool ucfg_is_nan_dbs_supported(struct wlan_objmgr_psoc *psoc)
  575. {
  576. struct nan_psoc_priv_obj *psoc_priv;
  577. psoc_priv = nan_get_psoc_priv_obj(psoc);
  578. if (!psoc_priv) {
  579. nan_err("nan psoc priv object is NULL");
  580. return false;
  581. }
  582. return (psoc_priv->nan_caps.nan_dbs_supported == 1);
  583. }
  584. bool ucfg_is_ndi_dbs_supported(struct wlan_objmgr_psoc *psoc)
  585. {
  586. struct nan_psoc_priv_obj *psoc_priv;
  587. psoc_priv = nan_get_psoc_priv_obj(psoc);
  588. if (!psoc_priv) {
  589. nan_err("nan psoc priv object is NULL");
  590. return false;
  591. }
  592. return (psoc_priv->nan_caps.ndi_dbs_supported == 1);
  593. }
  594. bool ucfg_is_nan_enable_allowed(struct wlan_objmgr_psoc *psoc,
  595. uint32_t nan_ch_freq)
  596. {
  597. return nan_is_enable_allowed(psoc, nan_ch_freq);
  598. }
  599. bool ucfg_is_nan_disc_active(struct wlan_objmgr_psoc *psoc)
  600. {
  601. return nan_is_disc_active(psoc);
  602. }
  603. QDF_STATUS ucfg_nan_discovery_req(void *in_req, uint32_t req_type)
  604. {
  605. struct wlan_objmgr_psoc *psoc;
  606. struct scheduler_msg msg = {0};
  607. uint32_t len;
  608. QDF_STATUS status;
  609. struct nan_psoc_priv_obj *psoc_priv;
  610. struct osif_request *request = NULL;
  611. static const struct osif_request_params params = {
  612. .priv_size = 0,
  613. .timeout_ms = 4000,
  614. };
  615. int err;
  616. if (!in_req) {
  617. nan_alert("NAN Discovery req is null");
  618. return QDF_STATUS_E_NULL_VALUE;
  619. }
  620. switch (req_type) {
  621. case NAN_ENABLE_REQ: {
  622. struct nan_enable_req *req = in_req;
  623. psoc = req->psoc;
  624. psoc_priv = nan_get_psoc_priv_obj(psoc);
  625. if (!psoc_priv) {
  626. nan_err("nan psoc priv object is NULL");
  627. return QDF_STATUS_E_INVAL;
  628. }
  629. if (policy_mgr_is_sta_mon_concurrency(psoc))
  630. return QDF_STATUS_E_INVAL;
  631. /*
  632. * Take a psoc reference while it is being used by the
  633. * NAN requests.
  634. */
  635. status = wlan_objmgr_psoc_try_get_ref(psoc,
  636. WLAN_NAN_ID);
  637. if (QDF_IS_STATUS_ERROR(status)) {
  638. nan_err("Couldn't obtain psoc ref");
  639. return status;
  640. }
  641. status = nan_discovery_pre_enable(req->pdev,
  642. req->social_chan_2g_freq);
  643. if (QDF_IS_STATUS_SUCCESS(status)) {
  644. len = sizeof(struct nan_enable_req) +
  645. req->params.request_data_len;
  646. } else {
  647. wlan_objmgr_psoc_release_ref(psoc,
  648. WLAN_NAN_ID);
  649. return status;
  650. }
  651. break;
  652. }
  653. case NAN_DISABLE_REQ: {
  654. struct nan_disable_req *req = in_req;
  655. psoc = req->psoc;
  656. psoc_priv = nan_get_psoc_priv_obj(psoc);
  657. if (!psoc_priv) {
  658. nan_err("nan psoc priv object is NULL");
  659. return QDF_STATUS_E_INVAL;
  660. }
  661. status = wlan_objmgr_psoc_try_get_ref(psoc,
  662. WLAN_NAN_ID);
  663. if (QDF_IS_STATUS_ERROR(status)) {
  664. nan_err("Couldn't obtain psoc ref");
  665. return status;
  666. }
  667. status =
  668. nan_set_discovery_state(req->psoc,
  669. NAN_DISC_DISABLE_IN_PROGRESS);
  670. if (QDF_IS_STATUS_SUCCESS(status)) {
  671. len = sizeof(struct nan_disable_req) +
  672. req->params.request_data_len;
  673. } else {
  674. wlan_objmgr_psoc_release_ref(psoc,
  675. WLAN_NAN_ID);
  676. return status;
  677. }
  678. break;
  679. }
  680. case NAN_GENERIC_REQ: {
  681. struct nan_generic_req *req = in_req;
  682. psoc = req->psoc;
  683. psoc_priv = nan_get_psoc_priv_obj(psoc);
  684. if (!psoc_priv) {
  685. nan_err("nan psoc priv object is NULL");
  686. return QDF_STATUS_E_INVAL;
  687. }
  688. status = wlan_objmgr_psoc_try_get_ref(psoc,
  689. WLAN_NAN_ID);
  690. if (QDF_IS_STATUS_ERROR(status)) {
  691. nan_err("Couldn't obtain psoc ref");
  692. return status;
  693. }
  694. len = sizeof(struct nan_generic_req) +
  695. req->params.request_data_len;
  696. break;
  697. }
  698. default:
  699. nan_err("in correct message req type: %d", req_type);
  700. return QDF_STATUS_E_INVAL;
  701. }
  702. msg.bodyptr = qdf_mem_malloc(len);
  703. if (!msg.bodyptr) {
  704. wlan_objmgr_psoc_release_ref(psoc, WLAN_NAN_ID);
  705. return QDF_STATUS_E_NOMEM;
  706. }
  707. qdf_mem_copy(msg.bodyptr, in_req, len);
  708. msg.type = req_type;
  709. msg.callback = nan_discovery_scheduled_handler;
  710. msg.flush_callback = nan_discovery_flush_callback;
  711. if (req_type == NAN_GENERIC_REQ)
  712. goto post_msg;
  713. request = osif_request_alloc(&params);
  714. if (!request) {
  715. nan_err("Request allocation failure");
  716. nan_discovery_flush_callback(&msg);
  717. return QDF_STATUS_E_NOMEM;
  718. }
  719. psoc_priv->nan_disc_request_ctx = osif_request_cookie(request);
  720. if (req_type == NAN_DISABLE_REQ)
  721. psoc_priv->is_explicit_disable = true;
  722. post_msg:
  723. status = scheduler_post_message(QDF_MODULE_ID_NAN,
  724. QDF_MODULE_ID_NAN,
  725. QDF_MODULE_ID_OS_IF, &msg);
  726. if (QDF_IS_STATUS_ERROR(status)) {
  727. nan_err("failed to post msg to NAN component, status: %d",
  728. status);
  729. nan_discovery_flush_callback(&msg);
  730. }
  731. if (req_type != NAN_GENERIC_REQ) {
  732. err = osif_request_wait_for_response(request);
  733. if (err) {
  734. nan_debug("NAN request: %u timed out: %d",
  735. req_type, err);
  736. if (req_type == NAN_ENABLE_REQ) {
  737. nan_set_discovery_state(psoc,
  738. NAN_DISC_DISABLED);
  739. policy_mgr_check_n_start_opportunistic_timer(
  740. psoc);
  741. } else if (req_type == NAN_DISABLE_REQ) {
  742. nan_disable_cleanup(psoc);
  743. }
  744. }
  745. if (req_type == NAN_DISABLE_REQ)
  746. psoc_priv->is_explicit_disable = false;
  747. osif_request_put(request);
  748. }
  749. return status;
  750. }
  751. void ucfg_nan_disable_concurrency(struct wlan_objmgr_psoc *psoc)
  752. {
  753. struct nan_disable_req nan_req = {0};
  754. enum nan_disc_state curr_nan_state;
  755. struct nan_psoc_priv_obj *psoc_priv;
  756. QDF_STATUS status;
  757. if (!psoc) {
  758. nan_err("psoc object is NULL, no action will be taken");
  759. return;
  760. }
  761. psoc_priv = nan_get_psoc_priv_obj(psoc);
  762. if (!psoc_priv) {
  763. nan_err("nan psoc priv object is NULL");
  764. return;
  765. }
  766. if (!ucfg_is_nan_conc_control_supported(psoc))
  767. return;
  768. qdf_spin_lock_bh(&psoc_priv->lock);
  769. curr_nan_state = nan_get_discovery_state(psoc);
  770. if (curr_nan_state == NAN_DISC_DISABLED ||
  771. curr_nan_state == NAN_DISC_DISABLE_IN_PROGRESS) {
  772. qdf_spin_unlock_bh(&psoc_priv->lock);
  773. return;
  774. }
  775. qdf_spin_unlock_bh(&psoc_priv->lock);
  776. nan_req.psoc = psoc;
  777. nan_req.disable_2g_discovery = true;
  778. nan_req.disable_5g_discovery = true;
  779. status = ucfg_nan_discovery_req(&nan_req, NAN_DISABLE_REQ);
  780. if (QDF_IS_STATUS_ERROR(status)) {
  781. nan_err("Unable to disable NAN Discovery");
  782. return;
  783. }
  784. nan_debug("NAN Disabled successfully");
  785. }
  786. QDF_STATUS
  787. ucfg_nan_disable_ndi(struct wlan_objmgr_psoc *psoc, uint32_t ndi_vdev_id)
  788. {
  789. enum nan_datapath_state curr_ndi_state;
  790. struct nan_datapath_host_event *event;
  791. struct nan_vdev_priv_obj *ndi_vdev_priv;
  792. struct nan_datapath_end_all_ndps req = {0};
  793. struct wlan_objmgr_vdev *ndi_vdev;
  794. struct osif_request *request;
  795. QDF_STATUS status;
  796. int err;
  797. static const struct osif_request_params params = {
  798. .priv_size = sizeof(struct nan_datapath_host_event),
  799. .timeout_ms = 1000,
  800. };
  801. if (!ucfg_is_ndi_dbs_supported(psoc))
  802. return QDF_STATUS_SUCCESS;
  803. ndi_vdev = wlan_objmgr_get_vdev_by_id_from_psoc(psoc, ndi_vdev_id,
  804. WLAN_NAN_ID);
  805. if (!ndi_vdev) {
  806. nan_err("Cannot obtain NDI vdev object!");
  807. return QDF_STATUS_E_INVAL;
  808. }
  809. ndi_vdev_priv = nan_get_vdev_priv_obj(ndi_vdev);
  810. if (!ndi_vdev_priv) {
  811. nan_err("ndi vdev priv object is NULL");
  812. wlan_objmgr_vdev_release_ref(ndi_vdev, WLAN_NAN_ID);
  813. return QDF_STATUS_E_INVAL;
  814. }
  815. curr_ndi_state = ucfg_nan_get_ndi_state(ndi_vdev);
  816. /*
  817. * Nothing to do if NDI is in DATA_END state.
  818. * Continue cleanup in NAN_DATA_NDI_DELETING_STATE as this API
  819. * can be called from hdd_ndi_delete.
  820. */
  821. if (curr_ndi_state == NAN_DATA_END_STATE) {
  822. wlan_objmgr_vdev_release_ref(ndi_vdev, WLAN_NAN_ID);
  823. return QDF_STATUS_SUCCESS;
  824. }
  825. ucfg_nan_set_ndi_state(ndi_vdev, NAN_DATA_END_STATE);
  826. request = osif_request_alloc(&params);
  827. if (!request) {
  828. nan_err("Request allocation failure");
  829. status = QDF_STATUS_E_NOMEM;
  830. goto cleanup;
  831. }
  832. ndi_vdev_priv->disable_context = osif_request_cookie(request);
  833. req.vdev = ndi_vdev;
  834. status = ucfg_nan_req_processor(NULL, &req, NDP_END_ALL);
  835. if (QDF_IS_STATUS_ERROR(status)) {
  836. nan_err("Unable to disable NDP's on NDI");
  837. wlan_objmgr_vdev_release_ref(ndi_vdev, WLAN_NAN_ID);
  838. goto cleanup;
  839. }
  840. nan_debug("Disabling all NDP's on NDI vdev id - %d", ndi_vdev_id);
  841. err = osif_request_wait_for_response(request);
  842. if (err) {
  843. nan_err("Disabling NDP's timed out waiting for confirmation");
  844. status = QDF_STATUS_E_TIMEOUT;
  845. goto cleanup;
  846. }
  847. event = osif_request_priv(request);
  848. if (!event->ndp_termination_in_progress) {
  849. nan_err("Failed to terminate NDP's on NDI");
  850. status = QDF_STATUS_E_FAILURE;
  851. } else {
  852. /*
  853. * Host can assume NDP delete is successful and
  854. * remove policy mgr entry
  855. */
  856. policy_mgr_decr_session_set_pcl(psoc, QDF_NDI_MODE,
  857. ndi_vdev_id);
  858. }
  859. cleanup:
  860. /* Restore original NDI state in case of failure */
  861. if (QDF_IS_STATUS_SUCCESS(status))
  862. ucfg_nan_set_ndi_state(ndi_vdev, NAN_DATA_DISCONNECTED_STATE);
  863. else
  864. ucfg_nan_set_ndi_state(ndi_vdev, curr_ndi_state);
  865. if (request)
  866. osif_request_put(request);
  867. return status;
  868. }
  869. QDF_STATUS
  870. ucfg_nan_check_and_disable_unsupported_ndi(struct wlan_objmgr_psoc *psoc,
  871. bool force)
  872. {
  873. uint32_t ndi_count, first_ndi_vdev_id, i;
  874. QDF_STATUS status;
  875. if (!psoc) {
  876. nan_err("psoc object is NULL, no action will be taken");
  877. return QDF_STATUS_E_INVAL;
  878. }
  879. if (!ucfg_is_ndi_dbs_supported(psoc))
  880. return QDF_STATUS_SUCCESS;
  881. ndi_count = policy_mgr_mode_specific_connection_count(psoc, PM_NDI_MODE,
  882. NULL);
  883. /* NDP force disable is done for unsupported concurrencies: NDI+SAP */
  884. if (force) {
  885. nan_debug("Force disable all NDPs");
  886. for (i = 0; i < ndi_count; i++) {
  887. first_ndi_vdev_id =
  888. policy_mgr_mode_specific_vdev_id(psoc,
  889. PM_NDI_MODE);
  890. status = ucfg_nan_disable_ndi(psoc, first_ndi_vdev_id);
  891. if (QDF_IS_STATUS_ERROR(status))
  892. return status;
  893. }
  894. return QDF_STATUS_SUCCESS;
  895. }
  896. if (ndi_count < 2) {
  897. nan_debug("No more than one NDI is active, nothing to do...");
  898. return QDF_STATUS_SUCCESS;
  899. }
  900. /*
  901. * At least 2 NDI active concurrencies exist. Disable all NDP's on the
  902. * first NDI to support an incoming connection.
  903. */
  904. first_ndi_vdev_id = policy_mgr_mode_specific_vdev_id(psoc, PM_NDI_MODE);
  905. status = ucfg_nan_disable_ndi(psoc, first_ndi_vdev_id);
  906. return status;
  907. }
  908. QDF_STATUS ucfg_ndi_remove_entry_from_policy_mgr(struct wlan_objmgr_vdev *vdev)
  909. {
  910. struct wlan_objmgr_psoc *psoc;
  911. struct nan_psoc_priv_obj *psoc_priv_obj;
  912. struct nan_vdev_priv_obj *vdev_priv_obj = nan_get_vdev_priv_obj(vdev);
  913. enum nan_datapath_state state;
  914. uint32_t active_ndp_peers;
  915. psoc = wlan_vdev_get_psoc(vdev);
  916. if (!psoc) {
  917. nan_err("can't get psoc");
  918. return QDF_STATUS_E_FAILURE;
  919. }
  920. psoc_priv_obj = nan_get_psoc_priv_obj(psoc);
  921. if (!psoc_priv_obj) {
  922. nan_err("psoc_priv_obj is null");
  923. return QDF_STATUS_E_NULL_VALUE;
  924. }
  925. if (!vdev_priv_obj) {
  926. nan_err("priv_obj is null");
  927. return QDF_STATUS_E_NULL_VALUE;
  928. }
  929. qdf_spin_lock_bh(&vdev_priv_obj->lock);
  930. state = vdev_priv_obj->state;
  931. active_ndp_peers = vdev_priv_obj->active_ndp_peers;
  932. qdf_spin_unlock_bh(&vdev_priv_obj->lock);
  933. if (state == NAN_DATA_NDI_DELETED_STATE &&
  934. NDI_CONCURRENCY_SUPPORTED(psoc) &&
  935. active_ndp_peers) {
  936. nan_info("Delete NDP peers: %u and remove NDI from policy mgr",
  937. active_ndp_peers);
  938. policy_mgr_decr_session_set_pcl(psoc, QDF_NDI_MODE,
  939. wlan_vdev_get_id(vdev));
  940. }
  941. return QDF_STATUS_SUCCESS;
  942. }
  943. bool ucfg_nan_is_enable_disable_in_progress(struct wlan_objmgr_psoc *psoc)
  944. {
  945. enum nan_disc_state nan_state;
  946. nan_state = nan_get_discovery_state(psoc);
  947. if (nan_state == NAN_DISC_ENABLE_IN_PROGRESS ||
  948. nan_state == NAN_DISC_DISABLE_IN_PROGRESS) {
  949. nan_info("NAN enable/disable is in progress, state: %u",
  950. nan_state);
  951. return true;
  952. }
  953. return false;
  954. }
  955. #ifdef NDP_SAP_CONCURRENCY_ENABLE
  956. /**
  957. * is_sap_ndp_concurrency_allowed() - Is SAP+NDP allowed
  958. *
  959. * Return: True if the NDP_SAP_CONCURRENCY_ENABLE feature define
  960. * is enabled, false otherwise.
  961. */
  962. static inline bool is_sap_ndp_concurrency_allowed(void)
  963. {
  964. return true;
  965. }
  966. #else
  967. static inline bool is_sap_ndp_concurrency_allowed(void)
  968. {
  969. return false;
  970. }
  971. #endif
  972. bool ucfg_nan_is_sta_ndp_concurrency_allowed(struct wlan_objmgr_psoc *psoc,
  973. struct wlan_objmgr_vdev *vdev)
  974. {
  975. uint8_t vdev_id_list[MAX_NUMBER_OF_CONC_CONNECTIONS];
  976. uint32_t freq_list[MAX_NUMBER_OF_CONC_CONNECTIONS];
  977. uint32_t ndi_cnt, sta_cnt, id, conc_ext_flags;
  978. sta_cnt = policy_mgr_mode_specific_connection_count(psoc,
  979. PM_STA_MODE, NULL);
  980. /* Allow if STA is not in connected state */
  981. if (!sta_cnt)
  982. return true;
  983. /* Reject STA+STA in below case
  984. * Non-ML STA: STA+STA+NDP concurrency is not supported
  985. * ML STA: As both links would be treated as separate STAs from
  986. * policy mgr perspective, don't reject here and continue with further
  987. * checks
  988. */
  989. if (sta_cnt > 1 && !policy_mgr_is_mlo_sta_present(psoc)) {
  990. nan_err("STA+STA+NDP concurrency is not allowed");
  991. return false;
  992. }
  993. /*
  994. * SAP+NDP concurrency is already validated in hdd_is_ndp_allowed().
  995. * If SAP+NDP concurrency is enabled, return true from here to avoid
  996. * failure.
  997. */
  998. if (is_sap_ndp_concurrency_allowed())
  999. return true;
  1000. /* ML STA + NAN + NDP concurrency is allowed only if firmware
  1001. * support is present
  1002. */
  1003. if (policy_mgr_is_mlo_sta_present(psoc) &&
  1004. !wlan_is_mlo_sta_nan_ndi_allowed(psoc))
  1005. return false;
  1006. ndi_cnt = policy_mgr_get_mode_specific_conn_info(psoc,
  1007. freq_list,
  1008. vdev_id_list,
  1009. PM_NDI_MODE);
  1010. /* Allow if no other NDP peers are present on the NDIs */
  1011. if (!ndi_cnt)
  1012. return true;
  1013. /*
  1014. * Allow NDP creation if the current NDP request is on
  1015. * the NDI which already has an NDP by checking the vdev id of
  1016. * the NDIs
  1017. */
  1018. for (id = 0; id < ndi_cnt; id++)
  1019. if (wlan_vdev_get_id(vdev) == vdev_id_list[id])
  1020. return true;
  1021. /* If the flow reaches here then it is 4th NDI with STA */
  1022. if (!ucfg_nan_is_sta_nan_ndi_4_port_allowed(psoc))
  1023. return false;
  1024. conc_ext_flags = policy_mgr_get_conc_ext_flags(vdev, false);
  1025. /* The final freq would be provided by FW, it is not known now */
  1026. return policy_mgr_allow_concurrency(psoc, PM_NDI_MODE, 0,
  1027. HW_MODE_20_MHZ, conc_ext_flags);
  1028. }
  1029. bool
  1030. ucfg_nan_is_sta_nan_ndi_4_port_allowed(struct wlan_objmgr_psoc *psoc)
  1031. {
  1032. struct nan_psoc_priv_obj *psoc_nan_obj;
  1033. psoc_nan_obj = nan_get_psoc_priv_obj(psoc);
  1034. if (!psoc_nan_obj) {
  1035. nan_err("psoc_nan_obj is null");
  1036. return false;
  1037. }
  1038. return psoc_nan_obj->nan_caps.sta_nan_ndi_ndi_allowed;
  1039. }
  1040. bool ucfg_nan_is_beamforming_supported(struct wlan_objmgr_psoc *psoc)
  1041. {
  1042. struct nan_psoc_priv_obj *psoc_nan_obj;
  1043. psoc_nan_obj = nan_get_psoc_priv_obj(psoc);
  1044. if (!psoc_nan_obj) {
  1045. nan_err("psoc_nan_obj is null");
  1046. return false;
  1047. }
  1048. return psoc_nan_obj->nan_caps.ndi_txbf_supported;
  1049. }
  1050. static inline bool
  1051. ucfg_is_nan_enabled(struct nan_psoc_priv_obj *psoc_nan_obj)
  1052. {
  1053. return psoc_nan_obj->cfg_param.enable;
  1054. }
  1055. static inline bool
  1056. ucfg_nan_is_vdev_creation_supp_by_fw(struct nan_psoc_priv_obj *psoc_nan_obj)
  1057. {
  1058. return psoc_nan_obj->nan_caps.nan_vdev_allowed;
  1059. }
  1060. static inline bool
  1061. ucfg_nan_is_vdev_creation_supp_by_host(struct nan_psoc_priv_obj *nan_obj)
  1062. {
  1063. return nan_obj->cfg_param.nan_separate_iface_support;
  1064. }
  1065. static void ucfg_nan_cleanup_all_ndps(struct wlan_objmgr_psoc *psoc)
  1066. {
  1067. QDF_STATUS status;
  1068. uint32_t ndi_count, vdev_id, i;
  1069. ndi_count = policy_mgr_mode_specific_connection_count(psoc, PM_NDI_MODE,
  1070. NULL);
  1071. for (i = 0; i < ndi_count; i++) {
  1072. vdev_id = policy_mgr_mode_specific_vdev_id(psoc, PM_NDI_MODE);
  1073. status = ucfg_nan_disable_ndi(psoc, vdev_id);
  1074. if (status == QDF_STATUS_E_TIMEOUT)
  1075. policy_mgr_decr_session_set_pcl(psoc, QDF_NDI_MODE,
  1076. vdev_id);
  1077. }
  1078. }
  1079. QDF_STATUS ucfg_disable_nan_discovery(struct wlan_objmgr_psoc *psoc,
  1080. uint8_t *data, uint32_t data_len)
  1081. {
  1082. struct nan_disable_req *nan_req;
  1083. QDF_STATUS status;
  1084. ucfg_nan_cleanup_all_ndps(psoc);
  1085. nan_req = qdf_mem_malloc(sizeof(*nan_req) + data_len);
  1086. if (!nan_req)
  1087. return -ENOMEM;
  1088. qdf_mem_zero(nan_req, sizeof(*nan_req) + data_len);
  1089. nan_req->psoc = psoc;
  1090. nan_req->disable_2g_discovery = true;
  1091. nan_req->disable_5g_discovery = true;
  1092. if (data_len && data) {
  1093. nan_req->params.request_data_len = data_len;
  1094. qdf_mem_copy(nan_req->params.request_data, data, data_len);
  1095. }
  1096. status = ucfg_nan_discovery_req(nan_req, NAN_DISABLE_REQ);
  1097. if (QDF_IS_STATUS_SUCCESS(status))
  1098. nan_debug("Successfully sent NAN Disable request");
  1099. else
  1100. nan_debug("Unable to send NAN Disable request: %u", status);
  1101. qdf_mem_free(nan_req);
  1102. return status;
  1103. }
  1104. bool ucfg_nan_is_vdev_creation_allowed(struct wlan_objmgr_psoc *psoc)
  1105. {
  1106. struct nan_psoc_priv_obj *psoc_nan_obj;
  1107. bool host_support, fw_support;
  1108. psoc_nan_obj = nan_get_psoc_priv_obj(psoc);
  1109. if (!psoc_nan_obj) {
  1110. nan_err("psoc_nan_obj is null");
  1111. return false;
  1112. }
  1113. if (!ucfg_is_nan_enabled(psoc_nan_obj)) {
  1114. nan_debug("NAN is not enabled");
  1115. return false;
  1116. }
  1117. host_support = ucfg_nan_is_vdev_creation_supp_by_host(psoc_nan_obj);
  1118. fw_support = ucfg_nan_is_vdev_creation_supp_by_fw(psoc_nan_obj);
  1119. if (!host_support || !fw_support) {
  1120. nan_debug("NAN separate vdev%s supported by host,%s supported by firmware",
  1121. host_support ? "" : " not", fw_support ? "" : " not");
  1122. return false;
  1123. }
  1124. return true;
  1125. }
  1126. void
  1127. ucfg_nan_set_vdev_creation_supp_by_fw(struct wlan_objmgr_psoc *psoc, bool set)
  1128. {
  1129. struct nan_psoc_priv_obj *psoc_nan_obj;
  1130. psoc_nan_obj = nan_get_psoc_priv_obj(psoc);
  1131. if (!psoc_nan_obj) {
  1132. nan_err("psoc_nan_obj is null");
  1133. return;
  1134. }
  1135. psoc_nan_obj->nan_caps.nan_vdev_allowed = set;
  1136. }
  1137. QDF_STATUS ucfg_get_nan_feature_config(struct wlan_objmgr_psoc *psoc,
  1138. uint32_t *nan_feature_config)
  1139. {
  1140. struct nan_psoc_priv_obj *psoc_nan_obj;
  1141. psoc_nan_obj = nan_get_psoc_priv_obj(psoc);
  1142. if (!psoc_nan_obj) {
  1143. nan_err("psoc_nan_obj is null");
  1144. *nan_feature_config = cfg_default(CFG_NAN_FEATURE_CONFIG);
  1145. return QDF_STATUS_E_INVAL;
  1146. }
  1147. *nan_feature_config = psoc_nan_obj->cfg_param.nan_feature_config;
  1148. return QDF_STATUS_SUCCESS;
  1149. }
  1150. bool ucfg_is_nan_vdev(struct wlan_objmgr_vdev *vdev)
  1151. {
  1152. if (wlan_vdev_mlme_get_opmode(vdev) == QDF_NAN_DISC_MODE ||
  1153. (!ucfg_nan_is_vdev_creation_allowed(wlan_vdev_get_psoc(vdev)) &&
  1154. wlan_vdev_mlme_get_opmode(vdev) == QDF_STA_MODE))
  1155. return true;
  1156. return false;
  1157. }
  1158. QDF_STATUS ucfg_nan_disable_ind_to_userspace(struct wlan_objmgr_psoc *psoc)
  1159. {
  1160. struct nan_psoc_priv_obj *psoc_nan_obj;
  1161. struct nan_event_params *disable_ind;
  1162. struct nan_disable_ind_msg msg = {
  1163. .msg_hdr.msg_id = NAN_MSG_ID_DISABLE_INDICATION,
  1164. .reason = 0, /* success */ };
  1165. psoc_nan_obj = nan_get_psoc_priv_obj(psoc);
  1166. if (!psoc_nan_obj) {
  1167. nan_err("psoc_nan_obj is null");
  1168. return QDF_STATUS_E_INVAL;
  1169. }
  1170. disable_ind = qdf_mem_malloc(sizeof(struct nan_event_params) +
  1171. sizeof(msg));
  1172. if (!disable_ind)
  1173. return QDF_STATUS_E_NOMEM;
  1174. disable_ind->psoc = psoc,
  1175. disable_ind->evt_type = nan_event_id_disable_ind;
  1176. disable_ind->buf_len = sizeof(msg);
  1177. qdf_mem_copy(disable_ind->buf, &msg, disable_ind->buf_len);
  1178. psoc_nan_obj->cb_obj.os_if_nan_event_handler(disable_ind);
  1179. qdf_mem_free(disable_ind);
  1180. return QDF_STATUS_SUCCESS;
  1181. }
  1182. bool ucfg_is_nan_allowed_on_freq(struct wlan_objmgr_pdev *pdev, uint32_t freq)
  1183. {
  1184. return wlan_is_nan_allowed_on_freq(pdev, freq);
  1185. }
  1186. bool ucfg_is_mlo_sta_nan_ndi_allowed(struct wlan_objmgr_psoc *psoc)
  1187. {
  1188. return wlan_is_mlo_sta_nan_ndi_allowed(psoc);
  1189. }