1 // SPDX-License-Identifier: GPL-2.0+
2 /* Copyright (c) 2015-2016 Quantenna Communications. All rights reserved. */
3
4 #include <linux/nl80211.h>
5
6 #include "qlink_util.h"
7
qlink_iface_type_to_nl_mask(u16 qlink_type)8 u16 qlink_iface_type_to_nl_mask(u16 qlink_type)
9 {
10 u16 result = 0;
11
12 switch (qlink_type) {
13 case QLINK_IFTYPE_AP:
14 result |= BIT(NL80211_IFTYPE_AP);
15 break;
16 case QLINK_IFTYPE_STATION:
17 result |= BIT(NL80211_IFTYPE_STATION);
18 break;
19 case QLINK_IFTYPE_ADHOC:
20 result |= BIT(NL80211_IFTYPE_ADHOC);
21 break;
22 case QLINK_IFTYPE_MONITOR:
23 result |= BIT(NL80211_IFTYPE_MONITOR);
24 break;
25 case QLINK_IFTYPE_WDS:
26 result |= BIT(NL80211_IFTYPE_WDS);
27 break;
28 case QLINK_IFTYPE_AP_VLAN:
29 result |= BIT(NL80211_IFTYPE_AP_VLAN);
30 break;
31 }
32
33 return result;
34 }
35
qlink_chan_width_mask_to_nl(u16 qlink_mask)36 u8 qlink_chan_width_mask_to_nl(u16 qlink_mask)
37 {
38 u8 result = 0;
39
40 if (qlink_mask & BIT(QLINK_CHAN_WIDTH_5))
41 result |= BIT(NL80211_CHAN_WIDTH_5);
42
43 if (qlink_mask & BIT(QLINK_CHAN_WIDTH_10))
44 result |= BIT(NL80211_CHAN_WIDTH_10);
45
46 if (qlink_mask & BIT(QLINK_CHAN_WIDTH_20_NOHT))
47 result |= BIT(NL80211_CHAN_WIDTH_20_NOHT);
48
49 if (qlink_mask & BIT(QLINK_CHAN_WIDTH_20))
50 result |= BIT(NL80211_CHAN_WIDTH_20);
51
52 if (qlink_mask & BIT(QLINK_CHAN_WIDTH_40))
53 result |= BIT(NL80211_CHAN_WIDTH_40);
54
55 if (qlink_mask & BIT(QLINK_CHAN_WIDTH_80))
56 result |= BIT(NL80211_CHAN_WIDTH_80);
57
58 if (qlink_mask & BIT(QLINK_CHAN_WIDTH_80P80))
59 result |= BIT(NL80211_CHAN_WIDTH_80P80);
60
61 if (qlink_mask & BIT(QLINK_CHAN_WIDTH_160))
62 result |= BIT(NL80211_CHAN_WIDTH_160);
63
64 return result;
65 }
66
qlink_chanwidth_to_nl(u8 qlw)67 static enum nl80211_chan_width qlink_chanwidth_to_nl(u8 qlw)
68 {
69 switch (qlw) {
70 case QLINK_CHAN_WIDTH_20_NOHT:
71 return NL80211_CHAN_WIDTH_20_NOHT;
72 case QLINK_CHAN_WIDTH_20:
73 return NL80211_CHAN_WIDTH_20;
74 case QLINK_CHAN_WIDTH_40:
75 return NL80211_CHAN_WIDTH_40;
76 case QLINK_CHAN_WIDTH_80:
77 return NL80211_CHAN_WIDTH_80;
78 case QLINK_CHAN_WIDTH_80P80:
79 return NL80211_CHAN_WIDTH_80P80;
80 case QLINK_CHAN_WIDTH_160:
81 return NL80211_CHAN_WIDTH_160;
82 case QLINK_CHAN_WIDTH_5:
83 return NL80211_CHAN_WIDTH_5;
84 case QLINK_CHAN_WIDTH_10:
85 return NL80211_CHAN_WIDTH_10;
86 default:
87 return -1;
88 }
89 }
90
qlink_chanwidth_nl_to_qlink(enum nl80211_chan_width nlwidth)91 static u8 qlink_chanwidth_nl_to_qlink(enum nl80211_chan_width nlwidth)
92 {
93 switch (nlwidth) {
94 case NL80211_CHAN_WIDTH_20_NOHT:
95 return QLINK_CHAN_WIDTH_20_NOHT;
96 case NL80211_CHAN_WIDTH_20:
97 return QLINK_CHAN_WIDTH_20;
98 case NL80211_CHAN_WIDTH_40:
99 return QLINK_CHAN_WIDTH_40;
100 case NL80211_CHAN_WIDTH_80:
101 return QLINK_CHAN_WIDTH_80;
102 case NL80211_CHAN_WIDTH_80P80:
103 return QLINK_CHAN_WIDTH_80P80;
104 case NL80211_CHAN_WIDTH_160:
105 return QLINK_CHAN_WIDTH_160;
106 case NL80211_CHAN_WIDTH_5:
107 return QLINK_CHAN_WIDTH_5;
108 case NL80211_CHAN_WIDTH_10:
109 return QLINK_CHAN_WIDTH_10;
110 default:
111 return -1;
112 }
113 }
114
qlink_chandef_q2cfg(struct wiphy * wiphy,const struct qlink_chandef * qch,struct cfg80211_chan_def * chdef)115 void qlink_chandef_q2cfg(struct wiphy *wiphy,
116 const struct qlink_chandef *qch,
117 struct cfg80211_chan_def *chdef)
118 {
119 struct ieee80211_channel *chan;
120
121 chan = ieee80211_get_channel(wiphy, le16_to_cpu(qch->chan.center_freq));
122
123 chdef->chan = chan;
124 chdef->center_freq1 = le16_to_cpu(qch->center_freq1);
125 chdef->center_freq2 = le16_to_cpu(qch->center_freq2);
126 chdef->width = qlink_chanwidth_to_nl(qch->width);
127 chdef->edmg.bw_config = 0;
128 chdef->edmg.channels = 0;
129 }
130
qlink_chandef_cfg2q(const struct cfg80211_chan_def * chdef,struct qlink_chandef * qch)131 void qlink_chandef_cfg2q(const struct cfg80211_chan_def *chdef,
132 struct qlink_chandef *qch)
133 {
134 struct ieee80211_channel *chan = chdef->chan;
135
136 qch->chan.hw_value = cpu_to_le16(chan->hw_value);
137 qch->chan.center_freq = cpu_to_le16(chan->center_freq);
138 qch->chan.flags = cpu_to_le32(chan->flags);
139
140 qch->center_freq1 = cpu_to_le16(chdef->center_freq1);
141 qch->center_freq2 = cpu_to_le16(chdef->center_freq2);
142 qch->width = qlink_chanwidth_nl_to_qlink(chdef->width);
143 }
144
qlink_hidden_ssid_nl2q(enum nl80211_hidden_ssid nl_val)145 enum qlink_hidden_ssid qlink_hidden_ssid_nl2q(enum nl80211_hidden_ssid nl_val)
146 {
147 switch (nl_val) {
148 case NL80211_HIDDEN_SSID_ZERO_LEN:
149 return QLINK_HIDDEN_SSID_ZERO_LEN;
150 case NL80211_HIDDEN_SSID_ZERO_CONTENTS:
151 return QLINK_HIDDEN_SSID_ZERO_CONTENTS;
152 case NL80211_HIDDEN_SSID_NOT_IN_USE:
153 default:
154 return QLINK_HIDDEN_SSID_NOT_IN_USE;
155 }
156 }
157
qtnf_utils_is_bit_set(const u8 * arr,unsigned int bit,unsigned int arr_max_len)158 bool qtnf_utils_is_bit_set(const u8 *arr, unsigned int bit,
159 unsigned int arr_max_len)
160 {
161 unsigned int idx = bit / BITS_PER_BYTE;
162 u8 mask = 1 << (bit - (idx * BITS_PER_BYTE));
163
164 if (idx >= arr_max_len)
165 return false;
166
167 return arr[idx] & mask;
168 }
169
qlink_acl_data_cfg2q(const struct cfg80211_acl_data * acl,struct qlink_acl_data * qacl)170 void qlink_acl_data_cfg2q(const struct cfg80211_acl_data *acl,
171 struct qlink_acl_data *qacl)
172 {
173 switch (acl->acl_policy) {
174 case NL80211_ACL_POLICY_ACCEPT_UNLESS_LISTED:
175 qacl->policy =
176 cpu_to_le32(QLINK_ACL_POLICY_ACCEPT_UNLESS_LISTED);
177 break;
178 case NL80211_ACL_POLICY_DENY_UNLESS_LISTED:
179 qacl->policy = cpu_to_le32(QLINK_ACL_POLICY_DENY_UNLESS_LISTED);
180 break;
181 }
182
183 qacl->num_entries = cpu_to_le32(acl->n_acl_entries);
184 memcpy(qacl->mac_addrs, acl->mac_addrs,
185 acl->n_acl_entries * sizeof(*qacl->mac_addrs));
186 }
187
qlink_utils_band_cfg2q(enum nl80211_band band)188 enum qlink_band qlink_utils_band_cfg2q(enum nl80211_band band)
189 {
190 switch (band) {
191 case NL80211_BAND_2GHZ:
192 return QLINK_BAND_2GHZ;
193 case NL80211_BAND_5GHZ:
194 return QLINK_BAND_5GHZ;
195 case NL80211_BAND_60GHZ:
196 return QLINK_BAND_60GHZ;
197 default:
198 return -EINVAL;
199 }
200 }
201
qlink_utils_dfs_state_cfg2q(enum nl80211_dfs_state state)202 enum qlink_dfs_state qlink_utils_dfs_state_cfg2q(enum nl80211_dfs_state state)
203 {
204 switch (state) {
205 case NL80211_DFS_USABLE:
206 return QLINK_DFS_USABLE;
207 case NL80211_DFS_AVAILABLE:
208 return QLINK_DFS_AVAILABLE;
209 case NL80211_DFS_UNAVAILABLE:
210 default:
211 return QLINK_DFS_UNAVAILABLE;
212 }
213 }
214
qlink_utils_chflags_cfg2q(u32 cfgflags)215 u32 qlink_utils_chflags_cfg2q(u32 cfgflags)
216 {
217 u32 flags = 0;
218
219 if (cfgflags & IEEE80211_CHAN_DISABLED)
220 flags |= QLINK_CHAN_DISABLED;
221
222 if (cfgflags & IEEE80211_CHAN_NO_IR)
223 flags |= QLINK_CHAN_NO_IR;
224
225 if (cfgflags & IEEE80211_CHAN_RADAR)
226 flags |= QLINK_CHAN_RADAR;
227
228 if (cfgflags & IEEE80211_CHAN_NO_HT40PLUS)
229 flags |= QLINK_CHAN_NO_HT40PLUS;
230
231 if (cfgflags & IEEE80211_CHAN_NO_HT40MINUS)
232 flags |= QLINK_CHAN_NO_HT40MINUS;
233
234 if (cfgflags & IEEE80211_CHAN_NO_80MHZ)
235 flags |= QLINK_CHAN_NO_80MHZ;
236
237 if (cfgflags & IEEE80211_CHAN_NO_160MHZ)
238 flags |= QLINK_CHAN_NO_160MHZ;
239
240 return flags;
241 }
242
qtnf_reg_rule_flags_parse(u32 qflags)243 static u32 qtnf_reg_rule_flags_parse(u32 qflags)
244 {
245 u32 flags = 0;
246
247 if (qflags & QLINK_RRF_NO_OFDM)
248 flags |= NL80211_RRF_NO_OFDM;
249
250 if (qflags & QLINK_RRF_NO_CCK)
251 flags |= NL80211_RRF_NO_CCK;
252
253 if (qflags & QLINK_RRF_NO_INDOOR)
254 flags |= NL80211_RRF_NO_INDOOR;
255
256 if (qflags & QLINK_RRF_NO_OUTDOOR)
257 flags |= NL80211_RRF_NO_OUTDOOR;
258
259 if (qflags & QLINK_RRF_DFS)
260 flags |= NL80211_RRF_DFS;
261
262 if (qflags & QLINK_RRF_PTP_ONLY)
263 flags |= NL80211_RRF_PTP_ONLY;
264
265 if (qflags & QLINK_RRF_PTMP_ONLY)
266 flags |= NL80211_RRF_PTMP_ONLY;
267
268 if (qflags & QLINK_RRF_NO_IR)
269 flags |= NL80211_RRF_NO_IR;
270
271 if (qflags & QLINK_RRF_AUTO_BW)
272 flags |= NL80211_RRF_AUTO_BW;
273
274 if (qflags & QLINK_RRF_IR_CONCURRENT)
275 flags |= NL80211_RRF_IR_CONCURRENT;
276
277 if (qflags & QLINK_RRF_NO_HT40MINUS)
278 flags |= NL80211_RRF_NO_HT40MINUS;
279
280 if (qflags & QLINK_RRF_NO_HT40PLUS)
281 flags |= NL80211_RRF_NO_HT40PLUS;
282
283 if (qflags & QLINK_RRF_NO_80MHZ)
284 flags |= NL80211_RRF_NO_80MHZ;
285
286 if (qflags & QLINK_RRF_NO_160MHZ)
287 flags |= NL80211_RRF_NO_160MHZ;
288
289 return flags;
290 }
291
qlink_utils_regrule_q2nl(struct ieee80211_reg_rule * rule,const struct qlink_tlv_reg_rule * tlv)292 void qlink_utils_regrule_q2nl(struct ieee80211_reg_rule *rule,
293 const struct qlink_tlv_reg_rule *tlv)
294 {
295 rule->freq_range.start_freq_khz = le32_to_cpu(tlv->start_freq_khz);
296 rule->freq_range.end_freq_khz = le32_to_cpu(tlv->end_freq_khz);
297 rule->freq_range.max_bandwidth_khz =
298 le32_to_cpu(tlv->max_bandwidth_khz);
299 rule->power_rule.max_antenna_gain = le32_to_cpu(tlv->max_antenna_gain);
300 rule->power_rule.max_eirp = le32_to_cpu(tlv->max_eirp);
301 rule->dfs_cac_ms = le32_to_cpu(tlv->dfs_cac_ms);
302 rule->flags = qtnf_reg_rule_flags_parse(le32_to_cpu(tlv->flags));
303 }
304