mirror of
https://github.com/espressif/esp-idf.git
synced 2025-12-05 08:27:30 +00:00
examples: added ESP-NETIF L2 TAP example
This commit is contained in:
Ondrej Kosta
265
examples/protocols/l2tap/main/l2tap_main.c
Normal file
265
examples/protocols/l2tap/main/l2tap_main.c
Normal file
@@ -0,0 +1,265 @@
|
||||
/*
|
||||
* SPDX-FileCopyrightText: 2022 Espressif Systems (Shanghai) CO LTD
|
||||
*
|
||||
* SPDX-License-Identifier: Unlicense OR CC0-1.0
|
||||
*/
|
||||
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
#include <unistd.h> // read/write
|
||||
#include <sys/fcntl.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include <errno.h>
|
||||
#include "freertos/FreeRTOS.h"
|
||||
#include "freertos/task.h"
|
||||
#include "esp_event.h"
|
||||
#include "esp_err.h"
|
||||
#include "esp_eth.h"
|
||||
#include "esp_log.h"
|
||||
#include "nvs_flash.h"
|
||||
#include "sdkconfig.h"
|
||||
#include "esp_vfs_l2tap.h"
|
||||
#include "lwip/prot/ethernet.h" // Ethernet header
|
||||
#include "arpa/inet.h" // ntohs, etc.
|
||||
#include "protocol_examples_common.h"
|
||||
|
||||
#if !defined(CONFIG_EXAMPLE_CONNECT_ETHERNET)
|
||||
#error Ethernet interface is not configured to connect.
|
||||
#endif
|
||||
|
||||
#define ETH_INTERFACE "ETH_DEF"
|
||||
#define ETH_TYPE_FILTER_BLOCK 0x2220
|
||||
#define ETH_TYPE_FILTER_NOBLOCK 0x2221
|
||||
#define ETH_TYPE_FILTER_TX 0x2223
|
||||
|
||||
#define INVALID_FD -1
|
||||
|
||||
typedef struct {
|
||||
struct eth_hdr header;
|
||||
char payload[44];
|
||||
} test_vfs_eth_tap_msg_t;
|
||||
|
||||
static const char *TAG = "l2tap_example";
|
||||
|
||||
|
||||
/** Opens and configures L2 TAP file descriptor */
|
||||
static int init_l2tap_fd(int flags, uint16_t eth_type_filter)
|
||||
{
|
||||
int fd = open("/dev/net/tap", flags);
|
||||
if (fd < 0) {
|
||||
ESP_LOGE(TAG, "Unable to open L2 TAP interface: errno %d", errno);
|
||||
goto error;
|
||||
}
|
||||
ESP_LOGI(TAG, "/dev/net/tap fd %d successfully opened", fd);
|
||||
|
||||
// Check fd block status (just for demonstration purpose)
|
||||
flags = 0;
|
||||
flags = fcntl(fd, F_GETFL);
|
||||
if (flags == -1) {
|
||||
ESP_LOGE(TAG, "Unable to get L2 TAP fd %d status flag: errno %d", fd, errno);
|
||||
goto error;
|
||||
}
|
||||
if (flags & O_NONBLOCK) {
|
||||
ESP_LOGI(TAG, "L2 TAP fd %d configured in non-blocking mode", fd);
|
||||
} else {
|
||||
ESP_LOGI(TAG, "L2 TAP fd %d configured in blocking mode", fd);
|
||||
}
|
||||
|
||||
// Configure Ethernet interface on which to get raw frames
|
||||
int ret;
|
||||
if ((ret = ioctl(fd, L2TAP_S_INTF_DEVICE, ETH_INTERFACE)) == -1) {
|
||||
ESP_LOGE(TAG, "Unable to bound L2 TAP fd %d with Ethernet device: errno %d", fd, errno);
|
||||
goto error;
|
||||
}
|
||||
ESP_LOGI(TAG, "L2 TAP fd %d successfully bound to `%s`", fd, ETH_INTERFACE);
|
||||
|
||||
// Configure Ethernet frames we want to filter out
|
||||
if ((ret = ioctl(fd, L2TAP_S_RCV_FILTER, ð_type_filter)) == -1) {
|
||||
ESP_LOGE(TAG, "Unable to configure fd %d Ethernet type receive filter: errno %d", fd, errno);
|
||||
goto error;
|
||||
}
|
||||
ESP_LOGI(TAG, "L2 TAP fd %d Ethernet type filter configured to 0x%x", fd, eth_type_filter);
|
||||
|
||||
return fd;
|
||||
error:
|
||||
if (fd != INVALID_FD) {
|
||||
close(fd);
|
||||
}
|
||||
return INVALID_FD;
|
||||
}
|
||||
|
||||
/** Creates "echo" message from received frame */
|
||||
static void create_echo_frame(test_vfs_eth_tap_msg_t *in_frame, test_vfs_eth_tap_msg_t *out_frame, int len)
|
||||
{
|
||||
// Set source address equal to our MAC address
|
||||
esp_eth_handle_t eth_hndl = get_example_eth_handle();
|
||||
uint8_t mac_addr[ETH_ADDR_LEN];
|
||||
esp_eth_ioctl(eth_hndl, ETH_CMD_G_MAC_ADDR, mac_addr);
|
||||
memcpy(out_frame->header.src.addr, mac_addr, ETH_ADDR_LEN);
|
||||
// Set destination address equal to source address from where the frame was received
|
||||
memcpy(out_frame->header.dest.addr, in_frame->header.src.addr, ETH_ADDR_LEN);
|
||||
// Set Ethernet type
|
||||
memcpy(&out_frame->header.type, &in_frame->header.type, sizeof(uint16_t));
|
||||
// Copy the payload
|
||||
memcpy(out_frame->payload, in_frame->payload, len - ETH_HEADER_LEN);
|
||||
}
|
||||
|
||||
/** Demonstrates usage of L2 TAP in blocking mode */
|
||||
static void echo_l2tap_task(void *pvParameters)
|
||||
{
|
||||
uint8_t rx_buffer[128];
|
||||
int eth_tap_fd;
|
||||
|
||||
// Open and configure L2 TAP File descriptor
|
||||
if ((eth_tap_fd = init_l2tap_fd(0, ETH_TYPE_FILTER_BLOCK)) == INVALID_FD) {
|
||||
goto error;
|
||||
}
|
||||
|
||||
while (1) {
|
||||
ssize_t len = read(eth_tap_fd, rx_buffer, sizeof(rx_buffer));
|
||||
if (len > 0) {
|
||||
test_vfs_eth_tap_msg_t *recv_msg = (test_vfs_eth_tap_msg_t *)rx_buffer;
|
||||
ESP_LOGI(TAG, "fd %d received %d bytes from %.2x:%.2x:%.2x:%.2x:%.2x:%.2x", eth_tap_fd,
|
||||
len, recv_msg->header.src.addr[0], recv_msg->header.src.addr[1], recv_msg->header.src.addr[2],
|
||||
recv_msg->header.src.addr[3], recv_msg->header.src.addr[4], recv_msg->header.src.addr[5]);
|
||||
// Construct echo frame
|
||||
test_vfs_eth_tap_msg_t echo_msg;
|
||||
create_echo_frame(recv_msg, &echo_msg, len);
|
||||
|
||||
// Send the echo message
|
||||
ssize_t ret = write(eth_tap_fd, &echo_msg, len);
|
||||
if (ret == -1) {
|
||||
ESP_LOGE(TAG, "L2 TAP fd %d write error: errno: %d\n", eth_tap_fd, errno);
|
||||
break;
|
||||
}
|
||||
} else {
|
||||
ESP_LOGE(TAG, "L2 TAP fd %d read error: errno %d", eth_tap_fd, errno);
|
||||
break;
|
||||
}
|
||||
}
|
||||
close(eth_tap_fd);
|
||||
error:
|
||||
vTaskDelete(NULL);
|
||||
}
|
||||
|
||||
/** Demonstrates usage of L2 TAP non-blocking mode with select */
|
||||
static void nonblock_l2tap_echo_task(void *pvParameters)
|
||||
{
|
||||
uint8_t rx_buffer[128];
|
||||
int eth_tap_fd;
|
||||
|
||||
// Open and configure L2 TAP File descriptor
|
||||
if ((eth_tap_fd = init_l2tap_fd(O_NONBLOCK, ETH_TYPE_FILTER_NOBLOCK)) == INVALID_FD) {
|
||||
goto error;
|
||||
}
|
||||
|
||||
while (1) {
|
||||
struct timeval tv;
|
||||
tv.tv_sec = 5;
|
||||
tv.tv_usec = 0;
|
||||
|
||||
fd_set rfds;
|
||||
FD_ZERO(&rfds);
|
||||
FD_SET(eth_tap_fd, &rfds);
|
||||
|
||||
int ret_sel = select(eth_tap_fd + 1, &rfds, NULL, NULL, &tv);
|
||||
if (ret_sel > 0) {
|
||||
ssize_t len = read(eth_tap_fd, rx_buffer, sizeof(rx_buffer));
|
||||
if (len > 0) {
|
||||
test_vfs_eth_tap_msg_t *recv_msg = (test_vfs_eth_tap_msg_t *)rx_buffer;
|
||||
ESP_LOGI(TAG, "fd %d received %d bytes from %.2x:%.2x:%.2x:%.2x:%.2x:%.2x", eth_tap_fd,
|
||||
len, recv_msg->header.src.addr[0], recv_msg->header.src.addr[1], recv_msg->header.src.addr[2],
|
||||
recv_msg->header.src.addr[3], recv_msg->header.src.addr[4], recv_msg->header.src.addr[5]);
|
||||
// Construct echo frame
|
||||
test_vfs_eth_tap_msg_t echo_msg;
|
||||
create_echo_frame(recv_msg, &echo_msg, len);
|
||||
|
||||
// Send the echo message
|
||||
ssize_t ret = write(eth_tap_fd, &echo_msg, len);
|
||||
if (ret == -1) {
|
||||
ESP_LOGE(TAG, "L2 TAP fd %d write error: errno: %d\n", eth_tap_fd, errno);
|
||||
break;
|
||||
}
|
||||
} else {
|
||||
ESP_LOGE(TAG, "L2 TAP fd %d read error: errno %d", eth_tap_fd, errno);
|
||||
break;
|
||||
}
|
||||
} else if (ret_sel == 0) {
|
||||
ESP_LOGD(TAG, "L2 TAP select timeout");
|
||||
} else {
|
||||
ESP_LOGE(TAG, "L2 TAP select error: errno %d", errno);
|
||||
break;
|
||||
}
|
||||
}
|
||||
close(eth_tap_fd);
|
||||
error:
|
||||
vTaskDelete(NULL);
|
||||
}
|
||||
|
||||
/** Demonstrates of how to construct Ethernet frame for transmit via L2 TAP */
|
||||
static void hello_tx_l2tap_task(void *pvParameters)
|
||||
{
|
||||
uint16_t eth_type_filter = ETH_TYPE_FILTER_TX;
|
||||
int eth_tap_fd;
|
||||
|
||||
// Open and configure L2 TAP File descriptor
|
||||
if ((eth_tap_fd = init_l2tap_fd(0, eth_type_filter)) == INVALID_FD) {
|
||||
goto error;
|
||||
}
|
||||
|
||||
// Construct "Hello" frame
|
||||
test_vfs_eth_tap_msg_t hello_msg = {
|
||||
.header = {
|
||||
.src.addr = {0},
|
||||
.dest.addr = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff}, // broadcast address
|
||||
.type = htons(eth_type_filter) // convert to big endian (network) byte order
|
||||
},
|
||||
.payload = "ESP32 hello to everybody!"
|
||||
};
|
||||
esp_eth_handle_t eth_hndl = get_example_eth_handle();
|
||||
esp_eth_ioctl(eth_hndl, ETH_CMD_G_MAC_ADDR, hello_msg.header.src.addr);
|
||||
|
||||
while (1) {
|
||||
// Send the Hello frame
|
||||
ssize_t ret = write(eth_tap_fd, &hello_msg, ETH_HEADER_LEN + strlen(hello_msg.payload));
|
||||
if (ret == -1) {
|
||||
ESP_LOGE(TAG, "L2 TAP fd %d write error: errno: %d\n", eth_tap_fd, errno);
|
||||
break;
|
||||
}
|
||||
vTaskDelay(pdMS_TO_TICKS(3000));
|
||||
}
|
||||
close(eth_tap_fd);
|
||||
error:
|
||||
vTaskDelete(NULL);
|
||||
}
|
||||
|
||||
void app_main(void)
|
||||
{
|
||||
// Initialize L2 TAP VFS interface
|
||||
ESP_ERROR_CHECK(esp_vfs_l2tap_intf_register(NULL));
|
||||
|
||||
// Initialize NVS Flash
|
||||
ESP_ERROR_CHECK(nvs_flash_init());
|
||||
// Initialize TCP/IP network interface (should be called only once in application)
|
||||
ESP_ERROR_CHECK(esp_netif_init());
|
||||
ESP_ERROR_CHECK(esp_event_loop_create_default());
|
||||
|
||||
/* This helper function configures Wi-Fi or Ethernet, as selected in menuconfig.
|
||||
* Read "Establishing Wi-Fi or Ethernet Connection" section in
|
||||
* examples/protocols/README.md for more information about this function.
|
||||
*/
|
||||
ESP_ERROR_CHECK(example_connect());
|
||||
|
||||
esp_eth_handle_t eth_hndl = get_example_eth_handle();
|
||||
uint8_t mac_addr[ETH_ADDR_LEN];
|
||||
esp_eth_ioctl(eth_hndl, ETH_CMD_G_MAC_ADDR, mac_addr);
|
||||
ESP_LOGI(TAG, "Ethernet HW Addr %02x:%02x:%02x:%02x:%02x:%02x",
|
||||
mac_addr[0], mac_addr[1], mac_addr[2], mac_addr[3], mac_addr[4], mac_addr[5]);
|
||||
|
||||
// Echo received message back to sender (blocks indefinitely)
|
||||
xTaskCreate(echo_l2tap_task, "echo", 4096, NULL, 6, NULL);
|
||||
// Echo received message back to sender (blocks with timeout)
|
||||
xTaskCreate(nonblock_l2tap_echo_task, "echo_no-block", 4096, NULL, 5, NULL);
|
||||
// Periodically broadcast "Hello message"
|
||||
xTaskCreate(hello_tx_l2tap_task, "hello_tx", 4096, NULL, 4, NULL);
|
||||
}
|
||||
Reference in New Issue
Block a user