当前位置：首页 > news >正文

IS620N 伺服驱动器核心功能模块解析

news 2026/5/11 21:23:41

EtherCAT和CANOPEN stm32f4主控，keil工程。带EtherCAT和CANOPEN总线通信。

引言

IS620N 是深圳市汇川技术有限公司推出的一款高性能伺服驱动器，广泛应用于工业自动化、机器人、数控机床等高精度运动控制场景。其软件架构采用模块化设计，强调实时性、可靠性与可维护性。本文基于 IS620N 的源码结构，从系统架构、关键功能模块及运行逻辑三个维度，深入剖析其核心控制逻辑，旨在为系统集成、二次开发及故障诊断提供技术参考。

一、整体软件架构

IS620N 的软件系统采用典型的分层与模块化设计，主要划分为以下几大功能域：

MTR（Motor Control）模块：负责底层电机控制，包括电流环、速度环、位置环、FPGA 接口驱动、编码器处理等，运行在高优先级中断（如 16kHz）中，确保控制的实时性。
FUNC（Function Management）模块：实现上层功能逻辑，如参数管理、故障监控、通信协议处理、模式切换、自整定等，运行在主循环（1kHz）或任务调度器中。
COMM（Communication）模块：支持 Modbus、CANopen、EtherCAT 等多种工业通信协议，提供参数读写、状态上报、指令下发等接口。
公共支撑模块：包括全局变量管理、EEPROM 操作、滤波器库、数学函数表（如正弦/余弦查表）等。

模块间通过结构化数据接口进行高效数据交换，例如MTRFUNCInterface.c中定义的pMTRToFUNCList16kHzAddr数组，将 MTR 模块的关键状态（如电流反馈、位置反馈、速度反馈）实时传递给 FUNC 模块，实现控制与监控的解耦。

二、核心功能模块详解

1. 绝对式编码器管理

IS620N 支持多品牌绝对式编码器（如 TAMAGAWA、NIKON、HDH 等），其管理逻辑高度抽象化。

初始化与参数加载：上电后，系统会通过 FPGA 与编码器通信，从其内部 EEPROM 读取校验字、版本号、位置偏置等参数。若校验失败或通信异常，将触发CHABSROMERR或ENCDERR_Z7等故障代码。
多圈数据处理：系统维护一个“多圈偏置”变量（PL_EncMultiTurnOffset），用于补偿编码器掉电后多圈计数的丢失。在特定操作（如 H0D20=1）下，可执行多圈数据清零，并同步更新该偏置。
动态读写：提供TAMAGAbsRom_ReadByte/WriteByte等函数，支持在运行时对编码器 EEPROM 进行安全读写，并内置 18ms 的写周期延时保护。

该模块的设计确保了即使在复杂工况下，也能维持位置信息的绝对性和连续性。

2. 过载与热保护机制

过载保护是伺服系统安全运行的核心。IS620N 实现了精细化的双维度保护策略：

驱动器/电机过载保护：根据驱动器功率等级（如 7.5kW、5-6kW 等），系统内置了多组“过载曲线表”。这些表格定义了不同负载电流下允许的持续时间，实现了 I²t 热累积模型。当累积热量超过阈值OVLoadErrValue时，触发过载报警。
堵转保护：在低速或静止状态下，系统启用另一套更严格的“堵转过载曲线”，防止电机因长时间堵转而烧毁。

该机制通过FUNCMonitorOverLoadProtect.c和FUNCMonitorOverLoadTable.c协同实现，将硬件保护与软件算法深度融合。

3. 参数管理与持久化

所有用户可配置参数（功能码）被组织成结构化的组（如 H00, H01...），并定义了详细的属性（可写性、数据范围、单位、小数位等）。

运行时管理：FUNC_ManageFunCode模块负责处理来自面板、上位机或总线的参数读写请求，并进行合法性校验。
非易失存储：通过FUNCOperEeprom.c模块，关键参数可被安全地写入板载 EEPROM。系统采用校验字（EEPROMCHECK_WORD）机制，确保数据在掉电后的一致性与完整性。

这种设计极大提升了系统的鲁棒性和用户友好性。

4. 全闭环与多段位置控制

全闭环控制：通过FUNC_FullCloseLoop.c模块，系统可接入外部直线光栅尺或旋转编码器，构成位置环的外环，实现纳米级的定位精度。
多段位置/速度规划：FUNCMultiBlockPos.c和FUNCMultiBlockSpeed.c模块支持复杂的运动序列规划，如 S 曲线加减速、多段速度切换等，满足高端自动化设备的轨迹控制需求。