超精密运动平台伺服模式切换方法与流程

摘要: 本发明涉及超精密运动平台伺服模式切换方法,属于半导体制造设备。背景技术:1、在超精密运动平台的实际工业应用中,为适应复杂多变的设备工艺需求,系统通常需要在运行过...
超精密运动平台伺服模式切换方法与流程

本发明涉及超精密运动平台伺服模式切换方法,属于半导体制造设备。

背景技术:

1、在超精密运动平台的实际工业应用中,为适应复杂多变的设备工艺需求,系统通常需要在运行过程中动态切换至不同的伺服模式。在切换过程中,位置环与速度环的反馈传感器、控制算法、控制器参数及环路增益等均需进行相应调整。目前,业界普遍采用变更位置环与速度环反馈源的方式来实现伺服模式的切换。例如,在伺服模式1下,速度与位置环均引入传感器a作为反馈源;在伺服模式2下,速度环维持传感器a,而位置环切换为传感器b;在伺服模式3下,则双环均切换为传感器b。然而,这种基于变更环路反馈源的模式切换机制在实际应用中暴露出以下显著的技术缺陷:

2、第一,由于传感器a与传感器b对应着相互独立的空间坐标系,在伺服模式切换时,系统不可避免地会丢失原有的回零标志。这迫使系统必须重新寻找位置传感器的index信号以执行回零操作。该机制不仅对传感器的设计与安装精度提出了极为苛刻的要求,且受限于设计及安装公差,两套坐标系之间必然存在物理偏置,且每台设备的偏置值均存在细微差异。这导致设备配置参数的标定与维护工作变得异常繁琐且极易出错。

3、第二,在伺服模式切换过程中,系统通常会丢失电机的寻相标志,进而被迫执行重新寻相操作。这一寻相过程会对运动平台产生不可忽视的机械冲击,且受限于物理条件,寻相成功率难以达到100%,这不仅严重影响了设备运行的稳定性,还大幅降低了设备的整体生产效率。

4、第三,为满足多模式切换需求,系统需配置复杂的硬件接线与信号路由。这不仅显著增加了现场安装与布线的工作量,还导致系统后期的维护与故障排查极其困难,整体架构的容错率较差,难以满足现代高端装备对高可靠性与灵活性的要求。

技术实现思路

1、为了解决上述问题,本发明提供了超精密运动平台伺服模式切换方法,所述技术方案如下:

2、步骤1:系统初始化,加载默认伺服模式的配置参数及预定义的反馈源路由矩阵;

3、步骤2:建立初始坐标系,通过单一定位参考源进行回零操作,并将所有传感器的测量计数器同步清零,以统一坐标系原点;

4、步骤3:接收并解析伺服模式切换指令,判断目标模式与当前模式是否相同,若不同则进入切换程序;

5、步骤4:根据所述目标模式的反馈源设置更新所述反馈源路由矩阵,在一个伺服控制周期内,通过双缓冲机制同步更新矩阵配置,以切换反馈源,同时保持电流环的反馈源不变;

6、步骤5:若目标模式的反馈源包含非所述单一定位参考源的传感器,则对所述非所述单一定位参考源的传感器的测量值进行坐标系旋转补偿,将其映射到所述单一定位参考源的坐标系中;

7、步骤6:解除环路冻结,以斜坡方式恢复闭环控制,完成模式切换。

8、可选的,所述电流环的反馈源被固定为某一传感器或通过无传感器初始相位辨识技术获得。

9、可选的,所述单一定位参考源为某一传感器的物理index信号或基于绝对式传感器的虚拟零点值。

10、可选的,所述反馈源路由矩阵的设计方式为:对于具有n个自由度、m个传感器的超精密平台,矩阵大小设置为3n×m,行依次对应每个轴的位置环、速度环、电流环,列对应传感器编号。

11、可选的,所述步骤4中,通过双缓冲机制同步更新矩阵配置的具体过程为:

12、在与当前运行矩阵隔离的后台缓冲区,写入目标模式对应的完整路由配置;

13、在后台缓冲区配置完成后,于下一个控制周期中断的固定时刻,通过原子指针交换操作激活新的路由矩阵。

14、可选的,所述步骤5中,对所述非所述单一定位参考源的传感器的测量值进行坐标系旋转补偿的方法包括:

15、在设备调试阶段,通过离线标定获取所述非所述单一定位参考源的传感器的坐标系相对于所述单一定位参考源的坐标系的旋转角;

16、在伺服模式切换后,实时读取所述旋转角,并对所述非所述单一定位参考源的传感器的原始测量矢量进行旋转变换,将其映射到所述单一定位参考源的坐标系中。

17、可选的,所述旋转变换的补偿公式为:

18、

19、

20、其中,表示旋转角,表示非所述单一定位参考源的传感器的原始测量矢量。

21、第二方面,本发明提供一种超精密运动平台伺服模式切换系统,用于实现如上任一项所述的方法,所述系统包括:

22、初始化模块,用于加载默认伺服模式的配置参数及预定义的反馈源路由矩阵;

23、坐标系建立模块,用于通过单一定位参考源进行回零操作,并将所有传感器的测量计数器同步清零,以统一坐标系原点;

24、指令解析模块,用于接收并解析伺服模式切换指令,判断目标模式与当前模式是否相同;

25、路由更新模块,用于根据所述目标模式的反馈源设置更新所述反馈源路由矩阵,在一个伺服控制周期内,通过双缓冲机制同步更新矩阵配置,以切换反馈源,同时保持电流环的反馈源不变;

26、坐标补偿模块,用于在目标模式的反馈源包含非所述单一定位参考源的传感器时,对所述非所述单一定位参考源的传感器的测量值进行坐标系旋转补偿,将其映射到所述单一定位参考源的坐标系中;

27、闭环恢复模块,用于解除环路冻结,以斜坡方式恢复闭环控制,完成模式切换。

28、第三方面,本发明提供一种电子设备,包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现如上任一项所述超精密运动平台伺服模式切换方法的步骤。

29、第四方面,本发明提供一种计算机可读存储介质,其上存储有计算机程序,其特征在于:所述计算机程序被处理器执行时,实现如上任一项所述超精密运动平台伺服模式切换方法的步骤。

30、本发明有益效果是:

31、第一,本发明彻底消除坐标系平移偏置,实现真正的坐标系统一。

32、现有技术中,每个传感器各自具有独立的index,导致两套坐标系原点不一致,切换模式后必然引入平移偏置,且每台设备的偏置值均不相同,维护复杂。

33、本发明强制规定所有伺服模式的回零均只使用某一传感器的index信号或者虚拟绝对零点值,回零时不仅将位置反馈强制置零,还主动清零所有可能被用作反馈的传感器的测量计数器,使得在唯一物理零点处,任意传感器的输出都是从零开始。此机制从物理和逻辑两个层面保证了坐标系原点绝对唯一,平移偏置被根本消除。切换模式时无需在线估计或人工设定任何偏置值,设备参数统一且免维护。

34、第二,本发明切换过程零冲击,平台稳定性与生产效率显著提升。

35、现有技术在伺服模式切换时,因传感器反馈源改变常需重新寻相,寻相过程中的电流冲击会影响平台精度,且寻相存在一定的失败概率,导致工艺中断和设备停机。

36、本发明通过路由矩阵将寻相(电流环)反馈源在所有模式下硬性固定为某一传感器,并设置“相位有效”硬件标志。初次上电寻相成功后,相位信息全生命周期内保持不变,任何模式切换均跳过寻相程序。由于电机换相时序完全连续,切换过程中速度环和位置环仅经历一次平滑的输出斜坡恢复,平台无任何冲击。寻相失败的概率降至零,大幅提高了设备的长期运行稳定性和单位时间产能。

37、第三,本发明硬件配置极度简化,安装、布线及维护成本大幅降低。

38、现有技术因需要在不同模式间切换传感器反馈源及index信号,控制器必须同时接入所有传感器的全部信号(含多路index),导致接口数量增加、线缆繁多、布线复杂、容错率差。

39、本发明明确其他传感器的index信号不需要接入控制器,硬件只需连接其他传感器的增量测量信号即可。所有反馈信号的路由选择、旋转补偿、index旁路等均由软件定义的矩阵和算法实现,无需任何外部硬件切换电路或跳线。这使得电柜内接线端子减少、线缆束简化,安装和后期维护的工作量明显下降,同时降低了因接插件接触不良或接线错误导致的故障率。

40、第四,本发明坐标系旋转补偿方法简洁可靠,兼容多种运动配置。

41、针对传感器安装角度差异,本发明采用预标定旋转角并实时旋转变换的方法,将传感器b的测量值精确映射到传感器a的坐标系。该标定仅需在出厂时进行一次,利用最小二乘等方法即可高精度辨识旋转参数。补偿计算量小(仅需乘加运算),可直接在伺服周期内完成。该方法不仅适用于二维运动平台,对于单轴平台可简化为投影系数,对于三维平台可扩展至三维旋转矩阵,适应性强且精度完全满足超精密运动要求。

42、综上所述,本发明通过单一定位参考源与坐标系旋转补偿机制相互配合,前者从原点层面消除了平移偏置,后者从轴向层面消除了角度偏差,两者结合确保了多传感器在统一数学模型下的无缝融合,为模式切换提供了精确的几何基准;在此基础上,本发明进一步引入电流环反馈源固定与软件定义路由矩阵机制,通过锁定相位基准保证了动力输出的连续性,通过原子化的信号切换保证了控制指令的实时重构。本发明在无需增加复杂硬件成本的前提下,实现了超精密运动平台在复杂工艺伺服模式切换下的全生命周期平滑运行。