CN110034715A - 一种基于扰动估计的音圈电机运动控制方法及相关设备 - Google Patents
一种基于扰动估计的音圈电机运动控制方法及相关设备 Download PDFInfo
- Publication number
- CN110034715A CN110034715A CN201910452342.XA CN201910452342A CN110034715A CN 110034715 A CN110034715 A CN 110034715A CN 201910452342 A CN201910452342 A CN 201910452342A CN 110034715 A CN110034715 A CN 110034715A
- Authority
- CN
- China
- Prior art keywords
- signal
- voice coil
- coil motor
- displacement
- disturbance
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Classifications
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
- H02P23/14—Estimation or adaptation of motor parameters, e.g. rotor time constant, flux, speed, current or voltage
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
- H02P25/00—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details
- H02P25/02—Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details characterised by the kind of motor
- H02P25/032—Reciprocating, oscillating or vibrating motors
- H02P25/034—Voice coil motors
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Control Of Electric Motors In General (AREA)
Abstract
本申请公开了一种基于扰动估计的音圈电机运动控制方法、装置、电子设备及系统,该控制方法包括:获取音圈电机的位移规划信号和实际位移信号;调用预先基于音圈电机的模型参数所设计的状态扩张观测器,根据实际位移信号和总控制量进行状态估计以获取位移观测信号、速度观测信号和扰动观测信号;根据位移规划信号与位移观测信号计算位移误差信号;根据位移误差信号、速度观测信号和扰动观测信号更新计算总控制量;输出与总控制量对应的驱动信号至音圈电机的驱动端,以便调节音圈电机的运动。本申请基于根据音圈电机的模型参数而预设的状态扩张观测器,对系统的外部扰动信号进行精确观测和针对性控制补偿,提高了控制精度、响应速度和抗干扰性。
Description
技术领域
本申请涉及自动控制技术领域,特别涉及一种基于扰动估计的音圈电机运动控制方法、装置、电子设备及系统。
背景技术
音圈电机(Voice Coil Motor,VCM)作为一种特殊形式的直流直线电机,具有高速、高加速以及高频往复运动的运动特性,被广泛应用于芯片封装的精密定位系统中,有效解决了精度与速度和大行程之间的矛盾。随着超精密定位系统性能指标的提高,对音圈电机的各项参数指标要求更加苛刻。运动控制策略作为音圈电机精密运动系统的关键技术之一,也是控制器的核心技术,在提高高响应速度下的定位精度和抗干扰能力,一直是研究的难点。
目前,PID控制仍然是音圈电机精密定位系统中最常见的控制策略,其控制结构简单,参数调整方便。但是PID控制具有快速性和超调性的矛盾,严重限制了音圈电机高定位精度指标下的运动速度。另外由于音圈电机消除了中间传动环间,使得外部扰动和负载变化直接作用在电机上,对系统鲁棒提出了更高的要求,传统的PID控制越来越难以满足音圈电机伺服控制的需求。在PID基础上,现有技术中提出了一种以状态扩张观测器(ExtendedState Observer,ESO)核心的自抗扰控制策略,不仅保留了PID控制的精髓,而且可以对总扰动进行估计补偿;现有技术中还提出了带有模型信息的扩张状态观测器。但是,该状态扩张观测器没有充分利用已知的音圈电机的模型信息,而是将音圈电机的模型参数信息作为未知,与外界的未知扰动统一为一个总的扰动进行观测估计,从而在控制律中予以补偿。这种方法会显著降低控制量的输出速度,进而会影响音圈电机运动系统的响应速度。
鉴于此,提供一种解决上述技术问题的方案,已经是本领域技术人员所亟需关注的。
发明内容
本申请的目的在于提供一种基于扰动估计的音圈电机运动控制方法、装置、电子设备及系统,以便充分利用已知的音圈电机的模型信息,进而有效提高音圈电机的运动控制精度、响应速度以及抗干扰性。
为解决上述技术问题,第一方面,本申请公开了一种基于扰动估计的音圈电机运动控制方法,包括:
获取音圈电机的位移规划信号和实际位移信号;
调用预先基于所述音圈电机的模型参数所设计的状态扩张观测器,根据所述实际位移信号和总控制量进行状态估计以获取位移观测信号、速度观测信号和扰动观测信号;
根据所述位移规划信号与所述位移观测信号计算位移误差信号;
根据所述位移误差信号、所述速度观测信号和所述扰动观测信号更新计算所述总控制量;
输出与所述总控制量对应的驱动信号至所述音圈电机的驱动端,以便调节所述音圈电机的运动。
可选地,所述根据所述实际位移信号和总控制量进行状态估计以获取位移观测信号、速度观测信号和扰动观测信号,包括:
将所述实际位移信号和所述总控制量代入预设观测表达式以计算所述位移观测信号、所述速度观测信号和所述扰动观测信号,所述预设观测表达式为:
其中,y为所述实际位移信号;u为所述总控制量;z1为所述位移观测信号;z2为所述速度观测信号;z3为所述扰动观测信号;l1、l2和l3均为观测参数;a0、a1和b0均为所述音圈电机的模型参数。
可选地,所述音圈电机的模型为:
其中,v为所述音圈电机的实际速度信号;w(t)为外部扰动信号。
可选地,所述观测参数为:
其中,wo为观测带宽参数。
可选地,所述根据所述位移误差信号、所述速度观测信号和所述扰动观测信号更新计算所述总控制量,包括:
将所述位移误差信号、所述速度观测信号和所述扰动观测信号代入第一预设总控制量计算公式以更新计算所述总控制量,所述第一预设总控制量计算公式为:
其中,kp和kd均为控制参数;ey=r-z1为所述位移误差信号,r为所述位移规划信号。
可选地,还包括:获取所述音圈电机的速度规划信号;
所述根据所述位移误差信号、所述速度观测信号和所述扰动观测信号更新计算所述总控制量,包括:
将所述位移误差信号、所述速度观测信号、所述速度规划信号和所述扰动观测信号代入第二预设总控制量计算公式以更新计算所述总控制量,所述第二预设总控制量计算公式为:
其中,kp和kd均为控制参数;ey=r-z1为所述位移误差信号,r为所述位移规划信号;vi为所述速度规划信号。
可选地,所述控制参数为:
其中,c为系统阻尼系数,wc为控制带宽参数。
第二方面,本申请还公开了一种基于扰动估计的音圈电机运动控制装置,包括:
获取模块,用于获取音圈电机的位移规划信号和实际位移信号;
观测模块,用于调用基于所述音圈电机的模型参数而预设的状态扩张观测器,根据所述实际位移信号和总控制量进行状态估计以获取位移观测信号、速度观测信号和扰动观测信号;
控制模块,用于根据所述位移规划信号与所述位移观测信号计算位移误差信号;根据所述位移误差信号、所述速度观测信号和所述扰动观测信号更新计算所述总控制量;
输出模块,用于输出与所述总控制量对应的驱动信号至所述音圈电机的驱动端,以便调节所述音圈电机的运动。
第三方面,本申请还公开了一种基于扰动估计的音圈电机运动控制电子设备,包括:
存储器,用于存储计算机程序;
处理器,用于执行所述计算机程序以实现如上所述的任一种基于扰动估计的音圈电机运动控制方法的步骤。
第四方面,本申请还公开了一种基于扰动估计的音圈电机运动控制系统,包括用于检测音圈电机的实际位移信号的传感器,以及如上所述的基于扰动估计的音圈电机运动控制电子设备。
本申请所提供的基于扰动估计的音圈电机运动控制方法包括:获取音圈电机的位移规划信号和实际位移信号;调用预先基于所述音圈电机的模型参数所设计的状态扩张观测器,根据所述实际位移信号和总控制量进行状态估计以获取位移观测信号、速度观测信号和扰动观测信号;根据所述位移规划信号与所述位移观测信号计算位移误差信号;根据所述位移误差信号、所述速度观测信号和所述扰动观测信号更新计算所述总控制量;输出与所述总控制量对应的驱动信号至所述音圈电机的驱动端,以便调节所述音圈电机的运动。
可见,本申请充分利用了音圈电机的模型参数信息,基于根据音圈电机的模型参数而预先设计的状态扩张观测器,对系统的外部扰动信号进行精确观测进而进行针对性控制补偿,从而可极大地提高音圈电机的运动控制精度、响应速度和抗干扰性。本申请所提供的基于扰动估计的音圈电机运动控制装置、电子设备及系统同样具有上述有益效果。
附图说明
为了更清楚地说明现有技术和本申请实施例中的技术方案,下面将对现有技术和本申请实施例描述中需要使用的附图作简要的介绍。当然,下面有关本申请实施例的附图描述的仅仅是本申请中的一部分实施例,对于本领域普通技术人员来说,在不付出创造性劳动的前提下,还可以根据提供的附图获得其他的附图,所获得的其他附图也属于本申请的保护范围。
图1为本申请实施例公开的一种基于扰动估计的音圈电机运动控制方法的流程图;
图2为本申请实施例公开的一种基于扰动估计的音圈电机运动控制方法的控制原理图;
图3为本申请实施例公开的一种位移规划信号的曲线图;
图4为本申请实施例公开的一种速度规划信号的曲线图;
图5为本申请实施例公开的基于扰动估计的音圈电机运动控制方法的位移响应曲线图;
图6为图5的细节放大图;
图7为本申请实施例公开的基于扰动估计的音圈电机运动控制方法的速度响应曲线图;
图8为图7的细节放大图;
图9为本申请实施例公开的基于扰动估计的音圈电机运动控制方法中总控制量的曲线图;
图10为本申请实施例公开的基于扰动估计的音圈电机运动控制方法的扰动观测信号的曲线图;
图11为本申请实施例公开的基于扰动估计的音圈电机运动控制方法在外部扰动信号作用下的位移响应曲线图;
图12为本申请实施例公开的基于扰动估计的音圈电机运动控制方法在外部扰动信号作用下的速度响应曲线图;
图13为本申请实施例公开的一种基于扰动估计的音圈电机运动控制装置的结构框图。
具体实施方式
本申请的核心在于提供一种基于扰动估计的音圈电机运动控制方法、装置、电子设备及系统,以便充分利用已知的音圈电机的模型信息,进而有效提高音圈电机的运动控制精度、响应速度以及抗干扰性。
为了对本申请实施例中的技术方案进行更加清楚、完整地描述,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行介绍。显然,所描述的实施例仅仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
当前,为了对广泛应用于芯片封装的精密定位系统中的音圈电机进行精密运动控制,现有技术中提供了一种以状态扩张观测器核心的自抗扰控制策略,不仅保留了PID控制的精髓,而且可以对总扰动进行估计补偿。但是,该状态扩张观测器没有充分利用已知的音圈电机的模型信息,而是将音圈电机的模型参数信息作为未知,与外界的未知扰动统一为一个总的扰动进行观测估计,因而显著降低了控制量的输出速度,进而影响了音圈电机运动系统的响应速度。鉴于此,本申请提供了一种基于扰动估计的音圈电机运动控制方法,可有效解决上述问题。
参见图1所示,本申请实施例公开了一种基于扰动估计的音圈电机运动控制方法,主要包括:
S11:获取音圈电机的位移规划信号r和实际位移信号y。
S12:调用预先基于音圈电机的模型参数所设计的状态扩张观测器,根据实际位移信号y和总控制量u进行状态估计以获取位移观测信号z1、速度观测信号z2和扰动观测信号z3。
S13:根据位移规划信号r与位移观测信号z1计算位移误差信号ey。
S14:根据位移误差信号ey、速度观测信号z2和扰动观测信号z3更新计算总控制量u。
S15:输出与总控制量u对应的驱动信号至音圈电机的驱动端,以便调节音圈电机的运动。
参见图2所示,图2为本申请实施例所公开的基于扰动估计的音圈电机运动控制方法的控制原理图。其中,w(t)为外部扰动信号。
首先需要说明的是,音圈电机是一种特殊的直线电机,所以对音圈电机的运动控制一般包括音圈电机的位移控制,音圈电机也因此多应用于芯片封装的精密定位系统中。
还需要指出的是,本实施例中,用于进行扰动估计的状态扩张观测器,具体是基于音圈电机的模型参数而设计的。其中,音圈电机的模型参数可通过系统辨识、查找音圈电机的产品说明书等方式而获取。在获取了音圈电机的模型参数之后,可利用该音圈电机的模型参数来设计状态扩张观测器,则音圈电机部分已经无需再进行估计,由此,通过状态扩张观测器所获取的扰动观测信号z3就仅仅是外部扰动信号w(t)的估计结果,并不包含现有技术中对于音圈电机的模型结构的估计结果,由此可有效提高针对于外部未知扰动的估计精确度。
由状态扩张观测器得到的扰动观测信号z3将与位移观测信号z1和速度观测信号z2一同用于更新计算总控制量u,以便实时调节与总控制量u对应的、用于驱动音圈电机的驱动信号。可想而知,基于精确度较高的扰动观测信号z3所计算生成的总控制量u,也势必具有较高的准确性,从而能有效提高对音圈电机的运动控制精度和相应速度。
一般地,音圈电机可由电压信号来驱动,音圈电机的输出力的大小取决于由电压信号所产生的电流大小。因此,具体地,所述驱动信号可具体为电压信号。当然,也可以采用电流驱动方式,即,所述驱动信号也可具体为电流信号。
本实施例所提供的基于扰动估计的音圈电机运动控制方法包括:获取音圈电机的位移规划信号r和实际位移信号y;调用预先基于音圈电机的模型参数所设计的状态扩张观测器,根据实际位移信号y和总控制量u进行状态估计以获取位移观测信号z1、速度观测信号z2和扰动观测信号z3;根据位移规划信号r与位移观测信号z1计算位移误差信号ey;根据位移误差信号ey、速度观测信号z2和扰动观测信号z3更新计算总控制量u;输出与总控制量u对应的驱动信号至音圈电机的驱动端,以便调节音圈电机的运动。可见,本申请充分利用了音圈电机的模型参数信息,基于根据音圈电机的模型参数而预先设计的状态扩张观测器,对系统的外部扰动信号w(t)进行精确观测进而进行针对性控制补偿,从而可极大地提高音圈电机的运动控制精度、响应速度和抗干扰性。
本申请实施例所提供的基于扰动估计的音圈电机运动控制方法,在上述内容的基础上,作为一种具体实施例,在步骤S12中可具体将实际位移信号y和总控制量u代入预设观测表达式以计算位移观测信号z1、速度观测信号z2和扰动观测信号z3,预设观测表达式为:
其中,l1、l2和l3均为观测参数;a0、a1和b0均为音圈电机的模型参数。
其中,如前文所述,音圈电机的模型参数可基于音圈电机的模型利用系统辨识等方式获取。作为一种具体实施例,所述音圈电机的模型为:
其中,v为音圈电机的实际速度信号;w(t)为外部扰动信号。
如此,针对某个音圈电机,通过获取其在已知的总控制量u和已知的外部扰动信号w(t)作用下的实际位移、速度、加速度,即可将模型参数辨识出来。
其中,进一步地,可采用带宽整定法来设计观测参数的大小。由此,观测参数可以具体为:
其中,wo为观测带宽参数。
本申请实施例所提供的基于扰动估计的音圈电机运动控制方法,在上述内容的基础上,作为一种具体实施例,在步骤S14中可具体将位移误差信号ey、速度观测信号z2和扰动观测信号z3代入第一预设总控制量计算公式以更新计算总控制量u,第一预设总控制量计算公式为:
其中,kp和kd均为控制参数;ey=r-z1为位移误差信号。
本申请实施例所提供的基于扰动估计的音圈电机运动控制方法,在上述内容的基础上,作为一种具体实施例,在步骤S11中还可以包括:获取音圈电机的速度规划信号;则在步骤S14中可具体将位移误差信号ey、速度观测信号z2、速度规划信号和扰动观测信号z3代入第二预设总控制量计算公式以更新计算总控制量u,第二预设总控制量计算公式为:
其中,kp和kd均为控制参数;ey=r-z1为位移误差信号;vi为速度规划信号。
本领域技术人员可根据实际应用需要而自行选择上述两种总控制量u的计算方式中的任意一种。当然,采用除上述两种计算方式以外的其他方式也可,本申请并不做进一步的限定。
在上述两种总控制量u的计算方式中,进一步地,控制参数可具体采用带宽整定法来设定。由此,控制参数可具体为:
其中,c为系统阻尼系数,wc为控制带宽参数。
下面将结合具体图示对本申请所提供的基于扰动估计的音圈电机运动控制方法的有益效果进行说明。
参见图3和图4所示,图3为本申请实施例公开的一种位移规划信号的曲线图;图4为本申请实施例公开的一种速度规划信号的曲线图。
依据图3和图4,音圈电机应当先后经过匀加速-匀速-匀减速这三个过程,最终稳定在稳态位移对应的位置处。
参见图5~图9所示,图5为本申请实施例公开的基于扰动估计的音圈电机运动控制方法的位移响应曲线图;图6为图5的细节放大图;图7为本申请实施例公开的基于扰动估计的音圈电机运动控制方法的速度响应曲线图;图8为图7的细节放大图;图9为本申请实施例公开的基于扰动估计的音圈电机运动控制方法中总控制量u的曲线图。
可见,相较于现有技术中常规ESO的控制方法,本申请所提供的基于扰动估计的音圈电机运动控制方法无超调,可有效提高对音圈电机的位移控制精度;同时,相较于现有技术中含模型ESO的控制方法,本申请所提供的基于扰动估计的音圈电机运动控制方法的调节时间短,响应快速。
参见图10~图12所示,图10为本申请实施例公开的基于扰动估计的音圈电机运动控制方法的扰动观测信号z3的曲线图;图11为本申请实施例公开的基于扰动估计的音圈电机运动控制方法在外部扰动信号作用下的位移响应曲线图;图12为本申请实施例公开的基于扰动估计的音圈电机运动控制方法在外部扰动信号作用下的速度响应曲线图。
在第4~6s的时间段内加入了一定幅值的外部扰动信号,基于本申请实施例所提供的基于扰动估计的音圈电机运动控制方法,在外部扰动信号施加时和撤去时,均可对音圈电机的运动位移和速度进行有效地调控,将位移和速度迅速调节至目标规划值。相比较于现有技术中常规ESO以及含模型ESO的控制方法,本申请实施例所提供的基于扰动估计的音圈电机运动控制方法能够有效提高对外部扰动信号的观测估计精度,进而提高系统的抗干扰性。
参见图13所示,本申请实施例公开了一种基于扰动估计的音圈电机运动控制装置,主要包括:
获取模块100,用于获取音圈电机的位移规划信号r和实际位移信号y;
观测模块200,用于调用基于音圈电机的模型参数而预设的状态扩张观测器,根据实际位移信号y和总控制量u进行状态估计以获取位移观测信号z1、速度观测信号z2和扰动观测信号z3;
控制模块300,用于根据位移规划信号r与位移观测信号z1计算位移误差信号ey;根据位移误差信号ey、速度观测信号z2和扰动观测信号z3更新计算总控制量u;
输出模块400,用于输出与总控制量u对应的驱动信号至音圈电机的驱动端,以便调节音圈电机的运动。
可见,本申请实施例所公开的基于扰动估计的音圈电机运动控制装置,充分利用了音圈电机的模型参数信息,基于根据音圈电机的模型参数而预先设计的状态扩张观测器,对系统的外部扰动信号进行精确观测进而进行针对性控制补偿,从而可极大地提高音圈电机的运动控制精度、响应速度和抗干扰性。
进一步地,本申请还公开了一种基于扰动估计的音圈电机运动控制电子设备,包括:
存储器,用于存储计算机程序;
处理器,用于执行所述计算机程序以实现如上所述的任一种基于扰动估计的音圈电机运动控制方法的步骤。
进一步地,本申请还公开了一种基于扰动估计的音圈电机运动控制系统,包括用于检测音圈电机的实际位移信号的传感器,以及如上所述的基于扰动估计的音圈电机运动控制电子设备。
关于上述基于扰动估计的音圈电机运动控制装置、电子设备及系统的具体内容,可参考前述关于基于扰动估计的音圈电机运动控制方法的详细介绍,这里就不再赘述。
本申请中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的设备而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
还需说明的是,在本申请文件中,诸如“第一”和“第二”之类的关系术语,仅仅用来将一个实体或者操作与另一个实体或者操作区分开来,而不一定要求或者暗示这些实体或者操作之间存在任何这种实际的关系或者顺序。此外,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
以上对本申请所提供的技术方案进行了详细介绍。本文中应用了具体个例对本申请的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本申请的方法及其核心思想。应当指出,对于本技术领域的普通技术人员来说,在不脱离本申请原理的前提下,还可以对本申请进行若干改进和修饰,这些改进和修饰也落入本申请的保护范围内。
Claims (10)
1.一种基于扰动估计的音圈电机运动控制方法,其特征在于,包括:
获取音圈电机的位移规划信号和实际位移信号;
调用预先基于所述音圈电机的模型参数所设计的状态扩张观测器,根据所述实际位移信号和总控制量进行状态估计以获取位移观测信号、速度观测信号和扰动观测信号;
根据所述位移规划信号与所述位移观测信号计算位移误差信号;
根据所述位移误差信号、所述速度观测信号和所述扰动观测信号更新计算所述总控制量;
输出与所述总控制量对应的驱动信号至所述音圈电机的驱动端,以便调节所述音圈电机的运动。
2.根据权利要求1所述的音圈电机运动控制方法,其特征在于,所述根据所述实际位移信号和总控制量进行状态估计以获取位移观测信号、速度观测信号和扰动观测信号,包括:
将所述实际位移信号和所述总控制量代入预设观测表达式以计算所述位移观测信号、所述速度观测信号和所述扰动观测信号,所述预设观测表达式为:
其中,y为所述实际位移信号;u为所述总控制量;z1为所述位移观测信号;z2为所述速度观测信号;z3为所述扰动观测信号;l1、l2和l3均为观测参数;a0、a1和b0均为所述音圈电机的模型参数。
3.根据权利要求2所述的音圈电机运动控制方法,其特征在于,所述音圈电机的模型为:
其中,v为所述音圈电机的实际速度信号;w(t)为外部扰动信号。
4.根据权利要求2所述的音圈电机运动控制方法,其特征在于,所述观测参数为:
l1=3wo;
其中,wo为观测带宽参数。
5.根据权利要求2所述的音圈电机运动控制方法,其特征在于,所述根据所述位移误差信号、所述速度观测信号和所述扰动观测信号更新计算所述总控制量,包括:
将所述位移误差信号、所述速度观测信号和所述扰动观测信号代入第一预设总控制量计算公式以更新计算所述总控制量,所述第一预设总控制量计算公式为:
其中,kp和kd均为控制参数;ey=r-z1为所述位移误差信号,r为所述位移规划信号。
6.根据权利要求2所述的音圈电机运动控制方法,其特征在于,还包括:获取所述音圈电机的速度规划信号;
所述根据所述位移误差信号、所述速度观测信号和所述扰动观测信号更新计算所述总控制量,包括:
将所述位移误差信号、所述速度观测信号、所述速度规划信号和所述扰动观测信号代入第二预设总控制量计算公式以更新计算所述总控制量,所述第二预设总控制量计算公式为:
其中,kp和kd均为控制参数;ey=r-z1为所述位移误差信号,r为所述位移规划信号;vi为所述速度规划信号。
7.根据权利要求5或者6所述的音圈电机运动控制方法,其特征在于,所述控制参数为:
其中,c为系统阻尼系数,wc为控制带宽参数。
8.一种基于扰动估计的音圈电机运动控制装置,其特征在于,包括:
获取模块,用于获取音圈电机的位移规划信号和实际位移信号;
观测模块,用于调用基于所述音圈电机的模型参数而预设的状态扩张观测器,根据所述实际位移信号和总控制量进行状态估计以获取位移观测信号、速度观测信号和扰动观测信号;
控制模块,用于根据所述位移规划信号与所述位移观测信号计算位移误差信号;根据所述位移误差信号、所述速度观测信号和所述扰动观测信号更新计算所述总控制量;
输出模块,用于输出与所述总控制量对应的驱动信号至所述音圈电机的驱动端,以便调节所述音圈电机的运动。
9.一种基于扰动估计的音圈电机运动控制电子设备,其特征在于,包括:
存储器,用于存储计算机程序;
处理器,用于执行所述计算机程序以实现如权利要求1至7任一项所述的基于扰动估计的音圈电机运动控制方法的步骤。
10.一种基于扰动估计的音圈电机运动控制系统,其特征在于,包括用于检测音圈电机的实际位移信号的传感器,以及如权利要求9所述的基于扰动估计的音圈电机运动控制电子设备。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910452342.XA CN110034715B (zh) | 2019-05-28 | 2019-05-28 | 一种基于扰动估计的音圈电机运动控制方法及相关设备 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910452342.XA CN110034715B (zh) | 2019-05-28 | 2019-05-28 | 一种基于扰动估计的音圈电机运动控制方法及相关设备 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110034715A true CN110034715A (zh) | 2019-07-19 |
CN110034715B CN110034715B (zh) | 2020-09-11 |
Family
ID=67243629
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910452342.XA Active CN110034715B (zh) | 2019-05-28 | 2019-05-28 | 一种基于扰动估计的音圈电机运动控制方法及相关设备 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110034715B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112821837A (zh) * | 2021-01-22 | 2021-05-18 | 维沃移动通信有限公司 | 设备控制方法、装置和电子设备 |
CN115085611A (zh) * | 2022-08-22 | 2022-09-20 | 广东工业大学 | 一种直线电机运动控制方法、装置、设备及存储介质 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20060023340A1 (en) * | 2004-07-29 | 2006-02-02 | Young-Hoon Kim | Servo controller method and apparatus for high tracks per inch hard disk drives using a delay accomodating state estimator |
JP4670405B2 (ja) * | 2005-02-09 | 2011-04-13 | 日本電産株式会社 | 同期電動機のベクトル制御方法 |
CN102983797A (zh) * | 2012-11-07 | 2013-03-20 | 天津大学 | 一种基于线性自抗扰控制器的粗纱机同步控制方法 |
US8902540B2 (en) * | 2012-11-30 | 2014-12-02 | Kabushiki Kaisha Toshiba | Disk storage apparatus and method for servo controlling |
CN106788036A (zh) * | 2016-12-30 | 2017-05-31 | 南京邮电大学 | 一种直流电机的改进型自抗扰位置控制器及其设计方法 |
CN107977987A (zh) * | 2017-11-20 | 2018-05-01 | 北京理工大学 | 一种无人机载多目标探测跟踪、指示系统及方法 |
CN109546898A (zh) * | 2018-12-22 | 2019-03-29 | 上海物景智能科技有限公司 | 一种基于adrc算法的电机转速控制方法、装置及系统 |
CN109676634A (zh) * | 2018-08-28 | 2019-04-26 | 杭州电子科技大学 | 自抗扰控制器及工业机器人 |
-
2019
- 2019-05-28 CN CN201910452342.XA patent/CN110034715B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20060023340A1 (en) * | 2004-07-29 | 2006-02-02 | Young-Hoon Kim | Servo controller method and apparatus for high tracks per inch hard disk drives using a delay accomodating state estimator |
JP4670405B2 (ja) * | 2005-02-09 | 2011-04-13 | 日本電産株式会社 | 同期電動機のベクトル制御方法 |
CN102983797A (zh) * | 2012-11-07 | 2013-03-20 | 天津大学 | 一种基于线性自抗扰控制器的粗纱机同步控制方法 |
US8902540B2 (en) * | 2012-11-30 | 2014-12-02 | Kabushiki Kaisha Toshiba | Disk storage apparatus and method for servo controlling |
CN106788036A (zh) * | 2016-12-30 | 2017-05-31 | 南京邮电大学 | 一种直流电机的改进型自抗扰位置控制器及其设计方法 |
CN107977987A (zh) * | 2017-11-20 | 2018-05-01 | 北京理工大学 | 一种无人机载多目标探测跟踪、指示系统及方法 |
CN109676634A (zh) * | 2018-08-28 | 2019-04-26 | 杭州电子科技大学 | 自抗扰控制器及工业机器人 |
CN109546898A (zh) * | 2018-12-22 | 2019-03-29 | 上海物景智能科技有限公司 | 一种基于adrc算法的电机转速控制方法、装置及系统 |
Non-Patent Citations (4)
Title |
---|
ZHONGXU WANG ET AL: "A Single Position Loop Control Strategy for High-Speed Voice Coil Motor Based on Active Disturbance Rejection Control", 《2017 IEEE 26TH INTERNATIONAL SYMPOSIUM ON INDUSTRIAL ELECTRONICS (ISIE)》 * |
刘川 等: "直线电机的线性自抗扰控制", 《电机与控制学报》 * |
周英超 等: "机械式自动变速器直线换挡执行器位移串级控制", 《电机与控制学报》 * |
王大彧 等: "基于扩张状态观测器的直驱阀用音圈电机控制系统", 《中国电机工程学报》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112821837A (zh) * | 2021-01-22 | 2021-05-18 | 维沃移动通信有限公司 | 设备控制方法、装置和电子设备 |
CN115085611A (zh) * | 2022-08-22 | 2022-09-20 | 广东工业大学 | 一种直线电机运动控制方法、装置、设备及存储介质 |
CN115085611B (zh) * | 2022-08-22 | 2022-11-15 | 广东工业大学 | 一种直线电机运动控制方法、装置、设备及存储介质 |
WO2024041042A1 (zh) * | 2022-08-22 | 2024-02-29 | 广东工业大学 | 一种直线电机运动控制方法、装置、设备及存储介质 |
US20240176315A1 (en) * | 2022-08-22 | 2024-05-30 | Guangdong University Of Technology | Linear motor motion control method, device, equipment and storage medium |
US12117782B2 (en) | 2022-08-22 | 2024-10-15 | Guangdong University Of Technology | Linear motor motion control method, device, equipment and storage medium |
Also Published As
Publication number | Publication date |
---|---|
CN110034715B (zh) | 2020-09-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104639003B (zh) | 一种交流伺服系统的转动惯量辨识方法 | |
CN101369133B (zh) | 基于灰色预估器的低速摩擦伺服系统滑模变结构控制方法 | |
CN109617485B (zh) | 一种基于Tabu和DOB的永磁直线电机推力波动复合抑制方法 | |
CN103926875B (zh) | 一种滚珠丝杠进给系统摩擦补偿方法 | |
CN110034715A (zh) | 一种基于扰动估计的音圈电机运动控制方法及相关设备 | |
CN101373947B (zh) | 一种步进电机速度的控制方法、装置及系统 | |
CN107395083A (zh) | Pmlsm伺服控制系统位置与速度估计方法及装置 | |
CN104201967A (zh) | 一种采用自抗扰控制技术的网络化永磁同步电机时延补偿和控制方法 | |
CN103197556A (zh) | 基于吸引律的二分之一周期重复控制方法 | |
CN113268040A (zh) | 一种数控机床伺服进给系统控制参数的优选方法 | |
CN110716430A (zh) | 一种采用等效扰动补偿的伺服系统快速吸引重复控制方法 | |
CN115157250A (zh) | 一种七自由度机械臂动力学参数辨识方法 | |
CN108015761B (zh) | 一种单连杆柔性机械臂控制方法及系统 | |
CN113886992B (zh) | 一种基于多保真度数据的数字孪生建模方法 | |
CN114083770A (zh) | 工艺参数调整及模型训练方法、装置、设备与存储介质 | |
CN106899253A (zh) | 一种采用可变增益的模型参考自适应惯量辨识方法 | |
CN101997480A (zh) | 马达控制方法 | |
CN117332313A (zh) | 预测模型构建、振动量预测方法、装置和系统 | |
CN108492040A (zh) | 一种智能建筑管理装置 | |
CN109164754A (zh) | 一种伺服驱动器位置命令的平滑方法及其控制装置 | |
CN104668493A (zh) | 一种连铸机结晶器的复合振动控制系统及其控制方法 | |
CN113486523B (zh) | 一种线性变参数振动系统全局辨识方法 | |
CN113258849B (zh) | 一种永磁同步电机控制参数智能辨识方法 | |
CN115406686A (zh) | 一种基于工业机器人的振动状态分析方法 | |
CN115237055A (zh) | 一种数控机床加工精度智能分析方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |