基于分段PD控制的振动基弹药传输机械臂轨迹跟踪控制

PDF(2094 KB)

振动与冲击 ›› 2021, Vol. 40 ›› Issue (4) : 283-292.

论文

席宝成1,2，郭宇飞1,2，王志刚1，郝志强1

作者信息 +

Trajectory tracking control of a vibration-based ammunition transmission manipulator based on piecewise PD control

XI Baocheng1,2, GUO Yufei1,2, WANG Zhigang1, HAO Zhiqiang1

Author information +

文章历史 +

摘要

针对一种新型带振动底座的弹药传输机械臂的轨迹跟踪控制问题，设计一种鲁棒控制器。首先阐明了弹药传输机械臂的工作原理以及三维模型，利用第二类拉格朗日方法建立了弹药传输机械臂动力学模型。其次，在控制力范数有界的假设下，基于分段线性控制算法以及计算力矩法，设计了反馈控制器。控制律表现为增益可变的比例微分控制，在动态过程中，控制器增益根据系统当时状态偏差以阶跃方式按设定规律作相应改变，当系统接近或达到终端状态时，控制器的增益趋于动态平衡状态。控制力输入总是满足给定的约束条件。最后，采用龙格库塔法在MATLAB环境下进行数值仿真。结果表明，该控制器能很好地抑制基座的振动以及载荷不确定性带来的影响，满足自动装弹机的精确快速轨迹跟踪控制，具有良好的鲁棒性。

Abstract

A robust controller was designed for trajectory tracking control of a new type of ammunition transmission manipulator with vibration base.Firstly, the working principle and a three-dimensional model of the ammunition transmission manipulator were expounded, and a dynamic model of the automatic loader was established by using the second Lagrange method.Secondly, under the assumption that the control force norm is bounded, a feedback controller was designed based on a piecewise linear control algorithm and a computational moment method.The control law was expressed as a proportional differential control with variable gain.In the dynamic process, the controller gain was changed by a step form based on the setting law according to the state deviation of the system at the current state.When the system approaches or reaches the terminal state, the controller gain tends to dynamic equilibrium.The input of control force always satisfies the given constraints.Finally, numerical simulation was carried out in the MATLAB environment using the Runge-Kutta method.The results show that the controller can suppress the vibration of the base and the influence of load uncertainty, satisfy the precise and fast trajectory tracking control of the automatic loader, and has good robustness.

导出引用

席宝成1,2，郭宇飞1,2，王志刚1，郝志强1. 基于分段PD控制的振动基弹药传输机械臂轨迹跟踪控制[J]. 振动与冲击, 2021, 40(4): 283-292

XI Baocheng1,2, GUO Yufei1,2, WANG Zhigang1, HAO Zhiqiang1. Trajectory tracking control of a vibration-based ammunition transmission manipulator based on piecewise PD control[J]. Journal of Vibration and Shock, 2021, 40(4): 283-292

参考文献

[1] 侯保林, 樵军谋, 刘琮敏. 火炮自动装填[M]. 北京: 兵器工业出版社, 2010: 36-38
Hou Baolin, Qiao Junmou, Liu Congmin. Autoloading of howitzer[M]. Beijing: The Publishing House of Ordnance Industry, 2010: 36-38.
[2] 郭宇飞, 侯保林. 传动柔性及负载变化弹药传输机械臂位置控制及柔性振动抑制[J]. 振动与冲击, 2015(22):1-8.
Guo Yufei, Hou Baolin. Positioning control and elastic vibration suppressing of an ammunition transfer manipulator with transmission flexibility and payload uncertainty[J]. Journal of Vibration and Shock, 22(1), 1–8(2015)
[3] Guo, Y., Hou, B.: Implicit Lyapunov function-based tracking control of a novel ammunition autoloader with base oscillation and payload uncertainty. Nonlinear Dynamics.87(2), 741–753 (2017)
[4] Rybus, T., Seweryn, K., Sasiadek, J.Z.: Control system for free-floating space manipulator based on nonlinear model predictive control(nmpc). Journal of Intelligent and Robotic Systems. 85(3-4), 491–509 (2017)
[5] Zong, L., Luo, J., Wang, M., Yuan, J.: Parameters concurrent learning and reactionless control in post-capture of unknown targets by space manipulators. Nonlinear Dynamics. 96(1), 443–447 (2019)
[6] Zhang, J., Li,W., Yu, J., Zhang,Q., Cui, S., Li, Y., Li, S., Chen, G.: Development of a virtual platform for telepresence control of an underwater manipulator mounted on a submersible vehicle. IEEE Transactions on Industrial Electronics. 64(2), 1716–1727 (2017)
[7] Wang, Y., Wang, S., Wei, Q., Tan, M., Zhou, C., Yu, J.: Development of an under water manipulator and its free-floating autonomous operation. IEEE-ASME Transactions on Mechatronics. 21(2), 815–824 (2016)
[8] Sun, N., Fang, Y., Chen, H., Wu, Y., Lu, B.: Nonlinear ant-swing control of offshore cranes with unknown parameters and persistent ship-induced perturbations: Theoretical design and hardware experiments. IEEE Transactions on Industrial Electronics. 65(3), 2629–2641 (2018)
[9] Sun, N., Fang, Y., Chen, H., Fu, Y., Lu, B.: Nonlinear stabilizing control for ship-mounted cranes with ship roll and heave movements: Design, analysis, and experiments. IEEE Transactions on Systems, Man, and Cybernetics. 48(10), 1781–1794 (2018)
[10] Fang, Y., Wang, P., Sun, N., Zhang, Y.: Dynamics analysis and nonlinear control of an offshore boom crane. IEEE Transactions on Industrial Electronics. 61(1), 414–427 (2014)
[11] Sebastian, K.,Mahl, T., Jorg, N., Schneider, K., Swaodny,O.: Active control for an offshore crane using prediction of the vessel’s motion. IEEE/ASME Transactions on Mechatronics. 16(2), 297–309 (2011)
[12] Sato, M., Toda, M.: Robust motion control of an oscillatory-base manipulator in a global coordinate system. IEEE Transactions on Industrial Electronics.62(2), 1163–1174 (2015)
[13] Wang, C., Wu, P., Zhou, X., Pei, X.: Composite sliding mode control for a free-floating space rigid-flexible coupling manipulator system. International Journal of Advanced Robotic System. 10(2), 323–330 (2015)
[14] Tang, W.Y., Wei, L.X., Jian, D.H.: Dynamic compensation control of flexible macro-micro manipulator systems. IEEE Transactions on Control Systems Technology. 18(1), 143–151 (2010)
[15] Singer, N.C., Seering,W.P.: Preshaping command input to reduce system vibration. Journal of Dynamic Systems, Measurement, and Control-Transactions of The ASME. 1112(1), 76–82 (1990)
[16] Lai, C.Y.: Decoupling of macro-mini manipulator using adaptive neural networks. In: IEEE/ASME International Conference on Advanced Intelligent Mechatronics. Besacon: IEEE , 2014.
[17] Bassan, H., Talebi, H.A., Patel, R.V., Moallem, M.: Control of a rigid manipulator mounted on a compliant base. Robotica. 23(2), 197–206 (2005)
[18] Ott, C., Albu-Schaffer, A., Hirzinger, G.: A cartesian compliance controller for a manipulator mounted on a flexible structure. In: IEEE/RSJ International Conference on Intelligent Robots and Systems. Beijing:IEEE，2006.
[19] Duan, X., Qiu, Y., Mi, J., Zhao, Z.: Motion prediction and supervisory control of the macro/micro parallel manipulator system. Robotica. 29(7), 1005–1015 (2011)
[20] Mannani, A., Talebi, H.A.: A fuzzy Lyapunov-based control strategy for a macro-micro manipulator: Experimental results. IEEE Transactions on Control Systems Technology. 15(2), 375–383 (2007)
[21] Lin, J., Huang, Z.Z., Huang, P.H.: An active damping control of robot manipulators with oscillatory bases by singular perturbation approach. Journal of Sound and Vibration. 304(1-2), 345–360 (2007)
[22] Lin, J., Huang, Z.Z.: A hierarchical fuzzy approach to supervisory control of robot manipulators with oscillatory bases. Mechatronics. 17(10), 589–600 (2007)
[23] Toda, M.: An control-based approach to robust control of mechanical systems with oscillatory bases. IEEE Transactions on Robotics and Automation. 20(2), 283–296 (2004)
[24] Iwamura, T., Toda,M.:Motion control of an oscillatory-base manipulator using sliding mode control via rotating sliding surface with variable-gain integral control. IEEE American Control Conference. Washington, DC:, IEEE, 2013.
[25] Sato, M., Toda, M.: Robust motion control of an oscillatory-base manipulator in a global coordinate system. IEEE Transactions on Industrial Electronics. 62(2), 1163–1174 (2015)
[26] 刘金琨, 孙富春. 滑模变结构控制理论及其算法研究与进展[J]. 控制理论与应用, 2007, 24(3):407-418.
Liu Jinkun, Sun Fuchun. Research and Development of Sliding Mode Variable Structure Control Theory and Algorithms[J]. Control Theory and Application, 2007, 24 (3): 407-418.
[27] 高为炳. 变结构控制研究的发展与现状[J]. 控制与决策, 1993(4):241-248.
Gao Weibing. The Development and Present Situation of Variable Structure Control Research [J]. Control and Decision-making, 1993 (4): 241-248.
[28] Ananievski IM. Bounded control of elastic linear mechanical systems with unknown parameters[A]. Control of Oscillations and Chaos. Saint Petersburg: IEEE,1997.
[29] Ananievski IM. The control of a mechanical system with unknown parameters by a bounded force[J]. Journal of Applied Mathematics and Mechanics, 1997, 61(1): 49-58.
[30] AnanievskiIM. Limited control of a rheonomous mechanical system under uncertainty[J]. Journal of Applied Mathematics and Mechanics, 2001, 65(5): 785-796.
[31] Chernousko FL, Ananievski I M, Reshmin S A. Control of nonlinear dynamical systems[M]. Berlin: springer-verlag Berlin Heidelberg, 2008.158-243.