83 lines
2.0 KiB
C
83 lines
2.0 KiB
C
#include "agile_modbus.h"
|
|
#include "serial.h"
|
|
#include <pthread.h>
|
|
#include <stdio.h>
|
|
#include <stdlib.h>
|
|
#include <unistd.h>
|
|
|
|
#define DBG_ENABLE
|
|
#define DBG_COLOR
|
|
#define DBG_SECTION_NAME "rtu_master"
|
|
#define DBG_LEVEL DBG_LOG
|
|
#include "dbg_log.h"
|
|
|
|
static int _fd = -1;
|
|
static struct termios _old_tios = {0};
|
|
|
|
static void *cycle_entry(void *param)
|
|
{
|
|
uint8_t ctx_send_buf[AGILE_MODBUS_MAX_ADU_LENGTH];
|
|
uint8_t ctx_read_buf[AGILE_MODBUS_MAX_ADU_LENGTH];
|
|
uint16_t hold_register[10];
|
|
|
|
agile_modbus_rtu_t ctx_rtu;
|
|
agile_modbus_t *ctx = &ctx_rtu._ctx;
|
|
agile_modbus_rtu_init(&ctx_rtu, ctx_send_buf, sizeof(ctx_send_buf), ctx_read_buf, sizeof(ctx_read_buf));
|
|
agile_modbus_set_slave(ctx, 1);
|
|
|
|
LOG_I("Running.");
|
|
|
|
while (1) {
|
|
usleep(100000);
|
|
|
|
serial_flush(_fd);
|
|
int send_len = agile_modbus_serialize_read_registers(ctx, 0, 10);
|
|
serial_send(_fd, ctx->send_buf, send_len);
|
|
int read_len = serial_receive(_fd, ctx->read_buf, ctx->read_bufsz, 1000);
|
|
if (read_len < 0) {
|
|
LOG_E("Receive error, now exit.");
|
|
break;
|
|
}
|
|
|
|
if (read_len == 0) {
|
|
LOG_W("Receive timeout.");
|
|
continue;
|
|
}
|
|
|
|
int rc = agile_modbus_deserialize_read_registers(ctx, read_len, hold_register);
|
|
if (rc < 0) {
|
|
LOG_W("Receive failed.");
|
|
if (rc != -1)
|
|
LOG_W("Error code:%d", -128 - rc);
|
|
|
|
continue;
|
|
}
|
|
|
|
LOG_I("Hold Registers:");
|
|
for (int i = 0; i < 10; i++)
|
|
LOG_I("Register [%d]: 0x%04X", i, hold_register[i]);
|
|
|
|
printf("\r\n\r\n\r\n");
|
|
}
|
|
|
|
serial_close(_fd, &_old_tios);
|
|
}
|
|
|
|
int main(int argc, char *argv[])
|
|
{
|
|
if (argc < 2) {
|
|
LOG_E("Please enter RtuMaster [dev]!");
|
|
return -1;
|
|
}
|
|
|
|
_fd = serial_init(argv[1], 9600, 'N', 8, 1, &_old_tios);
|
|
if (_fd < 0) {
|
|
LOG_E("Open %s failed!", argv[1]);
|
|
return -1;
|
|
}
|
|
|
|
pthread_t tid;
|
|
pthread_create(&tid, NULL, cycle_entry, NULL);
|
|
pthread_join(tid, NULL);
|
|
}
|