forked from espressif/esp-modbus
Merge branch 'feature/add_slave_id_command_v2' into 'main'
add slave report id command for master and slave (backport v2) See merge request idf/esp-modbus!97
This commit is contained in:
commit
877d331b4b
31 files changed
+663
-167
No files matched your search
@@ -3,7 +3,6 @@
|
||||
*
|
||||
* SPDX-License-Identifier: Apache-2.0
|
||||
*/
|
||||
|
||||
#include "esp_err.h" // for esp_err_t
|
||||
#include "mbc_master.h" // for master interface define
|
||||
#include "esp_modbus_master.h" // for public interface defines
|
||||
@@ -229,10 +228,28 @@ esp_err_t mbc_master_stop(void *ctx)
|
||||
/* ----------------------- Callback functions for Modbus stack ---------------------------------*/
|
||||
// These are executed by modbus stack to read appropriate type of registers.
|
||||
|
||||
mb_err_enum_t mbc_reg_common_cb(mb_base_t *inst, uint8_t *pdata, uint16_t address, uint16_t bytes)
|
||||
{
|
||||
MB_RETURN_ON_FALSE((pdata), MB_EINVAL, TAG, "incorrect parameters provided.");
|
||||
|
||||
mb_master_options_t *popts = MB_MASTER_GET_OPTS(MB_MASTER_GET_IFACE_FROM_BASE(inst));
|
||||
uint16_t reg_len = popts->reg_buffer_size;
|
||||
uint8_t *ppar_buffer = (uint8_t *)popts->reg_buffer_ptr; // Get instance address
|
||||
mb_err_enum_t status = MB_ENOERR;
|
||||
if (ppar_buffer && !address && (bytes >= 2) && (((reg_len << 1) >= bytes))){
|
||||
CRITICAL_SECTION(inst->lock) {
|
||||
memmove(ppar_buffer, pdata, bytes);
|
||||
}
|
||||
} else {
|
||||
status = MB_ENORES;
|
||||
}
|
||||
return status;
|
||||
}
|
||||
|
||||
/**
|
||||
* Modbus master input register callback function.
|
||||
*
|
||||
* @param ctx interface context pointer
|
||||
* @param inst interface context pointer
|
||||
* @param reg_buffer input register buffer
|
||||
* @param reg_addr input register address
|
||||
* @param num_regs input register number
|
||||
@@ -273,7 +290,7 @@ mb_err_enum_t mbc_reg_input_master_cb(mb_base_t *inst, uint8_t *reg_buffer, uint
|
||||
/**
|
||||
* Modbus master holding register callback function.
|
||||
*
|
||||
* @param ctx interface context pointer
|
||||
* @param inst interface context pointer
|
||||
* @param reg_buffer holding register buffer
|
||||
* @param reg_addr holding register address
|
||||
* @param num_regs holding register number
|
||||
@@ -331,7 +348,7 @@ mb_err_enum_t mbc_reg_holding_master_cb(mb_base_t *inst, uint8_t *reg_buffer, ui
|
||||
/**
|
||||
* Modbus master coils callback function.
|
||||
*
|
||||
* @param ctx interface context pointer
|
||||
* @param inst interface context pointer
|
||||
* @param reg_buffer coils buffer
|
||||
* @param reg_addr coils address
|
||||
* @param ncoils coils number
|
||||
@@ -394,7 +411,7 @@ mb_err_enum_t mbc_reg_coils_master_cb(mb_base_t *inst, uint8_t *reg_buffer, uint
|
||||
/**
|
||||
* Modbus master discrete callback function.
|
||||
*
|
||||
* @param ctx - pointer to interface structure
|
||||
* @param inst - pointer to interface structure
|
||||
* @param reg_buffer discrete buffer
|
||||
* @param reg_addr discrete address
|
||||
* @param n_discrete discrete number
|
||||
|
||||
@@ -14,7 +14,7 @@
|
||||
|
||||
#include "mb_utils.h" // for stack bit setting utilities
|
||||
|
||||
#ifdef CONFIG_FMB_CONTROLLER_SLAVE_ID_SUPPORT
|
||||
#if CONFIG_FMB_CONTROLLER_SLAVE_ID_SUPPORT
|
||||
|
||||
#define MB_ID_BYTE0(id) ((uint8_t)(id))
|
||||
#define MB_ID_BYTE1(id) ((uint8_t)(((uint16_t)(id) >> 8) & 0xFF))
|
||||
@@ -138,6 +138,37 @@ esp_err_t mbc_slave_unlock(void *ctx)
|
||||
return ESP_OK;
|
||||
}
|
||||
|
||||
#if CONFIG_FMB_CONTROLLER_SLAVE_ID_SUPPORT
|
||||
/**
|
||||
* Set object ID for the Modbus controller
|
||||
*/
|
||||
esp_err_t mbc_set_slave_id(void *ctx, uint8_t slave_addr, bool is_running, uint8_t const *pdata, uint8_t data_len)
|
||||
{
|
||||
MB_RETURN_ON_FALSE(ctx, ESP_ERR_INVALID_STATE, TAG,
|
||||
"Slave interface is not correctly initialized.");
|
||||
mbs_controller_iface_t *pmbs_controller = MB_SLAVE_GET_IFACE(ctx);
|
||||
// The Report Slave ID functionality is useful for TCP and gateway,
|
||||
// so the design decision is to keep this functionality for all slaves
|
||||
// Set the slave ID if the KConfig option is selected
|
||||
mb_err_enum_t status = mbs_set_slave_id(pmbs_controller->mb_base, slave_addr, is_running, (uint8_t *)pdata, data_len);
|
||||
MB_RETURN_ON_FALSE((status == MB_ENOERR), ESP_ERR_INVALID_STATE, TAG, "mb stack set slave ID failure.");
|
||||
return MB_ERR_TO_ESP_ERR(status);
|
||||
}
|
||||
|
||||
/**
|
||||
* Get object ID from the Modbus controller
|
||||
*/
|
||||
esp_err_t mbc_get_slave_id(void *ctx, uint8_t const *pdata, uint8_t *pdata_len)
|
||||
{
|
||||
MB_RETURN_ON_FALSE(ctx, ESP_ERR_INVALID_STATE, TAG,
|
||||
"Slave interface is not correctly initialized.");
|
||||
mbs_controller_iface_t *pmbs_controller = MB_SLAVE_GET_IFACE(ctx);
|
||||
mb_err_enum_t status = mbs_get_slave_id(pmbs_controller->mb_base, (uint8_t *)pdata, pdata_len);
|
||||
MB_RETURN_ON_FALSE((status == MB_ENOERR), ESP_ERR_INVALID_STATE, TAG, "mb stack get slave ID failure.");
|
||||
return MB_ERR_TO_ESP_ERR(status);
|
||||
}
|
||||
#endif
|
||||
|
||||
/**
|
||||
* Start Modbus controller start function
|
||||
*/
|
||||
@@ -149,10 +180,11 @@ esp_err_t mbc_slave_start(void *ctx)
|
||||
mbs_controller_iface_t *mbs_controller = MB_SLAVE_GET_IFACE(ctx);
|
||||
MB_RETURN_ON_FALSE(mbs_controller->start, ESP_ERR_INVALID_STATE, TAG,
|
||||
"Slave interface is not correctly configured.");
|
||||
#ifdef CONFIG_FMB_CONTROLLER_SLAVE_ID_SUPPORT
|
||||
// Set the slave ID if the KConfig option is selected
|
||||
mb_err_enum_t status = mb_set_slv_id(mbs_controller->mb_base, MB_SLAVE_ID_SHORT, true, (uint8_t *)mb_slave_id, sizeof(mb_slave_id));
|
||||
MB_RETURN_ON_FALSE((status == MB_ENOERR), ESP_ERR_INVALID_STATE, TAG, "mb stack set slave ID failure.");
|
||||
uint8_t slave_uid = mbs_controller->opts.comm_opts.common_opts.uid;
|
||||
#if CONFIG_FMB_CONTROLLER_SLAVE_ID_SUPPORT
|
||||
// Set the default slave ID if the KConfig option is selected
|
||||
error = mbc_set_slave_id(mbs_controller, slave_uid, true, (uint8_t *)mb_slave_id, sizeof(mb_slave_id));
|
||||
MB_RETURN_ON_FALSE((error == ESP_OK), ESP_ERR_INVALID_STATE, TAG, "mb stack set slave ID failure.");
|
||||
#endif
|
||||
error = mbs_controller->start(ctx);
|
||||
MB_RETURN_ON_FALSE((error == ESP_OK), ESP_ERR_INVALID_STATE, TAG,
|
||||
|
||||
@@ -117,6 +117,45 @@ typedef enum {
|
||||
MB_PARAM_UNKNOWN = 0xFF
|
||||
} mb_param_type_t;
|
||||
|
||||
#define mb_err_var esp_err##__func__##__line__
|
||||
#define esp_err_var mb_error##__func__##__line__
|
||||
#define MB_ERR_TO_ESP_ERR(error_code) (__extension__( \
|
||||
{ \
|
||||
mb_err_enum_t mb_err_var = (mb_err_enum_t)error_code; \
|
||||
esp_err_t esp_err_var = ESP_FAIL; \
|
||||
switch(mb_err_var) { \
|
||||
case MB_ENOERR: \
|
||||
esp_err_var = ESP_OK; \
|
||||
break; \
|
||||
case MB_ENOREG: \
|
||||
esp_err_var = ESP_ERR_NOT_SUPPORTED; \
|
||||
break; \
|
||||
case MB_ETIMEDOUT: \
|
||||
esp_err_var = ESP_ERR_TIMEOUT; \
|
||||
break; \
|
||||
case MB_EILLFUNC: \
|
||||
case MB_EINVAL: \
|
||||
esp_err_var = ESP_ERR_INVALID_RESPONSE; \
|
||||
break; \
|
||||
case MB_ERECVDATA: \
|
||||
esp_err_var = ESP_ERR_INVALID_RESPONSE; \
|
||||
break; \
|
||||
case MB_EBUSY: \
|
||||
case MB_EILLSTATE: \
|
||||
case MB_EPORTERR: \
|
||||
case MB_ENORES: \
|
||||
case MB_ENOCONN: \
|
||||
esp_err_var = ESP_ERR_INVALID_STATE; \
|
||||
break; \
|
||||
default: \
|
||||
ESP_LOGE(TAG, "%s: Incorrect return code (%x) ", __FUNCTION__, (int)mb_err_var); \
|
||||
esp_err_var = ESP_FAIL; \
|
||||
break; \
|
||||
} \
|
||||
(esp_err_var); \
|
||||
} \
|
||||
))
|
||||
|
||||
typedef enum _mb_comm_mode mb_mode_type_t;
|
||||
|
||||
typedef struct mb_base_t mb_base_t;
|
||||
|
||||
@@ -201,6 +201,39 @@ esp_err_t mbc_slave_get_param_info(void *ctx, mb_param_info_t *reg_info, uint32_
|
||||
*/
|
||||
esp_err_t mbc_slave_set_descriptor(void *ctx, mb_register_area_descriptor_t descr_data);
|
||||
|
||||
// The support of <0x11 - Report Slave ID> command is intentionally included for TCP slave as well!
|
||||
#if CONFIG_FMB_CONTROLLER_SLAVE_ID_SUPPORT
|
||||
/**
|
||||
* @brief Set Modbus slave identificator
|
||||
*
|
||||
* @param[in] ctx context pointer of the initialized modbus interface
|
||||
* @param[in] uid - unit identifier (short slave address) for Modbus slave
|
||||
* @param[in] is_running - Modbus slave running status
|
||||
* @param[in] pdata - pointer to data buffer for extended context (vendor specific)
|
||||
* @param[in] data_len - length of data buffer (the length of the extended context)
|
||||
*
|
||||
* @return
|
||||
* - ESP_OK: The appropriate identificator is set
|
||||
* - ESP_ERR_INVALID_ARG: The argument is incorrect
|
||||
*/
|
||||
esp_err_t mbc_set_slave_id(void *ctx, uint8_t uid, bool is_running, uint8_t const *pdata, uint8_t data_len);
|
||||
|
||||
/*! \brief Get slave identificator from the modbus object.
|
||||
*
|
||||
* This function is used to get the Slave ID array for modbus object.
|
||||
*
|
||||
* \param ctx - context pointer of the initialized modbus interface
|
||||
* \param pdata - the pointer to store object ID array from the modbus object
|
||||
* \param[in/out] pdata_len - in: length of the allocated pdata array,
|
||||
* out: returns the actual length of object id.
|
||||
* returns the modbus error code = ESP_OK, if set correctly,
|
||||
* ESP_ERR_INVALID_RESPONSE - if the object ID is not set,
|
||||
* ESP_ERR_INVALID_STATE - no space to store object ID in the pdata buffer,
|
||||
* or incorrect arguments are provided
|
||||
*/
|
||||
esp_err_t mbc_get_slave_id(void *ctx, uint8_t const *pdata, uint8_t *pdata_len);
|
||||
#endif
|
||||
|
||||
/**
|
||||
* @brief Holding register read/write callback function
|
||||
*
|
||||
|
||||
@@ -10,6 +10,8 @@
|
||||
#include "freertos/FreeRTOS.h" // for task creation and queue access
|
||||
#include "freertos/task.h" // for task api access
|
||||
#include "freertos/event_groups.h" // for event groups
|
||||
#include "freertos/semphr.h" // for semaphore
|
||||
#include "freertos/queue.h" // for queue api access
|
||||
#include "driver/uart.h" // for UART types
|
||||
#include "errno.h" // for errno
|
||||
#include "esp_log.h" // for log write
|
||||
@@ -49,6 +51,7 @@ typedef struct {
|
||||
uint16_t reg_buffer_size; /*!< Modbus data buffer size */
|
||||
TaskHandle_t task_handle; /*!< Modbus task handle */
|
||||
EventGroupHandle_t event_group_handle; /*!< Modbus controller event group */
|
||||
SemaphoreHandle_t mbm_sema; /*!< Modbus controller semaphore */
|
||||
const mb_parameter_descriptor_t *param_descriptor_table; /*!< Modbus controller parameter description table */
|
||||
size_t mbm_param_descriptor_size; /*!< Modbus controller parameter description table size */
|
||||
} mb_master_options_t;
|
||||
@@ -57,7 +60,7 @@ typedef esp_err_t (*iface_get_cid_info_fp)(void *, uint16_t, const mb_parameter_
|
||||
typedef esp_err_t (*iface_get_parameter_fp)(void *, uint16_t, uint8_t *, uint8_t *); /*!< Interface get_parameter method */
|
||||
typedef esp_err_t (*iface_get_parameter_with_fp)(void *, uint16_t, uint8_t, uint8_t *, uint8_t *); /*!< Interface get_parameter_with method */
|
||||
typedef esp_err_t (*iface_send_request_fp)(void *, mb_param_request_t*, void *); /*!< Interface send_request method */
|
||||
typedef esp_err_t (*iface_mbm_set_descriptor_fp)(void *, const mb_parameter_descriptor_t*, const uint16_t); /*!< Interface set_descriptor method */
|
||||
typedef esp_err_t (*iface_mbm_set_descriptor_fp)(void *, const mb_parameter_descriptor_t*, const uint16_t); /*!< Interface set_descriptor method */
|
||||
typedef esp_err_t (*iface_set_parameter_fp)(void *, uint16_t, uint8_t *, uint8_t *); /*!< Interface set_parameter method */
|
||||
typedef esp_err_t (*iface_set_parameter_with_fp)(void *, uint16_t, uint8_t, uint8_t *, uint8_t *); /*!< Interface set_parameter_with method */
|
||||
|
||||
@@ -65,7 +68,7 @@ typedef esp_err_t (*iface_set_parameter_with_fp)(void *, uint16_t, uint8_t, uint
|
||||
* @brief Modbus controller interface structure
|
||||
*/
|
||||
typedef struct {
|
||||
mb_base_t *mb_base;
|
||||
mb_base_t *mb_base;
|
||||
// Master object interface options
|
||||
mb_master_options_t opts;
|
||||
bool is_active; /*!< Interface is active */
|
||||
|
||||
@@ -119,6 +119,9 @@ static esp_err_t mbc_serial_master_delete(void *ctx)
|
||||
mbm_opts->task_handle = NULL;
|
||||
vEventGroupDelete(mbm_opts->event_group_handle);
|
||||
mbm_opts->event_group_handle = NULL;
|
||||
vSemaphoreDelete(mbm_opts->mbm_sema);
|
||||
mbm_opts->mbm_sema = NULL;
|
||||
// delete mb_base instance and all its allocations
|
||||
mb_error = mbm_iface->mb_base->delete(mbm_iface->mb_base);
|
||||
MB_RETURN_ON_FALSE((mb_error == MB_ENOERR), ESP_ERR_INVALID_STATE, TAG,
|
||||
"mb stack delete failure, returned (0x%x).", (int)mb_error);
|
||||
@@ -159,10 +162,8 @@ static esp_err_t mbc_serial_master_send_request(void *ctx, mb_param_request_t *r
|
||||
MB_RETURN_ON_FALSE((data_ptr), ESP_ERR_INVALID_ARG, TAG, "mb incorrect data pointer.");
|
||||
|
||||
mb_err_enum_t mb_error = MB_EBUSY;
|
||||
esp_err_t error = ESP_FAIL;
|
||||
|
||||
if (mb_port_event_res_take(mbm_controller_iface->mb_base->port_obj, pdMS_TO_TICKS(MB_MAX_RESP_DELAY_MS)))
|
||||
{
|
||||
if (xSemaphoreTake(mbm_opts->mbm_sema, pdMS_TO_TICKS(MB_MAX_RESP_DELAY_MS)) == pdTRUE) {
|
||||
uint8_t mb_slave_addr = request->slave_addr;
|
||||
uint8_t mb_command = request->command;
|
||||
uint16_t mb_offset = request->reg_start;
|
||||
@@ -172,11 +173,14 @@ static esp_err_t mbc_serial_master_send_request(void *ctx, mb_param_request_t *r
|
||||
mbm_opts->reg_buffer_ptr = (uint8_t *)data_ptr;
|
||||
mbm_opts->reg_buffer_size = mb_size;
|
||||
|
||||
mb_port_event_res_release(mbm_controller_iface->mb_base->port_obj);
|
||||
|
||||
// Calls appropriate request function to send request and waits response
|
||||
switch (mb_command)
|
||||
{
|
||||
#if MB_FUNC_OTHER_REP_SLAVEID_ENABLED
|
||||
case MB_FUNC_OTHER_REPORT_SLAVEID:
|
||||
mb_error = mbm_rq_report_slave_id(mbm_controller_iface->mb_base, mb_slave_addr, pdMS_TO_TICKS(MB_MAX_RESP_DELAY_MS));
|
||||
break;
|
||||
#endif
|
||||
|
||||
#if MB_FUNC_READ_COILS_ENABLED
|
||||
case MB_FUNC_READ_COILS:
|
||||
@@ -257,39 +261,13 @@ static esp_err_t mbc_serial_master_send_request(void *ctx, mb_param_request_t *r
|
||||
mb_error = MB_ENOREG;
|
||||
break;
|
||||
}
|
||||
} else {
|
||||
ESP_LOGD(TAG, "%s:MBC semaphore take fail.", __func__);
|
||||
}
|
||||
(void)xSemaphoreGive(mbm_opts->mbm_sema);
|
||||
|
||||
// Propagate the Modbus errors to higher level
|
||||
switch (mb_error)
|
||||
{
|
||||
case MB_ENOERR:
|
||||
error = ESP_OK;
|
||||
break;
|
||||
|
||||
case MB_ENOREG:
|
||||
error = ESP_ERR_NOT_SUPPORTED; // Invalid register request
|
||||
break;
|
||||
|
||||
case MB_ETIMEDOUT:
|
||||
error = ESP_ERR_TIMEOUT; // Slave did not send response
|
||||
break;
|
||||
|
||||
case MB_EILLFUNC:
|
||||
case MB_ERECVDATA:
|
||||
error = ESP_ERR_INVALID_RESPONSE; // Invalid response from slave
|
||||
break;
|
||||
|
||||
case MB_EBUSY:
|
||||
error = ESP_ERR_INVALID_STATE; // Master is busy (previous request is pending)
|
||||
break;
|
||||
|
||||
default:
|
||||
ESP_LOGE(TAG, "%s: Incorrect return code (%x) ", __FUNCTION__, (uint16_t)mb_error);
|
||||
error = ESP_FAIL;
|
||||
break;
|
||||
}
|
||||
|
||||
return error;
|
||||
return MB_ERR_TO_ESP_ERR(mb_error);
|
||||
}
|
||||
|
||||
static esp_err_t mbc_serial_master_get_cid_info(void *ctx, uint16_t cid, const mb_parameter_descriptor_t **param_buffer)
|
||||
@@ -623,6 +601,10 @@ static esp_err_t mbc_serial_master_controller_create(void **ctx)
|
||||
// Initialization of active context of the modbus controller
|
||||
mbm_opts->event_group_handle = xEventGroupCreate();
|
||||
MB_GOTO_ON_FALSE((mbm_opts->event_group_handle), ESP_ERR_INVALID_STATE, error, TAG, "mb event group error.");
|
||||
mbm_opts->mbm_sema = xSemaphoreCreateBinary();
|
||||
MB_GOTO_ON_FALSE((mbm_opts->mbm_sema != NULL), ESP_ERR_NO_MEM, error, TAG, "%s: mbm resource create error.", __func__);
|
||||
(void)xSemaphoreGive(mbm_opts->mbm_sema);
|
||||
|
||||
// Create modbus controller task
|
||||
status = xTaskCreatePinnedToCore((void *)&mbc_ser_master_task,
|
||||
"mbc_ser_master",
|
||||
|
||||
@@ -168,9 +168,8 @@ static esp_err_t mbc_tcp_master_send_request(void *ctx, mb_param_request_t *requ
|
||||
MB_RETURN_ON_FALSE((data_ptr), ESP_ERR_INVALID_ARG, TAG, "mb incorrect data pointer.");
|
||||
|
||||
mb_err_enum_t mb_error = MB_EBUSY;
|
||||
esp_err_t error = ESP_FAIL;
|
||||
|
||||
if (mb_port_event_res_take(mbm_controller_iface->mb_base->port_obj, pdMS_TO_TICKS(MB_MAX_RESP_DELAY_MS))) {
|
||||
if (xSemaphoreTake(mbm_opts->mbm_sema, pdMS_TO_TICKS(MB_MAX_RESP_DELAY_MS)) == pdTRUE) {
|
||||
uint8_t mb_slave_addr = request->slave_addr;
|
||||
uint8_t mb_command = request->command;
|
||||
uint16_t mb_offset = request->reg_start;
|
||||
@@ -180,8 +179,6 @@ static esp_err_t mbc_tcp_master_send_request(void *ctx, mb_param_request_t *requ
|
||||
mbm_opts->reg_buffer_ptr = (uint8_t *)data_ptr;
|
||||
mbm_opts->reg_buffer_size = mb_size;
|
||||
|
||||
mb_port_event_res_release(mbm_controller_iface->mb_base->port_obj);
|
||||
|
||||
// Calls appropriate request function to send request and waits response
|
||||
switch(mb_command) {
|
||||
#if MB_FUNC_READ_COILS_ENABLED
|
||||
@@ -263,38 +260,13 @@ static esp_err_t mbc_tcp_master_send_request(void *ctx, mb_param_request_t *requ
|
||||
mb_error = MB_ENOREG;
|
||||
break;
|
||||
}
|
||||
} else {
|
||||
ESP_LOGD(TAG, "%s:MBC semaphore take fail.", __func__);
|
||||
}
|
||||
(void)xSemaphoreGive(mbm_opts->mbm_sema);
|
||||
|
||||
// Propagate the Modbus errors to higher level
|
||||
switch(mb_error) {
|
||||
case MB_ENOERR:
|
||||
error = ESP_OK;
|
||||
break;
|
||||
|
||||
case MB_ENOREG:
|
||||
error = ESP_ERR_NOT_SUPPORTED; // Invalid register request
|
||||
break;
|
||||
|
||||
case MB_ETIMEDOUT:
|
||||
error = ESP_ERR_TIMEOUT; // Slave did not send response
|
||||
break;
|
||||
|
||||
case MB_EILLFUNC:
|
||||
case MB_ERECVDATA:
|
||||
error = ESP_ERR_INVALID_RESPONSE; // Invalid response from slave
|
||||
break;
|
||||
|
||||
case MB_EBUSY:
|
||||
error = ESP_ERR_INVALID_STATE; // Master is busy (previous request is pending)
|
||||
break;
|
||||
|
||||
default:
|
||||
ESP_LOGE(TAG, "%s: Incorrect return code (%x) ", __FUNCTION__, (int)mb_error);
|
||||
error = ESP_FAIL;
|
||||
break;
|
||||
}
|
||||
|
||||
return error;
|
||||
return MB_ERR_TO_ESP_ERR(mb_error);
|
||||
}
|
||||
|
||||
static esp_err_t mbc_tcp_master_get_cid_info(void *ctx, uint16_t cid, const mb_parameter_descriptor_t** param_buffer)
|
||||
@@ -622,7 +594,8 @@ static esp_err_t mbc_tcp_master_delete(void *ctx)
|
||||
mbm_opts->task_handle = NULL;
|
||||
vEventGroupDelete(mbm_opts->event_group_handle);
|
||||
mbm_opts->event_group_handle = NULL;
|
||||
|
||||
vSemaphoreDelete(mbm_opts->mbm_sema);
|
||||
mbm_opts->mbm_sema = NULL;
|
||||
mb_error = mbm_iface->mb_base->delete(mbm_iface->mb_base);
|
||||
MB_RETURN_ON_FALSE((mb_error == MB_ENOERR), ESP_ERR_INVALID_STATE, TAG,
|
||||
"mb stack delete failure, returned (0x%x).", (unsigned)mb_error);
|
||||
@@ -650,6 +623,10 @@ esp_err_t mbc_tcp_master_controller_create(void ** ctx)
|
||||
// Parameter change notification queue
|
||||
mbm_opts->event_group_handle = xEventGroupCreate();
|
||||
MB_GOTO_ON_FALSE((mbm_opts->event_group_handle), ESP_ERR_INVALID_STATE, error, TAG, "mb event group error.");
|
||||
mbm_opts->mbm_sema = xSemaphoreCreateBinary();
|
||||
MB_GOTO_ON_FALSE((mbm_opts->mbm_sema != NULL), ESP_ERR_NO_MEM, error, TAG, "%s: mbm resource create error.", __func__);
|
||||
(void)xSemaphoreGive(mbm_opts->mbm_sema);
|
||||
|
||||
// Create modbus controller task
|
||||
status = xTaskCreatePinnedToCore((void *)&modbus_tcp_master_task,
|
||||
"mbm_ctrl_tcp_task",
|
||||
|
||||
Reference in new issue
Block a user