|
@@ -120,6 +120,20 @@ int iwl_txq_update_write_ptr(struct iwl_priv *priv, struct iwl_tx_queue *txq)
|
|
|
EXPORT_SYMBOL(iwl_txq_update_write_ptr);
|
|
|
|
|
|
|
|
|
+void iwl_free_tfds_in_queue(struct iwl_priv *priv,
|
|
|
+ int sta_id, int tid, int freed)
|
|
|
+{
|
|
|
+ if (priv->stations[sta_id].tid[tid].tfds_in_queue >= freed)
|
|
|
+ priv->stations[sta_id].tid[tid].tfds_in_queue -= freed;
|
|
|
+ else {
|
|
|
+ IWL_ERR(priv, "free more than tfds_in_queue (%u:%d)\n",
|
|
|
+ priv->stations[sta_id].tid[tid].tfds_in_queue,
|
|
|
+ freed);
|
|
|
+ priv->stations[sta_id].tid[tid].tfds_in_queue = 0;
|
|
|
+ }
|
|
|
+}
|
|
|
+EXPORT_SYMBOL(iwl_free_tfds_in_queue);
|
|
|
+
|
|
|
/**
|
|
|
* iwl_tx_queue_free - Deallocate DMA queue.
|
|
|
* @txq: Transmit queue to deallocate.
|
|
@@ -1131,6 +1145,7 @@ int iwl_tx_queue_reclaim(struct iwl_priv *priv, int txq_id, int index)
|
|
|
struct iwl_queue *q = &txq->q;
|
|
|
struct iwl_tx_info *tx_info;
|
|
|
int nfreed = 0;
|
|
|
+ struct ieee80211_hdr *hdr;
|
|
|
|
|
|
if ((index >= q->n_bd) || (iwl_queue_used(q, index) == 0)) {
|
|
|
IWL_ERR(priv, "Read index for DMA queue txq id (%d), index %d, "
|
|
@@ -1145,13 +1160,16 @@ int iwl_tx_queue_reclaim(struct iwl_priv *priv, int txq_id, int index)
|
|
|
|
|
|
tx_info = &txq->txb[txq->q.read_ptr];
|
|
|
iwl_tx_status(priv, tx_info->skb[0]);
|
|
|
+
|
|
|
+ hdr = (struct ieee80211_hdr *)tx_info->skb[0]->data;
|
|
|
+ if (hdr && ieee80211_is_data_qos(hdr->frame_control))
|
|
|
+ nfreed++;
|
|
|
tx_info->skb[0] = NULL;
|
|
|
|
|
|
if (priv->cfg->ops->lib->txq_inval_byte_cnt_tbl)
|
|
|
priv->cfg->ops->lib->txq_inval_byte_cnt_tbl(priv, txq);
|
|
|
|
|
|
priv->cfg->ops->lib->txq_free_tfd(priv, txq);
|
|
|
- nfreed++;
|
|
|
}
|
|
|
return nfreed;
|
|
|
}
|
|
@@ -1559,7 +1577,7 @@ void iwl_rx_reply_compressed_ba(struct iwl_priv *priv,
|
|
|
if (txq->q.read_ptr != (ba_resp_scd_ssn & 0xff)) {
|
|
|
/* calculate mac80211 ampdu sw queue to wake */
|
|
|
int freed = iwl_tx_queue_reclaim(priv, scd_flow, index);
|
|
|
- priv->stations[sta_id].tid[tid].tfds_in_queue -= freed;
|
|
|
+ iwl_free_tfds_in_queue(priv, sta_id, tid, freed);
|
|
|
|
|
|
if ((iwl_queue_space(&txq->q) > txq->q.low_mark) &&
|
|
|
priv->mac80211_registered &&
|