一种机器人用异步电动机伺服驱动方法及系统 【技术领域】
本发明涉及电动机控制技术领域,特别涉及一种机器人用异步电动机伺服驱动方法及系统。
背景技术
首先简单介绍一下机器人,机器人是自动执行工作的机器装置。它的任务是协助或取代人类的工作,例如制造业、建筑业,或是危险的工作。
机器人的执行机构即机器人本体,其臂部一般采用空间连杆机构,其中的运动部分称为关节,主动关节个数通常称为机器人的自由度数。
机器人的关节由电动机来驱动,电动机在驱动器控制下实现位置、速度、加减速度和力矩的随动。电动机和驱动器构成的系统被称作伺服驱动系统。机器人对伺服驱动系统在电动机的位置精度、速度稳定性、加减速度的快速性、力矩的准确性以及运动控制的其它性能和精度等方面的要求都高于其它机械,因此机器人用电动机伺服驱动系统是一类高精度、高动态响应、高稳定性的伺服驱动系统。目前机器人用的电动机伺服驱动系统的电动机都是采用永磁同步电动机或直流电动机。永磁同步电动机的转子不能高速运转,否则定子绕组会产生很强的反电动势,要克服这种反电动势的作用,驱动器就得通过增大定子绕组的电流来使永磁同步电动机产生更大的定子磁动势,但是定子磁动势过强会使转子消磁。另一方面,永磁同步电动机会受工作温度的限制,温度达到永磁铁的居里点后,永磁铁会消磁。但是,机器人工作的环境有时相当恶劣,有些应用需要在高温环境下工作。而且永磁同步电动机伺服驱动系统的制造成本及材料成本都高于异步电动机构成的系统。直流电动机的伺服驱动系统由于直流电动机存在换向器,所以维护性差。在工业应用上已经被交流伺服驱动系统所取代。
因此,机器人利用永磁同步电动机来控制存在转速低,可靠性差的缺点。
【发明内容】
本发明要解决的技术问题是提供机器人用异步电动机伺服驱动方法及系统,能够解决机器人利用永磁同步电动机来控制存在转速低,可靠性差的缺点。
本发明实施例提供一种机器人用异步电动机伺服驱动方法,包括以下步骤:
实时监测异步电动机的当前运行状态,将监测的异步电动机的当前运行状态信息反馈给控制器;
控制器将所述当前运行状态信息与给定的指令值相比较得到对应的控制指令值;
由所述控制指令值对异步电动机进行控制。
优选地,当所述当前运行状态信息为异步电动机的实际角度时,对异步电动机进行位置控制,具体为:
控制器将异步电动机的实际角度与位置给定指令值做差,将差值进行PI调节以后得到转速控制指令值;
转速控制指令值与异步电动机的实际角频率做差,由两者的差值得到电磁转矩指令值;
将电磁转矩指令值和转矩电流之差经过电压方程得到转矩电压指令值;
由励磁电流控制值计算得到励磁电压指令值;所述励磁电流控制值为励磁电流指令值和励磁电流之差;
由转矩电压控制值和励磁电压控制值经过M-T坐标到三相交流坐标变换得到异步电动机的三相电压控制值;M-T坐标系与异步电动机的转子旋转磁场同步旋转,并规定M轴沿转子磁链方向,T轴沿M轴逆时针转90度;所述励磁电压控制值为励磁电压指令值和励磁解耦电压之差;所述转矩电压控制值为转矩电压指令值和转矩解耦电压之差;
SVPWM逆变器将输入的三相电压控制值转变为三相正弦电流并输入到异步电动机的定子绕组中,实现对异步电动机的伺服控制。
优选地,所述转速控制指令值ωrm*与异步电动机的实际角频率ωr做差,由两者的差值得到电磁转矩指令值,具体为:
iT′*=TrLmψrωse+Kpωe(k)+K1ωΣi=1ke(i)e(k)=ωrm*(k)-ωr(k)]]>
其中,k表示当前的采样时刻;Lm表示异步电动机定子绕组的自感;Tr表示异步电动机转子的时间常数;ψr表示异步电动机的转子磁链;ωse表示异步电动机的转差;Kpω表示消除误差e(k)影响的比例增益;KIω表示消除累积误差e(k)影响的积分增益。
优选地,将电磁转矩指令值iT′*和转矩电流iT之差经过电压方程得到转矩电压指令值uT′*;具体为:
uT′*=KpTeiT,]]>eiT=iT*-iT,]]>其中KpT表示增益系数,iT表示转矩电流。
优选地,当对异步电动机的位置进行控制时进行转速和转矩限幅。
本发明实施例还提供一种机器人用异步电动机伺服驱动系统,包括:反馈单元、比较单元和控制单元;
所述反馈单元,用于实时监测异步电动机的当前运行状态,将监测的异步电动机的当前运行状态信息反馈给比较单元;
所述比较单元,用于将所述当前运行状态信息与给定的指令值相比较得到对应的控制指令值;
所述控制单元,用于由所述控制指令值对异步电动机进行控制。
优选地,当所述反馈单元反馈的当前运行状态信息为异步电动机的实际角度时,所述比较单元包括:位置控制单元、转速控制单元、转矩电流控制单元、励磁电流控制单元、坐标转换单元和SVPWM逆变单元;
所述位置控制单元,用于将异步电动机的实际角度与位置给定指令值做差,将差值进行PI调节以后得到转速控制指令值;
所述转速控制单元,用于将转速控制指令值与异步电动机的实际角频率做差,由两者的差值得到电磁转矩指令值;
所述转矩电流控制单元,用于将电磁转矩指令值和转矩电流之差经过电压方程得到转矩电压指令值;
所述励磁电流控制单元,用于由励磁电流控制值经过电压方程得到励磁电压指令值;
坐标转换单元,用于由转矩电压控制值和励磁电压控制值经过M-T坐标到三相交流坐标变换得到异步电动机的三相电压控制值;M-T坐标系与异步电动机的转子旋转磁场同步旋转,并规定M轴沿转子磁链方向,T轴沿M轴逆时针转90度;所述励磁电压指令值为励磁电压控制值和励磁解耦电压之差;所述转矩电压控制值为转矩电压指令值与转矩解耦电压之差;
SVPWM逆变单元,用于将输入的三相电压控制值转变为三相正弦电流并输入到异步电动机地定子绕组中,实现对异步电动机的伺服控制。
优选地,所述转速控制单元,用于将转速控制指令值ωrm*与异步电动机的实际角频率ωr做差,由两者的差值得到电磁转矩指令值,具体为:
iT′*=TrLmψrωse+Kpωe(k)+KIωΣi=1ke(i)e(k)=ωrm*(k)-ωr(k)]]>
其中,k表示当前的采样时刻;Lm表示异步电动机定子绕组的自感;Tr表示异步电动机转子的时间常数;ψr表示异步电动机的转子磁链;ωse表示异步电动机的转差;Kpω表示消除误差e(k)影响的比例增益;KIω表示消除累积误差e(k)影响的积分增益。
优选地,
所述转矩电流控制单元,用于将电磁转矩指令值iT′*和转矩电流iT之差经过电压方程得到转矩电压指令值uT′*;具体为:
uT′*=KpTeiT,]]>eiT=iT*-iT,]]>其中KpT表示增益系数,iT表示转矩电流。
优选地,还包括解耦单元,用于由转矩电流和励磁电流解耦得到励磁解耦电压和转矩解耦电压。
与现有技术相比,本发明具有以下优点:
本发明提供的机器人用异步电动机伺服驱动方法及系统,可以满足机器人控制系统对伺服驱动装置在精度和性能方面的要求。采用异步电动机的当前运行状态信息和控制器给定的指令值相比较,以差值作为控制指令,这样可以实现实时地闭环控制。由于异步电动机的转速可以达到很高,而且其工作环境可以不受温度的限制,因此可以避免采用永磁同步电动机驱动时带来的缺点。
【附图说明】
图1是本发明提供的方法实施例一流程图;
图2是本发明提供的方法实施例二流程图;
图3是本发明提供的系统实施例一示意图;
图4是本发明提供的系统实施例二示意图;
图5是本发明提供的系统实施例三示意图。
【具体实施方式】
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图对本发明的具体实施方式做详细的说明。
本发明实施例对异步电动机的伺服控制采取闭环控制,可以包括位置控制、转速控制和转矩控制。
为了使本领域技术人员能够更好地理解和实施本发明,下面介绍几个技术术语。
将异步电动机定子的三相绕组A、B、C所在的坐标系定义为静止三相坐标系,将异步电动机转子的三相绕组a、b、c所在的坐标系定义为二相旋转坐标系,用M-T表示。其中,M-T坐标系与异步电动机的转子旋转磁场同步旋转,并规定M轴沿转子磁链方向,T轴沿M轴逆时针转90度。
从异步电动机的电源输入线上通过电流传感器测量异步电动机的A相电流和B相电流,分别用iA和iB表示。
由静止三相坐标系到M-T坐标系的转换公式(1),可以由iA和iB计算转子的励磁电流和转矩电流,其中励磁电流和转矩电流分别用iM和iT来表示,转换公式(1)具体如下:
iMiT=cosθsinθ-sinθcosθ320132iAiB---(1)]]>
其中θ是M轴与异步电动机A相定子绕组的轴线之间的夹角,θ可以有异步电动机的电源频率ωs积分得到。
需要说明的是,本发明实施例提供的异步电动机伺服驱动系统的控制方法可以采用单独的位置控制,也可以采用单独的转速控制,还可以采用单独的转矩控制。
实施例一:
参见图1,该图为本发明提供的方法实施例一流程图。
本实施例提供的机器人用异步电动机伺服驱动方法,包括以下步骤:
S1:实时监测异步电动机的当前运行状态,将监测的异步电动机的当前运行状态信息反馈给控制器。
S2:控制器将所述当前运行状态信息与给定的指令值相比较得到对应的控制指令值。
S3:由所述控制指令值对异步电动机进行控制。
本发明提供的机器人用异步电动机伺服驱动方法,可以满足机器人控制系统对伺服驱动装置在精度和性能方面的要求。采用异步电动机的当前运行状态信息和控制器给定的指令值相比较,以差值作为控制指令,这样可以实现实时地闭环控制。由于异步电动机的转速可以达到很高,而且其工作环境可以不受温度的限制,因此可以避免采用永磁同步电动机驱动时带来的缺点。
实施例二:
下面首先介绍位置控制。
参见图2,该图为本发明提供的方法实施例二流程图。
S101:位置传感器将测得的异步电动机的实际角度θr反馈给控制器,控制器将异步电动机的实际角度θr与位置给定指令值θrm**做差,将两者的差值进行PI调节以后得到转速控制指令值ωrm*。
需要说明的是,位置给定指令值θrm**是由异步电动机伺服驱动系统的控制器给定的值。
S102:转速控制指令值ωrm*与异步电动机的实际角频率ωr做差,由两者的差值得到电磁转矩指令值iT′*。iT′*的具体计算公式如下:
iT′*=TrLmψrωse+Kpωe(k)+KIωΣi=1ke(i)e(k)=ωrm*(k)-ωr(k)---(2)]]>
其中,k表示当前的采样时刻;Lm表示异步电动机定子绕组的自感;Tr表示异步电动机转子的时间常数;ψr表示异步电动机的转子磁链;ωse表示异步电动机的转差;Kpω表示消除误差e(k)影响的比例增益;KIω表示消除累积误差e(k)影响的积分增益。
需要说明的是,当转子转速小于或等于异步电动机额定频率时,ψr为固定值,当转子转速大于异步电动机额定频率时,ψr按异步电动机的设计或试验得到的规律减小。
此处,异步电动机的转差计算式是:ωs定子电源的频率,ωs=ωse+ωre,ωre是异步电动机的电角频率。a、b、c为常数,异步电动机设计参数由异步电动机厂家提供或测试获得。ω0为低频转差非线性转折频率,ωk为高频转差非线性转折频率,由异步电动机厂家提供或测试获得。
S103:将电磁转矩指令值iT′*和转矩电流iT之差经过电压方程得到转矩电压指令值uT′*。
电磁转矩指令值iT′*和转矩电流iT之差为转矩电流的控制值iT*。
具体如下:
uT′*=KpTeiT,]]>eiT=iT*-iT,]]>其中KpT表示增益系数。
S104:转矩电压指令值uT′*和转矩解耦电压uT′做差得到转矩电压控制值uT*。
下面介绍如何获得励磁电压控制值uM*。
首先由励磁电流iM计算转子磁链ψr,具体的计算公式如下:
ψr=LmiM1+TrP---(3)]]>
其中,ψr表示转子磁链;Tr表示转子时间常数;Lm表示异步电动机定子的自感;P表示微分算子。
磁链给定指令值ψm**和转子磁链ψr做差后计算励磁电流指令值iM′*,具体的计算公式如下:
iM′*=(1+TrP)Lm(ψM**-ψr)---(4)]]>
励磁电流指令值iM′*和励磁电流iM做差后得到励磁电流控制值iM*。
由励磁电流控制值iM*计算得到励磁电压指令值uM′*,具体的计算公式如下:
uM′*=KpMeiM,]]>eiM=iM*-iM,]]>其中KpM表示增益系数。
励磁电压指令值uM′*和励磁解耦电压uM′做差得到励磁电压控制值uM*。
下面结合如何获得转矩解耦电压uT′和励磁解耦电压uM′,具体的计算公式如下:
uM′uT′0=σLs{PiMiTψm--RsσLs-Rr(1-σ)σLr0LmRrσLsLr20RsσLs0LmRrLr0-RrLriMiTψm}---(5)]]>
其中,P表示微分算子;σ表示漏磁系数,σ=1-Lm2/(LsLr);]]>Lm表示异步电动机定子绕组的自感;Rs表示异步电动机定子绕组的内阻;Lr表示异步电动机转子绕组的自感;Rr表示异步电动机转子绕组的内阻;ψm表示定子磁链,本发明中定义定子磁链与转子磁链相等,即ψm=ψr。
需要说明的是,无论是位置控制,还是转速控制或转矩控制,均需要励磁控制环路,这是为了给转子提供旋转的磁场。励磁控制是通过将磁链指令值与励磁电流相结合来控制输出的励磁电压控制值。由于励磁电流是异步电动机的反馈值,这样可以实现闭环控制。
S105:由转矩电压控制值uT*和励磁电压控制值uM*经过M-T坐标到三相交流坐标变换可以得到异步电动机的三相电压控制值uA*、uB*和uC*。
S106:SVPWM逆变器将输入的uA*、uB*和uC*转变为三相正弦电流并输入到异步电动机的定子绕组中,实现对异步电动机的伺服控制。
由转矩电压控制值uT*和励磁电压控制值uM*计算三相电压控制值uA*、uB*和uC*的计算公式具体如下:
uA*uB*=230-1612cosθ-sinθsinθcosθuM*uT*uC*=-uA*-uB*---(6)]]>
实施例二介绍的异步电动机伺服驱动系统是对机器人采取位置控制,需要说明的是,上位机的控制指令为位置控制时,异步电动机伺服驱动系统对机器人采取位置控制。
需要说明的是,本实施例提供的位置控制,位置定位精度可以达到±1脉冲,异步电动机的位置具体可以由位置检测传感器获得,例如光学编码器和旋转变压器。
需要说明的是,位置控制时可以进行转速和转矩限幅。
转速限幅具体为:当ωrm*<ωlim]]>
其中,ωlim为转速限幅设定值。
转矩限幅具体为:当iT′*<iTlim′*]]>
其中,iT lim′*为转矩限幅设定值。
实施例三:
下面介绍转速控制:
S201:转速给定指令值ωrm**与异步电动机的实际角频率ωr做差,由两者的差值得到电磁转矩指令值iT′*。iT′*的具体计算公式如下:
iT′*=TrLmψrωse+Kpωe(k)+KIωΣi=1ke(i)e(k)=ωrm**(k)-ωr(k)---(7)]]>
需要说明的是,公式(7)与公式(2)的计算方法相同。
需要说明的是,转速给定指令值ωrm**是由异步电动机伺服驱动系统的控制器给定的值。
转速控制的后续步骤与位置控制相同,即与S102-S106相同,在此不再赘述。
实施例三介绍的异步电动机伺服驱动系统是对机器人采取转速控制,需要说明的是,上位机的控制指令为转速控制时,异步电动机伺服驱动系统对机器人采取转速控制。
需要说明的是,本实施例提供的转速控制中,转速控制可以达到:最低值为1/100Hz、1/256Hz、1/512Hz,最大值600Hz,转速控制精度可以达到小于或等于0.05Hz,加减速度指令范围1/65535Hz~1Hz,转矩指令范围在电动机额定转矩的10%~300%。
需要说明的是,转速控制时可以进行转矩限幅,具体的转矩限幅与实施例二中的相同,在此不再赘述。
实施例四:
下面介绍转矩控制:
S301:由转矩给定指令值TT**计算转矩电流给定指令值iT**。
具体的计算公式如下:
iT**=LrpnL2mimmT**---(8)]]>
其中,pn表示异步电动机的极对数;imm表示产生转子磁链的等效励磁电流;稳态时imm=im,Lm表示异步电动机定子绕组的自感;Lr表示异步电动机转子绕组的自感。
需要说明的是,转矩给定指令值TT**是由异步电动机伺服驱动系统的控制器给定的值。
S302:转矩电流给定指令值iT**和转矩电流iT做差得到转矩电流的控制值iT*。由电压方程得到转矩电压指令值uT′*。
需要说明的是,由转矩电流的控制值iT*经过电压方程计算转矩电压指令值uT′*与实施例二中的S103相同,在此不再赘述。
转矩控制的后续步骤与实施例二的后续步骤相同,即与S104-S106相同。
实施例四介绍的异步电动机伺服驱动系统是对机器人采取转矩控制,需要说明的是,上位机的控制指令为转矩控制时,异步电动机伺服驱动系统对机器人采取转矩控制。
需要说明的是,转矩控制时可以进行转速限幅,具体的转速限幅与实施例二中的相同,在此不再赘述。
位置指令、转速指令、转矩指令均可同时或独立在线改变,指令值改变后,电动机按照指令值实际运动。位置指令、速度指令和转矩指令三种指令可以通过不同接口与上位机连接进行通讯。
基于以上实施例提供的机器人用异步电动机伺服驱动方法,本发明实施例还提供一种机器人用异步电动机伺服驱动系统,下面结合附图进行详细描述。
参见图3,该图为本发明提供的系统第一实施例示意图。
本实施例提供的机器人用异步电动机伺服驱动系统,包括:反馈单元401、比较单元402和控制单元403。
所述反馈单元401,用于实时监测异步电动机的当前运行状态,将监测的异步电动机的当前运行状态信息反馈给比较单元402。
所述比较单元402,用于将所述当前运行状态信息与给定的指令值相比较得到对应的控制指令值。
所述控制单元403,用于由所述控制指令值对异步电动机进行控制。
本发明提供的机器人用异步电动机伺服驱动系统,可以满足机器人控制系统对伺服驱动装置在精度和性能方面的要求。采用异步电动机的当前运行状态信息和控制器给定的指令值相比较,以差值作为控制指令,这样可以实现实时地闭环控制。由于异步电动机的转速可以达到很高,而且其工作环境可以不受温度的限制,因此可以避免采用永磁同步电动机驱动时带来的缺点。
参见图4,该图为本发明提供的系统第二实施例示意图。
本实施例以监测异步电动机的实际角度,对异步电动机进行位置控制为例进行详细介绍。
当所述反馈单元反馈的当前运行状态信息为异步电动机的实际角度时,所述比较单元包括:位置控制单元、转速控制单元、转矩电流控制单元、励磁电流控制单元、坐标转换单元和SVPWM逆变单元。
所述位置控制单元,用于将异步电动机的实际角度θr与位置给定指令值θmm**做差,将差值进行PI调节以后得到转速控制指令值;
所述转速控制单元,用于将转速控制指令值与异步电动机的实际角频率做差,由两者的差值得到电磁转矩指令值ωrm*;
所述转矩电流控制单元,用于将电磁转矩指令值ωrm*和转矩电流之差经过电压方程得到转矩电压指令值uT′*;
所述励磁电流控制单元,用于将励磁电流指令值iM′*和励磁电流iM之差经过电压方程得到励磁电压指令值uM′*。
需要说明的是,励磁电流指令值iM′*和励磁电流iM之差为励磁电流控制值iM*。
坐标转换单元,用于由转矩电压控制值uT*和励磁电压控制值uM*经过M-T坐标到三相交流坐标变换得到异步电动机的三相电压控制值;M-T坐标系与异步电动机的旋转磁场同步旋转,并规定M轴沿转子磁链方向,T轴沿M轴逆时针转90度;所述励磁电压控制值uM*为励磁电压指令值uM′*和励磁解耦电压uM′之差;所述转矩电压控制值uT*为转矩电压指令值uT′*与转矩解耦电压uT′之差。
SVPWM逆变单元,用于将输入的三相电压控制值转变为三相正弦电流并输入到异步电动机的定子绕组中,实现对异步电动机的伺服控制。
需要说明的是,转矩电流和励磁电流是由异步电动机的相电流经过坐标转换得到的,具体可以参见公式(1)。
参见图5,该图为本发明提供的系统实施例三示意图。
励磁解耦电压和转矩解耦电压是由解耦单元通过励磁电流和转矩电流解耦得到的,具体可以参见公式(5)。
需要说明的是,需要说明的是,无论是位置控制,还是转速控制或转矩控制,均需要励磁控制环路,这是为了给转子提供旋转的磁场。励磁控制是通过将磁链指令值与励磁电流相结合来控制输出的励磁电压控制值。由于励磁电流是异步电动机的反馈值,这样可以实现闭环控制。
下面具体介绍励磁的计算。本实施例提供的系统还包括磁链计算单元和磁链控制单元,其中磁链计算单元是由励磁电流计算转子磁链。
磁链控制单元用于将磁链给定指令值ψm**和转子磁链ψr的差值经过计算得到励磁电流指令值iM′*。
以上所述,仅是本发明的较佳实施例而已,并非对本发明作任何形式上的限制。虽然本发明已以较佳实施例揭露如上,然而并非用以限定本发明。任何熟悉本领域的技术人员,在不脱离本发明技术方案范围情况下,都可利用上述揭示的方法和技术内容对本发明技术方案做出许多可能的变动和修饰,或修改为等同变化的等效实施例。因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所做的任何简单修改、等同变化及修饰,均仍属于本发明技术方案保护的范围内。