CN114826074A - 基于霍尔传感器的永磁同步电机速度和电角度的获取方法 - Google Patents
基于霍尔传感器的永磁同步电机速度和电角度的获取方法 Download PDFInfo
- Publication number
- CN114826074A CN114826074A CN202210519450.6A CN202210519450A CN114826074A CN 114826074 A CN114826074 A CN 114826074A CN 202210519450 A CN202210519450 A CN 202210519450A CN 114826074 A CN114826074 A CN 114826074A
- Authority
- CN
- China
- Prior art keywords
- value
- flag
- speed
- omega
- theta
- 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.)
- Withdrawn
Links
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
- H02P21/00—Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
- H02P21/14—Estimation or adaptation of machine parameters, e.g. flux, current or voltage
- H02P21/18—Estimation of position or speed
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02K—DYNAMO-ELECTRIC MACHINES
- H02K11/00—Structural association of dynamo-electric machines with electric components or with devices for shielding, monitoring or protection
- H02K11/20—Structural association of dynamo-electric machines with electric components or with devices for shielding, monitoring or protection for measuring, monitoring, testing, protecting or switching
- H02K11/21—Devices for sensing speed or position, or actuated thereby
- H02K11/215—Magnetic effect devices, e.g. Hall-effect or magneto-resistive elements
-
- 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/022—Synchronous motors
-
- 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
- H02P2207/00—Indexing scheme relating to controlling arrangements characterised by the type of motor
- H02P2207/05—Synchronous machines, e.g. with permanent magnets or DC excitation
Landscapes
- Engineering & Computer Science (AREA)
- Power Engineering (AREA)
- Microelectronics & Electronic Packaging (AREA)
- Control Of Motors That Do Not Use Commutators (AREA)
Abstract
本发明公开了一种基于霍尔传感器的永磁同步电机转子电角速度和电角度的获取方法,为永磁同步电机转子磁场定向控制系统提供全速范围内准确的电角速度反馈及电角度,采用速度、电流双闭环的控制方式,启动时通过M测速法进行电角速度反馈,待速度高于测速模式切换上限阀值时通过T测速法获得电角速度,保证电机全速范围内的速度闭环要求;低速及启动时采用方波驱动模式,中高速后转为正弦波驱动控制,保证了启动时的大转矩以及中高速下的转矩平稳性;上述复合型测速方式可以保证永磁同步电机低速大转矩启动,防止因霍尔元件安装位置不准造成的测速误差。
Description
技术领域
本发明涉及霍尔信号反馈的永磁同步电机转子磁场定向控制技术领域,尤其是涉及一种基于霍尔传感器的永磁同步电机转子电角速度和电角度的获取方法。
背景技术
永磁同步电机为实现其正弦波驱动控制需要连续的转子电角度,通常采用的机械式位置传感器,虽然可以提供高精度的转子电角度,但需要轴端安装且无法应用于恶劣的工作环境下,因此限制了永磁同步电机的应用场合。近年来受到广泛关注的无位置传感器技术,虽取消了机械位置传感器,但存在控制算法复杂,无法实现低速大转矩启动等问题。为解决永磁同步电机采用机械式位置传感器技术或无位置传感器技术存在的上述问题,工程应用中通常采用低成本的霍尔位置传感器,通过位置估算法获得高分辨率的转子电角度,以实现正弦波驱动控制调节永磁同步电机的转子电角速度使其转矩脉动最小化。
其中,采用霍尔传感器作为速度反馈的永磁同步电机转子磁场定向控制方案,不仅能使永磁同步电机在大转矩下实现平稳启动,而且也解决了由方波控制带来的噪音问题,这里的速度与发明名称中的速度相同是指转子的电角速度。该控制方式通过坐标变换将电机定子电流分解为励磁电流和转矩电流,能够大幅提高系统控制的精准性。但是转子磁场定向控制需要精准的电角度及电角速度反馈信号,对于霍尔元件作为反馈的调速系统来说,其电角速度信号的分辨率较低,特别是低速时,因此如何在全速范围内获得准确的电角速度反馈及电角度将尤为关键。
常规速度反馈方案都是通过每隔60°跳变区间进行速度测量,但受霍尔元件安装工艺及元件一致性的影响,通常情况下并不能保证每个跳变区间都是60°,误差率较大时可达20%,这将严重影响速度测量的准确性,进而影响电角度的细分,会在驱动系统中造成较大的转矩脉动。另外在重载启动,转子位置刚好处于60°跳变区间的边沿时会由于跳变区间的切换而造成电角度的抖动,严重时造成启动失败,亟待改进。
发明内容
本发明所要解决的技术问题是提供一种基于霍尔传感器的永磁同步电机转子电角速度和电角度的获取方法,为永磁同步电机转子磁场定向控制系统提供全速范围内准确的电角速度反馈及电角度。
本发明解决上述技术问题所采用的技术方案为:一种基于霍尔传感器的永磁同步电机速度和电角度的获取方法,永磁同步电机速度的控制器采用数字信号处理器,三相霍尔信号A/B/C通过逻辑电路异或后输出一路信号连接控制器的捕获引脚,控制器内设有捕获单元在该信号上升沿和下降沿分别触发进入捕获中断,三相霍尔信号A/B/C输出连接数字输入IO口;三相霍尔信号A/B/C连接数字输入IO;控制器内设置有定时中断进行电角度、电角速度、电流闭环控制;
控制器上电完成参数初始化,设置捕获中断标志位Cap_flag=0,Cap_flag=0表示已经处理过捕获中断的电角度值,Cap_flag=1表示还未处理过捕获中断的电角度值;速度标志位Spd_flag=0,Spd_flag=0表示转子电角速度处于低速,Spd_flag=1表示转子电角速度处于中高速;驱动标志位Angle_flag=0,Angle_flag=0表示方波驱动,Angle_flag=1表示正弦波驱动;设置数据寄存器Tt1=Tt2=Tt3=C1,其中C1为常数,累计脉冲寄存器sum=0,跳变区间内由角加速度累计后的电角速度值用于速度环调节器的反馈电角速度值ωr=0,用T测速法获得的当前电角速度ωtn=0,上个跳变区间用T测速法获得的当前电角速度ωtn_old=0,用M测速法获得的电角速度ωmn=0,测速模式切换上限阀值ωs1=0.02ωrate~0.05ωrate、测速模式切换下限阀值ωs0=0.01ωrate~0.04ωrate、驱动模式切换上限阀值ωa1=0.02ωrate~0.05ωrate、驱动模式切换下限阀值ωa0=0.01ωrate~0.04ωrate,ωrate为永磁同步电机的额定角频率,角加速度值αn=0,M测速周期值Tm=24ms;设置每个60°跳变区间的方波驱动电角度θnz(n=1~6),每个跳变区间正弦波驱动电角度初值θnx和θny,θnx表示正转时三相霍尔信号A/B/C序列编号为n的电角度初值,θny表示反转时三相霍尔信号A/B/C序列编号为n的电角度初值,n=1~6为三相霍尔信号A/B/C的序列编号;读取初始三相霍尔信号A/B/C的序列编号并存入序列脉冲新寄存器Num_new和序列脉冲旧寄存器Num_old,根据三相霍尔信号A/B/C的序列编号n选择相应的θnz值并设入电角度θrel作为启动时电角度使用,并根据Num_new值设置跳变区间内最大电角度θmax和跳变区间内最小电角度θmin;开启捕获中断和定时中断;
进入捕获中断时,捕获中断的具体步骤为:
(a1)赋值Tt3=Tt2,Tt2=Tt1,读取三相霍尔信号A/B/C的IO信号,将获得的序列编号放入序列脉冲新寄存器Num_new,读取捕获计数寄存器并存入Tt1寄存器,设置捕获标志位Cap_flag为1;
(a2)根据预定序列编码,比较Num_new值与Num_old值,如果判定转子是正转则Tt1不变,累计脉冲寄存器sum加一;如果判定转子是反转则Tt1取反,累计脉冲寄存器sum减一;用公式计算获得ωtn,用公式计算获得αn;
(a3)根据Num_new值设置跳变区间内最大电角度θmax和跳变区间内最小电角度θmin;
进入定时中断时,定时中断的具体步骤如下,
(b1)判断Angle_flag是否为0,Angle_flag为0则跳到步骤(b3),Angle_flag为1则判断Cap_flag标志是否为0,Cap_flag为0则跳到步骤(b4),Cap_flag为1进入步骤(b2);
(b2)设置Cap_flag为0,根据转子的转向,对跳变区间初始电角度θn0进行θnx或θny赋值,然后跳到步骤(b4);
(b3)根据Num_new值,将相应的预置θnz值设入电角度θrel,然后跳到步骤(b6);
(b4)根据电角度细分公式计算当前电角度θnp;其中,ωnp表示n跳变区间内的瞬时电角速度,αnf表示αn经过低通滤波器处理后的角加速度值,Ts为控制系统的运算周期,k表示跳变区间内经历的运算周期数;
(b5)比较当前电角度θnp与跳变区间内最大电角度θmax、跳变区间内最小电角度θmin的关系,当θnp大于θmax时,设置θnp=θmax,当θnp小于θmin时,设置θnp=θmin,保证θmin≤θnp≤θmax,然后将θnp值设入电角度θrel;
(b6)计算电角度θrel的正余弦值,用于矢量变换;
(b7)判断当前计数周期是否达到M测速周期Tm,如时间未到则跳到步骤(b10),如果已经达到M测速周期Tm,则根据公式计算出ωmn,进入步骤(b8);其中,summ表示当前测速周期获得脉冲累计值,summ-1表示上一测速周期获得脉冲累计值,Pn表示永磁同步电机极对数;
(b8)判断ωmn是否大于驱动模式切换上限阀值ωa1,如果大于则Angle_flag设置为1,然后跳到步骤(b9);如果ωmn小于驱动模式切换上限阀值ωa1,继续判断当前ωmn是否小于驱动模式切换下限阀值ωa0,小于则设置Angle_flag为0后进入步骤(b9),大于则进入步骤(b9);
(b9)判断ωmn是否大于测速模式切换上限阀值ωs1,如果大于则Spd_flag设置为1,然后跳到步骤(b10);如果ωmn小于测速模式切换上限阀值ωs1,继续判断ωmn是否小于测速模式切换下限阀值ωs0,小于ωs0则设置Spd_flag为0后进入步骤(b10),大于ωs0则进入步骤(b10);
(b10)判断标志Spd_flag是否为0,为0将ωmn设入ωr,为1则将ωtn设入ωr;
(b11)角加速度值αn经低通滤波器获得αnf;
(b12)经速度环、电流环、PI控制器及空间矢量PWM调制,最后输出占空比控制三相逆变电路,退出定时中断。
与现有技术相比,本发明的优点在于在基于霍尔传感器反馈的永磁同步电机转子磁场定向控制系统中,采用速度、电流双闭环的控制方式,启动时通过M测速法进行电角速度反馈,待速度高于测速模式切换上限阀值时通过T测速法获得电角速度,保证电机全速范围内的速度闭环要求;低速及启动时采用方波驱动模式,中高速后转为正弦波驱动控制,保证了启动时的大转矩以及中高速下的转矩平稳性;上述复合型测速方式可以保证永磁同步电机低速大转矩启动,防止因霍尔元件安装位置不准造成的测速误差。
附图说明
图1为永磁同步电机的转子磁场定向控制框图。
图2为三相霍尔信号A/B/C及序列编号和经逻辑异或后输出信号的示意图。
图3为霍尔信号反馈电角速度及电角度的原理图。
具体实施方式
以下结合附图实施例对本发明作进一步详细描述。
本优选实施例为一种基于霍尔传感器的永磁同步电机转子电角速度和电角度的获取方法,用于向转子磁场定向控制(Rotor Field Oriental Control,RFOC)提供全速范围内准确的电角速度反馈及电角度。
这里,转子磁场定向控制是通过控制变频器输出电压的幅值和频率来控制三相交流电机的一种变频驱动控制方法。通过测量永磁同步电机的定子电流,通过坐标变换,将三相静止坐标系转化为两相旋转的坐标系,从而使三相交流耦合的定子电流转换为互相正交,独立解耦的转矩与励磁分量,以达到类似于直流电动机通过控制转矩电流直接控制转矩的目的,能够大幅提高系统控制的精准性。
整个控制系统采用速度、电流双闭环的策略,其中速度环输出作为转矩电流给定,励磁电流根据实际情况设置。反馈电流经过坐标变换后转化为两相旋转坐标系上的电流ids和iqs经电流环调节后通过空间矢量发生器(SVPWM)输出电压信号,从而可以调节转矩Te和实现弱磁控制。
转子磁场定向控制中需要测量的量为:定子电流、转子电角速度、转子电角度,其中定子电流通过电流传感器获得,转子电角速度和转子电角度由霍尔元件作为反馈单元输出的信号反馈获得。
对照图1,简要介绍下转子磁场定向控制具体的步骤:
(1)将电流采样模块获得的相电流ia和ib,经Clarke变换将其从三相静止坐标系变换到两相静止坐标系iα和iβ;
(2)iα和iβ与转子电角度θrel结合,经过Park变换从两相静止坐标系变换到两相旋转坐标系ids和iqs;
(3)转子速度/位置反馈模块将测量的转子电角速度ωr与参考电角速度ωr *进行运算,并通过PI控制器产生交轴参考电流iqs *;
(4)交轴参考电流iqs *和直轴参考电流ids *与实际反馈的交轴电流iqs和直轴电流ids进行比较(取直轴参考电流ids *为0),再经过PI控制器,转化为电压νqs和νds。
(5)电压νqs和νds与检测到的转子电角度θrel相结合进行反Park变换,变换为两相静止坐标系的电压να和νβ;
(6)电压να和νβ经过空间矢量调制(SVPWM)模块调制为六路开关信号从而控制三相逆变器的开通和关断。
控制系统中使用的变换公式如下:
1)克拉克变换(CLARKE)
这里C相电流通过ic=-ia-ib获得,克拉克反变换为:
2)帕克变换(PARK)
帕克反变换为:
上述转子磁场控制方案中,需要获得永磁同步电机的电角速度反馈以及电角度来完成矢量控制,但由于采用霍尔元件作为反馈,其分辨率较差,需要对电角度进行细分处理。采用三相霍尔信号作为速度信号反馈如图2所示,每隔60°产生一次信号跳变,通过数字信号处理芯片采集每次信号发生跳变的时间间隔可以获得永磁同步电机电角速度值,图2中最下方的数字编号表示三相霍尔信号A/B/C经控制芯片的IO口读取后获得的序列编号,其中A相位于最高位,高电平为1,低电平为零。当永磁同步电机正转时序列编号的顺序为:546231,当永磁同步电机反转时序列编号的顺序为:513264。
图3所示是通过采集三相霍尔信号获得电角速度及电角度的原理图,将三相霍尔信号经逻辑异或后送入控制芯片的捕获单元输入口,捕获单元在信号的上升沿或下降沿进行捕获中断处理,捕获发生时记录定时器的计数值来确定60°跳变区间间隔时间,再经过运算后获取电角速度及电角度值。
这里以图3中ti时刻发生捕获中断为例,图中ti-2、ti-1、ti、ti+1分别为三相霍尔信号发生跳变捕获发生时记录的时间,θi-2、θi-1、θi、θi+1分别对应三相霍尔信号发生跳变时的电角度值。ωi-1为转子在θi-1与θi间的平均电角速度,其计算公式如下:
Ti-1表示从θi-1到θi所用的时间,即Ti-1=ti-ti-1。
把式(5)获得的平均电角速度看成60°跳变区间中点时刻的瞬时电角速度值,则αi-1加速度计算公式如下:
其中Ti-2表示从θi-2到θi-1所用的时间,ωi-2为转子在θi-2和θi-1间的平均电角速度,αi-1表示ti时刻永磁同步电机的角加速度值。
应用前60°跳变区间的平均电角速度ωi-1和角加速度αi-1来估算当前的电角度θip,从图3中可以看出当前的电角度θip等于区间初始电角度θi加上从θi已经旋转的电角度,其计算公式如下:
其中ωip表示tp时刻转子瞬时电角速度,Ts为数控系统的运算周期(电角速度越快运算周期越短),k表示跳变区间ti~ti+1经历的运算周期数。
这里提出了两种测速方案:(1)T测速法,通过计算两个捕获脉冲间隔时间来获得电角速度,如公式(5)所示;(2)M测速法,通过计算固定采样时间内获得的捕获脉冲数量来计算电角速度。由于霍尔元件安装工艺以及元件的一致性问题,实际应用时无法做到图2中的六个跳变区间都是60°的情况,故采用公式(5)计算电角速度会存在较大的误差,该误差率最大可达20%,将严重影响速度闭环控制效果。另外在带载启动及低速运行时,永磁同步电机容易抖动造成实际速度和测量速度存在较大误差,因此每60°进行速度测量的T测速法存在一定的局限性。
由于霍尔元件工作原理是感应磁场获得电信号,在每对磁极作用下产生宽度为180°的方波脉冲。即使三相霍尔元件由于安装位置存在偏差造成单个60°跳变区间有误差,从单路霍尔信号来看也都是高低电平各占一半,即180°。因此分别对A/B/C三相霍尔信号进行180°区间测速可以避免因机械位置或霍尔一致性差异造成的误差。通过设置三个数据寄存器:Tt3、Tt2、Tt1,参考图3,分别有Tt3=Ti-3,Tt2=Ti-2,Tt1=Ti-1。以图2的霍尔信号序列为例,假设永磁同步电机正转时产生546231的信号序列,可以通过比较当前序列编号和上个捕获发生时的序列编号,来对计数时间进行正负赋值处理。例如当前捕获到序列编号为6,而上一次编号为4,则获得的计数时间值取正值,反之当上一个编号为2时,则获得的计数时间值取负值,这样可以获得转速的正负值。此时T测速法获得速度计算公式如下:
这里下标t表示用于T测速法,下标n表示区间编号为1~6中的一个,其数值同图3中的序列编号,ωtn表示用T测速法获得的当前电角速度。
如采用M测速法时,对捕获信号的个数进行累计,该方式类似于增量式编码器的工作方式。比如当前序列编号为6,而上一次编号为4,则累计脉冲寄存器sum加1,反之当上一次编号为2时,累计脉冲寄存器sum减1。通过固定测速时间Tm来进行电角速度值的测量,此时M测速法下获得电角速度计算公式如下:
这里下标m表示用于M测速法,下标n表示区间编号为1~6中的一个,其数值同图3中的序列编号,ωmn表示用M测速法获得的电角速度,summ和summ-1分别表示当前和上一测速周期获得脉冲累计值,Pn表示永磁同步电机极对数,Tm表示速度测量周期值。
上述两种测速方式的优缺点如下:带载启动或低速运行时,电机很容易产生正反两个方向的抖动,如采用T测速法,由公式(8)获得的永磁同步电机电角速度会出现较大偏离真实值的情况;而采用M测速法可以避免这一情况,对比公式(8)和(9)可知,包含电角速度信息的变量在T测速法中处于分母,而M测速法中则在分子处;对于低速抖动这种带载启动固有的工况来说,M测速法更为准确。在中高速运行时,M测速法固有一个脉冲误差的情况,在Tm周期较短及每圈脉冲数较少的情况下会产生较大的测量误差;而此时永磁同步电机单方向运行,T测速法获得的区间间隔时间能正确反映当前电角速度。故在整个测速范围内,启动及低速采用M测速法,中高速采用T测速法。
实际应用时,设置电角速度反馈切换阀值ωs,当M测速法获得的ωmn低于等于该阀值时,采用M测速法,当ωmn高于阀值时,采用T测速法,具体如下:
其中ωr表示用于速度环调节器的反馈电角速度值,在工程应用中为了防止电机在切换阀值附近产生来回抖动,通常需要设置滞环。
角加速度αn通过T测速法获得,如计算公式(11)所示:
其中ωtn_old表示上一次捕获中断时计算的电角速度值。
在图1所示的转子磁场定向控制框图中,需要电角度用于坐标变换,而三相霍尔信号获得的电角度仅进行了60°区分,电角度在整个区间内保持不变,是离散量。为了产生正弦波电流,需要在区间内对电角度进行细分,可以采用计算公式(7)。
在进行电角度细分时需要对角加速度αn进行滤波处理,采用低通滤波器进行处理,设置低通滤波器截止角频率ω0,经低通滤波器获得的角加速度αnf用于电角度细分计算。此时公式(7)变为如下所示:
其中 表示该区间内由角加速度累计后的电角速度值,该值在每次进入捕获中断后需要清零处理,αnf表示αn经过低通滤波器处理后的角加速度值,θnp表示n跳变区间内瞬时电角度值,θn0表示n跳变区间初始电角度值,ωnp表示n跳变区间内的瞬时电角速度。
实际工程应用,考虑启动及低速区域时采用方波驱动模式,中高速采用正弦波驱动方式,因此需要设置驱动切换阀值ωa,如式(13)所示。同样考虑驱动切换阀值附近会出现抖动,需要设置一定的滞环。
上式中θrel表示用于矢量变换时的电角度值,θnz表示跳变n区间采用方波驱动模式时电角度值。
实施例1
电角速度和电角度的获取方法具体为:永磁同步电机速度的控制器采用数字信号处理器(DSP),三相霍尔信号A/B/C通过逻辑电路异或后输出一路信号(如图2中所示Ha⊕Hb⊕Hc)连接控制器的捕获引脚,控制器内设有捕获单元在该信号(Ha⊕Hb⊕Hc)上升沿和下降沿分别触发进入捕获中断,三相霍尔信号A/B/C输出连接数字输入IO口;触发捕获中断后,控制器自动将计数值存入捕获计数寄存器中,同时自动将计数值清零,读取捕获计数寄存器可以获得当前60°跳变区间的计数值,可进一步折算到时间。另外,控制器内设置有定时中断进行电角度、电角速度、电流闭环控制。
控制器上电完成参数初始化,设置捕获中断标志位Cap_flag=0,Cap_flag=0表示已经处理过捕获中断的电角度值,Cap_flag=1表示还未处理过捕获中断的电角度值;速度标志位Spd_flag=0,Spd_flag=0表示转子电角速度处于低速,Spd_flag=1表示转子电角速度处于中高速;驱动标志位Angle_flag=0,Angle_flag=0表示方波驱动,Angle_flag=1表示正弦波驱动;设置数据寄存器Tt1=Tt2=Tt3=C1,其中C1为常数,累计脉冲寄存器sum=0,跳变区间内由角加速度累计后的电角速度值用于速度环调节器的反馈电角速度值ωr=0,用T测速法获得的当前电角速度ωtn=0,上个跳变区间用T测速法获得的当前电角速度ωtn_old=0,用M测速法获得的电角速度ωmn=0,测速模式切换上限阀值ωs1=0.02ωrate~0.05ωrate、测速模式切换下限阀值ωs0=0.01ωrate~0.04ωrate、驱动模式切换上限阀值ωa1=0.02ωrate~0.05ωrate、驱动模式切换下限阀值ωa0=0.01ωrate~0.04ωrate,ωrate为永磁同步电机的额定角频率,角加速度值αn=0,M测速周期值Tm=24ms;设置每个60°跳变区间的方波驱动电角度θnz(n=1~6),每个跳变区间正弦波驱动电角度初值θnx和θny,θnx表示正转时三相霍尔信号A/B/C序列编号为n的电角度初值,θny表示反转时三相霍尔信号A/B/C序列编号为n的电角度初值,n=1~6为三相霍尔信号A/B/C的序列编号;读取初始三相霍尔信号A/B/C的序列编号并存入序列脉冲新寄存器Num_new和序列脉冲旧寄存器Num_old,根据三相霍尔信号A/B/C的序列编号n选择相应的θnz值并设入电角度θrel作为启动时电角度使用,并根据Num_new值设置跳变区间内最大电角度θmax和跳变区间内最小电角度θmin;开启捕获中断和定时中断;
进入捕获中断时,捕获中断的具体步骤为:
(a1)赋值Tt3=Tt2,Tt2=Tt1,读取三相霍尔信号A/B/C的IO信号,将获得的序列编号放入序列脉冲新寄存器Num_new,读取捕获计数寄存器并存入Tt1寄存器,设置捕获标志位Cap_flag为1;
(a2)根据预定序列编码,比较Num_new值与Num_old值,如果判定转子是正转则Tt1不变,累计脉冲寄存器sum加一;如果判定转子是反转则Tt1取反,累计脉冲寄存器sum减一;用公式计算获得ωtn,用公式计算获得αn;
(a3)根据Num_new值设置跳变区间内最大电角度θmax和跳变区间内最小电角度θmin;
进入定时中断时,定时中断的具体步骤如下,
(b1)判断Angle_flag是否为0,Angle_flag为0则跳到步骤(b3),Angle_flag为1则判断Cap_flag标志是否为0,Cap_flag为0则跳到步骤(b4),Cap_flag为1进入步骤(b2);
(b2)设置Cap_flag为0,根据转子的转向,对跳变区间初始电角度θn0进行θnx或θny赋值,然后跳到步骤(b4);
(b3)根据Num_new值,将相应的预置θnz值设入电角度θrel,然后跳到步骤(b6);
(b4)根据电角度细分公式计算当前电角度θnp;其中,ωnp表示n跳变区间内的瞬时电角速度,αnf表示αn经过低通滤波器处理后的角加速度值,Ts为控制系统的运算周期,k表示跳变区间内经历的运算周期数;
(b5)比较当前电角度θnp与跳变区间内最大电角度θmax、跳变区间内最小电角度θmin的关系,当θnp大于θmax时,设置θnp=θmax,当θnp小于θmin时,设置θnp=θmin,保证θmin≤θnp≤θmax,然后将θnp值设入电角度θrel;
(b6)计算电角度θrel的正余弦值,用于矢量变换;
(b7)判断当前计数周期是否达到M测速周期Tm,如时间未到则跳到步骤(b10),如果已经达到M测速周期Tm,则根据公式计算出ωmn,进入步骤(b8);其中,summ表示当前测速周期获得脉冲累计值,summ-1表示上一测速周期获得脉冲累计值,Pn表示永磁同步电机极对数;
(b8)判断ωmn是否大于驱动模式切换上限阀值ωa1,如果大于则Angle_flag设置为1,然后跳到步骤(b9);如果ωmn小于驱动模式切换上限阀值ωa1,继续判断ωmn是否小于驱动模式切换下限阀值ωa0,小于则设置Angle_flag为0后进入步骤(b9),大于则进入步骤(b9);其中,ωmn小于驱动模式切换下限阀值ωa0时设置Angle_flag为0即为设置了滞环;
(b9)判断ωmn是否大于测速模式切换上限阀值ωs1,如果大于则Spd_flag设置为1,然后跳到步骤(b10);如果ωmn小于测速模式切换上限阀值ωs1,继续判断ωmn是否小于测速模式切换下限阀值ωs0,小于ωs0则设置Spd_flag为0后进入步骤(b10),大于ωs0则进入步骤(b10);其中,ωmn小于测速模式切换下限阀值ωs0时设置设置Spd_flag为0即为设置了滞环;
(b10)判断标志Spd_flag是否为0,为0将ωmn设入ωr,为1则将ωtn设入ωr;
(b11)角加速度值αn经低通滤波器获得αnf;
(b12)经速度环、电流环、PI控制器及空间矢量PWM调制,最后输出占空比控制三相逆变电路,退出定时中断。
在本实施例中,永磁同步电机的额定转速3000rpm,额定电流14A,额定电压48V,Pn=5,额定频率250Hz,电机调速范围30~3000(n/min),额定角频率ωrate=100π(rad/s)时;ωs1=ωa1=2π(rad/s),ωs0=ωa0=π(rad/s),C1=4000000,Tm=24ms,ω0=50π(rad/s)。
Claims (1)
1.一种基于霍尔传感器的永磁同步电机速度和电角度的获取方法,永磁同步电机速度的控制器采用数字信号处理器,三相霍尔信号A/B/C通过逻辑电路异或后输出一路信号连接控制器的捕获引脚,控制器内设有捕获单元在该信号上升沿和下降沿分别触发进入捕获中断,三相霍尔信号A/B/C输出连接数字输入IO口;控制器内设置有定时中断进行电角度、电角速度、电流闭环控制;其特征在于,
控制器上电完成参数初始化,设置捕获中断标志位Cap_flag=0,Cap_flag=0表示已经处理过捕获中断的电角度值,Cap_flag=1表示还未处理过捕获中断的电角度值;速度标志位Spd_flag=0,Spd_flag=0表示转子电角速度处于低速,Spd_flag=1表示转子电角速度处于中高速;驱动标志位Angle_flag=0,Angle_flag=0表示方波驱动,Angle_flag=1表示正弦波驱动;设置数据寄存器Tt1=Tt2=Tt3=C1,其中C1为常数,累计脉冲寄存器sum=0,跳变区间内由角加速度累计后的电角速度值用于速度环调节器的反馈电角速度值ωr=0,用T测速法获得的当前电角速度ωtn=0,上个跳变区间用T测速法获得的当前电角速度ωtn_old=0,用M测速法获得的电角速度ωmn=0,测速模式切换上限阀值ωs1=0.02ωrate~0.05ωrate、测速模式切换下限阀值ωs0=0.01ωrate~0.04ωrate、驱动模式切换上限阀值ωa1=0.02ωrate~0.05ωrate、驱动模式切换下限阀值ωa0=0.01ωrate~0.04ωrate,ωrate为永磁同步电机的额定角频率,角加速度值αn=0,M测速周期值Tm=24ms;设置每个60°跳变区间的方波驱动电角度θnz(n=1~6),每个跳变区间正弦波驱动电角度初值θnx和θny,θnx表示正转时三相霍尔信号A/B/C序列编号为n的电角度初值,θny表示反转时三相霍尔信号A/B/C序列编号为n的电角度初值,n=1~6为三相霍尔信号A/B/C的序列编号;读取初始三相霍尔信号A/B/C的序列编号并存入序列脉冲新寄存器Num_new和序列脉冲旧寄存器Num_old,根据三相霍尔信号A/B/C的序列编号n选择相应的θnz值并设入电角度θrel作为启动时电角度使用,并根据Num_new值设置跳变区间内最大电角度θmax和跳变区间内最小电角度θmin;开启捕获中断和定时中断;
进入捕获中断时,捕获中断的具体步骤为:
(a1)赋值Tt3=Tt2,Tt2=Tt1,读取三相霍尔信号A/B/C的IO信号,将获得的序列编号放入序列脉冲新寄存器Num_new,读取捕获计数寄存器并存入Tt1寄存器,设置捕获标志位Cap_flag为1;
(a2)根据预定序列编码,比较Num_new值与Num_old值,如果判定转子是正转则Tt1不变,累计脉冲寄存器sum加一;如果判定转子是反转则Tt1取反,累计脉冲寄存器sum减一;用公式计算获得ωtn,用公式计算获得αn;
(a3)根据Num_new值设置跳变区间内最大电角度θmax和跳变区间内最小电角度θmin;
进入定时中断时,定时中断的具体步骤如下,
(b1)判断Angle_flag是否为0,Angle_flag为0则跳到步骤(b3),Angle_flag为1则判断Cap_flag标志是否为0,Cap_flag为0则跳到步骤(b4),Cap_flag为1进入步骤(b2);
(b2)设置Cap_flag为0,根据转子的转向,对跳变区间初始电角度θn0进行θnx或θny赋值,然后跳到步骤(b4);
(b3)根据Num_new值,将相应的预置θnz值设入电角度θrel,然后跳到步骤(b6);
(b4)根据电角度细分公式计算当前电角度θnp;其中,ωnp表示n跳变区间内的瞬时电角速度,αnf表示αn经过低通滤波器处理后的角加速度值,Ts为控制系统的运算周期,k表示跳变区间内经历的运算周期数;
(b5)比较当前电角度θnp与跳变区间内最大电角度θmax、跳变区间内最小电角度θmin的关系,当θnp大于θmax时,设置θnp=θmax,当θnp小于θmin时,设置θnp=θmin,保证θmin≤θnp≤θmax,然后将θnp值设入电角度θrel;
(b6)计算电角度θrel的正余弦值,用于矢量变换;
(b7)判断当前计数周期是否达到M测速周期Tm,如时间未到则跳到步骤(b10),如果已经达到M测速周期Tm,则根据公式计算出ωmn,进入步骤(b8);其中,summ表示当前测速周期获得脉冲累计值,summ-1表示上一测速周期获得脉冲累计值,Pn表示永磁同步电机极对数;
(b8)判断ωmn是否大于驱动模式切换上限阀值ωa1,如果大于则Angle_flag设置为1,然后跳到步骤(b9);如果ωmn小于驱动模式切换上限阀值ωa1,继续判断当前ωmn是否小于驱动模式切换下限阀值ωa0,小于则设置Angle_flag为0后进入步骤(b9),大于则进入步骤(b9);
(b9)判断ωmn是否大于测速模式切换上限阀值ωs1,如果大于则Spd_flag设置为1,然后跳到步骤(b10);如果ωmn小于测速模式切换上限阀值ωs1,继续判断ωmn是否小于测速模式切换下限阀值ωs0,小于ωs0则设置Spd_flag为0后进入步骤(b10),大于ωs0则进入步骤(b10);
(b10)判断标志Spd_flag是否为0,为0将ωmn设入ωr,为1则将ωtn设入ωr;
(b11)角加速度值αn经低通滤波器获得αnf;
(b12)经速度环、电流环、PI控制器及空间矢量PWM调制,最后输出占空比控制三相逆变电路,退出定时中断。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210519450.6A CN114826074A (zh) | 2022-05-13 | 2022-05-13 | 基于霍尔传感器的永磁同步电机速度和电角度的获取方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210519450.6A CN114826074A (zh) | 2022-05-13 | 2022-05-13 | 基于霍尔传感器的永磁同步电机速度和电角度的获取方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114826074A true CN114826074A (zh) | 2022-07-29 |
Family
ID=82513060
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210519450.6A Withdrawn CN114826074A (zh) | 2022-05-13 | 2022-05-13 | 基于霍尔传感器的永磁同步电机速度和电角度的获取方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114826074A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115208257A (zh) * | 2022-09-16 | 2022-10-18 | 成都爱旗科技有限公司 | 一种永磁同步电机极对数检测系统、方法及电子设备 |
CN115549530A (zh) * | 2022-10-09 | 2022-12-30 | 成都爱旗科技有限公司 | 一种永磁同步电机转子初始位置检测方法、装置及介质 |
-
2022
- 2022-05-13 CN CN202210519450.6A patent/CN114826074A/zh not_active Withdrawn
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115208257A (zh) * | 2022-09-16 | 2022-10-18 | 成都爱旗科技有限公司 | 一种永磁同步电机极对数检测系统、方法及电子设备 |
CN115208257B (zh) * | 2022-09-16 | 2023-01-31 | 成都爱旗科技有限公司 | 一种永磁同步电机极对数检测系统、方法及电子设备 |
CN115549530A (zh) * | 2022-10-09 | 2022-12-30 | 成都爱旗科技有限公司 | 一种永磁同步电机转子初始位置检测方法、装置及介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP3397007B2 (ja) | ブラシレスモータ | |
US8810169B2 (en) | Method and system for estimating rotor angle of an electric machine | |
JP3546817B2 (ja) | 電動機の磁極位置検出装置 | |
CN114826074A (zh) | 基于霍尔传感器的永磁同步电机速度和电角度的获取方法 | |
JP7168363B2 (ja) | モーター制御方法 | |
JP2006343318A (ja) | 回転位置検出装置およびそれを備える回転電機駆動装置 | |
JP5972248B2 (ja) | 同期電動機の回転位相検出装置 | |
JP4269686B2 (ja) | 同期電動機の位置・速度・電圧振幅のセンサレス計測方法およびセンサレス可変速装置 | |
JP2014514895A (ja) | ノイズ除去した電気モータ内の回転子の位置を決定するための方法およびシステム | |
TW201125279A (en) | Control circuit for motor drive | |
JP4735439B2 (ja) | 永久磁石式同期電動機の初期磁極位置推定装置 | |
JP3767896B2 (ja) | ステッピングモータの駆動装置 | |
JP4051833B2 (ja) | 永久磁石式同期電動機のベクトル制御装置 | |
KR20160065291A (ko) | 전동기 구동 모듈 | |
JP4027721B2 (ja) | ブラシレスモータの速度制御装置 | |
US7043395B2 (en) | Method for detecting the magnetic flux the rotor position and/or the rotational speed | |
JP5709693B2 (ja) | モータ制御装置 | |
KR20190062009A (ko) | Bldc 모터의 정현파 구동을 위한 전기각 추정 방법 및 이를 이용한 모터 제어 시스템 | |
JP4127000B2 (ja) | モータ制御装置 | |
JP2010004696A (ja) | 出力推定装置、それを用いたモータ制御装置およびモータ制御システム | |
JP3161237B2 (ja) | 誘導電動機制御装置 | |
JPH08126379A (ja) | ブラシレス直流モータの駆動装置及び制御方法 | |
JP3402322B2 (ja) | ブラシレスモータ | |
RU2755671C1 (ru) | Мониторинговое устройство для реактивной машины и способ мониторинга | |
JP3402328B2 (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 | ||
WW01 | Invention patent application withdrawn after publication | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20220729 |