跳转至

磁编码 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控制

地址DEC 地址HEX 功能名称 字节数 初始值 权限 取值范围 单位 说明
40 0x28 扭矩开关 1 0 读写 0~2 无 写0:关闭扭力输出;写1:打开扭力输出;写2:阻尼输出
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 目标电流 2 保护电流(28) 读写 -2047~2047 6.5mA 除模式3外其它模式可修改此值来控制电机最大运行电流的输出;恒流模式(模式2)BIT15为电流方向位;模式3下该寄存器表示PWM占空比(写入 0~1000,反向再置 BIT10 为1,单位0.1%)
46 0x2E 运行速度 2 舵机出厂默认最大速度 读写 -32767~32767 0.732RPM 控制电机最高运行速度,0表示停止运行;恒速模式(1),BIT15为速度方向位
48 0x30 转矩限制 2 最大扭矩(16) 读写 0~1000 0.1% 用户可程序修改此值来控制堵转扭矩的输出
50 0x32 Kp 1 位置环P 比例系数(21)/速度闭环P比例系数(37) 读写 0~254 无 位置伺服模式:控制电机位置环的比例系数(1/8);电机恒速模式:控制电机速度环的比例系数
51 0x33 Kd 1 位置环D 微分系数(22) 读写 0~254 无 位置伺服模式:控制电机位置环的微分系数(1/4);电机恒速模式:无效
52 0x34 Ki 1 速度闭环I积分系数(39) 读写 0~254 无 位置伺服模式:无效;电机恒速模式:控制电机速度环的积分系数
53 0x35 无定义 1 – 读写 – –
54 0x36 无定义 1 – 读写 – –
55 0x37 锁标志 1 1 读写 0~1 无 写0关闭写入锁,写入EEPROM地址的值掉电保存;写1打开写入锁,写入EEPROM地址的值掉电不保存

2.4 SRAM反馈

地址DEC 地址HEX 功能名称 字节数 初始值 权限 取值范围 单位 说明
56 0x38 当前位置 2 – 只读 – 0.0879° 反馈舵机当前绝对位置,BIT15为方向位
58 0x3A 当前速度 2 – 只读 – 0.732RPM 反馈当前电机转动的速度,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 只读 – 无 BIT0:舵机在运动时标志为1(大于移动速度阈值),舵机停止时为0;BIT1:舵机在运动时标志为1,舵机到达目标并且停止时为0,舵机无更新目标位置保持为0;阈值为出厂标定参数,见2.5节80号地址,以本型号资料为准
67 0x43 目标位置 2 – 只读 – 0.0879° 当前目标位置
69 0x45 当前电流 2 – 只读 – 6.5mA 反馈当前电机相电流,BIT15为电流方向位
71 0x47 无定义 2 – 只读 – –
73 0x49 电流偏置 2 – 只读 – – 电流0点偏移值
75~76 0x4B~0x4C 无定义 2 – 只读 – – 保留

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,可两套地址并用。

涉及寄存器:5 主ID、7 副ID、55 锁标志。

坑:

  • 总线上只有这一只舵机时才能直接写;多机请逐个单独上电修改。
  • 用广播地址写会让总线上所有舵机一起变更。
  • 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)。

涉及寄存器: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、范围 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 表示正在运动且尚未到位。

源码定义