用C语言写一段modbus TCP从机程序

以下是一个简单的 Modbus TCP 从机程序，使用 C 语言编写，可以响应主机的读取寄存器请求：

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sys/socket.h>
#include <arpa/inet.h>

#define SERVER_PORT 502          // 从机端口号
#define REG_COUNT 1              // 寄存器数量
#define REG_VALUE 0x1234         // 寄存器的值

int main() {
    int sock, client_sock;
    struct sockaddr_in server, client;
    int client_len, len;
    char buf[256];

    // 创建套接字
    sock = socket(AF_INET, SOCK_STREAM, 0);
    if (sock < 0) {
        perror("socket");
        exit(1);
    }

    // 设置服务器地址信息
    server.sin_family = AF_INET;
    server.sin_addr.s_addr = htonl(INADDR_ANY);
    server.sin_port = htons(SERVER_PORT);

    // 绑定套接字
    if (bind(sock, (struct sockaddr *)&server, sizeof(server)) < 0) {
        perror("bind");
        exit(1);
    }

    // 开始监听
    if (listen(sock, 1) < 0) {
        perror("listen");
        exit(1);
    }

    printf("Waiting for connection...\n");

    while (1) {
        // 等待连接
        client_len = sizeof(client);
        client_sock = accept(sock, (struct sockaddr *)&client, &client_len);
        if (client_sock < 0) {
            perror("accept");
            exit(1);
        }

        printf("Connection from %s:%d\n", inet_ntoa(client.sin_addr), ntohs(client.sin_port));

        // 接收 Modbus TCP 请求
        len = recv(client_sock, buf, sizeof(buf), 0);
        if (len < 0) {
            perror("recv");
            exit(1);
        }

        // 解析 Modbus TCP 请求
        unsigned char request[256];
        memcpy(request, buf, len);
        unsigned short addr = (request[2] << 8) | request[3];
        unsigned short count = (request[4] << 8) | request[5];

        // 构造 Modbus TCP 响应
        unsigned char response[256];
        response[0] = request[0];
        response[1] = request[1];
        response[2] = count * 2;
        for (int i = 0; i < count; i++) {
            unsigned short value = REG_VALUE;
            response[3 + i * 2] = value >> 8;
            response[4 + i * 2] = value & 0xFF;
        }

        // 发送 Modbus TCP 响应
        if (send(client_sock, response, 3 + count * 2, 0) < 0) {
            perror("send");
            exit(1);
        }

        printf("Response sent.\n");

        // 关闭客户端套接字
        close(client_sock);
    }

    // 关闭服务器套接字
    close(sock);

    return 0;
}

该程序通过创建套接字、绑定端口、开始监听、接受请求、解析请求、构造响应、发送响应等步骤实现了一个 Modbus TCP 从机。其中，解析请求和构造响应的格式遵循 Modbus TCP 协议规定，并且只支持读取寄存器功能（功能码为 0x03）。实际使用中，可以根据需要修改功能码和响应数据的格式，实现更多的功能。