Improved Strong Track Filter and Its Application to Servo Control System of 3PTT-2R Institutions
-
摘要: 为解决3PTT-2R伺服系统由于模型不准确和负载扰动而引起的控制精度下降的问题,以5自由度3PTT-2R伺服系统为研究对象,建立包含执行系统、进给系统和驱动系统等若干子系统的3PTT-2R伺服系统数学模型,提出一种基于改进强跟踪滤波(Strong track filter,STF)的3PTT-2R伺服系统控制算法,并在理论上证明了稳定性.通过仿真分析,比较了STF、改进的STF算法稳定性,及对模型不确定性的鲁棒性,表明所提算法具有跟踪速度快、抑制噪声、 精度高等优点.对试样进行表面粗糙度和表面轮廓度检测,实验结果进一步说明所建立的3PTT-2R伺服系统模型与实际非线性系统模型匹配,改进的STF算法具有较好的跟踪能力,鲁棒性强、控制精度高,进而提高了加工精度.Abstract: In order to solve the problem of the declining control accuracy for 5-DOF 3PTT-2R series-parallel machine caused by inaccurate model and the load disturbance, an improved strong track fillter (STF) control method is proposed. The method takes into account the feed system, the implementation system, and servo motor. The improved STF is designed to suppress noise disturbances and its stability is proved. In the simulation, the performance of the improved STF estimation is analyzed and the tracking performances of the STF and improved STF in slowly varying and mutation status are compared. For the experiments of detecting surface roughness and profile, the improved STF tracking control algorithm has better tracking ability, stronger robustness, and higher machining accuracy.
-
[1] Li Xiong-Jie, Zhou Dong-Hua, Chen Liang-Guang. Sensor active fault tolerant control of a class of nonlinear time-delay processes. Chinese Journal of Sensors and Actuators, 2007, 20(5): 980-984(李雄杰, 周东华, 陈良光. 一类非线性时滞过程的传感器主动容错控制. 传感技术学报, 2007, 20(5): 980-984) [2] Zhou Dong-Hua, Hu Yan-Yan. Fault diagnosis techniques for dynamic systems. Acta Automatica Sinica, 2009, 35(6): 748-758(周东华, 胡艳艳. 动态系统的故障诊断技术. 自动化学报, 2009, 35(6): 748-758) [3] Kong De-Qin, Huang Tian, Zhang Hong-Bo, Zhang Ju-Yong. Dynamic modeling and robust trail tracking control of 3-DOF translational parallel kinematic machine driven by AC servo motors. Acta Automatica Sinica, 2007, 33(1): 37-43(孔德庆, 黄田, 张洪波, 张巨勇. 考虑交流伺服电机动力学特性的并联机构鲁棒轨迹跟踪控制方法研究. 自动化学报, 2007, 33(1): 37-43) [4] Wang Liang-Yong, Chai Tian-You, Fang Zheng. Neural network control and application of robotic manipulators including actuator dynamics. Acta Automatica Sinica, 2009, 35(5): 622-626(王良勇, 柴天佑, 方正. 考虑驱动系统动态的机械手神经网络控制及应用. 自动化学报, 2009, 35(5): 622-626) [5] Shinnaka S. A new speed-varying ellipse voltage injection method for sensorless drive of permanent-magnet synchronous motors with pole saliency-new PLL method using high-frequency current component multiplied signal. IEEE Transactions on Industry Application, 2008, 44(3): 777-788 [6] Foo G, Rahman M F. Sensorless sliding mode MTPA control of an IPM Synchronous motor drive using a sliding mode observer and HF signal injection. IEEE Transactions on Industrial Electronics, 2010, 57(4): 1240-1278 [7] Wenzel T A, Burnham K J, Blundell M V, Williams R A. Kalman filter as a virtual sensor: applied to automotive stability systems. Transactions of the Institute of Measurement and Control, 2007, 29(2): 95-115 [8] Bolognani S, Tubiana L, Zigliotto M. Extended Kalman filter tuning in sensorless PMSM drives. IEEE Transactions on Industry Application, 2003, 39(6): 1741-1747 [9] Zhang Bang-Cheng, Wang Yi-Qiang, Yao Yu, Cai Yun. Model-free adaptive controller of permanent magnet AC servo control system based on extended Kalman filter. In: Proceedings of the 3rd International Conference on Computational Intelligence and Industrial Application. Wuhan, Hubei: IEEE, 2010. 142-145 [10] Xu Bo, Zhu Huang-Qiu, Ji Wei, Pan Wei, Sun Xiao-Dong. Modified square-root unscented Kalman filter and its application to speed sensorless control of bearingless permanent magnet synchronous motor. Control Theory and Applications, 2012, 29(1): 53-58(许波, 朱熀秋, 姬伟, 潘伟, 孙晓东. 改进型平方根无轨迹卡尔曼滤波及其在无轴承永磁同步电机无速度传感器运行中的应用. 控制理论与应用, 2012, 29(1): 53-58) [11] Lu Ke, Xiao Jian. Strong track schmidt filter and its application to speed sensorless colltrol of induction motor. Acta Automatica Sinica, 2008, 34(9): 1076-1082(陆可, 肖建. 强跟踪延迟滤波算法及其在感应电机无速度传感器控制中的应用. 自动化学报, 2008, 34(9): 1076-1082) [12] Zhou Dong-Hua, Ye Yin-Zhong. Modern Fault Diagnosis and Fault-Tolerant Control. Beijing: Tsinghua University Press, 2000. 55-76(周东华, 叶银忠. 现代故障诊断与容错控制. 北京: 清华大学出版社, 2000. 55-76) [13] Zhou Cong, Xiao Jian. Improved strong track filter and its application to vehicle state estimation. Acta Automatica Sinica, 2012, 38(9): 1520-1527(周聪, 肖建. 改进强跟踪滤波算法及其在汽车状态估计中的应用. 自动化学报, 2012, 38(9): 1520-1527) [14] Zhou Dong-Hua. Introduction to Adaptive Control of Nonlinear Systems. Being: Tsinghua University Press, 2002. 40-81(周东华. 非线性系统的自适应控制导论. 北京: 清华大学出版社, 2002. 40-81) [15] Zhou Dong-Hua, Xi Yu-Geng, Zhang Zhong-Jun. A suboptimal multiple fading extended Kalman filter. Acta Automatica Sinica, 1991, 17(6): 689-695(周东华, 席裕庚, 张钟俊. 一种带多重次优渐消因子的扩展卡尔曼滤波器. 自动化学报, 1991, 17(6): 689-695) [16] Humpherys J, West J. Kalman filtering with Newton's method. IEEE Control Systems Magazine, 2010, 30(6): 101-106 [17] Zhou Zhen-Wei, Fang Hai-Tao. L2-stability of discrete-time kalman filter with random coefficients under incorrect covariance. Acta Automatica Sinica, 2013, 39(1): 43-52(周振海, 方海涛. 在不准确方差下带随机系数矩阵的卡尔曼滤波稳定性. 自动化学报, 2013, 39(1): 43-52)
点击查看大图
计量
- 文章访问数: 1866
- HTML全文浏览量: 68
- PDF下载量: 1049
- 被引次数: 0