一种反飞行器测试系统转台步进电机的控制方法与流程

摘要: 本发明涉及电机控制与测试设备,具体为一种反飞行器测试系统转台步进电机的控制方法。背景技术:1、随着低空飞行器应用场景不断扩展,对飞行器进行探测、识别、跟踪及干扰...
一种反飞行器测试系统转台步进电机的控制方法与流程

本发明涉及电机控制与测试设备,具体为一种反飞行器测试系统转台步进电机的控制方法。

背景技术:

1、随着低空飞行器应用场景不断扩展,对飞行器进行探测、识别、跟踪及干扰的相关设备逐渐增多,相应设备在投入使用前通常需要通过反飞行器测试系统进行性能测试与评估。反飞行器测试系统可通过改变被测设备的位置及被测设备与测试设备之间的角度,模拟不同方位角和俯仰角下的测试场景。转台作为承载被测设备并调节其姿态的执行机构,其定位精度、运动平稳性及安全性会直接影响测试结果的准确性和可重复性。

2、现有反飞行器测试系统所采用的转台一般具有俯仰和方位两个运动维度,并采用步进电机驱动对应运动轴。转台控制器接收上位机下发的目标俯仰角和目标方位角,并通过向步进电机输出方向信号和脉冲信号,控制被测设备转动至相应姿态。部分转台还在运动边界处设置限位开关,或者设置编码器等位置检测器件,以对转台的运动范围和实际位置进行检测。

3、现有反飞行器测试系统中的转台通常采用步进电机驱动俯仰轴和方位轴运动。转台控制器接收上位机下发的目标角度后,根据步进电机的步距角及细分驱动参数输出控制脉冲,使俯仰轴和方位轴运动至对应目标位置。由于转台不同轴的机械结构、承载重量及受力状态存在差异,各轴能够采用的最大角速度和最大角加速度通常并不相同。

4、现有转台在上电后,其运动边界多采用预先写入控制器的固定参数或者通过人工标定获得。受机械装配误差、零部件磨损及维护调整等因素影响,预设边界可能与转台实际机械边界不一致。当预设范围大于实际机械范围时,转台存在触碰机械结构或者损坏驱动机构的风险;当预设范围小于实际机械范围时,又会造成转台可用运动空间未被充分利用。

5、在步进电机加减速控制方面,现有控制方法通常采用恒定加速度、线性调频或者梯形速度曲线。此类控制方式在启动、加速、减速或者停止的阶段切换位置容易出现角加速度突变。特别是在转台负载较大或者运行速度较高的情况下,角加速度突变容易引起机械振动、定位过冲或者步进电机失步,进而降低转台的运动平稳性和定位精度。对于运动量较小的角度指令,若仍按照完整加速、匀速和减速过程进行控制,还可能出现运动行程不足以完成预设加减速过程的问题。

6、在双轴运动控制方面,现有俯仰轴和方位轴通常根据各自的运动量及电机参数独立运行。由于两个轴的负载特性、最大角速度、最大角加速度和目标运动量不同,即使两个轴同时接收到运动指令,其完成运动所需的时间也可能不同。仅采用相同运行速度或者按照运动量比例分配速度,难以同时考虑各轴加速段、匀速段和减速段所占用的时间及角度行程,因而难以保证俯仰轴和方位轴同步到达各自的目标位置。

7、此外,现有转台的限位保护通常主要依赖安装于机械边界处的限位开关。只有在转台已经运动至限位开关所在位置后才能触发保护,缺少基于实际机械边界的预防性软件限位措施。当限位开关响应延迟或者发生故障时,仍可能产生机械碰撞。同时,步进电机通常采用开环控制,控制器只能根据输出脉冲推算转台位置,不能及时发现负载变化、机械阻滞或者高速运行引起的失步;失步误差持续累积后,会导致转台实际位置与指令位置之间产生较大偏差。

8、因此,有必要提供一种反飞行器测试系统转台步进电机的控制方法,以实现转台机械边界的自动学习、步进电机的平滑加减速、俯仰轴与方位轴的协同运动、软件限位与硬件限位的双重保护以及基于位置反馈的失步检测和处理,从而提高转台的定位精度、运动平稳性和运行安全性。

技术实现思路

1、基于以上所述现有技术的缺点,本发明的目的是提供一种反飞行器测试系统转台步进电机的控制方法,以解决上述技术问题。

2、为实现上述目的,本发明提供如下技术方案:一种反飞行器测试系统转台步进电机的控制方法,包括:

3、s1、上电自检与边界学习:转台控制器上电后,依次控制转台的俯仰轴和方位轴进行遍历运动,通过对应轴两侧的限位开关确定该轴的正向机械边界和反向机械边界,根据正向机械边界和反向机械边界确定该轴的初始位置,根据正向机械边界、反向机械边界和预设安全余量构建对应轴的可用工作空间模型;

4、s2、动态加减速控制:对俯仰轴和方位轴建立改良s曲线加减速控制模型,改良s曲线加减速控制模型以角速度、角加速度和加加速度为运动学量,根据角速度变化量选择包括加加速段、匀加速段和减加速段的三段式加减速过程,或省略匀加速段的两段式加减速过程;在运动执行过程中,按照预设控制周期更新对应轴的角加速度、角速度和角度行程,将角速度转换为步进电机的目标脉冲频率;

5、s3、双轴协同运动规划:接收上位机下发的目标俯仰角和目标方位角,根据各轴的目标位置与当前位置之差确定各轴的运动方向和运动量;对每个轴,根据该轴的运动量与预先确定的特征运动量之间的关系,从四类运动曲线中选择对应的运动曲线,计算该轴按照所选择运动曲线运行时的最短运动时间;以两个轴的最短运动时间中的较大者作为协同运动总时间,将最短运动时间等于协同运动总时间的轴确定为主导轴;对于最短运动时间小于协同运动总时间的非主导轴,在保持该非主导轴运动量不变的条件下降低其峰值角速度,重新计算各运动段的持续时间和角度行程,至该非主导轴的运动时间与协同运动总时间一致,使俯仰轴和方位轴同步到达各自的目标位置;

6、s4、双重限位保护:在运动过程中实时监测各轴的位置,当任一轴的当前位置与其机械边界之间的距离小于预设安全余量时,触发软件限位并降低该轴的步进电机脉冲频率或停止该轴运动;当任一轴的限位开关被触发时,触发硬件限位,立即停止该轴的步进电机脉冲输出,在预设延时后控制该轴向远离被触发限位开关的方向运动预设回退距离后停止。

7、本发明进一步设置为,上电自检与边界学习包括:

8、控制俯仰轴沿预设初始方向以预设探测速度运动,当俯仰轴一侧的限位开关被触发时,记录对应位置作为俯仰轴在该侧的机械边界,停止俯仰轴的步进电机脉冲输出,在预设延时后控制俯仰轴反向运动;当俯仰轴另一侧的限位开关被触发时,记录对应位置作为俯仰轴在另一侧的机械边界并停止俯仰轴运动;

9、按照与俯仰轴相同的边界探测方式,对方位轴进行边界探测,确定方位轴的正向机械边界和反向机械边界;

10、分别确定各轴的正向机械边界与反向机械边界之间的机械中位,将机械中位作为对应轴的初始位置,控制对应轴返回初始位置,将各轴的正向机械边界和反向机械边界分别向内收缩预设安全余量,形成可用工作空间模型。

11、本发明进一步设置为,三段式加减速过程和两段式加减速过程的选择包括:

12、当所需角速度变化量不小于角加速度以最大加加速度由零变化至最大角加速度并由最大角加速度变化至零所对应的角速度变化量时,采用三段式加减速过程,其中,加加速段用于使角加速度由零平滑变化至最大角加速度,匀加速段用于使角加速度保持不变,减加速段用于使角加速度由最大角加速度平滑变化至零;

13、当所需角速度变化量小于角速度变化量时,省略匀加速段,采用两段式加减速过程,使实际达到的最大角加速度小于预设最大角加速度;

14、在加速过程和减速过程中,加加速度的方向相反,且每一加减速过程开始时和结束时的角加速度均为零。

15、本发明进一步设置为,在每个控制周期内,根据当前所处的加减速阶段确定当前加加速度,根据当前加加速度和上一控制周期的角加速度更新当前角加速度,根据更新后的当前角加速度和上一控制周期的角速度更新当前角速度,根据相邻控制周期的角速度更新累计角度行程;根据步进电机每转细分脉冲数确定每个控制脉冲所对应的轴角位移,将当前角速度换算为目标脉冲频率,通过脉冲发生器输出具有目标脉冲频率的步进电机控制脉冲。

16、本发明进一步设置为,运动量为对应轴的目标位置与当前位置之差的绝对量,根据最大角速度、中速角速度和最低角速度确定第一分界运动量、第二分界运动量和第三分界运动量,其中:

17、第一分界运动量由从零角速度加速至最大角速度、从最大角速度减速至中速角速度以及从中速角速度减速至最低角速度的角度行程共同确定;

18、第二分界运动量由从零角速度加速至中速角速度以及从中速角速度减速至最低角速度的角度行程共同确定;

19、第三分界运动量由从零角速度加速至最低角速度以及从最低角速度减速至零角速度的角度行程共同确定;

20、当轴的运动量不小于第一分界运动量时,采用第一类运动曲线,使该轴依次从零角速度加速至最大角速度、以最大角速度运行、从最大角速度减速至中速角速度以及从中速角速度减速至最低角速度,最大角速度运行阶段的角度行程根据该轴的运动量与其余各段角度行程之差确定;

21、当轴的运动量不小于第二分界运动量且小于第一分界运动量时,采用第二类运动曲线,使该轴从零角速度加速至峰值角速度、从峰值角速度减速至中速角速度并继续减速至最低角速度,峰值角速度不低于中速角速度且低于最大角速度;

22、当轴的运动量不小于第三分界运动量且小于第二分界运动量时,采用第三类运动曲线,使该轴从零角速度加速至峰值角速度后直接减速至最低角速度,峰值角速度高于最低角速度且低于中速角速度;

23、当轴的运动量大于零且小于第三分界运动量时,采用第四类运动曲线,使该轴从零角速度加速至峰值角速度后对称减速至零角速度,峰值角速度低于最低角速度;

24、第二类运动曲线、第三类运动曲线和第四类运动曲线的峰值角速度均通过迭代求解确定,使相应运动曲线中各运动段的角度行程之和等于对应轴的运动量;当轴的运动量为零时,不向该轴输出运动脉冲;在第一类运动曲线、第二类运动曲线和第三类运动曲线中,对应轴以最低角速度到达目标位置后终止本次运动的脉冲输出。

25、本发明进一步设置为,计算俯仰轴和方位轴按照对应运动曲线运行时的最短运动时间,将较大的最短运动时间确定为协同运动总时间,将最短运动时间等于协同运动总时间的轴确定为主导轴;

26、对于采用第一类运动曲线且最短运动时间小于协同运动总时间的非主导轴,以高于中速角速度并且不高于原峰值角速度的候选峰值角速度为待求参数,重新计算从零角速度加速至候选峰值角速度的加速段、从候选峰值角速度减速至中速角速度的第一减速段以及从中速角速度减速至最低角速度的第二减速段的持续时间和角度行程;

27、在保持非主导轴的运动量不变并保证剩余运动量不小于零的条件下,将扣除加速段、第一减速段和第二减速段的角度行程后的剩余运动量分配给以候选峰值角速度运行的匀速段;

28、通过二分迭代调整候选峰值角速度,直至非主导轴的总运动时间与协同运动总时间之差不超过一个控制周期,控制俯仰轴和方位轴同步开始运动、同步到达各自的目标位置。

29、本发明进一步设置为,将各轴的当前位置与上电自检与边界学习过程中确定的正向机械边界和反向机械边界实时比较,当当前位置与任一机械边界之间的距离小于预设安全余量时,触发软件限位,将对应轴的步进电机脉冲频率降低至预设低速脉冲频率,使对应轴低速运动或者停止;

30、当任一限位开关被触发时,触发硬件限位,立即停止对应轴的步进电机脉冲输出,在保持停止状态经过预设延时后,控制对应轴向远离被触发限位开关的方向运动预设回退距离,在完成回退后停止。

31、本发明进一步设置为,还包括防失步闭环控制:

32、在步进电机运行过程中,通过位置反馈传感器实时获取各轴的实际位置,将实际位置与当前控制周期对应的指令位置进行比较,获得位置误差的绝对量,根据实际位置与指令位置的相对关系确定补偿方向;

33、当位置误差小于预设失步阈值时,继续正常执行当前运动指令;

34、当位置误差不小于预设失步阈值且小于预设严重失步阈值时,在当前运动周期结束后,按照补偿方向追加补偿脉冲,补偿脉冲数量根据位置误差以及步进电机在当前细分驱动条件下的单脉冲等效轴角位移确定,在补偿完成后继续执行后续运动指令;

35、当位置误差不小于预设严重失步阈值时,停止当前运动指令,重新执行上电自检与边界学习,对转台位置进行重新校准,在重新校准后向上位机发送失步告警信息,由上位机确定是否继续执行测试。

36、本发明进一步设置为,俯仰轴和方位轴分别采用根据各自负载特性设定的最大角速度和最大角加速度,两个轴采用相同的最大加加速度和控制周期;各轴的中速角速度根据对应轴的最大角速度按预设比例设定,并高于最低角速度且低于最大角速度;两个轴采用相同的最低角速度,最低角速度与步进电机的启动频率相对应;预设安全余量根据机械边界及软件限位所需的保护距离确定,预设回退距离根据限位开关的释放距离确定;预设失步阈值和预设严重失步阈值根据位置反馈传感器的分辨率及转台定位精度要求确定,且预设严重失步阈值大于预设失步阈值。

37、本发明进一步设置为,转台用于控制被测设备的位置以及被测设备与测试设备之间的角度,被测设备包括飞行器探测设备、飞行器干扰设备或者飞行器识别设备中的至少一种。

38、本发明提供一种反飞行器测试系统转台步进电机的控制方法,通过转台控制器上电后,依次探测俯仰轴和方位轴的正向机械边界与反向机械边界,确定各轴初始位置,并结合预设安全余量构建可用工作空间模型;建立以角速度、角加速度和加加速度为运动学量的改良s曲线加减速控制模型,根据角速度变化量选择三段式或两段式加减速过程,按照预设控制周期更新运动学量并转换得到目标脉冲频率;根据各轴运动量选择对应的四类运动曲线,计算各轴最短运动时间并确定协同运动总时间,在保持运动量不变的条件下调整非主导轴的峰值角速度,使两轴同步到达目标位置;运动过程中采用软件限位和硬件限位进行双重保护,在接近机械边界时减速或停止,并在限位开关触发后停止脉冲输出及执行安全回退,产生的有益效果包括:

39、1、通过俯仰轴和方位轴的遍历运动自动确定各轴的正向机械边界和反向机械边界,并结合预设安全余量构建可用工作空间模型,能够减少人工标定误差,适应机械装配偏差及使用磨损,提高工作空间模型与实际机械边界的一致性;

40、2、采用以角速度、角加速度和加加速度为运动学量的改良s曲线加减速控制模型,并根据角速度变化量选择三段式或两段式加减速过程,使角加速度在各运动阶段之间平滑变化,降低步进电机启动、加速、减速及停止过程中的机械冲击、振动和失步风险,提高转台运动的平稳性;

41、3、根据各轴运动量与特征运动量之间的关系选择对应的四类运动曲线,使不同大小的运动量均具有相应的运动规划方式;同时,在保持非主导轴运动量不变的条件下调整其峰值角速度,使俯仰轴和方位轴同步到达各自的目标位置,提高双轴协同运动的同步性及测试姿态控制的准确性;

42、4、采用软件限位与硬件限位相结合的双重限位保护方式,在转台接近机械边界时主动降低脉冲频率或者停止运动,并在限位开关触发后立即停止脉冲输出及执行安全回退,从而降低转台与机械边界发生碰撞的风险,提高转台运行的安全性和可靠性;

43、5、通过位置反馈传感器比较各轴的实际位置与指令位置,根据位置误差进行正常运行、补偿脉冲追加或者重新校准处理,能够及时检测并处理步进电机失步,防止位置误差持续累积,提高转台的定位精度和长期运行稳定性。

44、上述说明仅是本技术技术方案的概述,为了能够更清楚了解本技术的技术手段,而可依照说明书的内容予以实施,并且为了让本技术的上述和其它目的、特征和优点能够更明显易懂,以下特举本技术的具体实施方式。