Devourer Experimental TX implementation

Author: imagemlt

CMakeLists.txt

@@ -27,6 +27,7 @@ add_library(WiFiDriver
         hal/rtl8812a_recv.h
         hal/rtl8812a_spec.h
 
+        src/ieee80211_radiotap.h
         src/EepromManager.cpp
         src/EepromManager.h
         src/Firmware.h
@@ -39,6 +40,7 @@ add_library(WiFiDriver
         src/ParsedRadioPacket.cpp
         src/RadioManagementModule.cpp
         src/RadioManagementModule.h
+        src/Radiotap.c
         src/Rtl8812aDevice.cpp
         src/Rtl8812aDevice.h
         src/RtlUsbAdapter.cpp
@@ -62,3 +64,7 @@ add_executable(WiFiDriverDemo
         demo/main.cpp)
 
 target_link_libraries(WiFiDriverDemo PUBLIC WiFiDriver)
+
+add_executable(WiFiDriverTxDemo
+        txdemo/main.cpp)
+target_link_libraries(WiFiDriverTxDemo PUBLIC WiFiDriver)

hal/basic_types.h

@@ -18,8 +18,11 @@
 #define _FALSE FALSE
 #endif
 
-#define le16_to_cpu(x) ((uint16_t)(x))
-#define le32_to_cpu(x) ((uint32_t)(x))
+#define cpu_to_le32(x) ((__u32)(x))
+#define le32_to_cpu(x) ((__u32)(x))
+#define cpu_to_le16(x) ((__u16)(x))
+#define le16_to_cpu(x) ((__u16)(x))
+
 
 #define LE_BITS_TO_4BYTE(__pStart, __BitOffset, __BitLen)                      \
   ((LE_P4BYTE_TO_HOST_4BYTE(__pStart) >> (__BitOffset)) &                      \

src/EepromManager.h

@@ -8,6 +8,8 @@
 #include "phydm_pre_define.h"
 #include "rtl8812a_hal.h"
 
+typedef unsigned short ushort;
+
 class EepromManager {
   RtlUsbAdapter _device;
   Logger_t _logger;

src/FrameParser.cpp

@@ -118,8 +118,9 @@ std::vector<Packet> FrameParser::recvbuf2recvframe(std::span<uint8_t> ptr) {
       ret.push_back({pattrib, pbuf.subspan(pattrib.shift_sz +
                                                pattrib.drvinfo_sz + RXDESC_SIZE,
                                            pattrib.pkt_len)});
-      // pre_recv_entry(precvframe, pattrib.physt ? pbuf.Slice(RXDESC_OFFSET) :
-      // null);
+
+      ret.back().RxAtrib.rssi[0] = pbuf[RXDESC_SIZE];
+      ret.back().RxAtrib.rssi[1] = pbuf[RXDESC_SIZE + 1];
     } else {
       /* pkt_rpt_type == TX_REPORT1-CCX, TX_REPORT2-TX RTP,HIS_REPORT-USB HISR
        * RTP */
@@ -149,3 +150,56 @@ std::vector<Packet> FrameParser::recvbuf2recvframe(std::span<uint8_t> ptr) {
 
   return ret;
 }
+
+void rtl8812a_cal_txdesc_chksum(uint8_t *ptxdesc) {
+  u16 *usPtr;
+  u32 count;
+  u32 index;
+  u16 checksum = 0;
+
+  usPtr = (u16 *)ptxdesc;
+
+  /* checksum is always calculated by first 32 bytes, */
+  /* and it doesn't depend on TX DESC length. */
+  /* Thomas,Lucas@SD4,20130515 */
+  count = 16;
+
+  /* Clear first */
+  SET_TX_DESC_TX_DESC_CHECKSUM_8812(ptxdesc, 0);
+
+  for (index = 0; index < count; index++)
+    checksum = checksum ^ le16_to_cpu(*(usPtr + index));
+
+  SET_TX_DESC_TX_DESC_CHECKSUM_8812(ptxdesc, checksum);
+}
+
+int rtw_action_frame_parse(const u8 *frame, u32 frame_len, u8 *category,
+                           u8 *action) {
+  /*const u8 *frame_body = frame + sizeof(struct rtw_ieee80211_hdr_3addr);
+  u16 fc;
+  u8 c;
+  u8 a = ACT_PUBLIC_MAX;
+
+  fc = le16_to_cpu(((struct rtw_ieee80211_hdr_3addr *)frame)->frame_ctl);
+
+  if ((fc & (RTW_IEEE80211_FCTL_FTYPE | RTW_IEEE80211_FCTL_STYPE))
+      != (RTW_IEEE80211_FTYPE_MGMT | RTW_IEEE80211_STYPE_ACTION)
+     )
+          return _FALSE;
+
+  c = frame_body[0];
+
+  switch (c) {
+  case RTW_WLAN_CATEGORY_P2P: // vendor-specific
+          break;
+  default:
+          a = frame_body[1];
+  }
+
+  if (category)
+          *category = c;
+  if (action)
+          *action = a;
+*/
+  return _TRUE;
+}