Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 1 | /* |
| 2 | * Copyright 2004, Instant802 Networks, Inc. |
Johannes Berg | d98ad83 | 2014-09-03 15:24:57 +0300 | [diff] [blame] | 3 | * Copyright 2013-2014 Intel Mobile Communications GmbH |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 4 | * |
| 5 | * This program is free software; you can redistribute it and/or modify |
| 6 | * it under the terms of the GNU General Public License version 2 as |
| 7 | * published by the Free Software Foundation. |
| 8 | */ |
| 9 | |
| 10 | #include <linux/netdevice.h> |
| 11 | #include <linux/skbuff.h> |
| 12 | #include <linux/module.h> |
| 13 | #include <linux/if_arp.h> |
| 14 | #include <linux/types.h> |
| 15 | #include <net/ip.h> |
| 16 | #include <net/pkt_sched.h> |
| 17 | |
| 18 | #include <net/mac80211.h> |
| 19 | #include "ieee80211_i.h" |
| 20 | #include "wme.h" |
| 21 | |
David S. Miller | 51cb6db | 2008-07-15 03:34:57 -0700 | [diff] [blame] | 22 | /* Default mapping in classifier to work with default |
Johannes Berg | e100bb6 | 2008-04-30 18:51:21 +0200 | [diff] [blame] | 23 | * queue setup. |
| 24 | */ |
Johannes Berg | 4bce22b | 2010-11-16 11:49:58 -0800 | [diff] [blame] | 25 | const int ieee802_1d_to_ac[8] = { |
| 26 | IEEE80211_AC_BE, |
| 27 | IEEE80211_AC_BK, |
| 28 | IEEE80211_AC_BK, |
| 29 | IEEE80211_AC_BE, |
| 30 | IEEE80211_AC_VI, |
| 31 | IEEE80211_AC_VI, |
| 32 | IEEE80211_AC_VO, |
| 33 | IEEE80211_AC_VO |
| 34 | }; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 35 | |
David S. Miller | 51cb6db | 2008-07-15 03:34:57 -0700 | [diff] [blame] | 36 | static int wme_downgrade_ac(struct sk_buff *skb) |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 37 | { |
| 38 | switch (skb->priority) { |
| 39 | case 6: |
| 40 | case 7: |
| 41 | skb->priority = 5; /* VO -> VI */ |
| 42 | return 0; |
| 43 | case 4: |
| 44 | case 5: |
| 45 | skb->priority = 3; /* VI -> BE */ |
| 46 | return 0; |
| 47 | case 0: |
| 48 | case 3: |
| 49 | skb->priority = 2; /* BE -> BK */ |
| 50 | return 0; |
| 51 | default: |
| 52 | return -1; |
| 53 | } |
| 54 | } |
| 55 | |
Yoni Divinsky | 00e96de | 2012-06-20 15:39:13 +0300 | [diff] [blame] | 56 | static u16 ieee80211_downgrade_queue(struct ieee80211_sub_if_data *sdata, |
Johannes Berg | 4670cf7 | 2012-03-27 14:18:38 +0200 | [diff] [blame] | 57 | struct sk_buff *skb) |
| 58 | { |
| 59 | /* in case we are a client verify acm is not set for this ac */ |
Yoni Divinsky | 00e96de | 2012-06-20 15:39:13 +0300 | [diff] [blame] | 60 | while (unlikely(sdata->wmm_acm & BIT(skb->priority))) { |
Johannes Berg | 4670cf7 | 2012-03-27 14:18:38 +0200 | [diff] [blame] | 61 | if (wme_downgrade_ac(skb)) { |
| 62 | /* |
| 63 | * This should not really happen. The AP has marked all |
| 64 | * lower ACs to require admission control which is not |
| 65 | * a reasonable configuration. Allow the frame to be |
| 66 | * transmitted using AC_BK as a workaround. |
| 67 | */ |
| 68 | break; |
| 69 | } |
| 70 | } |
| 71 | |
| 72 | /* look up which queue to use for frames with this 1d tag */ |
| 73 | return ieee802_1d_to_ac[skb->priority]; |
| 74 | } |
| 75 | |
Thomas Pedersen | d3c1597 | 2011-11-24 17:15:23 -0800 | [diff] [blame] | 76 | /* Indicate which queue to use for this fully formed 802.11 frame */ |
Yoni Divinsky | 00e96de | 2012-06-20 15:39:13 +0300 | [diff] [blame] | 77 | u16 ieee80211_select_queue_80211(struct ieee80211_sub_if_data *sdata, |
Thomas Pedersen | d3c1597 | 2011-11-24 17:15:23 -0800 | [diff] [blame] | 78 | struct sk_buff *skb, |
| 79 | struct ieee80211_hdr *hdr) |
| 80 | { |
Yoni Divinsky | 00e96de | 2012-06-20 15:39:13 +0300 | [diff] [blame] | 81 | struct ieee80211_local *local = sdata->local; |
Thomas Pedersen | d3c1597 | 2011-11-24 17:15:23 -0800 | [diff] [blame] | 82 | u8 *p; |
| 83 | |
Johannes Berg | 32c5057 | 2012-03-28 11:04:29 +0200 | [diff] [blame] | 84 | if (local->hw.queues < IEEE80211_NUM_ACS) |
Thomas Pedersen | d3c1597 | 2011-11-24 17:15:23 -0800 | [diff] [blame] | 85 | return 0; |
| 86 | |
| 87 | if (!ieee80211_is_data(hdr->frame_control)) { |
| 88 | skb->priority = 7; |
| 89 | return ieee802_1d_to_ac[skb->priority]; |
| 90 | } |
| 91 | if (!ieee80211_is_data_qos(hdr->frame_control)) { |
| 92 | skb->priority = 0; |
| 93 | return ieee802_1d_to_ac[skb->priority]; |
| 94 | } |
| 95 | |
| 96 | p = ieee80211_get_qos_ctl(hdr); |
| 97 | skb->priority = *p & IEEE80211_QOS_CTL_TAG1D_MASK; |
| 98 | |
Yoni Divinsky | 00e96de | 2012-06-20 15:39:13 +0300 | [diff] [blame] | 99 | return ieee80211_downgrade_queue(sdata, skb); |
Thomas Pedersen | d3c1597 | 2011-11-24 17:15:23 -0800 | [diff] [blame] | 100 | } |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 101 | |
Johannes Berg | cf0277e | 2010-01-05 18:00:58 +0100 | [diff] [blame] | 102 | /* Indicate which queue to use. */ |
| 103 | u16 ieee80211_select_queue(struct ieee80211_sub_if_data *sdata, |
| 104 | struct sk_buff *skb) |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 105 | { |
Johannes Berg | cf0277e | 2010-01-05 18:00:58 +0100 | [diff] [blame] | 106 | struct ieee80211_local *local = sdata->local; |
| 107 | struct sta_info *sta = NULL; |
Johannes Berg | cf0277e | 2010-01-05 18:00:58 +0100 | [diff] [blame] | 108 | const u8 *ra = NULL; |
| 109 | bool qos = false; |
Kyeyoon Park | 32db6b5 | 2013-12-16 23:04:43 -0800 | [diff] [blame] | 110 | struct mac80211_qos_map *qos_map; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 111 | |
Johannes Berg | 32c5057 | 2012-03-28 11:04:29 +0200 | [diff] [blame] | 112 | if (local->hw.queues < IEEE80211_NUM_ACS || skb->len < 6) { |
Johannes Berg | cf0277e | 2010-01-05 18:00:58 +0100 | [diff] [blame] | 113 | skb->priority = 0; /* required for correct WPA/11i MIC */ |
Johannes Berg | ded81f6 | 2012-03-28 11:04:26 +0200 | [diff] [blame] | 114 | return 0; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 115 | } |
| 116 | |
Johannes Berg | cf0277e | 2010-01-05 18:00:58 +0100 | [diff] [blame] | 117 | rcu_read_lock(); |
| 118 | switch (sdata->vif.type) { |
| 119 | case NL80211_IFTYPE_AP_VLAN: |
Johannes Berg | cf0277e | 2010-01-05 18:00:58 +0100 | [diff] [blame] | 120 | sta = rcu_dereference(sdata->u.vlan.sta); |
Johannes Berg | 1721284 | 2010-12-22 10:15:30 +0100 | [diff] [blame] | 121 | if (sta) { |
Johannes Berg | a74a8c8 | 2014-07-22 14:50:47 +0200 | [diff] [blame] | 122 | qos = sta->sta.wme; |
Johannes Berg | cf0277e | 2010-01-05 18:00:58 +0100 | [diff] [blame] | 123 | break; |
Johannes Berg | 1721284 | 2010-12-22 10:15:30 +0100 | [diff] [blame] | 124 | } |
Johannes Berg | cf0277e | 2010-01-05 18:00:58 +0100 | [diff] [blame] | 125 | case NL80211_IFTYPE_AP: |
| 126 | ra = skb->data; |
| 127 | break; |
| 128 | case NL80211_IFTYPE_WDS: |
| 129 | ra = sdata->u.wds.remote_addr; |
| 130 | break; |
| 131 | #ifdef CONFIG_MAC80211_MESH |
| 132 | case NL80211_IFTYPE_MESH_POINT: |
Javier Cardona | d0ce185 | 2011-11-03 21:11:13 -0700 | [diff] [blame] | 133 | qos = true; |
Johannes Berg | cf0277e | 2010-01-05 18:00:58 +0100 | [diff] [blame] | 134 | break; |
| 135 | #endif |
| 136 | case NL80211_IFTYPE_STATION: |
| 137 | ra = sdata->u.mgd.bssid; |
| 138 | break; |
| 139 | case NL80211_IFTYPE_ADHOC: |
| 140 | ra = skb->data; |
| 141 | break; |
| 142 | default: |
| 143 | break; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 144 | } |
| 145 | |
Johannes Berg | cf0277e | 2010-01-05 18:00:58 +0100 | [diff] [blame] | 146 | if (!sta && ra && !is_multicast_ether_addr(ra)) { |
| 147 | sta = sta_info_get(sdata, ra); |
| 148 | if (sta) |
Johannes Berg | a74a8c8 | 2014-07-22 14:50:47 +0200 | [diff] [blame] | 149 | qos = sta->sta.wme; |
Johannes Berg | cf0277e | 2010-01-05 18:00:58 +0100 | [diff] [blame] | 150 | } |
Johannes Berg | cf0277e | 2010-01-05 18:00:58 +0100 | [diff] [blame] | 151 | rcu_read_unlock(); |
| 152 | |
| 153 | if (!qos) { |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 154 | skb->priority = 0; /* required for correct WPA/11i MIC */ |
Johannes Berg | 1721284 | 2010-12-22 10:15:30 +0100 | [diff] [blame] | 155 | return IEEE80211_AC_BE; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 156 | } |
| 157 | |
Felix Fietkau | 1bf4bbb | 2014-02-11 16:02:47 +0100 | [diff] [blame] | 158 | if (skb->protocol == sdata->control_port_protocol) { |
| 159 | skb->priority = 7; |
| 160 | return ieee80211_downgrade_queue(sdata, skb); |
| 161 | } |
| 162 | |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 163 | /* use the data classifier to determine what 802.1d tag the |
Johannes Berg | 3c3b00c | 2007-08-28 17:01:55 -0400 | [diff] [blame] | 164 | * data frame has */ |
Kyeyoon Park | 32db6b5 | 2013-12-16 23:04:43 -0800 | [diff] [blame] | 165 | rcu_read_lock(); |
| 166 | qos_map = rcu_dereference(sdata->qos_map); |
| 167 | skb->priority = cfg80211_classify8021d(skb, qos_map ? |
| 168 | &qos_map->qos_map : NULL); |
| 169 | rcu_read_unlock(); |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 170 | |
Yoni Divinsky | 00e96de | 2012-06-20 15:39:13 +0300 | [diff] [blame] | 171 | return ieee80211_downgrade_queue(sdata, skb); |
Johannes Berg | cf0277e | 2010-01-05 18:00:58 +0100 | [diff] [blame] | 172 | } |
| 173 | |
Marco Porsch | 40aefed | 2012-11-21 18:40:31 -0800 | [diff] [blame] | 174 | /** |
| 175 | * ieee80211_set_qos_hdr - Fill in the QoS header if there is one. |
| 176 | * |
| 177 | * @sdata: local subif |
| 178 | * @skb: packet to be updated |
| 179 | */ |
Javier Cardona | 2154c81 | 2011-09-07 17:49:53 -0700 | [diff] [blame] | 180 | void ieee80211_set_qos_hdr(struct ieee80211_sub_if_data *sdata, |
| 181 | struct sk_buff *skb) |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 182 | { |
Johannes Berg | cf0277e | 2010-01-05 18:00:58 +0100 | [diff] [blame] | 183 | struct ieee80211_hdr *hdr = (void *)skb->data; |
Simon Wunderlich | b53be79 | 2011-11-18 14:20:44 +0100 | [diff] [blame] | 184 | struct ieee80211_tx_info *info = IEEE80211_SKB_CB(skb); |
Marco Porsch | 40aefed | 2012-11-21 18:40:31 -0800 | [diff] [blame] | 185 | u8 *p; |
| 186 | u8 ack_policy, tid; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 187 | |
Marco Porsch | 40aefed | 2012-11-21 18:40:31 -0800 | [diff] [blame] | 188 | if (!ieee80211_is_data_qos(hdr->frame_control)) |
| 189 | return; |
Johannes Berg | cf0277e | 2010-01-05 18:00:58 +0100 | [diff] [blame] | 190 | |
Marco Porsch | 40aefed | 2012-11-21 18:40:31 -0800 | [diff] [blame] | 191 | p = ieee80211_get_qos_ctl(hdr); |
| 192 | tid = skb->priority & IEEE80211_QOS_CTL_TAG1D_MASK; |
Johannes Berg | cf0277e | 2010-01-05 18:00:58 +0100 | [diff] [blame] | 193 | |
Marco Porsch | 40aefed | 2012-11-21 18:40:31 -0800 | [diff] [blame] | 194 | /* preserve EOSP bit */ |
| 195 | ack_policy = *p & IEEE80211_QOS_CTL_EOSP; |
Johannes Berg | 68629c61 | 2011-11-03 09:59:39 +0100 | [diff] [blame] | 196 | |
Marco Porsch | 40aefed | 2012-11-21 18:40:31 -0800 | [diff] [blame] | 197 | if (is_multicast_ether_addr(hdr->addr1) || |
| 198 | sdata->noack_map & BIT(tid)) { |
| 199 | ack_policy |= IEEE80211_QOS_CTL_ACK_POLICY_NOACK; |
| 200 | info->flags |= IEEE80211_TX_CTL_NO_ACK; |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 201 | } |
Marco Porsch | 40aefed | 2012-11-21 18:40:31 -0800 | [diff] [blame] | 202 | |
| 203 | /* qos header is 2 bytes */ |
| 204 | *p++ = ack_policy | tid; |
Marco Porsch | 3f52b7e | 2013-01-30 18:14:08 +0100 | [diff] [blame] | 205 | if (ieee80211_vif_is_mesh(&sdata->vif)) { |
| 206 | /* preserve RSPI and Mesh PS Level bit */ |
| 207 | *p &= ((IEEE80211_QOS_CTL_RSPI | |
| 208 | IEEE80211_QOS_CTL_MESH_PS_LEVEL) >> 8); |
| 209 | |
| 210 | /* Nulls don't have a mesh header (frame body) */ |
| 211 | if (!ieee80211_is_qos_nullfunc(hdr->frame_control)) |
| 212 | *p |= (IEEE80211_QOS_CTL_MESH_CONTROL_PRESENT >> 8); |
| 213 | } else { |
| 214 | *p = 0; |
| 215 | } |
Jiri Benc | f0706e8 | 2007-05-05 11:45:53 -0700 | [diff] [blame] | 216 | } |