Complex Robot Trajectory Planning with Consideration of Joint-torque Dynamics Problem
-
摘要: 考虑到关节型机器人工作时关节力矩变化对工作质量的影响,针对机器人复杂工作中各关节受力平稳性控制问题,本文提出改进直接配点法优化求解复杂轨迹上机器人关节动力学问题。在对机器人动力学模型进行分析的基础上,使用直接配点法将沿复杂轨迹运动的机器人动力学优化求解问题转化为非线性方程组的多目标优化求解问题,并采用序列二次规划算法求解;针对方程组中高度非凸函数极值求解过程中对初值敏感的问题,采用线性二次调节器为序列二次规划算法提供迭代初值。理论分析和数值仿真结果表明:提出的算法可保证机器人各关节在复杂轨迹上力矩、角度及角速度变化平缓,稳定工作质量,同时也能更合理地控制机器人工作时的能耗水平。Abstract: Considering the impact of joint-torque variation of robot on the working quality, and aiming at the force control problem during the complex trajectory planning, an optimized algorithm for dynamics problems based on direct collocation method was proposed. With the analysis of robot's dynamical model, the direct collocation method was used to turn the robot's dynamic optimization problem into multi-objective optimization problem of nonlinear equations, and the sequential quadratic programming was used to solve the equations.For the initial value sensitivity problem which exists in the highly non-convex function extreme value solving process of the equations, the linear quadratic regulator was used to provide iterative initial values for sequential quadratic programming. Theoretical analysis and numerical simulation results indicated that the proposed method can guarantee smooth variation of robot's torque, angle and angular velocity during complex trajectory operation, stabilize working quality, and it can control energy consumption during working process more reasonably.
-
Key words:
- robots /
- trajectory planning /
- dynamics /
- direct collocation /
- linear quadratic regulator
-
[1] 朱华征,范大鹏,张文博,等.质量不平衡力矩对导引头伺服机构性能影响分析[J].红外与激光工程,2009,38(5):767-772 Zhu H Z, Fan D P, Zhang W B, et al. Influence analysis of the mass imbalance torque on the performance of seeker servo mechanism[J]. Infrared and Laser Engineering, 2009,38(5):767-772(in Chinese) [2] 周友行,张建勋,董银松.点焊机器人复杂轨迹逆运动学组合优化求解[J].焊接学报,2010,31(9):21-24,114 Zhou Y H, Zhang J X, Dong Y S. An optimization algorithm for combination inverse kinematics problems of welding robot in complex trajectory[J]. Transactions of the China Welding Institution, 2010,31(9):21-24,114(in Chinese) [3] Pfeiffer S, Angulo C. Gesture learning and execution in a humanoid robot via dynamic movement primitives[J]. Pattern Recognition Letters, 2015,67:100-107 [4] Park G, Tani J. Development of compositional and contextual communicable congruence in robots by using dynamic neural network models[J]. Neural Networks, 2015,72:109-122 [5] Zhang N, Shang W W. Dynamic trajectory planning of a 3-DOF under-constrained cable-driven parallel robot[J]. Mechanism and Machine Theory, 2016,98:21-35 [6] Kumar E V, Jerome J. Robust LQR controller design for stabilizing and trajectory tracking of inverted pendulum[J]. Procedia Engineering, 2013,64:169-178 [7] Tahirovic A, Magnani G. A Roughness-based RRT for mobile robot navigation planning[J]. IFAC Proceedings Volumes, 2011,44(1):5944-5949 [8] Thanh T D, Kotlarski J, Heimann B, et al. Dynamics identification of kinematically redundant parallel robots using the direct search method[J]. Mechanism and Machine Theory, 2012,55:104-121 [9] Edeling W N, Dwight R P, Cinnella P. Simplex-stochastic collocation method with improved scalability[J]. Journal of Computational Physics, 2016,310:301-328 [10] Christodoulou C A, Vita V, Ekonomou L, et al. Application of Powell's optimization method to surge arrester circuit models' parameters[J]. Energy, 2010,35(8):3375-3380 [11] Zhang P, Sun Q, Xiao W L. Parameter identification in mixed Brownian-fractional Brownian motions using Powell's optimization algorithm[J]. Economic Modelling, 2014,40:314-319 [12] Niku S B. Introduction to robotics:analysis, systems, applications[M]. Hoboken, NJ:Wiley, 2011 [13] Hargraves C R, Paris S W. Direct trajectory optimization using nonlinear programming and collocation[J]. Journal of Guidance, Control, and Dynamics, 1987,10(4):338-342 [14] Paul J, Bruce A. Optimal finite-thrust spacecraft trajectories using collocation and nonlinear programming[J]. Journal of Guidance, Control, and Dynamics, 1991,14(5):981-985 [15] Kumar E V, Jerome J. Robust LQR controller design for stabilizing and trajectory tracking of inverted pendulum[J]. Procedia Engineering, 2013,64:169-178 [16] Wang L, Ni H Q, Zhou W F, et al. MBPOA-based LQR controller and its application to the double-parallel inverted pendulum system[J]. Engineering Applications of Artificial Intelligence, 2014,36:262-268
点击查看大图
计量
- 文章访问数: 389
- HTML全文浏览量: 22
- PDF下载量: 6
- 被引次数: 0