ADD 增加modbus协议;
wangbo
2 months ago
parent
4a304f38e4
commit
e23e448bd4
@ -0,0 +1,49 @@
|
|||||||
|
#ifndef __PD_MODBUS_H__
|
||||||
|
#define __PD_MODBUS_H__
|
||||||
|
|
||||||
|
#ifdef CFG_DEV_TYPE_LAND_PD
|
||||||
|
|
||||||
|
#define WRITE 1
|
||||||
|
#define READ 0
|
||||||
|
|
||||||
|
#define MODBUS_IR_CURRENT_ADDR 0x0 // 铁芯
|
||||||
|
#define MODBUS_IR_CURRENT_LEN 2
|
||||||
|
#define MODBUS_DC_CURRENT_ADDR 0x34 // 直流偏磁
|
||||||
|
#define MODBUS_DC_CURRENT_LEN 2
|
||||||
|
|
||||||
|
#define MODBUS_UNIT_IR 0x01
|
||||||
|
|
||||||
|
#define MODBUS_CURRENT_LEN 4
|
||||||
|
#define MODBUS_ADDR_ALARM 0x32
|
||||||
|
#define MODBUS_ALARM_LEN 2
|
||||||
|
|
||||||
|
|
||||||
|
// 定义Modbus TCP MBAP头
|
||||||
|
//#pragma pack(push, 1)
|
||||||
|
typedef struct
|
||||||
|
{
|
||||||
|
uint16_t transaction_id; // 事务处理标识
|
||||||
|
uint16_t protocol_id; // 协议标识
|
||||||
|
uint16_t length; // 数据长度
|
||||||
|
uint8_t unit_id; // 设备地址
|
||||||
|
uint8_t function_code; // 功能码
|
||||||
|
} modbus_tcp_t;
|
||||||
|
//#pragma pack(pop)
|
||||||
|
|
||||||
|
typedef struct
|
||||||
|
{
|
||||||
|
uint8_t function;
|
||||||
|
uint16_t address;
|
||||||
|
uint16_t length;
|
||||||
|
} pdu_t;
|
||||||
|
|
||||||
|
typedef struct
|
||||||
|
{
|
||||||
|
int fd;
|
||||||
|
uint8_t txbuf[512];
|
||||||
|
uint8_t rxbuf[512];
|
||||||
|
}modbus_t;
|
||||||
|
|
||||||
|
extern int32_t modbus_handle_init_after(void);
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
@ -0,0 +1,33 @@
|
|||||||
|
#ifndef __SERIAL_H__
|
||||||
|
#define __SERIAL_H__
|
||||||
|
|
||||||
|
/* Includes ------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
/* Define --------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
/* Exported types ------------------------------------------------------------*/
|
||||||
|
|
||||||
|
typedef struct
|
||||||
|
{
|
||||||
|
char tty[20]; //tty: 0, 1, 2, 3, 4, 5, 6, 7
|
||||||
|
unsigned int baudrate; //baudrate
|
||||||
|
unsigned char prompt; //prompt after reciving data
|
||||||
|
unsigned char databit; //data bits, 5, 6, 7, 8
|
||||||
|
unsigned char debug; //debug mode, 0: none, 1: debug
|
||||||
|
unsigned char echo; //echo mode, 0: none, 1: echo
|
||||||
|
unsigned char fctl; //flow control, 0: none, 1: hardware, 2: software
|
||||||
|
unsigned char parity; //parity 0: none, 1: odd, 2: even
|
||||||
|
unsigned char stopbit; //stop bits, 1, 2
|
||||||
|
unsigned char reserved;
|
||||||
|
} serial_attr_t;
|
||||||
|
|
||||||
|
/* Exported macro ------------------------------------------------------------*/
|
||||||
|
|
||||||
|
/* Extern global variables ---------------------------------------------------*/
|
||||||
|
|
||||||
|
/* Extern functions ----------------------------------------------------------*/
|
||||||
|
extern int serial_open(const char * devname, int baudrate);
|
||||||
|
extern int serial_read(int fd, unsigned char * data, int len);
|
||||||
|
extern int serial_write(int fd, unsigned char * data, int len);
|
||||||
|
extern void serial_close(int fd);
|
||||||
|
#endif
|
||||||
@ -0,0 +1,288 @@
|
|||||||
|
/* Includes ------------------------------------------------------------------*/
|
||||||
|
#ifdef HAVE_CONFIG_H
|
||||||
|
#include "config.h"
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/* 标准C库头文件. */
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <sys/types.h>
|
||||||
|
#include <sys/stat.h>
|
||||||
|
#include <fcntl.h>
|
||||||
|
#include <errno.h>
|
||||||
|
#include <string.h>
|
||||||
|
#include <unistd.h>
|
||||||
|
#include <termios.h>
|
||||||
|
|
||||||
|
/* 用户代码头文件. */
|
||||||
|
#include "serial.h"
|
||||||
|
|
||||||
|
int serial_band_convert(unsigned int baudrate)
|
||||||
|
{
|
||||||
|
switch (baudrate)
|
||||||
|
{
|
||||||
|
case 2400:
|
||||||
|
return B2400;
|
||||||
|
|
||||||
|
case 4800:
|
||||||
|
return B4800;
|
||||||
|
|
||||||
|
case 9600:
|
||||||
|
return B9600;
|
||||||
|
|
||||||
|
case 19200:
|
||||||
|
return B19200;
|
||||||
|
|
||||||
|
case 38400:
|
||||||
|
return B38400;
|
||||||
|
|
||||||
|
case 57600:
|
||||||
|
return B57600;
|
||||||
|
|
||||||
|
case 115200:
|
||||||
|
return B115200;
|
||||||
|
|
||||||
|
case 921600:
|
||||||
|
return B921600;
|
||||||
|
|
||||||
|
case 1152000:
|
||||||
|
return B1152000;
|
||||||
|
|
||||||
|
default:
|
||||||
|
return B115200;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
int serial_attr_set(int fd, serial_attr_t * attr)
|
||||||
|
{
|
||||||
|
unsigned char databit = 0;
|
||||||
|
unsigned char stopbit = 0;
|
||||||
|
unsigned char parity = 0;
|
||||||
|
unsigned char fctl = 0;
|
||||||
|
int ret = -1;
|
||||||
|
unsigned int baudrate = 0;
|
||||||
|
|
||||||
|
struct termios termios_old;
|
||||||
|
struct termios termios_new;
|
||||||
|
|
||||||
|
memset(&termios_old, 0, sizeof(termios_old));
|
||||||
|
memset(&termios_new, 0, sizeof(termios_new));
|
||||||
|
|
||||||
|
cfmakeraw(&termios_new);
|
||||||
|
|
||||||
|
if (tcgetattr(fd, &termios_old) != 0)
|
||||||
|
{
|
||||||
|
DBG(DBG_M_SERIAL, "Setup Serial!\r\n");
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
//baudrates
|
||||||
|
baudrate = serial_band_convert(attr->baudrate);
|
||||||
|
cfsetispeed(&termios_new, baudrate);
|
||||||
|
cfsetospeed(&termios_new, baudrate);
|
||||||
|
termios_new.c_cflag |= CLOCAL;
|
||||||
|
termios_new.c_cflag |= CREAD;
|
||||||
|
|
||||||
|
//flow control
|
||||||
|
fctl = attr-> fctl;
|
||||||
|
switch (fctl)
|
||||||
|
{
|
||||||
|
case 0:
|
||||||
|
termios_new.c_cflag &= ~CRTSCTS; //no flow control
|
||||||
|
break;
|
||||||
|
case 1:
|
||||||
|
termios_new.c_cflag |= CRTSCTS; //hardware flow control
|
||||||
|
break;
|
||||||
|
|
||||||
|
case 2:
|
||||||
|
termios_new.c_iflag |= IXON | IXOFF | IXANY; //software flow control
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
//data bits
|
||||||
|
termios_new.c_cflag &= ~CSIZE; //控制模式，屏蔽字符大小位
|
||||||
|
databit = attr->databit;
|
||||||
|
switch (databit)
|
||||||
|
{
|
||||||
|
case 5:
|
||||||
|
termios_new.c_cflag |= CS5;
|
||||||
|
break;
|
||||||
|
|
||||||
|
case 6:
|
||||||
|
termios_new.c_cflag |= CS6;
|
||||||
|
break;
|
||||||
|
|
||||||
|
case 7:
|
||||||
|
termios_new.c_cflag |= CS7;
|
||||||
|
break;
|
||||||
|
|
||||||
|
case 8:
|
||||||
|
termios_new.c_cflag |= CS8;
|
||||||
|
break;
|
||||||
|
|
||||||
|
default:
|
||||||
|
termios_new.c_cflag |= CS8;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
//parity check
|
||||||
|
parity = attr->parity;
|
||||||
|
switch (parity)
|
||||||
|
{
|
||||||
|
case 0: //no parity check
|
||||||
|
termios_new.c_cflag &= ~PARENB;
|
||||||
|
break;
|
||||||
|
|
||||||
|
case 1: //odd check
|
||||||
|
termios_new.c_cflag |= PARENB;
|
||||||
|
termios_new.c_cflag &= ~PARODD;
|
||||||
|
break;
|
||||||
|
|
||||||
|
case 2: //even check
|
||||||
|
termios_new.c_cflag |= PARENB;
|
||||||
|
termios_new.c_cflag |= PARODD;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
//stop bits
|
||||||
|
stopbit = attr->stopbit;
|
||||||
|
if (stopbit == 2)
|
||||||
|
{
|
||||||
|
termios_new.c_cflag |= CSTOPB;
|
||||||
|
}
|
||||||
|
else if (stopbit == 1)
|
||||||
|
{
|
||||||
|
termios_new.c_cflag &= ~CSTOPB;
|
||||||
|
}
|
||||||
|
|
||||||
|
//other attributions default
|
||||||
|
termios_new.c_oflag &= ~OPOST;
|
||||||
|
termios_new.c_cc[VMIN] = 1;
|
||||||
|
termios_new.c_cc[VTIME] = 1;
|
||||||
|
tcflush(fd, TCIFLUSH);
|
||||||
|
ret = tcsetattr(fd, TCSANOW, &termios_new);
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
int serial_open(const char * devname, int baudrate)
|
||||||
|
{
|
||||||
|
int fd;
|
||||||
|
serial_attr_t attr;
|
||||||
|
fd = open(devname, O_RDWR | O_NOCTTY | O_NONBLOCK);
|
||||||
|
if (fd < 0)
|
||||||
|
{
|
||||||
|
DBG(DBG_M_SERIAL, "Open SerialPort(%s) failed[error = %d, %s]!!!!!!!\r\n",
|
||||||
|
devname, errno, strerror(errno));
|
||||||
|
return E_SYS_CALL;
|
||||||
|
}
|
||||||
|
|
||||||
|
strcpy(attr.tty, devname);
|
||||||
|
attr.baudrate = baudrate;
|
||||||
|
|
||||||
|
serial_attr_set(fd, &attr);
|
||||||
|
|
||||||
|
DBG(DBG_M_SERIAL, "Open SerialPort(%s:%d) port success!!!\r\n", devname, baudrate);
|
||||||
|
|
||||||
|
return fd;
|
||||||
|
}
|
||||||
|
|
||||||
|
int serial_read(int fd, unsigned char * data, int len)
|
||||||
|
{
|
||||||
|
int ret = -1;
|
||||||
|
fd_set fs_read;
|
||||||
|
int maxfd = -1;
|
||||||
|
|
||||||
|
if (fd < 0 || data == NULL || len <= 0)
|
||||||
|
{
|
||||||
|
DBG(DBG_M_SERIAL, "Param Error, fd = %d or NULL == data or len <= 0.\r\n", fd);
|
||||||
|
return E_ERROR;
|
||||||
|
}
|
||||||
|
|
||||||
|
FD_ZERO(&fs_read);
|
||||||
|
FD_SET(fd, &fs_read);
|
||||||
|
maxfd = fd + 1;
|
||||||
|
struct timeval tv;
|
||||||
|
tv.tv_sec = 0;
|
||||||
|
tv.tv_usec = 1000 * 1000;
|
||||||
|
|
||||||
|
ret = select(maxfd, &fs_read, NULL, NULL, &tv);
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
DBG(DBG_M_SERIAL, "select error[%d, %s]!!!\r\n", errno, strerror(errno));
|
||||||
|
return E_SYS_CALL;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (ret == 0)
|
||||||
|
{
|
||||||
|
DBG(DBG_M_SERIAL, "Timeout......\r\n");
|
||||||
|
return E_TIMEOUT;
|
||||||
|
}
|
||||||
|
|
||||||
|
ret = read(fd, data, len);
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
DBG(DBG_M_SERIAL, "read error[%d, %s]\r\n", errno, strerror(errno));
|
||||||
|
return E_SYS_CALL;
|
||||||
|
}
|
||||||
|
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
|
int serial_write(int fd, unsigned char * data, int len)
|
||||||
|
{
|
||||||
|
if (fd < 0 || NULL == data || len <= 0)
|
||||||
|
{
|
||||||
|
DBG(DBG_M_SERIAL, "Param Error, fd = %d or NULL == data or len = %d.\r\n", fd, len);
|
||||||
|
return E_BAD_PARAM;
|
||||||
|
}
|
||||||
|
|
||||||
|
fd_set fs_write;
|
||||||
|
FD_ZERO(&fs_write);
|
||||||
|
FD_SET(fd, &fs_write);
|
||||||
|
|
||||||
|
int maxfd = fd + 1;
|
||||||
|
struct timeval tv;
|
||||||
|
tv.tv_sec = 0;
|
||||||
|
tv.tv_usec = 1000 * 1000;
|
||||||
|
|
||||||
|
int ret = select(maxfd, NULL, &fs_write, NULL, &tv);
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
DBG(DBG_M_SERIAL, "select Error[errno = %d, %s]\r\n", errno, strerror(errno));
|
||||||
|
return E_SYS_CALL;
|
||||||
|
}
|
||||||
|
else if (ret == 0)
|
||||||
|
{
|
||||||
|
DBG(DBG_M_SERIAL, "Timeout!\r\n");
|
||||||
|
return E_TIMEOUT;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (FD_ISSET(fd, &fs_write))
|
||||||
|
{
|
||||||
|
int pos = 0;
|
||||||
|
|
||||||
|
while (len > 0)
|
||||||
|
{
|
||||||
|
ret = write(fd, data + pos, len);
|
||||||
|
if (ret < 0)
|
||||||
|
{
|
||||||
|
DBG(DBG_M_SERIAL, "write com[fd = %d] error[errno = %d, %s]\r\n", fd, errno, strerror(errno));
|
||||||
|
return E_SYS_CALL;
|
||||||
|
}
|
||||||
|
len -= ret;
|
||||||
|
pos += ret;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return len;
|
||||||
|
}
|
||||||
|
|
||||||
|
void serial_close(int fd)
|
||||||
|
{
|
||||||
|
if (fd > 0)
|
||||||
|
{
|
||||||
|
close(fd);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
Loading…
Reference in New Issue