面向激励系统的基于增量插值PID的音圈电机力矩控制方法
本发明涉及音圈电机控制,尤其是涉及面向激励系统的基于增量插值pid的音圈电机力矩控制方法。
背景技术:
1、对卫星气悬浮模拟器实施姿态扰动模拟时,采用音圈电机提供姿态扰动力矩是一种可行的输入方式。将扰动输入装置与模拟器相互隔离,能够杜绝接触面的产生,避免物体之间支持力的出现,此时姿态扰动输入仅包含电流与磁场之间相互作用的安培力。该安培力可以量化,对于直线型音圈电机,其推力计算公式为,其中f为输出的安培力,b为磁通密度,i为电流强度,l为音圈电机线圈有效长度。
2、在理想情况下,音圈电机输出的力矩或推力与线圈中的电流呈严格的线性关系。然而,在实际应用场景中,由于模拟器的姿态不断发生变化,线圈与磁缸之间的相对位置及姿态随之改变,且磁缸所提供的磁场强度在空间上并非完全均匀,导致作用在线圈上的磁场强度时变难以预测,无法建立相应有效的变化模型。同时,在长时间工作后,线圈电阻因焦耳热而升高,改变了线圈电阻值,进而影响实时输出的电流和力矩。
3、在姿态扰动激励模拟子系统中,需要精确的力矩输出。力传感器的反馈周期为16ms,电流输入周期为1ms,力传感器的反馈频率远低于驱动器的电流输入频率,导致在两次力传感器反馈之间无法获取新的实测力反馈值来更新控制量,需要相应的控制方法对此类非时域问题进行跟踪控制。
4、传统pid控制方法在应用于上述场景时,由于力传感器反馈频率受限和磁感应强度时变等因素的影响,高频条件下(如10hz)控制系统容易发散,难以实现稳定跟踪。
技术实现思路
1、本发明的目的是提供一种面向激励系统的基于增量插值pid的音圈电机力矩控制方法,旨在解决因力传感器反馈频率受限和磁感应强度时变导致传统pid控制难以实现高频力矩跟踪的问题,实现0~10hz范围内对期望跟踪力矩的稳定精确输出。
2、为实现上述目的,本发明提供了一种面向激励系统的基于增量插值pid的音圈电机力矩控制方法,包括以下步骤:
3、s1、在每个控制周期开始时,获取期望跟踪力矩、各音圈电机当前的驱动电流值以及各音圈电机的实测力反馈值;
4、s2、根据各音圈电机的实测力反馈值计算激励系统的实际输出力矩,计算实际输出力矩与期望跟踪力矩之间的误差量、误差变化量及误差积分量,并根据各音圈电机的实测力反馈值和驱动电流值,对各音圈电机对应磁缸的磁感应强度进行修正;
5、s3、根据误差量、误差变化量、误差积分量以及修正后的磁感应强度,计算各音圈电机的电流修正量,并在本控制周期内,将电流修正量通过多次插值调整的方式输出至音圈电机驱动器,循环执行上述步骤直至完成对期望跟踪力矩的跟踪控制。
6、优选的,s2具体包括:
7、s201、通过各音圈电机上力传感器反馈的各音圈电机的实测力反馈值,计算激励系统当前的实际输出力矩:
8、;
9、其中,为用于将各音圈电机的实测力反馈值合成为实际输出力矩的分配矩阵,为由各音圈电机的实测力反馈值构成的列向量;
10、s202、根据实际输出力矩与期望跟踪力矩,计算误差量、误差变化量及误差积分量:
11、误差量为期望跟踪力矩与实际输出力矩之差:
12、;
13、误差变化量为当前控制周期的误差量与上一个控制周期的误差量之差:
14、;
15、其中,为上一个控制周期的期望跟踪力矩,为上一个控制周期的实际输出力矩;
16、误差积分量为各控制周期的误差量的累加和:
17、;
18、其中,为当前控制周期的序号,为第个控制周期的误差量,为控制周期索引;
19、s203、根据各音圈电机的实测力反馈值和驱动电流值,对各音圈电机对应磁缸的磁感应强度进行修正。
20、优选的,s203中,对各音圈电机对应磁缸的磁感应强度进行修正采用以下公式:
21、;
22、其中,为第个音圈电机在当前控制周期对应磁缸的磁感应强度,为第个音圈电机在上一个控制周期对应磁缸的磁感应强度,为第个音圈电机的实测力反馈值,为第个音圈电机的驱动电流值,为预设的调整因子。
23、优选的,所述分配矩阵为:
24、;
25、其中,前三行对应各音圈电机实测力反馈值向实际输出力的分配,后三行对应各音圈电机实测力反馈值向实际输出力矩的分配,至分别为各音圈电机的力臂向量在对应力矩方向上的投影分量。
26、优选的,s3具体包括:
27、s301、根据s202中获得的误差量、误差变化量及误差积分量,按照比例-积分-微分控制律计算力矩修正量,根据各音圈电机对输出力矩的分配关系将力矩修正量转化为各音圈电机的电流修正量,再根据各音圈电机对应磁缸的修正后的磁感应强度对电流修正量进行折算,得到各音圈电机在本控制周期内的总电流修正量;
28、s302、根据各音圈电机的总电流修正量,在各音圈电机的当前驱动电流值基础上,以多次插值调整的方式逐次增加插值电流,完成对期望跟踪力矩的跟踪控制。
29、优选的,s301中,各音圈电机的总电流修正量的计算公式为:
30、;
31、其中,为由各音圈电机的总电流修正量构成的列向量,为分配矩阵的逆矩阵,为比例系数,为微分系数,为积分系数,为控制周期的时间长度,为由各音圈电机对应磁感应强度的倒数构成的列向量。
32、优选的,s302中,所述插值调整的次数为5次,相邻两次插值调整的时间间隔为3ms;所述插值电流为:
33、;
34、其中,为第次插值调整后的驱动电流值,为第次插值调整后的驱动电流值,为单个音圈电机的总电流修正量,为插值调整的次数序号且1≤≤5。
35、因此,本发明采用上述面向激励系统的基于增量插值pid的音圈电机力矩控制方法,达到了以下技术效果:
36、(1)本发明通过增量式pid控制与周期内多次插值输出相结合,有效避免了电流突变引起的电磁感应扰动,实现了力矩的平滑跟踪,在10hz高频条件下仍能保持稳定跟踪控制,而传统pid控制方法在相同条件下已发散。
37、(2)本发明通过对磁感应强度进行修正,适应了线圈位置变化引起的磁场波动,在不同频率下均保持了较高的力矩跟踪精度,在0.5hz以下输出力矩误差优于2%,在0.5hz至2hz范围内输出力矩误差优于5%。
38、(3)本发明通过将计算得到的总电流修正量在一个控制周期内分多次逐步输出,充分利用了驱动器的高频响应能力,同时兼顾了力传感器低频反馈的限制,实现了驱动器和力传感器不同响应频率之间的协同匹配,适用于力传感器反馈频率受限的应用场景。
39、下面通过附图和实施例,对本发明的技术方案做进一步的详细描述。
1.一种面向激励系统的基于增量插值pid的音圈电机力矩控制方法,其特征在于,包括以下步骤:
2.根据权利要求1所述的方法,其特征在于,s2具体包括:
3.根据权利要求2所述的方法,其特征在于,s203中,对各音圈电机对应磁缸的磁感应强度进行修正采用以下公式:
4.根据权利要求2所述的方法,其特征在于,所述分配矩阵为:
5.根据权利要求2所述的方法,其特征在于,s3具体包括:
6.根据权利要求5所述的方法,其特征在于,s301中,各音圈电机的总电流修正量的计算公式为:
7.根据权利要求6所述的方法,其特征在于,s302中,所述插值调整的次数为5次,相邻两次插值调整的时间间隔为3ms;所述插值电流为:
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com