if_ath: ath_tgt_send_beacon assert if beacon exist

[open-ath9k-htc-firmware.git] / target_firmware / wlan / if_ath.c

diff --git a/target_firmware/wlan/if_ath.c b/target_firmware/wlan/if_ath.c
index 78a02e1a3bb2a1652ea2f02f49f9d2008ea36ac8..b251940fed5dfba795ca6d2cba8610ad6c39cffd 100755 (executable)
--- a/target_firmware/wlan/if_ath.c
+++ b/target_firmware/wlan/if_ath.c
@@ -56,6 +56,8 @@
 #include "if_athvar.h"
 #include "ah_desc.h"
 #include "ah.h"
+#include "ratectrl.h"
+#include "ah_internal.h"
 
 static a_int32_t ath_numrxbufs = -1;
 static a_int32_t ath_numrxdescs = -1;
@@ -93,6 +95,8 @@ void ath_tgt_tx_sched_nonaggr(struct ath_softc_tgt *sc,struct ath_buf * bf_host)
  * extend(0x0000001200000004, 0x00000006) == 0x0000001200000006
  * extend(0x0000001200000004, 0x00000002) == 0x0000001200000002
  * extend(0x0000001200000004, 0xfffffffe) == 0x00000011fffffffe  ! tsfhigh--
+ * extend(0x000000127ffffffe, 0x80000002) == 0x0000001280000002
+ * extend(0x0000001280000002, 0x7ffffffe) == 0x000000127ffffffe
  * extend(0x00000012fffffffc, 0xfffffffe) == 0x00000012fffffffe
  * extend(0x00000012fffffffc, 0xfffffffa) == 0x00000012fffffffa
  * extend(0x00000012fffffffc, 0x00000002) == 0x0000001300000002  ! tsfhigh++
@@ -101,13 +105,13 @@ static u_int64_t ath_extend_tsf(struct ath_softc_tgt *sc, u_int32_t rstamp)
 {
        struct ath_hal *ah = sc->sc_ah;
        u_int64_t tsf;
-       a_int32_t tsf_low;
+       u_int32_t tsf_low;
        a_int64_t tsf_delta;  /* signed int64 */
 
        tsf = ah->ah_getTsf64(ah);
-       tsf_low = tsf & 0xffffffff;
+       tsf_low = tsf & 0xffffffffUL;
 
-       tsf_delta = (a_int32_t)rstamp - (a_int64_t)tsf_low;
+       tsf_delta = (a_int32_t)((rstamp - tsf_low) & 0xffffffffUL);
 
        return (tsf + (u_int64_t)tsf_delta);
 }
@@ -325,13 +329,11 @@ static void ath_uapsd_processtriggers(struct ath_softc_tgt *sc)
        a_int32_t retval;
        a_uint32_t cnt = 0;
        a_uint16_t frame_len = 0;
-       a_uint64_t tsf;
 
 #define        PA2DESC(_sc, _pa)                                               \
        ((struct ath_desc *)((caddr_t)(_sc)->sc_rxdma.dd_desc +         \
                             ((_pa) - (_sc)->sc_rxdma.dd_desc_paddr)))
 
-       tsf = ah->ah_getTsf64(ah);
        bf = asf_tailq_first(&sc->sc_rxbuf);
 
        ds = asf_tailq_first(&sc->sc_rxdesc);
@@ -581,24 +583,21 @@ static void ath_tgt_send_beacon(struct ath_softc_tgt *sc, adf_nbuf_t bc_hdr,
        struct ath_hal *ah = sc->sc_ah;
        struct ath_tx_buf *bf;
        a_uint8_t vap_index, *anbdata;
-       ath_beacon_hdr_t *bhdr;
-       struct ieee80211vap_target  *vap;
+       ath_beacon_hdr_t *bhdr = NULL;
        a_uint32_t anblen;
-       struct ieee80211_frame *wh;
 
        if (!bc_hdr) {
                adf_nbuf_peek_header(nbuf, &anbdata, &anblen);
                bhdr = (ath_beacon_hdr_t *)anbdata;
        } else {
                adf_os_print("found bc_hdr! 0x%x\n", bc_hdr);
+               adf_os_assert(0);
        }
 
        vap_index = bhdr->vap_index;
        adf_os_assert(vap_index < TARGET_VAP_MAX);
-       vap = &sc->sc_vap[vap_index].av_vap;
 
-       wh = (struct ieee80211_frame *)adf_nbuf_pull_head(nbuf,
-                                                 sizeof(ath_beacon_hdr_t));
+       adf_nbuf_pull_head(nbuf, sizeof(ath_beacon_hdr_t));
 
        bf = sc->sc_vap[vap_index].av_bcbuf;
        adf_os_assert(bf);
@@ -872,7 +871,6 @@ static void ath_descdma_cleanup(struct ath_softc_tgt *sc,
                                ath_bufhead *head, a_int32_t dir)
 {
        struct ath_buf *bf;
-       struct ieee80211_node_target *ni;
 
        asf_tailq_foreach(bf, head, bf_list) {
                if (adf_nbuf_queue_len(&bf->bf_skbhead) != 0) {
@@ -890,7 +888,6 @@ static void ath_descdma_cleanup(struct ath_softc_tgt *sc,
 
                adf_nbuf_dmamap_destroy(sc->sc_dev, bf->bf_dmamap);
 
-               ni = bf->bf_node;
                bf->bf_node = NULL;
        }
 
@@ -1102,9 +1099,9 @@ static void ath_enable_intr_tgt(void *Context, A_UINT16 Command,
 {
        struct ath_softc_tgt *sc = (struct ath_softc_tgt *)Context;
        struct ath_hal *ah = sc->sc_ah;
-       a_uint32_t intr;
+       a_uint32_t intr = 0;
 
-       if (data)
+       if (datalen == 4)
                intr = (*(a_uint32_t *)data);
 
        intr = adf_os_ntohl(intr);
@@ -1617,11 +1614,14 @@ static void ath_stop_tx_dma_tgt(void *Context, A_UINT16 Command,
        struct ath_hal *ah = sc->sc_ah;
        a_uint32_t q;
 
-       if (data)
-               q = *(a_uint32_t *)data;
+       if (!datalen)
+               goto done;
+
+       q = *(a_uint32_t *)data;
 
        q = adf_os_ntohl(q);
        ah->ah_stopTxDma(ah, q);
+done:
        wmi_cmd_rsp(sc->tgt_wmi_handle, Command, SeqNo, NULL, 0);
 }