1 // SPDX-License-Identifier: BSD-3-Clause-Clear
3 * Copyright (c) 2018-2019 The Linux Foundation. All rights reserved.
4 * Copyright (c) 2021-2022 Qualcomm Innovation Center, Inc. All rights reserved.
11 static struct ath11k_peer *ath11k_peer_find_list_by_id(struct ath11k_base *ab,
14 struct ath11k_peer *peer;
16 lockdep_assert_held(&ab->base_lock);
18 list_for_each_entry(peer, &ab->peers, list) {
19 if (peer->peer_id != peer_id)
28 struct ath11k_peer *ath11k_peer_find(struct ath11k_base *ab, int vdev_id,
31 struct ath11k_peer *peer;
33 lockdep_assert_held(&ab->base_lock);
35 list_for_each_entry(peer, &ab->peers, list) {
36 if (peer->vdev_id != vdev_id)
38 if (!ether_addr_equal(peer->addr, addr))
47 struct ath11k_peer *ath11k_peer_find_by_addr(struct ath11k_base *ab,
50 struct ath11k_peer *peer;
52 lockdep_assert_held(&ab->base_lock);
54 if (!ab->rhead_peer_addr)
57 peer = rhashtable_lookup_fast(ab->rhead_peer_addr, addr,
58 ab->rhash_peer_addr_param);
63 struct ath11k_peer *ath11k_peer_find_by_id(struct ath11k_base *ab,
66 struct ath11k_peer *peer;
68 lockdep_assert_held(&ab->base_lock);
70 if (!ab->rhead_peer_id)
73 peer = rhashtable_lookup_fast(ab->rhead_peer_id, &peer_id,
74 ab->rhash_peer_id_param);
79 struct ath11k_peer *ath11k_peer_find_by_vdev_id(struct ath11k_base *ab,
82 struct ath11k_peer *peer;
84 spin_lock_bh(&ab->base_lock);
86 list_for_each_entry(peer, &ab->peers, list) {
87 if (vdev_id == peer->vdev_id) {
88 spin_unlock_bh(&ab->base_lock);
92 spin_unlock_bh(&ab->base_lock);
96 void ath11k_peer_unmap_event(struct ath11k_base *ab, u16 peer_id)
98 struct ath11k_peer *peer;
100 spin_lock_bh(&ab->base_lock);
102 peer = ath11k_peer_find_list_by_id(ab, peer_id);
104 ath11k_warn(ab, "peer-unmap-event: unknown peer id %d\n",
109 ath11k_dbg(ab, ATH11K_DBG_DP_HTT, "htt peer unmap vdev %d peer %pM id %d\n",
110 peer->vdev_id, peer->addr, peer_id);
112 list_del(&peer->list);
114 wake_up(&ab->peer_mapping_wq);
117 spin_unlock_bh(&ab->base_lock);
120 void ath11k_peer_map_event(struct ath11k_base *ab, u8 vdev_id, u16 peer_id,
121 u8 *mac_addr, u16 ast_hash, u16 hw_peer_id)
123 struct ath11k_peer *peer;
125 spin_lock_bh(&ab->base_lock);
126 peer = ath11k_peer_find(ab, vdev_id, mac_addr);
128 peer = kzalloc(sizeof(*peer), GFP_ATOMIC);
132 peer->vdev_id = vdev_id;
133 peer->peer_id = peer_id;
134 peer->ast_hash = ast_hash;
135 peer->hw_peer_id = hw_peer_id;
136 ether_addr_copy(peer->addr, mac_addr);
137 list_add(&peer->list, &ab->peers);
138 wake_up(&ab->peer_mapping_wq);
141 ath11k_dbg(ab, ATH11K_DBG_DP_HTT, "htt peer map vdev %d peer %pM id %d\n",
142 vdev_id, mac_addr, peer_id);
145 spin_unlock_bh(&ab->base_lock);
148 static int ath11k_wait_for_peer_common(struct ath11k_base *ab, int vdev_id,
149 const u8 *addr, bool expect_mapped)
153 ret = wait_event_timeout(ab->peer_mapping_wq, ({
156 spin_lock_bh(&ab->base_lock);
157 mapped = !!ath11k_peer_find(ab, vdev_id, addr);
158 spin_unlock_bh(&ab->base_lock);
160 (mapped == expect_mapped ||
161 test_bit(ATH11K_FLAG_CRASH_FLUSH, &ab->dev_flags));
170 static inline int ath11k_peer_rhash_insert(struct ath11k_base *ab,
171 struct rhashtable *rtbl,
172 struct rhash_head *rhead,
173 struct rhashtable_params *params,
176 struct ath11k_peer *tmp;
178 lockdep_assert_held(&ab->tbl_mtx_lock);
180 tmp = rhashtable_lookup_get_insert_fast(rtbl, rhead, *params);
184 else if (IS_ERR(tmp))
190 static inline int ath11k_peer_rhash_remove(struct ath11k_base *ab,
191 struct rhashtable *rtbl,
192 struct rhash_head *rhead,
193 struct rhashtable_params *params)
197 lockdep_assert_held(&ab->tbl_mtx_lock);
199 ret = rhashtable_remove_fast(rtbl, rhead, *params);
200 if (ret && ret != -ENOENT)
206 static int ath11k_peer_rhash_add(struct ath11k_base *ab, struct ath11k_peer *peer)
210 lockdep_assert_held(&ab->base_lock);
211 lockdep_assert_held(&ab->tbl_mtx_lock);
213 if (!ab->rhead_peer_id || !ab->rhead_peer_addr)
216 ret = ath11k_peer_rhash_insert(ab, ab->rhead_peer_id, &peer->rhash_id,
217 &ab->rhash_peer_id_param, &peer->peer_id);
219 ath11k_warn(ab, "failed to add peer %pM with id %d in rhash_id ret %d\n",
220 peer->addr, peer->peer_id, ret);
224 ret = ath11k_peer_rhash_insert(ab, ab->rhead_peer_addr, &peer->rhash_addr,
225 &ab->rhash_peer_addr_param, &peer->addr);
227 ath11k_warn(ab, "failed to add peer %pM with id %d in rhash_addr ret %d\n",
228 peer->addr, peer->peer_id, ret);
235 ath11k_peer_rhash_remove(ab, ab->rhead_peer_id, &peer->rhash_id,
236 &ab->rhash_peer_id_param);
240 void ath11k_peer_cleanup(struct ath11k *ar, u32 vdev_id)
242 struct ath11k_peer *peer, *tmp;
243 struct ath11k_base *ab = ar->ab;
245 lockdep_assert_held(&ar->conf_mutex);
247 mutex_lock(&ab->tbl_mtx_lock);
248 spin_lock_bh(&ab->base_lock);
249 list_for_each_entry_safe(peer, tmp, &ab->peers, list) {
250 if (peer->vdev_id != vdev_id)
253 ath11k_warn(ab, "removing stale peer %pM from vdev_id %d\n",
254 peer->addr, vdev_id);
256 ath11k_peer_rhash_delete(ab, peer);
257 list_del(&peer->list);
262 spin_unlock_bh(&ab->base_lock);
263 mutex_unlock(&ab->tbl_mtx_lock);
266 static int ath11k_wait_for_peer_deleted(struct ath11k *ar, int vdev_id, const u8 *addr)
268 return ath11k_wait_for_peer_common(ar->ab, vdev_id, addr, false);
271 int ath11k_wait_for_peer_delete_done(struct ath11k *ar, u32 vdev_id,
275 unsigned long time_left;
277 ret = ath11k_wait_for_peer_deleted(ar, vdev_id, addr);
279 ath11k_warn(ar->ab, "failed wait for peer deleted");
283 time_left = wait_for_completion_timeout(&ar->peer_delete_done,
285 if (time_left == 0) {
286 ath11k_warn(ar->ab, "Timeout in receiving peer delete response\n");
293 static int __ath11k_peer_delete(struct ath11k *ar, u32 vdev_id, const u8 *addr)
296 struct ath11k_peer *peer;
297 struct ath11k_base *ab = ar->ab;
299 lockdep_assert_held(&ar->conf_mutex);
301 mutex_lock(&ab->tbl_mtx_lock);
302 spin_lock_bh(&ab->base_lock);
304 peer = ath11k_peer_find_by_addr(ab, addr);
306 spin_unlock_bh(&ab->base_lock);
307 mutex_unlock(&ab->tbl_mtx_lock);
310 "failed to find peer vdev_id %d addr %pM in delete\n",
315 ath11k_peer_rhash_delete(ab, peer);
317 spin_unlock_bh(&ab->base_lock);
318 mutex_unlock(&ab->tbl_mtx_lock);
320 reinit_completion(&ar->peer_delete_done);
322 ret = ath11k_wmi_send_peer_delete_cmd(ar, addr, vdev_id);
325 "failed to delete peer vdev_id %d addr %pM ret %d\n",
330 ret = ath11k_wait_for_peer_delete_done(ar, vdev_id, addr);
337 int ath11k_peer_delete(struct ath11k *ar, u32 vdev_id, u8 *addr)
341 lockdep_assert_held(&ar->conf_mutex);
343 ret = __ath11k_peer_delete(ar, vdev_id, addr);
352 static int ath11k_wait_for_peer_created(struct ath11k *ar, int vdev_id, const u8 *addr)
354 return ath11k_wait_for_peer_common(ar->ab, vdev_id, addr, true);
357 int ath11k_peer_create(struct ath11k *ar, struct ath11k_vif *arvif,
358 struct ieee80211_sta *sta, struct peer_create_params *param)
360 struct ath11k_peer *peer;
361 struct ath11k_sta *arsta;
364 lockdep_assert_held(&ar->conf_mutex);
366 if (ar->num_peers > (ar->max_num_peers - 1)) {
368 "failed to create peer due to insufficient peer entry resource in firmware\n");
372 spin_lock_bh(&ar->ab->base_lock);
373 peer = ath11k_peer_find_by_addr(ar->ab, param->peer_addr);
375 spin_unlock_bh(&ar->ab->base_lock);
378 spin_unlock_bh(&ar->ab->base_lock);
380 ret = ath11k_wmi_send_peer_create_cmd(ar, param);
383 "failed to send peer create vdev_id %d ret %d\n",
384 param->vdev_id, ret);
388 ret = ath11k_wait_for_peer_created(ar, param->vdev_id,
393 mutex_lock(&ar->ab->tbl_mtx_lock);
394 spin_lock_bh(&ar->ab->base_lock);
396 peer = ath11k_peer_find(ar->ab, param->vdev_id, param->peer_addr);
398 spin_unlock_bh(&ar->ab->base_lock);
399 mutex_unlock(&ar->ab->tbl_mtx_lock);
400 ath11k_warn(ar->ab, "failed to find peer %pM on vdev %i after creation\n",
401 param->peer_addr, param->vdev_id);
407 ret = ath11k_peer_rhash_add(ar->ab, peer);
409 spin_unlock_bh(&ar->ab->base_lock);
410 mutex_unlock(&ar->ab->tbl_mtx_lock);
414 peer->pdev_idx = ar->pdev_idx;
417 if (arvif->vif->type == NL80211_IFTYPE_STATION) {
418 arvif->ast_hash = peer->ast_hash;
419 arvif->ast_idx = peer->hw_peer_id;
422 peer->sec_type = HAL_ENCRYPT_TYPE_OPEN;
423 peer->sec_type_grp = HAL_ENCRYPT_TYPE_OPEN;
426 arsta = (struct ath11k_sta *)sta->drv_priv;
427 arsta->tcl_metadata |= FIELD_PREP(HTT_TCL_META_DATA_TYPE, 0) |
428 FIELD_PREP(HTT_TCL_META_DATA_PEER_ID,
431 /* set HTT extension valid bit to 0 by default */
432 arsta->tcl_metadata &= ~HTT_TCL_META_DATA_VALID_HTT;
437 spin_unlock_bh(&ar->ab->base_lock);
438 mutex_unlock(&ar->ab->tbl_mtx_lock);
443 fbret = __ath11k_peer_delete(ar, param->vdev_id, param->peer_addr);
445 ath11k_warn(ar->ab, "failed peer %pM delete vdev_id %d fallback ret %d\n",
446 param->peer_addr, param->vdev_id, fbret);
451 int ath11k_peer_rhash_delete(struct ath11k_base *ab, struct ath11k_peer *peer)
455 lockdep_assert_held(&ab->base_lock);
456 lockdep_assert_held(&ab->tbl_mtx_lock);
458 if (!ab->rhead_peer_id || !ab->rhead_peer_addr)
461 ret = ath11k_peer_rhash_remove(ab, ab->rhead_peer_addr, &peer->rhash_addr,
462 &ab->rhash_peer_addr_param);
464 ath11k_warn(ab, "failed to remove peer %pM id %d in rhash_addr ret %d\n",
465 peer->addr, peer->peer_id, ret);
469 ret = ath11k_peer_rhash_remove(ab, ab->rhead_peer_id, &peer->rhash_id,
470 &ab->rhash_peer_id_param);
472 ath11k_warn(ab, "failed to remove peer %pM id %d in rhash_id ret %d\n",
473 peer->addr, peer->peer_id, ret);
480 static int ath11k_peer_rhash_id_tbl_init(struct ath11k_base *ab)
482 struct rhashtable_params *param;
483 struct rhashtable *rhash_id_tbl;
487 lockdep_assert_held(&ab->tbl_mtx_lock);
489 if (ab->rhead_peer_id)
492 size = sizeof(*ab->rhead_peer_id);
493 rhash_id_tbl = kzalloc(size, GFP_KERNEL);
495 ath11k_warn(ab, "failed to init rhash id table due to no mem (size %zu)\n",
500 param = &ab->rhash_peer_id_param;
502 param->key_offset = offsetof(struct ath11k_peer, peer_id);
503 param->head_offset = offsetof(struct ath11k_peer, rhash_id);
504 param->key_len = sizeof_field(struct ath11k_peer, peer_id);
505 param->automatic_shrinking = true;
506 param->nelem_hint = ab->num_radios * TARGET_NUM_PEERS_PDEV(ab);
508 ret = rhashtable_init(rhash_id_tbl, param);
510 ath11k_warn(ab, "failed to init peer id rhash table %d\n", ret);
514 spin_lock_bh(&ab->base_lock);
516 if (!ab->rhead_peer_id) {
517 ab->rhead_peer_id = rhash_id_tbl;
519 spin_unlock_bh(&ab->base_lock);
523 spin_unlock_bh(&ab->base_lock);
528 rhashtable_destroy(rhash_id_tbl);
535 static int ath11k_peer_rhash_addr_tbl_init(struct ath11k_base *ab)
537 struct rhashtable_params *param;
538 struct rhashtable *rhash_addr_tbl;
542 lockdep_assert_held(&ab->tbl_mtx_lock);
544 if (ab->rhead_peer_addr)
547 size = sizeof(*ab->rhead_peer_addr);
548 rhash_addr_tbl = kzalloc(size, GFP_KERNEL);
549 if (!rhash_addr_tbl) {
550 ath11k_warn(ab, "failed to init rhash addr table due to no mem (size %zu)\n",
555 param = &ab->rhash_peer_addr_param;
557 param->key_offset = offsetof(struct ath11k_peer, addr);
558 param->head_offset = offsetof(struct ath11k_peer, rhash_addr);
559 param->key_len = sizeof_field(struct ath11k_peer, addr);
560 param->automatic_shrinking = true;
561 param->nelem_hint = ab->num_radios * TARGET_NUM_PEERS_PDEV(ab);
563 ret = rhashtable_init(rhash_addr_tbl, param);
565 ath11k_warn(ab, "failed to init peer addr rhash table %d\n", ret);
569 spin_lock_bh(&ab->base_lock);
571 if (!ab->rhead_peer_addr) {
572 ab->rhead_peer_addr = rhash_addr_tbl;
574 spin_unlock_bh(&ab->base_lock);
578 spin_unlock_bh(&ab->base_lock);
583 rhashtable_destroy(rhash_addr_tbl);
585 kfree(rhash_addr_tbl);
590 static inline void ath11k_peer_rhash_id_tbl_destroy(struct ath11k_base *ab)
592 lockdep_assert_held(&ab->tbl_mtx_lock);
594 if (!ab->rhead_peer_id)
597 rhashtable_destroy(ab->rhead_peer_id);
598 kfree(ab->rhead_peer_id);
599 ab->rhead_peer_id = NULL;
602 static inline void ath11k_peer_rhash_addr_tbl_destroy(struct ath11k_base *ab)
604 lockdep_assert_held(&ab->tbl_mtx_lock);
606 if (!ab->rhead_peer_addr)
609 rhashtable_destroy(ab->rhead_peer_addr);
610 kfree(ab->rhead_peer_addr);
611 ab->rhead_peer_addr = NULL;
614 int ath11k_peer_rhash_tbl_init(struct ath11k_base *ab)
618 mutex_lock(&ab->tbl_mtx_lock);
620 ret = ath11k_peer_rhash_id_tbl_init(ab);
624 ret = ath11k_peer_rhash_addr_tbl_init(ab);
628 mutex_unlock(&ab->tbl_mtx_lock);
633 ath11k_peer_rhash_id_tbl_destroy(ab);
635 mutex_unlock(&ab->tbl_mtx_lock);
639 void ath11k_peer_rhash_tbl_destroy(struct ath11k_base *ab)
641 mutex_lock(&ab->tbl_mtx_lock);
643 ath11k_peer_rhash_addr_tbl_destroy(ab);
644 ath11k_peer_rhash_id_tbl_destroy(ab);
646 mutex_unlock(&ab->tbl_mtx_lock);