X-Git-Url: https://jxself.org/git/?a=blobdiff_plain;f=carlfw%2Fsrc%2Fcmd.c;h=587a826cee6372dca2a72e0dd474c50d7a101052;hb=65dd584c008fdc28e8398bacfdb311b19ae80507;hp=e04e8da486b44dfac8eafe62374cb4cd595a6831;hpb=95e0b3d5f76e191546422c4dbb7afd2ad679ff8d;p=carl9170fw.git

diff --git a/carlfw/src/cmd.c b/carlfw/src/cmd.c
index e04e8da..587a826 100644
--- a/carlfw/src/cmd.c
+++ b/carlfw/src/cmd.c
@@ -82,9 +82,15 @@ void handle_cmd(struct carl9170_rsp *resp)
 #ifdef CONFIG_CARL9170FW_CAB_QUEUE
 	case CARL9170_CMD_FLUSH_CAB:
 		resp->hdr.len = 0;
-		fw.wlan.cab_flush_trigger = CARL9170_CAB_TRIGGER_ARMED;
-		fw.wlan.cab_flush_time = get_clock_counter() +
-					 CARL9170_TBTT_DELTA;
+
+		if (cmd->cab_flush.mode & CARL9170_CAB_FLUSH_CAB_TRIGGER) {
+			wlan_cab_modify_dtim_beacon(cmd->cab_flush.vif_id);
+			set(AR9170_MAC_REG_BCN_CTRL, AR9170_BCN_CTRL_READY);
+		} else {
+			wlan_cab_flush_queue(cmd->cab_flush.vif_id);
+			if (fw.wlan.cab_flush_vif == cmd->cab_flush.vif_id)
+				fw.wlan.cab_flush_trigger = CARL9170_CAB_TRIGGER_EMPTY;
+		}
 		break;
 #endif /* CONFIG_CARL9170FW_CAB_QUEUE */