CN108919735B - 伺服系统安全保护方法 - Google Patents
伺服系统安全保护方法 Download PDFInfo
- Publication number
- CN108919735B CN108919735B CN201810709062.8A CN201810709062A CN108919735B CN 108919735 B CN108919735 B CN 108919735B CN 201810709062 A CN201810709062 A CN 201810709062A CN 108919735 B CN108919735 B CN 108919735B
- Authority
- CN
- China
- Prior art keywords
- current
- acceleration
- volume
- failure volume
- acceleration failure
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/048—Monitoring; Safety
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P29/00—Arrangements for regulating or controlling electric motors, appropriate for both AC and DC motors
Abstract
本发明提供了一种伺服系统安全保护方法,该方法获取速度环输出控制量和实时加速度;根据速度环输出控制量和实时加速度,确定当前拍加速度故障状态量;根据上一拍加速度故障状态量对当前拍加速度故障状态量进行滤波处理;根据滤波处理后的当前拍加速度故障状态量进行安全保护。本发明提供的方法获取速度环输出控制量和实时加速度;根据速度环输出控制量和实时加速度,确定当前拍加速度故障状态量;根据上一拍加速度故障状态量对当前拍加速度故障状态量进行滤波处理;根据滤波处理后的当前拍加速度故障状态量进行安全保护,解决了反馈信号异常、驱动环节异常的检测手段欠缺的问题。
Description
技术领域
本发明涉及伺服技术领域,特别涉及一种伺服系统安全保护方法。
背景技术
伺服系统是一种机电一体化系统,由伺服控制软件发出控制指令,经过功率放大装置驱动电机旋转,从而带动负载进行直线、旋转等动作。伺服系统往往具有高速率、高加速度、大惯量等特点,考虑到对伺服系统操作人员、所携带负载、系统自身结构部件、高精密电子元器件的保护,伺服系统安全保护方法是系统设计中极其重要的环节,保护能力的强弱直接影响人员安全、伺服系统自身及其所携带负载的使用寿命。
传统的伺服系统安全保护方法,往往在结构设计中添加机械止挡和缓冲器,该方法可以在转台飞车后进行强制限位,从而保护电缆不被拉断。然而,伺服系统撞击机械限位产生的强大冲击会对系统自身和所携带负载产生不可预料的后果。
除机械止档外,伺服系统会设计电气开关对自身进行断电保护,断电后由电机电枢短路或制动器抱闸产生的制动效果会让运动部分立即减速。然而,在设计中为了节约空间和缩小尺寸,电气限位与机械止档的间距往往很小,则导致运动部分刚刚被电气限位保护且为被完全制动的情况下仍然会撞击到机械止档。
此外,伺服系统的控制柜和控制软件界面上会设置紧急停机按键,该方法虽可以有效保护系统异常振荡,但是当伺服系统飞车时,操作人员往往无法及时按下紧急停机按键,从而没办法保护系统飞车现象。
系统飞车现象往往来自于伺服系统开环、正反馈等故障,其故障往往来源于反馈信号异常、驱动环节异常。而系统对于反馈信号异常、驱动环节异常的检测手段欠缺,所以很难利用硬件和线路本身进行保护。此外,电气限位、机械止档和手动急停,也无法有效避免飞车而带来的对伺服系统自身的冲击。
对于一种位置环、速度环、电流环三环闭合的伺服系统,位置环和速度环的设计在伺服系统控制软件中实现,且由伺服系统控制软件采集反馈信号,电流环设计在驱动环节中实现,当反馈信号和驱动环节二者任意异常时都可能会导致伺服系统飞车。
发明内容
为了解决现有技术的问题,本发明实施例提供一种伺服系统安全保护方法。
本实施例提供的伺服系统安全保护方法,包括:
获取速度环输出控制量和实时加速度;
根据所述速度环输出控制量和实时加速度,确定当前拍加速度故障状态量;
根据上一拍加速度故障状态量对当前拍加速度故障状态量进行滤波处理;
根据滤波处理后的当前拍加速度故障状态量进行安全保护。
可选地,所述根据所述速度环输出控制量和实时加速度,确定当前拍加速度故障状态量,包括:
当前拍加速度故障状态量=速度环输出控制量×实时加速度;
其中,速度环输出控制量取值范围为[-8192,8192],实时加速度取值范围为[-60,60]。
可选地,所述根据上一拍加速度故障状态量对当前拍加速度故障状态量进行滤波处理,包括:
滤波处理后的当前拍加速度故障状态量=α×当前拍加速度故障状态量+(1-α)×上一拍加速度故障状态量;
其中,α为滤波参数。
可选地,所述α=0.8。
可选地,所述根据滤波处理后的当前拍加速度故障状态量进行安全保护,包括:
根据滤波处理后的当前拍加速度故障状态量确定当前拍是否处于异常状态;
根据当前拍是否处于异常状态的确定结果,更新故障计数器的值;
当故障计数器的值超过第一数值时,判定所述伺服系统处于异常状态,做断电保护。
可选地,所述第一数值为1000。
可选地,所述根据滤波处理后的当前拍加速度故障状态量确定当前拍是否处于异常状态,包括:
若滤波处理后的当前拍加速度故障状态量大于第二数值,则确定当前拍处于异常状态;
若速度环输出控制量超过预设范围,且滤波处理后的各拍加速度故障状态量均为0,则确定处于异常状态。
可选地,所述第二数值为-5000,所述预设范围为[-819,819]。
可选地,所述根据当前拍是否处于异常状态的确定结果,更新故障计数器的值,包括:
若确定当前拍处于异常状态,则故障计数器加一;
若确定当前拍未处于异常状态,则故障计数器清零。
可选地,根据滤波处理后的当前拍加速度故障状态量确定当前拍是否处于异常状态之前,还包括:
将滤波处理后的当前拍加速度故障状态量赋值到上一拍加速度故障状态量。
有益效果如下:
本发明实施例中,获取速度环输出控制量和实时加速度;根据速度环输出控制量和实时加速度,确定当前拍加速度故障状态量;根据上一拍加速度故障状态量对当前拍加速度故障状态量进行滤波处理;根据滤波处理后的当前拍加速度故障状态量进行安全保护,解决了反馈信号异常、驱动环节异常的检测手段欠缺的问题。
附图说明
下面将参照附图描述本发明的具体实施例,其中:
图1为本发明实施例中的一种伺服系统安全保护方法的流程示意图。
图2为本发明实施例中的另一种伺服系统安全保护方法的流程示意图。
具体实施方式
为了使本发明的技术方案及优点更加清楚明白,以下结合附图对本发明的示例性实施例进行进一步详细的说明,显然,所描述的实施例仅是本发明的一部分实施例,而不是所有实施例的穷举。并且在不冲突的情况下,本发明中的实施例及实施例中的特征可以互相结合。
系统飞车现象往往来自于伺服系统开环、正反馈等故障,其故障往往来源于反馈信号异常、驱动环节异常。而系统对于反馈信号异常、驱动环节异常的检测手段欠缺,所以很难利用硬件和线路本身进行保护。
基于此,本发明实施例提供了一种伺服系统安全保护方法,获取速度环输出控制量和实时加速度;根据速度环输出控制量和实时加速度,确定当前拍加速度故障状态量;根据上一拍加速度故障状态量对当前拍加速度故障状态量进行滤波处理;根据滤波处理后的当前拍加速度故障状态量进行安全保护,解决了反馈信号异常、驱动环节异常的检测手段欠缺的问题。
参见图1,本实施例提供的伺服系统安全保护方法实现流程如下。
101,获取速度环输出控制量和实时加速度。
102,根据速度环输出控制量和实时加速度,确定当前拍加速度故障状态量。
当前拍加速度故障状态量=速度环输出控制量×实时加速度;
其中,速度环输出控制量取值范围为[-8192,8192],实时加速度取值范围为[-60,60]。
即Value_Acce=Vel_Out×Acce。
其中,Value_Acce为当前拍加速度故障状态量。Vel_Out为速度环输出控制量,取值范围为[-8192,8192]。Acce为实时加速度,取值范围为[-60,60]。
103,根据上一拍加速度故障状态量对当前拍加速度故障状态量进行滤波处理。
滤波处理后的当前拍加速度故障状态量=α×当前拍加速度故障状态量+(1-α)×上一拍加速度故障状态量。
其中,α为滤波参数。
即Value_Acce′=α×Value_Acce+(1-α)×Value_Acce_1。
其中,α为滤波参数,Value_Acce′为滤波处理后的当前拍加速度故障状态量。
以α=0.8为例,Value_Acce′=0.8×Value_Acce+0.2×Value_Acce_1。
104,根据滤波处理后的当前拍加速度故障状态量进行安全保护。
可以按如下方式实现:
1)将滤波处理后的当前拍加速度故障状态量赋值到上一拍加速度故障状态量。
如,Value_Acce_1=Value_Acce′。
2)根据滤波处理后的当前拍加速度故障状态量确定当前拍是否处于异常状态。
若滤波处理后的当前拍加速度故障状态量大于第二数值,则确定当前拍处于异常状态。
若速度环输出控制量超过预设范围,且滤波处理后的各拍加速度故障状态量均为0,则确定处于异常状态。
其中,第二数值为-5000,预设范围为[-819,819]。
3)根据当前拍是否处于异常状态的确定结果,更新故障计数器的值。
若确定当前拍处于异常状态,则故障计数器加一;
若确定当前拍未处于异常状态,则故障计数器清零。
4)当故障计数器的值超过第一数值时,判定伺服系统处于异常状态,做断电保护。
其中,第一数值为1000。
例如,当Value_Acce′大于-5000时,则将故障计数器加一,反之则将故障计数器清零。当故障计数器超过1000时,即系统运行闭环运行时间达到0.2s,则判定伺服系统处于异常状态,对伺服系统做断电保护。
再例如,当Vel_Out超过阈值范围[-819,819],且各拍Value_Acce′的绝对值恒为0时,则将故障计数器加一,反之则将故障计数器清零。当故障计数器超过1000时,即系统运行闭环运行时间达到0.2s,则判定伺服系统处于异常状态,对伺服系统做断电保护。
图2示出了本实施例提供的伺服系统安全保护方法在实际应用时的流程。通过该流程解决了反馈信号异常、驱动环节异常的检测手段欠缺的问题,以及电气限位、机械止档和手动急停,无法有效避免飞车而带来对伺服系统自身的冲击。
有益效果:获取速度环输出控制量和实时加速度;根据速度环输出控制量和实时加速度,确定当前拍加速度故障状态量;根据上一拍加速度故障状态量对当前拍加速度故障状态量进行滤波处理;根据滤波处理后的当前拍加速度故障状态量进行安全保护,解决了反馈信号异常、驱动环节异常的检测手段欠缺的问题。
本领域内的技术人员应明白,本发明的实施例可提供为方法、系统、或计算机程序产品。因此,本发明可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本发明可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本发明是参照根据本发明实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
尽管已描述了本发明的优选实施例,但本领域内的技术人员一旦得知了基本创造性概念,则可对这些实施例作出另外的变更和修改。所以,所附权利要求意欲解释为包括优选实施例以及落入本发明范围的所有变更和修改。
Claims (9)
1.一种伺服系统安全保护方法,其特征在于,所述方法,包括:
获取速度环输出控制量和实时加速度;
根据所述速度环输出控制量和实时加速度,确定当前拍加速度故障状态量;
其中,
当前拍加速度故障状态量=速度环输出控制量×实时加速度;
速度环输出控制量取值范围为[-8192,8192],实时加速度取值范围为[-60,60];
根据上一拍加速度故障状态量对当前拍加速度故障状态量进行滤波处理;
根据滤波处理后的当前拍加速度故障状态量进行安全保护。
2.根据权利要求1所述的方法,其特征在于,所述根据上一拍加速度故障状态量对当前拍加速度故障状态量进行滤波处理,包括:
滤波处理后的当前拍加速度故障状态量=α×当前拍加速度故障状态量+(1-α)×上一拍加速度故障状态量;
其中,α为滤波参数。
3.根据权利要求2所述的方法,其特征在于,所述α=0.8。
4.根据权利要求1所述的方法,其特征在于,所述根据滤波处理后的当前拍加速度故障状态量进行安全保护,包括:
根据滤波处理后的当前拍加速度故障状态量确定当前拍是否处于异常状态;
根据当前拍是否处于异常状态的确定结果,更新故障计数器的值;
当故障计数器的值超过第一数值时,判定所述伺服系统处于异常状态,做断电保护。
5.根据权利要求4所述的方法,其特征在于,所述第一数值为1000。
6.根据权利要求4所述的方法,其特征在于,所述根据滤波处理后的当前拍加速度故障状态量确定当前拍是否处于异常状态,包括:
若滤波处理后的当前拍加速度故障状态量大于第二数值,则确定当前拍处于异常状态;
若速度环输出控制量超过预设范围,且滤波处理后的各拍加速度故障状态量均为0,则确定处于异常状态。
7.根据权利要求6所述的方法,其特征在于,所述第二数值为-5000,所述预设范围为[-819,819]。
8.根据权利要求4所述的方法,其特征在于,所述根据当前拍是否处于异常状态的确定结果,更新故障计数器的值,包括:
若确定当前拍处于异常状态,则故障计数器加一;
若确定当前拍未处于异常状态,则故障计数器清零。
9.根据权利要求4-8任一权利要求所述的方法,其特征在于,根据滤波处理后的当前拍加速度故障状态量确定当前拍是否处于异常状态之前,还包括:
将滤波处理后的当前拍加速度故障状态量赋值到上一拍加速度故障状态量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810709062.8A CN108919735B (zh) | 2018-07-02 | 2018-07-02 | 伺服系统安全保护方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810709062.8A CN108919735B (zh) | 2018-07-02 | 2018-07-02 | 伺服系统安全保护方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108919735A CN108919735A (zh) | 2018-11-30 |
CN108919735B true CN108919735B (zh) | 2019-10-25 |
Family
ID=64424778
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810709062.8A Active CN108919735B (zh) | 2018-07-02 | 2018-07-02 | 伺服系统安全保护方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108919735B (zh) |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1333251A1 (en) * | 2000-11-06 | 2003-08-06 | Sony Corporation | Angle or position determining device and method, servo device and servo method, and motor |
CN102411353A (zh) * | 2011-11-03 | 2012-04-11 | 固高科技(深圳)有限公司 | 驱控一体化控制器和控制系统 |
CN103064408A (zh) * | 2012-12-21 | 2013-04-24 | 兰州飞行控制有限责任公司 | 一种飞机舵机伺服系统故障检测方法 |
CN103302538A (zh) * | 2013-06-13 | 2013-09-18 | 嘉兴华嶺机电设备有限公司 | 直线电机重心驱动高频超高加减速微切削运动控制机构 |
JP2013191186A (ja) * | 2012-03-15 | 2013-09-26 | Mitsubishi Electric Corp | 象限突起測定装置および象限突起測定方法 |
CN103825506A (zh) * | 2012-11-19 | 2014-05-28 | 财团法人工业技术研究院 | 防止失速控制的真空设备 |
CN105071739A (zh) * | 2015-08-04 | 2015-11-18 | 大族激光科技产业集团股份有限公司 | 一种直线电机的控制系统及其控制方法 |
CN105240214A (zh) * | 2015-11-13 | 2016-01-13 | 天津瑞源电气有限公司 | 一种用于风电机组超速保护的安全回路 |
CN105487465A (zh) * | 2015-12-21 | 2016-04-13 | 中国科学院长春光学精密机械与物理研究所 | 基于加速度计的大型光电望远镜辅助安全保护系统 |
CN105629852A (zh) * | 2016-02-19 | 2016-06-01 | 西安大医数码技术有限公司 | 一种闭环控制系统的监测装置、方法及闭环控制系统 |
CN106672219A (zh) * | 2016-12-22 | 2017-05-17 | 西安航空制动科技有限公司 | 一种飞机防滑失效速度状态锁定的方法 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5204932A (en) * | 1989-01-10 | 1993-04-20 | Fujitsu Limited | Servo circuit for magnetic disk apparatus |
CN201639268U (zh) * | 2009-12-30 | 2010-11-17 | 中国船舶重工集团公司第七一三研究所 | 一种伺服系统故障保护装置 |
CN104597846B (zh) * | 2013-10-31 | 2017-05-03 | 中国科学院沈阳计算技术研究所有限公司 | 一种多轴联动管道插补全闭环运动控制方法 |
CN108111082B (zh) * | 2017-11-16 | 2020-05-08 | 中冶南方(武汉)自动化有限公司 | 永磁同步电机的if控制失速检测方法及系统 |
-
2018
- 2018-07-02 CN CN201810709062.8A patent/CN108919735B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP1333251A1 (en) * | 2000-11-06 | 2003-08-06 | Sony Corporation | Angle or position determining device and method, servo device and servo method, and motor |
CN102411353A (zh) * | 2011-11-03 | 2012-04-11 | 固高科技(深圳)有限公司 | 驱控一体化控制器和控制系统 |
JP2013191186A (ja) * | 2012-03-15 | 2013-09-26 | Mitsubishi Electric Corp | 象限突起測定装置および象限突起測定方法 |
CN103825506A (zh) * | 2012-11-19 | 2014-05-28 | 财团法人工业技术研究院 | 防止失速控制的真空设备 |
CN103064408A (zh) * | 2012-12-21 | 2013-04-24 | 兰州飞行控制有限责任公司 | 一种飞机舵机伺服系统故障检测方法 |
CN103302538A (zh) * | 2013-06-13 | 2013-09-18 | 嘉兴华嶺机电设备有限公司 | 直线电机重心驱动高频超高加减速微切削运动控制机构 |
CN105071739A (zh) * | 2015-08-04 | 2015-11-18 | 大族激光科技产业集团股份有限公司 | 一种直线电机的控制系统及其控制方法 |
CN105240214A (zh) * | 2015-11-13 | 2016-01-13 | 天津瑞源电气有限公司 | 一种用于风电机组超速保护的安全回路 |
CN105487465A (zh) * | 2015-12-21 | 2016-04-13 | 中国科学院长春光学精密机械与物理研究所 | 基于加速度计的大型光电望远镜辅助安全保护系统 |
CN105629852A (zh) * | 2016-02-19 | 2016-06-01 | 西安大医数码技术有限公司 | 一种闭环控制系统的监测装置、方法及闭环控制系统 |
CN106672219A (zh) * | 2016-12-22 | 2017-05-17 | 西安航空制动科技有限公司 | 一种飞机防滑失效速度状态锁定的方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108919735A (zh) | 2018-11-30 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP6015178B2 (ja) | 安全システム | |
US20060072265A1 (en) | Power and safety control hub | |
Garcia et al. | Detecting PLC control corruption via on-device runtime verification | |
CN201909983U (zh) | 一种基于cpld的电动汽车电机系统故障处理装置 | |
CN108919735B (zh) | 伺服系统安全保护方法 | |
CN205911736U (zh) | 一种电机控制系统 | |
CN109470463A (zh) | 一种环网柜断路器机械特性在线监测系统及方法 | |
CN109301792A (zh) | 保护电路、电路系统、自动化设备、控制方法和装置 | |
CN110347143A (zh) | 核安全级优选模块现场驱动输出回路诊断系统及方法 | |
CN206133294U (zh) | 一种控制器故障保护系统 | |
CN204737631U (zh) | 一种起重机监控系统 | |
CN202916000U (zh) | 电子振动开关 | |
CN204251227U (zh) | 一种起重机起升机构安全保护装置 | |
CN106054862B (zh) | 柴油发电机组防飞车控制方法 | |
CN102545330B (zh) | 一种供电电路、工程机械及其供电系统 | |
CN204011320U (zh) | 一种磁通变换器的复位装置 | |
CN211202068U (zh) | 一种汽轮机ets系统 | |
CN106523041A (zh) | 一种汽轮机差胀保护控制系统 | |
CN206332632U (zh) | 一种控制棒电源系统保护及控制系统 | |
CN201550076U (zh) | 智能交变电磁感应电动机控制保护器 | |
CN205583856U (zh) | 一种永磁真空断路器过零分断检测装置 | |
CN106814678A (zh) | 一种利用能耗制动实现转台超速保护的安全装置 | |
CN110509274A (zh) | 一种机器人安全控制系统 | |
CN203272015U (zh) | 一种新型的风力发电机组振动超限保护系统 | |
Cai et al. | Reliable analysis on fast valving of ultra-supercritical unit under transient fault conditions |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |