twr_cmwx1zzabz.c

#include <twr_cmwx1zzabz.h>
#include <twr_log.h>
#include <twr_timer.h>

/*

Supported Murata firmware versions

1.0.02
1.1.03 - added FRMCNT
1.1.06 - added JOINDC

*/

#define TWR_CMWX1ZZABZ_DELAY_RUN 100
#define TWR_CMWX1ZZABZ_DELAY_INITIALIZATION_RESET_H 100
#define TWR_CMWX1ZZABZ_DELAY_INITIALIZATION_AT_COMMAND 100 // ! when using longer AT responses
#define TWR_CMWX1ZZABZ_DELAY_CONFIG_SAVE 100
#define TWR_CMWX1ZZABZ_DELAY_INITIALIZATION_AT_RESPONSE 100
#define TWR_CMWX1ZZABZ_DELAY_SEND_MESSAGE_RESPONSE 1500
#define TWR_CMWX1ZZABZ_DELAY_JOIN_RESPONSE 500 //8000
#define TWR_CMWX1ZZABZ_DELAY_LINK_CHECK_RESPONSE 4000
#define TWR_CMWX1ZZABZ_DELAY_CUSTOM_COMMAND_RESPONSE 100

#define TWR_CMWX1ZZABZ_TIMEOUT_CUSTOM_COMMAND_RESPONSE 500
#define TWR_CMWX1ZZABZ_TIMEOUT_LNCHECK 20000
#define TWR_CMWX1ZZABZ_TIMEOUT_JOIN 20000

// Apply changes to the factory configuration
const char *_init_commands[] =
{
    "AT\r",
    "AT+VER?\r",
    "AT+DEV?\r",
    "AT+DFORMAT=0\r",
    "AT+DUTYCYCLE=0\r",
    "AT+JOINDC=0\r",
    "AT+DWELL=0,0\r",
    "AT+DEVADDR?\r",
    "AT+DEVEUI?\r",
    "AT+APPEUI?\r",
    "AT+NWKSKEY?\r",
    "AT+APPSKEY?\r",
    "AT+APPKEY?\r",
    "AT+BAND?\r",
    "AT+MODE?\r",
    "AT+CLASS?\r",
    "AT+RX2?\r",
    "AT+NWK?\r",
    "AT+ADR?\r",
    "AT+DR?\r",
    "AT+REP?\r",
    "AT+RTYNUM?\r",
    NULL
};

static void _twr_cmwx1zzabz_task(void *param);

static bool _twr_cmwx1zzabz_read_response(twr_cmwx1zzabz_t *self);

static void _twr_cmwx1zzabz_save_config(twr_cmwx1zzabz_t *self, twr_cmwx1zzabz_config_index_t config_index);

static void _uart_event_handler(twr_uart_channel_t channel, twr_uart_event_t event, void *param);

void twr_cmwx1zzabz_init(twr_cmwx1zzabz_t *self,  twr_uart_channel_t uart_channel)
{
    memset(self, 0, sizeof(*self));

    self->_uart_channel = uart_channel;
    self->_tx_port = 2;

    twr_fifo_init(&self->_tx_fifo, self->_tx_fifo_buffer, sizeof(self->_tx_fifo_buffer));
    twr_fifo_init(&self->_rx_fifo, self->_rx_fifo_buffer, sizeof(self->_rx_fifo_buffer));

    twr_uart_init(self->_uart_channel, TWR_UART_BAUDRATE_9600, TWR_UART_SETTING_8N1);
    twr_uart_set_async_fifo(self->_uart_channel, &self->_tx_fifo, &self->_rx_fifo);
    twr_uart_async_read_start(self->_uart_channel, TWR_TICK_INFINITY);
    twr_uart_set_event_handler(self->_uart_channel, _uart_event_handler, self);

    self->_task_id = twr_scheduler_register(_twr_cmwx1zzabz_task, self, TWR_CMWX1ZZABZ_DELAY_RUN);
    self->_state = TWR_CMWX1ZZABZ_STATE_INITIALIZE;
}

static void _uart_event_handler(twr_uart_channel_t channel, twr_uart_event_t event, void *param)
{
    (void) channel;
    twr_cmwx1zzabz_t *self = (twr_cmwx1zzabz_t*)param;

    if (event == TWR_UART_EVENT_ASYNC_READ_DATA && self->_state == TWR_CMWX1ZZABZ_STATE_IDLE)
    {
        twr_scheduler_plan_relative(self->_task_id, 100);
        self->_state = TWR_CMWX1ZZABZ_STATE_RECEIVE;
    }
}

void twr_cmwx1zzabz_set_event_handler(twr_cmwx1zzabz_t *self, void (*event_handler)(twr_cmwx1zzabz_t *, twr_cmwx1zzabz_event_t, void *), void *event_param)
{
    self->_event_handler = event_handler;
    self->_event_param = event_param;
}

bool twr_cmwx1zzabz_is_ready(twr_cmwx1zzabz_t *self)
{
    if (self->_state == TWR_CMWX1ZZABZ_STATE_IDLE)
    {
        return true;
    }

    return false;
}

bool twr_cmwx1zzabz_send_message(twr_cmwx1zzabz_t *self, const void *buffer, size_t length)
{
    if (!twr_cmwx1zzabz_is_ready(self) || length == 0 || length > TWR_CMWX1ZZABZ_TX_MAX_PACKET_SIZE)
    {
        return false;
    }

    self->_message_length = length;

    memcpy(self->_message_buffer, buffer, self->_message_length);

    self->_state = TWR_CMWX1ZZABZ_STATE_SEND_MESSAGE_COMMAND;

    twr_scheduler_plan_now(self->_task_id);

    return true;
}

bool twr_cmwx1zzabz_send_message_confirmed(twr_cmwx1zzabz_t *self, const void *buffer, size_t length)
{
    if (!twr_cmwx1zzabz_is_ready(self) || length == 0 || length > TWR_CMWX1ZZABZ_TX_MAX_PACKET_SIZE)
    {
        return false;
    }

    self->_message_length = length;

    memcpy(self->_message_buffer, buffer, self->_message_length);

    self->_state = TWR_CMWX1ZZABZ_STATE_SEND_MESSAGE_CONFIRMED_COMMAND;

    twr_scheduler_plan_now(self->_task_id);

    return true;
}

void twr_cmwx1zzabz_set_debug(twr_cmwx1zzabz_t *self, bool debug)
{
    self->_debug = debug;
}

static size_t _twr_cmwx1zzabz_async_write(twr_cmwx1zzabz_t *self, const void *buffer, size_t length)
{
    size_t ret = twr_uart_async_write(self->_uart_channel, buffer, length);

    if (self->_debug)
    {
        twr_log_debug("LoRa TX: %s", (const char*)buffer);
    }

    return ret;
}

static size_t _twr_cmwx1zzabz_write(twr_cmwx1zzabz_t *self, const void *buffer, size_t length)
{
    size_t ret = twr_uart_write(self->_uart_channel, buffer, length);

    if (self->_debug)
    {
        twr_log_debug("LoRa syncTX: %s", (const char*)buffer);
    }

    return ret;
}

static void _twr_cmwx1zzabz_task(void *param)
{
    twr_cmwx1zzabz_t *self = param;

    while (true)
    {
        switch (self->_state)
        {
            case TWR_CMWX1ZZABZ_STATE_READY:
            {
                self->_state = TWR_CMWX1ZZABZ_STATE_IDLE;

                if (self->_event_handler != NULL)
                {
                    self->_event_handler(self, TWR_CMWX1ZZABZ_EVENT_READY, self->_event_param);
                }

                continue;
            }
            case TWR_CMWX1ZZABZ_STATE_IDLE:
            {
                if (self->_save_config_mask != 0)
                {
                    self->_state = TWR_CMWX1ZZABZ_STATE_CONFIG_SAVE_SEND;
                    continue;
                }

                if(self->_join_command)
                {
                    self->_state = TWR_CMWX1ZZABZ_STATE_JOIN_SEND;
                    continue;
                }

                if(self->_custom_command)
                {
                    self->_state = TWR_CMWX1ZZABZ_STATE_CUSTOM_COMMAND_SEND;
                    continue;
                }

                if(self->_link_check_command)
                {
                    self->_state = TWR_CMWX1ZZABZ_STATE_LINK_CHECK_SEND;
                    continue;
                }

                return;
            }
            case TWR_CMWX1ZZABZ_STATE_RECEIVE:
            {
                self->_state = TWR_CMWX1ZZABZ_STATE_IDLE;

                while (_twr_cmwx1zzabz_read_response(self))
                {
                    if (memcmp(self->_response, "+RECV=", 5) == 0)
                    {
                        self->_message_port = atoi(&self->_response[6]);

                        char *comma_search = strchr(self->_response, ',');
                        if (!comma_search)
                        {
                            continue;
                        }

                        // Parse from the next character
                        self->_message_length = atoi(++comma_search);

                        // Dummy read three \r\n\r characters
                        char dummy[3];
                        uint32_t bytes = twr_uart_async_read(self->_uart_channel, &dummy, 3);
                        if (bytes != 3)
                        {
                            continue;
                        }

                        // Received data is bigger than library message buffer
                        if (self->_message_length > sizeof(self->_message_buffer))
                        {
                            continue;
                        }

                        // Read the received message
                        bytes = twr_uart_async_read(self->_uart_channel, self->_message_buffer, self->_message_length);
                        if (bytes != self->_message_length)
                        {
                            continue;
                        }

                        if (self->_event_handler != NULL)
                        {
                            self->_event_handler(self, TWR_CMWX1ZZABZ_EVENT_MESSAGE_RECEIVED, self->_event_param);
                        }
                    }
                    else if (memcmp(self->_response, "+ACK", 4) == 0)
                    {
                        if (self->_event_handler != NULL)
                        {
                            self->_event_handler(self, TWR_CMWX1ZZABZ_EVENT_MESSAGE_CONFIRMED, self->_event_param);
                        }
                    }
                    else if (memcmp(self->_response, "+NOACK", 4) == 0)
                    {
                        if (self->_event_handler != NULL)
                        {
                            self->_event_handler(self, TWR_CMWX1ZZABZ_EVENT_MESSAGE_NOT_CONFIRMED, self->_event_param);
                        }
                    }
                    else if (memcmp(self->_response, "+EVENT=2,2", 10) == 0)
                    {
                        if (self->_event_handler != NULL)
                        {
                            self->_event_handler(self, TWR_CMWX1ZZABZ_EVENT_MESSAGE_RETRANSMISSION, self->_event_param);
                        }
                    }
                    // This is used when band changes or factory reset command
                    // 1.0.0.2 & 1.1.0.6 sends +EVENT=0,0 boot event
                    // 1.1.0.3 & 1.1.0.6 sends +EVENT=0,1 factory reset event
                    else if (memcmp(self->_response, "+EVENT=0,1", 10) == 0 || memcmp(self->_response, "+EVENT=0,0", 10) == 0)
                    {
                        self->_state = TWR_CMWX1ZZABZ_STATE_INITIALIZE;
                        self->_save_config_mask = 0;

                        if (self->_event_handler != NULL)
                        {
                            self->_event_handler(self, TWR_CMWX1ZZABZ_EVENT_MODEM_FACTORY_RESET, self->_event_param);
                        }
                    }
                }

                continue;
            }
            case TWR_CMWX1ZZABZ_STATE_ERROR:
            {
                self->_save_config_mask = 0;

                if (self->_event_handler != NULL)
                {
                    self->_event_handler(self, TWR_CMWX1ZZABZ_EVENT_ERROR, self->_event_param);
                }

                self->_state = TWR_CMWX1ZZABZ_STATE_INITIALIZE;
                twr_scheduler_plan_current_from_now(3000);
                return;
            }
            case TWR_CMWX1ZZABZ_STATE_INITIALIZE:
            {
                self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;
                self->_init_command_index = 0;

                // Test AT command at 9600 baud
                char cmd_at[] = "AT\r";
                size_t length = strlen(cmd_at);

                _twr_cmwx1zzabz_write(self, cmd_at, length);

                twr_timer_start();
                twr_timer_delay(50000);
                twr_timer_stop();

                // Purge RX FIFO
                twr_fifo_purge(&self->_rx_fifo);

                if (_twr_cmwx1zzabz_async_write(self, cmd_at, length) != length)
                {
                    continue;
                }

                self->_state = TWR_CMWX1ZZABZ_STATE_INITIALIZE_AT_RESPONSE;

                twr_scheduler_plan_current_from_now(200);
                return;
            }

            case TWR_CMWX1ZZABZ_STATE_INITIALIZE_AT_RESPONSE:
            {
                _twr_cmwx1zzabz_read_response(self);

                if (strcmp(self->_response, "+OK\r") == 0)
                {
                    // Modem is replying @9600 baud
                    if (self->_debug)
                    {
                        twr_log_debug("OK response @9600");
                    }
                    self->_state = TWR_CMWX1ZZABZ_STATE_INITIALIZE_COMMAND_SEND;
                    continue;
                }

                // No repsponse from modem, try to recover baudrate
                if (self->_debug)
                {
                    twr_log_debug("NO response @9600");
                }
                self->_state = TWR_CMWX1ZZABZ_STATE_RECOVER_BAUDRATE_UART;
            }

            case TWR_CMWX1ZZABZ_STATE_RECOVER_BAUDRATE_UART:
            {
                self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;

                // 19200 baud
                if (self->_debug)
                {
                    twr_log_debug("Higher baudrate 19200");
                }
                twr_uart_deinit(self->_uart_channel);
                twr_uart_init(self->_uart_channel, TWR_UART_BAUDRATE_19200, TWR_UART_SETTING_8N1);


                twr_timer_init();

                char cmd_at[] = "AT\r";
                _twr_cmwx1zzabz_write(self, cmd_at, strlen(cmd_at));

                twr_timer_start();
                twr_timer_delay(50000);
                twr_timer_stop();

                char cmd_at_baud[] = "AT+UART=9600\r";
                _twr_cmwx1zzabz_write(self, cmd_at_baud, strlen(cmd_at_baud));

                twr_timer_start();
                twr_timer_delay(50000);
                twr_timer_stop();

                char cmd_at_reboot[] = "AT+REBOOT\r";
                _twr_cmwx1zzabz_write(self, cmd_at_reboot, strlen(cmd_at_reboot));

                // 9600 baud
                if (self->_debug)
                {
                    twr_log_debug("Lower baudrate 9600");
                }
                twr_uart_deinit(self->_uart_channel);
                twr_uart_init(self->_uart_channel, TWR_UART_BAUDRATE_9600, TWR_UART_SETTING_8N1);

                twr_fifo_init(&self->_tx_fifo, self->_tx_fifo_buffer, sizeof(self->_tx_fifo_buffer));
                twr_fifo_init(&self->_rx_fifo, self->_rx_fifo_buffer, sizeof(self->_rx_fifo_buffer));

                twr_uart_set_async_fifo(self->_uart_channel, &self->_tx_fifo, &self->_rx_fifo);
                twr_uart_async_read_start(self->_uart_channel, TWR_TICK_INFINITY);
                twr_uart_set_event_handler(self->_uart_channel, _uart_event_handler, self);

                self->_state = TWR_CMWX1ZZABZ_STATE_INITIALIZE;

                twr_scheduler_plan_current_from_now(1000);
                return;
            }

            case TWR_CMWX1ZZABZ_STATE_INITIALIZE_COMMAND_SEND:
            {
                self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;

                // Purge RX FIFO
                twr_fifo_purge(&self->_rx_fifo);

                strcpy(self->_command, _init_commands[self->_init_command_index]);
                size_t length = strlen(self->_command);

                if (_twr_cmwx1zzabz_async_write(self, self->_command, length) != length)
                {
                    continue;
                }

                self->_state = TWR_CMWX1ZZABZ_STATE_INITIALIZE_COMMAND_RESPONSE;
                self->_timeout = twr_tick_get();
                twr_scheduler_plan_current_from_now(TWR_CMWX1ZZABZ_DELAY_INITIALIZATION_AT_COMMAND);

                return;
            }
            case TWR_CMWX1ZZABZ_STATE_INITIALIZE_COMMAND_RESPONSE:
            {
                if (!_twr_cmwx1zzabz_read_response(self))
                {
                    twr_scheduler_plan_current_from_now(20);
                    if (twr_tick_get() > (self->_timeout + TWR_CMWX1ZZABZ_TIMEOUT_CUSTOM_COMMAND_RESPONSE))
                    {
                        self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;
                    }
                    return;
                }

                self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;
                uint8_t response_handled = 0;

                // Compare first 4 cahracters from response
                uint32_t response_valid = (memcmp(self->_response, "+OK=", 4) == 0);
                // Pointer to the last send command to know the context of the answer
                const char *last_command = _init_commands[self->_init_command_index];
                // Pointer to the first character of response value after +OK=
                char *response_string_value = &self->_response[4];

                if (strcmp(last_command, "AT+DEVADDR?\r") == 0 && response_valid)
                {
                    // Check if user did not filled this structure to save configuration, oterwise it would be overwritten
                    if ((self->_save_config_mask & 1 << TWR_CMWX1ZZABZ_CONFIG_INDEX_DEVADDR) == 0)
                    {
                        memcpy(self->_config.devaddr, response_string_value, 8);
                        self->_config.devaddr[8] = '\0';
                    }
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+DEVEUI?\r") == 0 && response_valid)
                {
                    if ((self->_save_config_mask & 1 << TWR_CMWX1ZZABZ_CONFIG_INDEX_DEVEUI) == 0)
                    {
                        memcpy(self->_config.deveui, response_string_value, 16);
                        self->_config.deveui[16] = '\0';
                    }
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+APPEUI?\r") == 0 && response_valid)
                {
                    if ((self->_save_config_mask & 1 << TWR_CMWX1ZZABZ_CONFIG_INDEX_APPEUI) == 0)
                    {
                        memcpy(self->_config.appeui, response_string_value, 16);
                        self->_config.appeui[16] = '\0';
                    }
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+NWKSKEY?\r") == 0 && response_valid)
                {
                    if ((self->_save_config_mask & 1 << TWR_CMWX1ZZABZ_CONFIG_INDEX_NWKSKEY) == 0)
                    {
                        memcpy(self->_config.nwkskey, response_string_value, 32);
                        self->_config.nwkskey[32] = '\0';
                    }
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+APPSKEY?\r") == 0 && response_valid)
                {
                    if ((self->_save_config_mask & 1 << TWR_CMWX1ZZABZ_CONFIG_INDEX_APPSKEY) == 0)
                    {
                        memcpy(self->_config.appskey, response_string_value, 32);
                        self->_config.appskey[32] = '\0';
                    }
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+APPKEY?\r") == 0 && response_valid)
                {
                    if ((self->_save_config_mask & 1 << TWR_CMWX1ZZABZ_CONFIG_INDEX_APPKEY) == 0)
                    {
                        memcpy(self->_config.appkey, response_string_value, 32);
                        self->_config.appkey[32] = '\0';
                    }
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+BAND?\r") == 0 && response_valid)
                {
                    if ((self->_save_config_mask & 1 << TWR_CMWX1ZZABZ_CONFIG_INDEX_BAND) == 0)
                    {
                        self->_config.band = response_string_value[0] - '0';
                    }
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+MODE?\r") == 0 && response_valid)
                {
                    if ((self->_save_config_mask & 1 << TWR_CMWX1ZZABZ_CONFIG_INDEX_MODE) == 0)
                    {
                        self->_config.mode = response_string_value[0] - '0';
                    }
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+CLASS?\r") == 0 && response_valid)
                {
                    if ((self->_save_config_mask & 1 << TWR_CMWX1ZZABZ_CONFIG_INDEX_CLASS) == 0)
                    {
                        self->_config.class = response_string_value[0] - '0';
                    }
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+RX2?\r") == 0 && response_valid)
                {
                    if ((self->_save_config_mask & 1 << TWR_CMWX1ZZABZ_CONFIG_INDEX_RX2) == 0)
                    {
                        self->_config.rx2_frequency = atoi(response_string_value);

                        char *comma_search = strchr(response_string_value, ',');
                        if (!comma_search)
                        {
                            continue;
                        }

                        self->_config.rx2_datarate = atoi(++comma_search);
                    }
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+NWK?\r") == 0 && response_valid)
                {
                    if ((self->_save_config_mask & 1 << TWR_CMWX1ZZABZ_CONFIG_INDEX_NWK) == 0)
                    {
                        self->_config.nwk_public = response_string_value[0] - '0';
                    }
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+ADR?\r") == 0 && response_valid)
                {
                    if ((self->_save_config_mask & 1 << TWR_CMWX1ZZABZ_CONFIG_INDEX_ADAPTIVE_DATARATE) == 0)
                    {
                        self->_config.adaptive_datarate = response_string_value[0] == '1';
                    }
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+DR?\r") == 0 && response_valid)
                {
                    if ((self->_save_config_mask & 1 << TWR_CMWX1ZZABZ_CONFIG_INDEX_DATARATE) == 0)
                    {
                        self->_config.datarate = atoi(response_string_value);
                    }
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+REP?\r") == 0 && response_valid)
                {
                    if ((self->_save_config_mask & 1 << TWR_CMWX1ZZABZ_CONFIG_INDEX_REP) == 0)
                    {
                        self->_config.repetition_unconfirmed = atoi(response_string_value);
                    }
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+RTYNUM?\r") == 0 && response_valid)
                {
                    if ((self->_save_config_mask & 1 << TWR_CMWX1ZZABZ_CONFIG_INDEX_RTYNUM) == 0)
                    {
                        self->_config.repetition_confirmed = atoi(response_string_value);
                    }
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+DUTYCYCLE=0\r") == 0 && strcmp(self->_response, "+ERR=-17\r") == 0)
                {
                    // DUTYCYLE is unusable in some band configuration, ignore this err response
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+DWELL=0,0\r") == 0 && strcmp(self->_response, "+ERR=-17\r") == 0)
                {
                    // DWELL is used only in AS923
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+JOINDC=0\r") == 0 && (strcmp(self->_response, "+ERR=-1\r") == 0 || strcmp(self->_response, "+ERR=-14\r") == 0 || strcmp(self->_response, "+ERR=-17\r") == 0))
                {
                    // JOINDC is in the firmware 1.1.06 and higher
                    // +ERR=-1 case is there for older firmwares
                    // +ERR=-14 case is there for 1.1.06 in case modem has set MODE=0 (ABP)
                    // +ERR=-17 case command is not supported in current band
                    response_handled = 1;
                }
                else if (strcmp(last_command, "AT+VER?\r") == 0 && memcmp(self->_response, "+OK=", 4) == 0)
                {
                    // Grab firmware version, only first part eg. 1.1.06
                    // +OK=1.1.06,Aug 24 2020 16:11:57<\r>
                    char *comma = strchr(self->_response, ',');
                    if (comma)
                    {
                        char *first_character = &self->_response[4];
                        memset(self->_fw_version, '\0', sizeof(self->_fw_version));
                        int len = comma - first_character;
                        memcpy(self->_fw_version, first_character, len);
                    }
                    response_handled = 1;
                }
                else if (   strcmp(last_command, "AT\r") == 0 &&
                            strcmp(self->_response, "+OK\r") == 0
                        )
                {
                    response_handled = 1;
                }
                // Generic OK response to other commands
                else if (memcmp(self->_response, "+OK", 3) == 0)
                {
                    response_handled = 1;
                }

                if (!response_handled)
                {
                    continue;
                }

                self->_init_command_index++;

                if (_init_commands[self->_init_command_index] == NULL)
                {
                    // If configuration was changed and flag set, save them
                    if (self->_save_config_mask)
                    {
                        self->_state = TWR_CMWX1ZZABZ_STATE_CONFIG_SAVE_SEND;
                        self->_save_command_index = 0;
                    }
                    else
                    {
                        self->_state = TWR_CMWX1ZZABZ_STATE_READY;
                    }
                }
                else
                {
                    self->_state = TWR_CMWX1ZZABZ_STATE_INITIALIZE_COMMAND_SEND;
                }

                continue;
            }
            case TWR_CMWX1ZZABZ_STATE_SEND_MESSAGE_COMMAND:
            case TWR_CMWX1ZZABZ_STATE_SEND_MESSAGE_CONFIRMED_COMMAND:
            {
                if (self->_state == TWR_CMWX1ZZABZ_STATE_SEND_MESSAGE_CONFIRMED_COMMAND)
                {
                    snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+PCTX %d,%d\r", self->_tx_port, self->_message_length);
                }
                else
                {
                    snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+PUTX %d,%d\r", self->_tx_port, self->_message_length);
                }

                self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;

                uint8_t command_length = strlen(self->_command);

                for (size_t i = 0; i < self->_message_length; i++)
                {
                    // put binary data directly to the "string" buffer
                    self->_command[command_length + i] = self->_message_buffer[i];
                }

                self->_command[command_length + self->_message_length] = '\r';

                size_t length = command_length + self->_message_length + 1; // 1 for \n

                if (_twr_cmwx1zzabz_async_write(self, self->_command, length) != length)
                {
                    continue;
                }

                self->_state = TWR_CMWX1ZZABZ_STATE_SEND_MESSAGE_RESPONSE;

                if (self->_event_handler != NULL)
                {
                    self->_event_handler(self, TWR_CMWX1ZZABZ_EVENT_SEND_MESSAGE_START, self->_event_param);
                }

                twr_scheduler_plan_current_from_now(TWR_CMWX1ZZABZ_DELAY_SEND_MESSAGE_RESPONSE);

                return;
            }
            case TWR_CMWX1ZZABZ_STATE_SEND_MESSAGE_RESPONSE:
            {
                self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;

                if (!_twr_cmwx1zzabz_read_response(self))
                {
                    continue;
                }

                if (strcmp(self->_response, "+OK\r") != 0)
                {
                    continue;
                }

                self->_state = TWR_CMWX1ZZABZ_STATE_IDLE;

                if (self->_event_handler != NULL)
                {
                    self->_event_handler(self, TWR_CMWX1ZZABZ_EVENT_SEND_MESSAGE_DONE, self->_event_param);
                }

                continue;
            }
            case TWR_CMWX1ZZABZ_STATE_CONFIG_SAVE_SEND:
            {
                self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;

                // There are no more config items to send
                if (self->_save_config_mask == 0)
                {
                    if (self->_event_handler != NULL)
                    {
                        self->_event_handler(self, TWR_CMWX1ZZABZ_EVENT_CONFIG_SAVE_DONE, self->_event_param);
                    }

                    self->_state = TWR_CMWX1ZZABZ_STATE_READY;
                    continue;
                }

                // Find config item that has been changed
                for (uint8_t i = 0; i < TWR_CMWX1ZZABZ_CONFIG_INDEX_LAST_ITEM; i++)
                {
                    if (self->_save_config_mask & 1 << i)
                    {
                        self->_save_command_index = i;
                        break;
                    }
                }

                // Purge RX FIFO
                twr_fifo_purge(&self->_rx_fifo);

                switch (self->_save_command_index)
                {
                    case TWR_CMWX1ZZABZ_CONFIG_INDEX_DEVADDR:
                    {
                        snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+DEVADDR=%s\r", self->_config.devaddr);
                        break;
                    }
                    case TWR_CMWX1ZZABZ_CONFIG_INDEX_DEVEUI:
                    {
                        snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+DEVEUI=%s\r", self->_config.deveui);
                        break;
                    }
                    case TWR_CMWX1ZZABZ_CONFIG_INDEX_APPEUI:
                    {
                        snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+APPEUI=%s\r", self->_config.appeui);
                        break;
                    }
                    case TWR_CMWX1ZZABZ_CONFIG_INDEX_NWKSKEY:
                    {
                        snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+NWKSKEY=%s\r", self->_config.nwkskey);
                        break;
                    }
                    case TWR_CMWX1ZZABZ_CONFIG_INDEX_APPSKEY:
                    {
                        snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+APPSKEY=%s\r", self->_config.appskey);
                        break;
                    }
                    case TWR_CMWX1ZZABZ_CONFIG_INDEX_APPKEY:
                    {
                        snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+APPKEY=%s\r", self->_config.appkey);
                        break;
                    }
                    case TWR_CMWX1ZZABZ_CONFIG_INDEX_BAND:
                    {
                        snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+BAND=%d\r", self->_config.band);
                        break;
                    }
                    case TWR_CMWX1ZZABZ_CONFIG_INDEX_MODE:
                    {
                        snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+MODE=%d\r", self->_config.mode);
                        break;
                    }
                    case TWR_CMWX1ZZABZ_CONFIG_INDEX_CLASS:
                    {
                        snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+CLASS=%d\r", self->_config.class);
                        break;
                    }
                    case TWR_CMWX1ZZABZ_CONFIG_INDEX_RX2:
                    {
                        snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+RX2=%d,%d\r", (int) self->_config.rx2_frequency, self->_config.rx2_datarate);
                        break;
                    }
                    case TWR_CMWX1ZZABZ_CONFIG_INDEX_NWK:
                    {
                        snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+NWK=%d\r", (int) self->_config.nwk_public);
                        break;
                    }
                    case TWR_CMWX1ZZABZ_CONFIG_INDEX_ADAPTIVE_DATARATE:
                    {
                        snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+ADR=%d\r", self->_config.adaptive_datarate ? 1 : 0);
                        break;
                    }
                    case TWR_CMWX1ZZABZ_CONFIG_INDEX_DATARATE:
                    {
                        snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+DR=%d\r", (int) self->_config.datarate);
                        break;
                    }
                    case TWR_CMWX1ZZABZ_CONFIG_INDEX_REP:
                    {
                        snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+REP=%d\r", (int) self->_config.repetition_unconfirmed);
                        break;
                    }
                    case TWR_CMWX1ZZABZ_CONFIG_INDEX_RTYNUM:
                    {
                        snprintf(self->_command, TWR_CMWX1ZZABZ_TX_FIFO_BUFFER_SIZE, "AT+RTYNUM=%d\r", (int) self->_config.repetition_confirmed);
                        break;
                    }

                    default:
                    {
                        break;
                    }
                }

                size_t length = strlen(self->_command);

                if (_twr_cmwx1zzabz_async_write(self, self->_command, length) != length)
                {
                    continue;
                }

                self->_state = TWR_CMWX1ZZABZ_STATE_CONFIG_SAVE_RESPONSE;
                twr_scheduler_plan_current_from_now(TWR_CMWX1ZZABZ_DELAY_CONFIG_SAVE);
                return;
            }

            case TWR_CMWX1ZZABZ_STATE_CONFIG_SAVE_RESPONSE:
            {
                self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;

                if (!_twr_cmwx1zzabz_read_response(self))
                {
                    continue;
                }

                // Jump to error state when response is not OK
                if (memcmp(self->_response, "+OK", 3) != 0)
                {
                    continue;
                }

                // Clean bit mask
                self->_save_config_mask &= ~(1 << self->_save_command_index);

                self->_state = TWR_CMWX1ZZABZ_STATE_CONFIG_SAVE_SEND;
                continue;

            }

            case TWR_CMWX1ZZABZ_STATE_JOIN_SEND:
            {
                self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;

                // Purge RX FIFO
                twr_fifo_purge(&self->_rx_fifo);

                strcpy(self->_command, "AT+JOIN\r");

                size_t length = strlen(self->_command);
                if (_twr_cmwx1zzabz_async_write(self, self->_command, length) != length)
                {
                    continue;
                }

                // Clear join command flag
                self->_join_command = false;

                self->_state = TWR_CMWX1ZZABZ_STATE_JOIN_RESPONSE;
                self->_timeout = twr_tick_get();
                twr_scheduler_plan_current_from_now(TWR_CMWX1ZZABZ_DELAY_JOIN_RESPONSE);
                return;
            }

            case TWR_CMWX1ZZABZ_STATE_JOIN_RESPONSE:
            {
                bool join_successful = false;

                if (!_twr_cmwx1zzabz_read_response(self))
                {
                    twr_scheduler_plan_current_from_now(50);
                    if (twr_tick_get() > (self->_timeout + TWR_CMWX1ZZABZ_TIMEOUT_JOIN))
                    {
                        self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;
                    }
                    return;
                }

                if (memcmp(self->_response, "+OK", 3) == 0)
                {
                    twr_scheduler_plan_current_now();
                    return;
                }

                // Response EVENT=1,1 means JOIN was successful
                if (memcmp(self->_response, "+EVENT=1,1", 10) == 0)
                {
                    join_successful = true;
                }

                if (join_successful)
                {
                    if (self->_event_handler != NULL)
                    {
                        self->_event_handler(self, TWR_CMWX1ZZABZ_EVENT_JOIN_SUCCESS, self->_event_param);
                    }
                }
                else
                {
                    if (self->_event_handler != NULL)
                    {
                        self->_event_handler(self, TWR_CMWX1ZZABZ_EVENT_JOIN_ERROR, self->_event_param);
                    }
                }

                self->_state = TWR_CMWX1ZZABZ_STATE_IDLE;
                continue;
            }

            case TWR_CMWX1ZZABZ_STATE_LINK_CHECK_SEND:
            {
                self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;

                // Purge RX FIFO
                twr_fifo_purge(&self->_rx_fifo);

                strcpy(self->_command, "AT+LNCHECK\r");

                size_t length = strlen(self->_command);
                if (_twr_cmwx1zzabz_async_write(self, self->_command, length) != length)
                {
                    continue;
                }

                self->_link_check_command = false;

                self->_state = TWR_CMWX1ZZABZ_STATE_LINK_CHECK_RESPONSE;
                self->_timeout = twr_tick_get();
                twr_scheduler_plan_current_from_now(TWR_CMWX1ZZABZ_DELAY_LINK_CHECK_RESPONSE);
                return;
            }

            case TWR_CMWX1ZZABZ_STATE_LINK_CHECK_RESPONSE:
            {
                if (!_twr_cmwx1zzabz_read_response(self))
                {
                    twr_scheduler_plan_current_from_now(10);
                    if (twr_tick_get() > (self->_timeout + TWR_CMWX1ZZABZ_TIMEOUT_LNCHECK))
                    {
                        self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;
                    }
                    return;
                }

                if (memcmp(self->_response, "+OK", 3) == 0)
                {
                    twr_scheduler_plan_current_now();
                    return;
                }

                // Check for response event
                if (strstr(self->_response, "+EVENT=2,") > 0)
                {
                    // MAC answer
                    char *event_str = strchr(self->_response, ',');
                    event_str++;

                    uint8_t link_check_event = atoi(event_str);

                    // Clean in case MAC response is 0 and we do not receive +ANS
                    self->_cmd_link_check_gwcnt = 0;
                    self->_cmd_link_check_margin = 0;

                    if (link_check_event == 1)
                    {
                        self->_state = TWR_CMWX1ZZABZ_STATE_LINK_CHECK_RESPONSE_ANS;
                        // Since +ANS was added in 1.1.03 we will wait until this URC arrives
                        twr_scheduler_plan_current_from_now(20);
                        return;
                    }
                }
                else
                {
                    self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;
                    continue;
                }

                self->_state = TWR_CMWX1ZZABZ_STATE_IDLE;

                if (self->_event_handler != NULL)
                {
                    self->_event_handler(self, TWR_CMWX1ZZABZ_EVENT_LINK_CHECK_NOK, self->_event_param);
                }

                twr_scheduler_plan_current_from_now(10);
                return;
            }

            case TWR_CMWX1ZZABZ_STATE_LINK_CHECK_RESPONSE_ANS:
            {
                // Did we received +ANS response? FW 1.0.02 don't have it
                if (_twr_cmwx1zzabz_read_response(self))
                {
                    // Search for ANS
                    char *ans = strstr(self->_response, "+ANS=2,");

                    if (ans)
                    {
                        ans += 7; // skip "+ANS=2,"
                        self->_cmd_link_check_margin = atoi(ans);

                        // MAC answer
                        char *gwcnt_str = strchr(ans, ',');
                        gwcnt_str++;

                        self->_cmd_link_check_gwcnt = atoi(gwcnt_str);
                    }
                }

                self->_state = TWR_CMWX1ZZABZ_STATE_IDLE;

                if (self->_event_handler != NULL)
                {
                    self->_event_handler(self, TWR_CMWX1ZZABZ_EVENT_LINK_CHECK_OK, self->_event_param);
                }

                twr_scheduler_plan_current_from_now(100);
                return;
            }

            case TWR_CMWX1ZZABZ_STATE_CUSTOM_COMMAND_SEND:
            {
                self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;

                // Purge RX FIFO
                twr_fifo_purge(&self->_rx_fifo);

                strcpy(self->_command, self->_custom_command_buf);

                size_t length = strlen(self->_command);
                if (_twr_cmwx1zzabz_async_write(self, self->_command, length) != length)
                {
                    continue;
                }

                self->_state = TWR_CMWX1ZZABZ_STATE_CUSTOM_COMMAND_RESPONSE;
                self->_timeout = twr_tick_get();
                twr_scheduler_plan_current_from_now(TWR_CMWX1ZZABZ_DELAY_CUSTOM_COMMAND_RESPONSE);
                return;
            }

            case TWR_CMWX1ZZABZ_STATE_CUSTOM_COMMAND_RESPONSE:
            {
                if (!_twr_cmwx1zzabz_read_response(self))
                {
                    twr_scheduler_plan_current_from_now(50);
                    if (twr_tick_get() > (self->_timeout + TWR_CMWX1ZZABZ_TIMEOUT_CUSTOM_COMMAND_RESPONSE))
                    {
                        self->_custom_command = false;
                        self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;
                        // If factory reset command, then reinitialize modem
                        if (strcmp(self->_command, "AT+FACNEW\r") == 0)
                        {
                            twr_scheduler_plan_current_from_now(1000);
                            self->_state = TWR_CMWX1ZZABZ_STATE_INITIALIZE;
                        }
                    }
                    return;
                }

                self->_state = TWR_CMWX1ZZABZ_STATE_ERROR;
                self->_custom_command = false;

                // In 1.0.02 fw FRMCNT is not supported, handle this in case this command
                // and others in future versions fails gracefully and jump to idle instead of ERROR state
                if (memcmp(self->_response, "+ERR=-1", 7) == 0)
                {
                    self->_state = TWR_CMWX1ZZABZ_STATE_IDLE;
                    self->_cmd_frmcnt_uplink = 0;
                    self->_cmd_frmcnt_downlink = 0;
                    continue;
                }

                if (memcmp(self->_response, "+OK=", 4) == 0)
                {
                    twr_scheduler_plan_current_now();

                    twr_cmwx1zzabz_event_t event = TWR_CMWX1ZZABZ_EVENT_ERROR;

                    if (strcmp(self->_custom_command_buf, "AT+RFQ?\r") == 0)
                    {
                        // RFQ request
                        char *rssi_str = strchr(self->_response, '=');
                        rssi_str++;

                        char *snr_str = strchr(self->_response, ',');
                        snr_str++;

                        self->_cmd_rfq_rssi = atoi(rssi_str);
                        self->_cmd_rfq_snr = atoi(snr_str);
                        event = TWR_CMWX1ZZABZ_EVENT_RFQ;
                    }

                    if (strcmp(self->_custom_command_buf, "AT+FRMCNT?\r") == 0)
                    {
                        // Framecounter request
                        char *uplink_str = strchr(self->_response, '=');
                        uplink_str++;

                        char *downlink_str = strchr(self->_response, ',');
                        downlink_str++;

                        self->_cmd_frmcnt_uplink = atoi(uplink_str);
                        self->_cmd_frmcnt_downlink = atoi(downlink_str);
                        event = TWR_CMWX1ZZABZ_EVENT_FRAME_COUNTER;
                    }

                    self->_state = TWR_CMWX1ZZABZ_STATE_IDLE;

                    if (self->_event_handler != NULL)
                    {
                        self->_event_handler(self, event, self->_event_param);
                    }
                    return;
                }

                continue;
            }

            default:
            {
                break;
            }
        }
    }
}

void twr_cmwx1zzabz_join(twr_cmwx1zzabz_t *self)
{
    self->_join_command = true;
    twr_scheduler_plan_now(self->_task_id);
}

void twr_cmwx1zzabz_set_port(twr_cmwx1zzabz_t *self, uint8_t port)
{
    self->_tx_port = port;
}

uint8_t twr_cmwx1zzabz_get_port(twr_cmwx1zzabz_t *self)
{
    return self->_tx_port;
}

void twr_cmwx1zzabz_set_devaddr(twr_cmwx1zzabz_t *self, char *devaddr)
{
    strncpy(self->_config.devaddr, devaddr, 8+1);

    _twr_cmwx1zzabz_save_config(self, TWR_CMWX1ZZABZ_CONFIG_INDEX_DEVADDR);
}

void twr_cmwx1zzabz_get_devaddr(twr_cmwx1zzabz_t *self, char *devaddr)
{
    strncpy(devaddr, self->_config.devaddr, 8+1);
}

void twr_cmwx1zzabz_set_deveui(twr_cmwx1zzabz_t *self, char *deveui)
{
    strncpy(self->_config.deveui, deveui, 16+1);

    _twr_cmwx1zzabz_save_config(self, TWR_CMWX1ZZABZ_CONFIG_INDEX_DEVEUI);
}

void twr_cmwx1zzabz_get_deveui(twr_cmwx1zzabz_t *self, char *deveui)
{
    strncpy(deveui, self->_config.deveui, 16+1);
}

void twr_cmwx1zzabz_set_appeui(twr_cmwx1zzabz_t *self, char *appeui)
{
    strncpy(self->_config.appeui, appeui, 16+1);

    _twr_cmwx1zzabz_save_config(self, TWR_CMWX1ZZABZ_CONFIG_INDEX_APPEUI);
}

void twr_cmwx1zzabz_get_appeui(twr_cmwx1zzabz_t *self, char *appeui)
{
    strncpy(appeui, self->_config.appeui, 16+1);
}

void twr_cmwx1zzabz_set_nwkskey(twr_cmwx1zzabz_t *self, char *nwkskey)
{
    strncpy(self->_config.nwkskey, nwkskey, 32);

    _twr_cmwx1zzabz_save_config(self, TWR_CMWX1ZZABZ_CONFIG_INDEX_NWKSKEY);
}

void twr_cmwx1zzabz_get_nwkskey(twr_cmwx1zzabz_t *self, char *nwkskey)
{
    strncpy(nwkskey, self->_config.nwkskey, 32+1);
}

void twr_cmwx1zzabz_set_appskey(twr_cmwx1zzabz_t *self, char *appskey)
{
    strncpy(self->_config.appskey, appskey, 32);

    _twr_cmwx1zzabz_save_config(self, TWR_CMWX1ZZABZ_CONFIG_INDEX_APPSKEY);
}

void twr_cmwx1zzabz_get_appskey(twr_cmwx1zzabz_t *self, char *appskey)
{
    strncpy(appskey, self->_config.appskey, 32+1);
}

void twr_cmwx1zzabz_set_appkey(twr_cmwx1zzabz_t *self, char *appkey)
{
    strncpy(self->_config.appkey, appkey, 32+1);

    _twr_cmwx1zzabz_save_config(self, TWR_CMWX1ZZABZ_CONFIG_INDEX_APPKEY);
}

void twr_cmwx1zzabz_get_appkey(twr_cmwx1zzabz_t *self, char *appkey)
{
    strncpy(appkey, self->_config.appkey, 32+1);
}

void twr_cmwx1zzabz_set_band(twr_cmwx1zzabz_t *self, twr_cmwx1zzabz_config_band_t band)
{
    self->_config.band = band;

    _twr_cmwx1zzabz_save_config(self, TWR_CMWX1ZZABZ_CONFIG_INDEX_BAND);
}

twr_cmwx1zzabz_config_band_t twr_cmwx1zzabz_get_band(twr_cmwx1zzabz_t *self)
{
    return self->_config.band;
}

void twr_cmwx1zzabz_set_mode(twr_cmwx1zzabz_t *self, twr_cmwx1zzabz_config_mode_t mode)
{
    self->_config.mode = mode;

    _twr_cmwx1zzabz_save_config(self, TWR_CMWX1ZZABZ_CONFIG_INDEX_MODE);
}

twr_cmwx1zzabz_config_mode_t twr_cmwx1zzabz_get_mode(twr_cmwx1zzabz_t *self)
{
    return self->_config.mode;
}

void twr_cmwx1zzabz_set_class(twr_cmwx1zzabz_t *self, twr_cmwx1zzabz_config_class_t class)
{
    self->_config.class = class;

    _twr_cmwx1zzabz_save_config(self, TWR_CMWX1ZZABZ_CONFIG_INDEX_CLASS);
}

twr_cmwx1zzabz_config_class_t twr_cmwx1zzabz_get_class(twr_cmwx1zzabz_t *self)
{
    return self->_config.class;
}

uint8_t twr_cmwx1zzabz_get_received_message_port(twr_cmwx1zzabz_t *self)
{
    return self->_message_port;
}

uint32_t twr_cmwx1zzabz_get_received_message_length(twr_cmwx1zzabz_t *self)
{
    return self->_message_length;
}

uint32_t twr_cmwx1zzabz_get_received_message_data(twr_cmwx1zzabz_t *self, uint8_t *buffer, uint32_t buffer_size)
{
    if (self->_message_length > buffer_size)
    {
        return 0;
    }

    memcpy(buffer, self->_message_buffer, self->_message_length);

    return self->_message_length;
}

void twr_cmwx1zzabz_set_rx2(twr_cmwx1zzabz_t *self, uint32_t frequency, uint8_t datarate)
{
    self->_config.rx2_frequency = frequency;

    self->_config.rx2_datarate = datarate;

    _twr_cmwx1zzabz_save_config(self, TWR_CMWX1ZZABZ_CONFIG_INDEX_RX2);
}

void twr_cmwx1zzabz_get_rx2(twr_cmwx1zzabz_t *self, uint32_t *frequency, uint8_t *datarate)
{
    *frequency = self->_config.rx2_frequency;
    *datarate = self->_config.rx2_datarate;
}

void twr_cmwx1zzabz_set_nwk_public(twr_cmwx1zzabz_t *self, uint8_t public)
{
    self->_config.nwk_public = public;

    _twr_cmwx1zzabz_save_config(self, TWR_CMWX1ZZABZ_CONFIG_INDEX_NWK);
}

uint8_t twr_cmwx1zzabz_get_nwk_public(twr_cmwx1zzabz_t *self)
{
    return self->_config.nwk_public;
}

void twr_cmwx1zzabz_set_adaptive_datarate(twr_cmwx1zzabz_t *self, bool enable)
{
    self->_config.adaptive_datarate = enable;

    _twr_cmwx1zzabz_save_config(self, TWR_CMWX1ZZABZ_CONFIG_INDEX_ADAPTIVE_DATARATE);
}

bool twr_cmwx1zzabz_get_adaptive_datarate(twr_cmwx1zzabz_t *self)
{
    return self->_config.adaptive_datarate;
}

void twr_cmwx1zzabz_set_datarate(twr_cmwx1zzabz_t *self, uint8_t datarate)
{
    self->_config.datarate = datarate;

    _twr_cmwx1zzabz_save_config(self, TWR_CMWX1ZZABZ_CONFIG_INDEX_DATARATE);
}

uint8_t twr_cmwx1zzabz_get_datarate(twr_cmwx1zzabz_t *self)
{
    return self->_config.datarate;
}

void twr_cmwx1zzabz_set_repeat_unconfirmed(twr_cmwx1zzabz_t *self, uint8_t repeat)
{
    self->_config.repetition_unconfirmed = repeat;

    _twr_cmwx1zzabz_save_config(self, TWR_CMWX1ZZABZ_CONFIG_INDEX_REP);
}

uint8_t twr_cmwx1zzabz_get_repeat_unconfirmed(twr_cmwx1zzabz_t *self)
{
    return self->_config.repetition_unconfirmed;
}

void twr_cmwx1zzabz_set_repeat_confirmed(twr_cmwx1zzabz_t *self, uint8_t repeat)
{
    self->_config.repetition_confirmed = repeat;

    _twr_cmwx1zzabz_save_config(self, TWR_CMWX1ZZABZ_CONFIG_INDEX_RTYNUM);
}

uint8_t twr_cmwx1zzabz_get_repeat_confirmed(twr_cmwx1zzabz_t *self)
{
    return self->_config.repetition_confirmed;
}

char *twr_cmwx1zzabz_get_error_command(twr_cmwx1zzabz_t *self)
{
    return self->_command;
}

char *twr_cmwx1zzabz_get_error_response(twr_cmwx1zzabz_t *self)
{
    return self->_response;
}

bool twr_cmwx1zzabz_rfq(twr_cmwx1zzabz_t *self)
{
    if (self->_custom_command)
    {
        return false;
    }

    self->_custom_command = true;
    strcpy(self->_custom_command_buf, "AT+RFQ?\r");

    twr_scheduler_plan_now(self->_task_id);

    return true;
}

bool twr_cmwx1zzabz_get_rfq(twr_cmwx1zzabz_t *self, int32_t *rssi, int32_t *snr)
{
    *rssi = self->_cmd_rfq_rssi;
    *snr = self->_cmd_rfq_snr;

    return true;
}

bool twr_cmwx1zzabz_frame_counter(twr_cmwx1zzabz_t *self)
{
    if (self->_custom_command)
    {
        return false;
    }

    self->_custom_command = true;
    strcpy(self->_custom_command_buf, "AT+FRMCNT?\r");

    twr_scheduler_plan_now(self->_task_id);

    return true;
}

bool twr_cmwx1zzabz_get_frame_counter(twr_cmwx1zzabz_t *self, uint32_t *uplink, uint32_t *downlink)
{
    *uplink = self->_cmd_frmcnt_uplink;
    *downlink = self->_cmd_frmcnt_downlink;

    return true;
}

bool twr_cmwx1zzabz_factory_reset(twr_cmwx1zzabz_t *self)
{
    if (self->_custom_command)
    {
        return false;
    }

    self->_custom_command = true;
    strcpy(self->_custom_command_buf, "AT+FACNEW\r");

    twr_scheduler_plan_now(self->_task_id);

    return true;
}

char *twr_cmwx1zzabz_get_fw_version(twr_cmwx1zzabz_t *self)
{
    return self->_fw_version;
}

bool twr_cmwx1zzabz_link_check(twr_cmwx1zzabz_t *self)
{
    if (self->_state != TWR_CMWX1ZZABZ_STATE_IDLE)
    {
        return false;
    }

    self->_link_check_command = true;

    twr_scheduler_plan_now(self->_task_id);

    return true;
}

bool twr_cmwx1zzabz_get_link_check(twr_cmwx1zzabz_t *self, uint8_t *margin, uint8_t *gateway_count)
{
    *margin = self->_cmd_link_check_margin;
    *gateway_count = self->_cmd_link_check_gwcnt;

    return true;
}

static bool _twr_cmwx1zzabz_read_response(twr_cmwx1zzabz_t *self)
{
    while (true)
    {
        char rx_character;

        if (twr_uart_async_read(self->_uart_channel, &rx_character, 1) == 0)
        {
            return false;
        }

        if (rx_character == '\n')
        {
            continue;
        }

        self->_response[self->_response_length++] = rx_character;

        if (rx_character == '\r')
        {
            if (self->_response_length == 1)
            {
                self->_response_length = 0;

                continue;
            }

            self->_response[self->_response_length] = '\0';

            break;
        }

        if (self->_response_length == sizeof(self->_response) - 1)
        {
            return false;
        }
    }

    if (self->_debug)
    {
        twr_log_debug("LoRa RX: %s", (const char*)self->_response);
    }

    self->_response_length = 0;

    return true;
}

static void _twr_cmwx1zzabz_save_config(twr_cmwx1zzabz_t *self, twr_cmwx1zzabz_config_index_t config_index)
{
    self->_save_config_mask |= 1 << config_index;

    if (self->_state == TWR_CMWX1ZZABZ_STATE_IDLE)
    {
        twr_scheduler_plan_now(self->_task_id);
    }
}