|
@@ -67,17 +67,22 @@ void iwl_rx_missed_beacon_notif(struct iwl_priv *priv,
|
|
|
* exactly when to expect beacons, therefore only when we're associated. */
|
|
|
static void iwl_rx_calc_noise(struct iwl_priv *priv)
|
|
|
{
|
|
|
- struct statistics_rx_non_phy *rx_info
|
|
|
- = &(priv->_agn.statistics.rx.general);
|
|
|
+ struct statistics_rx_non_phy *rx_info;
|
|
|
int num_active_rx = 0;
|
|
|
int total_silence = 0;
|
|
|
- int bcn_silence_a =
|
|
|
+ int bcn_silence_a, bcn_silence_b, bcn_silence_c;
|
|
|
+ int last_rx_noise;
|
|
|
+
|
|
|
+ if (priv->cfg->bt_statistics)
|
|
|
+ rx_info = &(priv->_agn.statistics_bt.rx.general.common);
|
|
|
+ else
|
|
|
+ rx_info = &(priv->_agn.statistics.rx.general);
|
|
|
+ bcn_silence_a =
|
|
|
le32_to_cpu(rx_info->beacon_silence_rssi_a) & IN_BAND_FILTER;
|
|
|
- int bcn_silence_b =
|
|
|
+ bcn_silence_b =
|
|
|
le32_to_cpu(rx_info->beacon_silence_rssi_b) & IN_BAND_FILTER;
|
|
|
- int bcn_silence_c =
|
|
|
+ bcn_silence_c =
|
|
|
le32_to_cpu(rx_info->beacon_silence_rssi_c) & IN_BAND_FILTER;
|
|
|
- int last_rx_noise;
|
|
|
|
|
|
if (bcn_silence_a) {
|
|
|
total_silence += bcn_silence_a;
|
|
@@ -112,17 +117,35 @@ static void iwl_rx_calc_noise(struct iwl_priv *priv)
|
|
|
static void iwl_accumulative_statistics(struct iwl_priv *priv,
|
|
|
__le32 *stats)
|
|
|
{
|
|
|
- int i;
|
|
|
+ int i, size;
|
|
|
__le32 *prev_stats;
|
|
|
u32 *accum_stats;
|
|
|
u32 *delta, *max_delta;
|
|
|
+ struct statistics_general_common *general, *accum_general;
|
|
|
+ struct statistics_tx *tx, *accum_tx;
|
|
|
|
|
|
- prev_stats = (__le32 *)&priv->_agn.statistics;
|
|
|
- accum_stats = (u32 *)&priv->_agn.accum_statistics;
|
|
|
- delta = (u32 *)&priv->_agn.delta_statistics;
|
|
|
- max_delta = (u32 *)&priv->_agn.max_delta;
|
|
|
-
|
|
|
- for (i = sizeof(__le32); i < sizeof(struct iwl_notif_statistics);
|
|
|
+ if (priv->cfg->bt_statistics) {
|
|
|
+ prev_stats = (__le32 *)&priv->_agn.statistics_bt;
|
|
|
+ accum_stats = (u32 *)&priv->_agn.accum_statistics_bt;
|
|
|
+ size = sizeof(struct iwl_bt_notif_statistics);
|
|
|
+ general = &priv->_agn.statistics_bt.general.common;
|
|
|
+ accum_general = &priv->_agn.accum_statistics_bt.general.common;
|
|
|
+ tx = &priv->_agn.statistics_bt.tx;
|
|
|
+ accum_tx = &priv->_agn.accum_statistics_bt.tx;
|
|
|
+ delta = (u32 *)&priv->_agn.delta_statistics_bt;
|
|
|
+ max_delta = (u32 *)&priv->_agn.max_delta_bt;
|
|
|
+ } else {
|
|
|
+ prev_stats = (__le32 *)&priv->_agn.statistics;
|
|
|
+ accum_stats = (u32 *)&priv->_agn.accum_statistics;
|
|
|
+ size = sizeof(struct iwl_notif_statistics);
|
|
|
+ general = &priv->_agn.statistics.general.common;
|
|
|
+ accum_general = &priv->_agn.accum_statistics.general.common;
|
|
|
+ tx = &priv->_agn.statistics.tx;
|
|
|
+ accum_tx = &priv->_agn.accum_statistics.tx;
|
|
|
+ delta = (u32 *)&priv->_agn.delta_statistics;
|
|
|
+ max_delta = (u32 *)&priv->_agn.max_delta;
|
|
|
+ }
|
|
|
+ for (i = sizeof(__le32); i < size;
|
|
|
i += sizeof(__le32), stats++, prev_stats++, delta++,
|
|
|
max_delta++, accum_stats++) {
|
|
|
if (le32_to_cpu(*stats) > le32_to_cpu(*prev_stats)) {
|
|
@@ -135,18 +158,12 @@ static void iwl_accumulative_statistics(struct iwl_priv *priv,
|
|
|
}
|
|
|
|
|
|
/* reset accumulative statistics for "no-counter" type statistics */
|
|
|
- priv->_agn.accum_statistics.general.common.temperature =
|
|
|
- priv->_agn.statistics.general.common.temperature;
|
|
|
- priv->_agn.accum_statistics.general.common.temperature_m =
|
|
|
- priv->_agn.statistics.general.common.temperature_m;
|
|
|
- priv->_agn.accum_statistics.general.common.ttl_timestamp =
|
|
|
- priv->_agn.statistics.general.common.ttl_timestamp;
|
|
|
- priv->_agn.accum_statistics.tx.tx_power.ant_a =
|
|
|
- priv->_agn.statistics.tx.tx_power.ant_a;
|
|
|
- priv->_agn.accum_statistics.tx.tx_power.ant_b =
|
|
|
- priv->_agn.statistics.tx.tx_power.ant_b;
|
|
|
- priv->_agn.accum_statistics.tx.tx_power.ant_c =
|
|
|
- priv->_agn.statistics.tx.tx_power.ant_c;
|
|
|
+ accum_general->temperature = general->temperature;
|
|
|
+ accum_general->temperature_m = general->temperature_m;
|
|
|
+ accum_general->ttl_timestamp = general->ttl_timestamp;
|
|
|
+ accum_tx->tx_power.ant_a = tx->tx_power.ant_a;
|
|
|
+ accum_tx->tx_power.ant_b = tx->tx_power.ant_b;
|
|
|
+ accum_tx->tx_power.ant_c = tx->tx_power.ant_c;
|
|
|
}
|
|
|
#endif
|
|
|
|
|
@@ -185,11 +202,30 @@ bool iwl_good_plcp_health(struct iwl_priv *priv,
|
|
|
* by zero.
|
|
|
*/
|
|
|
if (plcp_msec) {
|
|
|
- combined_plcp_delta =
|
|
|
- (le32_to_cpu(pkt->u.stats.rx.ofdm.plcp_err) -
|
|
|
- le32_to_cpu(priv->_agn.statistics.rx.ofdm.plcp_err)) +
|
|
|
- (le32_to_cpu(pkt->u.stats.rx.ofdm_ht.plcp_err) -
|
|
|
- le32_to_cpu(priv->_agn.statistics.rx.ofdm_ht.plcp_err));
|
|
|
+ struct statistics_rx_phy *ofdm;
|
|
|
+ struct statistics_rx_ht_phy *ofdm_ht;
|
|
|
+
|
|
|
+ if (priv->cfg->bt_statistics) {
|
|
|
+ ofdm = &pkt->u.stats_bt.rx.ofdm;
|
|
|
+ ofdm_ht = &pkt->u.stats_bt.rx.ofdm_ht;
|
|
|
+ combined_plcp_delta =
|
|
|
+ (le32_to_cpu(ofdm->plcp_err) -
|
|
|
+ le32_to_cpu(priv->_agn.statistics_bt.
|
|
|
+ rx.ofdm.plcp_err)) +
|
|
|
+ (le32_to_cpu(ofdm_ht->plcp_err) -
|
|
|
+ le32_to_cpu(priv->_agn.statistics_bt.
|
|
|
+ rx.ofdm_ht.plcp_err));
|
|
|
+ } else {
|
|
|
+ ofdm = &pkt->u.stats.rx.ofdm;
|
|
|
+ ofdm_ht = &pkt->u.stats.rx.ofdm_ht;
|
|
|
+ combined_plcp_delta =
|
|
|
+ (le32_to_cpu(ofdm->plcp_err) -
|
|
|
+ le32_to_cpu(priv->_agn.statistics.
|
|
|
+ rx.ofdm.plcp_err)) +
|
|
|
+ (le32_to_cpu(ofdm_ht->plcp_err) -
|
|
|
+ le32_to_cpu(priv->_agn.statistics.
|
|
|
+ rx.ofdm_ht.plcp_err));
|
|
|
+ }
|
|
|
|
|
|
if ((combined_plcp_delta > 0) &&
|
|
|
((combined_plcp_delta * 100) / plcp_msec) >
|
|
@@ -206,15 +242,14 @@ bool iwl_good_plcp_health(struct iwl_priv *priv,
|
|
|
* plcp_msec
|
|
|
*/
|
|
|
IWL_DEBUG_RADIO(priv, "plcp_err exceeded %u, "
|
|
|
- "%u, %u, %u, %u, %d, %u mSecs\n",
|
|
|
- priv->cfg->plcp_delta_threshold,
|
|
|
- le32_to_cpu(pkt->u.stats.rx.ofdm.plcp_err),
|
|
|
- le32_to_cpu(
|
|
|
- priv->_agn.statistics.rx.ofdm.plcp_err),
|
|
|
- le32_to_cpu(pkt->u.stats.rx.ofdm_ht.plcp_err),
|
|
|
- le32_to_cpu(
|
|
|
- priv->_agn.statistics.rx.ofdm_ht.plcp_err),
|
|
|
- combined_plcp_delta, plcp_msec);
|
|
|
+ "%u, %u, %u, %u, %d, %u mSecs\n",
|
|
|
+ priv->cfg->plcp_delta_threshold,
|
|
|
+ le32_to_cpu(ofdm->plcp_err),
|
|
|
+ le32_to_cpu(ofdm->plcp_err),
|
|
|
+ le32_to_cpu(ofdm_ht->plcp_err),
|
|
|
+ le32_to_cpu(ofdm_ht->plcp_err),
|
|
|
+ combined_plcp_delta, plcp_msec);
|
|
|
+
|
|
|
rc = false;
|
|
|
}
|
|
|
}
|
|
@@ -227,24 +262,50 @@ void iwl_rx_statistics(struct iwl_priv *priv,
|
|
|
int change;
|
|
|
struct iwl_rx_packet *pkt = rxb_addr(rxb);
|
|
|
|
|
|
+ if (priv->cfg->bt_statistics) {
|
|
|
+ IWL_DEBUG_RX(priv,
|
|
|
+ "Statistics notification received (%d vs %d).\n",
|
|
|
+ (int)sizeof(struct iwl_bt_notif_statistics),
|
|
|
+ le32_to_cpu(pkt->len_n_flags) &
|
|
|
+ FH_RSCSR_FRAME_SIZE_MSK);
|
|
|
|
|
|
- IWL_DEBUG_RX(priv, "Statistics notification received (%d vs %d).\n",
|
|
|
- (int)sizeof(priv->_agn.statistics),
|
|
|
- le32_to_cpu(pkt->len_n_flags) & FH_RSCSR_FRAME_SIZE_MSK);
|
|
|
+ change = ((priv->_agn.statistics_bt.general.common.temperature !=
|
|
|
+ pkt->u.stats_bt.general.common.temperature) ||
|
|
|
+ ((priv->_agn.statistics_bt.flag &
|
|
|
+ STATISTICS_REPLY_FLG_HT40_MODE_MSK) !=
|
|
|
+ (pkt->u.stats_bt.flag &
|
|
|
+ STATISTICS_REPLY_FLG_HT40_MODE_MSK)));
|
|
|
+#ifdef CONFIG_IWLWIFI_DEBUGFS
|
|
|
+ iwl_accumulative_statistics(priv, (__le32 *)&pkt->u.stats_bt);
|
|
|
+#endif
|
|
|
|
|
|
- change = ((priv->_agn.statistics.general.common.temperature !=
|
|
|
- pkt->u.stats.general.common.temperature) ||
|
|
|
- ((priv->_agn.statistics.flag &
|
|
|
- STATISTICS_REPLY_FLG_HT40_MODE_MSK) !=
|
|
|
- (pkt->u.stats.flag & STATISTICS_REPLY_FLG_HT40_MODE_MSK)));
|
|
|
+ } else {
|
|
|
+ IWL_DEBUG_RX(priv,
|
|
|
+ "Statistics notification received (%d vs %d).\n",
|
|
|
+ (int)sizeof(struct iwl_notif_statistics),
|
|
|
+ le32_to_cpu(pkt->len_n_flags) &
|
|
|
+ FH_RSCSR_FRAME_SIZE_MSK);
|
|
|
|
|
|
+ change = ((priv->_agn.statistics.general.common.temperature !=
|
|
|
+ pkt->u.stats.general.common.temperature) ||
|
|
|
+ ((priv->_agn.statistics.flag &
|
|
|
+ STATISTICS_REPLY_FLG_HT40_MODE_MSK) !=
|
|
|
+ (pkt->u.stats.flag &
|
|
|
+ STATISTICS_REPLY_FLG_HT40_MODE_MSK)));
|
|
|
#ifdef CONFIG_IWLWIFI_DEBUGFS
|
|
|
- iwl_accumulative_statistics(priv, (__le32 *)&pkt->u.stats);
|
|
|
+ iwl_accumulative_statistics(priv, (__le32 *)&pkt->u.stats);
|
|
|
#endif
|
|
|
+
|
|
|
+ }
|
|
|
+
|
|
|
iwl_recover_from_statistics(priv, pkt);
|
|
|
|
|
|
- memcpy(&priv->_agn.statistics, &pkt->u.stats,
|
|
|
- sizeof(priv->_agn.statistics));
|
|
|
+ if (priv->cfg->bt_statistics)
|
|
|
+ memcpy(&priv->_agn.statistics_bt, &pkt->u.stats_bt,
|
|
|
+ sizeof(priv->_agn.statistics_bt));
|
|
|
+ else
|
|
|
+ memcpy(&priv->_agn.statistics, &pkt->u.stats,
|
|
|
+ sizeof(priv->_agn.statistics));
|
|
|
|
|
|
set_bit(STATUS_STATISTICS, &priv->status);
|
|
|
|
|
@@ -277,6 +338,12 @@ void iwl_reply_statistics(struct iwl_priv *priv,
|
|
|
sizeof(struct iwl_notif_statistics));
|
|
|
memset(&priv->_agn.max_delta, 0,
|
|
|
sizeof(struct iwl_notif_statistics));
|
|
|
+ memset(&priv->_agn.accum_statistics_bt, 0,
|
|
|
+ sizeof(struct iwl_bt_notif_statistics));
|
|
|
+ memset(&priv->_agn.delta_statistics_bt, 0,
|
|
|
+ sizeof(struct iwl_bt_notif_statistics));
|
|
|
+ memset(&priv->_agn.max_delta_bt, 0,
|
|
|
+ sizeof(struct iwl_bt_notif_statistics));
|
|
|
#endif
|
|
|
IWL_DEBUG_RX(priv, "Statistics have been cleared\n");
|
|
|
}
|