基于匹配扰动补偿的音圈驱动器力输出式位移控制方法技术

一种基于匹配扰动补偿的音圈驱动器力输出式位移控制方法，可实现对时变非线性负载和系统模型不确定性动态进行实时在线估计与主动补偿，更适用于拖动宽动态范围复杂时变非线性负载的音圈型驱动器的位移控制。通过在线估计和主动补偿的方法，可抵消包含时变非线性负载与系统模型不确定性动态在内的等效匹配注入扰动，从而通过反馈的方法将补偿后的系统改造为典型的二阶系统，具备更理想的动态特性。在抵消等效注入扰动的基础上引入有限时间收敛律。可减少输出位移与参考位移的相位差，同时有效降低切换控制量，避免抖震效应对系统控制品质的劣化。制品质的劣化。制品质的劣化。

【技术实现步骤摘要】
基于匹配扰动补偿的音圈驱动器力输出式位移控制方法


[0001]本专利技术涉及音圈驱动器
，具体涉及一种基于匹配扰动补偿的音圈驱动器力输出式位移控制方法。

技术介绍

[0002]音圈型驱动器由于可取消传动装置，且无需换相机构，可实现理论上无限小的定位分辨率。应用音圈型驱动器的快速响应特性，设备可拖动负载实现较大动态范围内的高频运动，被广泛应用在机械硬盘，镜头对焦，机械臂末端执行器，疲劳测试装置等场景。然而，在实际运行中，伴随音圈型驱动器的动子与定子间磨损过程的加剧，摩擦系数会出现明显的变化过程；其拖动的负载本身也因工况的不同而在较大范围内出现变化。在设备层面表现为驱动器运行阻力相对于位置与速度的强非线性与时变特性。此外，在往复运动的过程中的每个最小运动周期内，存在两处位移速度为零的时刻。当动子运动到这些时刻对应的位置时，运行阻力会发生由动摩擦力到静摩擦力再到动摩擦力的特性变化，使得运行阻力曲线呈现周期性冲击的特点。上述现象的存在使得工业控制中所采用的常规方法难以确保整个设备运行周期中的定位精度。近些年，围绕音圈型驱动器的定位问题主要提出三类方法：第一类运用鲁棒控制方法，针对系统不确定性的上下界设计控制器。可确保闭环系统的稳定性，但在一定程度上牺牲了定位精度。第二类运用非线性控制方法，针对已知系统非线性动态与不确定性上下界设计控制器，但针对复杂摩擦性负载不能充分发挥其优势。第三类运用离线扰动补偿方法，对工况相对固定的音圈型定位平台以及自动对焦模块等应用场景有较好的效果，但不能适应工况变化范围大的疲劳测试装置与机械臂末端执行器等拖动时变负载的应用场景。

技术实现思路

[0003]本专利技术为了克服以上技术的不足，提供了一种对包含时变非线性负载与系统模型不确定性动态在内的等效匹配注入扰动的在线估计，通过系统输入端对扰动进行主动抵消，进而提升系统的控制精度的方法。
[0004]本专利技术克服其技术问题所采用的技术方案是：
[0005]一种基于匹配扰动补偿的音圈驱动器力输出式位移控制方法，包括如下步骤：
[0006]a)通过公式建立包含具有作用力量纲的等效匹配注入扰动力的音圈型驱动器的数学模型，其中为音圈驱动器中运动部件的加速度，M为音圈驱动器中运动部件的总质量，F
a
为作用在音圈上的电磁力，F
d
为具有作用力量纲的等效匹配注入扰动力，C为音圈驱动器的机械阻尼系数，为音圈驱动器中运动部件的速度，k为音圈驱动器内部板簧的弹性系数，x为音圈相对于平衡位置的位移量，F
f
为作用在音圈上的运行阻力；
[0007]b)通过公式计算得到对扰动力F
d
的估计值式中D为常数矩
阵。D＝[0 1]，L为扰动观测器参数向量，向量元素L1和L2均为可调参数，为的微分，的微分，
[0008]c)通过公式计算得到等价控制力F
eq
，式中k1和k2为构造的线性输出函数的比例参数，f为简谐运动频率，t为时间；
[0009]d)通过公式计算得到有限时间收敛力F
con
，式中K
λ
为可调参数，K
λ
＞0；
[0010]e)根据公式计算得到期望的控制力F
des
；
[0011]f)通过公式计算得到使音圈驱动器工作的音圈电流i
des
，K
s
为电机常数；
[0012]g)将音圈型驱动器建立基于PI控制的电流闭环控制，通过音圈电流i
des
驱动音圈驱动器动作。
[0013]进一步的，步骤a)中音圈驱动器中运动部件包括音圈驱动器的连杆以及音圈驱动器的音圈。
[0014]本专利技术的有益效果是：不同于已有控制方法对时变非线性负载不做显性处理或采用固定参数模型进行主动补偿，本专利技术可实现对时变非线性负载和系统模型不确定性动态进行实时在线估计与主动补偿，更适用于拖动宽动态范围复杂时变非线性负载的音圈型驱动器的位移控制。通过在线估计和主动补偿的方法，可抵消包含时变非线性负载与系统模型不确定性动态在内的等效匹配注入扰动，从而通过反馈的方法将补偿后的系统改造为典
型的二阶系统，具备更理想的动态特性。在抵消等效注入扰动的基础上引入有限时间收敛律。可减少输出位移与参考位移的相位差，同时有效降低切换控制量，避免抖震效应对系统控制品质的劣化。本专利技术不同于常规基于模型的控制方法，无需对控制对象做大量测试工作以用于建模。唯一需要获取的运动部件总质量这一参数通常可采用称重的方式来测得，对实际方法实施提供了极大的便利。
附图说明
[0015]图1为本专利技术的控制系统结构图；
[0016]图2为本专利技术的方法原理图。
具体实施方式
[0017]下面结合附图1、附图2对本专利技术做进一步说明。
[0018]如附图2所示，一种基于匹配扰动补偿的音圈驱动器力输出式位移控制方法，包括如下步骤：
[0019]a)通过公式建立包含具有作用力量纲的等效匹配注入扰动力的音圈型驱动器的数学模型，其中为音圈驱动器中运动部件的加速度，M为音圈驱动器中运动部件的总质量，F
a
为作用在音圈上的电磁力，F
d
为具有作用力量纲的等效匹配注入扰动力，C为音圈驱动器的机械阻尼系数，为音圈驱动器中运动部件的速度，k为音圈驱动器内部板簧的弹性系数，x为音圈相对于平衡位置的位移量，F
f
为作用在音圈上的运行阻力；
[0020]b)通过公式计算得到对扰动力F
d
的估计值式中D为常数矩阵。D＝[0 1]，L为扰动观测器参数向量，向量元素L1和L2均为可调参数，为的微分，的微分，
[0021]c)通过公式计算得到等价控制力F
eq
，式中k1和k2为构造的线性输出函数的比例参数，f为简谐运动频率，t为时间；
[0022]d)通过公式计算得到有限时间收敛力F
con
，式中K
λ
为可调参数，K
λ
＞0；
[0023]e)根据公式计算得到期望的控制力F
des
；
[0024]f)通过公式计算得到使音圈驱动器工作的音圈电流i
des
，K
s
为电机常数；
[0025]g)将音圈型驱动器建立基于PI控制的电流闭环控制，通过音圈电流i
des
驱动音圈驱动器动作。
[0026]如附图1所示，本专利技术的硬件部分主要包括位移传感器，嵌入式控制器，直流稳压电源，电流调节器。位移传感器采用直线正交编码器或LVDT获取。嵌入式控制器可选用数字信号处理器或ARM微控制器芯片。电流调节器电路拓扑为两相全桥IGBT或PowerMOSFET。直流稳压电源使用线性模拟电源或开关电源。嵌入式控制器到电流调节器电路的信号为脉宽调制信号。
[0027]不同于已有控制方法对时变非线性本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于匹配扰动补偿的音圈驱动器力输出式位移控制方法，其特征在于，包括如下步骤：a)通过公式建立包含具有作用力量纲的等效匹配注入扰动力的音圈型驱动器的数学模型，其中为音圈驱动器中运动部件的加速度，M为音圈驱动器中运动部件的总质量，F
a
为作用在音圈上的电磁力，F
d
为具有作用力量纲的等效匹配注入扰动力，C为音圈驱动器的机械阻尼系数，为音圈驱动器中运动部件的速度，k为音圈驱动器内部板簧的弹性系数，x为音圈相对于平衡位置的位移量，F
f
为作用在音圈上的运行阻力；b)通过公式计算得到对扰动力F
d
的估计值式中D为常数矩阵。D＝[0 1]，L为扰动观测器参数向量，向量元素L1和L2均为可调参数，均为可调参数，为的微分，的微分，c)通过公式计算得到等价控制力F...

【专利技术属性】
技术研发人员：王若同，舒明雷，王英龙，陈超，
申请(专利权)人：山东省人工智能研究院，
类型：发明
国别省市：