一种磁悬浮旋转关节转子周期扰动自适应抑制系统，包括：磁悬浮转子模态控制单元、平动扰动自适应抑制单元、转动扰动自适应抑制单元、周期扰动评价单元；磁悬浮转子模态控制单元用于控制磁悬浮转子稳定悬浮。周期扰动评价单元给旋转关节电机发送指令角速度，控制磁悬浮转子定转速旋转，并对磁悬浮转子A、B端位置频谱分析，作为扰动力矩抑制的参考。平动/转动扰动自适应抑制单元加在与磁悬浮转子模态控制单元中平动/转动控制器平行位置，对平动/转动模态中谐波次数为N的扰动力矩进行自适应控制。消除N次谐波扰动量。本发明专利技术适用于对电机磁场周期不均匀性进行自辨识、自补偿，进而抑制电机谐波扰动力矩，可大幅提高伺服系统的控制精度。精度。精度。
【技术实现步骤摘要】
一种磁悬浮旋转关节转子周期扰动自适应抑制系统
[0001]本专利技术涉及一种磁悬浮旋转关节转子周期扰动自适应抑制系统，适用于对磁悬浮旋转关节转子周期扰动进行自适应抑制，可大幅提磁悬浮转子的悬浮控制精度。
技术介绍
[0002]磁悬浮轴承支承相对于传统机械轴承支承具有无接触、无磨损、振动小、可主动控制等特点，在磁悬浮飞轮、磁悬浮控制力矩陀螺和磁悬浮旋转关节等航天精密机电产品中有广阔的应用前景。
[0003]高精度音圈电机在旋转关节、惯性执行机构、指向机构、转台、天线等领域应用广泛。音圈电机永磁体非正弦畸变、周向磁场不均匀等导致的电磁扰动力矩存在对转子的法向扰动力，对磁悬浮转子形成周期性扰动，
[0004]现有磁悬浮周期扰动力一般使用扰动观测器、重复控制等方法实现，扰动观测器不特定针对某个周期频率扰动，观测器对高频扰动跟踪速度慢，造成高频周期扰动抑制能力不足，重复控制虽然特定抑制周期频率扰动，但其抑制精度受限于重复步长和品质因数。
技术实现思路
[0005]本专利技术解决的技术问题是：克服现有技术的不足，提供一种磁悬浮旋转关节转子周期扰动自适应抑制系统，实时辨识扰动力和扰动力矩的大小和方向并提供反向力和力矩进行抵消，提高磁悬浮转子悬浮控制精度。
[0006]本专利技术所采用的技术方案是：
[0007]一种磁悬浮旋转关节转子周期扰动自适应抑制系统，包括：磁悬浮转子模态控制单元、平动扰动自适应抑制单元、转动扰动自适应抑制单元、周期扰动评价单元；
[0008]所述磁悬浮转子模态控制单元包括位置传感器A、位置传感器B、分散姿态量
‑
>模态姿态量转换模块、平动模态控制器、转动模态控制器、模态控制量
‑
>分散控制量转换模块、功率放大器A、电流传感器A、磁轴承A、功率放大器B、电流传感器B、磁轴承B以及磁悬浮转子；
[0009]周期扰动评价单元给旋转关节电机发送指令角速度，控制磁悬浮转子定转速旋转，并对位置传感器A和位置传感器B输出的磁悬浮转子A、B端位置进行频谱分析，将频谱分析得到的扰动谐波次数N传送给平动扰动自适应抑制单元和转动扰动自适应抑制单元，作为扰动力矩抑制的参考。
[0010]平动扰动自适应抑制单元加在与磁悬浮转子模态控制单元中平动控制器平行位置，对平动模态中谐波次数为N的扰动力矩进行自适应控制，消除N次谐波扰动量；
[0011]转动扰动自适应抑制单元加在与磁悬浮转子模态控制单元中转动控制器平行位置，对转动模态中谐波次数为N的扰动力矩进行自适应控制，消除N次谐波扰动量。
[0012]进一步的，磁悬浮转子模态控制单元中，位置传感器A检测转子A端位置S_a，位置传感器B检测转子B端位置S_b，送入分散姿态量
‑
>模态姿态量转换模块，得到平动姿态量S_
tran和转动姿态量S_rotate，将平动姿态量S_tran送入平动模态控制器得到平动控制量CTR_tran，将转动姿态量S_rotate送入转动模态控制器得到转动控制量CTR_rotate，将S_rotate和CTR_rotate送入模态控制量
‑
>分散控制量转换模块得到A端电流控制量和B端电流控制量，分别经过A端功率放大器和B端功率放大器后得到A端绕组电压控制量和B端绕组电压控制量，分别施加给磁轴承A和磁轴承B，形成A、B端磁轴承绕组控制电流，提供电磁力，控制磁悬浮转子悬浮在目标位置。
[0013]进一步的，假设周期扰动评价单元给旋转关节电机发送控制指令角速度为Vel_zl，则频谱分析后，扰动谐波次数
[0014][0015]其中，f
N
为主要频谱成分的频率，并依据f
N
处的频谱幅值大小评价谐波扰动大小。
[0016]进一步的，平动扰动自适应抑制单元平动模态中谐波次数为N的扰动力矩进行自适应控制，具体为：
[0017]将伺服控制单元测量角位置θ引入到平动扰动自适应抑制单元；
[0018]乘以扰动谐波次数N，得到Nθ；
[0019]然后对Nθ进行正余弦变换得到sin(Nθ)和cos(Nθ)；
[0020]对sin(Nθ)和cos(Nθ)进行相移处理；
[0021]乘以平动姿态量S_tran和增益系数A_tran；
[0022]然后分别进行积分运算；
[0023]将积分运算结果与sin(Nθ)和cos(Nθ)分别相乘并相加后得到平动扰动自适应抑制量；
[0024]与平动控制量CTR_tran相加后送入磁悬浮转子模态控制单元的模态控制量
‑
>分散控制量转换模块。
[0025]进一步的，对sin(Nθ)和cos(Nθ)进行相移处理，得到和乘以平动姿态量S_tran和增益系数A_tran，得到和
[0026]进一步的，分别进行积分运算得到
[0027][0028][0029]进一步的，将积分结果与sin(Nθ)和cos(Nθ)分别相乘并相加后得到平动扰动自适应抑制量：
[0030][0031]进一步的，转动扰动自适应抑制单元对转动模态中谐波次数为N的扰动力矩进行自适应控制，具体为：
[0032]将伺服控制单元测量角位置θ引入到转动扰动自适应抑制单元；
[0033]乘以扰动谐波次数N，得到Nθ；
[0034]然后对Nθ进行正余弦变换得到sin(Nθ)和cos(Nθ)；
[0035]对sin(Nθ)和cos(Nθ)进行相移处理，得到和
[0036]乘以转动姿态量S_rotate和增益系数A_rotate；
[0037]然后分别进行积分运算；
[0038]将积分运算结果与sin(Nθ)和cos(Nθ)分别相乘并相加后得到平动扰动自适应抑制量；
[0039]与转动控制量CTR_rotate相加后送入磁悬浮转子模态控制单元的模态控制量到分散控制量转换模块。
[0040]进一步的，乘以转动姿态量S_rotate和增益系数A_rotate，得到和分别进行积分运算得到和
[0041]进一步的，将积分运算结果与sin(Nθ)和cos(Nθ)分别相乘并相加后得到平动扰动自适应抑制量：
[0042][0043]本专利技术与现有技术相比的有益效果是：
[0044](1)本专利技术利用电磁谐波扰动力矩自身的频率特性(转频的谐波频率)进行周期自适应控制，可适应扰动变化的情况。
[0045](2)本专利技术使用模态控制方法对平动模态和转动模态进行解耦控制，可对平动扰动力和转动扰动力矩分别设计自适应控制器，提高控制精度和稳定性。
[0046](3)本专利技术可以抑制不同周期频率的扰动力/力矩，且不影响原系统的稳定性。
[0047](4)本专利技术适用于对电机磁场周期不均匀性进行自辨识、自补偿，进而抑制电机谐波扰动力矩，可大幅提高伺服系统的控制精度。
...
【技术保护点】
【技术特征摘要】
1.一种磁悬浮旋转关节转子周期扰动自适应抑制系统，其特征在于，包括：磁悬浮转子模态控制单元、平动扰动自适应抑制单元、转动扰动自适应抑制单元、周期扰动评价单元；磁悬浮转子模态控制单元对位置传感器A和位置传感器B检测到的转子位置进行模态转换，得到转子模态姿态量，分别进行转动模态和平动模态控制，然后转换成各控制量，给磁轴承提供控制电流，控制转子回到目标位置；周期扰动评价单元给旋转关节电机发送指令角速度，控制磁悬浮转子定转速旋转，并对位置传感器A和位置传感器B输出的磁悬浮转子A、B端位置进行频谱分析，将频谱分析得到的扰动谐波次数N传送给平动扰动自适应抑制单元和转动扰动自适应抑制单元，作为扰动力矩抑制的参考。平动扰动自适应抑制单元加在与磁悬浮转子模态控制单元中平动控制器平行位置，对平动模态中谐波次数为N的扰动力矩进行自适应控制，消除N次谐波扰动量；转动扰动自适应抑制单元加在与磁悬浮转子模态控制单元中转动控制器平行位置，对转动模态中谐波次数为N的扰动力矩进行自适应控制，消除N次谐波扰动量。2.根据权利要求1所述的一种磁悬浮旋转关节转子周期扰动自适应抑制系统，其特征在于：所述磁悬浮转子模态控制单元包括位置传感器A、位置传感器B、分散姿态量
‑
>模态姿态量转换模块、平动模态控制器、转动模态控制器、模态控制量
‑
>分散控制量转换模块、功率放大器A、电流传感器A、磁轴承A、功率放大器B、电流传感器B、磁轴承B以及磁悬浮转子；位置传感器A检测转子A端位置S_a，位置传感器B检测转子B端位置S_b，送入分散姿态量
‑
>模态姿态量转换模块，得到平动姿态量S_tran和转动姿态量S_rotate，将平动姿态量S_tran送入平动模态控制器得到平动控制量CTR_tran，将转动姿态量S_rotate送入转动模态控制器得到转动控制量CTR_rotate，将S_rotate和CTR_rotate送入模态控制量
‑
>分散控制量转换模块得到A端电流控制量和B端电流控制量，分别经过A端功率放大器和B端功率放大器后得到A端绕组电压控制量和B端绕组电压控制量，分别施加给磁轴承A和磁轴承B，形成A、B端磁轴承绕组控制电流，提供电磁力，控制磁悬浮转子悬浮在目标位置。3.根据权利要求2所述的一种磁悬浮旋转关节转子周期扰动自适应抑制系统，其特征在于：假设周期扰动评价单元给旋转关节电机发送控制指令角速度为Vel_zl，则频谱分析后，扰动谐波次数其中，f
N
...
【专利技术属性】
技术研发人员：王英广，张鹏波，樊亚洪，张激扬，武登云，张强，卿涛，冯洪伟，胡跃伟，赵维珩，宿诺，梁柱林，赵志新，肖晓，
申请(专利权)人：北京控制工程研究所，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。