|
@@ -549,73 +549,77 @@ static void p54_rx_frame_sent(struct ieee80211_hw *dev, struct sk_buff *skb)
|
|
|
spin_lock_irqsave(&priv->tx_queue.lock, flags);
|
|
|
while (entry != (struct sk_buff *)&priv->tx_queue) {
|
|
|
struct ieee80211_tx_info *info = IEEE80211_SKB_CB(entry);
|
|
|
+ struct p54_control_hdr *entry_hdr;
|
|
|
+ struct p54_tx_control_allocdata *entry_data;
|
|
|
+ int pad = 0;
|
|
|
+
|
|
|
range = (void *)info->rate_driver_data;
|
|
|
- if (range->start_addr == addr) {
|
|
|
- struct p54_control_hdr *entry_hdr;
|
|
|
- struct p54_tx_control_allocdata *entry_data;
|
|
|
- int pad = 0;
|
|
|
+ if (range->start_addr != addr) {
|
|
|
+ last_addr = range->end_addr;
|
|
|
+ entry = entry->next;
|
|
|
+ continue;
|
|
|
+ }
|
|
|
|
|
|
- if (entry->next != (struct sk_buff *)&priv->tx_queue) {
|
|
|
- struct ieee80211_tx_info *ni;
|
|
|
- struct memrecord *mr;
|
|
|
+ if (entry->next != (struct sk_buff *)&priv->tx_queue) {
|
|
|
+ struct ieee80211_tx_info *ni;
|
|
|
+ struct memrecord *mr;
|
|
|
|
|
|
- ni = IEEE80211_SKB_CB(entry->next);
|
|
|
- mr = (struct memrecord *)ni->rate_driver_data;
|
|
|
- freed = mr->start_addr - last_addr;
|
|
|
- } else
|
|
|
- freed = priv->rx_end - last_addr;
|
|
|
+ ni = IEEE80211_SKB_CB(entry->next);
|
|
|
+ mr = (struct memrecord *)ni->rate_driver_data;
|
|
|
+ freed = mr->start_addr - last_addr;
|
|
|
+ } else
|
|
|
+ freed = priv->rx_end - last_addr;
|
|
|
|
|
|
- last_addr = range->end_addr;
|
|
|
- __skb_unlink(entry, &priv->tx_queue);
|
|
|
- spin_unlock_irqrestore(&priv->tx_queue.lock, flags);
|
|
|
-
|
|
|
- /*
|
|
|
- * Clear manually, ieee80211_tx_info_clear_status would
|
|
|
- * clear the counts too and we need them.
|
|
|
- */
|
|
|
- memset(&info->status.ampdu_ack_len, 0,
|
|
|
- sizeof(struct ieee80211_tx_info) -
|
|
|
- offsetof(struct ieee80211_tx_info, status.ampdu_ack_len));
|
|
|
- BUILD_BUG_ON(offsetof(struct ieee80211_tx_info,
|
|
|
- status.ampdu_ack_len) != 23);
|
|
|
-
|
|
|
- entry_hdr = (struct p54_control_hdr *) entry->data;
|
|
|
- entry_data = (struct p54_tx_control_allocdata *) entry_hdr->data;
|
|
|
- if ((entry_hdr->magic1 & cpu_to_le16(0x4000)) != 0)
|
|
|
- pad = entry_data->align[0];
|
|
|
-
|
|
|
- /* walk through the rates array and adjust the counts */
|
|
|
- count = payload->retries;
|
|
|
- for (idx = 0; idx < 4; idx++) {
|
|
|
- if (count >= info->status.rates[idx].count) {
|
|
|
- count -= info->status.rates[idx].count;
|
|
|
- } else if (count > 0) {
|
|
|
- info->status.rates[idx].count = count;
|
|
|
- count = 0;
|
|
|
- } else {
|
|
|
- info->status.rates[idx].idx = -1;
|
|
|
- info->status.rates[idx].count = 0;
|
|
|
- }
|
|
|
+ last_addr = range->end_addr;
|
|
|
+ __skb_unlink(entry, &priv->tx_queue);
|
|
|
+ spin_unlock_irqrestore(&priv->tx_queue.lock, flags);
|
|
|
+
|
|
|
+ /*
|
|
|
+ * Clear manually, ieee80211_tx_info_clear_status would
|
|
|
+ * clear the counts too and we need them.
|
|
|
+ */
|
|
|
+ memset(&info->status.ampdu_ack_len, 0,
|
|
|
+ sizeof(struct ieee80211_tx_info) -
|
|
|
+ offsetof(struct ieee80211_tx_info, status.ampdu_ack_len));
|
|
|
+ BUILD_BUG_ON(offsetof(struct ieee80211_tx_info,
|
|
|
+ status.ampdu_ack_len) != 23);
|
|
|
+
|
|
|
+ entry_hdr = (struct p54_control_hdr *) entry->data;
|
|
|
+ entry_data = (struct p54_tx_control_allocdata *) entry_hdr->data;
|
|
|
+ if ((entry_hdr->magic1 & cpu_to_le16(0x4000)) != 0)
|
|
|
+ pad = entry_data->align[0];
|
|
|
+
|
|
|
+ /* walk through the rates array and adjust the counts */
|
|
|
+ count = payload->retries;
|
|
|
+ for (idx = 0; idx < 4; idx++) {
|
|
|
+ if (count >= info->status.rates[idx].count) {
|
|
|
+ count -= info->status.rates[idx].count;
|
|
|
+ } else if (count > 0) {
|
|
|
+ info->status.rates[idx].count = count;
|
|
|
+ count = 0;
|
|
|
+ } else {
|
|
|
+ info->status.rates[idx].idx = -1;
|
|
|
+ info->status.rates[idx].count = 0;
|
|
|
}
|
|
|
+ }
|
|
|
|
|
|
- priv->tx_stats[entry_data->hw_queue].len--;
|
|
|
- if (!(info->flags & IEEE80211_TX_CTL_NO_ACK) &&
|
|
|
- !(payload->status & 0x01))
|
|
|
- info->flags |= IEEE80211_TX_STAT_ACK;
|
|
|
- info->status.ack_signal = p54_rssi_to_dbm(dev,
|
|
|
- le16_to_cpu(payload->ack_rssi));
|
|
|
- skb_pull(entry, sizeof(*hdr) + pad + sizeof(*entry_data));
|
|
|
- ieee80211_tx_status_irqsafe(dev, entry);
|
|
|
- goto out;
|
|
|
- } else
|
|
|
- last_addr = range->end_addr;
|
|
|
- entry = entry->next;
|
|
|
+ priv->tx_stats[entry_data->hw_queue].len--;
|
|
|
+ if (!(info->flags & IEEE80211_TX_CTL_NO_ACK) &&
|
|
|
+ (!payload->status))
|
|
|
+ info->flags |= IEEE80211_TX_STAT_ACK;
|
|
|
+ if (payload->status & 0x02)
|
|
|
+ info->flags |= IEEE80211_TX_STAT_TX_FILTERED;
|
|
|
+ info->status.ack_signal = p54_rssi_to_dbm(dev,
|
|
|
+ le16_to_cpu(payload->ack_rssi));
|
|
|
+ skb_pull(entry, sizeof(*hdr) + pad + sizeof(*entry_data));
|
|
|
+ ieee80211_tx_status_irqsafe(dev, entry);
|
|
|
+ goto out;
|
|
|
}
|
|
|
spin_unlock_irqrestore(&priv->tx_queue.lock, flags);
|
|
|
|
|
|
out:
|
|
|
- if (freed >= IEEE80211_MAX_RTS_THRESHOLD + 0x170 +
|
|
|
- sizeof(struct p54_control_hdr))
|
|
|
+ if (freed >= priv->headroom + sizeof(struct p54_control_hdr) + 48 +
|
|
|
+ IEEE80211_MAX_RTS_THRESHOLD + priv->tailroom)
|
|
|
p54_wake_free_queues(dev);
|
|
|
}
|
|
|
|