1
2
3
4
5
6
7#include <linux/netdevice.h>
8#include <linux/skbuff.h>
9#include <linux/module.h>
10#include <linux/if_arp.h>
11#include <linux/types.h>
12#include <net/ip.h>
13#include <net/pkt_sched.h>
14
15#include <net/mac80211.h>
16#include "ieee80211_i.h"
17#include "wme.h"
18
19
20
21
22const int ieee802_1d_to_ac[8] = {
23 IEEE80211_AC_BE,
24 IEEE80211_AC_BK,
25 IEEE80211_AC_BK,
26 IEEE80211_AC_BE,
27 IEEE80211_AC_VI,
28 IEEE80211_AC_VI,
29 IEEE80211_AC_VO,
30 IEEE80211_AC_VO
31};
32
33static int wme_downgrade_ac(struct sk_buff *skb)
34{
35 switch (skb->priority) {
36 case 6:
37 case 7:
38 skb->priority = 5;
39 return 0;
40 case 4:
41 case 5:
42 skb->priority = 3;
43 return 0;
44 case 0:
45 case 3:
46 skb->priority = 2;
47 return 0;
48 default:
49 return -1;
50 }
51}
52
53
54
55
56
57
58
59static inline u8 ieee80211_fix_reserved_tid(u8 tid)
60{
61 switch (tid) {
62 case 0:
63 return 3;
64 case 1:
65 return 2;
66 case 2:
67 return 1;
68 case 3:
69 return 0;
70 case 4:
71 return 5;
72 case 5:
73 return 4;
74 case 6:
75 return 7;
76 case 7:
77 return 6;
78 }
79
80 return 0;
81}
82
83static u16 ieee80211_downgrade_queue(struct ieee80211_sub_if_data *sdata,
84 struct sta_info *sta, struct sk_buff *skb)
85{
86 struct ieee80211_if_managed *ifmgd = &sdata->u.mgd;
87
88
89 while (sdata->wmm_acm & BIT(skb->priority)) {
90 int ac = ieee802_1d_to_ac[skb->priority];
91
92 if (ifmgd->tx_tspec[ac].admitted_time &&
93 skb->priority == ifmgd->tx_tspec[ac].up)
94 return ac;
95
96 if (wme_downgrade_ac(skb)) {
97
98
99
100
101
102
103 break;
104 }
105 }
106
107
108 if (sta && sta->reserved_tid == skb->priority)
109 skb->priority = ieee80211_fix_reserved_tid(skb->priority);
110
111
112 return ieee802_1d_to_ac[skb->priority];
113}
114
115
116u16 ieee80211_select_queue_80211(struct ieee80211_sub_if_data *sdata,
117 struct sk_buff *skb,
118 struct ieee80211_hdr *hdr)
119{
120 struct ieee80211_local *local = sdata->local;
121 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
122 u8 *p;
123
124 if ((info->control.flags & IEEE80211_TX_CTRL_DONT_REORDER) ||
125 local->hw.queues < IEEE80211_NUM_ACS)
126 return 0;
127
128 if (!ieee80211_is_data(hdr->frame_control)) {
129 skb->priority = 7;
130 return ieee802_1d_to_ac[skb->priority];
131 }
132 if (!ieee80211_is_data_qos(hdr->frame_control)) {
133 skb->priority = 0;
134 return ieee802_1d_to_ac[skb->priority];
135 }
136
137 p = ieee80211_get_qos_ctl(hdr);
138 skb->priority = *p & IEEE80211_QOS_CTL_TAG1D_MASK;
139
140 return ieee80211_downgrade_queue(sdata, NULL, skb);
141}
142
143u16 __ieee80211_select_queue(struct ieee80211_sub_if_data *sdata,
144 struct sta_info *sta, struct sk_buff *skb)
145{
146 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
147 struct mac80211_qos_map *qos_map;
148 bool qos;
149
150
151 if (sdata->vif.type == NL80211_IFTYPE_MESH_POINT ||
152 sdata->vif.type == NL80211_IFTYPE_OCB)
153 qos = true;
154 else if (sta)
155 qos = sta->sta.wme;
156 else
157 qos = false;
158
159 if (!qos || (info->control.flags & IEEE80211_TX_CTRL_DONT_REORDER)) {
160 skb->priority = 0;
161 return IEEE80211_AC_BE;
162 }
163
164 if (skb->protocol == sdata->control_port_protocol) {
165 skb->priority = 7;
166 goto downgrade;
167 }
168
169
170
171 qos_map = rcu_dereference(sdata->qos_map);
172 skb->priority = cfg80211_classify8021d(skb, qos_map ?
173 &qos_map->qos_map : NULL);
174
175 downgrade:
176 return ieee80211_downgrade_queue(sdata, sta, skb);
177}
178
179
180
181u16 ieee80211_select_queue(struct ieee80211_sub_if_data *sdata,
182 struct sk_buff *skb)
183{
184 struct ieee80211_local *local = sdata->local;
185 struct sta_info *sta = NULL;
186 const u8 *ra = NULL;
187 u16 ret;
188
189
190 if (local->ops->wake_tx_queue)
191 return 0;
192
193 if (local->hw.queues < IEEE80211_NUM_ACS || skb->len < 6) {
194 skb->priority = 0;
195 return 0;
196 }
197
198 rcu_read_lock();
199 switch (sdata->vif.type) {
200 case NL80211_IFTYPE_AP_VLAN:
201 sta = rcu_dereference(sdata->u.vlan.sta);
202 if (sta)
203 break;
204 fallthrough;
205 case NL80211_IFTYPE_AP:
206 ra = skb->data;
207 break;
208 case NL80211_IFTYPE_STATION:
209
210 sta = sta_info_get(sdata, skb->data);
211 if (sta)
212 break;
213
214 ra = sdata->u.mgd.bssid;
215 break;
216 case NL80211_IFTYPE_ADHOC:
217 ra = skb->data;
218 break;
219 default:
220 break;
221 }
222
223 if (!sta && ra && !is_multicast_ether_addr(ra))
224 sta = sta_info_get(sdata, ra);
225
226 ret = __ieee80211_select_queue(sdata, sta, skb);
227
228 rcu_read_unlock();
229 return ret;
230}
231
232
233
234
235
236
237
238void ieee80211_set_qos_hdr(struct ieee80211_sub_if_data *sdata,
239 struct sk_buff *skb)
240{
241 struct ieee80211_hdr *hdr = (void *)skb->data;
242 struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb);
243 u8 tid = skb->priority & IEEE80211_QOS_CTL_TAG1D_MASK;
244 u8 flags;
245 u8 *p;
246
247 if (!ieee80211_is_data_qos(hdr->frame_control))
248 return;
249
250 p = ieee80211_get_qos_ctl(hdr);
251
252
253 if (info->flags & IEEE80211_TX_CTL_INJECTED) {
254
255 if (*p & IEEE80211_QOS_CTL_ACK_POLICY_NOACK)
256 info->flags |= IEEE80211_TX_CTL_NO_ACK;
257 return;
258 }
259
260
261
262
263
264
265
266 flags = *p & ~(IEEE80211_QOS_CTL_TID_MASK |
267 IEEE80211_QOS_CTL_ACK_POLICY_MASK);
268
269 if (is_multicast_ether_addr(hdr->addr1) ||
270 sdata->noack_map & BIT(tid)) {
271 flags |= IEEE80211_QOS_CTL_ACK_POLICY_NOACK;
272 info->flags |= IEEE80211_TX_CTL_NO_ACK;
273 }
274
275 *p = flags | tid;
276
277
278 p++;
279
280 if (ieee80211_vif_is_mesh(&sdata->vif)) {
281
282 *p &= ((IEEE80211_QOS_CTL_RSPI |
283 IEEE80211_QOS_CTL_MESH_PS_LEVEL) >> 8);
284
285
286 if (!ieee80211_is_qos_nullfunc(hdr->frame_control))
287 *p |= (IEEE80211_QOS_CTL_MESH_CONTROL_PRESENT >> 8);
288 } else {
289 *p = 0;
290 }
291}
292