Solving the Time-Jerk Optimal Trajectory Planning Problem of a Robot Using Augmented Lagrange Constrained Particle Swarm Optimization

Lu, Shaotian; Zhao, Jingdong; Jiang, Li; Liu, Hong

doi:https://doi.org/10.1155/2017/1921479

Mathematical Problems in Engineering

On this page

Abstract Introduction Discussion Conclusion Conflicts of Interest Acknowledgments References Copyright Related Articles

Research Article | Open Access

Volume 2017 | Article ID 1921479 | https://doi.org/10.1155/2017/1921479

Solving the Time-Jerk Optimal Trajectory Planning Problem of a Robot Using Augmented Lagrange Constrained Particle Swarm Optimization

Shaotian Lu,¹Jingdong Zhao,¹Li Jiang,¹and Hong Liu¹

Academic Editor: Luciano Mescia

Received15 Feb 2017

Accepted10 May 2017

Published15 Jun 2017

Abstract

The problem of minimum time-jerk trajectory planning for a robot is discussed in this paper. The optimal objective function is composed of two segments along the trajectory, which are the proportional to the total execution time and the proportional to the integral of the squared jerk (which denotes the derivative of the acceleration). The augmented Lagrange constrained particle swarm optimization (ALCPSO) algorithm, which combines the constrained particle swarm optimization (CPSO) with the augmented Lagrange multiplier (ALM) method, is proposed to optimize the objective function. In this algorithm, falling into a local best value can be avoided because a new particle swarm is generated per initial procedure, and the best value gained from the former generation is saved and delivered to the next generation during the iterative search procedure to enable the best value to be found more easily and more quickly. Finally, the proposed algorithm is tested on a planar 3-degree-of-freedom (DOF) robot; the simulation results show that the algorithm is effective, offering a solution to the time-jerk optimal trajectory planning problem of a robot under nonlinear constraints.

1. Introduction

Trajectory planning is the foundation of robot trajectory control. The aim of trajectory planning is to generate trajectory points and plan a smooth trajectory. Optimal trajectory planning has been a focus of robot research studies in recent years because its performance is important for the efficiency and motion stability of a robot. The major steps in optimal trajectory planning are as follows. First, several points along a given geometric path are given. Then, the inverse kinematic solutions of the given trajectory points are obtained. Next, interpolating functions are used to perform trajectory planning in the joint space. Finally, an optimal method is used to optimize the trajectory in order to make it smooth and continuous. Boundary condition constraints, such as those on the velocity, acceleration, jerk, and time, need to be considered in the optimization procedure.

Reasonable trajectory planning can reduce vibration and ensure the long joint life and high path tracking accuracy of a robot. The minimum-time trajectory planning approach was first proposed in the literature to improve the efficiency of robots; the study of such planning has become an important field in trajectory optimization. The purpose of minimum-time trajectory planning is to plan the shortest execution time trajectory according to the given points while the boundary constraints are satisfied. Examples of minimum-time trajectory planning are provided in [1–5]. In fact, vibration may appear when a robot is in the moving process or when it is stopped, which will negatively impact the tracking accuracy of the robot; therefore, minimum vibration is an important performance index, and many researchers have studied how to utilize minimum-jerk trajectory planning to reduce vibration [6–8]. The minimum-time and minimum-jerk trajectory planning studies are often considered together to improve the efficiency and smoothness of the trajectory and reduce the vibration of a robot; the combination of these two methods is referred to as time-jerk optimal trajectory planning. Examples of such trajectory planning are provided in [9–13].

In the many aforementioned optimal trajectory planning studies, the main research procedure can be summarized as follows. First, the optimal objective function is transformed into a mathematic expression. Second, relational optimization methods are adopted to optimize the mathematic expression. Finally, the optimal results are compared, and a conclusion is reached considering the requirements. Currently, the major interpolated functions used in joint space include cubic splines and fifth-order B-splines, and the major optimal methods include genetic algorithms, PSO, and the sequential quadratic programming (SQP) strategies. The current literature regarding time-jerk optimal trajectory planning suffers from two problems. First, few studies have been performed on this topic, and further in-depth study is required. Second, because optimal trajectory planning is an optimization problem with constraints, the penalty function method is typically used when considering these issues. In the penalty function method, in certain cases, the nonlinear constrained problem can only converge to the optimal solution when the penalty factor becomes infinitely large (according to the exterior penalty function method) or infinitely small (according to the interior penalty function method). Moreover, a large number of tests need to be performed to determine a reasonable initial penalty factor. Therefore, although some optimal algorithms adopted in the prior literature have been improved, it is difficult to achieve a balance in terms of the quality and efficiency of the optimal solution because of the condition restrictions.

This paper proposes a new approach for time-jerk optimal trajectory planning in order to increase the efficiency and reduce the vibration of the robot. The new approach, named augmented Lagrange constrained particle swarm optimization (ALCPSO), combines the constriction factor method from the basic PSO algorithm with the ALM. In contrast to previous research, a new particle swarm is generated for each initial procedure of the PSO; this process can avoid falling into the local best value, and the best value of the prior generation is saved and delivered to the next generation during the iterative search for procedure to allow the best value to be found more easily and quickly. This approach enables the best value to be obtained even for finite penalty factors. The new approach does not require an accurate dynamic model or a continuously differentiable objective function; thus, it has stronger robustness.

The remainder of this paper is organized as follows. The minimum time-jerk trajectory planning problem is described in Section 2. Application of the technique based on the CPSO and ALM methods to solve the nonlinear constrained optimization problem is described in Section 3. Section 4 presents the simulation results of the ALCPSO algorithm. Section 5 presents the conclusions of this study.

2. The Minimum Time-Jerk Trajectory Planning Problem

The optimal trajectory planning premise of this paper is that the geometric path has been given. Thus, the joint space position points corresponding to the discrete operative space (Cartesian space) can be obtained according to inverse kinematics; subsequently, the joint trajectory of the robot can also be obtained via the polynomial or the cubic splines method by connecting the relevant position points. The use of cubic splines in trajectory planning is ordinary because the generated trajectories have continuous acceleration values. In addition, in contrast to higher-order polynomials, the cubic splines can overcome excessive oscillations and overshoot problems between any pair of reference points. In this paper, we implement the joint trajectory planning by utilizing the cubic splines described in [10, 11, 14]. The trajectory planning performance depends largely on the objective function. The objective function [9] is defined as follows:

In (1), , through adjusting the values of and to allow the total execution time and jerk effect to reach the optimum. Because the total execution time and the proportional to the integral of the squared jerk may have a large difference in quantity grade, the elastic coefficient is introduced to balance the effects of them. The meanings of the symbols in (1) are presented in the Symbols.

Therefore, the optimal trajectory planning problem under constraints can be solved by using (1) to search for the optimum solution of time interval .

3. Solving the Nonlinear Constrained Optimization Problem

References [15–17] presented the PSO algorithm, which is a theory that explains the origins of the performance of individuals for bird flocks or fish schools about their collective behavior. The ALM method has numerous advantages, such as its numerical stability and calculated efficiency surpassing the penalty function.

3.1. Constrained Particle Swarm Optimization

In [18, 19], the constriction factor χ of PSO was introduced to ensure the convergence of the PSO as follows:

The particle velocity and position of the PSO are updated as follows:In (2), researchers commonly define and set ; thus, becomes 4.1 and . In (3), denotes the number of iterations; and are nonnegative values named acceleration factors; and are two random values distributed in the range ; describes the individual best position; describes the global best position. Now, the PSO can be referred to as the constrained particle swarm optimization (CPSO) algorithm, which can realize an effective balance between the global search and the local search.

3.2. Augmented Lagrange Multiplier (ALM) Method

The ALM method is similar to the Lagrange multiplier method; however, in contrast to the latter, the former does not require many tests to determine a reasonable initial penalty factor, and the dynamic penalty factor does not tend to infinity; that is, the former surpasses the latter in terms of numerical stability and computational efficiency [20–22]. For general inequality constraints, the optimization model can be described as

Its ALM method can be defined as follows:where denotes the independent variable, denotes the objective function, denotes the inequality constraints, denotes the Lagrange multiplier, and denotes the penalty factor. is described as follows:

The solution of the original constrained problem (4) can be obtained by solving (5). The Lagrange multiplier iterative formula is expressed aswhere denotes the number of times that the Lagrange multiplier is updated. The penalty factor updated formula is expressed as follows:where denotes the constraint error accuracy.

When , the termination criterions are as follows:

When , the termination criterions are defined as follows: where denotes the convergence accuracy and denotes the update maximal times.

The ALM method can guarantee that the optimal solution can be found when the penalty factor does not reach infinity, which cannot be guaranteed by either the interior or the exterior penalty function method.

3.3. Augmented Lagrange Constrained Particle Swarm Optimization (ALCPSO) Algorithm

Because the CPSO and ALM enjoy their respective advantages, in this paper, we propose an algorithm named ALCPSO algorithm which combines the CPSO with the ALM in order to make use of their respective advantages to provide a new approach for solving nonlinear constrained optimization problems. Time-jerk optimal trajectory planning is such a problem. The ALCPSO algorithm comprises the following steps.

[ALCPSO1]. Set , , , , , , , , and . Transform the constrained problem (4) into the unconstrained problem (5).

[ALCPSO2]. Initialize particles with randomly chosen positions and velocities and evaluate the corresponding fitness values at each position.

[ALCPSO3]. Check the termination criterions (9). If they are satisfied, the algorithm terminates with the best value ; if they are not satisfied, the obtained best value is saved. Initialize particles with randomly chosen positions and velocities and set .

[ALCPSO4]. Utilize the obtained best value of former generation to replace one group of particles.

[ALCPSO5]. Apply (3) to update the particles, evaluate the corresponding fitness values at each position, and find the best .

[ALCPSO6]. Check the updated number of times of the Lagrange multiplier/penalty factor. If it is satisfied, check the termination criterions (10); if the termination criterions (10) are satisfied, the best value is obtained; if they are not satisfied, update the Lagrange multipliers and the penalty factors according to (7) and (8) and set . If the updated number of times of the Lagrange multiplier/penalty factor is not satisfied, proceed with step [ALCPSO5].

In this algorithm, a new particle swarm is freshly generated in each initial procedure to avoid falling into the local best value, and the best value can be found more easily and quickly because the best value of the prior generation is saved and delivered to the next generation during the iterative search for procedure.

4. Trajectory Planning Simulation and Discussion

Before optimizing the robot’s trajectory, its inverse kinematics should be obtained. In [23, 24], the configuration control approach is proposed to solve the inverse kinematics of the redundant robot; this approach ensures that the inverse kinematics is unique and enables the robot to perform cyclic motion, which is an essential requirement for repetitive operations. Moreover, this approach requires little computational time, making it particularly favorable for the real-time control of a redundant robot. In this paper, we use the damped least squares (DLS) of the configuration control approach to determine the inverse kinematics of a redundant robot. Its formulation can be written in the following form: where W is a symmetric positive-definite weighting matrix, , where and are symmetric positive-definite weighting matrices in accordance with the basic task and an additional task, respectively; is a symmetric positive-definite weighting matrix; is a positive scalar constant; is a symmetric positive-definite feedback gain (constant); is error, .

Next, the position solution of inverse kinematics can be obtained by integrating (11). We use the proposed ALCPSO method to perform a trajectory planning simulation of a robot to verify the accuracy and reliability of the method. The program is compiled in Matlab™ R2014. The test object is a space robot under the condition that the position and pose of the associated carrying platform are under control; it is a 3-DOF planar robot shown in Figure 2. The tested mission is tracking a circular path in plane. In Figure 1, , , and are joint angles. The robot geometric parameters are defined as = 2,080 mm, = 2,080 mm, and = 430 mm. Because the robot has a redundant degree of freedom, the configuration control approach is utilized to determine its inverse kinematics. The initial position of the end effector is (4000, 0) (mm), with corresponding joint angles of (30°, −49.03°, −38.27°), and the radius and the center of the track circle are 400 mm and (3600, 0) (mm), respectively. The following procedure is used to obtain the inverse kinematics of the robot:(1)Set the planned trajectory points in the circular path as a function of time , mean , which is used to plan the desired trajectory points.(2)Choose as the additional task.(3)Let ].(4)Put the corresponding values into (11) and perform integration to obtain the position solution of inverse kinematics.

(a)

(b)

(c)

(d)

In this paper, indicates the circular central angle; it is divided into uniform acceleration, uniform velocity, and uniform deceleration for a total of three sections along the counterclockwise rotation. The robot starts from an initial position with the angular acceleration from the value of 120/(1/80 × n)^2°/ ( denotes the number of planned via-points). When the robot along the circle moves by 60°, the uniform acceleration section is completed, and it enters the uniform velocity section, moving along the circle by 240°; finally, the robot with value of 120/(1/80 × n)^2°/ enters the uniform deceleration section and returns to the initial point, thus completing the entire motion. In this paper, set . Other values are defined as follows:

, , , , , , and

The values of the plan-points of the trajectory are shown in Table 1. As shown in Table 1, the 1-point coincides with the 9-point when the end effector completes a cyclic motion. Thus, there are 9 plan-points and 8 via-points. The kinematic constraints of the velocity, acceleration, and jerk of the joints are 3 deg/s, 3 deg/s², and 5 deg/s³, respectively.

We set the robot’s execution time constraint s, the initial Langrage multiplier , the initial penalty factor , the convergence accuracy , the constraint error accuracy , the Lagrange multiplier update maximal times , the maximum number of iterations in the CPSO , the swarm particle number , and the elastic coefficient . The weighting coefficients are adjusted as follows: is 1, 0.8, 0.5, 0.2, and 0, and the corresponding can be determined via calculation. We performed the proposed optimal method using the five weighting coefficient values, and the corresponding results are shown in Table 2. The execution time gradually increases when gradually decreases from 1 to 0. The joint trajectories prior to optimization are shown in Figure 2.

The simulation results when is 1, 0.5, and 0 are shown in Figures 3–5, respectively. When is 1, the objective function contains only the minimum-time function. The joints’ velocities, accelerations, and jerks shown in Figure 3 are generally larger than those in Figure 2; the joint maximum jerk reaches the upper bounds on the absolute value at the initial moment, which corresponds to a rough trajectory, resulting in a comparatively larger vibration and lower path tracking accuracy of the robot during the moving process. If the robot operates in such a condition for an excessive period of time, its lifespan will be reduced. However, the working efficiency of the robot can increase because the execution time is reduced; this condition suits a robot with strict working efficiency requirement. The execution time in Figure 4 is longer than that in Figure 3; however, the jerks on the whole are smaller than that in Figure 3. In Figure 5, the execution time is equal to the set constraint t, and compared to the results in Figure 2, the joints’ velocities, accelerations, and jerks are generally smaller than those in Figure 2, indicating that, under the same execution time condition, it is beneficial for a robot during the moving process compared with that before performing optimization because of the lower velocities, accelerations, and jerks.

(a)

(b)

(c)

(d)

(a)

(b)

(c)

(d)

(a)

(b)

(c)

(d)

From analyzing Table 2 and Figures 2–5, we can achieve relevant objects by adjusting elastic and weighting coefficients according to different requirements.

When we combine the CPSO with the interior penalty function method, the constrained problem (4) can be expressed as follows:where denotes the penalty factor. We set the initial penalty factor = 100000 and the convergence accuracy ; other corresponding values are referred to in the aforementioned ALCPSO method.

The termination criterions are defined as follows:where denotes the number of iterations. The simulation results are shown in Table 3 for typical values of and . After comparing the corresponding results with those of the ALCPSO method, we can find that the ALCPSO method indeed has some advantages, such as the calculated velocity and some obtained best values. In Table 3, when is set as 0, the obtained time is shorter than that of the ALCPSO method. This implies that when is set as 0, the CPSO and interior penalty function methods can be used to perform time-jerk optimal trajectory planning because they can get better time.

When we utilize the SQP method (e.g., the fmincon function of Matlab) described in [9, 10], the initial input is the same as the aforementioned ALCPSO method to perform time-jerk optimal trajectory planning. The simulation results are shown in Table 4. After comparing the corresponding results with those of the ALCPSO method, we can find that the ALCPSO method generally surpasses the SQP method in the obtained best values.

5. Conclusion

This paper proposed an ALCPSO algorithm, which is based on the CPSO and the ALM methods, to realize the time-jerk optimal trajectory planning of a robot. In this algorithm, a new particle swarm is generated each time in the initial process in order to avoid falling into a local best value. In this manner, the best value can be found more easily and quickly because the best value of the previous generation is saved and delivered to the next generation during the iterative search for procedure. The optimal objective function considers both the total execution time and the integral of the squared jerk along the entire trajectory and then varies the values of two weighting coefficients and the elastic coefficient to achieve such requirements as rapid execution, a smooth trajectory, or both. The algorithm is implemented on a planar 3-DOF robot. The simulation results illustrate that the time-jerk optimal trajectory that meets both the kinematics and the execution time constraints can be obtained. The proposed algorithm is developed without performing an experiment; thus, future work will be devoted to performing experiments to verify the present algorithm’s effectiveness.

Symbols

:	Number of robot joints
:	Time weighting coefficient
:	Jerk weighting coefficient
:	Time interval between two via-points
:	Jerk limit for the th joint (symmetrical)
:	Number of via-points
:	Velocity of the th joint
:	Acceleration of the th joint
:	Jerk of the th joint
:	Velocity limit for the th joint (symmetrical)
:	Acceleration limit for the th joint (symmetrical)
:	Execution time limit.

Conflicts of Interest

The authors declare that there are no conflicts of interest regarding the publication of this paper.

Acknowledgments

This research was supported by the Foundation for Innovative Research Groups of the National Natural Science Foundation of China (Grant no. 51521003).

References

C.-S. Lin, P.-R. Chang, and J. Y. S. Luh, “Formulation and optimization of cubic polynomial joint trajectories for industrial robots,” IEEE Transactions on Automatic Control, vol. 28, no. 12, pp. 1066–1074, 1983.
View at: Publisher Site | Google Scholar
D. G. Li, J. Y. Qiu, and B. You, “Optimal algorithm for trajectory planning of the robot,” Electric Machines and Control, vol. 13, no. 1, pp. 123–127, 2009.
View at: Google Scholar
A. Piazzi and A. Visioli, “Global minimum-time trajectory planning of mechanical manipulators using interval analysis,” International Journal of Control, vol. 71, no. 4, pp. 631–652, 1998.
View at: Publisher Site | Google Scholar | MathSciNet
J. Kim, S.-R. Kim, S.-J. Kim, and D.-H. Kim, “A practical approach for minimum-time trajectory planning for industrial robots,” Industrial Robot, vol. 37, no. 1, pp. 51–61, 2010.
View at: Publisher Site | Google Scholar
F. Rubio, F. Valero, J. Sunyer, and J. Cuadrado, “Optimal time trajectories for industrial robots with torque, power, jerk and energy consumed constraints,” Industrial Robot, vol. 39, no. 1, pp. 92–100, 2012.
View at: Publisher Site | Google Scholar
A. Piazzi and A. Visioli, “Global minimum-jerk trajectory planning of robot manipulators,” IEEE Transactions on Industrial Electronics, vol. 47, no. 1, pp. 140–149, 2000.
View at: Publisher Site | Google Scholar
A. Piazzi and A. Visioli, “Interval algorithm for minimum-jerk trajectory planning of robot manipulators,” in Proceedings of the 1997 36th IEEE Conference on Decision and Control, pp. 1924–1927, December 1997.
View at: Google Scholar
H.-I. Lin, “A fast and unified method to find a minimum-jerk robot joint trajectory using particle swarm optimization,” Journal of Intelligent and Robotic Systems: Theory and Applications, vol. 75, no. 3-4, pp. 379–392, 2014.
View at: Publisher Site | Google Scholar
Z. Cao, H. Wang, W. Wu, and H. Xie, “Time-jerk optimal trajectory planning of shotcrete manipulators,” Journal of Central South University (Science and Technology), vol. 44, no. 1, pp. 114–121, 2013.
View at: Google Scholar
A. Gasparetto and V. Zanotto, “A technique for time-jerk optimal planning of robot trajectories,” Robotics and Computer-Integrated Manufacturing, vol. 24, no. 3, pp. 415–426, 2008.
View at: Publisher Site | Google Scholar
V. Zanotto, A. Gasparetto, A. Lanzutti, P. Boscariol, and R. Vidoni, “Experimental validation of minimum time-jerk algorithms for industrial robots,” Journal of Intelligent and Robotic Systems: Theory and Applications, vol. 64, no. 2, pp. 197–219, 2011.
View at: Publisher Site | Google Scholar
M. Cong, X. Xu, and P. Xu, “Time-jerk synthetic optimal trajectory planning of robot based on fuzzy genetic algorithm,” in Proceedings of the 15th International Conference on Mechatronics and Machine Vision in Practice (M2VIP'08), pp. 274–279, Auckland, New Zealand, December 2008.
View at: Publisher Site | Google Scholar
L. Feifei and L. Fei, “Time-jerk optimal planning Of industrial robot trajectories,” International Journal of Robotics and Automation, vol. 31, no. 1, pp. 1–7, 2016.
View at: Publisher Site | Google Scholar
S. F. Saramago and J. Steffen, “Optimization of the trajectory planning of robot manipulators taking into account the dynamics of the system,” Mechanism and Machine Theory, vol. 33, no. 7, pp. 883–894, 1998.
View at: Publisher Site | Google Scholar | MathSciNet
R. Poli, J. Kennedy, and T. Blackwell, “Particle swarm optimization: an overview,” Swarm Intelligence, vol. 1, no. 1, pp. 33–57, 2007.
View at: Publisher Site | Google Scholar
W. Xu, C. Li, B. Liang, Y. Liu, and Y. Xu, “The Cartesian path planning of free-floating space robot using particle swarm optimization,” International Journal of Advanced Robotic Systems, vol. 5, no. 3, pp. 301–310, 2008.
View at: Google Scholar
P. Huang and Y. Xu, “PSO-based time-optimal trajectory planning for space robot with dynamic constraints,” in Proceedings of the 2006 IEEE International Conference on Robotics and Biomimetics (ROBIO'06), pp. 1402–1407, Kunming, China, December 2006.
View at: Publisher Site | Google Scholar
A. Khare and S. Rangnekar, “A review of particle swarm optimization and its applications in Solar Photovoltaic system,” Journal Applied Soft Computing, vol. 13, no. 5, pp. 2997–3006, 2013.
View at: Publisher Site | Google Scholar
M. Wang, P. Wang, J.-S. Lin, X. Li, and X. Qin, “Nonlinear inertia classification model and application,” Mathematical Problems in Engineering, vol. 2014, Article ID 987686, 9 pages, 2014.
View at: Publisher Site | Google Scholar
Y. Yu, X. Yu, and Y. Li, “Solving engineering optimization problem by Augmented Lagrange particle swarm optimization,” Journal of Mechanical Engineering, vol. 45, no. 12, pp. 167–172, 2009.
View at: Publisher Site | Google Scholar
X. Yan, Y. Zhong, G. Sun, and Z. Zhong, “Cost optimization design of hybrid composite flywheel rotor,” Journal of Mechanical Engineering, vol. 48, no. 12, pp. 118–126, 2012.
View at: Publisher Site | Google Scholar
K. Sedlaczek and P. Eberhard, “Using augmented Lagrangian particle swarm optimization for constrained problems in engineering,” Structural and Multidisciplinary Optimization, vol. 32, no. 4, pp. 277–286, 2006.
View at: Publisher Site | Google Scholar
H. Seraji, “Configuration control of redundant manipulators: theory and implementation,” IEEE Transactions on Robotics and Automation, vol. 5, no. 4, pp. 472–490, 1989.
View at: Publisher Site | Google Scholar
K. Glass, R. Colbaugh, D. Lim, and H. Seraji, “On-line collision avoidance for redundant manipulators,” in Proceedings of the IEEE International Conference on Robotics and Automation, pp. 36–43, Atlanta, Ga, USA, 1993.
View at: Publisher Site | Google Scholar

Copyright

Copyright © 2017 Shaotian Lu et al. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

PDF Download Citation

Download other formats

Order printed copies

Views

4072

Downloads

1322

Citations