Author: adrian
Date: Sat Nov 17 01:11:00 2012
New Revision: 243166
URL: http://svnweb.freebsd.org/changeset/base/243166

Log:
  Implement a basic data decoder for the data produced by if_ath_alq.
  
  This decodes the AR5416 family 11n TX and RX descriptors.

Added:
  head/tools/tools/ath/athalq/
  head/tools/tools/ath/athalq/Makefile   (contents, props changed)
  head/tools/tools/ath/athalq/ar5416_ds.c   (contents, props changed)
  head/tools/tools/ath/athalq/ar5416_ds.h   (contents, props changed)
  head/tools/tools/ath/athalq/main.c   (contents, props changed)

Added: head/tools/tools/ath/athalq/Makefile
==============================================================================
--- /dev/null   00:00:00 1970   (empty, because file is newly added)
+++ head/tools/tools/ath/athalq/Makefile        Sat Nov 17 01:11:00 2012        
(r243166)
@@ -0,0 +1,10 @@
+# $FreeBSD$
+
+PROG=  athalq
+NOMAN= yes
+
+SRCS=  main.c ar5416_ds.c
+
+.include <../Makefile.inc>
+
+.include <bsd.prog.mk>

Added: head/tools/tools/ath/athalq/ar5416_ds.c
==============================================================================
--- /dev/null   00:00:00 1970   (empty, because file is newly added)
+++ head/tools/tools/ath/athalq/ar5416_ds.c     Sat Nov 17 01:11:00 2012        
(r243166)
@@ -0,0 +1,356 @@
+/*
+ * Copyright (c) 2012 Adrian Chadd <adr...@freebsd.org>
+ * All Rights Reserved.
+ *
+ * Permission to use, copy, modify, and/or distribute this software for any
+ * purpose with or without fee is hereby granted, provided that the above
+ * copyright notice and this permission notice appear in all copies.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
+ * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
+ * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
+ * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
+ * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
+ * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+ */
+
+#include <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <fcntl.h>
+#include <errno.h>
+#include <string.h>
+
+#include <sys/types.h>
+#include <sys/alq.h>
+#include <sys/endian.h>
+
+#include <dev/ath/if_ath_alq.h>
+#include <dev/ath/ath_hal/ar5416/ar5416desc.h>
+
+#include "ar5416_ds.h"
+
+#define        MS(_v, _f)      ( ((_v) & (_f)) >> _f##_S )
+#define        MF(_v, _f) ( !! ((_v) & (_f)))
+
+static void
+ar5416_decode_txstatus(struct if_ath_alq_payload *a)
+{
+       struct ar5416_desc txs;
+
+       /* XXX assumes txs is smaller than PAYLOAD_LEN! */
+       memcpy(&txs, &a->payload, sizeof(struct ar5416_desc));
+
+       printf("[%u] [%llu] TXSTATUS\n",
+           (unsigned int) be32toh(a->hdr.tstamp),
+           (unsigned long long) be64toh(a->hdr.threadid));
+
+       /* ds_txstatus0 */
+       printf("    RX RSSI 0 [%d %d %d]\n",
+           MS(txs.u.tx.status[0], AR_TxRSSIAnt00),
+           MS(txs.u.tx.status[0], AR_TxRSSIAnt01),
+           MS(txs.u.tx.status[0], AR_TxRSSIAnt02));
+       printf("    BA Valid=%d\n",
+           MF(txs.u.tx.status[0], AR_TxBaStatus));
+
+       /* ds_txstatus1 */
+       printf("    Frmok=%d, xretries=%d, fifounderrun=%d, filt=%d\n",
+           MF(txs.u.tx.status[1], AR_FrmXmitOK),
+           MF(txs.u.tx.status[1], AR_ExcessiveRetries),
+           MF(txs.u.tx.status[1], AR_FIFOUnderrun),
+           MF(txs.u.tx.status[1], AR_Filtered));
+       printf("    DelimUnderrun=%d, DataUnderun=%d, DescCfgErr=%d,"
+           " TxTimerExceeded=%d\n",
+           MF(txs.u.tx.status[1], AR_TxDelimUnderrun),
+           MF(txs.u.tx.status[1], AR_TxDataUnderrun),
+           MF(txs.u.tx.status[1], AR_DescCfgErr),
+           MF(txs.u.tx.status[1], AR_TxTimerExpired));
+
+       printf("    RTScnt=%d, FailCnt=%d, VRetryCnt=%d\n",
+           MS(txs.u.tx.status[1], AR_RTSFailCnt),
+           MS(txs.u.tx.status[1], AR_DataFailCnt),
+           MS(txs.u.tx.status[1], AR_VirtRetryCnt));
+
+       /* ds_txstatus2 */
+       printf("    TxTimestamp=0x%08x\n", txs.u.tx.status[2]);
+
+       /* ds_txstatus3 */
+       /* ds_txstatus4 */
+       printf("    BALow=0x%08x\n", txs.u.tx.status[3]);
+       printf("    BAHigh=0x%08x\n", txs.u.tx.status[4]);
+
+       /* ds_txstatus5 */
+       printf("    RX RSSI 1 [%d %d %d] Comb=%d\n",
+           MS(txs.u.tx.status[5], AR_TxRSSIAnt10),
+           MS(txs.u.tx.status[5], AR_TxRSSIAnt11),
+           MS(txs.u.tx.status[5], AR_TxRSSIAnt12),
+           MS(txs.u.tx.status[5], AR_TxRSSICombined));
+
+       /* ds_txstatus6 */
+       /* ds_txstatus7 */
+       /* ds_txstatus8 */
+       printf("    TxEVM[0]=0x%08x, TxEVM[1]=0x%08x, TxEVM[2]=0x%08x\n",
+           txs.u.tx.status[6],
+           txs.u.tx.status[7],
+           txs.u.tx.status[8]);
+
+       /* ds_txstatus9 */
+       printf("    TxDone=%d, SeqNum=0x%04x, TxOpExceeded=%d, FinalTsIdx=%d\n",
+           MF(txs.u.tx.status[9], AR_TxDone),
+           MS(txs.u.tx.status[9], AR_SeqNum),
+           MF(txs.u.tx.status[9], AR_TxOpExceeded),
+           MS(txs.u.tx.status[9], AR_FinalTxIdx));
+       printf("    PowerMgmt=%d, TxTid=%d\n",
+           MF(txs.u.tx.status[9], AR_PowerMgmt),
+           MS(txs.u.tx.status[9], AR_TxTid));
+
+       printf("\n ------\n");
+}
+
+static void
+ar5416_decode_txdesc(struct if_ath_alq_payload *a)
+{
+       struct ar5416_desc txc;
+
+       /* XXX assumes txs is smaller than PAYLOAD_LEN! */
+       memcpy(&txc, &a->payload, sizeof(struct ar5416_desc));
+
+       printf("[%u] [%llu] TXD\n",
+           (unsigned int) be32toh(a->hdr.tstamp),
+           (unsigned long long) be64toh(a->hdr.threadid));
+
+       printf("  link=0x%08x, data=0x%08x\n",
+           txc.ds_link,
+           txc.ds_data);
+
+       /* ds_ctl0 */
+       printf("    Frame Len=%d, VMF=%d\n",
+            txc.ds_ctl0 & AR_FrameLen,
+           MF(txc.ds_ctl0, AR_VirtMoreFrag));
+       printf("    TX power0=%d, RtsEna=%d, Veol=%d, ClrDstMask=%d\n",
+           MS(txc.ds_ctl0, AR_XmitPower),
+           MF(txc.ds_ctl0, AR_RTSEnable),
+           MF(txc.ds_ctl0, AR_VEOL),
+           MF(txc.ds_ctl0, AR_ClrDestMask));
+       printf("    TxIntrReq=%d, DestIdxValid=%d, CtsEnable=%d\n",
+           MF(txc.ds_ctl0, AR_TxIntrReq),
+           MF(txc.ds_ctl0, AR_DestIdxValid),
+           MF(txc.ds_ctl0, AR_CTSEnable));
+
+       /* ds_ctl1 */
+       printf("    BufLen=%d, TxMore=%d, DestIdx=%d,"
+           " FrType=0x%x\n",
+           txc.ds_ctl1 & AR_BufLen,
+           MF(txc.ds_ctl1, AR_TxMore),
+           MS(txc.ds_ctl1, AR_DestIdx),
+           MS(txc.ds_ctl1, AR_FrameType));
+       printf("    NoAck=%d, InsertTs=%d, CorruptFcs=%d, ExtOnly=%d,"
+           " ExtAndCtl=%d\n",
+           MF(txc.ds_ctl1, AR_NoAck),
+           MF(txc.ds_ctl1, AR_InsertTS),
+           MF(txc.ds_ctl1, AR_CorruptFCS),
+           MF(txc.ds_ctl1, AR_ExtOnly),
+           MF(txc.ds_ctl1, AR_ExtAndCtl));
+       printf("    MoreAggr=%d, IsAggr=%d, MoreRifs=%d\n",
+           MF(txc.ds_ctl1, AR_MoreAggr),
+           MF(txc.ds_ctl1, AR_IsAggr),
+           MF(txc.ds_ctl1, AR_MoreRifs));
+
+       /* ds_ctl2 */
+       printf("    DurUpEna=%d, Burstdur=0x%04x\n",
+           MF(txc.ds_ctl2, AR_DurUpdateEn),
+           MS(txc.ds_ctl2, AR_BurstDur));
+       printf("    Try0=%d, Try1=%d, Try2=%d, Try3=%d\n",
+           MS(txc.ds_ctl2, AR_XmitDataTries0),
+           MS(txc.ds_ctl2, AR_XmitDataTries1),
+           MS(txc.ds_ctl2, AR_XmitDataTries2),
+           MS(txc.ds_ctl2, AR_XmitDataTries3));
+
+       /* ds_ctl3 */
+       printf("    rate0=0x%02x, rate1=0x%02x, rate2=0x%02x, rate3=0x%02x\n",
+           MS(txc.ds_ctl3, AR_XmitRate0),
+           MS(txc.ds_ctl3, AR_XmitRate1),
+           MS(txc.ds_ctl3, AR_XmitRate2),
+           MS(txc.ds_ctl3, AR_XmitRate3));
+
+       /* ds_ctl4 */
+       printf("    try 0: PktDur=%d, RTS/CTS ena=%d\n",
+           MS(txc.ds_ctl4, AR_PacketDur0),
+           MF(txc.ds_ctl4, AR_RTSCTSQual0));
+       printf("    try 1: PktDur=%d, RTS/CTS ena=%d\n",
+           MS(txc.ds_ctl4, AR_PacketDur1),
+           MF(txc.ds_ctl4, AR_RTSCTSQual1));
+
+       /* ds_ctl5 */
+       printf("    try 2: PktDur=%d, RTS/CTS ena=%d\n",
+           MS(txc.ds_ctl5, AR_PacketDur2),
+           MF(txc.ds_ctl5, AR_RTSCTSQual2));
+       printf("    try 3: PktDur=%d, RTS/CTS ena=%d\n",
+           MS(txc.ds_ctl5, AR_PacketDur3),
+           MF(txc.ds_ctl5, AR_RTSCTSQual3));
+
+       /* ds_ctl6 */
+       printf("    AggrLen=%d, PadDelim=%d, EncrType=%d\n",
+           MS(txc.ds_ctl6, AR_AggrLen),
+           MS(txc.ds_ctl6, AR_PadDelim),
+           MS(txc.ds_ctl6, AR_EncrType));
+
+       /* ds_ctl7 */
+       printf("    try 0: chainMask=0x%x, GI=%d, 2040=%d, STBC=%d\n",
+           MS(txc.ds_ctl7, AR_ChainSel0),
+           MF(txc.ds_ctl7, AR_GI0),
+           MF(txc.ds_ctl7, AR_2040_0),
+           MF(txc.ds_ctl7, AR_STBC0));
+       printf("    try 1: chainMask=0x%x, GI=%d, 2040=%d, STBC=%d\n",
+           MS(txc.ds_ctl7, AR_ChainSel1),
+           MF(txc.ds_ctl7, AR_GI1),
+           MF(txc.ds_ctl7, AR_2040_1),
+           MF(txc.ds_ctl7, AR_STBC1));
+       printf("    try 2: chainMask=0x%x, GI=%d, 2040=%d, STBC=%d\n",
+           MS(txc.ds_ctl7, AR_ChainSel2),
+           MF(txc.ds_ctl7, AR_GI2),
+           MF(txc.ds_ctl7, AR_2040_2),
+           MF(txc.ds_ctl7, AR_STBC2));
+       printf("    try 3: chainMask=0x%x, GI=%d, 2040=%d, STBC=%d\n",
+           MS(txc.ds_ctl7, AR_ChainSel3),
+           MF(txc.ds_ctl7, AR_GI3),
+           MF(txc.ds_ctl7, AR_2040_3),
+           MF(txc.ds_ctl7, AR_STBC3));
+
+       /* ds_ctl8 */
+       printf("    try 0: ant=0x%08x\n", txc.ds_ctl8 &  AR_AntCtl0);
+
+       /* ds_ctl9 */
+       printf("    try 1: TxPower=%d, ant=0x%08x\n",
+           MS(txc.ds_ctl9, AR_XmitPower1),
+           txc.ds_ctl9 & AR_AntCtl1);
+
+       /* ds_ctl10 */
+       printf("    try 2: TxPower=%d, ant=0x%08x\n",
+           MS(txc.ds_ctl10, AR_XmitPower2),
+           txc.ds_ctl10 & AR_AntCtl2);
+
+       /* ds_ctl11 */
+       printf("    try 3: TxPower=%d, ant=0x%08x\n",
+           MS(txc.ds_ctl11, AR_XmitPower3),
+           txc.ds_ctl11 & AR_AntCtl3);
+
+       printf("\n ------ \n");
+}
+
+static void
+ar5416_decode_rxstatus(struct if_ath_alq_payload *a)
+{
+       struct ar5416_desc rxs;
+
+       /* XXX assumes rxs is smaller than PAYLOAD_LEN! */
+       memcpy(&rxs, &a->payload, sizeof(struct ar5416_desc));
+
+       printf("[%u] [%llu] RXSTATUS\n",
+           (unsigned int) be32toh(a->hdr.tstamp),
+           (unsigned long long) be64toh(a->hdr.threadid));
+
+       printf("  link=0x%08x, data=0x%08x, ctl0=0x%08x, ctl2=0x%08x\n",
+           rxs.ds_link,
+           rxs.ds_data,
+           rxs.ds_ctl0,
+           rxs.ds_ctl1);
+
+       /* status0 */
+       /*
+        * XXX TODO: For AR9285, the chain 1 and chain 2 RSSI values
+        * acutally contain the RX mixer configuration
+        */
+       printf("  RSSICtl[0]=%d, RSSICtl[1]=%d, RSSICtl[2]=%d\n",
+           MS(rxs.ds_rxstatus0, AR_RxRSSIAnt00),
+           MS(rxs.ds_rxstatus0, AR_RxRSSIAnt01),
+           MS(rxs.ds_rxstatus0, AR_RxRSSIAnt02));
+
+       /* status1 */
+       printf("  DataLen=%d, RxMore=%d, NumDelim=%d\n",
+           rxs.ds_rxstatus1 & AR_DataLen,
+           MF(rxs.ds_rxstatus1, AR_RxMore),
+           MS(rxs.ds_rxstatus1, AR_NumDelim));
+
+       /* status2 */
+       printf("  RxTimestamp=0x%08x\n", rxs.ds_rxstatus2);
+
+       /* status3 - RxRate however is for Owl 2.0 */
+       printf("  GI=%d, 2040=%d, RxRate=0x%02x, DupFrame=%d, RxAnt=0x%08x\n",
+           MF(rxs.ds_rxstatus3, AR_GI),
+           MF(rxs.ds_rxstatus3, AR_2040),
+           MS(rxs.ds_rxstatus0, AR_RxRate),
+           MF(rxs.ds_rxstatus3, AR_DupFrame),
+           MS(rxs.ds_rxstatus3, AR_RxAntenna));
+
+       /* status4 */
+       printf("  RSSIExt[0]=%d, RSSIExt[1]=%d, RSSIExt[2]=%d, RSSIComb=%d\n",
+           MS(rxs.ds_rxstatus4, AR_RxRSSIAnt10),
+           MS(rxs.ds_rxstatus4, AR_RxRSSIAnt11),
+           MS(rxs.ds_rxstatus4, AR_RxRSSIAnt12),
+           MS(rxs.ds_rxstatus4, AR_RxRSSICombined));
+
+       /* status5 */
+       /* status6 */
+       /* status7 */
+       printf("  RxEvm0=0x%08x, RxEvm1=0x%08x, RxEvm2=0x%08x\n",
+           rxs.ds_rxstatus5,
+           rxs.ds_rxstatus6,
+           rxs.ds_rxstatus7);
+       
+       /* status8 */
+       printf("  RxDone=%d, RxFrameOk=%d, CrcErr=%d, DecryptCrcErr=%d\n",
+           MF(rxs.ds_rxstatus8, AR_RxDone),
+           MF(rxs.ds_rxstatus8, AR_RxFrameOK),
+           MF(rxs.ds_rxstatus8, AR_CRCErr),
+           MF(rxs.ds_rxstatus8, AR_DecryptCRCErr));
+       printf("  PhyErr=%d, MichaelErr=%d, PreDelimCRCErr=%d, 
KeyIdxValid=%d\n",
+           MF(rxs.ds_rxstatus8, AR_PHYErr),
+           MF(rxs.ds_rxstatus8, AR_MichaelErr),
+           MF(rxs.ds_rxstatus8, AR_PreDelimCRCErr),
+           MF(rxs.ds_rxstatus8, AR_RxKeyIdxValid));
+
+       /* If PHY error, print that out. Otherwise, the key index */
+       if (MF(rxs.ds_rxstatus8, AR_PHYErr))
+               printf("  PhyErrCode=0x%02x\n",
+                   MS(rxs.ds_rxstatus8, AR_PHYErrCode));
+       else
+               printf("  KeyIdx=0x%02x\n",
+                   MS(rxs.ds_rxstatus8, AR_KeyIdx));
+
+       printf("  RxMoreAggr=%d, RxAggr=%d, PostDelimCRCErr=%d, HiRxChain=%d\n",
+           MF(rxs.ds_rxstatus8, AR_RxMoreAggr),
+           MF(rxs.ds_rxstatus8, AR_RxAggr),
+           MF(rxs.ds_rxstatus8, AR_PostDelimCRCErr),
+           MF(rxs.ds_rxstatus8, AR_HiRxChain));
+       printf("  KeyMiss=%d\n",
+           MF(rxs.ds_rxstatus8, AR_KeyMiss));
+
+       printf("\n ------\n");
+}
+
+void
+ar5416_alq_payload(struct if_ath_alq_payload *a)
+{
+
+               switch (be16toh(a->hdr.op)) {
+                       case ATH_ALQ_EDMA_TXSTATUS:     /* TXSTATUS */
+                               ar5416_decode_txstatus(a);
+                               break;
+                       case ATH_ALQ_EDMA_RXSTATUS:     /* RXSTATUS */
+                               ar5416_decode_rxstatus(a);
+                               break;
+                       case ATH_ALQ_EDMA_TXDESC:       /* TXDESC */
+                               ar5416_decode_txdesc(a);
+                               break;
+                       default:
+                               printf("[%d] [%lld] op: %d; len %d\n",
+                                   be32toh(a->hdr.tstamp),
+                                   be64toh(a->hdr.threadid),
+                                   be16toh(a->hdr.op), be16toh(a->hdr.len));
+               }
+}

Added: head/tools/tools/ath/athalq/ar5416_ds.h
==============================================================================
--- /dev/null   00:00:00 1970   (empty, because file is newly added)
+++ head/tools/tools/ath/athalq/ar5416_ds.h     Sat Nov 17 01:11:00 2012        
(r243166)
@@ -0,0 +1,24 @@
+/*
+ * Copyright (c) 2012 Adrian Chadd <adr...@freebsd.org>
+ * All Rights Reserved.
+ *
+ * Permission to use, copy, modify, and/or distribute this software for any
+ * purpose with or without fee is hereby granted, provided that the above
+ * copyright notice and this permission notice appear in all copies.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
+ * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
+ * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
+ * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
+ * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
+ * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+ *
+ * $FreeBSD$
+ */
+#ifndef        __AR5416_DS_H__
+#define        __AR5416_DS_H__
+
+extern void ar5416_alq_payload(struct if_ath_alq_payload *a);
+
+#endif /* __AR5416_DS_H__ */

Added: head/tools/tools/ath/athalq/main.c
==============================================================================
--- /dev/null   00:00:00 1970   (empty, because file is newly added)
+++ head/tools/tools/ath/athalq/main.c  Sat Nov 17 01:11:00 2012        
(r243166)
@@ -0,0 +1,139 @@
+/*
+ * Copyright (c) 2012 Adrian Chadd <adr...@freebsd.org>
+ * All Rights Reserved.
+ *
+ * Permission to use, copy, modify, and/or distribute this software for any
+ * purpose with or without fee is hereby granted, provided that the above
+ * copyright notice and this permission notice appear in all copies.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
+ * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
+ * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
+ * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
+ * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
+ * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
+ * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+ */
+#include <sys/cdefs.h>
+__FBSDID("$FreeBSD$");
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <fcntl.h>
+#include <errno.h>
+#include <string.h>
+
+#include <sys/types.h>
+#include <sys/alq.h>
+#include <sys/endian.h>
+
+#include <dev/ath/if_ath_alq.h>
+
+#if 0
+#include "ar9300_ds.h"
+#endif
+#include "ar5416_ds.h"
+
+#define AR5210_MAGIC    0x19980124
+#define AR5211_MAGIC    0x19570405
+#define AR5212_MAGIC    0x19541014
+#define AR5416_MAGIC    0x20065416
+#define AR9300_MAGIC    0x19741014
+
+#define        READBUF_SIZE    1024
+
+struct if_ath_alq_init_state hdr;
+
+static void
+ath_alq_print_hdr(struct if_ath_alq_init_state *hdr)
+{
+       printf("macVersion=%d.%d, PHY=%d, Magic=%08x\n",
+           be32toh(hdr->sc_mac_version),
+           be32toh(hdr->sc_mac_revision),
+           be32toh(hdr->sc_phy_rev),
+           be32toh(hdr->sc_hal_magic));
+}
+
+int
+main(int argc, const char *argv[])
+{
+       const char *file = argv[1];
+       int fd;
+       struct if_ath_alq_payload *a;
+       int r;
+       char buf[READBUF_SIZE];
+       int buflen = 0;
+
+       if (argc < 2) {
+               printf("usage: %s <ahq log>\n", argv[0]);
+               exit(127);
+       }
+
+       fd = open(file, O_RDONLY);
+       if (fd < 0) {
+               perror("open"); 
+               exit(127);
+       }
+
+       /*
+        * The payload structure is now no longer a fixed
+        * size. So, hoops are jumped through.  Really
+        * terrible, infficient hoops.
+        */
+       while (1) {
+               if (buflen < 512) { /* XXX Eww */
+                       r = read(fd, buf + buflen, READBUF_SIZE - buflen);
+                       if (r <= 0)
+                               break;
+                       buflen += r;
+                       //printf("read %d bytes, buflen now %d\n", r, buflen);
+               }
+
+               a = (struct if_ath_alq_payload *) &buf[0];
+
+               /*
+                * XXX sanity check that len is within the left over
+                * size of buf.
+                */
+               if (be16toh(a->hdr.len) > buflen) {
+                       fprintf(stderr, "%s: len=%d, buf=%d, tsk!\n",
+                           argv[0], be16toh(a->hdr.len),
+                           buflen);
+                       break;
+               }
+
+               switch (be16toh(a->hdr.op)) {
+                       case ATH_ALQ_INIT_STATE:
+                               /* XXX should double check length! */
+                               memcpy(&hdr, a->payload, sizeof(hdr));
+                               ath_alq_print_hdr(&hdr);
+                               break;
+                       default:
+#if 0
+                               if (be32toh(hdr.sc_hal_magic) == AR9300_MAGIC)
+                                       ar9300_alq_payload(a);
+#endif
+                               if (be32toh(hdr.sc_hal_magic) == AR5416_MAGIC)
+                                       ar5416_alq_payload(a);
+                               else
+                                       printf("[%d] [%lld] op: %d; len %d\n",
+                                           be32toh(a->hdr.tstamp),
+                                           be64toh(a->hdr.threadid),
+                                           be16toh(a->hdr.op),
+                                           be16toh(a->hdr.len));
+               }
+
+               /*
+                * a.len is minus the header size, so..
+                */
+               buflen -= (be16toh(a->hdr.len)
+                   + sizeof(struct if_ath_alq_hdr));
+               memmove(&buf[0],
+                  &buf[be16toh(a->hdr.len) + sizeof(struct if_ath_alq_hdr)],
+                  READBUF_SIZE - (be16toh(a->hdr.len)
+                  + sizeof(struct if_ath_alq_hdr)));
+               //printf("  buflen is now %d\n", buflen);
+       }
+       close(fd);
+}
_______________________________________________
svn-src-all@freebsd.org mailing list
http://lists.freebsd.org/mailman/listinfo/svn-src-all
To unsubscribe, send any mail to "svn-src-all-unsubscr...@freebsd.org"

Reply via email to