磁编码 SMS 舵机 - 内存表解析¶
适用于 SMS RS485 系列串行舵机。双字节字段按低字节在前传输。
STS 系列(半双工 TTL)内存表见STS 内存表,两系列地址含义存在差异,不要混用。
1 舵机通信协议¶
舵机使用FT-SCS自定义协议,出厂时的串口默认配置,SMS舵机波特率默认为115200使用RS485总线通信;波特率可配置范围38400~1Mbps,默认通信地址(站号)为1。
完整协议帧格式与指令集见FT-SCS 自定义协议。
2 舵机内存表定义¶
如果功能地址采用两个字节的数据,低位字节在前地址,高位字节在后地址
注意:
- 部分参数的初始值与取值范围因型号而异(表中以 – 表示),以本型号出厂资料为准。
- 表中「最小分辨角度」指编码器能分辨的最小角度:本系列把一整圈 360° 分为 4096 份,每份 = 360° ÷ 4096 ≈ 0.0879°,也就是单位列里写的那个值;位置、角度限制等寄存器都以它为计数单位,以本型号资料为准。
- 速度单位有两档:0.732RPM 与 0.0146RPM(后者为前者的 1/50,只是指令粒度更细)。硬件最小速度变化仍是 0.732RPM(每 20ms 走 1 格 = 0.0879°):细档下写 50 才对应 1 档,写 1~49 不产生实际速度变化。
2.1 版本信息¶
| 地址DEC | 地址HEX | 功能名称 | 字节数 | 初始值 | 权限 | 取值范围 | 单位 | 说明 |
|---|---|---|---|---|---|---|---|---|
| 0 | 0x00 | 固件主版本号 | 1 | – | 只读 | |||
| 1 | 0x01 | 固件次版本号 | 1 | – | 只读 | |||
| 2 | 0x02 | END | 1 | 0 | 只读 | 0表示小端存储结构 | ||
| 3 | 0x03 | 舵机主版本号 | 1 | – | 只读 | |||
| 4 | 0x04 | 舵机次版本号 | 1 | – | 只读 |
2.2 EEPROM配置¶
| 地址DEC | 地址HEX | 功能名称 | 字节数 | 初始值 | 权限 | 取值范围 | 单位 | 说明 |
|---|---|---|---|---|---|---|---|---|
| 5 | 0x05 | 舵机ID | 1 | 1 | 读写 | 0~253 | 号 | 总线上唯一的主ID标识 |
| 6 | 0x06 | 波特率 | 1 | 4 | 读写 | 0~7 | 无 | 0-7分别代表波特率:1000000(0),500000(1),250000(2),128000(3),115200(4),76800(5),57600(6),38400(7) |
| 7 | 0x07 | 应答返回延时 | 1 | 0 | 读写 | 0/50~253 | 2us | 最大可设置返回延时 254*2=508us,0表示最少返回延时,设置<50默认仍然为50(100us) |
| 8 | 0x08 | 应答状态级别 | 1 | 1 | 读写 | 0~1 | 无 | 0:除读指令与PING指令外其它指令不返回应答包;1:对所有指令返回应答包 |
| 9 | 0x09 | 最小角度限制 | 2 | 0 | 读写 | 0~4094 | 0.0879° | 设置最小运行角度限制,取值小于最大角度限制;最小角度限制=最大角度限制=0 进入多圈绝对位置控制模式 |
| 11 | 0x0B | 最大角度限制 | 2 | 4095 | 读写 | 0~4095 | 0.0879° | 设置最大运行角度限制,取值大于最小角度限制;最小角度限制=最大角度限制=0 进入多圈绝对位置控制模式 |
| 13 | 0x0D | 最高温度上限 | 1 | 70 | 读写 | 0~100 | ℃ | 过热保护的温度阈值 |
| 14 | 0x0E | 最高输入电压 | 1 | – | 读写 | 0~254 | 0.1V | 过压保护的电压阈值 |
| 15 | 0x0F | 最低输入电压 | 1 | 40 | 读写 | 0~254 | 0.1V | 欠压保护的电压阈值(默认值按低压型号设定,高压型号宜上调) |
| 16 | 0x10 | 最大扭矩 | 2 | 1000 | 读写 | 0~1000 | 0.1% | 上电赋值给48号地址转矩限制 |
| 18 | 0x12 | 相位 | 1 | – | 读写 | 0~254 | 无 | 特殊功能字节,无特别需求不可修改 |
| 19 | 0x13 | 卸载条件 | 1 | – | 读写 | 0~254 | 无 | 对应位设置1为开启相应保护,对应位设置0为关闭相应保护;位定义见 3.3 卸载条件 |
| 20 | 0x14 | LED报警条件 | 1 | – | 读写 | 0~254 | 无 | 对应位设置1为开启闪灯报警,对应位设置0为关闭闪灯报警;位定义见 3.4 LED报警条件 |
| 21 | 0x15 | 位置环P 比例系数 | 1 | – | 读写 | 0~254 | 无 | 控制电机的比例系数(1/4) |
| 22 | 0x16 | 位置环D 微分系数 | 1 | – | 读写 | 0~254 | 无 | 控制电机的微分系数(1/8) |
| 23 | 0x17 | 位置环I 积分系数 | 1 | 0 | 读写 | 0~254 | 无 | 控制电机的积分系数 |
| 24 | 0x18 | 最小启动扭矩 | 1 | – | 读写 | 0~254 | 0.1% | 设置舵机的最小输出启动扭矩 |
| 25 | 0x19 | 积分限制值 | 1 | 0 | 读写 | 0~254 | 无 | 最大积分值=积分限制值*4,0表示关闭积分限制功能,位置模式0与模式4生效(模式4 为个别定制,特殊款才有) |
| 26 | 0x1A | 正向不灵敏区 | 1 | 1 | 读写 | 0~16 | 0.0879° | 最小单位为一个最小分辨角度 |
| 27 | 0x1B | 负向不灵敏区 | 1 | 1 | 读写 | 0~16 | 0.0879° | 最小单位为一个最小分辨角度 |
| 28 | 0x1C | 保护电流 | 2 | 511 | 读写 | 0~2047 | 6.5mA | 最大可设置电流为 500 * 6.5mA = 3250mA(建议上限,具体请按照实际型号) |
| 30 | 0x1E | 角度分辨率 | 1 | 1 | 读写 | 1~128 | 无 | 对传感器最小分辨角度的放大系数:设为 K 时一个计数 = K × 0.0879°,满量程 0~4095 对应 K 圈;K 越大圈数越多,步距越粗 |
| 31 | 0x1F | 位置偏移 | 2 | 0 | 读写 | 0~8191 | 0.0879° | 0~2047表示0~2047;2048~4095表示0~-2047;4096~6143表示2048~4095;6144~8191表示-2048~-4095(表示偏置-4095~4095) |
| 33 | 0x21 | 运行模式 | 1 | 0 | 读写 | 0~3 | 无 | 0:位置伺服模式;1:电机恒速模式;2:PWM开环调速度模式;3:步进模式 |
| 34 | 0x22 | 保持扭矩 | 1 | 20 | 读写 | 0~254 | 1% | 进入过载保护后输出扭矩,如设20表示20%的最大扭矩 |
| 35 | 0x23 | 保护时间 | 1 | 200 | 读写 | 0~254 | 10ms | 当前负载输出超过过载扭力并保持的计时时长,如设200表示2秒,最大可设2.54秒 |
| 36 | 0x24 | 过载扭矩 | 1 | 80 | 读写 | 0~254 | 1% | 启动过载保护时间计时的最大扭力阈值,如设80表示80%的最大扭矩 |
| 37 | 0x25 | 速度闭环P比例系数 | 1 | – | 读写 | 0~254 | 无 | 电机恒速模式(模式1)下,速度环比例系数 |
| 38 | 0x26 | 过流保护时间 | 1 | 200 | 读写 | 0~254 | 10ms | 最大可设置 254 * 10ms = 2540ms |
| 39 | 0x27 | 速度闭环I积分系数 | 1 | – | 读写 | 0~254 | 无 | 电机恒速模式(模式1)下,速度环积分系数 |
2.3 SRAM控制¶
2.4 SRAM反馈¶
2.5 出厂参数¶
| 地址DEC | 地址HEX | 功能名称 | 字节数 | 初始值 | 权限 | 取值范围 | 单位 | 说明 |
|---|---|---|---|---|---|---|---|---|
| 80 | 0x50 | 移动速度阈值 | 1 | – | 只读 | – | – | |
| 81 | 0x51 | DTs(ms) | 1 | – | 只读 | – | – | |
| 82 | 0x52 | 速度单位系数 | 1 | – | 只读 | – | – | |
| 83 | 0x53 | Hts(ns) | 1 | – | 只读 | – | – | 20.83ns,sms舵机固件>=2.54有效,其它版本保持0 |
| 84 | 0x54 | 最大速度限制 | 1 | – | 只读 | – | – | 单位0.732rpm |
| 85 | 0x55 | 加速度限制 | 1 | – | 只读 | – | – | |
| 86 | 0x56 | 加速度倍数 | 1 | – | 只读 | – | – | 加速度为0时加速度倍数生效,加速度倍数与加速度同时为0表示舵机响应速度最快 |
3 特殊字节解释¶
3.1 舵机相位¶
位数/位权重:说明
- BIT0(1):驱动方向相位;(0)正向,(1)反向
- BIT1(2):驱动桥模式;(0)无刷,(1)有刷,重启生效
- BIT2(4):速度单位,(0)0.732RPM,(1)0.0146RPM
- BIT3(8):速度模式;(0)速度0表示停止,(1)速度0表示最高速度
- BIT4(16):角度反馈模式,(0)反馈单圈角度,(1)反馈全角度
- BIT5(32):电压采样,(0)1.5K低压采样,(1)1K高压采样
- 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):----
- BIT5(32):负载状态
- BIT6(64):----
- BIT7(128):----
提示
如果同时有多种状态,舵机的状态值为各个位值之和。例如:电压过压/欠压与舵机过热,则舵机状态值为4+1=5;
3.3 卸载条件¶
卸载条件:0表示关闭,1表示开启
位数/位权重:说明
- BIT0(1):电压保护
- BIT1(2):磁编码保护
- BIT2(4):过热保护
- BIT3(8):过流保护
- BIT4(16):----
- BIT5(32):负载过载
- BIT6(64):----
- BIT7(128):----
提示
如果同时设置多个位,舵机的卸载条件值为各位值之和。例如:电压保护与过热保护同时开启,则卸载条件值为4+1=5;
3.4 LED报警条件¶
LED报警条件:0表示关闭,1表示开启
位数/位权重:说明
- BIT0(1):电压报警
- BIT1(2):磁编码报警
- BIT2(4):过热报警
- BIT3(8):过流报警
- BIT4(16):----
- BIT5(32):负载过载报警
- BIT6(64):----
- BIT7(128):----
提示
如果同时设置多个位,舵机的LED报警条件值为各位值之和。例如:电压报警与过热报警同时开启,则报警条件值为4+1=5;
不要跨系列套用地址
其他系列即使使用相同地址,含义也可能不同(例如 HLS 系列地址 44–45 为目标电流,本表为 PWM 开环速度)。请返回通信协议选择正确的内存表。
4 常见使用场景¶
连接成功后,舵机的日常操作都可以归结为对若干寄存器的读写。本节按场景汇总常见用法;指令帧怎么发不在本节范围,见FT-SCS 自定义协议。文中编号均指本表地址。
4.0 使用前必读¶
- EEPROM 区(2.2,5~39 号):修改前需将55 锁标志写 0,改完写回 1,写入的值才掉电保存。实测锁标志为 1 时写入仍受理、当次生效,掉电后不保存;使能(40 扭矩开关)不影响掉电保存。
- SRAM 区(2.3,40~55 号):直接写、立即生效,断电丢失,适合试验性写入;55 锁标志 本身也在这一区,写它不需要解锁。
- 2.4 的 56~71 号与 2.5 的 80~86 号为只读,读取不改变舵机状态。
- 本系列走 RS-485 总线:A/B 两线不可接反,收发方向由转接模块切换;波特率出厂 115200(档位 4),与 STS / HLS 系列的 1 Mbps 不同,接上先确认主控的波特率。
- 本系列位置类寄存器以「最小分辨角度」计数:默认(30 号角度分辨率 = 1)一整圈 4096 格、每格 0.0879°(360° ÷ 4096),下文说的「格」即指这一单位;30 号设为 K 时一格变 K × 0.0879°。
4.1 让舵机动起来¶
目标:第一次让输出轴转动一小段角度。
| 步骤 | 动作 | 寄存器 | 取值 / 写入示例 |
|---|---|---|---|
| 1 | 读当前位置,屏蔽 BIT15 方向位后记作 P | 56 当前位置 | 只读,如读到 2048 |
| 2 | 转矩限制降到 30% | 48 转矩限制 | 300(上电默认取 16 号 = 1000) |
| 3 | 设运行速度 | 46 运行速度 | 100(100 × 0.732 RPM ≈ 73 RPM) |
| 4 | 打开扭矩输出(可跳过) | 40 扭矩开关 | 1 |
| 5 | 写目标位置 | 42 目标位置 | P + 200(约 17.6°) |
按角度转
42 目标位置 写的是绝对位置,所以「转 90°」要先确定角度从哪儿量。每格 0.0879°,90° 正好 1024 格。
| 想要的效果 | 算法 | 算例 |
|---|---|---|
| 从当前位置再转 90°(推荐) | 读 56 当前位置 得 P(屏蔽 BIT15),目标 = P ±(90° ÷ 0.0879°) | P ± 1024 |
| 从行程起点转 90° | 目标 = 90° ÷ 0.0879° | 1024 |
- 先按 P + 1024 试转:方向不对就改 P − 1024。往哪一侧是加,由舵盘安装方向决定。
- 算出的目标为负时,写它的绝对值并在 42 目标位置 上置 BIT15(反向位)。
- 目标须在 9 最小角度限制 / 11 最大角度限制 内(见 4.3)。
说明:
- 48 转矩限制 属 SRAM:改完立即生效、掉电丢失,上电时会用 16 最大扭矩 的值重新赋值,所以试转改 48 号最省事;要长期生效才去改 16 号(属 EEPROM,需先解锁)。
- 46 运行速度 的单位由 18 相位 的 BIT2 决定(0.732 RPM / 0.0146 RPM);写 0 的含义由 BIT3 决定:BIT3=1 时 0 表示最高速度,BIT3=0 时 0 表示停止(位定义见 3.1 舵机相位)。
- 40 扭矩开关 除 0/1 外还有 2(阻尼输出,由 48 控制阻尼力)与 128(把当前位置校正为 2048,见 4.2),首次试转用 1 即可。
- 直接发 42 目标位置 时,40 扭矩开关 会自动置 1,所以步骤 4 可以跳过。
- 多机同在一条 RS-485 总线上时,可用 7 应答返回延时 错开各自的应答时隙(单位 2 μs,设 0 或小于 50 时为 100 μs)。
验证:运动中 66 移动标志 为 1,到位后回 0;再读 56 当前位置(屏蔽 BIT15)应等于目标幅值(被行程限制钳制时则为边界值)。
4.2 中位校准¶
目标:让目标位置 2048 对应舵盘装正时的姿态。磁编码零点固定在出厂轴向上,装舵盘常有偏差,靠这一步把零点摆正。
涉及寄存器:40 扭矩开关(写 128)。
步骤:
- 先把输出轴手动转到舵盘装正时的姿态(可拆下舵盘,校正后再装回)。
- 写 40 扭矩开关 = 128:舵机把此刻的位置当作 2048(半圈)。
注意:
- 校正时输出轴应空载、静止;每执行一次都会把「当时的位置」改成 2048,重复执行会累积偏移。
- 校正后 0~4095 的零点整体平移:之前记录的位置读数作废。行程限制若还是出厂默认 0 / 4095(整圈),平移后仍是整圈,不用重设;设过自定义范围的,9 最小角度限制 / 11 最大角度限制 的数值现在指向平移后的物理角度,要按新零点重设(见 4.3)。
- 断电重启后重读 56 当前位置 复核标定是否保持;31 位置偏移 由固件在校准时算好并写入(属 EEPROM),掉电保存,不用手动改。
验证:写完读 56 当前位置 应为 2048;再把 42 目标位置 写成 2048,输出轴应纹丝不动。
4.3 设置行程范围¶
目标:限制输出轴的转动范围。
涉及寄存器:9 最小角度限制、11 最大角度限制,单位为最小分辨角度(0.0879°);两者属 EEPROM 区,写入需先解锁 55 锁标志。
步骤:
注意:
- 出厂默认 9 号 = 0、11 号 = 4095,即整圈范围。
- 9 号与 11 号同时为 0 会进入多圈绝对位置控制模式,不再受单圈范围约束,属进阶用法;恢复普通模式需重新写入两个限制值。
- 行程限制只约束目标位置指令,外力仍可能把输出轴推到边界外。
验证:先把 11 最大角度限制 设成 2048(属 EEPROM,同样要先解锁),再把 42 目标位置 写成 3000,输出轴应停在 2048 格处,不再继续前进。
4.4 改 ID¶
目标:修改舵机的总线地址,多机组网前必做。
涉及寄存器:5 舵机ID、55 锁标志;多机时序可另配 7 应答返回延时。
坑:
- 总线上只有这一只舵机时才能直接写;多机请逐个单独上电修改。
- 用广播地址写会让总线上所有舵机一起变更。
- ID 范围 0~253,同一总线不要重复。
- 写入成功后舵机当场改用新 ID 应答,旧 ID 上不再有应答;后面的回锁、PING 都要把指令里的 ID 字节换成新 ID(串口不用重开),用旧 ID 发只会超时。
步骤:确认总线上只有这一只舵机 → 写 55 = 0 → 写 5 = 新 ID → 用新 ID 写 55 = 1。
验证:用新 ID 发 PING(或读 5)应有应答,旧 ID 不再应答。广播改法见FT-SCS 自定义协议。
4.5 改波特率¶
目标:更改通讯波特率,与主控匹配。出厂默认 115200(档位 4),注意与 STS / HLS 的 1 Mbps 不同。
坑:
- 写入的是档位号 0~7,不是波特率数值(0=1000000、1=500000、2=250000、3=128000、4=115200、5=76800、6=57600、7=38400)。
- 写入成功后当前连接立即失联:舵机当场改用新档位通信,旧波特率上不再应答,要用新波特率重新连接(串口助手改波特率并重开端口,主控重新初始化串口)才能继续发指令,回锁也一样;写错档位只能逐档重试或恢复出厂默认。
- 主控与总线上所有舵机必须同一档,混档总线不通;RS-485 转接模块本身也要支持该波特率。
步骤:解锁流程见 4.0 使用前必读 → 写 6 = 新档位(写入即失联)→ 按新波特率重新连接 → 写 55 = 1 回锁。
验证:按新波特率重新连接后发 PING,有应答即成。失联排查见故障排查。
4.6 配置保护¶
目标:设置温度、电压、电流与过载保护,避免堵转损坏舵机。
涉及寄存器:
| 作用 | 寄存器 | 说明 |
|---|---|---|
| 温度门槛 | 13 最高温度上限 | 单位 ℃,默认 70;越过即置 65 的 BIT2 |
| 电压门槛 | 14 最高输入电压 / 15 最低输入电压 | 单位 0.1 V,15 号默认 40 即 4.0 V(按低压型号设定,高压型号宜上调) |
| 电流门槛 | 28 保护电流 / 38 过流保护时间 | 28 单位 6.5 mA(默认 511 ≈ 3.3 A),38 单位 10 ms(默认 200 = 2 秒) |
| 是否卸载输出 | 19 卸载条件 | 按位使能电压、磁编码、过热、过流、负载五项,位定义见 3.3 卸载条件 |
| 是否闪灯 | 20 LED报警条件 | 独立通道,型号带 LED 时才闪,位定义见 3.4 LED报警条件 |
| 过载降扭 | 36 过载扭矩 / 35 保护时间 / 34 保持扭矩 | 负载超 36 号扭力(80 = 80%)并持续 35 号时长(200 = 2 秒)后,输出扭矩降为 34 号保持扭矩(20 = 20%) |
以上参数都在 EEPROM 区(2.2),写入需先解锁 55 锁标志。
要点:
- 温度、电压、电流三类要两个条件串起来才动作:19 卸载条件 对应位置 1(使能该项)+ 实测值越过 13~15 或 28 号阈值 → 该项动作(卸载输出);19 对应位为 0 时该项不动作。
- 过载是另一套链路:负载超过 36 过载扭矩 并持续 35 保护时间 后,输出扭矩降为 34 保持扭矩;是否同时卸载输出,由 19 的 BIT5(负载过载位)决定。
- 65 舵机状态 反映的是检测层:越过阈值对应位就置 1,与 19 号开关无关;20 LED报警条件 是另一条独立通道,20 号报警与 19 号卸载互不替代。
- 19 的 BIT1(磁编码保护)没有对应阈值寄存器:传感器本身报错即触发,不靠 13~15、28 号设值。
- 13~15、28 号是阈值不是开关:单个写 0 不等于关闭该项保护。
验证:先确认 19 对应位已置 1,再人为越阈(或制造堵转),读 65 相应位变 1、输出按保护动作;解除后回 0。
4.7 读状态排错¶
目标:舵机行为异常时,用只读寄存器定位问题。
涉及寄存器:56 当前位置、58 当前速度、60 当前负载、62 当前电压、63 当前温度、65 舵机状态、66 移动标志、67 目标位置、69 当前电流,全部只读,随意读不影响舵机。
排查顺序:
- 读 65 舵机状态:非 0 时按 3.2 舵机状态 位定义对位(1=电压、2=磁编码、4=温度、8=电流、32=负载)。
- 读 62 当前电压 / 63 当前温度:确认供电电压与内部温度是否正常,对照 13~15 号设定的门槛。
- 读 69 当前电流:乘 6.5 mA,看是否接近 28 保护电流 的门槛(本表未标注方向位)。
- 读 60 当前负载:读到的值先屏蔽 BIT10(方向位)再按 0~1000 换算,持续接近 100% 说明堵转或扭矩不足。
- 读 56 / 67 / 66:对比当前位置与目标位置、看移动标志,确认指令是否被执行;56 与 58 都要先屏蔽 BIT15 方向位。
- 总线本身:多机不通时先确认 A/B 未反接、主控与舵机同档波特率,再用 7 应答返回延时 错开应答时隙。