[发明专利]基于虚拟速度内环的双闭环电锁回路控制方法

摘要

本发明属于导引头系统电锁控制技术领域，具体涉及一种基于虚拟速度内环的双闭环电锁回路控制方法。与现有技术相比较，本发明技术方案提供的速度内环能够削弱被速度内环包围的电机参数及摩擦、间隙等非线性影响，起到稳定特性以及改善线性度的作用。通过设置虚拟速度内环来代替安装框架测速传感器，从而能够获得良好的伺服刚度并保证随动电锁控制性能。

主权项

一种基于虚拟速度内环的双闭环电锁回路控制方法，其特征在于，所述控制方法基于双闭环电锁回路控制系统来实施，所述控制系统包括：位置回路控制器、速度回路控制器、电机、积分器、电位器、跟踪微分器；所述位置回路控制器、速度回路控制器、电机、积分器、电位器依次串联构成位置控制回环；所述电位器的输出端口还连接跟踪微分器的输入端口；所述跟踪微分器的输出端口连接速度回路控制器的输入端口；所述电位器、跟踪微分器、速度回路控制器、电机、积分器构成虚拟速度回环；所述控制方法包括：步骤S1：导引装置指定输入角位置指令，利用所输入的角位置指令和当前状态下电位器测量的框架角位置信号相减，获取位置控制偏差；步骤S2：将位置控制偏差输入至所述位置回路控制器，经过位置回路控制器后的输出作为虚拟速度回环的一路输入；步骤S3：将所述电位器测量的框架角位置信号经过跟踪微分器的跟踪微分运算后输出作为测量到的框架角速度信号，该测量到的框架角速度信号作为虚拟速度回环的另一路输入；步骤S4：利用步骤S2得到的一路输入和步骤S3得到的另一路输出，将两者相减，计算得到速度控制偏差；步骤S5：将所述速度控制偏差输入速度回路控制器，经过速度回路控制器后输出电机控制量至电机，电机转动至指定角位置；步骤S6：电机转动角速度经过积分后为角位置信息，先通过电位器测量，然后一路反馈测量的框架角位置信号用以重复步骤S1，另一路反馈测量的框架角位置信号至跟踪微分器用以重复步骤S3。