1 | // SPDX-License-Identifier: GPL-2.0+ |
2 | /* Copyright (c) 2015-2016 Quantenna Communications. All rights reserved. */ |
3 | |
4 | #include "util.h" |
5 | #include "qtn_hw_ids.h" |
6 | |
7 | void qtnf_sta_list_init(struct qtnf_sta_list *list) |
8 | { |
9 | if (unlikely(!list)) |
10 | return; |
11 | |
12 | INIT_LIST_HEAD(list: &list->head); |
13 | atomic_set(v: &list->size, i: 0); |
14 | } |
15 | |
16 | struct qtnf_sta_node *qtnf_sta_list_lookup(struct qtnf_sta_list *list, |
17 | const u8 *mac) |
18 | { |
19 | struct qtnf_sta_node *node; |
20 | |
21 | if (unlikely(!mac)) |
22 | return NULL; |
23 | |
24 | list_for_each_entry(node, &list->head, list) { |
25 | if (ether_addr_equal(addr1: node->mac_addr, addr2: mac)) |
26 | return node; |
27 | } |
28 | |
29 | return NULL; |
30 | } |
31 | |
32 | struct qtnf_sta_node *qtnf_sta_list_lookup_index(struct qtnf_sta_list *list, |
33 | size_t index) |
34 | { |
35 | struct qtnf_sta_node *node; |
36 | |
37 | if (qtnf_sta_list_size(list) <= index) |
38 | return NULL; |
39 | |
40 | list_for_each_entry(node, &list->head, list) { |
41 | if (index-- == 0) |
42 | return node; |
43 | } |
44 | |
45 | return NULL; |
46 | } |
47 | |
48 | struct qtnf_sta_node *qtnf_sta_list_add(struct qtnf_vif *vif, |
49 | const u8 *mac) |
50 | { |
51 | struct qtnf_sta_list *list = &vif->sta_list; |
52 | struct qtnf_sta_node *node; |
53 | |
54 | if (unlikely(!mac)) |
55 | return NULL; |
56 | |
57 | node = qtnf_sta_list_lookup(list, mac); |
58 | |
59 | if (node) |
60 | goto done; |
61 | |
62 | node = kzalloc(size: sizeof(*node), GFP_KERNEL); |
63 | if (unlikely(!node)) |
64 | goto done; |
65 | |
66 | ether_addr_copy(dst: node->mac_addr, src: mac); |
67 | list_add_tail(new: &node->list, head: &list->head); |
68 | atomic_inc(v: &list->size); |
69 | ++vif->generation; |
70 | |
71 | done: |
72 | return node; |
73 | } |
74 | |
75 | bool qtnf_sta_list_del(struct qtnf_vif *vif, const u8 *mac) |
76 | { |
77 | struct qtnf_sta_list *list = &vif->sta_list; |
78 | struct qtnf_sta_node *node; |
79 | bool ret = false; |
80 | |
81 | node = qtnf_sta_list_lookup(list, mac); |
82 | |
83 | if (node) { |
84 | list_del(entry: &node->list); |
85 | atomic_dec(v: &list->size); |
86 | kfree(objp: node); |
87 | ++vif->generation; |
88 | ret = true; |
89 | } |
90 | |
91 | return ret; |
92 | } |
93 | |
94 | void qtnf_sta_list_free(struct qtnf_sta_list *list) |
95 | { |
96 | struct qtnf_sta_node *node, *tmp; |
97 | |
98 | atomic_set(v: &list->size, i: 0); |
99 | |
100 | list_for_each_entry_safe(node, tmp, &list->head, list) { |
101 | list_del(entry: &node->list); |
102 | kfree(objp: node); |
103 | } |
104 | |
105 | INIT_LIST_HEAD(list: &list->head); |
106 | } |
107 | |
108 | const char *qtnf_chipid_to_string(unsigned long chip_id) |
109 | { |
110 | switch (chip_id) { |
111 | case QTN_CHIP_ID_TOPAZ: |
112 | return "Topaz" ; |
113 | case QTN_CHIP_ID_PEARL: |
114 | return "Pearl revA" ; |
115 | case QTN_CHIP_ID_PEARL_B: |
116 | return "Pearl revB" ; |
117 | case QTN_CHIP_ID_PEARL_C: |
118 | return "Pearl revC" ; |
119 | default: |
120 | return "unknown" ; |
121 | } |
122 | } |
123 | EXPORT_SYMBOL_GPL(qtnf_chipid_to_string); |
124 | |