发明名称 伺服转台LuGre模型摩擦参数及转动惯量的一体化测量方法
摘要 伺服转台LuGre模型摩擦参数及转动惯量的一体化测量方法:获取转台驱动电机输入端等效电容C,电感L,输入电阻R,电机反电势系数Kb,力矩系数Cm;控制转台做匀速转动,测量角速度、电流的变化曲线,求出转台库伦力矩MC和粘滞摩擦系数σ2;测量转台驱动电机输入开路、仅有摩擦作用下自由减速过程的角速度变化曲线ω0(t);以LuGre模型的动力参数和转台转动惯量为输入变量,以时间t为自变量构造自由减速拟合曲线ω([ωs,Ms,σ0,σ1,J],t);设置评价准则,利用优化算法使ω([ωs,Ms,σ0,σ1,J],t)逼近ω0(t),从而辨识出拟合曲线的输入参数。本发明不需安装力矩传感器,不破坏转台的整体性;在测量过程中只需要驱动电流、转台角速度等信息,实现方便,且能够准确地描述摩擦过程的复杂的动态、静态特性,便于对转台进行高精度控制。
申请公布号 CN102269638B 申请公布日期 2013.01.02
申请号 CN201110106758.X 申请日期 2011.04.27
申请人 中国科学院光电技术研究所 发明人 马佳光;于伟;包启亮;李锦英;毛耀;李志俊
分类号 G01M1/10(2006.01)I;G01N19/02(2006.01)I 主分类号 G01M1/10(2006.01)I
代理机构 北京科迪生专利代理有限责任公司 11251 代理人 成金玉;贾玉忠
主权项 1.伺服转台LuGre模型摩擦参数及转动惯量的一体化测量方法,其特征在于步骤如下:(1)获取转台驱动电机输入端等效电容C、电感L、输入电阻R、电机反电势系数K<sub>b</sub>和力矩系数C<sub>m</sub>;(2)控制转台做匀速转动,测量转台角速度、电流的变化曲线,根据电机力矩平衡公式C<sub>m</sub>·i<sub>a</sub>=M<sub>C</sub>+σ<sub>2</sub>·ω求出库伦力矩M<sub>c</sub>和粘滞摩擦系数σ<sub>2</sub>,式中,i<sub>a</sub>为转台驱动电机的电枢电流,ω为转台驱动电机的角速度;(3)测量转台驱动电机输入端开路、仅有摩擦作用下自由减速过程的角速度变化曲线<img file="FDA00002267110300011.GIF" wi="186" he="70" />其中t<sub>s</sub>为角速度衰减到0的调节时间;(4)以LuGre模型的动力参数stribeck角速度ω<sub>s</sub>、最大静摩擦力M<sub>s</sub>、鬃毛刚度σ<sub>0</sub>、微观阻尼系数σ<sub>1</sub>和转台转动惯量J为输入变量,以时间t为自变量构造自由减速拟合曲线<img file="FDA00002267110300012.GIF" wi="521" he="54" />具体构造方法如下:(a)利用电机电枢回路电压平衡方程:<maths num="0001"><![CDATA[<math><mrow><mn>0</mn><mo>=</mo><mfrac><mn>1</mn><mi>C</mi></mfrac><mo>&Integral;</mo><msub><mi>i</mi><mi>a</mi></msub><mi>dt</mi><mo>+</mo><mi>R</mi><msub><mi>i</mi><mi>a</mi></msub><mo>+</mo><mi>L</mi><mfrac><msub><mi>di</mi><mi>a</mi></msub><mi>dt</mi></mfrac><mo>+</mo><msub><mi>K</mi><mi>b</mi></msub><mi>&omega;</mi><mo>;</mo></mrow></math>]]></maths>(b)通过连续系统离散化方法得到转台驱动电机的电枢电流i<sub>a</sub>递推公式:i<sub>a</sub>(k)=b<sub>1</sub>·i<sub>a</sub>(k-1)+…+b<sub>n</sub>·i<sub>a</sub>(k-n)+a<sub>1</sub>·ω(k-1)+…+a<sub>m</sub>·ω(k-m);式中{ω(k-1),ω(k-2),…,ω(k-m)}为离散表达式输入信号序列,m为离散表达式中输入信号最高阶项阶次,{i<sub>a</sub>(k),…,i<sub>a</sub>(k-n)}为输出信号序列,n为输出信号最高阶阶次,k为采样时刻,b<sub>1</sub>,…,b<sub>n</sub>,a<sub>1</sub>,…,a<sub>m</sub>为各阶系数;(c)利用LuGre模型表达式:<maths num="0002"><![CDATA[<math><mfenced open='{' close=''><mtable><mtr><mtd><mfrac><mi>dz</mi><mi>dt</mi></mfrac><mo>=</mo><mi>&omega;</mi><mo>-</mo><msub><mi>&sigma;</mi><mn>0</mn></msub><mfrac><mrow><mo>|</mo><mi>&omega;</mi><mo>|</mo></mrow><mrow><mi>g</mi><mrow><mo>(</mo><mi>&omega;</mi><mo>)</mo></mrow></mrow></mfrac><mi>z</mi></mtd></mtr><mtr><mtd><msub><mi>M</mi><mi>f</mi></msub><mo>=</mo><msub><mi>&sigma;</mi><mn>0</mn></msub><mi>z</mi><mo>+</mo><msub><mi>&sigma;</mi><mn>1</mn></msub><mfrac><mi>dz</mi><mi>dt</mi></mfrac><mo>+</mo><msub><mi>&sigma;</mi><mn>2</mn></msub><mi>&omega;</mi></mtd></mtr><mtr><mtd><mi>g</mi><mrow><mo>(</mo><mi>&omega;</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>M</mi><mi>c</mi></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>M</mi><mi>S</mi></msub><mo>-</mo><msub><mi>M</mi><mi>c</mi></msub><mo>)</mo></mrow><msup><mi>e</mi><mrow><mo>-</mo><msup><mrow><mo>(</mo><mi>&omega;</mi><mo>/</mo><msub><mi>&omega;</mi><mi>s</mi></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow></msup></mtd></mtr></mtable></mfenced></math>]]></maths>上式中z为刚鬃形变,ω为当前角速度,g(ω)为stribeck曲线,由此得到摩擦力矩M<sub>f</sub>的离散表达式:<maths num="0003"><![CDATA[<math><mfenced open='{' close=''><mtable><mtr><mtd><mi>g</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>M</mi><mi>c</mi></msub><mo>+</mo><mrow><mo>(</mo><msub><mi>M</mi><mi>S</mi></msub><mo>-</mo><msub><mi>M</mi><mi>c</mi></msub><mo>)</mo></mrow><msup><mi>e</mi><mrow><mo>-</mo><msup><mrow><mo>(</mo><mi>&omega;</mi><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>/</mo><msub><mi>&omega;</mi><mi>s</mi></msub><mo>)</mo></mrow><mn>2</mn></msup></mrow></msup></mtd></mtr><mtr><mtd><mi>&Delta;z</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mi>&omega;</mi><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>-</mo><msub><mi>&sigma;</mi><mn>0</mn></msub><mfrac><mrow><mo>|</mo><mi>&omega;</mi><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow><mo>|</mo></mrow><mrow><mi>g</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mrow></mfrac><mo>&CenterDot;</mo><mi>z</mi><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mtd></mtr><mtr><mtd><mi>z</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><mi>&Delta;z</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>&CenterDot;</mo><msub><mi>T</mi><mi>s</mi></msub><mo>+</mo><mi>z</mi><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msub><mi>M</mi><mi>f</mi></msub><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>=</mo><msub><mi>&sigma;</mi><mn>0</mn></msub><mo>&CenterDot;</mo><mi>z</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>&sigma;</mi><mn>1</mn></msub><mo>&CenterDot;</mo><mi>&Delta;z</mi><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow><mo>+</mo><msub><mi>&sigma;</mi><mn>2</mn></msub><mo>&CenterDot;</mo><mi>&omega;</mi><mrow><mo>(</mo><mi>k</mi><mo>-</mo><mn>1</mn><mo>)</mo></mrow></mtd></mtr></mtable></mfenced></math>]]></maths>上式中Ts为数据更新周期,k为采样时刻,g(k)为k时刻stribeck曲线离散值,Δz(k)表示刚鬃形变z在k时刻的一阶差分值,z(k)表示刚鬃形变z在k时刻的离散值,M<sub>f</sub>(k)表示摩擦力矩在k时刻的离散值;(d)利用电机动力学方程:<maths num="0004"><![CDATA[<math><mrow><mi>J</mi><mfrac><mi>d&omega;</mi><mi>dt</mi></mfrac><mo>=</mo><msub><mi>C</mi><mi>m</mi></msub><mo>&CenterDot;</mo><msub><mi>i</mi><mi>a</mi></msub><mo>-</mo><msub><mi>M</mi><mi>f</mi></msub></mrow></math>]]></maths>通过连续系统离散化方法得到角速度的递推公式:Δω(k)=C<sub>m</sub>·i<sub>a</sub>(k)-M<sub>f</sub>(k)    ω(k)=Δω(k)·T<sub>s</sub>+ω(k-1);(5)设置评价函数为实测曲线ω<sub>0</sub>(t)和拟合曲线ω([ω<sub>s</sub>,M<sub>s</sub>,σ<sub>0</sub>,σ<sub>1</sub>,J],t)误差的范数:e=‖ω<sub>0</sub>(t)-ω([ω<sub>s</sub>,M<sub>s</sub>,σ<sub>0</sub>,σ<sub>1</sub>,J],t)‖,利用优化算法求解最优输入变量组[ω<sub>s</sub>,M<sub>s</sub>,σ<sub>0</sub>,σ<sub>1</sub>,J],使<img file="FDA00002267110300023.GIF" wi="505" he="55" />逼近<img file="FDA00002267110300024.GIF" wi="186" he="68" />从而辨识出拟合曲线的输入参数。
地址 610209 四川省成都市双流350信箱