X-Git-Url: https://jxself.org/git/?a=blobdiff_plain;f=carlfw%2Fsrc%2Fwlan.c;h=8bc3d4fa4dcc21cdb493d05357c7f941aa72dc1d;hb=fa4d2c34ac5c90976d3821827e7dadb372ad0678;hp=aaff3eeaf9bb2555cd6aa86f035e149060c1ab64;hpb=e72388a0aa23da8bc8e24a0cbe9d523c5a9ce294;p=carl9170fw.git

diff --git a/carlfw/src/wlan.c b/carlfw/src/wlan.c
index aaff3ee..8bc3d4f 100644
--- a/carlfw/src/wlan.c
+++ b/carlfw/src/wlan.c
@@ -44,32 +44,6 @@ static void wlan_txupdate(unsigned int queue)
 	wlan_trigger(BIT(queue));
 }
 
-static void wlan_dma_bump(unsigned int qidx)
-{
-	unsigned int offset = qidx;
-	uint32_t status, trigger;
-
-	status = get(AR9170_MAC_REG_DMA_STATUS) >> 12;
-	trigger = get(AR9170_MAC_REG_DMA_TRIGGER) >> 12;
-
-	while (offset != 0) {
-		status >>= 4;
-		trigger >>= 4;
-		offset--;
-	}
-
-	status &= 0xf;
-	trigger &= 0xf;
-
-	if ((trigger == 0xa) && (status == 0x8)) {
-		DBG("UNSTUCK");
-		wlan_txunstuck(qidx);
-	} else {
-		DBG("UPDATE");
-		wlan_txupdate(qidx);
-	}
-}
-
 #ifdef CONFIG_CARL9170FW_DEBUG
 static void wlan_dump_queue(unsigned int qidx)
 {
@@ -181,7 +155,7 @@ static void wlan_tx_complete(struct carl9170_tx_superframe *super,
 static bool wlan_tx_consume_retry(struct carl9170_tx_superframe *super)
 {
 	/* check if this was the last possible retry with this rate */
-	if (unlikely(super->s.cnt >= super->s.tries[super->s.rix])) {
+	if (unlikely(super->s.cnt >= super->s.ri[super->s.rix].tries)) {
 		/* end of the road - indicate tx failure */
 		if (unlikely(super->s.rix == CARL9170_TX_MAX_RETRY_RATES))
 			return false;
@@ -196,6 +170,10 @@ static bool wlan_tx_consume_retry(struct carl9170_tx_superframe *super)
 		/* finally - mark the old rate as USED */
 		super->s.rix++;
 
+		/* update MAC flags */
+		super->f.hdr.mac.erp_prot = super->s.ri[super->s.rix].erp_prot;
+		super->f.hdr.mac.ampdu = super->s.ri[super->s.rix].ampdu;
+
 		/* reinitialize try counter */
 		super->s.cnt = 1;
 	} else {
@@ -287,7 +265,10 @@ static bool wlan_tx_status(struct dma_queue *queue,
 
 	success = true;
 
-	if (!!(desc->ctrl & AR9170_CTRL_FAIL_MASK)) {
+	/* update hangcheck */
+	fw.wlan.last_tx_desc_num[qidx] = 0;
+
+	if (!!(desc->ctrl & AR9170_CTRL_FAIL)) {
 		txfail = !!(desc->ctrl & AR9170_CTRL_TXFAIL);
 
 		/* reset retry indicator flags */
@@ -364,9 +345,6 @@ static bool wlan_tx_status(struct dma_queue *queue,
 
 	unhide_super(desc);
 
-	/* update hangcheck */
-	fw.wlan.last_tx_desc_num[qidx] = 0;
-
 #ifdef CONFIG_CARL9170FW_HANDLE_BACK_REQ
 	if (unlikely(super == (void *) &dma_mem.reserved.ba)) {
 		fw.wlan.ba_desc = desc;
@@ -379,7 +357,7 @@ static bool wlan_tx_status(struct dma_queue *queue,
 
 #ifdef CONFIG_CARL9170FW_CAB_QUEUE
 	if (unlikely(super->s.cab))
-		fw.wlan.cab_queue_len--;
+		fw.wlan.cab_queue_len[super->s.vif_id]--;
 #endif /* CONFIG_CARL9170FW_CAB_QUEUE */
 
 	/* recycle freed descriptors */
@@ -429,8 +407,8 @@ void __hot wlan_tx(struct dma_desc *desc)
 
 #ifdef CONFIG_CARL9170FW_CAB_QUEUE
 	if (unlikely(super->s.cab)) {
-		fw.wlan.cab_queue_len++;
-		dma_put(&fw.wlan.cab_queue, desc);
+		fw.wlan.cab_queue_len[super->s.vif_id]++;
+		dma_put(&fw.wlan.cab_queue[super->s.vif_id], desc);
 		return;
 	}
 #endif /* CONFIG_CARL9170FW_CAB_QUEUE */
@@ -467,7 +445,7 @@ static void wlan_send_buffered_ba(void)
 		sizeof(struct ar9170_tx_hwdesc) +
 		sizeof(struct ieee80211_ba);
 
-	baf->s.tries[0] = 3;
+	baf->s.ri[0].tries = 3;
 	baf->s.queue = 0;
 	baf->f.hdr.length = sizeof(struct ieee80211_ba) + FCS_LEN;
 
@@ -587,6 +565,8 @@ static void wlan_check_rx_overrun(void)
 			DBG("RX Overrun");
 			fw.wlan.mac_reset++;
 		}
+
+		wlan_trigger(AR9170_DMA_TRIGGER_RXQ);
 	}
 }
 
@@ -594,8 +574,6 @@ static void handle_rx(void)
 {
 	struct dma_desc *desc;
 
-	wlan_check_rx_overrun();
-
 	for_each_desc_not_bits(desc, &fw.wlan.rx_queue, AR9170_OWN_BITS_HW) {
 		if (unlikely(desc->totalLen < 26 ||
 		    desc->totalLen > CONFIG_CARL9170FW_RX_FRAME_LEN)) {
@@ -617,6 +595,36 @@ static void handle_rx(void)
 }
 
 #ifdef CONFIG_CARL9170FW_CAB_QUEUE
+void wlan_cab_flush_queue(const unsigned int vif)
+{
+	struct dma_queue *cab_queue = &fw.wlan.cab_queue[vif];
+	struct dma_desc *desc;
+
+	/* move queued frames into the main tx queues */
+	for_each_desc(desc, cab_queue) {
+		struct carl9170_tx_superframe *super = get_super(desc);
+		if (!queue_empty(cab_queue)) {
+			/*
+			 * Set MOREDATA flag for all,
+			 * but the last queued frame.
+			 * see: 802.11-2007 11.2.1.5 f)
+			 *
+			 * This is actually the reason to why
+			 * we need to prevent the reentry.
+			 */
+
+			super->f.data.i3e.frame_control |=
+				cpu_to_le16(IEEE80211_FCTL_MOREDATA);
+		} else {
+			super->f.data.i3e.frame_control &=
+				cpu_to_le16(~IEEE80211_FCTL_MOREDATA);
+		}
+
+		/* ready to roll! */
+		_wlan_tx(desc);
+	}
+}
+
 static uint8_t *beacon_find_ie(uint8_t ie)
 {
 	struct ieee80211_mgmt *mgmt = getp(AR9170_MAC_REG_BCN_ADDR);
@@ -643,60 +651,7 @@ static uint8_t *beacon_find_ie(uint8_t ie)
 	return NULL;
 }
 
-static void wlan_cab_flush_queue(void)
-{
-	struct dma_desc *desc;
-	uint8_t *_ie;
-	struct ieee80211_tim_ie *ie;
-
-	/*
-	 * This prevents the code from sending new BC/MC frames
-	 * which were queued after the previous buffered traffic
-	 * has been sent out... They will have to wait until the
-	 * next DTIM beacon comes along.
-	 */
-	if (unlikely(fw.wlan.cab_flush_trigger == CARL9170_CAB_TRIGGER_DEFER))
-		return ;
-
-	_ie = beacon_find_ie(WLAN_EID_TIM);
-	if (unlikely(!_ie))
-		return ;
-
-	ie = (struct ieee80211_tim_ie *) &_ie[2];
-
-	/* Ideally, check here for == AR9170_CAB_TRIGGER_ARMED */
-	if (fw.wlan.cab_flush_trigger) {
-		/* move queued frames into the main tx queues */
-		for_each_desc(desc, &fw.wlan.cab_queue) {
-			struct carl9170_tx_superframe *super = get_super(desc);
-
-			if (!queue_empty(&fw.wlan.cab_queue)) {
-				/*
-				 * Set MOREDATA flag for all,
-				 * but the last queued frame.
-				 * see: 802.11-2007 11.2.1.5 f)
-				 *
-				 * This is actually the reason to why
-				 * we need to prevent the reentry.
-				 */
-
-				super->f.data.i3e.frame_control |=
-					cpu_to_le16(IEEE80211_FCTL_MOREDATA);
-			} else {
-				super->f.data.i3e.frame_control &=
-					cpu_to_le16(~IEEE80211_FCTL_MOREDATA);
-			}
-
-			/* ready to roll! */
-			_wlan_tx(desc);
-		}
-	}
-
-	/* Transfer finished - waiting for tx status */
-	fw.wlan.cab_flush_trigger = CARL9170_CAB_TRIGGER_DEFER;
-}
-
-static void wlan_cab_modify_dtim_beacon(void)
+void wlan_cab_modify_dtim_beacon(const unsigned int vif)
 {
 	uint8_t *_ie;
 	struct ieee80211_tim_ie *ie;
@@ -705,16 +660,17 @@ static void wlan_cab_modify_dtim_beacon(void)
 	if (likely(_ie)) {
 		ie = (struct ieee80211_tim_ie *) &_ie[2];
 
-		if (!queue_empty(&fw.wlan.cab_queue) && (ie->dtim_count == 0)) {
+		if (!queue_empty(&fw.wlan.cab_queue[vif]) && (ie->dtim_count == 0)) {
 			/* schedule DTIM transfer */
-			fw.wlan.cab_flush_trigger = CARL9170_CAB_TRIGGER_ARMED;
-		} else if ((fw.wlan.cab_queue_len == 0) && (fw.wlan.cab_flush_trigger)) {
+			fw.wlan.cab_flush_trigger[vif] = CARL9170_CAB_TRIGGER_ARMED;
+		} else if ((fw.wlan.cab_queue_len[vif] == 0) && (fw.wlan.cab_flush_trigger[vif])) {
 			/* undo all chances to the beacon structure */
 			ie->bitmap_ctrl &= ~0x1;
-			fw.wlan.cab_flush_trigger = CARL9170_CAB_TRIGGER_EMPTY;
+			fw.wlan.cab_flush_trigger[vif] = CARL9170_CAB_TRIGGER_EMPTY;
 		}
 
-		if (fw.wlan.cab_flush_trigger) {
+		/* Triggered by CARL9170_CAB_TRIGGER_ARMED || CARL9170_CAB_TRIGGER_DEFER */
+		if (fw.wlan.cab_flush_trigger[vif]) {
 			/* Set the almighty Multicast Traffic Indication Bit. */
 			ie->bitmap_ctrl |= 0x1;
 		}
@@ -726,19 +682,11 @@ static void handle_beacon_config(void)
 {
 	uint32_t bcn_count;
 
-#ifdef CONFIG_CARL9170FW_CAB_QUEUE
-	/*
-	 * The application has now updated the relevant beacon data.
-	 * Now it should be the perfect time to apply the DTIM
-	 * multicast information.
-	 */
-
-	wlan_cab_modify_dtim_beacon();
-#endif /* CONFIG_CARL9170FW_CAB_QUEUE */
-
 	bcn_count = get(AR9170_MAC_REG_BCN_COUNT);
 	send_cmd_to_host(4, CARL9170_RSP_BEACON_CONFIG, 0x00,
 			 (uint8_t *) &bcn_count);
+
+	set(AR9170_MAC_REG_BCN_CTRL, AR9170_BCN_CTRL_READY);
 }
 
 static void handle_pretbtt(void)
@@ -755,7 +703,6 @@ static void handle_pretbtt(void)
 #else
 	send_cmd_to_host(0, CARL9170_RSP_PRETBTT, 0x00, NULL);
 #endif /* CONFIG_CARL9170FW_PSM */
-
 }
 
 static void handle_atim(void)
@@ -782,21 +729,33 @@ static void handle_radar(void)
 static void wlan_janitor(void)
 {
 #ifdef CONFIG_CARL9170FW_CAB_QUEUE
-	if (unlikely(fw.wlan.cab_flush_trigger)) {
-		/*
-		 * This is hardcoded into carl9170usb driver.
-		 *
-		 * The driver must set the PRETBTT event to beacon_interval -
-		 * CARL9170_PRETBTT_KUS (usually 6) Kus.
-		 *
-		 * But still, we can only do so much about 802.11-2007 9.3.2.1 &
-		 * 11.2.1.6. Let's hope the current solution is adequate enough.
-		 */
+	unsigned int i;
 
-		if (is_after_msecs(fw.wlan.cab_flush_time,
-		    (CARL9170_TBTT_DELTA))) {
-			wlan_cab_flush_queue();
+	for (i = 0; i < CARL9170_INTF_NUM; i++) {
+		if (unlikely(fw.wlan.cab_flush_trigger[i] == CARL9170_CAB_TRIGGER_ARMED)) {
+			/*
+			 * This is hardcoded into carl9170usb driver.
+			 *
+			 * The driver must set the PRETBTT event to beacon_interval -
+			 * CARL9170_PRETBTT_KUS (usually 6) Kus.
+			 *
+			 * But still, we can only do so much about 802.11-2007 9.3.2.1 &
+			 * 11.2.1.6. Let's hope the current solution is adequate enough.
+			 */
+
+			if (is_after_msecs(fw.wlan.cab_flush_time, (CARL9170_TBTT_DELTA))) {
+				wlan_cab_flush_queue(i);
+
+				/*
+				 * This prevents the code from sending new BC/MC frames
+				 * which were queued after the previous buffered traffic
+				 * has been sent out... They will have to wait until the
+				 * next DTIM beacon comes along.
+				 */
+				fw.wlan.cab_flush_trigger[i] = CARL9170_CAB_TRIGGER_DEFER;
+			}
 		}
+
 	}
 #endif /* CONFIG_CARL9170FW_CAB_QUEUE */
 
@@ -854,6 +813,32 @@ void handle_wlan(void)
 #undef HANDLER
 }
 
+static void wlan_dma_bump(unsigned int qidx)
+{
+	unsigned int offset = qidx;
+	uint32_t status, trigger;
+
+	status = get(AR9170_MAC_REG_DMA_STATUS) >> 12;
+	trigger = get(AR9170_MAC_REG_DMA_TRIGGER) >> 12;
+
+	while (offset != 0) {
+		status >>= 4;
+		trigger >>= 4;
+		offset--;
+	}
+
+	status &= 0xf;
+	trigger &= 0xf;
+
+	if ((trigger == 0xa) && (status == 0x8)) {
+		DBG("UNSTUCK");
+		wlan_txunstuck(qidx);
+	} else {
+		DBG("UPDATE");
+		wlan_txupdate(qidx);
+	}
+}
+
 static void wlan_check_hang(void)
 {
 	struct dma_desc *desc;
@@ -913,6 +898,7 @@ static void wlan_check_hang(void)
 	}
 }
 
+#ifdef CONFIG_CARL9170FW_FW_MAC_RESET
 /*
  * NB: Resetting the MAC is a two-edged sword.
  * On most occasions, it does what it is supposed to do.
@@ -935,7 +921,7 @@ static void wlan_mac_reset(void)
 	uint32_t rx_BB;
 #endif /* CONFIG_CARL9170FW_RADIO_FUNCTIONS */
 
-	ERR("MAC RESET");
+	INFO("MAC RESET");
 
 	/* Save aggregation parameters */
 	agg_wait_counter = get(AR9170_MAC_REG_AMPDU_FACTOR);
@@ -1015,6 +1001,13 @@ static void wlan_mac_reset(void)
 	set(AR9170_MAC_REG_DMA_RXQ_ADDR, (uint32_t) fw.wlan.rx_queue.head);
 	wlan_trigger(AR9170_DMA_TRIGGER_RXQ);
 }
+#else
+static void wlan_mac_reset(void)
+{
+	/* The driver takes care of reinitializing the device */
+	BUG("MAC RESET");
+}
+#endif /* CONFIG_CARL9170FW_FW_MAC_RESET */
 
 void __cold wlan_timer(void)
 {