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
qtnf_sta_list_init(struct qtnf_sta_list * list)7 void qtnf_sta_list_init(struct qtnf_sta_list *list)
8 {
9 if (unlikely(!list))
10 return;
11
12 INIT_LIST_HEAD(&list->head);
13 atomic_set(&list->size, 0);
14 }
15
qtnf_sta_list_lookup(struct qtnf_sta_list * list,const u8 * mac)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(node->mac_addr, mac))
26 return node;
27 }
28
29 return NULL;
30 }
31
qtnf_sta_list_lookup_index(struct qtnf_sta_list * list,size_t index)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
qtnf_sta_list_add(struct qtnf_vif * vif,const u8 * mac)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(sizeof(*node), GFP_KERNEL);
63 if (unlikely(!node))
64 goto done;
65
66 ether_addr_copy(node->mac_addr, mac);
67 list_add_tail(&node->list, &list->head);
68 atomic_inc(&list->size);
69 ++vif->generation;
70
71 done:
72 return node;
73 }
74
qtnf_sta_list_del(struct qtnf_vif * vif,const u8 * mac)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(&node->list);
85 atomic_dec(&list->size);
86 kfree(node);
87 ++vif->generation;
88 ret = true;
89 }
90
91 return ret;
92 }
93
qtnf_sta_list_free(struct qtnf_sta_list * list)94 void qtnf_sta_list_free(struct qtnf_sta_list *list)
95 {
96 struct qtnf_sta_node *node, *tmp;
97
98 atomic_set(&list->size, 0);
99
100 list_for_each_entry_safe(node, tmp, &list->head, list) {
101 list_del(&node->list);
102 kfree(node);
103 }
104
105 INIT_LIST_HEAD(&list->head);
106 }
107
qtnf_chipid_to_string(unsigned long chip_id)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