一种闭环控制系统的监测装置、方法及闭环控制系统

摘要

本发明公开了一种闭环控制系统的监测装置、方法及闭环控制系统，该装置包括：采集模块，用于从控制机构采集执行机构的移动位移以及位移误差；第一判断模块，用于在设定的T时间段内，对比位移误差和第一设定值；第二判断模块，用于根据移动位移和位移误差计算得到执行机构的实际移动距离，并在T时间段内，对比实际移动距离和第二设定值；以及控制模块，用于在第一判断模块判定位移误差大于第一设定值，且第二判断模块判定实际移动距离大于第二设定值时，控制闭环控制系统关闭。通过本发明能够在闭环控制系统即将发生飞车现象时停止及其运转，避免机器损坏造成损失。

说明书

技术领域

本发明涉及自动控制领域，特别是涉及一种闭环控制系统的监测装置、方法及闭环控制系统。

背景技术

伺服单元的控制方式分为开环控制和闭环控制方式，开环控制系统主要用于对控制位置精度要求不高的场合，如果有一定的控制精度需求，则需要选择闭环控制系统。

但是闭环控制系统一旦发生反馈断线(比如电缆断裂、反馈线接触不良、调试时反馈线接错等情况)，闭环控制系统会发生飞车现象(高速失控)。目前为了达到安全可靠的目的，各个厂家为避免上述现象基本上采用安全限位开关、控制器位置监控等方法防止闭环控制系统出现飞车现象。上述方式的处理是建立在飞车现象真实发生以后，伺服电机及控制转轴从飞车时的高速到完全停止下来，需要较长的运动时间，在这段时间内往往会造成机器部件损坏，造成财产损失。

发明内容

本发明主要解决的技术问题是提供一种闭环控制系统的监测装置、方法及闭环控制系统，能够在闭环控制系统即将发生飞车现象时停止及其运转，避免机器损坏造成损失。

为解决上述技术问题，本发明采用的一个技术方案是：提供一种闭环控制系统的监测装置，闭环控制系统至少包括控制机构、伺服电机和执行机构，该装置包括：采集模块，用于从控制机构采集执行机构的移动位移以及位移误差；第一判断模块，用于在设定的T时间段内，对比位移误差和第一设定值；第二判断模块，用于根据移动位移和位移误差计算得到执行机构的实际移动距离，并在T时间段内，对比实际移动距离和第二设定值；控制模块，用于在第一判断模块判定位移误差大于第一设定值，且第二判断模块判定实际移动距离大于第二设定值时，控制闭环控制系统关闭；其中，第一设定值是影响闭环控制系统运转的最小位移误差值，第二设定值是控制机构设定的执行机构移动的位移值。

为解决上述技术问题，本发明采用的一个技术方案是：提供一种闭环控制系统，至少包括控制机构、伺服电机和执行机构，该系统还包括前一技术方案中的监测装置。

为解决上述技术问题，本发明采用的一个技术方案是：提供一种闭环控制系统的监测方法，该方法的步骤包括：从控制机构采集执行机构的移动位移以及位移误差；在设定的T时间段内，对比位移误差和第一设定值；根据移动位移和位移误差计算得到执行机构的实际移动距离，并在T时间段内，对比实际移动距离和第二设定值；在判定位移误差大于第一设定值，且判定实际移动距离大于第二设定值时，控制闭环控制系统关闭。

区别于现有技术，本发明的闭环控制系统的监测装置采集闭环控制系统的执行机构运动的位移及运动时产生的位移误差，计算得到执行机构运动的测量位移，在设定时间段内，利用位移误差及测量位移与预设值比较，在位移误差和测量位移均大于预设值时，向闭环控制系统发送关闭的命令。本发明的监测装置能够在闭环控制系统即将发生飞车现象时停止机器运转，避免机器损坏造成损失。

附图说明

图1是本发明提供的一种闭环控制系统的监测装置第一实施方式的结构示意图；

图2是本发明提供的一种闭环控制系统第一实施方式的结构示意图；

图3是本发明提供的一种闭环控制系统的监测方法第一实施方式的流程示意图。

具体实施方式

下面结合具体实施方式对本发明的技术方案作进一步更详细的描述。显然，所描述的实施例仅仅是本发明的一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有作出创造性劳动的前提下所获得的所有其他实施例，都应属于本发明保护的范围。

全闭环监测系统和半闭环监测系统是目前自动控制领域常见的监控系统。其中，半闭环监测系统监控的是整个系统最终执行环节的驱动环节，对最终执行机构不作监控；全闭环监测系统监控的是整个系统的最终执行环节，可对系统任一环节造成的位移误差进行补偿。

闭环控制系统至少包括四个部分：控制机构、伺服控制机构、伺服电机和执行机构，其控制过程通常是由控制机构设定负载的运动位移传输到伺服控制机构，伺服控制机构根据伺服电机的性能及转速，将负载的运动位移转换成伺服电机旋转的转数，伺服电机根据伺服控制机构转换成的电机转数转动以使执行机构带动负载进行移动。伺服电机旋转相应的转数后，使负载随执行机构到达指定位置。由于转换的精度问题，执行机构带动负载移动时，往往存在位移误差而无法准确到达指定位置，若位移误差在合理范围内是可以接受的。当位移误差过大时会由伺服电机及伺服控制机构反馈到控制机构，进行重新设定。

但是在实际的闭环控制系统中，容易出现伺服控制机构与控制机构的反馈链接因外力因素而断开，造成控制机构无法得到反馈，无法向伺服电机及伺服控制机构发送停止的指令，或者出现伺服电机不受控制，发生飞车现象的情况。伺服电机带动执行机构继续移动，此时若使高速运转的伺服电机停止，需要一段时间，在该时间段内，执行机构或负载会高速撞击设备，导致设备损坏，造成经济损失。

参阅图1，图1是本发明提供的一种闭环控制系统的监测装置第一实施方式的结构示意图。该装置100连接闭环控制系统101，用于监测闭环控制系统101，在其出现开环时停止闭环控制系统101的运转。该装置100包括：采集模块110、第一判断模块120、第二判断模块130和控制模块140，第一判断模块120和第二判断模块130均连接采集模块110及控制模块140。

采集模块110连接到闭环控制系统101，从闭环控制系统101实时采集由闭环控制系统101设定的负载随执行机构(图未示)的移动位移，获取负载随执行机构移动时产生的位移误差。第一判断模块120从采集模块110获取其采集到的位移误差数据，根据常规的控制操作设定一第一设定值，该第一设定值是影响该闭环控制系统101运转的最小位移误差值，当位移误差值超过该最小位移误差值时，需要停止闭环控制系统101的运转进行调整。闭环控制系统101根据伺服电机转数及执行机构移动的位移，计算执行机构完成移动所需时间，并记录该时间为T。第一判断模块120在T时间内，用获取到的位移误差值和第一设定值比较，当判断到位移误差值大于第一设定值时，启动第二判断模块130。第二判断模块130根据采集模块110采集到的位移误差值和移动位移，得到测量位移。根据常规操作过程的数据可知，测量位移理论等于设定的移动位移和获取的位移误差值的差值。所以测量位移可通过前述计算得到，或者从闭环控制系统101的控制机构直接读取。在本实施方式中，闭环控制系统101将负载实际移动的距离作为测量位移。同时第二判断模块130设定一第二设定值。第二设定值是闭环控制系统101控制机构设定的负载随执行机构移动的位移。第二判断模块130在T时间内用计算得到的测量位移和第二设定值比较。在测量位移大于第二设定值时，控制模块140向闭环控制系统101传输指令，使其关闭电源，使伺服电机停止运行，负载停止运动。

进一步，还包括第三判断模块150，根据实时获取的,伺服电机的旋转速度，在T时间段内，对比实时获取的旋转速度和第三设定值，在第三判断模块150判定旋转速度大于第三设定值时，向闭环控制系统101发送关闭命令。第三设定值是设定的伺服电机最大旋转速度阈值。旋转电机带动负载运动设定的位移时，伺服电机的旋转速度是从慢到快再到慢的过程。如果伺服电机旋转速度达到第三设定值后还继续升高，负载运动的位移必然超出设定的运动位移，造成设备损坏。因此第三判断模块150在判定伺服电机旋转速度大于设定的速度阈值时，控制模块140向闭环控系统101发送关闭指令。

对于不同的闭环控制系统101，设定的时间段T及第一设定值、第二设定值、第三设定值是不同的，均根据系统的实际配置进行设置。

进一步，控制模块140连接到关源机构(图未示)，在控制模块140向闭环控制系统101发送关闭指令。关源机构优选为看门狗软件。监测装置100用于包含至少一个治疗头的放疗系统中，控制模块140连接到放疗系统的一关源机构(图未示)，若判定位移误差大于第一设定值，且实际移动距离大于第二设定值时，控制模块140控制关源机构关闭放疗系统的放射性治疗头(图未示)，同时使所述放射性治疗头停止转动。

在本实施方式中，如果闭环控制系统101的伺服控制机构和控制机构之间的反馈链接因外力作用断开(比如电缆断开、反馈线接触不良、调试时反馈线接错)，控制机构无法得到伺服电机运转的情况，伺服电机也无法得到停止的指令，一直带动负载运动，且旋转速度越来越高，使负载运动的速度也越来越快，导致其撞击以及损坏设备，造成经济损失。而本发明的监测装置100能够避免机器损坏造成的损失。

区别于现有技术，本发明的闭环控制系统的监测装置采集闭环控制系统的执行机构运动的位移及运动时产生的位移误差，计算得到执行机构运动的测量位移，在设定时间段内，利用位移误差及测量位移与预设值比较，在位移误差和测量位移均大于预设值时，向闭环控制系统发送关闭的命令。本发明的监测装置能够在闭环控制系统即将发生飞车现象时停止机器运转，避免机器损坏造成损失。

参阅图2，图2是本发明提供的一种闭环控制系统第一实施方式的结构示意图。该系统200至少包括：控制机构210、伺服电机220、执行机构230和监测机构240。

控制机构210设定负载250移动的位移，并根据设定的位移确定负载250移动设定位移时伺服电机220需要转动的转数。控制机构210包括系统控制单元211和伺服控制单元212，系统控制单元211设定负载移动的参数，用于对整个系统200的控制。系统控制单元211设定执行机构230带动负载移动的位移，伺服控制单元212将系统控制单元211设定的位移参数转换成伺服电机220旋转的转数，伺服电机220根据伺服控制单元212要求的转数转动，为执行机构230带动负载移动提供动能，使之移动指定的位移。监测机构240是前一实施方式中所述的监测装置，从控制机构210获取负载移动的位移、执行机构230反馈的位移误差以及执行机构230带动负载移动时的测量位移，分别用实时获取的位移误差值及实时采集的测量位移和设定值进行比较，与位移误差值比较的设定值是影响该闭环控制系统101运转的最小位移误差值，当位移误差值超过该最小位移误差值时，需要停止闭环控制系统101的运转进行调整；与测量位移比较的是控制机构210设定的负载移动的位移。且在位移误差值及测量位移均大于设定值时，监测机构240向控制机构210发送关闭指令，使之关闭系统200的运行。

进一步，闭环控制系统200还包括人机交互机构250，用于为读取操作数据或设定控制数据提供可视化界面。

当系统200正常运转时，伺服电机220会将其实时运转的转速和转数反馈到控制机构210，控制机构210根据伺服电机220反馈的数据，判断负载是否按照指令完成移动，但是当伺服电机220向控制机构210反馈的链接断开时，控制机构210无法根据反馈数据发送指令，伺服电机220的转速会一直提高，执行机构230带动负载加速运动，可能导致机器设备损坏。本实施方式中，监测机构240监测执行机构230带动负载移动的位移误差值和测量位移，在伺服电机220即将发生飞车现象时，向控制机构210发送停止的指令，可避免对机器设备的损坏和造成经济损失。

区别于现有技术，本发明的闭环控制系统通过监测机构监测装置采集闭环控制系统的执行机构运动的位移及运动时产生的位移误差，计算得到执行机构运动的测量位移，在设定时间段内，利用位移误差及测量位移与预设值比较，在位移误差和测量位移均大于预设值时，向闭环控制系统发送关闭的命令。本发明闭环控制系统能够在即将发生飞车现象时停止机器运转，避免机器损坏造成损失。

参阅图3，图3是本发明提供的一种闭环控制系统的监测方法第一实施方式的流程示意图。该方法的步骤包括：

S301：从控制机构采集执行机构的移动位移以及位移误差。

从闭环控制系统实时采集由闭环控制系统设定的负载随执行机构的移动位移，并获取负载随执行机构移动时产生的位移误差。

S302：在设定的T时间段内，对比位移误差和第一设定值。

根据常规的控制操作设定一第一设定值，该第一设定值是影响该闭环控制系统运转的最小位移误差值，当位移误差值超过该最小位移误差值时，需要停止闭环控制系统的运转进行调整。闭环控制系统根据伺服电机转数及执行机构移动的位移，计算执行机构完成移动所需时间，并记录该时间为T。在T时间内，用获取到的位移误差值和第一设定值比较。

S303：根据移动位移和位移误差计算得到执行机构的实际移动距离，并在T时间段内，对比实际移动距离和第二设定值。

根据常规操作过程的数据可知，测量位移理论等于设定的移动位移和获取的位移误差值的差值。测量位移可通过前述计算得到，或者从闭环控制系统101的控制机构直接读取。在本实施方式中，闭环控制系统将负载实际移动的距离作为测量位移。同时设定一第二设定值。第二设定值是闭环控制系统控制机构设定的负载随执行机构移动的位移。在T时间内用计算得到的测量位移和第二设定值比较。

S304：在判定位移误差大于第一设定值，且判定实际移动距离大于第二设定值时，控制闭环控制系统关闭。

在位移误差值大于第一设定值，且测量位移大于第二设定值时，向闭环控制系统传输指令，使其关闭电源，使伺服电机停止运行，负载停止运动。

进一步，根据实时获取的伺服电机的旋转速度，在T时间段内，对比实时获取的旋转速度和第三设定值，在判定旋转速度大于第三设定值时，向闭环控制系统发送关闭命令。第三设定值是设定的伺服电机最大旋转速度阈值。旋转电机带动负载运动设定的位移时，伺服电机的旋转速度是从慢到快再到慢的过程。如果伺服电机旋转速度达到第三设定值后还继续升高，负载运动的位移必然超出设定的运动位移，造成设备损坏。在判定伺服电机旋转速度大于设定的速度阈值时，向闭环控系统发送关闭指令。

对于不同的闭环控制系统，设定的时间段T及第一设定值、第二设定值、第三设定值是不同的，均根据系统的实际配置进行设置。

进一步，在向闭环控制系统发送关闭指令后，连接到闭环控制系统的关源机构，关源机构使负载关源到初始位置，以便进行再次的操作。关源机构优选为看门狗软件。在本实施方式中，连接到放疗系统的一关源机构，若判定位移误差大于第一设定值，且实际移动距离大于第二设定值时，控制关源机构关闭放疗系统的放射性治疗头，同时使所述放射性治疗头停止转动。

在本实施方式中，如果闭环控制系统的伺服控制机构和控制机构之间的反馈链接因外力作用断开(比如电缆断开、反馈线接触不良、调试时反馈线接错)，控制机构无法得到伺服电机运转的情况，伺服电机也无法得到停止的指令，一直带动负载运动，且旋转速度越来越高，使负载运动的速度也越来越快，导致其撞击以及损坏设备，造成经济损失。而本发明的监测装置能够避免机器损坏造成的损失。

区别于现有技术，本发明的闭环控制系统的监测方法采集闭环控制系统的执行机构运动的位移及运动时产生的位移误差，计算得到执行机构运动的测量位移，在设定时间段内，利用位移误差及测量位移与预设值比较，在位移误差和测量位移均大于预设值时，向闭环控制系统发送关闭的命令。本发明的监测装置能够在闭环控制系统即将发生飞车现象时停止机器运转，避免机器损坏造成损失。

以上所述仅为本发明的实施方式，并非因此限制本发明的专利范围，凡是利用本发明说明书及附图内容所作的等效结构或等效流程变换，或直接或间接运用在其他相关的技术领域，均同理包括在本发明的专利保护范围内。