X-Git-Url: https://jxself.org/git/?a=blobdiff_plain;f=carlfw%2Fsrc%2Fwlan.c;h=794aa86f44ba9d29a37a7209f514c054cc4be038;hb=1660e67386f708c58552be00daa1eb028126677b;hp=61976b05d6b3311ca96d905907f55eedbc52406e;hpb=c48e2d095d50c9aea409c3171ed1f183fe906ea6;p=carl9170fw.git

diff --git a/carlfw/src/wlan.c b/carlfw/src/wlan.c
index 61976b0..794aa86 100644
--- a/carlfw/src/wlan.c
+++ b/carlfw/src/wlan.c
@@ -35,14 +35,12 @@
 static void wlan_txunstuck(unsigned int queue)
 {
 	set_wlan_txq_dma_addr(queue, ((uint32_t) fw.wlan.tx_queue[queue].head) | 1);
-	wlan_trigger(BIT(queue));
 }
 
 #ifdef CONFIG_CARL9170FW_DMA_QUEUE_BUMP
 static void wlan_txupdate(unsigned int queue)
 {
 	set_wlan_txq_dma_addr(queue, ((uint32_t) fw.wlan.tx_queue[queue].head));
-	wlan_trigger(BIT(queue));
 }
 
 static void wlan_dma_bump(unsigned int qidx)
@@ -212,13 +210,48 @@ static bool wlan_tx_consume_retry(struct carl9170_tx_superframe *super)
 	return true;
 }
 
+static inline u16 get_tid(struct ieee80211_hdr *hdr)
+{
+        return (ieee80211_get_qos_ctl(hdr))[0] & IEEE80211_QOS_CTL_TID_MASK;
+}
+
+/* This function will only work on uint32_t-aligned pointers! */
+static inline bool compare_ether_address(const void *_d0, const void *_d1)
+{
+	const uint32_t *d0 = _d0;
+	const uint32_t *d1 = _d1;
+
+	/* BUG_ON((unsigned long)d0 & 3 || (unsigned long)d1 & 3)) */
+	return !((d0[0] ^ d1[0]) | (unsigned short)(d0[1] ^ d1[1]));
+}
+
+#ifdef CONFIG_CARL9170FW_TX_AMPDU
+static void wlan_tx_ampdu(struct carl9170_tx_superframe *super)
+{
+	unsigned int qidx = super->s.queue;
+	struct carl9170_tx_superframe *ht_prev = fw.wlan.ampdu_prev[qidx];
+
+	if (!super->f.hdr.mac.ampdu) {
+		fw.wlan.ampdu_prev[qidx] = NULL;
+
+		if (ht_prev)
+			ht_prev->f.hdr.mac.ba_end = 1;
+	} else {
+		fw.wlan.ampdu_prev[qidx] = super;
+
+		if (ht_prev && (get_tid(&super->f.data.i3e) != get_tid(&ht_prev->f.data.i3e) ||
+		    !compare_ether_address(super->f.data.i3e.addr1, ht_prev->f.data.i3e.addr1)))
+			ht_prev->f.hdr.mac.ba_end = 1;
+		else
+			super->f.hdr.mac.ba_end = 0;
+	}
+}
+#endif /* CONFIG_CARL9170FW_TX_AMPDU */
+
 /* for all tries */
 static void __wlan_tx(struct dma_desc *desc)
 {
 	struct carl9170_tx_superframe *super = get_super(desc);
-#ifdef CONFIG_CARL9170FW_NORMAL_TX_RX
-	unsigned int queue = super->s.queue;
-#endif /* CONFIG_CARL9170FW_LOOPBACK */
 
 	if (unlikely(super->s.fill_in_tsf)) {
 		struct ieee80211_mgmt *mgmt = (void *) &super->f.data.i3e;
@@ -237,6 +270,10 @@ static void __wlan_tx(struct dma_desc *desc)
 		read_tsf(tsf);
 	}
 
+#ifdef CONFIG_CARL9170FW_TX_AMPDU
+	wlan_tx_ampdu(super);
+#endif /* CONFIG_CARL9170FW_TX_AMPDU */
+
 #if (defined CONFIG_CARL9170FW_LOOPBACK) || (defined CONFIG_CARL9170FW_DISCARD)
 	wlan_tx_complete(super, true);
 	unhide_super(desc);
@@ -254,8 +291,7 @@ static void __wlan_tx(struct dma_desc *desc)
 # endif /* CONFIG_CARL9170FW_DEBUG && CONFIG_CARL9170FW_PSM */
 
 	/* insert desc into the right queue */
-	dma_put(&fw.wlan.tx_queue[queue], desc);
-	wlan_trigger(BIT(queue));
+	dma_put(&fw.wlan.tx_queue[super->s.queue], desc);
 #endif /* CONFIG_CARL9170FW_LOOPBACK */
 }
 
@@ -414,6 +450,7 @@ static void handle_tx_completion(void)
 		for_each_desc(desc, &fw.wlan.tx_delay[i])
 			_wlan_tx(desc);
 #endif /* CONFIG_CARL9170FW_DELAYED_TX */
+		wlan_trigger(BIT(i));
 	}
 }
 
@@ -426,13 +463,6 @@ void __hot wlan_tx(struct dma_desc *desc)
 	super->s.cnt = 1;
 	hide_super(desc);
 
-#ifdef CONFIG_CARL9170FW_DELAYED_TX
-	if (!queue_empty(&fw.wlan.tx_queue[super->s.queue])) {
-		dma_put(&fw.wlan.tx_delay[super->s.queue], desc);
-		return;
-	}
-#endif /* CONFIG_CARL9170FW_DELAYED_TX */
-
 #ifdef CONFIG_CARL9170FW_CAB_QUEUE
 	if (unlikely(super->s.cab)) {
 		fw.wlan.cab_queue_len[super->s.vif_id]++;
@@ -441,7 +471,15 @@ void __hot wlan_tx(struct dma_desc *desc)
 	}
 #endif /* CONFIG_CARL9170FW_CAB_QUEUE */
 
+#ifdef CONFIG_CARL9170FW_DELAYED_TX
+	if (!queue_empty(&fw.wlan.tx_queue[super->s.queue])) {
+		dma_put(&fw.wlan.tx_delay[super->s.queue], desc);
+		return;
+	}
+#endif /* CONFIG_CARL9170FW_DELAYED_TX */
+
 	_wlan_tx(desc);
+	wlan_trigger(BIT(super->s.queue));
 }
 
 #ifdef CONFIG_CARL9170FW_HANDLE_BACK_REQ
@@ -601,13 +639,11 @@ static unsigned int wlan_rx_filter(struct dma_desc *desc)
 	data_len = ar9170_get_rx_mpdu_len(desc);
 	mac_err = ar9170_get_rx_macstatus_error(desc);
 
-#define AR9170_RX_ERROR_BAD (AR9170_RX_ERROR_FCS | AR9170_RX_ERROR_PLCP | \
-			     AR9170_RX_ERROR_FATAL)
+#define AR9170_RX_ERROR_BAD (AR9170_RX_ERROR_FCS | AR9170_RX_ERROR_PLCP)
 
 	if (unlikely(data_len < (4 + 6 + FCS_LEN) ||
 	    desc->totalLen > CONFIG_CARL9170FW_RX_FRAME_LEN) ||
 	    mac_err & AR9170_RX_ERROR_BAD) {
-
 		/*
 		 * This frame is too damaged to do anything
 		 * useful with it.
@@ -695,6 +731,7 @@ void wlan_cab_flush_queue(const unsigned int vif)
 
 		/* ready to roll! */
 		_wlan_tx(desc);
+		wlan_trigger(BIT(super->s.queue));
 	}
 }
 
@@ -936,6 +973,7 @@ static void wlan_check_hang(void)
 				 */
 
 				wlan_dma_bump(i);
+				wlan_trigger(BIT(i));
 			}
 #endif /* CONFIG_CARL9170FW_DMA_QUEUE_BUMP */
 		} else {