Merge branch 'next' of git://git.kernel.org/pub/scm/linux/kernel/git/benh/powerpc
[firefly-linux-kernel-4.4.55.git] / drivers / net / wireless / iwlwifi / mvm / rx.c
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 - 2014 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
25  * in the file called COPYING.
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 - 2014 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 #include "mvm.h"
64 #include "fw-api.h"
65
66 /*
67  * iwl_mvm_rx_rx_phy_cmd - REPLY_RX_PHY_CMD handler
68  *
69  * Copies the phy information in mvm->last_phy_info, it will be used when the
70  * actual data will come from the fw in the next packet.
71  */
72 int iwl_mvm_rx_rx_phy_cmd(struct iwl_mvm *mvm, struct iwl_rx_cmd_buffer *rxb,
73                           struct iwl_device_cmd *cmd)
74 {
75         struct iwl_rx_packet *pkt = rxb_addr(rxb);
76
77         memcpy(&mvm->last_phy_info, pkt->data, sizeof(mvm->last_phy_info));
78         mvm->ampdu_ref++;
79
80 #ifdef CONFIG_IWLWIFI_DEBUGFS
81         if (mvm->last_phy_info.phy_flags & cpu_to_le16(RX_RES_PHY_FLAGS_AGG)) {
82                 spin_lock(&mvm->drv_stats_lock);
83                 mvm->drv_rx_stats.ampdu_count++;
84                 spin_unlock(&mvm->drv_stats_lock);
85         }
86 #endif
87
88         return 0;
89 }
90
91 /*
92  * iwl_mvm_pass_packet_to_mac80211 - builds the packet for mac80211
93  *
94  * Adds the rxb to a new skb and give it to mac80211
95  */
96 static void iwl_mvm_pass_packet_to_mac80211(struct iwl_mvm *mvm,
97                                             struct ieee80211_hdr *hdr, u16 len,
98                                             u32 ampdu_status,
99                                             struct iwl_rx_cmd_buffer *rxb,
100                                             struct ieee80211_rx_status *stats)
101 {
102         struct sk_buff *skb;
103         unsigned int hdrlen, fraglen;
104
105         /* Dont use dev_alloc_skb(), we'll have enough headroom once
106          * ieee80211_hdr pulled.
107          */
108         skb = alloc_skb(128, GFP_ATOMIC);
109         if (!skb) {
110                 IWL_ERR(mvm, "alloc_skb failed\n");
111                 return;
112         }
113         /* If frame is small enough to fit in skb->head, pull it completely.
114          * If not, only pull ieee80211_hdr so that splice() or TCP coalesce
115          * are more efficient.
116          */
117         hdrlen = (len <= skb_tailroom(skb)) ? len : sizeof(*hdr);
118
119         memcpy(skb_put(skb, hdrlen), hdr, hdrlen);
120         fraglen = len - hdrlen;
121
122         if (fraglen) {
123                 int offset = (void *)hdr + hdrlen -
124                              rxb_addr(rxb) + rxb_offset(rxb);
125
126                 skb_add_rx_frag(skb, 0, rxb_steal_page(rxb), offset,
127                                 fraglen, rxb->truesize);
128         }
129
130         memcpy(IEEE80211_SKB_RXCB(skb), stats, sizeof(*stats));
131
132         ieee80211_rx(mvm->hw, skb);
133 }
134
135 /*
136  * iwl_mvm_get_signal_strength - use new rx PHY INFO API
137  * values are reported by the fw as positive values - need to negate
138  * to obtain their dBM.  Account for missing antennas by replacing 0
139  * values by -256dBm: practically 0 power and a non-feasible 8 bit value.
140  */
141 static void iwl_mvm_get_signal_strength(struct iwl_mvm *mvm,
142                                         struct iwl_rx_phy_info *phy_info,
143                                         struct ieee80211_rx_status *rx_status)
144 {
145         int energy_a, energy_b, energy_c, max_energy;
146         u32 val;
147
148         val =
149             le32_to_cpu(phy_info->non_cfg_phy[IWL_RX_INFO_ENERGY_ANT_ABC_IDX]);
150         energy_a = (val & IWL_RX_INFO_ENERGY_ANT_A_MSK) >>
151                                                 IWL_RX_INFO_ENERGY_ANT_A_POS;
152         energy_a = energy_a ? -energy_a : -256;
153         energy_b = (val & IWL_RX_INFO_ENERGY_ANT_B_MSK) >>
154                                                 IWL_RX_INFO_ENERGY_ANT_B_POS;
155         energy_b = energy_b ? -energy_b : -256;
156         energy_c = (val & IWL_RX_INFO_ENERGY_ANT_C_MSK) >>
157                                                 IWL_RX_INFO_ENERGY_ANT_C_POS;
158         energy_c = energy_c ? -energy_c : -256;
159         max_energy = max(energy_a, energy_b);
160         max_energy = max(max_energy, energy_c);
161
162         IWL_DEBUG_STATS(mvm, "energy In A %d B %d C %d , and max %d\n",
163                         energy_a, energy_b, energy_c, max_energy);
164
165         rx_status->signal = max_energy;
166         rx_status->chains = (le16_to_cpu(phy_info->phy_flags) &
167                                 RX_RES_PHY_FLAGS_ANTENNA)
168                                         >> RX_RES_PHY_FLAGS_ANTENNA_POS;
169         rx_status->chain_signal[0] = energy_a;
170         rx_status->chain_signal[1] = energy_b;
171         rx_status->chain_signal[2] = energy_c;
172 }
173
174 /*
175  * iwl_mvm_set_mac80211_rx_flag - translate fw status to mac80211 format
176  * @mvm: the mvm object
177  * @hdr: 80211 header
178  * @stats: status in mac80211's format
179  * @rx_pkt_status: status coming from fw
180  *
181  * returns non 0 value if the packet should be dropped
182  */
183 static u32 iwl_mvm_set_mac80211_rx_flag(struct iwl_mvm *mvm,
184                                         struct ieee80211_hdr *hdr,
185                                         struct ieee80211_rx_status *stats,
186                                         u32 rx_pkt_status)
187 {
188         if (!ieee80211_has_protected(hdr->frame_control) ||
189             (rx_pkt_status & RX_MPDU_RES_STATUS_SEC_ENC_MSK) ==
190                              RX_MPDU_RES_STATUS_SEC_NO_ENC)
191                 return 0;
192
193         /* packet was encrypted with unknown alg */
194         if ((rx_pkt_status & RX_MPDU_RES_STATUS_SEC_ENC_MSK) ==
195                                         RX_MPDU_RES_STATUS_SEC_ENC_ERR)
196                 return 0;
197
198         switch (rx_pkt_status & RX_MPDU_RES_STATUS_SEC_ENC_MSK) {
199         case RX_MPDU_RES_STATUS_SEC_CCM_ENC:
200                 /* alg is CCM: check MIC only */
201                 if (!(rx_pkt_status & RX_MPDU_RES_STATUS_MIC_OK))
202                         return -1;
203
204                 stats->flag |= RX_FLAG_DECRYPTED;
205                 IWL_DEBUG_WEP(mvm, "hw decrypted CCMP successfully\n");
206                 return 0;
207
208         case RX_MPDU_RES_STATUS_SEC_TKIP_ENC:
209                 /* Don't drop the frame and decrypt it in SW */
210                 if (!(rx_pkt_status & RX_MPDU_RES_STATUS_TTAK_OK))
211                         return 0;
212                 /* fall through if TTAK OK */
213
214         case RX_MPDU_RES_STATUS_SEC_WEP_ENC:
215                 if (!(rx_pkt_status & RX_MPDU_RES_STATUS_ICV_OK))
216                         return -1;
217
218                 stats->flag |= RX_FLAG_DECRYPTED;
219                 return 0;
220
221         case RX_MPDU_RES_STATUS_SEC_EXT_ENC:
222                 if (!(rx_pkt_status & RX_MPDU_RES_STATUS_MIC_OK))
223                         return -1;
224                 stats->flag |= RX_FLAG_DECRYPTED;
225                 return 0;
226
227         default:
228                 IWL_ERR(mvm, "Unhandled alg: 0x%x\n", rx_pkt_status);
229         }
230
231         return 0;
232 }
233
234 /*
235  * iwl_mvm_rx_rx_mpdu - REPLY_RX_MPDU_CMD handler
236  *
237  * Handles the actual data of the Rx packet from the fw
238  */
239 int iwl_mvm_rx_rx_mpdu(struct iwl_mvm *mvm, struct iwl_rx_cmd_buffer *rxb,
240                        struct iwl_device_cmd *cmd)
241 {
242         struct ieee80211_hdr *hdr;
243         struct ieee80211_rx_status rx_status = {};
244         struct iwl_rx_packet *pkt = rxb_addr(rxb);
245         struct iwl_rx_phy_info *phy_info;
246         struct iwl_rx_mpdu_res_start *rx_res;
247         u32 len;
248         u32 ampdu_status;
249         u32 rate_n_flags;
250         u32 rx_pkt_status;
251
252         phy_info = &mvm->last_phy_info;
253         rx_res = (struct iwl_rx_mpdu_res_start *)pkt->data;
254         hdr = (struct ieee80211_hdr *)(pkt->data + sizeof(*rx_res));
255         len = le16_to_cpu(rx_res->byte_count);
256         rx_pkt_status = le32_to_cpup((__le32 *)
257                 (pkt->data + sizeof(*rx_res) + len));
258
259         memset(&rx_status, 0, sizeof(rx_status));
260
261         /*
262          * drop the packet if it has failed being decrypted by HW
263          */
264         if (iwl_mvm_set_mac80211_rx_flag(mvm, hdr, &rx_status, rx_pkt_status)) {
265                 IWL_DEBUG_DROP(mvm, "Bad decryption results 0x%08x\n",
266                                rx_pkt_status);
267                 return 0;
268         }
269
270         if ((unlikely(phy_info->cfg_phy_cnt > 20))) {
271                 IWL_DEBUG_DROP(mvm, "dsp size out of range [0,20]: %d\n",
272                                phy_info->cfg_phy_cnt);
273                 return 0;
274         }
275
276         /*
277          * Keep packets with CRC errors (and with overrun) for monitor mode
278          * (otherwise the firmware discards them) but mark them as bad.
279          */
280         if (!(rx_pkt_status & RX_MPDU_RES_STATUS_CRC_OK) ||
281             !(rx_pkt_status & RX_MPDU_RES_STATUS_OVERRUN_OK)) {
282                 IWL_DEBUG_RX(mvm, "Bad CRC or FIFO: 0x%08X.\n", rx_pkt_status);
283                 rx_status.flag |= RX_FLAG_FAILED_FCS_CRC;
284         }
285
286         /* This will be used in several places later */
287         rate_n_flags = le32_to_cpu(phy_info->rate_n_flags);
288
289         /* rx_status carries information about the packet to mac80211 */
290         rx_status.mactime = le64_to_cpu(phy_info->timestamp);
291         rx_status.device_timestamp = le32_to_cpu(phy_info->system_timestamp);
292         rx_status.band =
293                 (phy_info->phy_flags & cpu_to_le16(RX_RES_PHY_FLAGS_BAND_24)) ?
294                                 IEEE80211_BAND_2GHZ : IEEE80211_BAND_5GHZ;
295         rx_status.freq =
296                 ieee80211_channel_to_frequency(le16_to_cpu(phy_info->channel),
297                                                rx_status.band);
298         /*
299          * TSF as indicated by the fw is at INA time, but mac80211 expects the
300          * TSF at the beginning of the MPDU.
301          */
302         /*rx_status.flag |= RX_FLAG_MACTIME_MPDU;*/
303
304         iwl_mvm_get_signal_strength(mvm, phy_info, &rx_status);
305
306         IWL_DEBUG_STATS_LIMIT(mvm, "Rssi %d, TSF %llu\n", rx_status.signal,
307                               (unsigned long long)rx_status.mactime);
308
309         /* set the preamble flag if appropriate */
310         if (phy_info->phy_flags & cpu_to_le16(RX_RES_PHY_FLAGS_SHORT_PREAMBLE))
311                 rx_status.flag |= RX_FLAG_SHORTPRE;
312
313         if (phy_info->phy_flags & cpu_to_le16(RX_RES_PHY_FLAGS_AGG)) {
314                 /*
315                  * We know which subframes of an A-MPDU belong
316                  * together since we get a single PHY response
317                  * from the firmware for all of them
318                  */
319                 rx_status.flag |= RX_FLAG_AMPDU_DETAILS;
320                 rx_status.ampdu_reference = mvm->ampdu_ref;
321         }
322
323         /* Set up the HT phy flags */
324         switch (rate_n_flags & RATE_MCS_CHAN_WIDTH_MSK) {
325         case RATE_MCS_CHAN_WIDTH_20:
326                 break;
327         case RATE_MCS_CHAN_WIDTH_40:
328                 rx_status.flag |= RX_FLAG_40MHZ;
329                 break;
330         case RATE_MCS_CHAN_WIDTH_80:
331                 rx_status.vht_flag |= RX_VHT_FLAG_80MHZ;
332                 break;
333         case RATE_MCS_CHAN_WIDTH_160:
334                 rx_status.vht_flag |= RX_VHT_FLAG_160MHZ;
335                 break;
336         }
337         if (rate_n_flags & RATE_MCS_SGI_MSK)
338                 rx_status.flag |= RX_FLAG_SHORT_GI;
339         if (rate_n_flags & RATE_HT_MCS_GF_MSK)
340                 rx_status.flag |= RX_FLAG_HT_GF;
341         if (rate_n_flags & RATE_MCS_LDPC_MSK)
342                 rx_status.flag |= RX_FLAG_LDPC;
343         if (rate_n_flags & RATE_MCS_HT_MSK) {
344                 u8 stbc = (rate_n_flags & RATE_MCS_HT_STBC_MSK) >>
345                                 RATE_MCS_STBC_POS;
346                 rx_status.flag |= RX_FLAG_HT;
347                 rx_status.rate_idx = rate_n_flags & RATE_HT_MCS_INDEX_MSK;
348                 rx_status.flag |= stbc << RX_FLAG_STBC_SHIFT;
349         } else if (rate_n_flags & RATE_MCS_VHT_MSK) {
350                 u8 stbc = (rate_n_flags & RATE_MCS_VHT_STBC_MSK) >>
351                                 RATE_MCS_STBC_POS;
352                 rx_status.vht_nss =
353                         ((rate_n_flags & RATE_VHT_MCS_NSS_MSK) >>
354                                                 RATE_VHT_MCS_NSS_POS) + 1;
355                 rx_status.rate_idx = rate_n_flags & RATE_VHT_MCS_RATE_CODE_MSK;
356                 rx_status.flag |= RX_FLAG_VHT;
357                 rx_status.flag |= stbc << RX_FLAG_STBC_SHIFT;
358                 if (rate_n_flags & RATE_MCS_BF_MSK)
359                         rx_status.vht_flag |= RX_VHT_FLAG_BF;
360         } else {
361                 rx_status.rate_idx =
362                         iwl_mvm_legacy_rate_to_mac80211_idx(rate_n_flags,
363                                                             rx_status.band);
364         }
365
366 #ifdef CONFIG_IWLWIFI_DEBUGFS
367         iwl_mvm_update_frame_stats(mvm, &mvm->drv_rx_stats, rate_n_flags,
368                                    rx_status.flag & RX_FLAG_AMPDU_DETAILS);
369 #endif
370         iwl_mvm_pass_packet_to_mac80211(mvm, hdr, len, ampdu_status,
371                                         rxb, &rx_status);
372         return 0;
373 }
374
375 static void iwl_mvm_update_rx_statistics(struct iwl_mvm *mvm,
376                                          struct iwl_notif_statistics *stats)
377 {
378         /*
379          * NOTE FW aggregates the statistics - BUT the statistics are cleared
380          * when the driver issues REPLY_STATISTICS_CMD 0x9c with CLEAR_STATS
381          * bit set.
382          */
383         lockdep_assert_held(&mvm->mutex);
384         memcpy(&mvm->rx_stats, &stats->rx, sizeof(struct mvm_statistics_rx));
385 }
386
387 struct iwl_mvm_stat_data {
388         struct iwl_notif_statistics *stats;
389         struct iwl_mvm *mvm;
390 };
391
392 static void iwl_mvm_stat_iterator(void *_data, u8 *mac,
393                                   struct ieee80211_vif *vif)
394 {
395         struct iwl_mvm_stat_data *data = _data;
396         struct iwl_notif_statistics *stats = data->stats;
397         struct iwl_mvm *mvm = data->mvm;
398         int sig = -stats->general.beacon_filter_average_energy;
399         int last_event;
400         int thold = vif->bss_conf.cqm_rssi_thold;
401         int hyst = vif->bss_conf.cqm_rssi_hyst;
402         u16 id = le32_to_cpu(stats->rx.general.mac_id);
403         struct iwl_mvm_vif *mvmvif = iwl_mvm_vif_from_mac80211(vif);
404
405         if (mvmvif->id != id)
406                 return;
407
408         if (vif->type != NL80211_IFTYPE_STATION)
409                 return;
410
411         mvmvif->bf_data.ave_beacon_signal = sig;
412
413         /* BT Coex */
414         if (mvmvif->bf_data.bt_coex_min_thold !=
415             mvmvif->bf_data.bt_coex_max_thold) {
416                 last_event = mvmvif->bf_data.last_bt_coex_event;
417                 if (sig > mvmvif->bf_data.bt_coex_max_thold &&
418                     (last_event <= mvmvif->bf_data.bt_coex_min_thold ||
419                      last_event == 0)) {
420                         mvmvif->bf_data.last_bt_coex_event = sig;
421                         IWL_DEBUG_RX(mvm, "cqm_iterator bt coex high %d\n",
422                                      sig);
423                         iwl_mvm_bt_rssi_event(mvm, vif, RSSI_EVENT_HIGH);
424                 } else if (sig < mvmvif->bf_data.bt_coex_min_thold &&
425                            (last_event >= mvmvif->bf_data.bt_coex_max_thold ||
426                             last_event == 0)) {
427                         mvmvif->bf_data.last_bt_coex_event = sig;
428                         IWL_DEBUG_RX(mvm, "cqm_iterator bt coex low %d\n",
429                                      sig);
430                         iwl_mvm_bt_rssi_event(mvm, vif, RSSI_EVENT_LOW);
431                 }
432         }
433
434         if (!(vif->driver_flags & IEEE80211_VIF_SUPPORTS_CQM_RSSI))
435                 return;
436
437         /* CQM Notification */
438         last_event = mvmvif->bf_data.last_cqm_event;
439         if (thold && sig < thold && (last_event == 0 ||
440                                      sig < last_event - hyst)) {
441                 mvmvif->bf_data.last_cqm_event = sig;
442                 IWL_DEBUG_RX(mvm, "cqm_iterator cqm low %d\n",
443                              sig);
444                 ieee80211_cqm_rssi_notify(
445                         vif,
446                         NL80211_CQM_RSSI_THRESHOLD_EVENT_LOW,
447                         GFP_KERNEL);
448         } else if (sig > thold &&
449                    (last_event == 0 || sig > last_event + hyst)) {
450                 mvmvif->bf_data.last_cqm_event = sig;
451                 IWL_DEBUG_RX(mvm, "cqm_iterator cqm high %d\n",
452                              sig);
453                 ieee80211_cqm_rssi_notify(
454                         vif,
455                         NL80211_CQM_RSSI_THRESHOLD_EVENT_HIGH,
456                         GFP_KERNEL);
457         }
458 }
459
460 /*
461  * iwl_mvm_rx_statistics - STATISTICS_NOTIFICATION handler
462  *
463  * TODO: This handler is implemented partially.
464  */
465 int iwl_mvm_rx_statistics(struct iwl_mvm *mvm,
466                           struct iwl_rx_cmd_buffer *rxb,
467                           struct iwl_device_cmd *cmd)
468 {
469         struct iwl_rx_packet *pkt = rxb_addr(rxb);
470         struct iwl_notif_statistics *stats = (void *)&pkt->data;
471         struct mvm_statistics_general_common *common = &stats->general.common;
472         struct iwl_mvm_stat_data data = {
473                 .stats = stats,
474                 .mvm = mvm,
475         };
476
477         if (mvm->temperature != le32_to_cpu(common->temperature)) {
478                 mvm->temperature = le32_to_cpu(common->temperature);
479                 iwl_mvm_tt_handler(mvm);
480         }
481         iwl_mvm_update_rx_statistics(mvm, stats);
482
483         ieee80211_iterate_active_interfaces(mvm->hw,
484                                             IEEE80211_IFACE_ITER_NORMAL,
485                                             iwl_mvm_stat_iterator,
486                                             &data);
487         return 0;
488 }