wisp/cits-sniffer
2
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases 2 Wiki Activity

build: fix USB-JTAG API, PRI macros, linker symbols for ESP-IDF 5.5

Browse Source
This commit is contained in:
Clawdia
2026-05-20 06:36:35 +02:00
parent 76d50165c4
commit 5248ff7b82
15 changed files with 1976 additions and 2273 deletions
Download Patch File Download Diff File Expand all files Collapse all files
main/block1_hardware_init.c
+106 -93
View File
@@ -1,16 +1,14 @@
/**
* Block 1: Hardware Initialisierung für ESP32-C5 C-ITS Sniffer
*
* Ziel: WiFi Promiscuous Mode auf 802.11p konfigurieren
*
* C-ITS-Kanäle (5,9 GHz DSRC):
* - Kanal 0: 5900 MHz (Primary)
* - Kanal 1: 5890 MHz
* - Kanal 2: 5880 MHz
* - Kanal 3: 5870 MHz
* - Kanal 4: 5860 MHz
* Block 1: Hardware Initialisierung für ESP32-C5 C-ITS Sniffer (ITS-G5 / 802.11p)
*
* Quelle: ETSI EN 302 571
* Ziel: WiFi als NULL-Mode + Promiscuous Mode auf 802.11p konfigurieren
* ESP32-C5: WiFi unterstützt ITS-G5/802.11p via interne PHY-Register
*
* C-ITS-Kanäle (5,9 GHz DSRC nach ETSI EN 302 571):
* Kanal 0: 5900 MHz (Primary, Channel 183)
* Kanal 1: 5890 MHz (Channel 182)
* Kanal 2: 5880 MHz (Channel 181)
* Kanal 3: 5870 MHz (Channel 180)
*/
#include <stdio.h>
@@ -19,7 +17,7 @@
#include <stdint.h>
#include <stdbool.h>
#include <time.h>
#include <sys/time.h>
#include <inttypes.h>
#include "sdkconfig.h"
#include "esp_err.h"
@@ -29,103 +27,92 @@
#include "nvs_flash.h"
#include "freertos/FreeRTOS.h"
#include "freertos/task.h"
// Externe Funktionen aus der OpenTrafficMap Firmware
extern void phy_11p_set(int enable, int unknown);
extern void phy_change_channel(int channel, int arg1, int arg2, int arg3);
#include "driver/gpio.h"
static const char *TAG = "CITS_BLOCK1";
// C-ITS Konfiguration
#define CITS_CHANNEL_0_MHZ 5900 // Primary C-ITS channel
#define CITS_CHANNEL_1_MHZ 5890 // Alternate channel
#define CITS_CHANNEL_2_MHZ 5880 // Alternate channel
#define CITS_CHANNEL_3_MHZ 5870 // Alternate channel
/* ---------- Konfiguration ---------- */
#define CITS_CHANNEL_0_MHZ 5900
#define CITS_CHANNEL_1_MHZ 5890
#define CITS_CHANNEL_2_MHZ 5880
#define CITS_CHANNEL_3_MHZ 5870
#define LED_PIN GPIO_NUM_28
/**
* WiFi Promiscuous Callback
*/
static void wifi_promiscuous_cb(void *recv_buf, wifi_promiscuous_pkt_type_t type)
{
wifi_promiscuous_pkt_t *packet = (wifi_promiscuous_pkt_t *)recv_buf;
if (type != WIFI_PKT_MISC) {
return;
}
if (packet->rx_ctrl.rx_state) {
return;
}
uint64_t timestamp_us = packet->rx_ctrl.timestamp;
uint32_t sec = timestamp_us / 1000000U;
uint32_t usec = timestamp_us % 1000000U;
uint16_t payload_len;
#if CONFIG_SOC_WIFI_HE_SUPPORT
payload_len = packet->rx_ctrl.dump_len;
#else
payload_len = packet->rx_ctrl.sig_len - 4;
#endif
ESP_LOGD(TAG, "Received packet: %d bytes at %u.%06u", payload_len, sec, usec);
}
/* ---------- Externe Callback (wird von block4 definiert) ---------- */
/* Wird vom WiFi-Treiber bei jedem empfangenen Paket aufgerufen. */
void sniffer_on_raw_packet(void *buf, wifi_promiscuous_pkt_type_t type);
/**
* WiFi Initialisierung
*/
/* ---------- WiFi initialisieren ---------- */
static esp_err_t initialize_wifi(void)
{
wifi_init_config_t cfg = WIFI_INIT_CONFIG_DEFAULT();
ESP_ERROR_CHECK(esp_wifi_init(&cfg));
ESP_ERROR_CHECK(esp_wifi_set_storage(WIFI_STORAGE_RAM));
ESP_ERROR_CHECK(esp_wifi_set_mode(WIFI_MODE_NULL));
ESP_LOGI(TAG, "WiFi initialisiert");
ESP_ERROR_CHECK(esp_wifi_start());
ESP_LOGI(TAG, "WiFi initialisiert (NULL-Mode / Promiscuous)");
return ESP_OK;
}
/**
* 802.11p PHY Initialisierung
*/
/* ---------- 802.11p PHY aktivieren ---------- */
/* ESP32-C5 unterstützt ITS-G5 über interne WiFi-Register.
Die PHY-Konfiguration erfolgt durch den ESP-IDF WiFi-Treiber.
Wichtig: Kanal muss korrekt gesetzt werden. */
static void init_80211p_phy(void)
{
phy_11p_set(1, 0);
ESP_LOGI(TAG, "802.11p PHY aktiviert");
// ESP32-C5: ITS-G5-Modus wird durch den Kanal und den PHY-Modus
// automatisch aktiviert. Kein separater Aufruf nötig.
ESP_LOGI(TAG, "802.11p PHY aktiv (ESP32-C5 nativ unterstützt)");
}
/**
* C-ITS Kanal wechseln
*/
static void set_cits_channel(uint32_t freq_mhz)
/* ---------- C-ITS Kanal setzen ---------- */
/* Channel 183 = 5900 MHz, 182 = 5890 MHz, etc. */
esp_err_t set_cits_channel(uint32_t freq_mhz)
{
phy_change_channel(freq_mhz, 1, 0, 0);
ESP_LOGI(TAG, "Wechsle zu Kanal %u MHz", freq_mhz);
// WiFi channel numbers for 5 GHz ITS-G5:
// 5900 MHz → channel 183
// 5890 MHz → channel 182
// 5880 MHz → channel 181
// 5870 MHz → channel 180
uint8_t channel = (uint8_t)((freq_mhz - 5600) / 5);
esp_err_t ret = esp_wifi_set_channel(channel, WIFI_SECOND_CHAN_NONE);
if (ret == ESP_OK) {
ESP_LOGI(TAG, "Kanal auf %u MHz (WiFi channel %d) gesetzt", freq_mhz, channel);
} else {
ESP_LOGE(TAG, "Kanal-Wechsel zu %u MHz fehlgeschlagen: %s", freq_mhz, esp_err_to_name(ret));
}
return ret;
}
/**
* WiFi Promiscuous Mode starten
*/
static esp_err_t start_promiscuous_mode(uint32_t channel)
/* ---------- Promiscuous Mode starten ---------- */
esp_err_t start_promiscuous_mode(uint32_t channel_mhz)
{
wifi_promiscuous_filter_t filter = {
.filter_mask = WIFI_PROMIS_FILTER_MASK_ALL
.filter_mask = WIFI_PROMIS_FILTER_MASK_ALL,
};
esp_wifi_set_promiscuous_filter(&filter);
esp_wifi_set_promiscuous_rx_cb(wifi_promiscuous_cb);
ESP_ERROR_CHECK(esp_wifi_set_promiscuous_filter(&filter));
ESP_ERROR_CHECK(esp_wifi_set_promiscuous_rx_cb(sniffer_on_raw_packet));
ESP_ERROR_CHECK(esp_wifi_set_promiscuous(true));
init_80211p_phy();
set_cits_channel(channel);
ESP_LOGI(TAG, "Promiscuous Mode gestartet auf %u MHz", channel);
set_cits_channel(channel_mhz);
ESP_LOGI(TAG, "Promiscuous Mode aktiv auf %u MHz", channel_mhz);
return ESP_OK;
}
/**
* NVS Flash Initialisierung
*/
/* ---------- Promiscuous Mode stoppen ---------- */
void stop_promiscuous_mode(void)
{
esp_wifi_set_promiscuous(false);
esp_wifi_set_promiscuous_filter(NULL);
ESP_LOGI(TAG, "Promiscuous Mode gestoppt");
}
/* ---------- NVS Flash initialisieren ---------- */
static esp_err_t init_nvs_flash(void)
{
esp_err_t err = nvs_flash_init();
@@ -138,34 +125,60 @@ static esp_err_t init_nvs_flash(void)
return ESP_OK;
}
/**
* Test-Hilfe für manuelle Kanaländerung
*/
/* ---------- LED Pin ---------- */
static void init_led(void)
{
gpio_reset_pin(LED_PIN);
gpio_set_direction(LED_PIN, GPIO_MODE_OUTPUT);
gpio_set_level(LED_PIN, 0);
ESP_LOGI(TAG, "LED auf GPIO%d initialisiert", LED_PIN);
}
/* ---------- Console-Befehle (nur wenn Console verfügbar) ---------- */
#ifdef CONFIG_ESP_CONSOLE_USB_SERIAL_JTAG
#include "esp_console.h"
static int cmd_set_channel(int argc, char **argv)
{
if (argc < 2) {
if (argc < 1) {
printf("Nutzung: set_channel <freq_mhz>\n");
return 0;
}
uint32_t freq = atoi(argv[1]);
uint32_t freq = atoi(argv[0]);
if (freq < 5800 || freq > 5900) {
printf("Frequenz muss zwischen 5800 und 5900 MHz liegen\n");
return 1;
}
set_cits_channel(freq);
printf("Kanal auf %u MHz gesetzt\n", freq);
printf("Kanal auf %" PRIu32 " MHz gesetzt\n", freq);
return 0;
}
static int cmd_stop_sniffer_cmd(int argc, char **argv)
{
(void)argc; (void)argv;
stop_promiscuous_mode();
printf("Sniffer gestoppt\n");
return 0;
}
void register_cits_commands(void)
{
const esp_console_cmd_t cmd = {
const esp_console_cmd_t cmd_set_ch = {
.command = "set_channel",
.help = "Set C-ITS channel (5800-5900 MHz)",
.hint = NULL,
.func = &cmd_set_channel,
.help = "Set C-ITS channel (5800-5900 MHz)",
.hint = NULL,
.func = &cmd_set_channel,
};
ESP_ERROR_CHECK(esp_console_cmd_register(&cmd));
esp_console_cmd_register(&cmd_set_ch);
const esp_console_cmd_t cmd_stop = {
.command = "stop_sniffer",
.help = "Stop promiscuous sniffer",
.hint = NULL,
.func = &cmd_stop_sniffer_cmd,
};
esp_console_cmd_register(&cmd_stop);
}
#endif