Optimal Trajectory Generation for Energy Consumption Minimization and Moving Obstacle Avoidance of SURENA III Robot’s Arm

Document Type: Original Article


1 Center of Advanced Systems and Technologies(CAST), Faculty of Mechanical Engineering, University of Tehran, Tehran, Iran

2 School of Mechanical Eng Faculty Of Engineering University Of Tehran

3 Faculty of Mechanical Engineering, University of Tehran, Tehran, Iran

4 Faculty of Mechanical Engineering, K. N. Toosi University of Technology, Tehran, Iran

5 Faculty of Mechatronic Systems Engineering, Simon Fraser University, Vancouver, Canada


In this paper, trajectory generation for the 4 DOF arm of SURENA III humanoid robot with the purpose of optimizing energy and avoiding a moving obstacle is presented. For this purpose, first, kinematic equations for a seven DOF manipulator are derived. Then, using the Lagrange method, an explicit dynamics model for the arm is developed. In the next step, in order to generate the desired trajectory for the arm, two different methods are utilized. In the first method, each joint motion is presented by a quadratic polynomial. In the second one, the end effector’s path has been considered as 3 polynomial functions. Also, a known moving spherical obstacle with a linear path and constant velocity is considered in robot workspace. The main goal of optimization is to reduce the consumed energy by the arm in a movement between two known points in a specified time frame to avoid the moving obstacle. Initial and final velocities of the arm are set as zero. To this end, the optimization is carried out using Genetic Algorithm. Finally, in order to obtain the most reliable solutions for trajectory generation, many optimizations with various parameters are conducted and the results are presented and discussed.


[1]     G. Field, Y. Stepanenko. “Iterative Dynamic Programming: An Approach to Minimum Energy Trajectory Planning for Robotic Manipulators”, Intemational Conference on Robotics and Automation, Minneapolis, Minnesota, April, (1996).

[2]     A. R. Hirakawa, A. Kawamura, “Trajectory Planning of Redundant Manipulators for Minimum Energy Consumption without Matrix Iniversion” International Conference on Robotics and Automation. Albuquerque, New Mexico, April (1997).

[3]     S. F. P. Saramago, V. Steffen Jr., “Optimization Of The Trajectory Planning Of Robot Manipulators Taking Into Account The Dynamics Of The System”, Mechanism and Machine Theory, (1998).

[4]     Y. F. Li Ding, S. K. Tso, “Dynamic optimization of redundant manipulators in worst”, Mechanism and Machine Theory,  (2000).

[5]     Y. G. Zhang, L. M. X. H. Shen, L. Jin, “Dynamic Optimization Of A Robot Manipulator Based On Ga”, International Conference On Machine Learning And Cybernetics. Baoding, (2009).

[6]     Y. Zhang, S. S. Ge and T. H. Lee, “A Unified Quadratic-Programming-Based Dynamical System Approach to Joint Torque Optimization of Physically Constrained Redundant Manipulators”, IEEE Transactions On Systems, Man, and Cybernetics, (2004).

[7]     S. Ma, “A New Formulation Technique for Local Torque Optimization of Redundant Manipulators”, IEEE Transactions On Industrial Electronics, (1996).

[8]     Z. Y. Guo, T. C. Hsia, “Joint Trajectory Generation For Redundant Robots In An Environment With Obstacles”, Journal of Robotic Systems, (1990).

[9]     N. Baba, N. Kubota, “Collision Avoidance Planning of a Robot Manipulator by Using Genetic Algorithm-A Consideration for the Problem in Which Moving Obstacles and/or Several Robots Are Included in the Workspace”, IEEE World Congress on Computational Intelligence, (1994).

[10]  Y. Zhang, J. Wang, “Obstacle Avoidance for Kinematically Redundant Manipulators Using a Dual Neural Network”, IEEE Transactions On Systems, Man, And Cybernetics–Part B: Cybernetics, (2004).

[11]  M. Kawato, Y. Maeda, Y. Uno , and R. Suzuki, “Trajectory Formation of Arm Movement by Cascade Neural Network Model Based on Minimum Torque-Change Criterion”, Biological Cybernetics, (1990).

[12]  A. S. Deo, I. D. Walker, “Minimum Effort Inverse Kinematics for Redundant Manipulators”, IEEE Transactions On Robotics And Automation, (1997).

[13]  S. F. P. Saramago, V. Steffen Jr, “Dynamic Optimization for the Trajectory Planning of Robot Manipulators in the Presence of Obstacles” Journal of the Brazilian Society of Mechanical Sciences, (1999).

[14]  Z. H. Zhu , R. V. Mayorga and A. K. C. Wong, “Dynamic Robot Manipulator Trajectory Planning For Obstacle Avoidance”, Mechanics Research Communications, (1999).

[15]  Y .Zhang, S. Ma. “Minimum-Energy Redundancy Resolution of Robot Manipulators Unified by Quadratic Programming and its Online Solution”, International Conference on Mechatronics and Automation, (2007).

[16]  G. S. Sharma, A. kaur, “Optimization of Energy in Robotic arm using Genetic Algorithm”, International Journal of Computer Science and Technology, (2011).

[17]  S. F. P. Saramagoa,V. Stefen Jr. “Optimal trajectory planning of robot manipulators in the presence of moving obstacles”, Mechanism and Machine Theory, (2000).

[18]  S. Kucuk, “Energy minimization for 3-RRR fully planar parallel manipulator using particle swarm optimization”, Mechanism and Machine Theory, (2012).

[19]  D. Hui, D. Zhijiang, “Obstacle Avoidance Path Planning of Planar Redundant Manipulators using Workspace Density”, International Journal of Advanced Robotic Systems, (2015).