espressif/esp-protocols
1
0
Fork 1
mirror of https://github.com/espressif/esp-protocols.git synced 2025-07-16 12:02:11 +02:00
Code Issues Packages Projects Releases Wiki Activity

Merge pull request #157 from david-cermak/bugfix/modem_lambda_capture

Browse Source 
fix(esp-modem): On read/command callback fixes
This commit is contained in:
david-cermak
2022-10-13 21:25:04 +02:00
committed by GitHub
parent c6fc267e5f a02bf05eed
commit 06103e4bb4
3 changed files with 13 additions and 15 deletions
Download Patch File Download Diff File Expand all files Collapse all files

1
components/esp_modem/include/cxx_include/esp_modem_dte.hpp
View File

@ -122,6 +122,7 @@ private:
std::shared_ptr<Terminal> data_term; /*!< Secondary terminal for this DTE */ std::shared_ptr<Terminal> data_term; /*!< Secondary terminal for this DTE */
modem_mode mode; /*!< DTE operation mode */ modem_mode mode; /*!< DTE operation mode */
SignalGroup signal; /*!< Event group used to signal request-response operations */ SignalGroup signal; /*!< Event group used to signal request-response operations */
command_result result; /*!< Command result of the currently exectuted command */
std::function<bool(uint8_t *data, size_t len)> on_data; /*!< on data callback for current terminal */ std::function<bool(uint8_t *data, size_t len)> on_data; /*!< on data callback for current terminal */
}; };

12
components/esp_modem/src/esp_modem_dte.cpp
View File

@ -35,9 +35,9 @@ DTE::DTE(std::unique_ptr<Terminal> terminal):
command_result DTE::command(const std::string &command, got_line_cb got_line, uint32_t time_ms, const char separator) command_result DTE::command(const std::string &command, got_line_cb got_line, uint32_t time_ms, const char separator)
{ {
Scoped<Lock> l(internal_lock); Scoped<Lock> l(internal_lock);
command_result res = command_result::TIMEOUT; result = command_result::TIMEOUT;
signal.clear(GOT_LINE); signal.clear(GOT_LINE);
command_term->set_read_cb([&](uint8_t *data, size_t len) { command_term->set_read_cb([this, got_line, separator](uint8_t *data, size_t len) {
if (!data) { if (!data) {
data = buffer.get(); data = buffer.get();
len = command_term->read(data + buffer.consumed, buffer.size - buffer.consumed); len = command_term->read(data + buffer.consumed, buffer.size - buffer.consumed);
@ -45,8 +45,8 @@ command_result DTE::command(const std::string &command, got_line_cb got_line, ui
buffer.consumed = 0; // if the underlying terminal contains data, we cannot fragment buffer.consumed = 0; // if the underlying terminal contains data, we cannot fragment
} }
if (memchr(data + buffer.consumed, separator, len)) { if (memchr(data + buffer.consumed, separator, len)) {
res = got_line(data, buffer.consumed + len); result = got_line(data, buffer.consumed + len);
if (res == command_result::OK || res == command_result::FAIL) { if (result == command_result::OK || result == command_result::FAIL) {
signal.set(GOT_LINE); signal.set(GOT_LINE);
return true; return true;
} }
@ -56,12 +56,12 @@ command_result DTE::command(const std::string &command, got_line_cb got_line, ui
}); });
command_term->write((uint8_t *)command.c_str(), command.length()); command_term->write((uint8_t *)command.c_str(), command.length());
auto got_lf = signal.wait(GOT_LINE, time_ms); auto got_lf = signal.wait(GOT_LINE, time_ms);
if (got_lf && res == command_result::TIMEOUT) { if (got_lf && result == command_result::TIMEOUT) {
ESP_MODEM_THROW_IF_ERROR(ESP_ERR_INVALID_STATE); ESP_MODEM_THROW_IF_ERROR(ESP_ERR_INVALID_STATE);
} }
buffer.consumed = 0; buffer.consumed = 0;
command_term->set_read_cb(nullptr); command_term->set_read_cb(nullptr);
return res; return result;
} }
command_result DTE::command(const std::string &cmd, got_line_cb got_line, uint32_t time_ms) command_result DTE::command(const std::string &cmd, got_line_cb got_line, uint32_t time_ms)

15
components/esp_modem/src/esp_modem_uart.cpp
View File

@ -72,8 +72,8 @@ public:
void set_read_cb(std::function<bool(uint8_t *data, size_t len)> f) override void set_read_cb(std::function<bool(uint8_t *data, size_t len)> f) override
{ {
ESP_MODEM_THROW_IF_FALSE(signal.wait(TASK_PARAMS, 1000), "Failed to set UART task params");
on_read = std::move(f); on_read = std::move(f);
signal.set(TASK_PARAMS);
} }
private: private:
@ -118,7 +118,6 @@ std::unique_ptr<Terminal> create_uart_terminal(const esp_modem_dte_config *confi
void UartTerminal::task() void UartTerminal::task()
{ {
std::function<bool(uint8_t *data, size_t len)> on_read_priv = nullptr;
uart_event_t event; uart_event_t event;
size_t len; size_t len;
signal.set(TASK_INIT); signal.set(TASK_INIT);
@ -127,17 +126,15 @@ void UartTerminal::task()
return; // exits to the static method where the task gets deleted return; // exits to the static method where the task gets deleted
} }
while (signal.is_any(TASK_START)) { while (signal.is_any(TASK_START)) {
signal.set(TASK_PARAMS);
if (get_event(event, 100)) { if (get_event(event, 100)) {
if (signal.is_any(TASK_PARAMS)) { signal.clear(TASK_PARAMS);
on_read_priv = on_read;
signal.clear(TASK_PARAMS);
}
switch (event.type) { switch (event.type) {
case UART_DATA: case UART_DATA:
uart_get_buffered_data_len(uart.port, &len); uart_get_buffered_data_len(uart.port, &len);
if (len && on_read_priv) { if (len && on_read) {
if (on_read_priv(nullptr, len)) { if (on_read(nullptr, len)) {
on_read_priv = nullptr; on_read = nullptr;
} }
} }
break; break;