磁编码 HLS 舵机 - 内存表解析¶
适用于 HLS 半双工 TTL 系列串行舵机。双字节字段按低字节在前传输。
1 舵机通信协议¶
舵机使用FT-SCS自定义协议,出厂时的串口默认配置,波特率默认为1Mbps,数据位 8,无校验,停止位 1;波特率可配置范围38400~1Mbps,默认通信地址(站号)为 1。
完整协议帧格式与指令集见FT-SCS 自定义协议。
2 舵机内存表定义¶
如果功能地址采用两个字节的数据,低位字节在前地址,高位字节在后地址
注意:
- 部分参数的初始值与取值范围因型号而异(表中以 – 表示),以本型号出厂资料为准。
- 表中「最小分辨角度」指编码器能分辨的最小角度:本系列把一整圈 360° 分为 4096 份,每份 = 360° ÷ 4096 ≈ 0.0879°,也就是单位列里写的那个值;位置、角度限制等寄存器都以它为计数单位,以本型号资料为准。
2.1 版本信息¶
| 地址DEC | 地址HEX | 功能名称 | 字节数 | 初始值 | 权限 | 取值范围 | 单位 | 说明 |
|---|---|---|---|---|---|---|---|---|
| 0 | 0x00 | 固件主版本号 | 1 | 3 | 只读 | |||
| 1 | 0x01 | 固件次版本号 | 1 | – | 只读 | 40 ~ 59 | ||
| 2 | 0x02 | END | 1 | 0 | 只读 | 0表示小端存储结构 | ||
| 3 | 0x03 | 舵机主版本号 | 1 | 10 | 只读 | |||
| 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 | 副ID | 1 | 0 | 读写 | 0~253 | 号 | 副ID标识(第二标识),副ID适用于写指令、异步写指令(0x04)、执行异步写指令(0x05)与同步写指令;对主ID写入会同步修改副ID的参数 |
| 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 | 980 | 读写 | 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 | 无 | 上电赋值给50号地址Kp |
| 22 | 0x16 | 位置环D 微分系数 | 1 | – | 读写 | 0~254 | 无 | 上电赋值给51号地址Kd |
| 23 | 0x17 | 位置环I 积分系数 | 1 | 0 | 读写 | 0~254 | 无 | 上电赋值给52号地址Ki |
| 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 | – | 读写 | 0~2047 | 6.5mA | 上电赋值给44号地址目标电流 |
| 30 | 0x1E | 角度分辨率 | 1 | 1 | 读写 | 1~128 | 无 | 对传感器最小分辨角度的放大系数:设为 K 时一个计数 = K × 0.0879°,满量程 0~4095 对应 K 圈;K 越大圈数越多,步距越粗 |
| 31 | 0x1F | 位置偏移 | 2 | 0 | 读写 | -4095~4095 | 0.0879° | BIT15表示正负方向,其他位可表示范围为0-4095 |
| 33 | 0x21 | 运行模式 | 1 | 0 | 读写 | 0~3 | 无 | 0:位置伺服模式(位置+限流);1:电机恒速模式(恒速+限流);2:电机恒流模式(限流,速度不可控);3:PWM开环调速度模式 |
| 34 | 0x22 | 电流环P 比例系数 | 1 | – | 读写 | 无 | ||
| 35 | 0x23 | 电流环I 积分系数 | 1 | – | 读写 | 无 | ||
| 36 | 0x24 | 无定义 | 1 | – | 读写 | – | – | – |
| 37 | 0x25 | 速度闭环P比例系数 | 1 | – | 读写 | 0~254 | 无 | 电机恒速模式(模式1)下,速度环比例系数 |
| 38 | 0x26 | 过流保护时间 | 1 | 200 | 读写 | 0~254 | 10ms | |
| 39 | 0x27 | 速度闭环I积分系数 | 1 | – | 读写 | 0~254 | 无 | 电机恒速模式(模式1)下,速度环积分系数 |
2.3 SRAM控制¶
2.4 SRAM反馈¶
2.5 出厂参数¶
| 地址DEC | 地址HEX | 功能名称 | 字节数 | 初始值 | 权限 | 取值范围 | 单位 | 说明 |
|---|---|---|---|---|---|---|---|---|
| 77 | 0x4D | vFk(*10) | 1 | – | 只读 | – | – | – |
| 78 | 0x4E | vKgI | 1 | – | 只读 | – | – | – |
| 79 | 0x4F | pFk(*10) | 1 | – | 只读 | – | – | – |
| 80 | 0x50 | 移动速度阈值 | 1 | – | 只读 | – | – | – |
| 81 | 0x51 | DTs(ms) | 1 | – | 只读 | – | – | – |
| 82 | 0x52 | eFk(*10) | 1 | – | 只读 | – | – | – |
| 83 | 0x53 | Vk(ms) | 1 | – | 只读 | – | – | – |
| 84 | 0x54 | 最大速度限制 | 1 | – | 只读 | – | – | – |
| 85 | 0x55 | 加速度限制 | 1 | – | 只读 | – | – | – |
| 86 | 0x56 | 加速度倍数 | 1 | – | 只读 | – | – | – |
3 特殊字节解释¶
3.1 舵机相位¶
位数/位权重:说明
- BIT0(1):伺服相位(固件版本<=3.41),磁编码支持(0:AS5600,1:MT6701,固件版本>=3.44)
- BIT1(2):电流反馈方向相位;(0)正向,(1)反向
- BIT2(4):驱动桥方向相位;(0)正向,(1)反向
- BIT3(8):速度方向相位(固件版本<=3.41)
- BIT4(16):角度反馈模式;(0)反馈单圈角度,(1)反馈全角度
- BIT5(32):驱动桥配置,(0)独立H桥,(1)集成H桥
- BIT6(64):PWM频率,(0)24kHz,(1)16kHz
- BIT7(128):位置反馈方向相位,(0)正向,(1)反向
提示
如果同时设置多个位,舵机的相位值为各个位值之和。例如:原相位值为0,舵机运行反向,则相位值为128+4+2=134;
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报警条件¶
报警条件:0表示关闭,1表示开启
位数/位权重:说明
- BIT0(1):电压报警
- BIT1(2):磁编码报警
- BIT2(4):过热报警
- BIT3(8):过流报警
- BIT4(16):-----
- BIT5(32):-----
- BIT6(64):-----
- BIT7(128):-----
提示
如果同时设置多个位,舵机的报警条件值为各位值之和。例如:电压报警与过热报警同时开启,则报警条件值为4+1=5;
不要跨系列套用地址
其他系列即使使用相同地址,含义也可能不同(例如 SMS 系列地址 44–45 为 PWM 开环速度,而非本表的目标电流)。请返回通信协议选择正确的内存表。
4 常见使用场景¶
连接成功后,舵机的日常操作都可以归结为对若干寄存器的读写。本节按场景汇总常见用法;指令帧怎么发不在本节范围,见FT-SCS 自定义协议。文中编号均指本表地址。
4.0 使用前必读¶
- EEPROM 区(2.2,5~39 号):修改前需将40 扭矩开关写 0 关闭扭矩输出,再把55 锁标志写 0,改完写回 1。实测使能状态下写入仍受理、当次生效,掉电后不保存(锁标志为 0 也一样),改完再按需重新使能。
- SRAM 区(2.3,40~55 号):直接写、立即生效,断电丢失,适合试验性写入;55 锁标志 本身也在这一区,写它不需要解锁。
- 2.4 的 56~76 号与 2.5 的 77~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 号 = 980) |
| 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,需先解锁并关使能,见 4.0)。
- 46 运行速度 的单位固定为 0.732 RPM(本表没有第二档细单位),写 0 表示停止运行,不是「最高速度」;BIT15 为速度方向位,只在恒速模式(33 运行模式 = 1)下起作用。
- 40 扭矩开关 只有 0、1、2 三个值(2 为阻尼输出),本系列没有 128 那档中位校准,校零走协议指令 0x0B,见 4.2。
- 直接发 42 目标位置 时,40 扭矩开关 会自动置 1,所以步骤 4 可以跳过。
验证:运动中 66 移动标志 的 BIT0 与 BIT1 均为 1,到位停止后回 0;再读 56 当前位置(屏蔽 BIT15)应等于目标幅值(被行程限制钳制时则为边界值)。
4.2 中位校准¶
目标:让目标位置 2048 对应舵盘装正时的姿态。磁编码零点固定在出厂轴向上,装舵盘常有偏差,靠这一步把零点摆正。
涉及寄存器:无——本系列走协议的位置校准指令(0x0B),不写寄存器;校准结果由固件自动计算并写入 31 位置偏移。
步骤:
- 先把输出轴手动转到舵盘装正时的姿态(可拆下舵盘,校正后再装回)。
- 发位置校准指令:不带参数 = 把此刻位置校为中位(2048);带 2 字节参数(低字节在前)= 校为设定值,例如
00 04表示校成 1024。
注意:
- 位置校准指令要求固件 ≥ 3.43;40 扭矩开关 只接受 0、1、2 三个值。
- 校正时输出轴应空载、静止;每执行一次都会把「当时的位置」改成设定值,重复执行会累积偏移。
- 校正后 0~4095 的零点整体平移:之前记录的位置读数作废。行程限制若还是出厂默认 0 / 4095(整圈),平移后仍是整圈,不用重设;设过自定义范围的,9 最小角度限制 / 11 最大角度限制 的数值现在指向平移后的物理角度,要按新零点重设(见 4.3)。
- 断电重启后重读 56 当前位置 复核标定是否保持;31 位置偏移 由固件在校准时算好并写入(属 EEPROM),掉电保存,不用手动改。
验证:写完读 56 当前位置 应为 2048(或指令里给的设定值);再把 42 目标位置 写成同一值,输出轴应纹丝不动。
4.3 设置行程范围¶
目标:限制输出轴的转动范围。
涉及寄存器:9 最小角度限制、11 最大角度限制,单位为最小分辨角度(0.0879°);两者属 EEPROM 区,写入需先解锁 55 锁标志。
步骤:
- 把想要的边界换算成格(角度 ÷ 0.0879°,换算方法见 4.1「按角度转」)。
- 写 9 与 11,9 号必须小于 11 号;写前先关 40 扭矩开关、把 55 锁标志 写 0 解锁(原因见 4.0),写完置 1 回锁。
注意:
- 出厂默认 9 号 = 0、11 号 = 4095,即整圈范围。
- 9 号与 11 号同时为 0 会进入多圈绝对位置控制模式,不再受单圈范围约束,属进阶用法;恢复普通模式需重新写入两个限制值。
- 行程限制只约束目标位置指令,外力仍可能把输出轴推到边界外。
验证:先把 11 最大角度限制 设成 2048(属 EEPROM,同样要先解锁),再把 42 目标位置 写成 3000,输出轴应停在 2048 格处,不再继续前进。
4.4 改 ID¶
目标:修改舵机的总线地址,多机组网前必做。本系列除主 ID 外还有副 ID,可两套地址并用。
坑:
- 总线上只有这一只舵机时才能直接写;多机请逐个单独上电修改。
- 用广播地址写会让总线上所有舵机一起变更。
- ID 范围 0~253,同一总线不要重复;主 ID 与副 ID 也不要撞号。
- 写入成功后舵机当场改用新 ID 应答,旧 ID 上不再有应答;后面的回锁、PING 都要把指令里的 ID 字节换成新 ID(串口不用重开),用旧 ID 发只会超时。
- 副 ID 只适用于写指令、异步写(0x04)、执行异步写(0x05)与同步写指令,读指令与 PING 不在其列,仍按主 ID 应答。
- 表内注明「对主 ID 写入会同步修改副 ID 的参数」,改完主 ID 记得回读 7 复核副 ID。
步骤:确认总线上只有这一只舵机 → 写 55 = 0 → 写 5 = 新 ID(需要时再写 7 = 副 ID)→ 用新 ID 写 55 = 1。
验证:用新 ID 发 PING(或读 5)应有应答,旧 ID 不再应答;再读 7 复核副 ID 是否符合预期。广播改法见FT-SCS 自定义协议。
4.5 改波特率¶
目标:更改通讯波特率,与主控匹配。出厂默认 1 Mbps(档位 0)。
坑:
- 写入的是档位号 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、范围 0~2047;38 单位 10 ms(默认 200 = 2 秒) |
| 限流 | 44 目标电流 | 除模式 3 外各模式的电流上限,SRAM 实时生效;上电时由 28 号赋值 |
| 是否卸载输出 | 19 卸载条件 | 按位使能电压、磁编码、过热、过流四项,位定义见 3.3 卸载条件 |
| 是否闪灯 | 20 LED报警条件 | 独立通道,型号带 LED 时才闪,位定义见 3.4 LED报警条件 |
以上阈值与开关都在 EEPROM 区(2.2)与 SRAM 区(2.3),改 EEPROM 项需先解锁 55 锁标志。
要点:
- 温度、电压、电流三类都要两个条件串起来才动作:19 卸载条件 对应位置 1(使能该项)+ 实测值越过 13~15 或 28 号阈值 → 该项动作(卸载输出);19 对应位为 0 时该项不动作。
- 过载保护靠限流实现:28 / 44 定电流上限,38 定过流保护时间。
- 28 保护电流 属 EEPROM,上电时赋值给 44 目标电流:要让新电流上限立即生效改 44(SRAM),要掉电保存改 28;28 号写 0 等于上电把 44 置 0,电机将不出力。
- 65 舵机状态 反映的是检测层:越过阈值对应位就置 1,与 19 号开关无关;20 LED报警条件 是另一条独立通道,20 号报警与 19 号卸载互不替代。
- 19 的 BIT1(磁编码保护)没有对应阈值寄存器:传感器本身报错即触发。
- 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=电流;BIT4 及以上本系列未定义)。
- 读 62 当前电压 / 63 当前温度:确认供电电压与内部温度是否正常,对照 13~15 号设定的门槛。
- 读 69 当前电流:屏蔽 BIT15(电流方向位)后乘 6.5 mA,看是否接近 28 保护电流 的门槛。
- 读 60 当前负载:读到的值先屏蔽 BIT10(方向位)再按 0~1000 换算,持续接近 100% 说明堵转或扭矩不足。
- 读 56 / 67 / 66:对比当前位置与目标位置,确认指令是否被执行;56 与 58 都要先屏蔽 BIT15 方向位;66 的 BIT0 表示速度已超过移动速度阈值、BIT1 表示正在运动且尚未到位。