[发明专利]机电伺服系统保护与故障恢复控制方法

说明书

技术领域

本发明涉及飞行器控制领域，具体而言，涉及一种机电伺服系统保护与故障恢复控制方法。

背景技术

我国对运载火箭等的采用机电伺服技术的飞行控制执行闭环系统的统称为机电伺服系统，机电伺服系统的典型应用之一就是摇摆发动机或发动机喷管实现推力矢量控制，完成对运载火箭姿态的控制。由于机电伺服系统具有组成与结构简单，使用与维护方便，系统特性好等显著优点，已经成为近年来运载火箭推力矢量控制不断采用的控制执行系统。

机电伺服系统主要由以下几个部分组成：机电传动机构、永磁同步伺服电机、伺服控制驱动器、伺服动力电源。其中伺服动力电源为整个系统提供直流电能，是整个系统的初级能源。伺服控制驱动器集成了伺服控制功能与伺服驱动功能，伺服控制功能是以DSP为核心的控制功能电路，DSP中运行闭环控制算法，接收伺服指令信号，采集系统的各种状态反馈信号，最终生成六路PWM占空比斩波信号。伺服驱动功能是以IGBT为核心的功率驱动电路，接收PWM信号后根据PWM信号要求完成功率管的开、关动作，将伺服动力电源提供的直流电能逆变为三相交流电能，提供给永磁同步伺服电机，而永磁同步伺服电机作为整个系统的动力执行元件，输出转矩、转速功率运动，带动机电传动机构做功，实现推力矢量控制。

运载火箭推力矢量控制对机电伺服系统的动态响应速度要求极高，机电伺服系统作为控制执行机构子系统经常处于瞬间短时高功率输出的工况条件下，即要求伺服控制驱动器向永磁同步伺服电机短时间提供峰值大电流。同时，运载火箭在飞行过程中，受到飞行环境中各种气动环境等恶劣影响的干扰，随时需要机电伺服系统输出较大的功率，同时承受振动、冲击、加速度等力学环境与高温环境的影响。而伺服控制驱动器作为电力电子产品，其工作电流必须受到限制，否则电流过大会损坏IGBT功率管，造成产品失效。同时功率驱动电路受恶劣环境影响，有发生短时失效的可能性。但是运载火箭对机电伺服系统的使用要求极高，机电伺服系统作为飞行控制执行系统，一旦在飞行过程中因工作电流过大在成损坏或功率驱动电路失效无法正常工作，都会造成整个任务的失败。因此必须针对在复杂环境与复杂工况下可能出现的过电流或驱动电路失效做出高可靠的有效处理。

发明内容

本发明旨在提供一种可靠性高且故障恢复迅速的机电伺服系统保护与故障恢复控制方法。

本发明提供了一种机电伺服系统保护与故障恢复控制方法，包括：步骤S10：采集当前状态的系统参数；步骤S20：对比系统参数与预设参数；步骤S30：当系统参数不满足预设参数的限制时，进入故障保护状态，并锁止驱动器、关闭PWM输出；步骤S40：继续采集当前状态的系统参数，并与预设参数对比，直到系统参数满足预设参数的限制时，故障恢复计数器开始计数；步骤S50：当故障恢复计数器的计数达到预设值时，退出故障保护状态，并复位驱动器、恢复PWM输出、清零故障恢复计数器。

进一步地，该方法还包括位于步骤S40和步骤S50之间的计数步骤：计数步骤包括继续采集当前状态的系统参数，并与预设参数对比，当系统参数满足预设参数的限制时，故障恢复计数器的计数加一；当系统参数不满足预设参数的限制时，返回步骤S10。

进一步地，系统参数包括相电流，预设参数包括过流电流和过流恢复电流，故障保护状态包括过流故障保护状态，故障恢复计数器包括过流故障恢复计数器；步骤S30包括：当相电流大于过流电流时，进入过流故障保护状态，并锁止驱动器、关闭PWM输出；步骤S40包括：继续采集当前状态的相电流，并与过流恢复电流对比，直到相电流小于过流恢复电流时，过流故障恢复计数器开始计数。

进一步地，系统参数包括母线电流和母线电压，预设参数包括短路电流、欠压电压、短路恢复电流和欠压恢复电压；故障保护状态包括驱动故障保护状态，故障恢复计数器包括短路故障恢复计数器和欠压故障恢复计数器；步骤S30包括：当母线电流大于短路电流或者母线电压小于欠压电压时，进入驱动故障保护状态，并锁止驱动器、关闭PWM输出；步骤S40包括：继续采集当前状态的母线电流和母线电压，并将母线电流与短路恢复电流对比，直到母线电流小于短路恢复电流时，短路故障恢复计数器开始计数；或者将母线电压与欠压恢复电压对比，直到母线电压小于欠压恢复电压时，欠压故障恢复计数器开始计数。