跳转至

磁编码 SMSMB 舵机 - 内存表解析

适用于 SMSMB 系列串行舵机,使用 MODBUS-RTU 标准协议。MODBUS 保持寄存器为 16 位,双字节字段按高字节在前传输;「地址PLC」为对应的 MODBUS 保持寄存器地址(4xxxx)。

1 舵机通信协议

舵机使用MODBUS-RTU标准协议,出厂时的串口默认配置,波特率默认为115200,数据位 8,无校验,停止位 1;波特率可配置范围4800~256Kbps,默认通信地址(站号)为 1。

完整帧格式与功能码见MODBUS-RTU协议。

2 舵机内存表定义

2.1 版本信息

地址DEC 地址HEX 地址PLC 功能名称 字节数 初始值 权限 取值范围 单位 说明
0 0x0 40001 固件版本号 2 – 只读 – –
1 0x1 40002 伺服版本号 2 – 只读 – –
2 0x2 40003 固件发布日期(年) 2 – 只读 – –
3 0x3 40004 固件发布日期(月) 2 – 只读 – –

2.2 EEPROM配置

地址DEC 地址HEX 地址PLC 功能名称 字节数 初始值 权限 取值范围 单位 说明
10 0x0A 40011 ID 2 1 读写 1~247 号 总线上唯一的身份识别码,同一总线不可出现重复ID,0号(0x00)为广播ID
11 0x0B 40012 波特率 2 2 读写 0~9 无 0-9分别代表波特率: 256000(0),128000(1),115200(2),57600(3),56000(4),38400(5),19200(6),14400(7),9600(8),4800(9)
12 0x0C 40013 返回延时 2 500 读写 0~500 1us 0表示最少返回延时,最大可设置返回延时500us
13 0x0D 40014 最小角度限制 2 0 读写 0~4095 0.0879° 设置运动行程最小值限制,取值小于最大角度限制,多圈绝对位置控制时此值为0
14 0x0E 40015 最大角度限制 2 4095 读写 0~4095 0.0879° 设置运动行程最大值限制,取值大于最小角度限制,多圈绝对位置控制时此值为0
15 0x0F 40016 位置校正 2 0 读写 -2047~2047 0.0879° 校正表示范围为-2047~2047,故障复位(134)写4自动计算中位(2048)校正值后存储于此地址
16 0x10 40017 运行模式 2 0 读写 0~4 无 0:伺服模式 1:恒速模式 2:预留 3:特殊模式(到目标位置自动关闭扭矩)4:步进模式
17 0x11 40018 位置闭环P 比例系数 2 – 读写 0~254 无 控制电机的比例系数
18 0x12 40019 位置闭环D 微分系数 2 – 读写 0~254 无 控制电机的微分系数
19 0x13 40020 位置闭环I 积分系数 2 0 读写 0~254 无 控制电机的积分系数
20 0x14 40021 速度闭环P 比例系数 2 – 读写 0~254 无 电机恒速模式(模式1)下,速度环比例系数
21 0x15 40022 速度闭环I 积分系数 2 – 读写 0~254 无 电机恒速模式(模式1)下,速度环积分系数

2.3 SRAM控制

地址DEC 地址HEX 地址PLC 功能名称 字节数 初始值 权限 取值范围 单位 说明
128 0x80 40129 目标位置 2 0 读写 -32768~32767 0.0879° 绝对位置控制方式,最大对应最大有效角度
129 0x81 40130 扭矩开关 2 0 读写 0~1 无 写0:关闭扭力输出;写1:打开扭力输出
130 0x82 40131 加速度 2 加速度默认值 读写 0~65535 8.79°/秒² 如设置为0则按舵机最大加速度变速,上电由“加速度默认值(405)”赋值
131 0x83 40132 运行速度 2 速度默认值 读写 0~65535 0.732RPM 上电由“速度默认值(406)”赋值
132 0x84 40133 扭矩限制 2 扭矩限制默认值 读写 0~1000 0.1% 上电初始值会由扭矩限制默认值(404)赋值,用户可程序修改此值来控制最大扭矩的输出,注意设置此扭矩限制值会同时影响转动速度,线性比例减小最高空载转速
133 0x85 40134 锁标志 2 1 读写 0~1/128 无 写0关闭EEPROM写入锁,写入EEPROM地址的值掉电保存;写1打开写入锁,写入EEPROM地址的值掉电不保存;写128关闭出厂参数写入锁
134 0x86 40135 故障复位 2 0 读写 0~65535 无 对应位被置1复位相应故障,复位成功相应位被置0,详见特殊字节位解析

2.4 SRAM反馈

地址DEC 地址HEX 地址PLC 功能名称 字节数 初始值 权限 取值范围 单位 说明
256 0x100 40257 伺服状态 2 0 只读 – 无 对应位被置1表示相应错误出现,详见特殊字节位解析
257 0x101 40258 当前位置 2 0 只读 – 0.0879° 反馈当前所处位置;绝对位置控制方式,最大值对应最大有效角度
258 0x102 40259 当前速度 2 0 只读 – 0.732RPM 反馈当前电机转动的速度
259 0x103 40260 输出PWM 2 0 只读 – 0.1% 当前控制输出驱动电机的电压占空比
260 0x104 40261 当前电压 2 0 只读 – 0.1V 当前舵机工作电压
261 0x105 40262 当前温度 2 0 只读 – ℃ 当前舵机内部工作温度
262 0x106 40263 移动标志 2 0 只读 – 无 舵机在运动时标志为1,舵机到达目标并且停止时为0
263 0x107 40264 当前电流 2 0 只读 – 6.5mA 最大可测量电流为 500 * 6.5mA= 3250mA

2.5 出厂参数

地址DEC 地址HEX 地址PLC 功能名称 字节数 初始值 权限 取值范围 单位 说明
384 0x180 40385 移动检测阈值 2 – 默认 – 无 舵机出厂默认参数
385 0x181 40386 D 控制时间 2 – 默认 – 无 舵机出厂默认参数
386 0x182 40387 最大速度限制 2 – 默认 0~32767 0.732RPM 舵机出厂默认参数
387 0x183 40388 H桥死区时间 2 – 默认 – – 舵机出厂默认参数
388 0x184 40389 加速度限制 2 – 默认 0~65535 8.79°/秒² 舵机出厂默认参数
389 0x185 40390 启动扭矩 2 – 默认 0~1000 0.1% 设置舵机的最小输出启动扭矩,设1000 = 100% * 堵转扭力
390 0x186 40391 顺时针不灵敏区 2 – 默认 0~32 0.0879°
391 0x187 40392 逆时针不灵敏区 2 – 默认 0~32 0.0879°
392 0x188 40393 相位 2 – 默认 0~255 无 特殊功能字节,无特别需求不可修改,详见特殊字节位解析
393 0x189 40394 保护开关 2 – 默认 0~255 无 对应位设置1为开启相应保护,对应位设置0为关闭相应保护,详见特殊字节位解析
394 0x18A 40395 LED报警条件 2 – 默认 0~255 无 对应位设置1为开启闪灯报警,对应位设置0为关闭闪灯报警,详见特殊字节位解析
395 0x18B 40396 最高温度上限 2 – 默认 0~100 ℃ 最高工作温度限制,如设置为70 则最高温度为70°C,设置精度为1°C
396 0x18C 40397 最高输入电压 2 – 默认 最低输入电压~360 0.1V 最高输入电压如设置为80,则最高工作电压限制为8.0V,设置精度为0.1V
397 0x18D 40398 最低输入电压 2 – 默认 0~最高输入电压 0.1V 最低输入电压如设置为40,则最低工作电压限制为4.0V,设置精度为0.1V
398 0x18E 40399 过载电流 2 – 默认 0~511 6.5mA 舵机工作过载保护电流
399 0x18F 40400 过流保护时间 2 – 默认 0~5000 1ms 工作电流超出过载电流的最长工作时间
400 0x190 40401 保护扭矩 2 – 默认 0~1000 0.1% 进入过载保护后输出扭矩,如设200表示20%的最大扭矩
401 0x191 40402 过载扭矩 2 – 默认 0~1000 0.1% 启动过载保护的最大扭力阈值,如设800表示80%的最大扭矩
402 0x192 40403 过载保护时间 2 – 默认 0~5000 1ms 舵机扭矩超出过载扭矩的最长工作时间
403 0x193 40404 角度分辨率 2 1 默认 1~128 无 对传感器最小分辨角度的放大系数,修改此值可以扩展控制圈数
404 0x194 40405 扭矩限制默认值 2 1000 默认 0~1000 0.1% 扭矩限制上电默认值
405 0x195 40406 加速度默认值 2 – 默认 0~65535 8.79°/秒² 加速度上电默认值
406 0x196 40407 速度默认值 2 – 默认 0~32767 0.732RPM 速度上电默认值

3 特殊字节解释

3.1 舵机相位

位数/位权重:说明

  • BIT0(1):驱动方向相位; (0)正向,(1)反向
  • BIT1(2):驱动桥模式; (0)无刷,(1)有刷,重启生效
  • BIT2(4):扭矩自动开关; (0)自动开启,(1)指令开启,固件>=20.9版本
  • BIT3(8):状态自动复位; (0)自动复位,(1)指令复位,固件>=20.9版本
  • BIT4(16):角度反馈模式; (0)反馈单圈角度,(1)反馈全角度
  • BIT5(32):----
  • BIT6(64):PWM频率,(0)24kHz,(1)16kHz
  • BIT7(128):位置反馈方向相位,(0)正向,(1)反向

提示

如果同时设置多个位,舵机的相位值为各个位值之和。例如:原相位值为0,舵机运行反向,则相位值为128+1=129;

3.2 舵机状态

舵机状态:0表示正常,1表示异常

位数/位权重:说明

  • BIT0(1):电压状态
  • BIT1(2):磁编码状态
  • BIT2(4):温度状态
  • BIT3(8):电流状态
  • BIT4(16):扭矩状态:0表示扭矩关闭,1表示扭矩打开
  • BIT5(32):负载状态

提示

如果同时有多种状态,舵机的状态值为各个位值之和。例如:电压过压/欠压与舵机过热,则舵机状态值为4+1=5;

3.3 保护开关

卸载条件:0表示关闭,1表示开启

位数/位权重:说明

  • BIT0(1):电压保护
  • BIT1(2):磁编码保护
  • BIT2(4):过热保护
  • BIT3(8):过流保护
  • BIT4(16):----
  • BIT5(32):负载过载

提示

如果同时设置多个位,舵机的卸载条件值为各位值之和。例如:电压保护与过热保护同时开启,则卸载条件值为4+1=5;

3.4 LED报警条件

LED报警条件:0表示关闭,1表示开启

位数/位权重:说明

  • BIT0(1):电压报警
  • BIT1(2):磁编码报警
  • BIT2(4):过热报警
  • BIT3(8):过流报警
  • BIT4(16):----
  • BIT5(32):负载过载报警

提示

如果同时设置多个位,舵机的LED报警条件值为各位值之和。例如:电压报警与过热报警同时开启,则报警条件值为4+1=5;

3.5 故障复位

故障复位:0无效,1表示复位

位数/位权重:说明

  • BIT0(1):复位过载故障; 自动复位开启,反向目标与关闭扭矩开关可复位故障
  • BIT1(2):复位过流故障; 自动复位开启,反向目标与关闭扭矩开关可复位故障
  • BIT2(4):中位设置,当前位置设置为2048中位
  • BIT3(8):----
  • BIT4(16):----
  • BIT5(32):复位过压/欠压,电压恢复正常,状态复位写32复位过压/欠压状态;自动复位开启,电压恢复正常自动复位
  • BIT6(64):复位过热状态,温度恢复正常,状态复位写64复位过热状态;自动复位开启,温度恢复正常自动复位
  • BIT7(128):复位磁编码状态,磁编码连接正常,状态复位写128复位磁编码状态;自动复位开启,磁编码连接正常自动复位

提示

如果同时设置多个位,复位过载故障与复位过流故障的值为各位值之和。例如:复位过载故障同时复位过流故障,则复位故障值为1+2=3;

不要跨系列套用地址

其他系列即使使用相同地址,含义也可能不同:地址 16 在 HLS 系列是最大扭矩,在本系列是运行模式;地址 20 在 HLS 系列是 LED 报警条件,在本系列是速度闭环 P 比例系数。请返回通信协议选择正确的内存表。

4 常见使用场景

  • 本节范围:连接成功后,舵机的日常操作都可以归结为对若干寄存器的读写,本节按场景汇总常见用法;指令帧怎么发不在本节范围,见 MODBUS-RTU协议。
  • 编号与功能码:文中编号均指本表「地址DEC」列,PLC 编程软件照「地址PLC」列;读用功能码 03、写单寄存器用功能码 06,双字节高字节在前、CRC16 低字节在前。
  • 在线判断:本协议没有 PING 指令,判断从站是否在线用「读 0 号固件版本号有应答」。

4.0 使用前必读

  • EEPROM 区(2.2,10~21 号):修改前需将133 锁标志写 0,改完写回 1,写入的值才掉电保存。实测锁标志为 1 时写入仍受理、当次生效,掉电后不保存;使能(129 扭矩开关)不影响掉电保存。
  • SRAM 区(2.3,128~134 号):直接写、立即生效,断电丢失,适合试验性写入;133 锁标志本身也在这一区,写它不需要解锁。
  • 2.1 的 0~3 号与 2.4 的 256~263 号为只读,读取不改变舵机状态。
  • 2.5 出厂参数区(384~406 号)权限为「默认」:实测可以修改——先把 133 锁标志写 128 解除出厂参数写入锁,改完写回 1,写入的值掉电保存,写法见 4.6。
  • 本系列位置类寄存器以「最小分辨角度」计数:默认(403 角度分辨率 = 1)一整圈 4096 格、每格 0.0879°(360° ÷ 4096),下文说的「格」即指这一单位;403 号设为 K 时一格变 K × 0.0879°。位置是有符号数:负目标按补码写,转向由正负号决定,本表没有方向位。

4.1 让舵机动起来

目标:第一次让输出轴转动一小段角度。

步骤 动作 寄存器 取值 / 写入示例
1 读当前位置,记作 P 257 当前位置 只读,如读到 2048
2 扭矩限制降到 30% 132 扭矩限制 300(0.1%,上电默认取 404 号 = 1000)
3 设运行速度 131 运行速度 100(100 × 0.732 RPM ≈ 73 RPM)
4 打开扭矩输出 129 扭矩开关 1
5 写目标位置 128 目标位置 P + 200(约 17.6°)

按角度转

128 目标位置 写的是绝对位置,所以「转 90°」要先确定角度从哪儿量。每格 0.0879°,90° 正好 1024 格。

想要的效果 算法 算例
从当前位置再转 90°(推荐) 读 257 当前位置 得 P,目标 = P ±(90° ÷ 0.0879°) P ± 1024
从行程起点转 90° 目标 = 90° ÷ 0.0879° 1024(13 号 = 0 时)
  • 先按 P + 1024 试转:方向不对就改 P − 1024。往哪一侧是加,由舵盘安装方向决定。
  • 算出的目标为负时直接写负数(如 −1024):本表没有方向位,转向由目标值的正负号决定。
  • 目标须在 13 最小角度限制 / 14 最大角度限制 内(见 4.3)。

说明:

验证:运动中 262 移动标志为 1,到位后回 0;再读 257 当前位置应等于目标值(被行程限制钳制时则为边界值)。

4.2 中位校准

目标:让目标位置 2048 对应舵盘装正时的姿态。磁编码零点固定在出厂轴向上,装舵盘常有偏差,靠这一步把零点摆正。

涉及寄存器:134 故障复位(写 4,即 BIT2 中位设置)。

步骤:

  • 先把输出轴手动转到舵盘装正时的姿态(可拆下舵盘,校正后再装回)。
  • 写 134 故障复位 = 4:舵机把此刻的位置当作 2048(半圈),算出的偏移自动存入 15 位置校正(属 EEPROM,掉电保存;实测无需先解锁 133),不用手动改。

注意:

  • 校正时输出轴应空载、静止;每执行一次都会把「当时的位置」改成 2048,重复执行会累积偏移。
  • 校正后 0~4095 的零点整体平移:之前记录的位置读数作废。行程限制若还是出厂默认 0 / 4095(整圈),平移后仍是整圈,不用重设;设过自定义范围的,13 最小角度限制 / 14 最大角度限制的数值现在指向平移后的物理角度,要按新零点重设(见 4.3)。
  • 断电重启后再读 257 当前位置复核标定是否保持。

验证:写完读 257 当前位置应为 2048;再把 128 目标位置写成 2048,输出轴应纹丝不动。

4.3 设置行程范围

目标:限制输出轴的转动范围。

涉及寄存器:13 最小角度限制、14 最大角度限制,单位为最小分辨角度(0.0879°);两者属 EEPROM 区(2.2),写入需先解锁 133 锁标志。

步骤:

  • 把想要的边界换算成格(角度 ÷ 0.0879°,换算方法见 4.1「按角度转」)。
  • 写 13 与 14,13 号必须小于 14 号;写前先把 133 锁标志写 0 解锁,写完置 1 回锁。

注意:

  • 出厂默认 13 号 = 0、14 号 = 4095,即整圈范围。
  • 13 号与 14 号同时为 0 会进入多圈绝对位置控制模式(两行表说明均标注「多圈绝对位置控制时此值为 0」),不再受单圈范围约束,128 目标位置的 ±32767 约对应 ±8 圈;此机制以实测为准。恢复普通模式需重新写入两个限制值(需先解锁 133 锁标志)。控制圈数还与 2.5 的 403 角度分辨率有关(见其表行说明)。
  • 行程限制只约束目标位置指令,外力仍可能把输出轴推到边界外。

验证:先把 14 最大角度限制设成 2048(属 EEPROM,同样要先解锁),再把 128 目标位置写成 3000,输出轴应停在 2048 格处,不再继续前进。

4.4 改 ID

目标:修改舵机的从站地址,多机组网前必做。

涉及寄存器:10 ID、133 锁标志。

坑:

  • 总线上只有这一只舵机时才能直接写;多机请逐个单独上电修改。
  • 用广播地址(0)写会把总线上所有从站一起变更,且广播帧从站不应答,不要等应答。
  • ID 范围 1~247,同一总线不要重复。
  • 写入成功后舵机当场改用新 ID 应答,旧 ID 上不再有应答;后面的回锁、读状态都要把指令帧里的从站地址字节换成新 ID,用旧 ID 发只会超时。

步骤:确认总线上只有这一只舵机 → 写 133 = 0 → 写 10 = 新 ID → 用新 ID 写 133 = 1。

验证:用新 ID 读 10 ID(或 0 号固件版本号)应有应答,旧 ID 不再应答。

4.5 改波特率

目标:更改通讯波特率,与主控匹配。出厂默认 115200(档位 2)。

涉及寄存器:11 波特率、133 锁标志;多机时可一并设置 12 返回延时。

坑:

  • 写入的是档位号 0~9,不是波特率数值(2=115200、1=128000、0=256000……完整对照见 2.2 表 11 号行)。
  • 写入成功后当前连接立即失联:舵机当场改用新档位通信,旧波特率上不再应答,要用新波特率重新连接(串口助手改波特率并重开端口,主控重新初始化串口)才能继续发指令,回锁也一样;写错档位只能逐档重试。
  • 主控与总线上所有从机必须同一档,混档总线不通。
  • 12 返回延时(0~500 μs,出厂 500)不是第二个 ID:多机同总线时用它按从站错开各自的应答时隙;它与 11 号同属 EEPROM,解锁流程相同。

步骤:解锁流程见 4.0 使用前必读 → 写 11 = 新档位(写入即失联)→ 按新波特率重新连接 → 写 133 = 1 回锁。

验证:按新波特率重新连接后读 0 号固件版本号,有应答即成。失联排查见故障排查。

4.6 配置保护

目标:设置温度、电压、电流与过载保护,避免堵转损坏舵机。

涉及寄存器:

作用 寄存器 说明
温度门槛 395 最高温度上限 单位 ℃;越过即置 256 的 BIT2
电压门槛 396 最高输入电压 / 397 最低输入电压 单位 0.1 V,397 号设 40 即 4.0 V(按供电电压设定)
电流门槛 398 过载电流 / 399 过流保护时间 398 单位 6.5 mA(0~511),399 单位 1 ms(0~5000)
是否卸载输出 393 保护开关 按位使能电压、磁编码、过热、过流、负载五项,位定义见 3.3 保护开关
是否闪灯 394 LED报警条件 独立通道,型号带 LED 时才闪,位定义见 3.4 LED报警条件
过载降扭 401 过载扭矩 / 402 过载保护时间 / 400 保护扭矩 负载超 401 号(800 = 80%)并持续 402 号时长后,输出扭矩降为 400 号保护扭矩(如 200 = 20%)

以上参数都在 2.5 出厂参数区,权限为「默认」:实测写入需先把 133 锁标志写 128 解除出厂参数写入锁,改完写回 1,写入的值掉电保存。

要点:

  • 温度、电压、电流三类要两个条件串起来才动作:393 保护开关对应位置 1(使能该项)+ 实测值越过 395~397 或 398 号阈值 → 该项动作(卸载输出);对应位为 0 时该项不动作。
  • 过载是另一套链路:负载超过 401 过载扭矩并持续 402 过载保护时间后,输出扭矩降为 400 保护扭矩;是否同时卸载输出,由 393 的 BIT5(负载过载位)决定。
  • 256 伺服状态反映的是检测层:越过阈值对应位就置 1,与 393 号开关无关;394 LED报警条件是另一条独立通道,报警与卸载互不替代。
  • 393 的 BIT1(磁编码保护)没有对应阈值寄存器:传感器本身报错即触发,不靠 395~398 号设值。
  • 395~398 号是阈值不是开关:单个写 0 不等于关闭该项保护。

验证:先确认 393 对应位已置 1,再人为越阈(或制造堵转),读 256 相应位变 1、输出按保护动作;解除后回 0。

4.7 读状态排错

目标:舵机行为异常时,用只读寄存器定位问题。

涉及寄存器:256 伺服状态、257 当前位置、258 当前速度、259 输出PWM、260 当前电压、261 当前温度、262 移动标志、263 当前电流,全部只读,随意读不影响舵机。

排查顺序:

源码定义

  • 本系列使用标准 MODBUS-RTU,没有专用 SDK 类,任何 Modbus 主站或调试工具都可以按本表访问
  • 官方 Arduino 库 FTServo_Arduino 不含本系列;寄存器含义以本页表格为准