STM32通过RS485与Modbus RTU控制汇川SV660C伺服电机

1. 项目概述

在工业自动化控制系统中，伺服电机的精确控制是核心需求之一。本文将详细介绍如何使用STM32微控制器通过RS485总线和Modbus RTU协议控制汇川SV660C系列伺服电机。这种控制方案广泛应用于CNC机床、自动化生产线、机器人等需要高精度运动控制的场景。

整个系统架构中，STM32作为主站（Master），通过USART2接口连接RS485总线，最多可控制4台SV660C伺服电机（从站）。主要实现以下功能：

• 伺服使能/禁用控制
• 目标位置设定
• 运行速度设定
• 启动/停止控制
• 实时位置读取

2. 硬件连接与通信基础

2.1 RS485硬件连接

RS485是一种差分信号标准的串行通信协议，具有抗干扰能力强、传输距离远（最长1200米）、支持多点通信等特点。在本项目中：

1. 接线方式：

   • A线（差分+）连接所有设备的A端子
   • B线（差分-）连接所有设备的B端子
   • 需要终端电阻（通常120Ω）匹配阻抗

2. STM32连接方案：

   • 使用USART2外设
   • 通过SP3485或MAX485芯片转换为RS485电平
   • 注意DE/RE控制线用于切换收发方向

3. 伺服电机侧：

   • SV660C标配RS485接口（端子号为5:A，6:B）
   • 从站地址通过面板设置（默认为1）

关键提示：RS485总线必须采用手拉手式连接，避免星型拓扑。总线两端需要接120Ω终端电阻。

2.2 Modbus RTU协议要点

Modbus RTU是工业领域广泛应用的串行通信协议，基于主从架构，使用紧凑的二进制编码。核心特点：

1. 报文格式：

   • 从站地址（1字节）
   • 功能码（1字节）
   • 数据区（N字节）
   • CRC校验（2字节）

2. 功能码：

   • 0x03：读保持寄存器
   • 0x10：写多个寄存器
   • 其他功能码在本项目中未使用

3. 数据格式：

   • 所有数据大端序（高字节在前）
   • 寄存器地址为16位
   • 保持寄存器可读可写

3. 核心代码实现解析

3.1 CRC16校验实现

CRC校验是Modbus通信可靠性的关键保障。以下是经过优化的实现：

c复制/**
 * @brief Modbus CRC16计算函数
 * @param buf 数据缓冲区
 * @param len 数据长度
 * @return uint16_t CRC校验值
 */
static uint16_t Modbus_CRC16(uint8_t *buf, uint16_t len)
{
    uint16_t crc = 0xFFFF;  // 初始值
    uint8_t i, j;