机器人直线关节测试系统高精度协同控制方法及系统与流程

摘要: 本发明属于智能制造与高端机器人核心部件测试,更具体地,涉及一种机器人直线关节测试系统高精度协同控制方法及系统。背景技术:1、在智能制造与高端机器人装备快速发展的...
机器人直线关节测试系统高精度协同控制方法及系统与流程

本发明属于智能制造与高端机器人核心部件测试,更具体地,涉及一种机器人直线关节测试系统高精度协同控制方法及系统。

背景技术:

1、在智能制造与高端机器人装备快速发展的背景下,直线关节作为机器人实现直线运动的核心传动部件,其定位精度、重复定位精度、动态响应、刚性及负载特性等关键性能,直接决定了机器人的运动精度、速度与稳定性。因此,对直线关节进行全面的指标测试是研发与质量管控的关键环节。然而,当前主流的测试方法依赖于针对单一指标的独立测试台和定制化程序,导致测试流程碎片化、效率低下,且难以复现真实的多轴协同工作场景,已成为提升关节品质与研发效率的瓶颈。

2、目前,高精度运动控制测试系统的技术核心普遍在于分布式网络,典型系统由上位机、运动控制器、工业通讯网络及多伺服驱动器构成。工作时,上位机分别下达对测试系统不同子单元的指令,由子单元内的控制器编码指令形成运动轨迹并立即运行,以此协调各轴实现启停与轨迹跟踪,从而完成复杂的协同运动。此类现有技术在理想的同构系统中能够实现极高的同步控制精度。

3、然而,上述现有技术的局限性亦十分显著。首先,系统集成度低,测试不同指标常需切换不同硬件与软件,操作繁琐,无法实现一站式综合测试。其次,系统高度依赖特定的高性能实时网络,rs485等传统协议的高时延低速特性对信号同步的不利影响、以及当同意测试平台采用不同通讯协议的子设备时难以统筹进行协同控制,造成指令下发混叠。总体来说,现有技术在理想的同构系统中能够实现极高的同步控制精度。但是在复杂的多指标高精度测试流程中,现有方法还缺乏能够通过高度集成化的操作界面、底层统一的时钟同步算法以及对多元通讯协议的广泛兼容的手段,难以满足对机器人直线关节性能高效、精准、完整的评估需求。

技术实现思路

1、针对现有技术的以上缺陷或改进需求,本发明提供一种机器人直线关节测试系统高精度协同控制方法及系统,能够将复杂的多指标测试流程简化为“一键式”操作,极大提升了测试效率与易用性;同时确保了不同品牌驱动器及测试设备间的高精度同步运动,为性能评估提供了严格一致且可靠的测试条件。该方案打破了设备与协议的壁垒,显著增强了测试平台的通用性和适用范围,实现了对机器人直线关节性能全面、精准且高效的评估。

2、为了实现上述目的,按照本发明的带一方面,提供一种机器人直线关节测试系统高精度协同控制方法,包括:

3、s100:获取上位机设定的测试工况参数,由plc对所述测试工况参数进行解析,生成针对被测直线关节与陪测测试设备的控制环选择指令;

4、s200:根据所述控制环选择指令,在所述plc的寄存器中匹配对应的控制环配置参数并下发至被测驱动器与陪测驱动器,以使各驱动器分别执行指令编码,实现控制模式映射与执行信号预备;

5、s300:在所述被测驱动器与所述陪测驱动器完成初始化后,通过时钟同步给定初始时间戳以触发测试开始,并在测试运行过程中,按预设的时间间隔执行时钟同步,校准各驱动器节点间的时钟偏差;

6、s400:实时判别当前时刻是否满足同步执行条件或终止条件:若满足同步执行条件且未达成终止条件,则读取各驱动器编码器状态,并跳转至步骤s300继续执行时钟同步及测试运行;若达成终止条件,则进入步骤s500;

7、s500:响应于所述终止条件,执行时钟同步s300以控制所述被测直线关节与所述陪测测试设备同步停止,并将全测试周期的控制步信号进行解码与汇总。

8、进一步地,步骤s300包括:

9、s301:驱动器在接收到编码指令后,首先执行init动作,包括硬件电路自检、通讯链路链路握手及驱动层参数加载;

10、s303:系统引入多级时钟同步机制,首先执行时钟同步建立系统基准时间戳,随后进入测试运行状态;

11、s303:在测试过程中,系统并非开环运行,而是每隔预设的微秒级时间间隔执行时钟同步,用于实时校准被测与陪测节点间的时钟漂移,确保测试指令在全过程内实现微秒级的协同下发。

12、进一步地,步骤s300中,所述时钟同步包括如下步骤:

13、s600:从节点发送同步请求报文sync;

14、s700:主节点发送虚拟延时报文delay_req;

15、s800:从节点发送延时应答报文delay_resp。

16、进一步地,在分布式网络系统中,各节点的本地时钟是通过自身携带的晶振中断计数计算,在t时刻,节点的本地时钟为:

17、

18、其中,是传感器节点的标称频率,为初始时刻,是传感器的实际频率,是初始时刻传感器节点的时钟值;

19、节点,的本地时钟存在如下关系:

20、

21、其中,为节点,的相对频率偏移,为节点,的初始相位差。

22、进一步地,步骤s600包括:

23、s601:在时刻,从节点向主节点发送sync信号,该sync信号意味着主节点接收到从节点的同步请求,并记录主节点接收信号的时间;

24、s602:主节点采用two-step两步法模式,即时刻,从节点将会在后续的follow_up报文中传输给主节点。此时,主节点拥有了,2个已知的时刻信息,完成了同步的第一阶段。

25、进一步地,步骤s700包括:主节点靠定时发送,虚拟一个延时,在时刻向从节点发送delay_req报文,用于测算网络传输延时,且该报文于时刻到达从节点;

26、步骤s800包括:

27、s801:当步骤s700中的delay_req报文到达后,从节点通过延时回答报文delay_resp,将时刻发送给从设备;

28、s802:对主节点此时拥有的,,,4个时刻信息,进行时钟同步计算;

29、s803:求解时间偏移offset,从而修正从节点的本地时钟,实现主从节点的微秒级时钟同步。由于主节点和从节点之间存在时钟不同步,因此对于从节点而言的时刻与对于主节点而言的时刻存在着一个时间偏移量offset,这一量在仿真测试中是假设量;而信息在主节点和从节点之间传输时,会造成路径延时delay,基于,,,的4个时间戳,可以通过下式联立计算这两个量:

30、。

31、进一步地,步骤s200包括:

32、s201:plc根据s100生成的指令,在内部寄存器中进行逻辑判断,从预设的参数库中选择并调用对应的控制环配置映射表;

33、s202:将选定的配置参数通过工业通讯总线实时传输至被测电机驱动器与陪测驱动器;

34、s203:驱动器侧执行指令编码,通过switch逻辑完成从plc寄存器值到驱动器pwm控制信号的协议转换与模式映射,实现上位机指令到硬件执行层的打通。

35、进一步地,步骤s400包括:

36、s401:同步判别:系统周期性检查当前运行时间是否达到预设的执行阈值,若到达间隔,则强制执行:读取被陪测编码器的实时位置/状态信息,再次触发时钟同步,随后进入continue指令继续测试;

37、s402:终止判别:在每个控制步结束时,系统执行信号解码,将编码器或传感器的反馈信号还原为物理量,并判别是否满足预设的测试终止条件;

38、若满足条件,转入s500;

39、若不满足,则通过反馈回路返回s300执行continue,继续维持步骤s200的同步高精度测试。

40、进一步地,步骤s500包括:

41、s501:当满足终止条件时,执行时钟同步s300,该步骤的物理意义在于确保被测设备与陪测设备在停止时刻的物理运动保持完全相位一致,防止异步停止产生机械冲击;

42、s502:停止后,系统执行end指令,并将整个测试周期内存储在缓存中的控制步信号进行全量解码;

43、s503:最终执行信号汇总与数据处理,将处理后的高精度测试数据上传至上位机,完成测试报告的自动生成。

44、按照本发明的另一个方面,提供一种机器人直线关节测试系统高精度协同控制系统,用于实现所述的机器人直线关节测试系统高精度协同控制方法,包括:

45、参数获取模块,用于获取上位机设定的测试工况参数,由plc对所述测试工况参数进行解析,生成针对被测直线关节与陪测测试设备的控制环选择指令;

46、模式映射模块,用于根据所述控制环选择指令,在所述plc的寄存器中匹配对应的控制环配置参数并下发至被测驱动器与陪测驱动器,以使各驱动器分别执行指令编码,实现控制模式映射与执行信号预备;

47、时钟同步模块,用于在所述被测驱动器与所述陪测驱动器完成初始化后,通过时钟同步给定初始时间戳以触发测试开始,并在测试运行过程中,按预设的时间间隔执行时钟同步,校准各驱动器节点间的时钟偏差;

48、条件判别模块,用于实时判别当前时刻是否满足同步执行条件或终止条件:若满足同步执行条件且未达成终止条件,则读取各驱动器编码器状态,并跳转继续执行时钟同步及测试运行;若达成终止条件则进入下一步;

49、终止模块,用于响应于所述终止条件,执行时钟同步以控制所述被测直线关节与所述陪测测试设备同步停止,并将全测试周期的控制步信号进行解码与汇总。

50、总体而言,通过本发明所构思的以上技术方案与现有技术相比,能够取得下列有益效果:

51、1.本发明突破了传统测试系统软硬件解耦过度导致的交互冗余,通过在plc层构建统一的工况解析与控制环映射引擎,实现了从上位机高层抽象工况到驱动器底层执行信号的原子化流转。该架构消除了异构设备间繁琐的逻辑适配过程。用户侧的“一键式”操作底层是由系统自动完成的协议转换、参数对齐与模式映射支撑的。这不仅大幅提升了测试任务的周转效率,更从根源上规避了人工多界面切换配置产生的参数非一致性风险,确保了复杂测试工况的易用性与鲁棒性。

52、2.本发明提出了一种基于底层统一时钟同步算法的测试方法,通过在控制中枢(plc)与执行末端(驱动器)之间建立通用的同步语义层,实现了对主流工业通讯协议的透明化兼容,该方法打破了物理层通讯协议对测试平台的束缚。系统不再依赖特定的总线协议来实现同步,而是通过算法层面的时间戳补偿机制,使同一测试平台能够无差别地接入并精确控制具有不同通讯接口的关节样品。这种“软定义”的测试平台极大地扩展了测试系统的通用性,显著降低了异构设备集成过程中的开发成本与维护复杂度。

53、3.针对异构设备混合组网中普遍存在的“通讯抖动”与“响应异构”问题,本发明创新性地引入了基于延时响应机制的多级时钟同步模块,微秒级动态确定性:通过强制执行与判别机制,系统能够在运行过程中实时感知并修正不同品牌驱动器间的处理延时差异,确保指令下发的空间相位差在全量程内处于微秒级受控状态,解决了高速运动下被测/陪测设备因停机响应不一致导致的机械惯性冲击或原始数据对齐失效问题。这一闭环同步体系为高精度性能评估(如动态跟随误差、刚度解析等)提供了物理层面的绝对一致性基准,确保了测试数据的严谨性与复现性。