Commit | Line | Data |
---|---|---|
8ca151b5 JB |
1 | /****************************************************************************** |
2 | * | |
3 | * This file is provided under a dual BSD/GPLv2 license. When using or | |
4 | * redistributing this file, you may do so under either license. | |
5 | * | |
6 | * GPL LICENSE SUMMARY | |
7 | * | |
8 | * Copyright(c) 2012 - 2013 Intel Corporation. All rights reserved. | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or modify | |
11 | * it under the terms of version 2 of the GNU General Public License as | |
12 | * published by the Free Software Foundation. | |
13 | * | |
14 | * This program is distributed in the hope that it will be useful, but | |
15 | * WITHOUT ANY WARRANTY; without even the implied warranty of | |
16 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | |
17 | * General Public License for more details. | |
18 | * | |
19 | * You should have received a copy of the GNU General Public License | |
20 | * along with this program; if not, write to the Free Software | |
21 | * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110, | |
22 | * USA | |
23 | * | |
24 | * The full GNU General Public License is included in this distribution | |
410dc5aa | 25 | * in the file called COPYING. |
8ca151b5 JB |
26 | * |
27 | * Contact Information: | |
28 | * Intel Linux Wireless <ilw@linux.intel.com> | |
29 | * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497 | |
30 | * | |
31 | * BSD LICENSE | |
32 | * | |
33 | * Copyright(c) 2012 - 2013 Intel Corporation. All rights reserved. | |
34 | * All rights reserved. | |
35 | * | |
36 | * Redistribution and use in source and binary forms, with or without | |
37 | * modification, are permitted provided that the following conditions | |
38 | * are met: | |
39 | * | |
40 | * * Redistributions of source code must retain the above copyright | |
41 | * notice, this list of conditions and the following disclaimer. | |
42 | * * Redistributions in binary form must reproduce the above copyright | |
43 | * notice, this list of conditions and the following disclaimer in | |
44 | * the documentation and/or other materials provided with the | |
45 | * distribution. | |
46 | * * Neither the name Intel Corporation nor the names of its | |
47 | * contributors may be used to endorse or promote products derived | |
48 | * from this software without specific prior written permission. | |
49 | * | |
50 | * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS | |
51 | * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT | |
52 | * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR | |
53 | * A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT | |
54 | * OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, | |
55 | * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT | |
56 | * LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, | |
57 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY | |
58 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT | |
59 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE | |
60 | * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | |
61 | *****************************************************************************/ | |
62 | #include "iwl-trans.h" | |
63 | ||
64 | #include "mvm.h" | |
65 | #include "fw-api.h" | |
66 | ||
67 | /* | |
68 | * iwl_mvm_rx_rx_phy_cmd - REPLY_RX_PHY_CMD handler | |
69 | * | |
70 | * Copies the phy information in mvm->last_phy_info, it will be used when the | |
71 | * actual data will come from the fw in the next packet. | |
72 | */ | |
73 | int iwl_mvm_rx_rx_phy_cmd(struct iwl_mvm *mvm, struct iwl_rx_cmd_buffer *rxb, | |
74 | struct iwl_device_cmd *cmd) | |
75 | { | |
76 | struct iwl_rx_packet *pkt = rxb_addr(rxb); | |
77 | ||
78 | memcpy(&mvm->last_phy_info, pkt->data, sizeof(mvm->last_phy_info)); | |
79 | mvm->ampdu_ref++; | |
80 | return 0; | |
81 | } | |
82 | ||
83 | /* | |
84 | * iwl_mvm_pass_packet_to_mac80211 - builds the packet for mac80211 | |
85 | * | |
86 | * Adds the rxb to a new skb and give it to mac80211 | |
87 | */ | |
88 | static void iwl_mvm_pass_packet_to_mac80211(struct iwl_mvm *mvm, | |
89 | struct ieee80211_hdr *hdr, u16 len, | |
90 | u32 ampdu_status, | |
91 | struct iwl_rx_cmd_buffer *rxb, | |
92 | struct ieee80211_rx_status *stats) | |
93 | { | |
94 | struct sk_buff *skb; | |
95 | unsigned int hdrlen, fraglen; | |
96 | ||
97 | /* Dont use dev_alloc_skb(), we'll have enough headroom once | |
98 | * ieee80211_hdr pulled. | |
99 | */ | |
100 | skb = alloc_skb(128, GFP_ATOMIC); | |
101 | if (!skb) { | |
102 | IWL_ERR(mvm, "alloc_skb failed\n"); | |
103 | return; | |
104 | } | |
105 | /* If frame is small enough to fit in skb->head, pull it completely. | |
106 | * If not, only pull ieee80211_hdr so that splice() or TCP coalesce | |
107 | * are more efficient. | |
108 | */ | |
109 | hdrlen = (len <= skb_tailroom(skb)) ? len : sizeof(*hdr); | |
110 | ||
111 | memcpy(skb_put(skb, hdrlen), hdr, hdrlen); | |
112 | fraglen = len - hdrlen; | |
113 | ||
114 | if (fraglen) { | |
115 | int offset = (void *)hdr + hdrlen - | |
116 | rxb_addr(rxb) + rxb_offset(rxb); | |
117 | ||
118 | skb_add_rx_frag(skb, 0, rxb_steal_page(rxb), offset, | |
119 | fraglen, rxb->truesize); | |
120 | } | |
121 | ||
122 | memcpy(IEEE80211_SKB_RXCB(skb), stats, sizeof(*stats)); | |
123 | ||
2bfb5092 | 124 | ieee80211_rx_ni(mvm->hw, skb); |
8ca151b5 JB |
125 | } |
126 | ||
127 | /* | |
128 | * iwl_mvm_calc_rssi - calculate the rssi in dBm | |
129 | * @phy_info: the phy information for the coming packet | |
130 | */ | |
131 | static int iwl_mvm_calc_rssi(struct iwl_mvm *mvm, | |
132 | struct iwl_rx_phy_info *phy_info) | |
133 | { | |
8101a7f0 EG |
134 | int rssi_a, rssi_b, rssi_a_dbm, rssi_b_dbm, max_rssi_dbm; |
135 | int rssi_all_band_a, rssi_all_band_b; | |
136 | u32 agc_a, agc_b, max_agc; | |
8ca151b5 JB |
137 | u32 val; |
138 | ||
8101a7f0 | 139 | /* Find max rssi among 2 possible receivers. |
8ca151b5 JB |
140 | * These values are measured by the Digital Signal Processor (DSP). |
141 | * They should stay fairly constant even as the signal strength varies, | |
142 | * if the radio's Automatic Gain Control (AGC) is working right. | |
143 | * AGC value (see below) will provide the "interesting" info. | |
144 | */ | |
8101a7f0 EG |
145 | val = le32_to_cpu(phy_info->non_cfg_phy[IWL_RX_INFO_AGC_IDX]); |
146 | agc_a = (val & IWL_OFDM_AGC_A_MSK) >> IWL_OFDM_AGC_A_POS; | |
147 | agc_b = (val & IWL_OFDM_AGC_B_MSK) >> IWL_OFDM_AGC_B_POS; | |
148 | max_agc = max_t(u32, agc_a, agc_b); | |
149 | ||
8ca151b5 JB |
150 | val = le32_to_cpu(phy_info->non_cfg_phy[IWL_RX_INFO_RSSI_AB_IDX]); |
151 | rssi_a = (val & IWL_OFDM_RSSI_INBAND_A_MSK) >> IWL_OFDM_RSSI_A_POS; | |
152 | rssi_b = (val & IWL_OFDM_RSSI_INBAND_B_MSK) >> IWL_OFDM_RSSI_B_POS; | |
8101a7f0 EG |
153 | rssi_all_band_a = (val & IWL_OFDM_RSSI_ALLBAND_A_MSK) >> |
154 | IWL_OFDM_RSSI_ALLBAND_A_POS; | |
155 | rssi_all_band_b = (val & IWL_OFDM_RSSI_ALLBAND_B_MSK) >> | |
156 | IWL_OFDM_RSSI_ALLBAND_B_POS; | |
157 | ||
158 | /* | |
159 | * dBm = rssi dB - agc dB - constant. | |
160 | * Higher AGC (higher radio gain) means lower signal. | |
161 | */ | |
162 | rssi_a_dbm = rssi_a - IWL_RSSI_OFFSET - agc_a; | |
163 | rssi_b_dbm = rssi_b - IWL_RSSI_OFFSET - agc_b; | |
164 | max_rssi_dbm = max_t(int, rssi_a_dbm, rssi_b_dbm); | |
8ca151b5 | 165 | |
8101a7f0 EG |
166 | IWL_DEBUG_STATS(mvm, "Rssi In A %d B %d Max %d AGCA %d AGCB %d\n", |
167 | rssi_a_dbm, rssi_b_dbm, max_rssi_dbm, agc_a, agc_b); | |
8ca151b5 | 168 | |
8101a7f0 | 169 | return max_rssi_dbm; |
8ca151b5 JB |
170 | } |
171 | ||
172 | /* | |
173 | * iwl_mvm_set_mac80211_rx_flag - translate fw status to mac80211 format | |
174 | * @mvm: the mvm object | |
175 | * @hdr: 80211 header | |
176 | * @stats: status in mac80211's format | |
177 | * @rx_pkt_status: status coming from fw | |
178 | * | |
179 | * returns non 0 value if the packet should be dropped | |
180 | */ | |
181 | static u32 iwl_mvm_set_mac80211_rx_flag(struct iwl_mvm *mvm, | |
182 | struct ieee80211_hdr *hdr, | |
183 | struct ieee80211_rx_status *stats, | |
184 | u32 rx_pkt_status) | |
185 | { | |
186 | if (!ieee80211_has_protected(hdr->frame_control) || | |
187 | (rx_pkt_status & RX_MPDU_RES_STATUS_SEC_ENC_MSK) == | |
188 | RX_MPDU_RES_STATUS_SEC_NO_ENC) | |
189 | return 0; | |
190 | ||
191 | /* packet was encrypted with unknown alg */ | |
192 | if ((rx_pkt_status & RX_MPDU_RES_STATUS_SEC_ENC_MSK) == | |
193 | RX_MPDU_RES_STATUS_SEC_ENC_ERR) | |
194 | return 0; | |
195 | ||
196 | switch (rx_pkt_status & RX_MPDU_RES_STATUS_SEC_ENC_MSK) { | |
197 | case RX_MPDU_RES_STATUS_SEC_CCM_ENC: | |
198 | /* alg is CCM: check MIC only */ | |
199 | if (!(rx_pkt_status & RX_MPDU_RES_STATUS_MIC_OK)) | |
200 | return -1; | |
201 | ||
202 | stats->flag |= RX_FLAG_DECRYPTED; | |
203 | IWL_DEBUG_WEP(mvm, "hw decrypted CCMP successfully\n"); | |
204 | return 0; | |
205 | ||
206 | case RX_MPDU_RES_STATUS_SEC_TKIP_ENC: | |
207 | /* Don't drop the frame and decrypt it in SW */ | |
208 | if (!(rx_pkt_status & RX_MPDU_RES_STATUS_TTAK_OK)) | |
209 | return 0; | |
210 | /* fall through if TTAK OK */ | |
211 | ||
212 | case RX_MPDU_RES_STATUS_SEC_WEP_ENC: | |
213 | if (!(rx_pkt_status & RX_MPDU_RES_STATUS_ICV_OK)) | |
214 | return -1; | |
215 | ||
216 | stats->flag |= RX_FLAG_DECRYPTED; | |
217 | return 0; | |
218 | ||
219 | default: | |
220 | IWL_ERR(mvm, "Unhandled alg: 0x%x\n", rx_pkt_status); | |
221 | } | |
222 | ||
223 | return 0; | |
224 | } | |
225 | ||
226 | /* | |
227 | * iwl_mvm_rx_rx_mpdu - REPLY_RX_MPDU_CMD handler | |
228 | * | |
229 | * Handles the actual data of the Rx packet from the fw | |
230 | */ | |
231 | int iwl_mvm_rx_rx_mpdu(struct iwl_mvm *mvm, struct iwl_rx_cmd_buffer *rxb, | |
232 | struct iwl_device_cmd *cmd) | |
233 | { | |
234 | struct ieee80211_hdr *hdr; | |
235 | struct ieee80211_rx_status rx_status = {}; | |
236 | struct iwl_rx_packet *pkt = rxb_addr(rxb); | |
237 | struct iwl_rx_phy_info *phy_info; | |
238 | struct iwl_rx_mpdu_res_start *rx_res; | |
239 | u32 len; | |
240 | u32 ampdu_status; | |
241 | u32 rate_n_flags; | |
242 | u32 rx_pkt_status; | |
243 | ||
244 | phy_info = &mvm->last_phy_info; | |
245 | rx_res = (struct iwl_rx_mpdu_res_start *)pkt->data; | |
246 | hdr = (struct ieee80211_hdr *)(pkt->data + sizeof(*rx_res)); | |
247 | len = le16_to_cpu(rx_res->byte_count); | |
248 | rx_pkt_status = le32_to_cpup((__le32 *) | |
249 | (pkt->data + sizeof(*rx_res) + len)); | |
250 | ||
251 | memset(&rx_status, 0, sizeof(rx_status)); | |
252 | ||
253 | /* | |
254 | * drop the packet if it has failed being decrypted by HW | |
255 | */ | |
256 | if (iwl_mvm_set_mac80211_rx_flag(mvm, hdr, &rx_status, rx_pkt_status)) { | |
257 | IWL_DEBUG_DROP(mvm, "Bad decryption results 0x%08x\n", | |
258 | rx_pkt_status); | |
259 | return 0; | |
260 | } | |
261 | ||
262 | if ((unlikely(phy_info->cfg_phy_cnt > 20))) { | |
263 | IWL_DEBUG_DROP(mvm, "dsp size out of range [0,20]: %d\n", | |
264 | phy_info->cfg_phy_cnt); | |
265 | return 0; | |
266 | } | |
267 | ||
268 | if (!(rx_pkt_status & RX_MPDU_RES_STATUS_CRC_OK) || | |
269 | !(rx_pkt_status & RX_MPDU_RES_STATUS_OVERRUN_OK)) { | |
270 | IWL_DEBUG_RX(mvm, "Bad CRC or FIFO: 0x%08X.\n", rx_pkt_status); | |
271 | return 0; | |
272 | } | |
273 | ||
274 | /* This will be used in several places later */ | |
275 | rate_n_flags = le32_to_cpu(phy_info->rate_n_flags); | |
276 | ||
277 | /* rx_status carries information about the packet to mac80211 */ | |
278 | rx_status.mactime = le64_to_cpu(phy_info->timestamp); | |
d2931bbd | 279 | rx_status.device_timestamp = le32_to_cpu(phy_info->system_timestamp); |
8ca151b5 JB |
280 | rx_status.band = |
281 | (phy_info->phy_flags & cpu_to_le16(RX_RES_PHY_FLAGS_BAND_24)) ? | |
282 | IEEE80211_BAND_2GHZ : IEEE80211_BAND_5GHZ; | |
283 | rx_status.freq = | |
284 | ieee80211_channel_to_frequency(le16_to_cpu(phy_info->channel), | |
285 | rx_status.band); | |
286 | /* | |
287 | * TSF as indicated by the fw is at INA time, but mac80211 expects the | |
288 | * TSF at the beginning of the MPDU. | |
289 | */ | |
290 | /*rx_status.flag |= RX_FLAG_MACTIME_MPDU;*/ | |
291 | ||
292 | /* Find max signal strength (dBm) among 3 antenna/receiver chains */ | |
293 | rx_status.signal = iwl_mvm_calc_rssi(mvm, phy_info); | |
294 | ||
295 | IWL_DEBUG_STATS_LIMIT(mvm, "Rssi %d, TSF %llu\n", rx_status.signal, | |
296 | (unsigned long long)rx_status.mactime); | |
297 | ||
298 | /* | |
299 | * "antenna number" | |
300 | * | |
301 | * It seems that the antenna field in the phy flags value | |
302 | * is actually a bit field. This is undefined by radiotap, | |
303 | * it wants an actual antenna number but I always get "7" | |
304 | * for most legacy frames I receive indicating that the | |
305 | * same frame was received on all three RX chains. | |
306 | * | |
307 | * I think this field should be removed in favor of a | |
308 | * new 802.11n radiotap field "RX chains" that is defined | |
309 | * as a bitmask. | |
310 | */ | |
311 | rx_status.antenna = (le16_to_cpu(phy_info->phy_flags) & | |
312 | RX_RES_PHY_FLAGS_ANTENNA) | |
313 | >> RX_RES_PHY_FLAGS_ANTENNA_POS; | |
314 | ||
315 | /* set the preamble flag if appropriate */ | |
316 | if (phy_info->phy_flags & cpu_to_le16(RX_RES_PHY_FLAGS_SHORT_PREAMBLE)) | |
317 | rx_status.flag |= RX_FLAG_SHORTPRE; | |
318 | ||
319 | if (phy_info->phy_flags & cpu_to_le16(RX_RES_PHY_FLAGS_AGG)) { | |
320 | /* | |
321 | * We know which subframes of an A-MPDU belong | |
322 | * together since we get a single PHY response | |
323 | * from the firmware for all of them | |
324 | */ | |
325 | rx_status.flag |= RX_FLAG_AMPDU_DETAILS; | |
326 | rx_status.ampdu_reference = mvm->ampdu_ref; | |
327 | } | |
328 | ||
329 | /* Set up the HT phy flags */ | |
330 | switch (rate_n_flags & RATE_MCS_CHAN_WIDTH_MSK) { | |
331 | case RATE_MCS_CHAN_WIDTH_20: | |
332 | break; | |
333 | case RATE_MCS_CHAN_WIDTH_40: | |
334 | rx_status.flag |= RX_FLAG_40MHZ; | |
335 | break; | |
336 | case RATE_MCS_CHAN_WIDTH_80: | |
337 | rx_status.flag |= RX_FLAG_80MHZ; | |
338 | break; | |
339 | case RATE_MCS_CHAN_WIDTH_160: | |
340 | rx_status.flag |= RX_FLAG_160MHZ; | |
341 | break; | |
342 | } | |
343 | if (rate_n_flags & RATE_MCS_SGI_MSK) | |
344 | rx_status.flag |= RX_FLAG_SHORT_GI; | |
345 | if (rate_n_flags & RATE_HT_MCS_GF_MSK) | |
346 | rx_status.flag |= RX_FLAG_HT_GF; | |
347 | if (rate_n_flags & RATE_MCS_HT_MSK) { | |
348 | rx_status.flag |= RX_FLAG_HT; | |
349 | rx_status.rate_idx = rate_n_flags & RATE_HT_MCS_INDEX_MSK; | |
350 | } else if (rate_n_flags & RATE_MCS_VHT_MSK) { | |
351 | rx_status.vht_nss = | |
352 | ((rate_n_flags & RATE_VHT_MCS_NSS_MSK) >> | |
353 | RATE_VHT_MCS_NSS_POS) + 1; | |
354 | rx_status.rate_idx = rate_n_flags & RATE_VHT_MCS_RATE_CODE_MSK; | |
355 | rx_status.flag |= RX_FLAG_VHT; | |
356 | } else { | |
357 | rx_status.rate_idx = | |
358 | iwl_mvm_legacy_rate_to_mac80211_idx(rate_n_flags, | |
359 | rx_status.band); | |
360 | } | |
361 | ||
362 | iwl_mvm_pass_packet_to_mac80211(mvm, hdr, len, ampdu_status, | |
363 | rxb, &rx_status); | |
364 | return 0; | |
365 | } |