1 files changed, 140 insertions, 0 deletions

@@ -0,0 +1,140 @@
+#include "../../src/libwifi.h"
+
+#include <errno.h>
+#include <stdio.h>
+#include <string.h>
+
+#define BCAST_MAC "\xff\xff\xff\xff\xff\xff"
+#define TO_MAC "\x00\x20\x91\xAA\xBB\xCC"
+const unsigned char to[] = TO_MAC;
+const unsigned char bcast[] = BCAST_MAC;
+
+const unsigned char beacon[] = "\x00\x00\x18\x00\x8e\x58\x00\x00\x10\x02\x6c\x09\xa0\x00\x54\x00" \
+                               "\x00\x2b\x00\x00\x9f\x61\xc9\x5c\x80\x00\x00\x00\xff\xff\xff\xff" \
+                               "\xff\xff\x00\x0c\x41\x82\xb2\x55\x00\x0c\x41\x82\xb2\x55\x50\xf8" \
+                               "\x89\xf1\xd4\x1b\x01\x00\x00\x00\x64\x00\x11\x04\x00\x07\x43\x6f" \
+                               "\x68\x65\x72\x65\x72\x01\x08\x82\x84\x8b\x96\x24\x30\x48\x6c\x03" \
+                               "\x01\x01\x05\x04\x00\x01\x00\x00\x2a\x01\x02\x2f\x01\x02\x30\x18" \
+                               "\x01\x00\x00\x0f\xac\x02\x02\x00\x00\x0f\xac\x04\x00\x0f\xac\x02" \
+                               "\x01\x00\x00\x0f\xac\x02\x00\x00\x32\x04\x0c\x12\x18\x60\xdd\x06" \
+                               "\x00\x10\x18\x02\x00\x04\xdd\x1c\x00\x50\xf2\x01\x01\x00\x00\x50" \
+                               "\xf2\x02\x02\x00\x00\x50\xf2\x04\x00\x50\xf2\x02\x01\x00\x00\x50" \
+                               "\xf2\x02\x00\x00\x9f\x61\xc9\x5c";
+
+int test_beacon_gen_full() {
+    struct libwifi_beacon beacon = {0};
+
+    int ret = libwifi_create_beacon(&beacon, bcast, to, "Some SSID", 11);
+    if (ret != 0) {
+        fprintf(stderr, "Failed to create beacon: %s\n", strerror(ret));
+        return ret;
+    }
+
+    int beacon_len = libwifi_get_beacon_length(&beacon);
+    if (beacon_len <= 0) {
+        fprintf(stderr, "Invalid beacon length: %d\n", beacon_len);
+        return beacon_len;
+    }
+
+    unsigned char *buf = malloc(beacon_len);
+    if (buf == NULL) {
+        fprintf(stderr, "Failed to allocate buffer\n");
+        return -1;
+    }
+
+    int dump_len = libwifi_dump_beacon(&beacon, buf, beacon_len);
+    if (dump_len <= 0) {
+        fprintf(stderr, "Failed to dump beacon\n");
+        return ret;
+    }
+
+    return 0;
+}
+
+int test_beacon_add_tag() {
+    struct libwifi_beacon beacon = {0};
+
+    int ret = libwifi_create_beacon(&beacon, bcast, to, "Some SSID", 11);
+    if (ret != 0) {
+        fprintf(stderr, "Failed to create beacon: %s\n", strerror(ret));
+        return ret;
+    }
+
+    ret = libwifi_quick_add_tag(&beacon.tags,
+                                TAG_VENDOR_SPECIFIC,
+                                (const unsigned char *) "\x00\x11\x22\xAAHello World",
+                                15);
+    if (ret != 0) {
+        fprintf(stderr, "Failed to add beacon tagged parameter: %s\n", strerror(ret));
+        return ret;
+    }
+
+    int beacon_len = libwifi_get_beacon_length(&beacon);
+    if (beacon_len <= 0) {
+        fprintf(stderr, "Invalid beacon length: %d\n", beacon_len);
+        return beacon_len;
+    }
+
+    unsigned char *buf = malloc(beacon_len);
+    if (buf == NULL) {
+        fprintf(stderr, "Failed to allocate buffer\n");
+        return -1;
+    }
+
+    int dump_len = libwifi_dump_beacon(&beacon, buf, beacon_len);
+    if (dump_len <= 0) {
+        fprintf(stderr, "Failed to dump beacon\n");
+        return ret;
+    }
+
+    return 0;
+}
+
+int test_beacon_parse() {
+    struct libwifi_frame frame = {0};
+    struct libwifi_bss bss = {0};
+
+    int ret = libwifi_get_wifi_frame(&frame, beacon, sizeof(beacon), 1);
+    if (ret != 0) {
+        return ret;
+    }
+
+    if (frame.frame_control.type != TYPE_MANAGEMENT || frame.frame_control.subtype != SUBTYPE_BEACON) {
+        return -1;
+    }
+
+    ret = libwifi_parse_beacon(&bss, &frame);
+    if (ret != 0) {
+        return ret;
+    }
+
+    if (strcmp(bss.ssid, "Coherer") != 0) {
+        return -2;
+    }
+
+    if (bss.channel != 1) {
+        return -3;
+    }
+
+    libwifi_free_bss(&bss);
+    libwifi_free_wifi_frame(&frame);
+
+    return 0;
+}
+
+int main(int argc, char **argv) {
+    if (argc < 2) {
+        printf("Specify test\n");
+        return -1;
+    }
+
+    if (strcmp(argv[1], "--beacon-gen-full") == 0) {
+        return test_beacon_gen_full();
+    } else if (strcmp(argv[1], "--beacon-gen-tags") == 0) {
+        return test_beacon_add_tag();
+    } else if (strcmp(argv[1], "--beacon-parse") == 0) {
+        return test_beacon_parse();
+    }
+
+    return -1;
+}