船体除锈机械手的干扰抑制轨迹跟踪控制

中国机械工程

船体除锈机械手的干扰抑制轨迹跟踪控制

王众1,2;焦晓红1;程明星1,3

1.燕山大学电气工程学院,秦皇岛,066004
2.北京恒进博力液压科技有限公司,北京,100176
3.凯迈（洛阳）机电有限公司,洛阳,471000

出版日期:2018-03-25 发布日期:2018-03-21

Trajectory Tracking Control with Disturbance Attenuation for Hull Derusting Manipulators

WANG Zhong1,2;JIAO Xiaohong1;CHENG Mingxing1,3

1.School of Electric Engineering,Yanshan University,Qinhuangdao,Hebei,066004
2.Beijing Eternal-Trend Bright Hydraulic Technology Co.,Ltd.,Beijing，100176
3.CAMA(Luoyang) Electromechanic Co.,Ltd.,Luoyang，Henan，471000

Online:2018-03-25 Published:2018-03-21

摘要/Abstract

摘要： 船体外壁除锈喷漆过程中需要控制机械手臂的变幅和伸缩油缸协调动作，以保证机械手臂末端在垂直轨迹方向上的匀速直线运动。针对运动过程中存在的机械手臂的柔性变形不确定性等干扰以及比例阀油缸系统内部状态量的不可测性，运用Lyapunov稳定性理论设计了基于降维观测器的干扰抑制轨迹跟踪控制器，并将所设计控制器对干扰的鲁棒性与传统PID控制进行了仿真对比。同时，应用所设计的控制算法对样机进行了相关测试，验证了所设计的控制器对机械臂外部干扰的抑制作用。

关键词: 除锈喷漆, 高空作业机械手, 干扰抑制, 动态输出反馈, 轨迹控制

Abstract: During derusting and paint-spray periods, the luffing and telescopic cylinders of the manipulator should be managed to coordinate actions， and the internal and external uncertainties acting on the system should be overcome so as to ensure the manipulator movement as uniform speed in the vertical direction. In view of uncertain disturbances existing in the deflections while the manipulator moving and unmeasured internal state variables of proportional valve cylinder system, a reduced-order observer-based trajectory tracking controller with disturbance attenuation was designed by utilizing Lyapunov stability theory. The robustness of the designed controller to disturbance was verified by comparing with the traditional PID controllers in the simulation environments. Meanwhile, the proposed control algorithm was applied to mechanical engineerings. The results show the attenuations on the external disturbances of the manipulators.

Key words: derusting and paint-spraying, aerial work manipulator, disturbance attenuation, dynamic output feedback, trajectory control

中图分类号:

TG156

王众1,2;焦晓红1;程明星1,3. 船体除锈机械手的干扰抑制轨迹跟踪控制[J]. 中国机械工程.

WANG Zhong1,2;JIAO Xiaohong1;CHENG Mingxing1,3. Trajectory Tracking Control with Disturbance Attenuation for Hull Derusting Manipulators[J]. China Mechanical Engineering.

参考文献

[1]KRASUCKI J, ROSTKOWSKI A, GOZDEK L, et al. Control Strategy of the Hybrid Drive for Vehicle Mounted Aerial Work Platform[J]. Automation in Construction, 2009, 18(2): 130-138.
[2]PILTAN F, SULAIMAN N, MARHABAN M H, et al. Design of FPGA-based Sliding Mode Controller for Robot Manipulator[J]. International Journal of Robotics & Automation, 2011, 2(3):183-204.
[3]JOEL P P, PEREZ J P, SOTO R, et al. Trajectory Tracking Error Using PID Control Law for Two-link Robot Manipulator via Adaptive Neural Networks[J]. Procedia Technology, 2012, 3(5):139-146.
[4]MANCHESTER R, SHIRIAEV A. Identification and Control of a Hydraulic Forestry Crane[J]. Fundamentals of Air Pollution, 2008,41(2): 825-851.
[5]CAO X, Liu P, SUN R, et al. Research on Straight Trajectory Control of Telescopic Boom Aerial Work Platform[J]. Journal of Convergence Information Technology, 2012, 7(14): 394-404.
[6]王欣, 高凌翀, 黄兆秋, 等. 直臂高空作业车船体喷涂轨迹控制研究与仿真[J]. 系统仿真学报, 2016, 28(2): 404-409.
WANG Xin, GAO Lingchong, HUANG Zhaoqiu, et al. Research and Simulation on Trajectory Control of Telescopic Boom Aerial Work Platform for Hull Spray Painting[J]. Journal of System Simulation, 2016, 28(2): 404-409.
[7]王硕, 李恩, 赵晓光,等. 伸缩臂高空作业车轨迹跟踪控制方法研究[J]. 华中科技大学学报(自然科学版), 2011,39(增2): 216-219.
WANG Shuo, LI En, ZHAO Xiaoguang, et al. Research on Trajectory Tracking Control Method of Aerial Work Platform with Telescopic Booms[J]. Journal of Huazhong University of Science and Technology(Natural Science Edition), 2011, 39(S2): 216-219.
[8]YUAN Q H, LEW J, PIYABONGKAM D. Motion Control of an Aerial Work Platform[J]. American Control Conference. St. Louis, MO, 2009: 2873-2878.
[9]赵静一, 苗增, 程斐,等. 高空作业车支反力计算及作业半径规划[J]. 机床与液压, 2011, 39(16):1-3.
ZHAO Jingyi, MIAO Zeng, CHENG Fei, et al. Calculation of the Support Reaction and Planning of Working Radius on Aerial Platform[J]. Machine Tool & Hydraulics, 2011, 39(16): 1-3.
[10]马振书, 梅涛. 复杂柔性车载液压机械手弹性动力学建模方法研究[J]. 中国机械工程, 2010, 21(2): 131-136.
MA Zhenshu, MEI Tao. Study on the Dynamic Modeling of a Complex Flexible Hydraulic Robot System Carried by Vehicle[J]. China Mechanical Engineering, 2010, 21(2): 131-136.
[11]GUO R, ZHAO J. Research of Electro-Hydraulic Control System Design and Energy Saving Characteristic in the New Drawbead Test Bed[C]// International Conference on Fluid Power and Mechatronics. Beijing, 2011: 301-305.
[12]陈佳, 邢继峰, 彭利坤. 基于传递函数的数字液压缸建模与分析[J]. 中国机械工程, 2014, 25(1): 65-70.
CHEN Jia, XING Jifeng, PENG Likun. Modeling and Analysis of Digital Hydraulic Cylinder Based on Transfer Function[J]. China Mechanical Engineering, 2014,25(1): 65-70.
[13]ZHANG W, SU H, WANG H, et al. Full-order and Reduced-order Observers for One-sided Lipschitz Nonlinear Systems Using Riccati Equations[J]. Communication in Nonlinear Science & Numerical Simulation. 2012, 17(12): 4968-4977.