磁编码 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配置¶
2.3 SRAM控制¶
2.4 SRAM反馈¶
2.5 出厂参数¶
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)。
说明:
- 132 扭矩限制 属 SRAM:改完立即生效、掉电丢失,上电会用 404 扭矩限制默认值重新赋值,所以试转改 132 号最省事;要长期生效就去改 404 号(属 2.5 出厂参数,需先把 133 锁标志写 128 解锁)。
- 131 运行速度 与 130 加速度 同属 SRAM,上电分别由 406 速度默认值 / 405 加速度默认值赋值;130 号写 0 表示按舵机最大加速度变速。
- 改 132 扭矩限制会同时影响转动速度:限制越低,最高空载转速按比例线性减小。
验证:运动中 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 锁标志。
步骤:
注意:
- 出厂默认 13 号 = 0、14 号 = 4095,即整圈范围。
- 13 号与 14 号同时为 0 会进入多圈绝对位置控制模式(两行表说明均标注「多圈绝对位置控制时此值为 0」),不再受单圈范围约束,128 目标位置的 ±32767 约对应 ±8 圈;此机制以实测为准。恢复普通模式需重新写入两个限制值(需先解锁 133 锁标志)。控制圈数还与 2.5 的 403 角度分辨率有关(见其表行说明)。
- 行程限制只约束目标位置指令,外力仍可能把输出轴推到边界外。
验证:先把 14 最大角度限制设成 2048(属 EEPROM,同样要先解锁),再把 128 目标位置写成 3000,输出轴应停在 2048 格处,不再继续前进。
4.4 改 ID¶
目标:修改舵机的从站地址,多机组网前必做。
坑:
- 总线上只有这一只舵机时才能直接写;多机请逐个单独上电修改。
- 用广播地址(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 当前电流,全部只读,随意读不影响舵机。
排查顺序:
- 读 256 伺服状态:非 0 时按 3.2 舵机状态位定义对位(1=电压、2=磁编码、4=温度、8=电流、16=扭矩状态、32=负载);注意 BIT4(16)为 1 表示扭矩正常打开,不是错误。
- 读 260 当前电压 / 261 当前温度:确认供电电压与内部温度是否正常,对照 396 / 397 / 395 号设定的门槛。
- 读 263 当前电流:乘 6.5 mA,看是否接近 398 过载电流的门槛。
- 读 257 / 258 / 262:对比当前位置与目标位置、看移动标志,确认指令是否被执行。
- 定位到故障后,复位用 134 故障复位,但其位号与 256 不同(BIT0 过载、BIT1 过流、BIT2 中位、BIT5 过压欠压、BIT6 过热、BIT7 磁编码),见 3.5 故障复位。
源码定义¶
- 本系列使用标准 MODBUS-RTU,没有专用 SDK 类,任何 Modbus 主站或调试工具都可以按本表访问
- 官方 Arduino 库
FTServo_Arduino不含本系列;寄存器含义以本页表格为准