CN114244195A - 基于pid的无刷直流电机控制方法、系统、装置及存储介质 - Google Patents
基于pid的无刷直流电机控制方法、系统、装置及存储介质 Download PDFInfo
- Publication number
- CN114244195A CN114244195A CN202111667076.6A CN202111667076A CN114244195A CN 114244195 A CN114244195 A CN 114244195A CN 202111667076 A CN202111667076 A CN 202111667076A CN 114244195 A CN114244195 A CN 114244195A
- Authority
- CN
- China
- Prior art keywords
- value
- integral
- motor
- rotating speed
- limit
- 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
- 238000000034 method Methods 0.000 title claims abstract description 53
- 238000004364 calculation method Methods 0.000 claims abstract description 203
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 69
- 230000010354 integration Effects 0.000 claims description 25
- 238000004590 computer program Methods 0.000 claims description 10
- 238000009825 accumulation Methods 0.000 abstract description 4
- 230000008030 elimination Effects 0.000 abstract description 4
- 238000003379 elimination reaction Methods 0.000 abstract description 4
- 239000000126 substance Substances 0.000 description 3
- 230000003247 decreasing effect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005070 sampling Methods 0.000 description 2
- 230000004069 differentiation Effects 0.000 description 1
- 238000011946 reduction process Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Images
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
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/08—Arrangements for controlling the speed or torque of a single motor
-
- 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
-
- 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
- H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
- H02P6/14—Electronic commutators
- H02P6/16—Circuit arrangements for detecting position
- H02P6/17—Circuit arrangements for detecting position and for generating speed information
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Control Of Motors That Do Not Use Commutators (AREA)
Abstract
本申请公开了一种基于PID的无刷直流电机控制方法、系统、装置及计算机可读存储介质,包括:利用位置积分限值公式,对初始位置积分计算值进行限值,得到限值后的限值位置积分计算值;利用位置积分消减公式,对限值位置积分计算值进行积分消减,得到位置积分计算值;利用位置比例积分计算值和电机转速限值积分计算值,得到无刷直流电机的电机方向和电机控制占空比;利用电机方向和电机控制占空比,控制无刷直流电机工作。本申请改进了位置积分算法中的位置积分饱和处理算法,对位置积分计算过程中设定了限值,避免了最终的位置积分值过大,同时,还引入了位置积分快速消除方法,快速消减因积分累计产生的过大的积分值,避免引起超调或抖动现象。
Description
技术领域
本发明涉及自动化控制领域,特别涉及一种基于PID的无刷直流电机控制方法、系统、装置及计算机可读存储介质。
背景技术
目前对电机控制算法主要是经典的PID算法,但此算法只是个基础理论,在实际控制运用中会出现各种问题,比如超调,抖动,积分饱和,电机换向等问题。
为此,需要一种更为稳定可靠的基于PID的无刷直流电机控制方法。
发明内容
有鉴于此,本发明的目的在于提供一种基于PID的无刷直流电机控制方法、系统、装置及计算机可读存储介质,更为稳定可靠。其具体方案如下:
一种基于PID的无刷直流电机控制方法,包括:
根据无刷直流电机的实际位置和目标位置,计算出位置误差值;
利用所述位置误差值和所述位置比例算法,得到位置比例计算值;
利用所述位置误差值和所述位置积分算法,得到位置积分计算值;
利用所述位置比例计算值和所述位置积分计算值,得到所述位置比例积分计算值;
利用所述无刷直流电机的实际电机转速与预设的电机转速限值,得到电机转速差值;
利用所述电机转速差值和限速算法,得到电机转速限值积分计算值;
利用所述位置比例积分计算值和所述电机转速限值积分计算值,得到所述无刷直流电机的电机方向和电机控制占空比;
利用所述电机方向和所述电机控制占空比,控制所述无刷直流电机工作;
其中,所述位置积分算法中的位置积分饱和处理算法包括:
利用位置积分限值公式,对初始位置积分计算值进行限值,得到限值后的限值位置积分计算值;
利用位置积分消减公式,对所述限值位置积分计算值进行积分消减,得到所述位置积分计算值;
其中,所述位置积分限值公式为:
所述位置积分消减公式为:
式中,sum为所述位置误差值的初始位置误差积分值,Emax为所述初始位置误差积分值的最大限值,Emin为所述初始位置误差积分值的最小限值,sum'为所述限值位置积分计算值,Kj为预设的系统参数,x为预设的系统参数,abs()为取绝对值,sum”为所述限值位置积分计算值进行积分消减后得到的所述位置积分计算值。
可选的,还包括:
利用霍尔传感器获取所述无刷直流电机的所述实际位置。
可选的,还包括:
利用可编程2D位置传感器通过PWM,获取所述无刷直流电机的所述实际位置。
可选的,所述利用所述电机方向和所述电机控制占空比,控制所述无刷直流电机工作的过程,包括:
利用预驱芯片根据所述电机方向和所述电机控制占空比,控制所述无刷直流电机工作。
可选的,所述利用所述电机转速差值和限速算法,得到电机转速限值积分计算值的过程,包括:
当所述实际电机转速大于所述电机转速限值后,对所述电机转速差值进行积分,得到速度积分值;
利用位置比例积分计算值和转速限值公式对所述速度积分值进行限值,得到限值后的限值速度积分值;
当所述实际电机转速小于所述电机转速限值后,对所述限值速度积分值进行积分消减,得到所述电机转速限值积分计算值;
其中,所述转速限值公式为:
Smax=Vpi/Ks if Vpi>0;
Smin=Vpi/Ks if Vpi<0;
式中,sums'为所述限值速度积分值,Vpi为所述位置比例积分计算值,Smax为所述限值速度积分值的最大限值,Smin为所述限值速度积分值的最小限值,Ks为电机转速限值积分参数,sums为所述速度积分值,spd为所述实际电机转速,Vmax为所述位置比例积分计算值的最大值,Vmin为所述位置比例积分计算值的最小值,Vp为位置比例计算值,Vi为位置积分计算值。
可选的,所述当所述实际电机转速小于所述电机转速限值后,对所述限值速度积分值进行积分消减,得到电机转速限值积分计算值的过程,包括:
当所述实际电机转速小于所述电机转速限值后,利用速度积分消减公式对所述限值速度积分值进行积分消减,得到消减后的消减速度积分值;
利用所述消减速度积分值和电机转速限值积分计算值公式,得到所述电机转速限值积分计算值;
其中,所述速度积分消减公式为:sums”=sums'–S If(-Slimit)<spd<Slimit;
所述电机转速限值积分计算值公式为:Vs=Ks*sums”;
式中,S为预设的系统参数,sums”为所述消减速度积分值,Slimit为电机转速限值,值为正,Ks为电机转速限值积分参数,Vs为电机转速限值积分计算值。
可选的,所述当所述实际电机转速小于所述电机转速限值后,对所述限值速度积分值进行积分消减,得到电机转速限值积分计算值的过程,包括:
当所述实际电机转速小于所述电机转速限值后,利用速度积分消减公式对所述速度积分值进行积分消减,得到消减后的消减速度积分值;
利用所述消减速度积分值和电机转速限值积分计算值公式,得到所述电机转速限值积分计算值;
其中,所述速度积分消减公式为:
所述电机转速限值积分计算值公式为:Vs=Ks*sums”;
式中,sums'为所述限值速度积分值,Kj为预设的系统参数,x为预设的系统参数,abs()为取绝对值,sums”为所述消减速度积分值,Ks为电机转速限值积分参数,Vs为电机转速限值积分计算值。
本发明还公开了一种基于PID的无刷直流电机控制系统,包括:
位置误差计算模块,用于根据无刷直流电机的实际位置和目标位置,计算出位置误差值;
位置比例计算模块,用于利用所述位置误差值和所述位置比例算法,得到位置比例计算值;
位置积分计算模块,用于利用所述位置误差值和所述位置积分算法,得到位置积分计算值;
位置比例积分计算模块,用于利用所述位置比例计算值和所述位置积分计算值,得到所述位置比例积分计算值;
转速差值计算模块,用于利用所述无刷直流电机的实际电机转速与预设的电机转速限值,得到电机转速差值;
转速积分计算模块,用于利用所述电机转速差值和限速算法,得到电机转速限值积分计算值;
控制信号生成模块,用于利用所述位置比例积分计算值和所述电机转速限值积分计算值,得到所述无刷直流电机的电机方向和电机控制占空比;
电机控制模块,用于利用所述电机方向和所述电机控制占空比,控制所述无刷直流电机工作;
其中,所述位置积分算法中的位置积分饱和处理算法包括:
利用位置积分限值公式,对初始位置积分计算值进行限值,得到限值后的限值位置积分计算值;
利用位置积分消减公式,对所述限值位置积分计算值进行积分消减,得到所述位置积分计算值;
其中,所述位置积分限值公式为:
所述位置积分消减公式为:
式中,sum为所述位置误差值的初始位置误差积分值,Emax为所述初始位置误差积分值的最大限值,Emin为所述初始位置误差积分值的最小限值,sum'为所述限值位置积分计算值,Kj为预设的系统参数,x为预设的系统参数,abs()为取绝对值,sum”为所述限值位置积分计算值进行积分消减后得到的所述位置积分计算值。
本发明还公开了一种基于PID的无刷直流电机控制装置,包括:
存储器,用于存储计算机程序;
处理器,用于执行所述计算机程序以实现如前述的基于PID的无刷直流电机控制方法。
本发明还公开了一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如前述的基于PID的无刷直流电机控制方法。
本发明中基于PID的无刷直流电机控制方法,包括:根据无刷直流电机的实际位置和目标位置,计算出位置误差值;利用位置误差值和位置比例算法,得到位置比例计算值;利用位置误差值和位置积分算法,得到位置积分计算值;利用位置比例计算值和位置积分计算值,得到位置比例积分计算值;利用无刷直流电机的实际电机转速与预设的电机转速限值,得到电机转速差值;利用电机转速差值和限速算法,得到电机转速限值积分计算值;利用位置比例积分计算值和电机转速限值积分计算值,得到无刷直流电机的电机方向和电机控制占空比;利用电机方向和电机控制占空比,控制无刷直流电机工作;其中,位置积分算法中的位置积分饱和处理算法包括:利用位置积分限值公式,对初始位置积分计算值进行限值,得到限值后的限值位置积分计算值;利用位置积分消减公式,对限值位置积分计算值进行积分消减,得到位置积分计算值;其中,位置积分限值公式为:
位置积分消减公式为:
式中,sum为位置误差值的初始位置误差积分值,Emax为初始位置误差积分值的最大限值,Emin为初始位置误差积分值的最小限值,sum'为限值位置积分计算值,Kj为预设的系统参数,x为预设的系统参数,abs()为取绝对值,sum”为限值位置积分计算值进行积分消减后得到的位置积分计算值。
本发明改进了位置积分算法中的位置积分饱和处理算法,对位置积分计算过程中设定了限值,避免了最终的位置积分值过大,同时,还引入了位置积分快速消除方法,快速消减因积分累计产生的过大的积分值,避免引起超调或抖动现象,提高了对电机控制的稳定性和可靠性。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据提供的附图获得其他的附图。
图1为本发明实施例公开的一种基于PID的无刷直流电机控制方法流程示意图;
图2为本发明实施例公开的一种基于PID的无刷直流电机控制方法仿真示意图;
图3为本发明实施例公开的另一种基于PID的无刷直流电机控制方法流程示意图;
图4为本发明实施例公开的另一种基于PID的无刷直流电机控制方法流程示意图;
图5为本发明实施例公开的一种基于PID的无刷直流电机控制系统结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明实施例公开了一种基于PID的无刷直流电机控制方法,参见图1所示,该方法包括:
S11:根据无刷直流电机的实际位置和目标位置,计算出位置误差值。
具体的,为了使电机到达目标位置,因此,需要计算出无刷直流电机当前的实际位置和目标位置的位置误差,即计算出位置误差值,根据位置误差值后续调整控制信号,控制电机以使电机抵达目标位置进行闭环控制。
具体的,参见图2中401所示,根据目标位置(Pt)和实际位置(Pa)计算出位置误差值(err),可以通过位置误差表达式表达:err=Pt–Pa;式中,Pt为目标位置,Pa为实际位置,err为位置误差值。
具体的,可以通过三个相位差120°的霍尔传感器计算出无刷直流电机的实际位置或利用可编程2D位置传感器通过PWM直接读取无刷直流电机的实际位置。
其中,可用可编程2D位置传感器(例如,HAL3735)代替,使用可编程2D位置传感器的PWM 10%-90%的范围对执行器的全行程进行标定,通过PWM来监测执行器实际输出位置。
S12:利用位置误差值和位置比例算法,得到位置比例计算值。
具体的,参见图2所示,位置比例算法100包括位置比例计算值101以及位置比例计算值限值方法102,首先,根据位置误差值err乘以比例系数Kp得到位置比例计算值Vp,位置比例计算值Vp的表达式为:Vp=Kp*err;式中,Kp为比例系数,err为位置误差值,Vp为位置比例计算值。然后,再利用位置比例计算值限值方法102计算限值后的位置比例计算值,限值后的位置比例计算值Vp可以表达为:
式中,Pmax为位置比例计算值Vp的最大限值,Pmin为位置比例计算值Vp的最小限值,Vp为位置比例计算值。
S13:利用位置误差值和位置积分算法,得到位置积分计算值。
具体的,参见图2所示,位置积分算法200可以表示为:
式中,sum为位置误差err的积分值,A为积分作用范围,spd为电机实际转速,Slimit为电机转速限值,err为位置误差值。
具体的,在经过位置积分饱和处理算法210后,位置误差err的积分值(积分限值消减后)sum”乘以积分系数Ki作为位置积分计算值Vi,可以表示为以下形式:Vi=Ki*sum”;式中,Vi为位置积分计算值,Ki为积分系数,sum”为位置误差err的积分值(积分限值消减后)。
进一步的,参见图2所示位置积分算法200中的位置积分饱和处理算法210的具体处理过程可以包括S131和S132;其中,
S131:利用位置积分限值公式,对初始位置积分计算值进行限值,得到限值后的限值位置积分计算值。
具体的,参见图2中202所示,首先利用位置积分限值公式对位置积分计算值进行限值,得到限值后的限值位置积分计算值,位置积分限值公式为:
式中,sum为位置误差值的位置误差积分值,Emax为位置误差积分值的最大限值,Emin为位置误差积分值的最小限值,sum'为限值位置积分计算值。
S132:利用位置积分消减公式,对限值位置积分计算值进行积分消减,得到位置积分计算值;
具体的,参见图2中203所示,得到限值位置积分计算值后,再利用位置积分消减公式,对限值位置积分计算值进行积分消减,位置积分消减公式为:
式中,sum为位置误差值的初始位置误差积分值,Emax为初始位置误差积分值的最大限值,Emin为初始位置误差积分值的最小限值,sum'为限值位置积分计算值,Kj为预设的系统参数,x为预设的系统参数,abs()为取绝对值,sum”为限值位置积分计算值进行积分消减后得到的位置积分计算值。
S14:利用位置比例计算值和位置积分计算值,得到位置比例积分计算值。
具体的,参见图2中501所示,位置误差值经过位置比例算法和位置积分算法处理后,便可以得到位置比例计算值Vp和位置积分计算值Vi,两者相加后便可以得到位置比例积分计算值Vpi,其中,位置比例积分计算值表达式为:
式中,Vpi为位置比例积分计算值,Vmax为位置比例积分计算值的最大值,Vmin为位置比例积分计算值的最小值,Vp为位置比例计算值,Vi为位置积分计算值。
S15:利用无刷直流电机的实际电机转速与预设的电机转速限值,得到电机转速差值。
具体的,当负载较大,且负载方向和执行器运动方向一致,或通过无刷直流电机控制算法计算出的电机控制信号PWM的占空比过大,或电源电压过高,会导致无刷直流电机转速过高,从而引发执行器故障。因此需要对无刷直流电机转速进行限值,通过单位时间内实际位置差值计算出电机转速,通过限速积分算法,对电机控制信号PWM的占空比进行实时调整,保证电机转速不会超过设定限值。
具体的,参见图2中409所示,在得到电机的实际位置后,便可以利用电机的实际位置和采样间隔时间计算出电机的实际电机转速,实际电机转速表达式如下:
spd=ΔPa/Δt;
式中,spd为实际电机转速,Δt为采样间隔时间,ΔPa为采样实际位置差值。
进一步的,参见图2中402所示,有了实际电机转速后,实际电机转速与预设的电机转速限值的差值便是电机转速差值,电机转速差值表达式为:
式中,errs为电机转速差值,spd为实际电机转速,Slimit为电机转速限值,值为正。
S16:利用电机转速差值和限速算法,得到电机转速限值积分计算值。
具体的,参见图2中限速算法300所示,构建速度环利用电机转速差值为电机提供反馈,得到电机转速限值积分计算值Vs,确保电机稳定可靠安全的运转。
S17:利用位置比例积分计算值和电机转速限值积分计算值,得到无刷直流电机的电机方向和电机控制占空比。
具体的,参见图2中403所示,位置环位置误差值err和速度环超出电机转速差值errs作为PID控制器的输入,分别经过比例计算、积分运算后和限速积分运算后作为PID控制的输出,输出可表示为下式:Vpis=Vpi–Vs;式中,Vs为电机转速限值积分计算值,Vpi为位置比例积分计算值,Vpis为PID算法的控制输出。
进一步的,PID算法的控制输出Vpis的值是有正负的,需要把Vips转化成电机控制占空比(PWM)和电机控制方向(Dir),其中,电机控制占空比表达式为:
式中,PWM为电机控制占空比,Dir为电机控制方向,cw为电机正转,ccw为电机反转,Vpis为PID算法的控制输出。
S18:利用电机方向和电机控制占空比,控制无刷直流电机工作。
具体的,参见图2中404所示,在得到电机控制占空比和电机方向后,便可以通过预驱芯片,例如A3930芯片或A3931芯片控制无刷直流电机运转,其中,A3930芯片通过控制6个MOS管的开闭,来控制电机的三相线圈的电流的大小和方向,实现电机的运转。无刷直流电机的运转位置又通过3个霍尔传感器反馈给MCU,进行实时闭环控制。A3930芯片内部自带控制算法,A3930芯片也会监测3个霍尔传感器的信号。
可见,本发明实施例改进了位置积分算法中的位置积分饱和处理算法,对位置积分计算过程中设定了限值,避免了最终的位置积分值过大,同时,还引入了位置积分快速消除方法,快速消减因积分累计产生的过大的积分值,避免引起超调或抖动现象,提高了对电机控制的稳定性和可靠性。
本发明实施例公开了一种具体的方法,相对于上一实施例,本实施例对技术方案作了进一步的说明和优化。参见图3所示,具体的:
S201:根据无刷直流电机的实际位置和目标位置,计算出位置误差值;
S202:利用位置误差值和位置比例算法,得到位置比例计算值;
S203:利用位置误差值和位置积分算法,得到位置积分计算值;
其中,位置积分算法中的位置积分饱和处理算法包括:
利用位置积分限值公式,对初始位置积分计算值进行限值,得到限值后的限值位置积分计算值;
利用位置积分消减公式,对限值位置积分计算值进行积分消减,得到位置积分计算值;
其中,位置积分限值公式为:
位置积分消减公式为:
式中,sum为位置误差值的初始位置误差积分值,Emax为初始位置误差积分值的最大限值,Emin为初始位置误差积分值的最小限值,sum'为限值位置积分计算值,Kj为预设的系统参数,x为预设的系统参数,abs()为取绝对值,sum”为限值位置积分计算值进行积分消减后得到的位置积分计算值。
S204:利用位置比例计算值和位置积分计算值,得到位置比例积分计算值;
S205:利用无刷直流电机的实际电机转速与预设的电机转速限值,得到电机转速差值;
S206:当实际电机转速大于电机转速限值后,对电机转速差值进行积分,得到速度积分值。
具体的,参见图2中301所示,当实际电机转速大于电机转速限值后,速度积分值的表达式可以为:
式中,sums为速度积分值,即电机转速差值errs的积分值。
S207:利用位置比例积分计算值和转速限值公式对速度积分值进行限值,得到限值后的限值速度积分值。
具体的,为了避免无刷直流电机转速过高,出现超速的情况,参见图2中302所示,因此,利用位置比例积分计算值和转速限值公式对速度积分值进行限值,得到限值后的限值速度积分值,避免因积分过大出现超调。
其中,转速限值公式为:
Smax=Vpi/Ks if Vpi>0;
Smin=Vpi/Ks if Vpi<0;
式中,sums'为限值速度积分值,Smax为限值速度积分值的最大限值,Smin为限值速度积分值的最小限值,Ks为电机转速限值积分参数,sums为速度积分值,spd为实际电机转速。
S208:当实际电机转速小于电机转速限值后,对限值速度积分值进行积分消减,得到电机转速限值积分计算值。
具体的,通过限值减少积分,使得实际电机转速小于电机转速限值,在实际电机转速小于电机转速限值后,为了避免因积分饱和而引起的超调或抖动,需要进行积分消减,对限值速度积分值进行积分消减,从而得到电机转速限值积分计算值,参见图2中303和304所示。
S209:利用位置比例积分计算值和电机转速限值积分计算值,得到无刷直流电机的电机方向和电机控制占空比;
S210:利用电机方向和电机控制占空比,控制无刷直流电机工作。
可见,通过限速位置积分算法,设置电机转速限值,根据实际电机转速实时判断电机是否超速,一旦超速对速度积分值进行限值,避免出现超速的情况,进一步提高了对电机控制的稳定性和可靠性。
本发明实施例公开了一种具体的方法,相对于上一实施例,本实施例对技术方案作了进一步的说明和优化。参见图4所示,具体的:
S301:根据无刷直流电机的实际位置和目标位置,计算出位置误差值;
S302:利用位置误差值和位置比例算法,得到位置比例计算值;
S303:利用位置误差值和位置积分算法,得到位置积分计算值;
S304:利用位置比例计算值和位置积分计算值,得到位置比例积分计算值;
S305:利用无刷直流电机的实际电机转速与预设的电机转速限值,得到电机转速差值;
S306:当实际电机转速大于电机转速限值后,对电机转速差值进行积分,得到速度积分值。
S307:利用位置比例积分计算值和转速限值公式对速度积分值进行限值,得到限值后的限值速度积分值。
S308:当实际电机转速小于电机转速限值后,利用积分消减公式对速度积分值进行积分消减,得到消减后的消减速度积分值;
S309:利用消减速度积分值和电机转速限值积分计算值公式,得到电机转速限值积分计算值。
具体的,在限值后,说明电机已经超速,此时已经相对长时间电机存在未知误差,位置积分算法已经累积较大误差,导致积分值过大,从而引起超调或抖动现象,为此,需要快速消减积分值,同时消减过程中也不能直接清零,积分快速消除,也会导致抖动,因此,当实际电机转速小于电机转速限值后,利用速度积分消减公式对速度积分值进行积分消减,得到消减后的消减速度积分值,参见图2中303所示。
其中,速度积分消减公式为:sums”=sums'–S If(-Slimit)<spd<Slimit;
式中,S为预设的系统参数,sums”为消减速度积分值,Slimit为电机转速限值,值为正。
又或者速度积分消减公式还可以为:
式中,sums'为限值速度积分值,Kj为预设的系统参数,x为预设的系统参数,abs()为取绝对值,sums”为消减速度积分值,Ks为电机转速限值积分参数,Vs为电机转速限值积分计算值。
具体的,积分消减后,再乘以电机转速限值积分参数得到电机转速限值积分计算值,参见图2中304所示。
其中,电机转速限值积分计算值公式为:Vs=Ks*sums”;
式中,Ks为电机转速限值积分参数,Vs为电机转速限值积分计算值。
S310:利用位置比例积分计算值和电机转速限值积分计算值,得到无刷直流电机的电机方向和电机控制占空比;
S311:利用电机方向和电机控制占空比,控制无刷直流电机工作。
相应的,本发明实施例还公开了一种基于PID的无刷直流电机控制系统,参见图5所示,该系统包括:
位置误差计算模块11,用于根据无刷直流电机的实际位置和目标位置,计算出位置误差值;
位置比例计算模块12,用于利用位置误差值和位置比例算法,得到位置比例计算值;
位置积分计算模块13,用于利用位置误差值和位置积分算法,得到位置积分计算值;
位置比例积分计算模块14,用于利用位置比例计算值和位置积分计算值,得到位置比例积分计算值;
转速差值计算模块15,用于利用无刷直流电机的实际电机转速与预设的电机转速限值,得到电机转速差值;
转速积分计算模块16,用于利用电机转速差值和限速算法,得到电机转速限值积分计算值;
控制信号生成模块17,用于利用位置比例积分计算值和电机转速限值积分计算值,得到无刷直流电机的电机方向和电机控制占空比;
电机控制模块18,用于利用电机方向和电机控制占空比,控制无刷直流电机工作;
其中,位置积分算法中的位置积分饱和处理算法包括:
利用位置积分限值公式,对初始位置积分计算值进行限值,得到限值后的限值位置积分计算值;
利用位置积分消减公式,对限值位置积分计算值进行积分消减,得到位置积分计算值;
其中,位置积分限值公式为:
位置积分消减公式为:
式中,sum为位置误差值的初始位置误差积分值,Emax为初始位置误差积分值的最大限值,Emin为初始位置误差积分值的最小限值,sum'为限值位置积分计算值,Kj为预设的系统参数,x为预设的系统参数,abs()为取绝对值,sum”为限值位置积分计算值进行积分消减后得到的位置积分计算值。
可见,本发明实施例改进了位置积分算法中的位置积分饱和处理算法,对位置积分计算过程中设定了限值,避免了最终的位置积分值过大,同时,还引入了位置积分快速消除方法,快速消减因积分累计产生的过大的积分值,避免引起超调或抖动现象,提高了对电机控制的稳定性和可靠性。
具体的,还可以包括位置获取模块,用于利用霍尔传感器获取无刷直流电机的实际位置,或利用可编程2D位置传感器通过PWM,获取无刷直流电机的实际位置。
具体的,电机控制模块18,具体用于利用预驱芯片根据电机方向和电机控制占空比,控制无刷直流电机工作。
具体的,上述转速积分计算模块16,包括:转速积分计算单元、转速积分限值单元和转速积分消减单元;其中,
转速积分计算单元,用于当实际电机转速大于电机转速限值后,对电机转速差值进行积分,得到速度积分值;
转速积分限值单元,用于利用位置比例积分计算值和转速限值公式对速度积分值进行限值,得到限值后的限值速度积分值;
转速积分消减单元,用于当实际电机转速小于电机转速限值后,对限值速度积分值进行积分消减,得到电机转速限值积分计算值;
其中,转速限值公式为:
Smax=Vpi/Ks if Vpi>0;
Smin=Vpi/Ks if Vpi<0;
式中,sums'为限值速度积分值,Vpi为位置比例积分计算值,Smax为限值速度积分值的最大限值,Smin为限值速度积分值的最小限值,Ks为电机转速限值积分参数,sums为速度积分值,spd为实际电机转速,Vmax为位置比例积分计算值的最大值,Vmin为位置比例积分计算值的最小值,Vp为位置比例计算值,Vi为位置积分计算值。
具体的,上述转速积分消减单元,包括:转速积分消减子单元和转速限值计算子单元;其中,
转速积分消减子单元,用于当实际电机转速小于电机转速限值后,利用位置积分消减公式对限值速度积分值进行积分消减,得到消减后的消减速度积分值;
转速限值计算子单元,用于利用消减速度积分值和电机转速限值积分计算值公式,得到电机转速限值积分计算值;
其中,位置积分消减公式为:sums”=sums'–S If(-Slimit)<spd<Slimit;
电机转速限值积分计算值公式为:Vs=Ks*sums”;
式中,S为预设的系统参数,sums”为消减速度积分值,Slimit为电机转速限值,值为正,Ks为电机转速限值积分参数,Vs为电机转速限值积分计算值。
或上述速度积分消减公式为:
式中,sums'为限值速度积分值,Kj为预设的系统参数,x为预设的系统参数,abs()为取绝对值,sums”为消减速度积分值,Ks为电机转速限值积分参数,Vs为电机转速限值积分计算值。
此外,本发明实施例还公开了一种基于PID的无刷直流电机控制装置,包括:
存储器,用于存储计算机程序;
处理器,用于执行计算机程序以实现如前述的基于PID的无刷直流电机控制方法。
另外,本发明实施例还公开了一种计算机可读存储介质,计算机可读存储介质上存储有计算机程序,计算机程序被处理器执行时实现如前述的基于PID的无刷直流电机控制方法。
最后,还需要说明的是,在本文中,诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
专业人员还可以进一步意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、计算机软件或者二者的结合来实现,为了清楚地说明硬件和软件的可互换性,在上述说明中已经按照功能一般性地描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本发明的范围。
以上对本发明所提供的技术内容进行了详细介绍,本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处,综上所述,本说明书内容不应理解为对本发明的限制。
Claims (10)
1.一种基于PID的无刷直流电机控制方法,其特征在于,包括:
根据无刷直流电机的实际位置和目标位置,计算出位置误差值;
利用所述位置误差值和所述位置比例算法,得到位置比例计算值;
利用所述位置误差值和所述位置积分算法,得到位置积分计算值;
利用所述位置比例计算值和所述位置积分计算值,得到所述位置比例积分计算值;
利用所述无刷直流电机的实际电机转速与预设的电机转速限值,得到电机转速差值;
利用所述电机转速差值和限速算法,得到电机转速限值积分计算值;
利用所述位置比例积分计算值和所述电机转速限值积分计算值,得到所述无刷直流电机的电机方向和电机控制占空比;
利用所述电机方向和所述电机控制占空比,控制所述无刷直流电机工作;
其中,所述位置积分算法中的位置积分饱和处理算法包括:
利用位置积分限值公式,对初始位置积分计算值进行限值,得到限值后的限值位置积分计算值;
利用位置积分消减公式,对所述限值位置积分计算值进行积分消减,得到所述位置积分计算值;
其中,所述位置积分限值公式为:
所述位置积分消减公式为:
式中,sum为所述位置误差值的初始位置误差积分值,Emax为所述初始位置误差积分值的最大限值,Emin为所述初始位置误差积分值的最小限值,sum'为所述限值位置积分计算值,Kj为预设的系统参数,x为预设的系统参数,abs()为取绝对值,sum”为所述限值位置积分计算值进行积分消减后得到的所述位置积分计算值。
2.根据权利要求1所述的基于PID的无刷直流电机控制方法,其特征在于,还包括:
利用霍尔传感器获取所述无刷直流电机的所述实际位置。
3.根据权利要求1所述的基于PID的无刷直流电机控制方法,其特征在于,还包括:
利用可编程2D位置传感器通过PWM,获取所述无刷直流电机的所述实际位置。
4.根据权利要求1所述的基于PID的无刷直流电机控制方法,其特征在于,所述利用所述电机方向和所述电机控制占空比,控制所述无刷直流电机工作的过程,包括:
利用预驱芯片根据所述电机方向和所述电机控制占空比,控制所述无刷直流电机工作。
5.根据权利要求1至4任一项所述的基于PID的无刷直流电机控制方法,其特征在于,所述利用所述电机转速差值和限速算法,得到电机转速限值积分计算值的过程,包括:
当所述实际电机转速大于所述电机转速限值后,对所述电机转速差值进行积分,得到速度积分值;
利用位置比例积分计算值和转速限值公式对所述速度积分值进行限值,得到限值后的限值速度积分值;
当所述实际电机转速小于所述电机转速限值后,对所述限值速度积分值进行积分消减,得到所述电机转速限值积分计算值;
其中,所述转速限值公式为:
Smax=Vpi/Ks if Vpi>0;
Smin=Vpi/Ks if Vpi<0;
式中,sums'为所述限值速度积分值,Vpi为所述位置比例积分计算值,Smax为所述限值速度积分值的最大限值,Smin为所述限值速度积分值的最小限值,Ks为电机转速限值积分参数,sums为所述速度积分值,spd为所述实际电机转速,Vmax为所述位置比例积分计算值的最大值,Vmin为所述位置比例积分计算值的最小值,Vp为位置比例计算值,Vi为位置积分计算值。
6.根据权利要求5所述的基于PID的无刷直流电机控制方法,其特征在于,所述当所述实际电机转速小于所述电机转速限值后,对所述限值速度积分值进行积分消减,得到电机转速限值积分计算值的过程,包括:
当所述实际电机转速小于所述电机转速限值后,利用速度积分消减公式对所述限值速度积分值进行积分消减,得到消减后的消减速度积分值;
利用所述消减速度积分值和电机转速限值积分计算值公式,得到所述电机转速限值积分计算值;
其中,所述速度积分消减公式为:sums”=sums'–S If(-Slimit)<spd<Slimit;
所述电机转速限值积分计算值公式为:Vs=Ks*sums”;
式中,S为预设的系统参数,sums”为所述消减速度积分值,Slimit为电机转速限值,值为正,Ks为电机转速限值积分参数,Vs为电机转速限值积分计算值。
7.根据权利要求5所述的基于PID的无刷直流电机控制方法,其特征在于,所述当所述实际电机转速小于所述电机转速限值后,对所述限值速度积分值进行积分消减,得到电机转速限值积分计算值的过程,包括:
当所述实际电机转速小于所述电机转速限值后,利用速度积分消减公式对所述速度积分值进行积分消减,得到消减后的消减速度积分值;
利用所述消减速度积分值和电机转速限值积分计算值公式,得到所述电机转速限值积分计算值;
其中,所述速度积分消减公式为:
所述电机转速限值积分计算值公式为:Vs=Ks*sums”;
式中,sums'为所述限值速度积分值,Kj为预设的系统参数,x为预设的系统参数,abs()为取绝对值,sums”为所述消减速度积分值,Ks为电机转速限值积分参数,Vs为电机转速限值积分计算值。
8.一种基于PID的无刷直流电机控制系统,其特征在于,包括:
位置误差计算模块,用于根据无刷直流电机的实际位置和目标位置,计算出位置误差值;
位置比例计算模块,用于利用所述位置误差值和所述位置比例算法,得到位置比例计算值;
位置积分计算模块,用于利用所述位置误差值和所述位置积分算法,得到位置积分计算值;
位置比例积分计算模块,用于利用所述位置比例计算值和所述位置积分计算值,得到所述位置比例积分计算值;
转速差值计算模块,用于利用所述无刷直流电机的实际电机转速与预设的电机转速限值,得到电机转速差值;
转速积分计算模块,用于利用所述电机转速差值和限速算法,得到电机转速限值积分计算值;
控制信号生成模块,用于利用所述位置比例积分计算值和所述电机转速限值积分计算值,得到所述无刷直流电机的电机方向和电机控制占空比;
电机控制模块,用于利用所述电机方向和所述电机控制占空比,控制所述无刷直流电机工作;
其中,所述位置积分算法中的位置积分饱和处理算法包括:
利用位置积分限值公式,对初始位置积分计算值进行限值,得到限值后的限值位置积分计算值;
利用位置积分消减公式,对所述限值位置积分计算值进行积分消减,得到所述位置积分计算值;
其中,所述位置积分限值公式为:
所述位置积分消减公式为:
式中,sum为所述位置误差值的初始位置误差积分值,Emax为所述初始位置误差积分值的最大限值,Emin为所述初始位置误差积分值的最小限值,sum'为所述限值位置积分计算值,Kj为预设的系统参数,x为预设的系统参数,abs()为取绝对值,sum”为所述限值位置积分计算值进行积分消减后得到的所述位置积分计算值。
9.一种基于PID的无刷直流电机控制装置,其特征在于,包括:
存储器,用于存储计算机程序;
处理器,用于执行所述计算机程序以实现如权利要求1至7任一项所述的基于PID的无刷直流电机控制方法。
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如权利要求1至7任一项所述的基于PID的无刷直流电机控制方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111667076.6A CN114244195B (zh) | 2021-12-30 | 2021-12-30 | 基于pid的无刷直流电机控制方法、系统、装置及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111667076.6A CN114244195B (zh) | 2021-12-30 | 2021-12-30 | 基于pid的无刷直流电机控制方法、系统、装置及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114244195A true CN114244195A (zh) | 2022-03-25 |
CN114244195B CN114244195B (zh) | 2024-06-18 |
Family
ID=80745213
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111667076.6A Active CN114244195B (zh) | 2021-12-30 | 2021-12-30 | 基于pid的无刷直流电机控制方法、系统、装置及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114244195B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004032826A (ja) * | 2002-06-21 | 2004-01-29 | Meidensha Corp | モータ可変速制御における制動制御装置 |
CN102624299A (zh) * | 2012-01-20 | 2012-08-01 | 中国科学院上海技术物理研究所 | 电机调速系统的抗饱和pid控制方法 |
CN103269195A (zh) * | 2013-05-24 | 2013-08-28 | 电子科技大学 | 一种用于电动汽车异步电机矢量控制的变速积分pid控制器 |
CN103838139A (zh) * | 2014-02-28 | 2014-06-04 | 北京联合大学 | 具有积分饱和预处理功能的pid控制方法 |
CN110657935A (zh) * | 2019-09-24 | 2020-01-07 | 浙江大学 | 一种地震波加速度积分处理方法及系统 |
CN111665712A (zh) * | 2020-07-09 | 2020-09-15 | 厦门势拓御能科技有限公司 | 一种抗饱和及抑制超调的控制方法及pi调节器 |
CN113612420A (zh) * | 2021-08-26 | 2021-11-05 | 北京芯格诺微电子有限公司 | 抗积分饱和的无感永磁同步电机转子位置检测方法 |
-
2021
- 2021-12-30 CN CN202111667076.6A patent/CN114244195B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2004032826A (ja) * | 2002-06-21 | 2004-01-29 | Meidensha Corp | モータ可変速制御における制動制御装置 |
CN102624299A (zh) * | 2012-01-20 | 2012-08-01 | 中国科学院上海技术物理研究所 | 电机调速系统的抗饱和pid控制方法 |
CN103269195A (zh) * | 2013-05-24 | 2013-08-28 | 电子科技大学 | 一种用于电动汽车异步电机矢量控制的变速积分pid控制器 |
CN103838139A (zh) * | 2014-02-28 | 2014-06-04 | 北京联合大学 | 具有积分饱和预处理功能的pid控制方法 |
CN110657935A (zh) * | 2019-09-24 | 2020-01-07 | 浙江大学 | 一种地震波加速度积分处理方法及系统 |
CN111665712A (zh) * | 2020-07-09 | 2020-09-15 | 厦门势拓御能科技有限公司 | 一种抗饱和及抑制超调的控制方法及pi调节器 |
CN113612420A (zh) * | 2021-08-26 | 2021-11-05 | 北京芯格诺微电子有限公司 | 抗积分饱和的无感永磁同步电机转子位置检测方法 |
Non-Patent Citations (3)
Title |
---|
SHEN JUN: "Rotary position system based on improved nonlinear tracking differentiator fuzzy PID", PROCEEDINGS OF THE 34TH CHINESE CONTROL CONFERENCE, 28 July 2015 (2015-07-28) * |
刘洋: "基于智能优化的模糊PID永磁同步电机控制系统研究", 工程科技Ⅱ辑, no. 8, 15 August 2019 (2019-08-15) * |
赖义汉: "《单片机原理及应用——基于STC15系列单片机+C51编程》", 31 January 2016, 西南交通大学出版社, pages: 291 - 293 * |
Also Published As
Publication number | Publication date |
---|---|
CN114244195B (zh) | 2024-06-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP0967535A1 (en) | Position controller | |
JP3892823B2 (ja) | モータの速度制御装置 | |
US9164495B2 (en) | Motor controller controlling two motors for driving single driven object | |
JP2005057900A (ja) | エンジン駆動インバータ発電装置 | |
JP3850363B2 (ja) | モータの位置制御装置 | |
CN104977949B (zh) | 用于调节马达转速的方法 | |
US7265511B2 (en) | Motor control device | |
JP4858020B2 (ja) | Dc−dcコンバータの制御装置 | |
CN114244195A (zh) | 基于pid的无刷直流电机控制方法、系统、装置及存储介质 | |
CN110632844B (zh) | 一种数据处理方法及装置 | |
CN109067284B (zh) | 一种基于滤波误差的电机控制方法及装置 | |
JP3230571B2 (ja) | 電動機の速度制御装置 | |
Abu-Rub et al. | Maximum torque production in rotor field oriented control of an induction motor at field weakening | |
CN109067288B (zh) | 一种基于电流环的电机控制方法及装置 | |
JP2849085B2 (ja) | 電動機のデイジタル速度制御方法 | |
JP3233009B2 (ja) | 電動機の制御装置 | |
JP3337058B2 (ja) | 位置制御装置 | |
JP3850381B2 (ja) | 電流制御装置 | |
JP2000003204A (ja) | 制御方法及び制御装置 | |
JP2009031989A (ja) | サーボ制御装置 | |
JPH11155295A (ja) | 制振制御装置 | |
JP2006331013A (ja) | サーボ制御装置と制御方法 | |
JPS6122807B2 (zh) | ||
JPH08297512A (ja) | スライディングモード制御による位置決め制御方法 | |
JP2850076B2 (ja) | 制御装置 |
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 |