268 lines
9.1 KiB
C
268 lines
9.1 KiB
C
/* PPPoS Client Example
|
|
|
|
This example code is in the Public Domain (or CC0 licensed, at your option.)
|
|
|
|
Unless required by applicable law or agreed to in writing, this
|
|
software is distributed on an "AS IS" BASIS, WITHOUT WARRANTIES OR
|
|
CONDITIONS OF ANY KIND, either express or implied.
|
|
*/
|
|
#include <string.h>
|
|
#include "freertos/FreeRTOS.h"
|
|
#include "freertos/event_groups.h"
|
|
#include "esp_netif.h"
|
|
#include "esp_netif_ppp.h"
|
|
#include "esp_modem.h"
|
|
#include "esp_modem_netif.h"
|
|
#include "esp_log.h"
|
|
#include "lwip/err.h"
|
|
#include "lwip/sockets.h"
|
|
#include "null_dce.h"
|
|
|
|
#define HOST_IP_ADDR CONFIG_TEST_APP_PPP_SERVER_IP
|
|
#define PORT CONFIG_TEST_APP_TCP_PORT
|
|
|
|
static const char *TAG = "pppos_test_app";
|
|
static EventGroupHandle_t event_group = NULL;
|
|
static const int CONNECT_BIT = BIT0;
|
|
static const int STOP_BIT = BIT1;
|
|
static const int DISCONNECT_BIT = BIT2;
|
|
static const int TCP_SERVER_DONE = BIT3;
|
|
static const int TCP_SERVER_FAILED = BIT4;
|
|
static char addr_str[128];
|
|
static char rx_buffer[128];
|
|
|
|
|
|
static void modem_event_handler(void *event_handler_arg, esp_event_base_t event_base, int32_t event_id, void *event_data)
|
|
{
|
|
switch (event_id) {
|
|
case ESP_MODEM_EVENT_PPP_START:
|
|
ESP_LOGI(TAG, "Modem PPP Started");
|
|
break;
|
|
case ESP_MODEM_EVENT_PPP_STOP:
|
|
ESP_LOGI(TAG, "Modem PPP Stopped");
|
|
xEventGroupSetBits(event_group, STOP_BIT);
|
|
break;
|
|
case ESP_MODEM_EVENT_UNKNOWN:
|
|
ESP_LOGW(TAG, "Unknow line received: %s", (char *)event_data);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void on_ppp_changed(void *arg, esp_event_base_t event_base,
|
|
int32_t event_id, void *event_data)
|
|
{
|
|
ESP_LOGI(TAG, "PPP state changed event %d", event_id);
|
|
if (event_id == NETIF_PPP_PHASE_DISCONNECT) {
|
|
xEventGroupSetBits(event_group, DISCONNECT_BIT);
|
|
}
|
|
}
|
|
|
|
|
|
static void on_ip_event(void *arg, esp_event_base_t event_base,
|
|
int32_t event_id, void *event_data)
|
|
{
|
|
if (event_id == IP_EVENT_PPP_GOT_IP) {
|
|
ESP_LOGI(TAG, "GOT ip event!!!");
|
|
|
|
ip_event_got_ip_t *event = (ip_event_got_ip_t *)event_data;
|
|
|
|
ESP_LOGI(TAG, "PPP client connected to PPP Server");
|
|
ESP_LOGI(TAG, "IP : " IPSTR, IP2STR(&event->ip_info.ip));
|
|
ESP_LOGI(TAG, "Netmask : " IPSTR, IP2STR(&event->ip_info.netmask));
|
|
ESP_LOGI(TAG, "Gateway : " IPSTR, IP2STR(&event->ip_info.gw));
|
|
xEventGroupSetBits(event_group, CONNECT_BIT);
|
|
|
|
} else if (event_id == IP_EVENT_PPP_LOST_IP) {
|
|
ESP_LOGI(TAG, "Modem Disconnect from PPP Server");
|
|
} else if (event_id == IP_EVENT_GOT_IP6) {
|
|
ESP_LOGI(TAG, "GOT IPv6 event!");
|
|
|
|
ip_event_got_ip6_t *event = (ip_event_got_ip6_t *)event_data;
|
|
ESP_LOGI(TAG, "Got IPv6 address " IPV6STR, IPV62STR(event->ip6_info.ip));
|
|
}
|
|
}
|
|
|
|
static esp_err_t test_tcp_client_ipv4(void)
|
|
{
|
|
struct sockaddr_in dest_addr;
|
|
|
|
int addr_family;
|
|
int ip_protocol;
|
|
const char *payload = "Espressif";
|
|
|
|
|
|
dest_addr.sin_addr.s_addr = inet_addr(HOST_IP_ADDR);
|
|
dest_addr.sin_family = AF_INET;
|
|
dest_addr.sin_port = htons(PORT);
|
|
addr_family = AF_INET;
|
|
ip_protocol = IPPROTO_IP;
|
|
inet_ntoa_r(dest_addr.sin_addr, addr_str, sizeof(addr_str) - 1);
|
|
int sock = socket(addr_family, SOCK_STREAM, ip_protocol);
|
|
if (sock < 0) {
|
|
ESP_LOGE(TAG, "Unable to create socket: errno %d", errno);
|
|
goto fail;
|
|
}
|
|
ESP_LOGI(TAG, "Socket created, connecting to %s:%d", HOST_IP_ADDR, PORT);
|
|
|
|
int err = connect(sock, (struct sockaddr *)&dest_addr, sizeof(dest_addr));
|
|
if (err != 0) {
|
|
ESP_LOGE(TAG, "Socket unable to connect: errno %d", errno);
|
|
goto fail;
|
|
}
|
|
ESP_LOGI(TAG, "Successfully connected");
|
|
err = send(sock, payload, strlen(payload), 0);
|
|
if (err < 0) {
|
|
ESP_LOGE(TAG, "Error occurred during sending: errno %d", errno);
|
|
goto fail;
|
|
}
|
|
int len = recv(sock, rx_buffer, sizeof(rx_buffer) - 1, 0);
|
|
if (len < 0) {
|
|
ESP_LOGE(TAG, "recv failed: errno %d", errno);
|
|
goto fail;
|
|
}
|
|
rx_buffer[len] = 0; // Null-terminate whatever we received and treat like a string
|
|
ESP_LOGI(TAG, "Received from socket:%s", rx_buffer);
|
|
return ESP_OK;
|
|
|
|
fail:
|
|
ESP_LOGE(TAG, "Test TCP connection failed!");
|
|
return ESP_FAIL;
|
|
}
|
|
|
|
static void test_tcp_server_ipv6(void *pvParameters)
|
|
{
|
|
int addr_family;
|
|
int ip_protocol;
|
|
|
|
struct sockaddr_in6 dest_addr;
|
|
bzero(&dest_addr.sin6_addr.un, sizeof(dest_addr.sin6_addr.un));
|
|
dest_addr.sin6_family = AF_INET6;
|
|
dest_addr.sin6_port = htons(PORT);
|
|
addr_family = AF_INET6;
|
|
ip_protocol = IPPROTO_IPV6;
|
|
inet6_ntoa_r(dest_addr.sin6_addr, addr_str, sizeof(addr_str) - 1);
|
|
|
|
int listen_sock = socket(addr_family, SOCK_STREAM, ip_protocol);
|
|
if (listen_sock < 0) {
|
|
ESP_LOGE(TAG, "Unable to create socket: errno %d", errno);
|
|
vTaskDelete(NULL);
|
|
return;
|
|
}
|
|
ESP_LOGI(TAG, "Socket created");
|
|
|
|
int err = bind(listen_sock, (struct sockaddr *)&dest_addr, sizeof(dest_addr));
|
|
if (err != 0) {
|
|
ESP_LOGE(TAG, "Socket unable to bind: errno %d", errno);
|
|
goto failed;
|
|
}
|
|
ESP_LOGI(TAG, "Socket bound, port %d", PORT);
|
|
|
|
err = listen(listen_sock, 1);
|
|
if (err != 0) {
|
|
ESP_LOGE(TAG, "Error occurred during listen: errno %d", errno);
|
|
goto failed;
|
|
}
|
|
|
|
while (1) {
|
|
ESP_LOGI(TAG, "Socket listening");
|
|
|
|
struct sockaddr_in6 source_addr;
|
|
size_t addr_len = sizeof(source_addr);
|
|
int sock = accept(listen_sock, (struct sockaddr *)&source_addr, &addr_len);
|
|
if (sock < 0) {
|
|
ESP_LOGE(TAG, "Unable to accept connection: errno %d", errno);
|
|
break;
|
|
}
|
|
|
|
inet6_ntoa_r(source_addr.sin6_addr, addr_str, sizeof(addr_str) - 1);
|
|
ESP_LOGI(TAG, "Socket accepted ip address: %s", addr_str);
|
|
|
|
int len = recv(sock, rx_buffer, sizeof(rx_buffer) - 1, 0);
|
|
if (len < 0) {
|
|
ESP_LOGE(TAG, "Error occurred during receiving: errno %d", errno);
|
|
} else if (len == 0) {
|
|
ESP_LOGW(TAG, "Connection closed");
|
|
} else {
|
|
rx_buffer[len] = 0; // Null-terminate whatever is received and treat it like a string
|
|
ESP_LOGI(TAG, "Received %d bytes: %s", len, rx_buffer);
|
|
goto passed;
|
|
}
|
|
|
|
shutdown(sock, 0);
|
|
close(sock);
|
|
}
|
|
|
|
failed:
|
|
xEventGroupSetBits(event_group, TCP_SERVER_FAILED);
|
|
passed:
|
|
xEventGroupSetBits(event_group, TCP_SERVER_DONE);
|
|
close(listen_sock);
|
|
vTaskDelete(NULL);
|
|
}
|
|
|
|
void app_main(void)
|
|
{
|
|
ESP_ERROR_CHECK(esp_netif_init());
|
|
ESP_ERROR_CHECK(esp_event_loop_create_default());
|
|
ESP_ERROR_CHECK(esp_event_handler_register(IP_EVENT, ESP_EVENT_ANY_ID, &on_ip_event, NULL));
|
|
ESP_ERROR_CHECK(esp_event_handler_register(NETIF_PPP_STATUS, ESP_EVENT_ANY_ID, &on_ppp_changed, NULL));
|
|
|
|
event_group = xEventGroupCreate();
|
|
|
|
// Init netif object
|
|
esp_netif_config_t cfg = ESP_NETIF_DEFAULT_PPP();
|
|
esp_netif_t *esp_netif = esp_netif_new(&cfg);
|
|
assert(esp_netif);
|
|
esp_netif_ppp_config_t ppp_config = {
|
|
.ppp_error_event_enabled = true,
|
|
.ppp_phase_event_enabled = true
|
|
};
|
|
esp_netif_ppp_set_params(esp_netif, &ppp_config);
|
|
|
|
/* create dte object */
|
|
esp_modem_dte_config_t config = ESP_MODEM_DTE_DEFAULT_CONFIG();
|
|
config.rx_io_num = 26;
|
|
config.tx_io_num = 25;
|
|
modem_dte_t *dte = esp_modem_dte_init(&config);
|
|
/* Register event handler */
|
|
ESP_ERROR_CHECK(esp_modem_set_event_handler(dte, modem_event_handler, ESP_EVENT_ANY_ID, NULL));
|
|
/* create dce object */
|
|
modem_dce_t *dce = null_dce_init(dte);
|
|
|
|
void *modem_netif_adapter = esp_modem_netif_setup(dte);
|
|
esp_modem_netif_set_default_handlers(modem_netif_adapter, esp_netif);
|
|
/* attach the modem to the network interface */
|
|
esp_netif_attach(esp_netif, modem_netif_adapter);
|
|
/* Wait for IP address */
|
|
xEventGroupWaitBits(event_group, CONNECT_BIT, pdTRUE, pdTRUE, portMAX_DELAY);
|
|
ESP_LOGI(TAG, "start IPv6 test");
|
|
xTaskCreate(test_tcp_server_ipv6, "tcp_server_ipv6", 4096, NULL, 5, NULL);
|
|
xEventGroupWaitBits(event_group, TCP_SERVER_DONE, pdTRUE, pdTRUE, portMAX_DELAY);
|
|
if (TCP_SERVER_FAILED & xEventGroupGetBits(event_group)) {
|
|
ESP_LOGE(TAG, "IPv6 test failed!");
|
|
} else {
|
|
ESP_LOGI(TAG, "IPv6 test passed");
|
|
}
|
|
|
|
/* Wait until the TCP server starts on the host */
|
|
vTaskDelay(1000 / portTICK_PERIOD_MS);
|
|
ESP_LOGI(TAG, "start IPv4 test");
|
|
if (test_tcp_client_ipv4() == ESP_OK) {
|
|
ESP_LOGI(TAG, "IPv4 test passed");
|
|
} else {
|
|
ESP_LOGE(TAG, "IPv6 test failed!");
|
|
}
|
|
|
|
ESP_ERROR_CHECK(esp_modem_stop_ppp(dte));
|
|
/* Wait for the PPP connection to terminate gracefully */
|
|
xEventGroupWaitBits(event_group, DISCONNECT_BIT, pdTRUE, pdTRUE, portMAX_DELAY);
|
|
/* Destroy the netif adapter withe events, which internally frees also the esp-netif instance */
|
|
esp_modem_netif_clear_default_handlers(modem_netif_adapter);
|
|
esp_modem_netif_teardown(modem_netif_adapter);
|
|
xEventGroupWaitBits(event_group, STOP_BIT, pdTRUE, pdTRUE, portMAX_DELAY);
|
|
ESP_ERROR_CHECK(dce->deinit(dce));
|
|
ESP_ERROR_CHECK(dte->deinit(dte));
|
|
}
|