esp-protocols/components/eppp_link/eppp_netif_tun.c

/*
 * SPDX-FileCopyrightText: 2025 Espressif Systems (Shanghai) CO LTD
 *
 * SPDX-License-Identifier: Apache-2.0
 */
#include <string.h>
#include <stdint.h>
#include "sdkconfig.h"
#include "esp_log.h"
#include "esp_netif.h"
#include "esp_netif_net_stack.h"
#include "lwip/esp_netif_net_stack.h"
#include "lwip/prot/ethernet.h"
#include "lwip/inet.h"
#include "lwip/sockets.h"
#include "ping/ping_sock.h"
#include "esp_check.h"
#include "esp_idf_version.h"

static const char *TAG = "eppp_tun_netif";

static void tun_input(void *h, void *buffer, unsigned int len, void *eb)
{
    __attribute__((unused)) esp_err_t ret = ESP_OK;
    struct netif *netif = h;
    struct pbuf *p = NULL;

    ESP_LOG_BUFFER_HEXDUMP(TAG, buffer, len, ESP_LOG_VERBOSE);
    // need to alloc extra space for the ETH header to support possible packet forwarding
    ESP_GOTO_ON_FALSE(p = pbuf_alloc(PBUF_RAW, len + SIZEOF_ETH_HDR, PBUF_RAM), ESP_ERR_NO_MEM, err, TAG, "pbuf_alloc failed");
    ESP_GOTO_ON_FALSE(pbuf_remove_header(p, SIZEOF_ETH_HDR) == 0, ESP_FAIL, err, TAG, "pbuf_remove_header failed");
    memcpy(p->payload, buffer, len);
    ESP_GOTO_ON_FALSE(netif->input(p, netif) == ERR_OK, ESP_FAIL, err, TAG, "failed to input packet to lwip");
    return;
err:
    if (p) {
        pbuf_free(p);
    }
}

static err_t tun_output(struct netif *netif, struct pbuf *p)
{
    LWIP_ASSERT("netif != NULL", (netif != NULL));
    LWIP_ASSERT("netif->state != NULL", (netif->state != NULL));
    LWIP_ASSERT("p != NULL", (p != NULL));
    esp_err_t ret = esp_netif_transmit(netif->state, p->payload, p->len);
    switch (ret) {
    case ESP_OK:
        return ERR_OK;
    case ESP_ERR_NO_MEM:
        return ERR_MEM;
#if ESP_IDF_VERSION >= ESP_IDF_VERSION_VAL(5, 4, 0)
    case ESP_ERR_ESP_NETIF_TX_FAILED:
        return ERR_BUF;
#endif
    case ESP_ERR_INVALID_ARG:
        return ERR_ARG;
    default:
        return ERR_IF;
    }
}

static err_t tun_output_v4(struct netif *netif, struct pbuf *p, const ip4_addr_t *ipaddr)
{
    LWIP_UNUSED_ARG(ipaddr);
    return tun_output(netif, p);
}
#if LWIP_IPV6
static err_t tun_output_v6(struct netif *netif, struct pbuf *p, const ip6_addr_t *ipaddr)
{
    LWIP_UNUSED_ARG(ipaddr);
    return tun_output(netif, p);
}
#endif
static err_t tun_init(struct netif *netif)
{
    if (netif == NULL) {
        return ERR_IF;
    }
    netif->name[0] = 't';
    netif->name[1] = 'u';
#if LWIP_IPV4
    netif->output = tun_output_v4;
#endif
#if LWIP_IPV6
    netif->output_ip6 = tun_output_v6;
#endif
    netif->mtu = 1500;
    return ERR_OK;
}

static const struct esp_netif_netstack_config s_config_tun = {
    .lwip = {
        .init_fn = tun_init,
        .input_fn = tun_input,
    }
};

const esp_netif_netstack_config_t *g_eppp_netif_config_tun = &s_config_tun;

static void cmd_ping_on_ping_success(esp_ping_handle_t hdl, void *args)
{
    uint8_t ttl;
    uint16_t seqno;
    uint32_t elapsed_time, recv_len;
    ip_addr_t target_addr;
    esp_ping_get_profile(hdl, ESP_PING_PROF_SEQNO, &seqno, sizeof(seqno));
    esp_ping_get_profile(hdl, ESP_PING_PROF_TTL, &ttl, sizeof(ttl));
    esp_ping_get_profile(hdl, ESP_PING_PROF_IPADDR, &target_addr, sizeof(target_addr));
    esp_ping_get_profile(hdl, ESP_PING_PROF_SIZE, &recv_len, sizeof(recv_len));
    esp_ping_get_profile(hdl, ESP_PING_PROF_TIMEGAP, &elapsed_time, sizeof(elapsed_time));
    ESP_LOGD(TAG, "%" PRIu32 " bytes from %s icmp_seq=%" PRIu16 " ttl=%" PRIu16 " time=%" PRIu32 " ms\n",
             recv_len, ipaddr_ntoa((ip_addr_t *)&target_addr), seqno, ttl, elapsed_time);
    if (esp_ping_stop(hdl) != ESP_OK) {
        ESP_LOGE(TAG, "Failed to stop ping session");
        // continue to delete the session
    }
    esp_ping_delete_session(hdl);
    ESP_LOGI(TAG, "PING success -> stop and post IP");
    esp_netif_t *netif = (esp_netif_t *)args;
    esp_netif_ip_info_t ip = {0};
    esp_netif_get_ip_info(netif, &ip);
    esp_netif_set_ip_info(netif, &ip);
}

static void cmd_ping_on_ping_timeout(esp_ping_handle_t hdl, void *args)
{
    uint16_t seqno;
    ip_addr_t target_addr;
    esp_ping_get_profile(hdl, ESP_PING_PROF_SEQNO, &seqno, sizeof(seqno));
    esp_ping_get_profile(hdl, ESP_PING_PROF_IPADDR, &target_addr, sizeof(target_addr));
    ESP_LOGD(TAG, "From %s icmp_seq=%" PRIu16 "timeout", ipaddr_ntoa((ip_addr_t *)&target_addr), seqno);
}

static void cmd_ping_on_ping_end(esp_ping_handle_t hdl, void *args)
{
    ip_addr_t target_addr;
    uint32_t transmitted;
    uint32_t received;
    uint32_t total_time_ms;
    uint32_t loss;

    esp_ping_get_profile(hdl, ESP_PING_PROF_REQUEST, &transmitted, sizeof(transmitted));
    esp_ping_get_profile(hdl, ESP_PING_PROF_REPLY, &received, sizeof(received));
    esp_ping_get_profile(hdl, ESP_PING_PROF_IPADDR, &target_addr, sizeof(target_addr));
    esp_ping_get_profile(hdl, ESP_PING_PROF_DURATION, &total_time_ms, sizeof(total_time_ms));

    if (transmitted > 0) {
        loss = (uint32_t)((1 - ((float)received) / transmitted) * 100);
    } else {
        loss = 0;
    }
    if (IP_IS_V4(&target_addr)) {
        ESP_LOGD(TAG, "\n--- %s ping statistics ---\n", inet_ntoa(*ip_2_ip4(&target_addr)));
    }
#if LWIP_IPV6
    else {
        ESP_LOGD(TAG, "\n--- %s ping statistics ---\n", inet6_ntoa(*ip_2_ip6(&target_addr)));
    }
#endif
    ESP_LOGI(TAG, "%" PRIu32 " packets transmitted, %" PRIu32 " received, %" PRIu32 "%% packet loss, time %" PRIu32 "ms\n",
             transmitted, received, loss, total_time_ms);
    esp_ping_delete_session(hdl);
}

esp_err_t eppp_check_connection(esp_netif_t *netif)
{
    esp_err_t ret = ESP_OK;
    esp_ping_config_t config = ESP_PING_DEFAULT_CONFIG();
    config.count = 100;
    ESP_LOGI(TAG, "Checking connection on EPPP interface #%" PRIu32, config.interface);
    ip_addr_t target_addr = {0};
    esp_netif_ip_info_t ip;
    esp_netif_get_ip_info(netif, &ip);
#if LWIP_IPV6
    target_addr.u_addr.ip4.addr =  ip.gw.addr;
#else
    target_addr.addr =  ip.gw.addr;
#endif
    config.target_addr = target_addr;
    esp_ping_callbacks_t cbs = {
        .cb_args = netif,
        .on_ping_success = cmd_ping_on_ping_success,
        .on_ping_timeout = cmd_ping_on_ping_timeout,
        .on_ping_end = cmd_ping_on_ping_end
    };
    esp_ping_handle_t ping;
    ESP_GOTO_ON_ERROR(esp_ping_new_session(&config, &cbs, &ping), err, TAG, "Failed to create ping session");
    ESP_GOTO_ON_ERROR(esp_ping_start(ping), err, TAG, "Failed to start ping session");
    ESP_LOGI(TAG, "Ping started");
    return ret;
err:
    ESP_LOGE(TAG, "Failed to start connection check");
    return ret;
}