2021-02-26 20:23:29 +01:00
|
|
|
//
|
|
|
|
// Created by david on 2/26/21.
|
|
|
|
//
|
|
|
|
#include <memory>
|
|
|
|
#include <utility>
|
|
|
|
#include <esp_log.h>
|
|
|
|
#include <esp_event.h>
|
2021-03-07 19:43:45 +01:00
|
|
|
#include "cxx_include/esp_modem_netif.hpp"
|
2021-02-26 20:23:29 +01:00
|
|
|
#include "cxx_include/esp_modem_dte.hpp"
|
|
|
|
#include "esp_netif_ppp.h"
|
|
|
|
|
2021-03-03 20:35:08 +01:00
|
|
|
#include <iostream>
|
2021-02-26 20:23:29 +01:00
|
|
|
|
|
|
|
|
2021-03-25 07:48:53 +01:00
|
|
|
void Netif::on_ppp_changed(void *arg, esp_event_base_t event_base,
|
2021-02-26 20:23:29 +01:00
|
|
|
int32_t event_id, void *event_data)
|
|
|
|
{
|
2021-03-25 07:48:53 +01:00
|
|
|
Netif *ppp = (Netif*)arg;
|
2021-03-03 20:35:08 +01:00
|
|
|
// DTE *e = (DTE*)arg;
|
|
|
|
std::cout << "on_ppp_changed " << std::endl;
|
2021-02-27 09:32:14 +01:00
|
|
|
ESP_LOGW("TAG", "PPP state changed event %d", event_id);
|
2021-02-26 20:23:29 +01:00
|
|
|
if (event_id < NETIF_PP_PHASE_OFFSET) {
|
|
|
|
ESP_LOGI("TAG", "PPP state changed event %d", event_id);
|
|
|
|
// only notify the modem on state/error events, ignoring phase transitions
|
2021-03-04 20:19:18 +01:00
|
|
|
ppp->signal.set(PPP_EXIT);
|
|
|
|
// e->notify_ppp_exit();
|
2021-03-03 20:35:08 +01:00
|
|
|
// e->data_mode_closed();
|
2021-02-26 20:23:29 +01:00
|
|
|
// esp_modem_notify_ppp_netif_closed(dte);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2021-03-25 07:48:53 +01:00
|
|
|
esp_err_t Netif::esp_modem_dte_transmit(void *h, void *buffer, size_t len)
|
2021-02-26 20:23:29 +01:00
|
|
|
{
|
2021-03-25 07:48:53 +01:00
|
|
|
Netif *ppp = (Netif*)h;
|
2021-03-04 20:19:18 +01:00
|
|
|
if (ppp->signal.is_any(PPP_STARTED)) {
|
|
|
|
std::cout << "sending data " << len << std::endl;
|
|
|
|
if (ppp->ppp_dte->write((uint8_t*)buffer, len) > 0) {
|
|
|
|
return ESP_OK;
|
|
|
|
}
|
2021-02-26 20:23:29 +01:00
|
|
|
}
|
|
|
|
return ESP_FAIL;
|
|
|
|
}
|
|
|
|
|
2021-03-25 07:48:53 +01:00
|
|
|
esp_err_t Netif::esp_modem_post_attach(esp_netif_t * esp_netif, void * args)
|
2021-02-26 20:23:29 +01:00
|
|
|
{
|
2021-02-27 09:32:14 +01:00
|
|
|
auto d = (ppp_netif_driver*)args;
|
2021-02-26 20:23:29 +01:00
|
|
|
esp_netif_driver_ifconfig_t driver_ifconfig = { };
|
2021-03-25 07:48:53 +01:00
|
|
|
driver_ifconfig.transmit = Netif::esp_modem_dte_transmit;
|
2021-03-04 20:19:18 +01:00
|
|
|
driver_ifconfig.handle = (void*)d->ppp;
|
2021-03-03 20:35:08 +01:00
|
|
|
std::cout << "esp_modem_post_attach " << std::endl;
|
2021-02-26 20:23:29 +01:00
|
|
|
d->base.netif = esp_netif;
|
|
|
|
ESP_ERROR_CHECK(esp_netif_set_driver_config(esp_netif, &driver_ifconfig));
|
|
|
|
// check if PPP error events are enabled, if not, do enable the error occurred/state changed
|
|
|
|
// to notify the modem layer when switching modes
|
|
|
|
esp_netif_ppp_config_t ppp_config;
|
2021-03-24 21:06:27 +01:00
|
|
|
// esp_netif_ppp_get_params(esp_netif, &ppp_config);
|
2021-03-04 20:19:18 +01:00
|
|
|
if (!ppp_config.ppp_error_event_enabled) {
|
2021-02-26 20:23:29 +01:00
|
|
|
ppp_config.ppp_error_event_enabled = true;
|
|
|
|
esp_netif_ppp_set_params(esp_netif, &ppp_config);
|
2021-03-04 20:19:18 +01:00
|
|
|
}
|
2021-02-26 20:23:29 +01:00
|
|
|
|
2021-03-03 20:35:08 +01:00
|
|
|
// ESP_ERROR_CHECK(esp_event_handler_register(NETIF_PPP_STATUS, ESP_EVENT_ANY_ID, &on_ppp_changed, 0));
|
2021-02-26 20:23:29 +01:00
|
|
|
return ESP_OK;
|
|
|
|
}
|
|
|
|
|
2021-03-25 07:48:53 +01:00
|
|
|
void Netif::receive(uint8_t *data, size_t len)
|
2021-02-27 09:32:14 +01:00
|
|
|
{
|
2021-03-04 20:19:18 +01:00
|
|
|
if (signal.is_any(PPP_STARTED)) {
|
|
|
|
std::cout << "received data " << len << std::endl;
|
|
|
|
esp_netif_receive(driver.base.netif, data, len, nullptr);
|
|
|
|
}
|
2021-02-27 09:32:14 +01:00
|
|
|
}
|
2021-02-26 20:23:29 +01:00
|
|
|
|
2021-03-25 07:48:53 +01:00
|
|
|
Netif::Netif(std::shared_ptr<DTE> e, esp_netif_t *ppp_netif):
|
2021-02-27 09:32:14 +01:00
|
|
|
ppp_dte(std::move(e)), netif(ppp_netif)
|
2021-02-26 20:23:29 +01:00
|
|
|
{
|
|
|
|
driver.base.netif = ppp_netif;
|
2021-03-04 20:19:18 +01:00
|
|
|
driver.ppp = this;
|
2021-02-26 20:23:29 +01:00
|
|
|
driver.base.post_attach = esp_modem_post_attach;
|
2021-03-03 20:35:08 +01:00
|
|
|
throw_if_esp_fail(esp_event_handler_register(NETIF_PPP_STATUS, ESP_EVENT_ANY_ID, &on_ppp_changed, (void*)this));
|
|
|
|
throw_if_esp_fail(esp_event_handler_register(IP_EVENT, IP_EVENT_PPP_GOT_IP, esp_netif_action_connected, ppp_netif));
|
|
|
|
throw_if_esp_fail(esp_event_handler_register(IP_EVENT, IP_EVENT_PPP_LOST_IP, esp_netif_action_disconnected, ppp_netif));
|
2021-02-26 20:23:29 +01:00
|
|
|
throw_if_esp_fail(esp_netif_attach(ppp_netif, &driver));
|
|
|
|
}
|
2021-02-27 09:32:14 +01:00
|
|
|
|
2021-03-25 07:48:53 +01:00
|
|
|
void Netif::start()
|
2021-02-27 09:32:14 +01:00
|
|
|
{
|
2021-03-06 16:56:50 +01:00
|
|
|
ppp_dte->set_data_cb([this](size_t len) -> bool {
|
2021-03-04 20:19:18 +01:00
|
|
|
uint8_t *data;
|
|
|
|
auto actual_len = ppp_dte->read(&data, len);
|
|
|
|
receive(data, actual_len);
|
|
|
|
return false;
|
|
|
|
});
|
2021-02-27 09:32:14 +01:00
|
|
|
esp_netif_action_start(driver.base.netif, 0, 0, 0);
|
2021-03-04 20:19:18 +01:00
|
|
|
signal.set(PPP_STARTED);
|
2021-03-03 20:35:08 +01:00
|
|
|
}
|
|
|
|
|
2021-03-25 07:48:53 +01:00
|
|
|
void Netif::stop()
|
2021-03-03 20:35:08 +01:00
|
|
|
{
|
|
|
|
std::cout << "esp_netif_action_stop " << std::endl;
|
|
|
|
esp_netif_action_stop(driver.base.netif, nullptr, 0, nullptr);
|
2021-03-04 20:19:18 +01:00
|
|
|
signal.clear(PPP_STARTED);
|
2021-03-03 20:35:08 +01:00
|
|
|
|
2021-02-27 09:32:14 +01:00
|
|
|
}
|