modbus_app.c

Go to the documentation of this file.

 
#include "modbus_app.h"
 
#include <stdbool.h>
#include <stdio.h>
 
#include "driver/uart.h"
#include "esp_check.h"
#include "esp_err.h"
#include "esp_log.h"
#include "freertos/FreeRTOS.h"
#include "freertos/task.h"
#include "mbcontroller.h"
#include "mqtt_app.h"
 
static const char *TAG = "modbus_app";
 
#define MB_UART_PORT            UART_NUM_1
 
#define MB_UART_TXD_GPIO        17
#define MB_UART_RXD_GPIO        5
#define MB_UART_RTS_GPIO        33
 
#define MB_UART_BAUD_RATE       9600
 
#define MB_SLAVE_ADDR           7
 
#define MB_HOLD_REG_ADDR        1000
 
#define MB_CMD_READ_HOLDING_REGISTER    3
 
#define MB_POLL_INTERVAL_MS     5000
 
static void *s_master_handle;
 
static esp_err_t modbus_master_init(void)
{
    mb_communication_info_t comm = {
        .ser_opts.port = MB_UART_PORT,
        .ser_opts.mode = MB_RTU,
        .ser_opts.baudrate = MB_UART_BAUD_RATE,
        .ser_opts.parity = MB_PARITY_NONE,
        .ser_opts.uid = 0,
        .ser_opts.response_tout_ms = 1000,
        .ser_opts.data_bits = UART_DATA_8_BITS,
        .ser_opts.stop_bits = UART_STOP_BITS_1,
    };
 
    esp_err_t err = mbc_master_create_serial(&comm, &s_master_handle);
    ESP_RETURN_ON_FALSE(s_master_handle != NULL, ESP_ERR_INVALID_STATE, TAG,
                        "mb controller init failed");
    ESP_RETURN_ON_ERROR(err, TAG, "mb controller create failed");
 
    err = uart_set_pin(MB_UART_PORT, MB_UART_TXD_GPIO, MB_UART_RXD_GPIO,
                       MB_UART_RTS_GPIO, UART_PIN_NO_CHANGE);
    ESP_RETURN_ON_ERROR(err, TAG, "uart_set_pin failed");
 
    err = uart_set_mode(MB_UART_PORT, UART_MODE_RS485_HALF_DUPLEX);
    ESP_RETURN_ON_ERROR(err, TAG, "uart_set_mode failed");
 
    err = mbc_master_start(s_master_handle);
    ESP_RETURN_ON_ERROR(err, TAG, "mb controller start failed");
 
    ESP_LOGI(TAG, "Modbus master started: UART%d, %d baud, slave %d",
             MB_UART_PORT, MB_UART_BAUD_RATE, MB_SLAVE_ADDR);
    return ESP_OK;
}
 
static void modbus_poll_task(void *arg)
{
    // mb_param_request_t request = {
    //     .slave_addr = MB_SLAVE_ADDR,
    //     .command = MB_CMD_READ_HOLDING_REGISTER,
    //     .reg_start = MB_HOLD_REG_ADDR,
    //     .reg_size = 1,
    // };
 
    while (true) {
        uint16_t reg_value = 0;
        // esp_err_t err = mbc_master_send_request(s_master_handle, &request, &reg_value);
        // для тестирования временная заглушка
        esp_err_t err = ESP_OK;
 
        if (err == ESP_OK) {
            ESP_LOGI(TAG, "Slave %d, reg %d = %u",
                     MB_SLAVE_ADDR, MB_HOLD_REG_ADDR, reg_value);
 
            char topic[64];
            snprintf(topic, sizeof(topic), "ozlocks/%s/modbus/%d/reg%d",
                     mqtt_app_get_client_id(), MB_SLAVE_ADDR, MB_HOLD_REG_ADDR);
 
            char payload[32];
            snprintf(payload, sizeof(payload), "%u", reg_value);
            mqtt_app_publish(topic, payload, 1, 0);
        } else {
            ESP_LOGW(TAG, "Read slave %d reg %d failed: %s",
                     MB_SLAVE_ADDR, MB_HOLD_REG_ADDR, esp_err_to_name(err));
        }
 
        vTaskDelay(pdMS_TO_TICKS(MB_POLL_INTERVAL_MS));
    }
}
 
esp_err_t modbus_app_start(void)
{
    static bool started = false;
 
    if (started) {
        return ESP_OK;
    }
 
    ESP_RETURN_ON_ERROR(modbus_master_init(), TAG, "modbus init failed");
 
    BaseType_t created = xTaskCreate(modbus_poll_task, "modbus_poll", 4096, NULL, 5, NULL);
    ESP_RETURN_ON_FALSE(created == pdPASS, ESP_ERR_NO_MEM, TAG, "poll task create failed");
 
    started = true;
    return ESP_OK;
}