1. 安全事项
为确保用户安全正确使用本产品,避免对人员造成伤害,特制定安全事项。在使用本产品前,请务必认真阅读以下安全事项:
(1)本产品的适用性请由系统设计者或规格制定者来判断。 本产品的使用条件具有多样化,请由系统的设计者或规格的制定者来判断系统的适用性。必要时请通过分析和测试进行判断。 请在参考最新的产品资料、确认规格的全部内容、考虑到可能发生的故障,在此基础上构建系统。
(2)请具有充分知识和经验的人员使用本产品。 在此所述产品若误操作会损害其安全性。 机械装置的组装、操作、维修保养等作业请由具有充分知识和经验的人执行。
(3)请务必在确认机械、设备的安全之后,再进行产品的使用和拆卸。
请在确认已进行了移动体的落下防止对策和失控防止对策之后再进行机械、设备的使用和维护。
请在确认已采取上述安全措施,并切断了能量源和设备电源以保证系统安全 的同时,确认和理解设备上产品个别注意事项的基础上,进行产品的拆卸。
重新启动机械、设备时,请对意外动作、误操作采取预防措施。
(4)在如下所示条件和环境下使用时,请在考虑安全对策的同时,提前向我司咨询。
明确记载的规格以外的条件或环境。
使用于原子能、铁路、航空、宇宙设备、船舶、军用、医疗设备、食品用设备、燃料装置、安全设备等场合,以及用于非产品手册中的标准规格的场合。
预测对人身和财产有重大影响,特别是在有安全要求的场合使用时。
用于互锁回路时,请设置应对故障的机械式保护功能,进行双重互锁。另外 进行定期检查以确认是否正常作动。
2. 总体介绍
随着机器人市场规模的不断扩大,各行业对机器人关节的需求量也随之增长,促使企业开发更通用、高性能的关节产品,以满足市场的多样化需求,降低生产成本,提高市场竞争力。
国内一些友商的关节产品已广泛运用于工业机器人、协作机器人,满足使用场景需求,强调产品的负载能力和可靠性。公司已有成熟的协作机器人用关节,也已开发了人形机器人的关节。综合已有的技术储备,开发尺寸小、重量轻、质量优、成本低的通用型关节紧紧围绕为客户解决问题,提供价值角度出发,打造属于自己的产品领域和蓝海。
3. 产品基本信息
3.1. FM-11-B基本信息
参数类型 |
参数分解 |
产品类型 |
FM-11-B |
产品重量/g |
420 |
尺寸/mm |
φ52*68.5 |
减速比 |
100 |
额定扭矩/N.m |
3.7 |
平均负载扭矩/N.m |
6.2 |
最大扭矩/N.m |
17.5 |
额定转速/RPM |
30 |
重复定位精度/” |
±15 |
中控孔径/mm |
10 |
工作温度/℃ |
0~45℃ |
额定功率/W |
31 |
额定电压/V |
48 |
抱闸 |
支持 |
通讯接口 |
EtherCAT |
3.2. FM-14-B基本信息
参数类型 |
参数分解 |
型号 |
FM-14-B |
产品重量/g |
730 |
尺寸/mm |
φ70*83.6 |
减速比 |
100 |
额定扭矩/N.m |
9 |
平均负载扭矩/N.m |
13 |
最大扭矩/N.m |
63 |
额定转速/RPM |
30 |
重复定位精度/” |
±15 |
中控孔径/mm |
12 |
工作温度/℃ |
0~45℃ |
额定功率/W |
100 |
额定电压/V |
48 |
抱闸 |
支持 |
通讯接口 |
EtherCAT |
3.3. FM-17-B基本信息
参数类型 |
参数分解 |
型号 |
FM-17-B |
产品重量/g |
1054 |
尺寸/mm |
φ80*97.4 |
减速比 |
120 |
额定扭矩/N.m |
24 |
平均负载扭矩/N.m |
39 |
最大扭矩/N.m |
86 |
额定转速/RPM |
25 |
重复定位精度/” |
±15 |
中控孔径/mm |
12 |
工作温度/℃ |
0~45℃ |
额定功率/W |
200 |
额定电压/V |
48 |
抱闸 |
支持 |
通讯接口 |
EtherCAT |
4. 产品外形尺寸及安装孔位
4.1. FM-11-B外形尺寸及安装孔位
图表 4-1 FM-11-B外形尺寸及安装孔位
4.2. FM-14-B外形尺寸及安装孔位
图表 4-2 FM-14-B外形尺寸及安装孔位
4.3. FM-17-B外形尺寸及安装孔位
图表 4-2 FM-17-B外形尺寸及安装孔位
5. 安装事项
在安装之前,请认真阅读通用关节相关安全说明(1.1安全事项)。在固定好产品前,请勿提前打开电源。
5.1. 使用条件
通用关节的操作及运输、存储条件为:
操作环境温度: 0℃~+45℃;
操作环境湿度: 20%~90% RH(40°C)(无霜无结露);
运输及储存温度: -20℃ ~ +60℃(无霜无结露);
警告
通用关节须远离振动及冲击环境,环境不含灰尘、烟尘或水,不含腐蚀性气体、液体或爆炸性气体, 没有强大的电磁干扰源。
5.2. 电气接口
各通用关节的电气接口示意:
(1)FM-11-B关节电气接口图:
图表 5-1 FM-11-B关节电气接口图
(2)FM-14/17-B关节电气接口图:
图表 5-2 FM-14/17-B关节电气接口图
5.3. 线缆连接
电源及调试线束插头型号:
(1)电源线束
图表 5-3-1 电源线束
(2)网线线束
图表 5-3-2 网线线束
(3)调试线束
调试线束为法奥专供线束,可按需购买
图表 5-3-3 调试线束
6. 调整参数
6.1. 基本设置
图表 6-1 基本参数功能描述表
6.2. 通讯参数
图表 6-2 通信参数功能描述表
图表 6-3 通讯接口功能描述表
图表 6-4 波特率功能描述表
6.3. 电机参数
电机参数项:总长度60个元素,元素类型为S32,当前有效数据为2-21个元素,有效元素均可读写。
图表 6-5 电机参数功能描述表
图表 6-6 编码器类型功能描述表
6.4. 驱动参数
监控参数项:总长度60个元素,元素类型为S32,当前有效数据为2-11个元素,有效元素均可读写。
图表 6-7 驱动参数功能描述表
6.5. 监控参数
监控参数项:总长度60个元素,元素类型为S32,当前有效数据为2-8个元素,有效元素只支持读取,不支持写入。故障码具体说明详见报警代码表。
图表 6-8 监控参数功能描述表
6.6. 调整参数
调整参数项:总长度60个元素,元素类型为S32,当前有效数据为2-32个元素,有效元素均可读写。
图表 6-9 调整参数功能描述表
6.7. 运动控制
运动控制参数项:总长度60个元素,元素类型为S32,当前有效数据为0-27个元素,有效元素均可读写。
3-电机正转方向:0-CCW方向运行,1-CW方向运行。
16-内部速度指令速度1:PV模式有效,PV模式速度指令。
图表 6-10 运动控制功能描述表
6.8. 保护参数
保护参数项:总长度60个元素,元素类型为S32,当前有效数据为2-19个元素,有效元素均可读写。
15-故障复位参数:置位对可复位故障和警告,执行故障复位功能;
图表 6-11 保护参数功能描述表
6.9. 辅助功能
辅助参数项:总长度60个元素,元素类型为S32,当前有效数据为2-30个元素,有效元素均可读写。
14-能耗电阻制动电压:默认参数51000Mv,最大能耗制动电压为70000Mv。
11~13电磁刹车电压:默认参数24000Mv,最大支持刹车电压为48000Mv
图表 6-12 辅助参数功能描述表
6.10. 限制参数
限制参数项:总长度60个元素,元素类型为S32,当前有效数据为2-16个元素,有效元素均可读写。
13-电机正向位置范围参数:多圈编码器有效,该参数为多圈编码器的正向运动范围;例如多圈编码器为0~65535,正向范围建议设置为32767,约为多圈编码分辨率/2。
默认关闭不启用支持360°旋转功能,若需要启用需配置13~15参数,并将16支持360°旋转参数设置为1。
若电机正向位置范围参数大于单圈编码器分辨率,正向运动范围为(多圈编码器分辨率*单圈编码器分辨率=编码器总分辨率)/2。
图表 6-13 限制参数功能描述表
6.11. 输出输出1
输入输出1参数项:总长度60个元素,元素类型为S32,当前有效数据为0-12个元素。 3-低四位输入端子参数:置位-电机使能;复位-电机去使能。(需要将通讯参数中通讯接口设定为0(调试485)后才可通过设置全参数生效使能与去使能)
图表 6-14 输入输出1参数功能描述表
6.12. 输出输出2
输入输出2参数项:总长度60个元素,元素类型为S32,当前有效数据为2-18个元素。
图表 6-15 输入输出2参数功能描述表
6.13. 自适应PID刚度0
自适应PID刚度0参数项:总长度60个元素,元素类型为S32,当前有效数据为2-30个元素。
需搭配闭环PID模式参数项使用,进行自适应PID和前馈控制模式切换。
图表 6-16 自适应PID刚度0 参数功能描述表
6.14. 自适应PID刚度1
自适应PID刚度1参数项:总长度60个元素,元素类型为S32,当前有效数据为2-30个元素。
需搭配闭环PID模式参数项使用,进行自适应PID和前馈控制模式切换。
图表 6-17 自适应PID刚度1 参数功能描述表
6.15. 自适应PID刚度2
自适应PID刚度2参数项:总长度60个元素,元素类型为S32,当前有效数据为2-30个元素。
需搭配闭环PID模式参数项使用,进行自适应PID和前馈控制模式切换。
图表 6-18 自适应PID刚度2 参数功能描述表
6.16. 闭环前馈控制
闭环前馈控制参数项:总长度60个元素,元素类型为S32,当前有效数据为2-30个元素。
需搭配闭环PID模式参数项使用,进行自适应PID和前馈控制模式切换。
图表 6-19 闭环前馈控制 参数功能描述表
6.17. 闭环PID模式
闭环控制模式参数项:总长度60个元素,元素类型为S32,当前有效数据为2-3个元素。
2-闭环控制模式:0:选择为闭环前馈控制,1:选择为自适应PID控制
3-自适应PID刚度,当闭环控制模式为PID自适应控制时,可进行刚度配置与控制。
图表 6-20 闭环PID模式 参数功能描述表
图表 6-21 闭环控制模式 参数功能描述表
图表 6-22 自适应PID刚度 参数功能描述表
7. 上位机调试软件DynamicLAB
7.1. 建立连接
在设备列表中选中要连接设备(驱动器);
选择正确COM口;
设置通信波特率(默认115200);
点击地址扫描可以自动扫描主线上存在的从站数量与地址;
点击连接与从站进行通信。
图表 7-1 设备列表与通信设置图
显示打开串口成功;
显示获取底层电机参数成功;
说明与驱动器建立连接成功。
图表 7-2 连接功能图示
7.2. 固件升级
485升级:
功能树选中固件升级;
选择升级方式(默认485升级);
打开要升级的固件文件(.bin)文件;
发送文件开始文件传输;
等待信息栏显示文件发送完成;
图表 7-3 固件升级图示
JLink升级:
功能树选中固件升级;
选择升级模式选择JLink升级(需安装JLink驱动,使用usb转JLink工具连接电脑与驱动器);
点击JLink连接,连接驱动器;
Flash擦除用于擦除驱动器中固件程序;
打开文件选择要升级固件程序(.hex格式文件);
点击发送文件进行固件升级。
7.3. 参数列表
图表 7-4 固件JLink升级图示
功能树选中参数列表;
参数根据功能分为各子参数;
对参数的加载(从文件加载)、保存(将参数保存为文件)、读取(从驱动器读取参数)、写入(将参数写入驱动器,在各子参数页读取、写入只读写当前子参数,在参数列表读取、写入读写全部参数)、写入FLASH(参数写入FLASH)、恢复出厂设置(将驱动器参数恢复出厂);
双击修改某个参数值(修改后需写入);
图表 7-5 参数列表图示
7.4. 全参数配置
选择功能树中的参数列表,点击加载。
图表 7-6 功能树参数列表
在DynamicLAB文件夹中选择对应的关节的全参数配置文件
图表 7-7 全参数配置文件
提示窗中提示“加载全参数完毕”点击“写入”,提示写入成功后,点击“写入Flash”写入Flash完成,重新断电上电,进行读取操作查看是否写入成功。
图表 7-8 写入Flash
7.5. 速度模式运行
在参数列表-通讯参数中,将通信接口切换为0(调试485接口),执行写入操作。
图表 7-9 切换为0写入操作
在参数列表-运动控制中,将控制模式切换为1(速度模式),执行写入操作。
图表 7-10 切换为1写入操作
在参数列表-输出输出1,将低四位输入端子强制ON控制字写入为1,执行写入操作。电机使能。
图表 7-11 控制字写入为1写入操作
在参数列表-运动控制,下发内部速度指令速度1,执行写入操作,电机开始按照设定速度运行。
图表 7-12 指令速度11写入操作
8. 通讯协议
8.1. EtherCAT通信
EtherCAT,全称 Ethernet for Control Automation Technology,由 Beckhoff Atuomation GmbH 开发,是一种实时以太网用于主站和从站开放式的网络通信。 EtherCAT 作为成熟的工业以太网技术,具备高性能、低成本、使用简易等特点。
图表 8-1 EtherCAT通讯规格表
备注
点击运行控制使用标准Cia402行规。
8.2. EtherCAT对象字典
8.2.1. PDO对象字典
PDO对象字典分为RxPDO和TxPDO两种。RxPDO为驱动器接收主站数据,TxPDO为驱动器向主站反馈数据。
8.2.2. RxPDO
控制字(Control Word)对象字典,可读可写(RW),其索引(Index)为0x6040,子索引(SubIndex)为0,数据类型为无符号16位,下面对控制字的每个bit信息进行说明。
图表 8-2 控制字对象字典详细信息
其中bit3-bit0(enable operation/quick stop/enable voltage/switch on)符合Cia402协议标准,如下图所示。
图表 8-2 Cia402
通过控制字可将关节使能和去使能。需要使能时,应将控制字按顺序(0x06->0x07->0x0F)进行赋值;需要去使能时,应将控制字直接赋值为0。
通过控制字可进行机器人零点校准,在关节去使能和处于非OP状态时,将控制字的bit13置1。
目标位置(Target Position)对象字典,可读可写(RW),其索引(Index)为0x607A,子索引(SubIndex)为0,数据类型为有符号32位。
图表 8-3 目标位置对象字典
通过此对象字典更新需要的目标位置,单位为pulse,上位机规划位置值,607Ah目标位置值两次的差值,需小于100000Pulse。
目标扭矩(Target Torque)对象字典,可读可写(RW),其索引(Index)为0x6071,子索引(SubIndex)为0,数据类型为有符号16位。
图表 8-4 目标扭矩对象字典
通过此对象字典更新需要的目标扭矩,单位为额定扭矩0.1%。
速度前馈(Velocity offset)对象字典,可读可写(RW),其索引(Index)为0x60B1,子索引(SubIndex)为0,数据类型为有符号32位。
图表 8-5 速度前馈对象字典
通过此对象字典设置合理的速度前馈。
剩余的RxPDO对象字典(0x2001、0x2010、0x2011、0x2012和0x2013)未进行实际使用,不进行赘述。
8.2.3. TxPDO
状态字(Status Word)对象字典,只读(RO),其索引(Index)为0x6041,子索引(SubIndex)为0,数据类型为无符号16位,下面对状态字的每个bit信息进行说明。
图表 8-6 状态字对象字典详细信息
首先根据bit6,5,3-0(switch on disabled/quick stop/fault/operation enabled/switched on/ready to switch on)的组合可以确定功率状态机的状态,下图为具体说明。
图表 8-7 功率状态机状态确认表
bit13(home):1的情况下表示已校零。
bit12(drag):1的情况下表示进入拖动模式。
bit5(quick stop):0的情况下表示功率状态机接收quick stop要求。
bit4(voltage enabled):1的情况下表示主电路电源电压加到主回路。
当前位置(Position Actual Value)对象字典,只读(RO),其索引(Index)为0x6064,子索引(SubIndex)为0,数据类型为有符号32位。
图表 8-8 当前位置对象字典
通过此对象字典获取关节当前的位置数据,单位为pulse。
故障码(Error Code)对象字典,只读(RO),其索引(Index)为0x603F,子索引(SubIndex)为0,数据类型为无符号16位。
图表 8-9 故障码对象字典
如果此对象字典不为0,则驱动器出现故障。
实时扭矩(Torque Actual Value)对象字典,只读(RO),其索引(Index)为0x6077,子索引(SubIndex)为0,数据类型为有符号16位。
图表 8-10 实时扭矩对象字典
通过此对象字典获取关节的实时扭矩数据,单位为额定扭矩0.1%。
实时速度(Velocity Actual Value)对象字典,只读(RO),其索引(Index)为0x606C,子索引(SubIndex)为0,数据类型为有符号32位。
图表 8-11 实时速度对象字典
通过此对象字典获取关节的实时速度数据,单位为rmp。
剩余TxPDO对象字典(0x2000、0x3010、0x3011、0x3012和0x3013)未实际使用,不进行赘述。
8.2.4. SDO
主站设置从站的SDO对象字典时,建议电机处于去使能状态,否则会导致异常警告;读取时不需要关心电机的状态。 1. 软件版本(Sofeware version)对象字典,只读(RO),其索引(Index)为0x100A,子索引(SubIndex)为0,数据类型为可见字符串。
图表 8-12 软件版本对象字典
在上电初始化时,驱动器固件会将固件版本号赋值给此对象字典,可通过此对象字典查看驱动器的当前固件版本号。
基本设定(sBaseSetPara)、通信参数(sCommPara)对象字典、驱动参数(sDrivePara)对象字典、监控参数(sDisplyPara)对象字典、调整参数(sAdjPara)对象字典、运动控制(sMtCtrlPara)对象字典、保护参数(sKeepPara)对象字典、辅助功能(sAuxPara)对象字典、限制参数(sLmtPara)对象字典、输入输出1(sIoPara1)对象字典、输入输出2(sIoPara2)对象字典、自适应PID刚度0~2对象字典、闭环前馈控制对象字典、闭环PID模式对象字典。详见附录2:Sdo读写驱动器全参数表-V0.4-20251208
全参数读取&修改通过各个对象字典的子索引1参数命令完成。以基本设定对象为例,修改参数:修改密码、驱动器型号等子索引内容后,参数命令写1,将参数全部写入驱动器RAM中,完成后驱动器将参数命令置0;参数命令写2,将参数全部写入驱动器Flash中,完成后驱动器将参数命令置0。读取参数:参数命令写2,驱动器将参数放入基本设定SDO对象字典,随后将参数命令置0。
图表 8-13 配置对象字典
9. 电机控制模式
9.1. 位置模式
位置模式下,上位控制器完成位置指令规划,然后将规划好的目标位置 607Ah 上以周期性同步的方式发送给伺服驱动器,位置、速度、转矩控制由伺服驱动器内部完成。
图表 8-14 位置运行模式图
9.2. 位置模式下配置图
图表 8-15 位置模式设置流程图
10. 使用寿命
FM-通用关节平均使用寿命50000h。
11. 附录
11.1. 附录1 报警代码表