发明名称 一种电动助力转向系统扭矩传感器零点漂移补偿方法
摘要 一种电动助力转向系统扭矩传感器零点漂移补偿方法,包括转向系统、助力电机、PID控制器、扭矩传感器、状态观测器,通过建立EPS系统空间状态模型,采用状态观测器对电动助力转向系统进行状态观测,检测扭矩传感器偏离零点时的输出是由驾驶员输入产生还是由扭矩传感器本身零点漂移产生;检测是扭矩传感器本身零点漂移产生的输出,则记录此值,并执行扭矩传感器零点漂移补偿算法;实现对扭矩传感器零点校准。本发明通过建立EPS系统空间状态模型,并采用状态观测器对系统进行状态观测,纯软件补偿,提高了扭矩传感器可靠性;当扭矩传感器补偿值大于预定范围时,可对扭矩传感器进行故障报警,提高了整个系统的安全。
申请公布号 CN103085864B 申请公布日期 2015.07.29
申请号 CN201310029195.8 申请日期 2013.01.25
申请人 株洲易力达机电有限公司 发明人 高明;林联伟;石广林;吴艳霞
分类号 B62D5/04(2006.01)I;B62D6/10(2006.01)I 主分类号 B62D5/04(2006.01)I
代理机构 代理人
主权项 一种电动助力转向系统扭矩传感器零点漂移补偿方法,其特征在于,包括转向系统、助力电机、PID控制器、扭矩传感器、状态观测器,通过建立EPS系统空间状态模型,采用状态观测器对电动助力转向系统进行状态观测,检测扭矩传感器偏离零点时的输出是由驾驶员输入产生还是由扭矩传感器本身零点漂移产生;当检测是扭矩传感器本身零点漂移产生的输出,则记录此值,并执行扭矩传感器零点漂移补偿算法;实现对扭矩传感器零点校准;具体补偿方法包括如下:第一步:建立状态观测器,观测扭矩传感器产生零点漂移的时刻;区别是驾驶员输入力矩使得扭矩传感器输出,还是扭矩传感器零点漂移产生输出;在没有驾驶员输入力矩或外力输入转向盘时,此状态称之转向盘自由状态,如果扭矩传感器正常,处在自由状态下的扭矩传感器没有输出,扭矩传感器没有产生零点漂移;反之,则扭矩传感器产生了零点漂移,需要对扭矩传感器进行校准或补偿;由于EPS中包括管柱和传感器执行系统及电机执行系统,执行系统中含有丰富的状态信息,能提高状态鉴别的精度,在做状态监测时,同时建立电机执行子系统数学模型和整个EPS执行动力学模型;EPS执行动力学模型:<img file="190563dest_path_image001.GIF" wi="333" he="54" />(1‑1)<img file="232338dest_path_image002.GIF" wi="528" he="54" />(1‑2)<img file="12075dest_path_image003.GIF" wi="404" he="54" />(1‑3)<img file="597164dest_path_image004.GIF" wi="165" he="54" />(1‑4)<img file="171682dest_path_image006.GIF" wi="120" he="54" />(1‑5)式中,θ<sub>s</sub>为转向盘转角,θ<sub>m</sub>为电机转角,T<sub>h</sub>为驾驶员输入力矩,Ts为扭矩传感器测出的转矩,<img file="438716dest_path_image007.GIF" wi="20" he="24" />为电机电磁转矩,<img file="824566dest_path_image008.GIF" wi="23" he="24" />为齿轮位移,<img file="493445dest_path_image009.GIF" wi="23" he="24" />为电机控制电压;根据状态空间表达形式,建立电动助力转向系统的空间状态模型:<img file="486809dest_path_image010.GIF" wi="98" he="45" />根据(1‑1)~(1‑3)式,令状态向量为<img file="178821dest_path_image011.GIF" wi="386" he="26" /><img file="915833dest_path_image012.GIF" wi="351" he="48" />(1‑6)<img file="626169dest_path_image013.GIF" wi="537" he="48" />(1‑7)<img file="56013dest_path_image014.GIF" wi="404" he="48" />(1‑8)由于<img file="297639dest_path_image015.GIF" wi="102" he="24" />,<img file="510446dest_path_image016.GIF" wi="98" he="24" />,<img file="153917dest_path_image017.GIF" wi="108" he="24" />为常数,令它们分别等于<img file="489083dest_path_image018.GIF" wi="86" he="24" />;将公式(1‑6)~(1‑8)整理后得,<img file="404955dest_path_image019.GIF" wi="293" he="45" /><img file="483770dest_path_image020.GIF" wi="57" he="24" /><img file="919430dest_path_image021.GIF" wi="470" he="48" /><img file="691077dest_path_image022.GIF" wi="57" he="26" /><img file="641716dest_path_image023.GIF" wi="297" he="45" /><img file="714101dest_path_image024.GIF" wi="57" he="26" /><img file="66585dest_path_image025.GIF" wi="470" he="180" /><img file="9133dest_path_image026.GIF" wi="70" he="147" />,<img file="384751dest_path_image027.GIF" wi="70" he="147" />,<img file="805368dest_path_image028.GIF" wi="65" he="159" />,<img file="277938dest_path_image029.GIF" wi="62" he="144" />,<img file="578338dest_path_image030.GIF" wi="102" he="168" /><img file="503569dest_path_image031.GIF" wi="272" he="147" />上式中,Z为系统线性输入,A为系统的系统矩阵,X为系统的状态向量,B为控制矩阵,U为输入向量,C为输出矩阵,系统以T<sub>h</sub>为输入,以θ<sub>m</sub>,<img file="665560dest_path_image032.GIF" wi="23" he="24" />为输出;经过标准矩阵修正后的实际矩阵为<img file="727057dest_path_image033.GIF" wi="125" he="45" />电机执行子系统数学模型:<img file="11407dest_path_image034.GIF" wi="201" he="45" />(2‑1)<img file="638884dest_path_image035.GIF" wi="72" he="21" />(2‑2)<img file="820466dest_path_image036.GIF" wi="89" he="39" />(2‑3)<img file="947822dest_path_image037.GIF" wi="125" he="27" />(2‑4)其中,<img file="847645dest_path_image038.GIF" wi="24" he="24" />为电机回路总电阻,<img file="413756dest_path_image039.GIF" wi="19" he="24" />为电机电流,<img file="902375dest_path_image040.GIF" wi="23" he="24" />为电机端电压,<img file="262949dest_path_image041.GIF" wi="23" he="24" />为电机电枢电感,Ce为电枢反电动势常数,<img file="587751dest_path_image042.GIF" wi="24" he="21" />为电动机转子旋转速度,C<sub>m</sub>为电机电磁转矩常数;EPS执行器的力矩通过蜗轮蜗杆减速后施加到转向轴上;根据状态空间表达形式,(2‑1)~(2‑4)建立直流有刷助力电机的空间状态模型:<img file="957553dest_path_image043.GIF" wi="77" he="45" />直流电机对象引入两个状态变量:<img file="848148dest_path_image044.GIF" wi="99" he="24" />,选取输入量:<img file="835083dest_path_image045.GIF" wi="45" he="24" />,输出量为<img file="443919dest_path_image046.GIF" wi="39" he="19" />;再根据公式(2‑1)~(2‑4)经过整理消去中间变量,可以表示成为:<img file="617412dest_path_image047.GIF" wi="176" he="45" /><img file="565776dest_path_image048.GIF" wi="80" he="42" />再将<img file="533732dest_path_image049.GIF" wi="99" he="24" />代人上式,得到状态空间表达式<img file="816815dest_path_image050.GIF" wi="240" he="87" /><img file="466102dest_path_image051.GIF" wi="125" he="51" />从上面两个状态监测器可以看出,<img file="331290dest_path_image052.GIF" wi="309" he="36" />为系统的状态;<img file="470147dest_path_image053.GIF" wi="81" he="27" />,转向盘输入转矩T<sub>h</sub>和车速V作为系统输入,电机电流作为输出,可由控制器中电流检测部件获得,当转向盘处于自由状态时,<img file="240526dest_path_image052.GIF" wi="309" he="36" />和<img file="490242dest_path_image053.GIF" wi="81" he="27" />全为零,而当驾驶员输入力矩时或有外力作用于转向系统时,<img file="475515dest_path_image054.GIF" wi="309" he="36" />和<img file="722957dest_path_image053.GIF" wi="81" he="27" />不全为零;如果当转向盘处于自由状态时,电机电流<img file="793681dest_path_image055.GIF" wi="84" he="24" />为零,从而可以得出在某一个车速下转向盘输入扭矩T<sub>h</sub>为零,如果此刻扭矩传感器<img file="847088dest_path_image056.GIF" wi="120" he="48" />有输出,则扭矩传感器发生了零点漂移,漂移值的大小为Ts;第二步:设计补偿算法计算漂移值的大小,EPS的扭矩信号设有主辅两路,在实际控制时,主路控制,辅路主要判断故障,主路和辅路电压之和为5V;扭矩传感器的零点中间位置在2.5V处,小于2.5V代表向左输入力矩,大于2.5V代表向右输入力矩;状态观测器一边采集数据,一边计算,实现对系统状态的实时的观测,其递推公式计算可由单片机或数字信号处理在线完成;具体算法为:    在扭矩传感器出厂时主路初始电压Umref为2.52V,辅路初始电压Usref为2.48V,假设经过2万公里路试,主路初始电压Umref变为电压Um1 =2.43V,辅路初始电压Umref变为电压Us1=2.57V,经过计算<img file="873818dest_path_image057.GIF" wi="152" he="42" />    第三步:将补偿值更新至助力模块中,使助力值达到左右相等; 经过补偿后,传感器主路电压为Um=2.43‑(‑0.07)=2.5V,与理想主路电压相同,与主路初始电压Umref(2.52V)相差0.02V;即可把漂移值存入单片机或数字信号处理的EEPROM中,在助力模型中对扭矩的漂移进行补偿。
地址 412000 湖南省株洲市芦淞区董家塅高科技工业园
您可能感兴趣的专利