跳转至

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

适用于 STS 半双工 TTL 系列串行舵机。双字节字段按低字节在前传输。

SMS 系列(RS485)地址定义与本表存在差异,见SMS 内存表。

1 舵机通信协议

舵机使用FT-SCS自定义协议,出厂时的串口默认配置,STS舵机默认波特率为1M使用TTL单总线通信,数据位 8,无校验,停止位 1;波特率可配置范围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 0 读写 0~7 无 0-7分别代表波特率:1000000(0),500000(1),250000(2),128000(3),115200(4),76800(5),57600(6),38400(7)
7 0x07 预留地址 1 – 读写 – –
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控制

地址DEC 地址HEX 功能名称 字节数 初始值 权限 取值范围 单位 说明
40 0x28 扭矩开关 1 0 读写 0~2 无 写0:关闭扭力输出;写1:打开扭力输出;写2:阻尼输出(转矩限制(48)可控制阻尼力大小);写128:任意当前位置校正为2048
41 0x29 加速度 1 0 读写 0~254 8.79°/秒² 舵机运行加/减速度,0表示最大加速度
42 0x2A 目标位置 2 0 读写 -32767~32767 0.0879° 绝对位置控制方式,最大对应最大有效角度,BIT15为方向位;±32767 为概念范围,实际写入 = 幅值(0~32767),反向再置 BIT15 为1
44 0x2C PWM开环速度 2 1000 读写 -1000~1000 0.1% PWM开环调速度模式下生效,为PWM占空比;写入 = 幅值(0~1000),反向再置 BIT10 为1
46 0x2E 运行速度 2 舵机出厂默认最大速度 读写 -32767~32767 0.732RPM/0.0146RPM 控制电机最高运行速度,BIT15为方向位;速度0默认表示最高速度,可通过相位设置0表示停止;速度单位可通过相位设置,0.732RPM/0.0146RPM两种单位(由相位BIT2决定),0.0146RPM 是把 0.732RPM 这一物理步长在指令层细分为 50 档,物理分辨率仍为 0.732RPM
48 0x30 转矩限制 2 最大扭矩(16),默认1000 读写 0~1000 0.1% 用户可程序修改此值来控制堵转扭矩的输出
50~54 0x32~0x36 无定义 5 – 读写 – –
55 0x37 锁标志 1 1 读写 0~1 无 写0关闭写入锁,写入EEPROM地址的值掉电保存;写1打开写入锁,写入EEPROM地址的值掉电不保存

2.4 SRAM反馈

地址DEC 地址HEX 功能名称 字节数 初始值 权限 取值范围 单位 说明
56 0x38 当前位置 2 – 只读 – 0.0879° 反馈舵机当前绝对位置,BIT15为方向位;步进模式3返回当前位置与目标位置的步进差值,BIT15为方向位
58 0x3A 当前速度 2 – 只读 – 0.732RPM/0.0146RPM 反馈当前电机转动的速度,速度单位根据相位设置,BIT15为方向位
60 0x3C 当前负载 2 – 只读 – 0.1% 当前控制输出驱动电机的电压占空比,BIT10为方向位
62 0x3E 当前电压 1 – 只读 – 0.1V 当前舵机工作电压
63 0x3F 当前温度 1 – 只读 – ℃ 当前舵机内部工作温度
64 0x40 异步写标志 1 0 只读 – 无 采用异步写指令时,标志位:异步写指令(0x04,单播或广播)受理即置 1,执行指令(0x05)受理即清 0;普通直写(0x03)不改变该标志;RAM 位,断电清零。
65 0x41 舵机状态 1 0 只读 – 无 对应位被置1表示相应错误出现
66 0x42 移动标志 1 0 只读 – 无 舵机在运动时标志为1,舵机到达目标并且停止时为0;舵机无更新目标位置保持为0
67 0x43 目标位置 2 0 只读 – 0.0879° 当前目标位置
69 0x45 当前电流 2 – 只读 – 6.5mA 反馈当前电机相电流,BIT15为电流方向位
71 0x47 无定义 2 – 只读 – –

2.5 出厂参数

地址DEC 地址HEX 功能名称 字节数 初始值 权限 取值范围 单位 说明
80 0x50 移动速度阈值 1 – 只读 – –
81 0x51 DTs(ms) 1 – 只读 – –
82 0x52 速度单位系数 1 – 只读 – –
83 0x53 最小速度限制 1 – 只读 – – 单位0.732rpm(随相位 BIT2 切换)
84 0x54 最大速度限制 1 – 只读 – – 单位0.732rpm(随相位 BIT2 切换)
85 0x55 加速度限制 1 – 只读 – –
86 0x56 加速度倍数 1 – 只读 – – 加速度为0时加速度倍数生效,加速度倍数与加速度同时为0表示舵机响应速度最快

3 特殊字节解释

3.1 舵机相位

位数/位权重:说明

  • BIT0(1):驱动方向相位;(0)正向,(1)反向
  • BIT1(2):STSBL舵机此位置1;STSCL舵机此位无效
  • BIT2(4):速度单位,(0)0.732RPM,(1)0.0146RPM
  • BIT3(8):速度模式,(0)速度0表示停止,(1)速度0表示最高速度
  • BIT4(16):角度反馈模式,(0)反馈单圈角度,(1)反馈全角度
  • BIT5(32):驱动桥配置,(0)独立H桥,(1)集成H桥/无电流反馈
  • 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;

不要跨系列套用地址

其他系列即使使用相同地址,含义也可能不同(例如 SMS 系列地址 7 为应答返回延时,本表为预留地址)。请返回通信协议选择正确的内存表。

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 号为只读,读取不改变舵机状态。
  • 本系列位置类寄存器以「最小分辨角度」计数:默认(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(阻尼输出)与 128(把当前位置校正为 2048,见 4.2),首次试转用 1 即可。
  • 直接发 42 目标位置 时,40 扭矩开关 会自动置 1,所以步骤 4 可以跳过。

验证:运动中 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 锁标志。

步骤:

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

注意:

  • 出厂默认 9 号 = 0、11 号 = 4095,即整圈范围。
  • 9 号与 11 号同时为 0 会进入多圈绝对位置控制模式,不再受单圈范围约束,属进阶用法;恢复普通模式需重新写入两个限制值。
  • 行程限制只约束目标位置指令,外力仍可能把输出轴推到边界外。

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

4.4 改 ID

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

涉及寄存器:5 舵机ID、55 锁标志。

坑:

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

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

验证:用新 ID 发 PING(或读 5)应有应答,旧 ID 不再应答。广播改法见FT-SCS 自定义协议。

4.5 改波特率

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

涉及寄存器:6 波特率、55 锁标志。

坑:

  • 写入的是档位号 0~7,不是波特率数值(0=1000000、1=500000、2=250000……完整对照见 2.2 表 6 号行)。
  • 写入成功后当前连接立即失联:舵机当场改用新档位通信,旧波特率上不再应答,要用新波特率重新连接(串口助手改波特率并重开端口,主控重新初始化串口)才能继续发指令,回锁也一样;写错档位只能逐档重试或恢复出厂默认。
  • 主控与总线上所有舵机必须同一档,混档总线不通。

步骤:解锁流程见 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 当前电流:屏蔽 BIT15(电流方向位)后乘 6.5 mA,看是否接近 28 保护电流 的门槛。
  • 读 60 当前负载:读到的值先屏蔽 BIT10(方向位)再按 0~1000 换算,持续接近 100% 说明堵转或扭矩不足。
  • 读 56 / 67 / 66:对比当前位置与目标位置、看移动标志,确认指令是否被执行;56 与 58 都要先屏蔽 BIT15 方向位。

源码定义