dp_peer.c 36 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312
  1. /*
  2. * Copyright (c) 2016-2017 The Linux Foundation. All rights reserved.
  3. *
  4. * Permission to use, copy, modify, and/or distribute this software for
  5. * any purpose with or without fee is hereby granted, provided that the
  6. * above copyright notice and this permission notice appear in all
  7. * copies.
  8. *
  9. * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL
  10. * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED
  11. * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE
  12. * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL
  13. * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR
  14. * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER
  15. * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
  16. * PERFORMANCE OF THIS SOFTWARE.
  17. */
  18. #include <qdf_types.h>
  19. #include <qdf_lock.h>
  20. #include "dp_htt.h"
  21. #include "dp_types.h"
  22. #include "dp_internal.h"
  23. #include "dp_peer.h"
  24. #include <hal_api.h>
  25. #include <hal_reo.h>
  26. #ifdef CONFIG_MCL
  27. #include <cds_ieee80211_common.h>
  28. #endif
  29. /* Temporary definitions to be moved to wlan_cfg */
  30. static inline uint32_t wlan_cfg_max_peer_id(void *wlan_cfg_ctx)
  31. {
  32. /* TODO: This should be calculated based on target capabilities */
  33. return 2048;
  34. }
  35. static inline int dp_peer_find_mac_addr_cmp(
  36. union dp_align_mac_addr *mac_addr1,
  37. union dp_align_mac_addr *mac_addr2)
  38. {
  39. return !((mac_addr1->align4.bytes_abcd == mac_addr2->align4.bytes_abcd)
  40. /*
  41. * Intentionally use & rather than &&.
  42. * because the operands are binary rather than generic boolean,
  43. * the functionality is equivalent.
  44. * Using && has the advantage of short-circuited evaluation,
  45. * but using & has the advantage of no conditional branching,
  46. * which is a more significant benefit.
  47. */
  48. &
  49. (mac_addr1->align4.bytes_ef == mac_addr2->align4.bytes_ef));
  50. }
  51. static int dp_peer_find_map_attach(struct dp_soc *soc)
  52. {
  53. uint32_t max_peers, peer_map_size;
  54. /* allocate the peer ID -> peer object map */
  55. max_peers = wlan_cfg_max_peer_id(soc->wlan_cfg_ctx) + 1;
  56. soc->max_peers = max_peers;
  57. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_INFO,
  58. "\n<=== cfg max peer id %d ====>\n", max_peers);
  59. peer_map_size = max_peers * sizeof(soc->peer_id_to_obj_map[0]);
  60. soc->peer_id_to_obj_map = qdf_mem_malloc(peer_map_size);
  61. if (!soc->peer_id_to_obj_map) {
  62. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  63. "%s: peer map memory allocation failed\n", __func__);
  64. return QDF_STATUS_E_NOMEM;
  65. }
  66. /*
  67. * The peer_id_to_obj_map doesn't really need to be initialized,
  68. * since elements are only used after they have been individually
  69. * initialized.
  70. * However, it is convenient for debugging to have all elements
  71. * that are not in use set to 0.
  72. */
  73. qdf_mem_zero(soc->peer_id_to_obj_map, peer_map_size);
  74. #ifdef notyet /* ATH_BAND_STEERING */
  75. OS_INIT_TIMER(soc->osdev, &(soc->bs_inact_timer),
  76. dp_peer_find_inact_timeout_handler, (void *)soc,
  77. QDF_TIMER_TYPE_WAKE_APPS);
  78. #endif
  79. return 0; /* success */
  80. }
  81. static int dp_log2_ceil(unsigned value)
  82. {
  83. unsigned tmp = value;
  84. int log2 = -1;
  85. while (tmp) {
  86. log2++;
  87. tmp >>= 1;
  88. }
  89. if (1 << log2 != value)
  90. log2++;
  91. return log2;
  92. }
  93. static int dp_peer_find_add_id_to_obj(
  94. struct dp_peer *peer,
  95. uint16_t peer_id)
  96. {
  97. int i;
  98. for (i = 0; i < MAX_NUM_PEER_ID_PER_PEER; i++) {
  99. if (peer->peer_ids[i] == HTT_INVALID_PEER) {
  100. peer->peer_ids[i] = peer_id;
  101. return 0; /* success */
  102. }
  103. }
  104. return QDF_STATUS_E_FAILURE; /* failure */
  105. }
  106. #define DP_PEER_HASH_LOAD_MULT 2
  107. #define DP_PEER_HASH_LOAD_SHIFT 0
  108. static int dp_peer_find_hash_attach(struct dp_soc *soc)
  109. {
  110. int i, hash_elems, log2;
  111. /* allocate the peer MAC address -> peer object hash table */
  112. hash_elems = wlan_cfg_max_peer_id(soc->wlan_cfg_ctx) + 1;
  113. hash_elems *= DP_PEER_HASH_LOAD_MULT;
  114. hash_elems >>= DP_PEER_HASH_LOAD_SHIFT;
  115. log2 = dp_log2_ceil(hash_elems);
  116. hash_elems = 1 << log2;
  117. soc->peer_hash.mask = hash_elems - 1;
  118. soc->peer_hash.idx_bits = log2;
  119. /* allocate an array of TAILQ peer object lists */
  120. soc->peer_hash.bins = qdf_mem_malloc(
  121. hash_elems * sizeof(TAILQ_HEAD(anonymous_tail_q, dp_peer)));
  122. if (!soc->peer_hash.bins)
  123. return QDF_STATUS_E_NOMEM;
  124. for (i = 0; i < hash_elems; i++)
  125. TAILQ_INIT(&soc->peer_hash.bins[i]);
  126. return 0;
  127. }
  128. static void dp_peer_find_hash_detach(struct dp_soc *soc)
  129. {
  130. qdf_mem_free(soc->peer_hash.bins);
  131. }
  132. static inline unsigned dp_peer_find_hash_index(struct dp_soc *soc,
  133. union dp_align_mac_addr *mac_addr)
  134. {
  135. unsigned index;
  136. index =
  137. mac_addr->align2.bytes_ab ^
  138. mac_addr->align2.bytes_cd ^
  139. mac_addr->align2.bytes_ef;
  140. index ^= index >> soc->peer_hash.idx_bits;
  141. index &= soc->peer_hash.mask;
  142. return index;
  143. }
  144. void dp_peer_find_hash_add(struct dp_soc *soc, struct dp_peer *peer)
  145. {
  146. unsigned index;
  147. index = dp_peer_find_hash_index(soc, &peer->mac_addr);
  148. qdf_spin_lock_bh(&soc->peer_ref_mutex);
  149. /*
  150. * It is important to add the new peer at the tail of the peer list
  151. * with the bin index. Together with having the hash_find function
  152. * search from head to tail, this ensures that if two entries with
  153. * the same MAC address are stored, the one added first will be
  154. * found first.
  155. */
  156. TAILQ_INSERT_TAIL(&soc->peer_hash.bins[index], peer, hash_list_elem);
  157. qdf_spin_unlock_bh(&soc->peer_ref_mutex);
  158. }
  159. #if ATH_SUPPORT_WRAP
  160. static struct dp_peer *dp_peer_find_hash_find(struct dp_soc *soc,
  161. uint8_t *peer_mac_addr, int mac_addr_is_aligned, uint8_t vdev_id)
  162. #else
  163. static struct dp_peer *dp_peer_find_hash_find(struct dp_soc *soc,
  164. uint8_t *peer_mac_addr, int mac_addr_is_aligned)
  165. #endif
  166. {
  167. union dp_align_mac_addr local_mac_addr_aligned, *mac_addr;
  168. unsigned index;
  169. struct dp_peer *peer;
  170. if (mac_addr_is_aligned) {
  171. mac_addr = (union dp_align_mac_addr *) peer_mac_addr;
  172. } else {
  173. qdf_mem_copy(
  174. &local_mac_addr_aligned.raw[0],
  175. peer_mac_addr, DP_MAC_ADDR_LEN);
  176. mac_addr = &local_mac_addr_aligned;
  177. }
  178. index = dp_peer_find_hash_index(soc, mac_addr);
  179. qdf_spin_lock_bh(&soc->peer_ref_mutex);
  180. TAILQ_FOREACH(peer, &soc->peer_hash.bins[index], hash_list_elem) {
  181. #if ATH_SUPPORT_WRAP
  182. /* ProxySTA may have multiple BSS peer with same MAC address,
  183. * modified find will take care of finding the correct BSS peer.
  184. */
  185. if (dp_peer_find_mac_addr_cmp(mac_addr, &peer->mac_addr) == 0 &&
  186. (peer->vdev->vdev_id == vdev_id)) {
  187. #else
  188. if (dp_peer_find_mac_addr_cmp(mac_addr, &peer->mac_addr) == 0) {
  189. #endif
  190. /* found it - increment the ref count before releasing
  191. * the lock
  192. */
  193. qdf_atomic_inc(&peer->ref_cnt);
  194. qdf_spin_unlock_bh(&soc->peer_ref_mutex);
  195. return peer;
  196. }
  197. }
  198. qdf_spin_unlock_bh(&soc->peer_ref_mutex);
  199. return NULL; /* failure */
  200. }
  201. void dp_peer_find_hash_remove(struct dp_soc *soc, struct dp_peer *peer)
  202. {
  203. unsigned index;
  204. struct dp_peer *tmppeer = NULL;
  205. int found = 0;
  206. index = dp_peer_find_hash_index(soc, &peer->mac_addr);
  207. /* Check if tail is not empty before delete*/
  208. QDF_ASSERT(!TAILQ_EMPTY(&soc->peer_hash.bins[index]));
  209. /*
  210. * DO NOT take the peer_ref_mutex lock here - it needs to be taken
  211. * by the caller.
  212. * The caller needs to hold the lock from the time the peer object's
  213. * reference count is decremented and tested up through the time the
  214. * reference to the peer object is removed from the hash table, by
  215. * this function.
  216. * Holding the lock only while removing the peer object reference
  217. * from the hash table keeps the hash table consistent, but does not
  218. * protect against a new HL tx context starting to use the peer object
  219. * if it looks up the peer object from its MAC address just after the
  220. * peer ref count is decremented to zero, but just before the peer
  221. * object reference is removed from the hash table.
  222. */
  223. TAILQ_FOREACH(tmppeer, &soc->peer_hash.bins[index], hash_list_elem) {
  224. if (tmppeer == peer) {
  225. found = 1;
  226. break;
  227. }
  228. }
  229. QDF_ASSERT(found);
  230. TAILQ_REMOVE(&soc->peer_hash.bins[index], peer, hash_list_elem);
  231. }
  232. void dp_peer_find_hash_erase(struct dp_soc *soc)
  233. {
  234. int i;
  235. /*
  236. * Not really necessary to take peer_ref_mutex lock - by this point,
  237. * it's known that the soc is no longer in use.
  238. */
  239. for (i = 0; i <= soc->peer_hash.mask; i++) {
  240. if (!TAILQ_EMPTY(&soc->peer_hash.bins[i])) {
  241. struct dp_peer *peer, *peer_next;
  242. /*
  243. * TAILQ_FOREACH_SAFE must be used here to avoid any
  244. * memory access violation after peer is freed
  245. */
  246. TAILQ_FOREACH_SAFE(peer, &soc->peer_hash.bins[i],
  247. hash_list_elem, peer_next) {
  248. /*
  249. * Don't remove the peer from the hash table -
  250. * that would modify the list we are currently
  251. * traversing, and it's not necessary anyway.
  252. */
  253. /*
  254. * Artificially adjust the peer's ref count to
  255. * 1, so it will get deleted by
  256. * dp_peer_unref_delete.
  257. */
  258. /* set to zero */
  259. qdf_atomic_init(&peer->ref_cnt);
  260. /* incr to one */
  261. qdf_atomic_inc(&peer->ref_cnt);
  262. dp_peer_unref_delete(peer);
  263. }
  264. }
  265. }
  266. }
  267. static void dp_peer_find_map_detach(struct dp_soc *soc)
  268. {
  269. #ifdef notyet /* ATH_BAND_STEERING */
  270. OS_FREE_TIMER(&(soc->bs_inact_timer));
  271. #endif
  272. qdf_mem_free(soc->peer_id_to_obj_map);
  273. }
  274. int dp_peer_find_attach(struct dp_soc *soc)
  275. {
  276. if (dp_peer_find_map_attach(soc))
  277. return 1;
  278. if (dp_peer_find_hash_attach(soc)) {
  279. dp_peer_find_map_detach(soc);
  280. return 1;
  281. }
  282. return 0; /* success */
  283. }
  284. static inline void dp_peer_find_add_id(struct dp_soc *soc,
  285. uint8_t *peer_mac_addr, uint16_t peer_id, uint8_t vdev_id)
  286. {
  287. struct dp_peer *peer;
  288. QDF_ASSERT(peer_id <= wlan_cfg_max_peer_id(soc->wlan_cfg_ctx) + 1);
  289. /* check if there's already a peer object with this MAC address */
  290. #if ATH_SUPPORT_WRAP
  291. peer = dp_peer_find_hash_find(soc, peer_mac_addr,
  292. 0 /* is aligned */, vdev_id);
  293. #else
  294. peer = dp_peer_find_hash_find(soc, peer_mac_addr, 0 /* is aligned */);
  295. #endif
  296. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  297. "%s: peer %p ID %d vid %d mac %02x:%02x:%02x:%02x:%02x:%02x\n",
  298. __func__, peer, peer_id, vdev_id, peer_mac_addr[0],
  299. peer_mac_addr[1], peer_mac_addr[2], peer_mac_addr[3],
  300. peer_mac_addr[4], peer_mac_addr[5]);
  301. if (peer) {
  302. /* peer's ref count was already incremented by
  303. * peer_find_hash_find
  304. */
  305. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  306. "%s: ref_cnt: %d", __func__,
  307. qdf_atomic_read(&peer->ref_cnt));
  308. soc->peer_id_to_obj_map[peer_id] = peer;
  309. if (dp_peer_find_add_id_to_obj(peer, peer_id)) {
  310. /* TBDXXX: assert for now */
  311. QDF_ASSERT(0);
  312. }
  313. return;
  314. }
  315. }
  316. void
  317. dp_rx_peer_map_handler(void *soc_handle, uint16_t peer_id, uint8_t vdev_id,
  318. uint8_t *peer_mac_addr)
  319. {
  320. struct dp_soc *soc = (struct dp_soc *)soc_handle;
  321. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_INFO_HIGH,
  322. "peer_map_event (soc:%p): peer_id %d, peer_mac "
  323. "%02x:%02x:%02x:%02x:%02x:%02x, vdev_id %d\n", soc, peer_id,
  324. peer_mac_addr[0], peer_mac_addr[1], peer_mac_addr[2],
  325. peer_mac_addr[3], peer_mac_addr[4], peer_mac_addr[5], vdev_id);
  326. dp_peer_find_add_id(soc, peer_mac_addr, peer_id, vdev_id);
  327. }
  328. void
  329. dp_rx_peer_unmap_handler(void *soc_handle, uint16_t peer_id)
  330. {
  331. struct dp_peer *peer;
  332. struct dp_soc *soc = (struct dp_soc *)soc_handle;
  333. uint8_t i;
  334. peer = dp_peer_find_by_id(soc, peer_id);
  335. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_INFO_HIGH,
  336. "peer_unmap_event (soc:%p) peer_id %d peer %p\n",
  337. soc, peer_id, peer);
  338. /*
  339. * Currently peer IDs are assigned for vdevs as well as peers.
  340. * If the peer ID is for a vdev, then the peer pointer stored
  341. * in peer_id_to_obj_map will be NULL.
  342. */
  343. if (!peer)
  344. return;
  345. soc->peer_id_to_obj_map[peer_id] = NULL;
  346. for (i = 0; i < MAX_NUM_PEER_ID_PER_PEER; i++) {
  347. if (peer->peer_ids[i] == peer_id) {
  348. peer->peer_ids[i] = HTT_INVALID_PEER;
  349. break;
  350. }
  351. }
  352. /*
  353. * Remove a reference to the peer.
  354. * If there are no more references, delete the peer object.
  355. */
  356. dp_peer_unref_delete(peer);
  357. }
  358. void
  359. dp_peer_find_detach(struct dp_soc *soc)
  360. {
  361. dp_peer_find_map_detach(soc);
  362. dp_peer_find_hash_detach(soc);
  363. }
  364. static void dp_rx_tid_update_cb(struct dp_soc *soc, void *cb_ctxt,
  365. union hal_reo_status *reo_status)
  366. {
  367. struct dp_rx_tid *rx_tid = (struct dp_rx_tid *)cb_ctxt;
  368. if (reo_status->queue_status.header.status) {
  369. /* Should not happen normally. Just print error for now */
  370. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  371. "%s: Rx tid HW desc update failed(%d): tid %d\n",
  372. __func__,
  373. reo_status->rx_queue_status.header.status,
  374. rx_tid->tid);
  375. }
  376. }
  377. /*
  378. * dp_find_peer_by_addr - find peer instance by mac address
  379. * @dev: physical device instance
  380. * @peer_mac_addr: peer mac address
  381. * @local_id: local id for the peer
  382. *
  383. * Return: peer instance pointer
  384. */
  385. void *dp_find_peer_by_addr(void *dev, uint8_t *peer_mac_addr,
  386. uint8_t *local_id)
  387. {
  388. struct dp_pdev *pdev = dev;
  389. struct dp_peer *peer;
  390. #if ATH_SUPPORT_WRAP
  391. peer = dp_peer_find_hash_find(pdev->soc, peer_mac_addr, 0, 0);
  392. /* WAR, VDEV ID? TEMP 0 */
  393. #else
  394. peer = dp_peer_find_hash_find(pdev->soc, peer_mac_addr, 0);
  395. #endif
  396. if (!peer)
  397. return NULL;
  398. /* Multiple peer ids? How can know peer id? */
  399. *local_id = peer->local_id;
  400. DP_TRACE(INFO, "%s: peer %p id %d", __func__, peer, *local_id);
  401. /* ref_cnt is incremented inside dp_peer_find_hash_find().
  402. * Decrement it here.
  403. */
  404. qdf_atomic_dec(&peer->ref_cnt);
  405. return peer;
  406. }
  407. /*
  408. * dp_rx_tid_update_wifi3() – Update receive TID state
  409. * @peer: Datapath peer handle
  410. * @tid: TID
  411. * @ba_window_size: BlockAck window size
  412. * @start_seq: Starting sequence number
  413. *
  414. * Return: 0 on success, error code on failure
  415. */
  416. static int dp_rx_tid_update_wifi3(struct dp_peer *peer, int tid, uint32_t
  417. ba_window_size, uint32_t start_seq)
  418. {
  419. struct dp_rx_tid *rx_tid = &peer->rx_tid[tid];
  420. struct dp_soc *soc = peer->vdev->pdev->soc;
  421. struct hal_reo_cmd_params params;
  422. qdf_mem_zero(&params, sizeof(params));
  423. params.std.need_status = 1;
  424. params.std.addr_lo = rx_tid->hw_qdesc_paddr & 0xffffffff;
  425. params.std.addr_hi = (uint64_t)(rx_tid->hw_qdesc_paddr) >> 32;
  426. params.u.upd_queue_params.update_ba_window_size = 1;
  427. params.u.upd_queue_params.ba_window_size = ba_window_size;
  428. if (start_seq < IEEE80211_SEQ_MAX) {
  429. params.u.upd_queue_params.update_ssn = 1;
  430. params.u.upd_queue_params.ssn = start_seq;
  431. }
  432. dp_reo_send_cmd(soc, CMD_UPDATE_RX_REO_QUEUE, &params, dp_rx_tid_update_cb, rx_tid);
  433. return 0;
  434. }
  435. /*
  436. * dp_rx_tid_setup_wifi3() – Setup receive TID state
  437. * @peer: Datapath peer handle
  438. * @tid: TID
  439. * @ba_window_size: BlockAck window size
  440. * @start_seq: Starting sequence number
  441. *
  442. * Return: 0 on success, error code on failure
  443. */
  444. int dp_rx_tid_setup_wifi3(struct dp_peer *peer, int tid,
  445. uint32_t ba_window_size, uint32_t start_seq)
  446. {
  447. struct dp_rx_tid *rx_tid = &peer->rx_tid[tid];
  448. struct dp_vdev *vdev = peer->vdev;
  449. struct dp_soc *soc = vdev->pdev->soc;
  450. uint32_t hw_qdesc_size;
  451. uint32_t hw_qdesc_align;
  452. int hal_pn_type;
  453. void *hw_qdesc_vaddr;
  454. if (rx_tid->hw_qdesc_vaddr_unaligned != NULL)
  455. return dp_rx_tid_update_wifi3(peer, tid, ba_window_size,
  456. start_seq);
  457. #ifdef notyet
  458. hw_qdesc_size = hal_get_reo_qdesc_size(soc->hal_soc, ba_window_size);
  459. #else
  460. /* TODO: Allocating HW queue descriptors based on max BA window size
  461. * for all QOS TIDs so that same descriptor can be used later when
  462. * ADDBA request is recevied. This should be changed to allocate HW
  463. * queue descriptors based on BA window size being negotiated (0 for
  464. * non BA cases), and reallocate when BA window size changes and also
  465. * send WMI message to FW to change the REO queue descriptor in Rx
  466. * peer entry as part of dp_rx_tid_update.
  467. */
  468. if (tid != DP_NON_QOS_TID)
  469. hw_qdesc_size = hal_get_reo_qdesc_size(soc->hal_soc,
  470. HAL_RX_MAX_BA_WINDOW);
  471. else
  472. hw_qdesc_size = hal_get_reo_qdesc_size(soc->hal_soc,
  473. ba_window_size);
  474. #endif
  475. hw_qdesc_align = hal_get_reo_qdesc_align(soc->hal_soc);
  476. /* To avoid unnecessary extra allocation for alignment, try allocating
  477. * exact size and see if we already have aligned address.
  478. */
  479. rx_tid->hw_qdesc_alloc_size = hw_qdesc_size;
  480. rx_tid->hw_qdesc_vaddr_unaligned = qdf_mem_alloc_consistent(
  481. soc->osdev, soc->osdev->dev, rx_tid->hw_qdesc_alloc_size,
  482. &(rx_tid->hw_qdesc_paddr_unaligned));
  483. if (!rx_tid->hw_qdesc_vaddr_unaligned) {
  484. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  485. "%s: Rx tid HW desc alloc failed: tid %d\n",
  486. __func__, tid);
  487. return QDF_STATUS_E_NOMEM;
  488. }
  489. if ((unsigned long)(rx_tid->hw_qdesc_vaddr_unaligned) %
  490. hw_qdesc_align) {
  491. /* Address allocated above is not alinged. Allocate extra
  492. * memory for alignment
  493. */
  494. qdf_mem_free_consistent(soc->osdev, soc->osdev->dev,
  495. rx_tid->hw_qdesc_alloc_size,
  496. rx_tid->hw_qdesc_vaddr_unaligned,
  497. rx_tid->hw_qdesc_paddr_unaligned, 0);
  498. rx_tid->hw_qdesc_alloc_size =
  499. hw_qdesc_size + hw_qdesc_align - 1;
  500. rx_tid->hw_qdesc_vaddr_unaligned = qdf_mem_alloc_consistent(
  501. soc->osdev, soc->osdev->dev, rx_tid->hw_qdesc_alloc_size,
  502. &(rx_tid->hw_qdesc_paddr_unaligned));
  503. if (!rx_tid->hw_qdesc_vaddr_unaligned) {
  504. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  505. "%s: Rx tid HW desc alloc failed: tid %d\n",
  506. __func__, tid);
  507. return QDF_STATUS_E_NOMEM;
  508. }
  509. hw_qdesc_vaddr = rx_tid->hw_qdesc_vaddr_unaligned +
  510. ((unsigned long)(rx_tid->hw_qdesc_vaddr_unaligned) %
  511. hw_qdesc_align);
  512. rx_tid->hw_qdesc_paddr = rx_tid->hw_qdesc_paddr_unaligned +
  513. ((unsigned long)hw_qdesc_vaddr -
  514. (unsigned long)(rx_tid->hw_qdesc_vaddr_unaligned));
  515. } else {
  516. hw_qdesc_vaddr = rx_tid->hw_qdesc_vaddr_unaligned;
  517. rx_tid->hw_qdesc_paddr = rx_tid->hw_qdesc_paddr_unaligned;
  518. }
  519. /* TODO: Ensure that sec_type is set before ADDBA is received.
  520. * Currently this is set based on htt indication
  521. * HTT_T2H_MSG_TYPE_SEC_IND from target
  522. */
  523. switch (peer->security[dp_sec_ucast].sec_type) {
  524. case htt_sec_type_tkip_nomic:
  525. case htt_sec_type_aes_ccmp:
  526. case htt_sec_type_aes_ccmp_256:
  527. case htt_sec_type_aes_gcmp:
  528. case htt_sec_type_aes_gcmp_256:
  529. hal_pn_type = HAL_PN_WPA;
  530. break;
  531. case htt_sec_type_wapi:
  532. if (vdev->opmode == wlan_op_mode_ap)
  533. hal_pn_type = HAL_PN_WAPI_EVEN;
  534. else
  535. hal_pn_type = HAL_PN_WAPI_UNEVEN;
  536. break;
  537. default:
  538. hal_pn_type = HAL_PN_NONE;
  539. break;
  540. }
  541. hal_reo_qdesc_setup(soc->hal_soc, tid, ba_window_size, start_seq,
  542. hw_qdesc_vaddr, rx_tid->hw_qdesc_paddr, hal_pn_type);
  543. if (soc->cdp_soc.ol_ops->peer_rx_reorder_queue_setup) {
  544. soc->cdp_soc.ol_ops->peer_rx_reorder_queue_setup(soc->osif_soc,
  545. peer->vdev->vdev_id, peer->mac_addr.raw,
  546. rx_tid->hw_qdesc_paddr, tid, tid);
  547. }
  548. return 0;
  549. }
  550. /*
  551. * Rx TID deletion callback to free memory allocated for HW queue descriptor
  552. */
  553. static void dp_rx_tid_delete_cb(struct dp_soc *soc, void *cb_ctxt,
  554. union hal_reo_status *reo_status)
  555. {
  556. struct dp_rx_tid *rx_tid = (struct dp_rx_tid *)cb_ctxt;
  557. if (reo_status->rx_queue_status.header.status) {
  558. /* Should not happen normally. Just print error for now */
  559. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  560. "%s: Rx tid HW desc deletion failed(%d): tid %d\n",
  561. __func__,
  562. reo_status->rx_queue_status.header.status,
  563. rx_tid->tid);
  564. }
  565. QDF_TRACE(QDF_MODULE_ID_DP, QDF_TRACE_LEVEL_INFO,
  566. "%s: rx_tid: %d status: %d\n", __func__,
  567. rx_tid->tid, reo_status->rx_queue_status.header.status);
  568. /* Calling qdf_mem_free_consistent() in MCL is resulting in kernel BUG.
  569. * Diasble this temporarily.
  570. */
  571. #ifndef QCA_WIFI_NAPIER_EMULATION
  572. qdf_mem_free_consistent(soc->osdev, soc->osdev->dev,
  573. rx_tid->hw_qdesc_alloc_size,
  574. rx_tid->hw_qdesc_vaddr_unaligned,
  575. rx_tid->hw_qdesc_paddr_unaligned, 0);
  576. #endif
  577. qdf_mem_free(rx_tid);
  578. }
  579. /*
  580. * dp_rx_tid_delete_wifi3() – Delete receive TID queue
  581. * @peer: Datapath peer handle
  582. * @tid: TID
  583. *
  584. * Return: 0 on success, error code on failure
  585. */
  586. static int dp_rx_tid_delete_wifi3(struct dp_peer *peer, int tid)
  587. {
  588. struct dp_rx_tid *rx_tid = &(peer->rx_tid[tid]);
  589. struct dp_soc *soc = peer->vdev->pdev->soc;
  590. struct hal_reo_cmd_params params;
  591. struct dp_rx_tid *rx_tid_copy = qdf_mem_malloc(sizeof(*rx_tid_copy));
  592. if (!rx_tid_copy) {
  593. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  594. "%s: malloc failed for rx_tid_copy: tid %d\n",
  595. __func__, rx_tid->tid);
  596. return -ENOMEM;
  597. }
  598. *rx_tid_copy = *rx_tid;
  599. qdf_mem_zero(&params, sizeof(params));
  600. params.std.need_status = 1;
  601. params.std.addr_lo = rx_tid->hw_qdesc_paddr & 0xffffffff;
  602. params.std.addr_hi = (uint64_t)(rx_tid->hw_qdesc_paddr) >> 32;
  603. params.u.upd_queue_params.update_vld = 1;
  604. params.u.upd_queue_params.vld = 0;
  605. rx_tid->hw_qdesc_vaddr_unaligned = NULL;
  606. rx_tid->hw_qdesc_alloc_size = 0;
  607. dp_reo_send_cmd(soc, CMD_UPDATE_RX_REO_QUEUE, &params,
  608. dp_rx_tid_delete_cb, (void *)rx_tid_copy);
  609. return 0;
  610. }
  611. /*
  612. * dp_peer_rx_init() – Initialize receive TID state
  613. * @pdev: Datapath pdev
  614. * @peer: Datapath peer
  615. *
  616. */
  617. void dp_peer_rx_init(struct dp_pdev *pdev, struct dp_peer *peer)
  618. {
  619. int tid;
  620. struct dp_rx_tid *rx_tid;
  621. for (tid = 0; tid < DP_MAX_TIDS; tid++) {
  622. rx_tid = &peer->rx_tid[tid];
  623. rx_tid->array = &rx_tid->base;
  624. rx_tid->base.head = rx_tid->base.tail = NULL;
  625. rx_tid->tid = tid;
  626. rx_tid->defrag_timeout_ms = 0;
  627. rx_tid->ba_win_size = 0;
  628. rx_tid->ba_status = DP_RX_BA_INACTIVE;
  629. rx_tid->defrag_waitlist_elem.tqe_next = NULL;
  630. rx_tid->defrag_waitlist_elem.tqe_prev = NULL;
  631. #ifdef notyet /* TODO: See if this is required for exception handling */
  632. /* invalid sequence number */
  633. peer->tids_last_seq[tid] = 0xffff;
  634. #endif
  635. }
  636. /* Setup default (non-qos) rx tid queue */
  637. dp_rx_tid_setup_wifi3(peer, DP_NON_QOS_TID, 1, 0);
  638. /* Setup rx tid queue for TID 0.
  639. * Other queues will be setup on receiving first packet, which will cause
  640. * NULL REO queue error
  641. */
  642. dp_rx_tid_setup_wifi3(peer, 0, 1, 0);
  643. /*
  644. * Set security defaults: no PN check, no security. The target may
  645. * send a HTT SEC_IND message to overwrite these defaults.
  646. */
  647. peer->security[dp_sec_ucast].sec_type =
  648. peer->security[dp_sec_mcast].sec_type = htt_sec_type_none;
  649. }
  650. /*
  651. * dp_peer_rx_cleanup() – Cleanup receive TID state
  652. * @vdev: Datapath vdev
  653. * @peer: Datapath peer
  654. *
  655. */
  656. void dp_peer_rx_cleanup(struct dp_vdev *vdev, struct dp_peer *peer)
  657. {
  658. int tid;
  659. uint32_t tid_delete_mask = 0;
  660. for (tid = 0; tid < DP_MAX_TIDS; tid++) {
  661. if (peer->rx_tid[tid].hw_qdesc_vaddr_unaligned != NULL) {
  662. dp_rx_tid_delete_wifi3(peer, tid);
  663. tid_delete_mask |= (1 << tid);
  664. }
  665. }
  666. #ifdef notyet /* See if FW can remove queues as part of peer cleanup */
  667. if (soc->ol_ops->peer_rx_reorder_queue_remove) {
  668. soc->ol_ops->peer_rx_reorder_queue_remove(soc->osif_soc,
  669. peer->vdev->vdev_id, peer->mac_addr.raw,
  670. tid_delete_mask);
  671. }
  672. #endif
  673. }
  674. /*
  675. * dp_peer_cleanup() – Cleanup peer information
  676. * @vdev: Datapath vdev
  677. * @peer: Datapath peer
  678. *
  679. */
  680. void dp_peer_cleanup(struct dp_vdev *vdev, struct dp_peer *peer)
  681. {
  682. peer->last_assoc_rcvd = 0;
  683. peer->last_disassoc_rcvd = 0;
  684. peer->last_deauth_rcvd = 0;
  685. /* cleanup the Rx reorder queues for this peer */
  686. dp_peer_rx_cleanup(vdev, peer);
  687. }
  688. /*
  689. * dp_rx_addba_requestprocess_wifi3() – Process ADDBA request from peer
  690. *
  691. * @peer: Datapath peer handle
  692. * @dialogtoken: dialogtoken from ADDBA frame
  693. * @tid: TID number
  694. * @startseqnum: Start seq. number received in BA sequence control
  695. * in ADDBA frame
  696. *
  697. * Return: 0 on success, error code on failure
  698. */
  699. int dp_addba_requestprocess_wifi3(void *peer_handle,
  700. uint8_t dialogtoken, uint16_t tid, uint16_t batimeout,
  701. uint16_t buffersize, uint16_t startseqnum)
  702. {
  703. struct dp_peer *peer = (struct dp_peer *)peer_handle;
  704. struct dp_rx_tid *rx_tid = &peer->rx_tid[tid];
  705. if ((rx_tid->ba_status == DP_RX_BA_ACTIVE) &&
  706. (rx_tid->hw_qdesc_vaddr_unaligned != NULL))
  707. rx_tid->ba_status = DP_RX_BA_INACTIVE;
  708. if (dp_rx_tid_setup_wifi3(peer, tid, buffersize,
  709. startseqnum)) {
  710. /* TODO: Should we send addba reject in this case */
  711. return QDF_STATUS_E_FAILURE;
  712. }
  713. rx_tid->ba_win_size = buffersize;
  714. rx_tid->dialogtoken = dialogtoken;
  715. rx_tid->statuscode = QDF_STATUS_SUCCESS;
  716. rx_tid->ba_status = DP_RX_BA_ACTIVE;
  717. return 0;
  718. }
  719. /*
  720. * dp_rx_addba_responsesetup_wifi3() – Process ADDBA request from peer
  721. *
  722. * @peer: Datapath peer handle
  723. * @tid: TID number
  724. * @dialogtoken: output dialogtoken
  725. * @statuscode: output dialogtoken
  726. * @buffersize: Ouput BA window sizze
  727. * @batimeout: Ouput BA timeout
  728. */
  729. void dp_addba_responsesetup_wifi3(void *peer_handle, uint8_t tid,
  730. uint8_t *dialogtoken, uint16_t *statuscode,
  731. uint16_t *buffersize, uint16_t *batimeout)
  732. {
  733. struct dp_peer *peer = (struct dp_peer *)peer_handle;
  734. struct dp_rx_tid *rx_tid = &peer->rx_tid[tid];
  735. /* setup ADDBA response paramters */
  736. *dialogtoken = rx_tid->dialogtoken;
  737. *statuscode = rx_tid->statuscode;
  738. *buffersize = rx_tid->ba_win_size;
  739. *batimeout = 0;
  740. }
  741. /*
  742. * dp_rx_delba_process_wifi3() – Process DELBA from peer
  743. * @peer: Datapath peer handle
  744. * @tid: TID number
  745. * @reasoncode: Reason code received in DELBA frame
  746. *
  747. * Return: 0 on success, error code on failure
  748. */
  749. int dp_delba_process_wifi3(void *peer_handle,
  750. int tid, uint16_t reasoncode)
  751. {
  752. struct dp_peer *peer = (struct dp_peer *)peer_handle;
  753. struct dp_rx_tid *rx_tid = &peer->rx_tid[tid];
  754. if (rx_tid->ba_status != DP_RX_BA_ACTIVE)
  755. return QDF_STATUS_E_FAILURE;
  756. /* TODO: See if we can delete the existing REO queue descriptor and
  757. * replace with a new one without queue extenstion descript to save
  758. * memory
  759. */
  760. dp_rx_tid_update_wifi3(peer, tid, 0, 0);
  761. rx_tid->ba_status = DP_RX_BA_INACTIVE;
  762. return 0;
  763. }
  764. void dp_rx_discard(struct dp_vdev *vdev, struct dp_peer *peer, unsigned tid,
  765. qdf_nbuf_t msdu_list)
  766. {
  767. while (msdu_list) {
  768. qdf_nbuf_t msdu = msdu_list;
  769. msdu_list = qdf_nbuf_next(msdu_list);
  770. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_INFO_HIGH,
  771. "discard rx %p from partly-deleted peer %p "
  772. "(%02x:%02x:%02x:%02x:%02x:%02x)\n",
  773. msdu, peer,
  774. peer->mac_addr.raw[0], peer->mac_addr.raw[1],
  775. peer->mac_addr.raw[2], peer->mac_addr.raw[3],
  776. peer->mac_addr.raw[4], peer->mac_addr.raw[5]);
  777. qdf_nbuf_free(msdu);
  778. }
  779. }
  780. void
  781. dp_rx_sec_ind_handler(void *soc_handle, uint16_t peer_id,
  782. enum htt_sec_type sec_type, int is_unicast, u_int32_t *michael_key,
  783. u_int32_t *rx_pn)
  784. {
  785. struct dp_soc *soc = (struct dp_soc *)soc_handle;
  786. struct dp_peer *peer;
  787. int sec_index;
  788. peer = dp_peer_find_by_id(soc, peer_id);
  789. if (!peer) {
  790. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  791. "Couldn't find peer from ID %d - skipping security inits\n",
  792. peer_id);
  793. return;
  794. }
  795. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_INFO_HIGH,
  796. "sec spec for peer %p (%02x:%02x:%02x:%02x:%02x:%02x): "
  797. "%s key of type %d\n",
  798. peer,
  799. peer->mac_addr.raw[0], peer->mac_addr.raw[1],
  800. peer->mac_addr.raw[2], peer->mac_addr.raw[3],
  801. peer->mac_addr.raw[4], peer->mac_addr.raw[5],
  802. is_unicast ? "ucast" : "mcast",
  803. sec_type);
  804. sec_index = is_unicast ? dp_sec_ucast : dp_sec_mcast;
  805. peer->security[sec_index].sec_type = sec_type;
  806. #ifdef notyet /* TODO: See if this is required for defrag support */
  807. /* michael key only valid for TKIP, but for simplicity,
  808. * copy it anyway
  809. */
  810. qdf_mem_copy(
  811. &peer->security[sec_index].michael_key[0],
  812. michael_key,
  813. sizeof(peer->security[sec_index].michael_key));
  814. #ifdef BIG_ENDIAN_HOST
  815. OL_IF_SWAPBO(peer->security[sec_index].michael_key[0],
  816. sizeof(peer->security[sec_index].michael_key));
  817. #endif /* BIG_ENDIAN_HOST */
  818. #endif
  819. #ifdef notyet /* TODO: Check if this is required for wifi3.0 */
  820. if (sec_type != htt_sec_type_wapi) {
  821. qdf_mem_set(peer->tids_last_pn_valid, _EXT_TIDS, 0x00);
  822. } else {
  823. for (i = 0; i < DP_MAX_TIDS; i++) {
  824. /*
  825. * Setting PN valid bit for WAPI sec_type,
  826. * since WAPI PN has to be started with predefined value
  827. */
  828. peer->tids_last_pn_valid[i] = 1;
  829. qdf_mem_copy(
  830. (u_int8_t *) &peer->tids_last_pn[i],
  831. (u_int8_t *) rx_pn, sizeof(union htt_rx_pn_t));
  832. peer->tids_last_pn[i].pn128[1] =
  833. qdf_cpu_to_le64(peer->tids_last_pn[i].pn128[1]);
  834. peer->tids_last_pn[i].pn128[0] =
  835. qdf_cpu_to_le64(peer->tids_last_pn[i].pn128[0]);
  836. }
  837. }
  838. #endif
  839. /* TODO: Update HW TID queue with PN check parameters (pn type for
  840. * all security types and last pn for WAPI) once REO command API
  841. * is available
  842. */
  843. }
  844. #ifndef CONFIG_WIN
  845. /**
  846. * dp_register_peer() - Register peer into physical device
  847. * @pdev - data path device instance
  848. * @sta_desc - peer description
  849. *
  850. * Register peer into physical device
  851. *
  852. * Return: QDF_STATUS_SUCCESS registration success
  853. * QDF_STATUS_E_FAULT peer not found
  854. */
  855. QDF_STATUS dp_register_peer(void *pdev_handle,
  856. struct ol_txrx_desc_type *sta_desc)
  857. {
  858. struct dp_peer *peer;
  859. struct dp_pdev *pdev = pdev_handle;
  860. peer = dp_peer_find_by_local_id(pdev, sta_desc->sta_id);
  861. if (!peer)
  862. return QDF_STATUS_E_FAULT;
  863. qdf_spin_lock_bh(&peer->peer_info_lock);
  864. peer->state = OL_TXRX_PEER_STATE_CONN;
  865. qdf_spin_unlock_bh(&peer->peer_info_lock);
  866. return QDF_STATUS_SUCCESS;
  867. }
  868. /**
  869. * dp_clear_peer() - remove peer from physical device
  870. * @pdev - data path device instance
  871. * @sta_id - local peer id
  872. *
  873. * remove peer from physical device
  874. *
  875. * Return: QDF_STATUS_SUCCESS registration success
  876. * QDF_STATUS_E_FAULT peer not found
  877. */
  878. QDF_STATUS dp_clear_peer(void *pdev_handle, uint8_t local_id)
  879. {
  880. struct dp_peer *peer;
  881. struct dp_pdev *pdev = pdev_handle;
  882. peer = dp_peer_find_by_local_id(pdev, local_id);
  883. if (!peer)
  884. return QDF_STATUS_E_FAULT;
  885. qdf_spin_lock_bh(&peer->peer_info_lock);
  886. peer->state = OL_TXRX_PEER_STATE_DISC;
  887. qdf_spin_unlock_bh(&peer->peer_info_lock);
  888. return QDF_STATUS_SUCCESS;
  889. }
  890. /**
  891. * dp_find_peer_by_addr_and_vdev() - Find peer by peer mac address within vdev
  892. * @pdev - data path device instance
  893. * @vdev - virtual interface instance
  894. * @peer_addr - peer mac address
  895. * @peer_id - local peer id with target mac address
  896. *
  897. * Find peer by peer mac address within vdev
  898. *
  899. * Return: peer instance void pointer
  900. * NULL cannot find target peer
  901. */
  902. void *dp_find_peer_by_addr_and_vdev(void *pdev_handle, void *vdev,
  903. uint8_t *peer_addr, uint8_t *local_id)
  904. {
  905. struct dp_pdev *pdev = pdev_handle;
  906. struct dp_peer *peer;
  907. DP_TRACE(INFO, "vdev %p peer_addr %p", vdev, peer_addr);
  908. peer = dp_peer_find_hash_find(pdev->soc, peer_addr, 0);
  909. DP_TRACE(INFO, "peer %p vdev %p", peer, vdev);
  910. if (!peer)
  911. return NULL;
  912. if (peer->vdev != vdev)
  913. return NULL;
  914. *local_id = peer->local_id;
  915. DP_TRACE(INFO, "peer %p vdev %p lcoal id %d", peer, vdev, *local_id);
  916. /* ref_cnt is incremented inside dp_peer_find_hash_find().
  917. * Decrement it here.
  918. */
  919. qdf_atomic_dec(&peer->ref_cnt);
  920. return peer;
  921. }
  922. /**
  923. * dp_local_peer_id() - Find local peer id within peer instance
  924. * @peer - peer instance
  925. *
  926. * Find local peer id within peer instance
  927. *
  928. * Return: local peer id
  929. */
  930. uint16_t dp_local_peer_id(void *peer)
  931. {
  932. return ((struct dp_peer *)peer)->local_id;
  933. }
  934. /**
  935. * dp_peer_find_by_local_id() - Find peer by local peer id
  936. * @pdev - data path device instance
  937. * @local_peer_id - local peer id want to find
  938. *
  939. * Find peer by local peer id within physical device
  940. *
  941. * Return: peer instance void pointer
  942. * NULL cannot find target peer
  943. */
  944. void *dp_peer_find_by_local_id(void *pdev_handle, uint8_t local_id)
  945. {
  946. struct dp_peer *peer;
  947. struct dp_pdev *pdev = pdev_handle;
  948. qdf_spin_lock_bh(&pdev->local_peer_ids.lock);
  949. peer = pdev->local_peer_ids.map[local_id];
  950. qdf_spin_unlock_bh(&pdev->local_peer_ids.lock);
  951. DP_TRACE(INFO, "peer %p lcoal id %d",
  952. peer, local_id);
  953. return peer;
  954. }
  955. /**
  956. * dp_peer_state_update() - update peer local state
  957. * @pdev - data path device instance
  958. * @peer_addr - peer mac address
  959. * @state - new peer local state
  960. *
  961. * update peer local state
  962. *
  963. * Return: QDF_STATUS_SUCCESS registration success
  964. */
  965. QDF_STATUS dp_peer_state_update(void *pdev_handle, uint8_t *peer_mac,
  966. enum ol_txrx_peer_state state)
  967. {
  968. struct dp_peer *peer;
  969. struct dp_pdev *pdev = pdev_handle;
  970. peer = dp_peer_find_hash_find(pdev->soc, peer_mac, 0);
  971. if (NULL == peer) {
  972. QDF_TRACE(QDF_MODULE_ID_TXRX, QDF_TRACE_LEVEL_ERROR,
  973. "Failed to find peer for: [%pM]", peer_mac);
  974. return QDF_STATUS_E_FAILURE;
  975. }
  976. peer->state = state;
  977. DP_TRACE(INFO, "peer %p state %d", peer, peer->state);
  978. /* ref_cnt is incremented inside dp_peer_find_hash_find().
  979. * Decrement it here.
  980. */
  981. qdf_atomic_dec(&peer->ref_cnt);
  982. return QDF_STATUS_SUCCESS;
  983. }
  984. /**
  985. * dp_get_vdevid() - Get virtaul interface id which peer registered
  986. * @peer - peer instance
  987. * @vdev_id - virtaul interface id which peer registered
  988. *
  989. * Get virtaul interface id which peer registered
  990. *
  991. * Return: QDF_STATUS_SUCCESS registration success
  992. */
  993. QDF_STATUS dp_get_vdevid(void *peer_handle, uint8_t *vdev_id)
  994. {
  995. struct dp_peer *peer = peer_handle;
  996. DP_TRACE(INFO, "peer %p vdev %p vdev id %d",
  997. peer, peer->vdev, peer->vdev->vdev_id);
  998. *vdev_id = peer->vdev->vdev_id;
  999. return QDF_STATUS_SUCCESS;
  1000. }
  1001. /**
  1002. * dp_get_vdev_for_peer() - Get virtual interface instance which peer belongs
  1003. * @peer - peer instance
  1004. *
  1005. * Get virtual interface instance which peer belongs
  1006. *
  1007. * Return: virtual interface instance pointer
  1008. * NULL in case cannot find
  1009. */
  1010. void *dp_get_vdev_for_peer(void *peer_handle)
  1011. {
  1012. struct dp_peer *peer = peer_handle;
  1013. DP_TRACE(INFO, "peer %p vdev %p", peer, peer->vdev);
  1014. return (void *)peer->vdev;
  1015. }
  1016. /**
  1017. * dp_peer_get_peer_mac_addr() - Get peer mac address
  1018. * @peer - peer instance
  1019. *
  1020. * Get peer mac address
  1021. *
  1022. * Return: peer mac address pointer
  1023. * NULL in case cannot find
  1024. */
  1025. uint8_t *dp_peer_get_peer_mac_addr(void *peer_handle)
  1026. {
  1027. struct dp_peer *peer = peer_handle;
  1028. uint8_t *mac;
  1029. mac = peer->mac_addr.raw;
  1030. DP_TRACE(INFO, "peer %p mac 0x%x 0x%x 0x%x 0x%x 0x%x 0x%x",
  1031. peer, mac[0], mac[1], mac[2], mac[3], mac[4], mac[5]);
  1032. return peer->mac_addr.raw;
  1033. }
  1034. /**
  1035. * dp_get_peer_state() - Get local peer state
  1036. * @peer - peer instance
  1037. *
  1038. * Get local peer state
  1039. *
  1040. * Return: peer status
  1041. */
  1042. int dp_get_peer_state(void *peer_handle)
  1043. {
  1044. struct dp_peer *peer = peer_handle;
  1045. DP_TRACE(INFO, "peer %p stats %d", peer, peer->state);
  1046. return peer->state;
  1047. }
  1048. /**
  1049. * dp_get_last_assoc_received() - get time of last assoc received
  1050. * @peer_handle: peer handle
  1051. *
  1052. * Return: pointer for the time of last assoc received
  1053. */
  1054. qdf_time_t *dp_get_last_assoc_received(void *peer_handle)
  1055. {
  1056. struct dp_peer *peer = peer_handle;
  1057. DP_TRACE(INFO, "peer %p last_assoc_rcvd: %lu", peer,
  1058. peer->last_assoc_rcvd);
  1059. return &peer->last_assoc_rcvd;
  1060. }
  1061. /**
  1062. * dp_get_last_disassoc_received() - get time of last disassoc received
  1063. * @peer_handle: peer handle
  1064. *
  1065. * Return: pointer for the time of last disassoc received
  1066. */
  1067. qdf_time_t *dp_get_last_disassoc_received(void *peer_handle)
  1068. {
  1069. struct dp_peer *peer = peer_handle;
  1070. DP_TRACE(INFO, "peer %p last_disassoc_rcvd: %lu", peer,
  1071. peer->last_disassoc_rcvd);
  1072. return &peer->last_disassoc_rcvd;
  1073. }
  1074. /**
  1075. * dp_get_last_deauth_received() - get time of last deauth received
  1076. * @peer_handle: peer handle
  1077. *
  1078. * Return: pointer for the time of last deauth received
  1079. */
  1080. qdf_time_t *dp_get_last_deauth_received(void *peer_handle)
  1081. {
  1082. struct dp_peer *peer = peer_handle;
  1083. DP_TRACE(INFO, "peer %p last_deauth_rcvd: %lu", peer,
  1084. peer->last_deauth_rcvd);
  1085. return &peer->last_deauth_rcvd;
  1086. }
  1087. /**
  1088. * dp_local_peer_id_pool_init() - local peer id pool alloc for physical device
  1089. * @pdev - data path device instance
  1090. *
  1091. * local peer id pool alloc for physical device
  1092. *
  1093. * Return: none
  1094. */
  1095. void dp_local_peer_id_pool_init(struct dp_pdev *pdev)
  1096. {
  1097. int i;
  1098. /* point the freelist to the first ID */
  1099. pdev->local_peer_ids.freelist = 0;
  1100. /* link each ID to the next one */
  1101. for (i = 0; i < OL_TXRX_NUM_LOCAL_PEER_IDS; i++) {
  1102. pdev->local_peer_ids.pool[i] = i + 1;
  1103. pdev->local_peer_ids.map[i] = NULL;
  1104. }
  1105. /* link the last ID to itself, to mark the end of the list */
  1106. i = OL_TXRX_NUM_LOCAL_PEER_IDS;
  1107. pdev->local_peer_ids.pool[i] = i;
  1108. qdf_spinlock_create(&pdev->local_peer_ids.lock);
  1109. DP_TRACE(INFO, "Peer pool init");
  1110. }
  1111. /**
  1112. * dp_local_peer_id_alloc() - allocate local peer id
  1113. * @pdev - data path device instance
  1114. * @peer - new peer instance
  1115. *
  1116. * allocate local peer id
  1117. *
  1118. * Return: none
  1119. */
  1120. void dp_local_peer_id_alloc(struct dp_pdev *pdev, struct dp_peer *peer)
  1121. {
  1122. int i;
  1123. qdf_spin_lock_bh(&pdev->local_peer_ids.lock);
  1124. i = pdev->local_peer_ids.freelist;
  1125. if (pdev->local_peer_ids.pool[i] == i) {
  1126. /* the list is empty, except for the list-end marker */
  1127. peer->local_id = OL_TXRX_INVALID_LOCAL_PEER_ID;
  1128. } else {
  1129. /* take the head ID and advance the freelist */
  1130. peer->local_id = i;
  1131. pdev->local_peer_ids.freelist = pdev->local_peer_ids.pool[i];
  1132. pdev->local_peer_ids.map[i] = peer;
  1133. }
  1134. qdf_spin_unlock_bh(&pdev->local_peer_ids.lock);
  1135. DP_TRACE(INFO, "peer %p, local id %d", peer, peer->local_id);
  1136. }
  1137. /**
  1138. * dp_local_peer_id_free() - remove local peer id
  1139. * @pdev - data path device instance
  1140. * @peer - peer instance should be removed
  1141. *
  1142. * remove local peer id
  1143. *
  1144. * Return: none
  1145. */
  1146. void dp_local_peer_id_free(struct dp_pdev *pdev, struct dp_peer *peer)
  1147. {
  1148. int i = peer->local_id;
  1149. if ((i == OL_TXRX_INVALID_LOCAL_PEER_ID) ||
  1150. (i >= OL_TXRX_NUM_LOCAL_PEER_IDS)) {
  1151. return;
  1152. }
  1153. /* put this ID on the head of the freelist */
  1154. qdf_spin_lock_bh(&pdev->local_peer_ids.lock);
  1155. pdev->local_peer_ids.pool[i] = pdev->local_peer_ids.freelist;
  1156. pdev->local_peer_ids.freelist = i;
  1157. pdev->local_peer_ids.map[i] = NULL;
  1158. qdf_spin_unlock_bh(&pdev->local_peer_ids.lock);
  1159. }
  1160. #endif