In high-speed and high-precision machinery, trajectories with high-frequency harmonic content are one of the main sources of reduction of operational precision. Trajectories with high-frequency harmonic content generally demand even higher-harmonic actuating forces/torques due to the nonlinear dynamics of such systems, which may excite natural modes of vibration of the system and/or be beyond the dynamic response limitation of the actuation devices. In this paper, a global interpolation algorithm that uses the trajectory pattern method (TPM) for synthesizing low-harmonic trajectories is presented. The trajectory synthesis with the TPM is performed with a prescribed fundamental frequency and continuous jounce boundary condition, which would minimize the number of high-harmonic components in the required actuation forces/torques and avoid excitation of the system modes of vibration. The minimal curvature variation energy method, Lagrange multiplier method, and contour error control are used to obtain smooth kinematic profiles and satisfy the trajectory accuracy requirements. As an example, trajectory patterns that consist of a fundamental frequency sinusoidal time function and its first three harmonics are used to synthesize the desired trajectories for a selected dynamic system. The synthesized trajectories are shown to cause minimal system vibration during its operation. A comparison with a commonly used trajectory synthesis method clearly shows the superiority of the developed TPM-based approach in reducing vibration and demand on the actuator dynamic response, thereby allowing the system to operate at higher speeds and precision.
For the trajectory synthesis (Chu et al., 2020; Dai et al., 2020; Van Loock et al., 2015) of high-speed machinery, such as CNC (computerized numerical control) machinery, robot manipulators and other computer-controlled machines, polynomial-based curves (Analooee et al., 2020; Liang and Su, 2019; Shen et al., 2020) are still the most widely used trajectories. It has the following advantages: (1) numerically stable algorithms; (2) it is more natural for designing and representing shape in a computer. The coefficients of functions possess considerable geometric significance. This translates into intuitive design methods. However, it is important to note that when expressed in Fourier series, all synthesized trajectories – such as those based on polynomial (Analooee et al., 2020; Shen et al., 2020), Akima (Bica, 2014; Wang et al., 2014), or B spline (Du et al., 2018; Simba et al., 2016) curves – contain significant high-harmonic content. In addition, the nonlinearity of the machine system dynamics would require actuating forces/torques with even higher-harmonic content to follow the prescribed trajectories. The lack of control over the harmonic content of the required actuating forces/torques and their frequencies in currently available and published methods for trajectory synthesis leads to excitation of natural modes of vibration of high-speed machinery.
In order to avoid exciting the natural modes of the mechanical structure or servo control system, many researchers have focused on flexible feed-rate planning methods for high-speed and high-precision machinery. Erkorkmaz and Altintas (2001) provided a continuous feed motion by constructing trapezoidal acceleration profiles along the quintic spline trajectory. Lee and Choi (2015) obtained smoother kinematic profiles with a discretized sinusoidal jerk function. To improve the flexibility, Wang (2015) proposed a trigonometric velocity scheduling algorithm, which could generate smooth velocity, acceleration, and jerk curves of parametric interpolation. Huang and Zhu (2016) represent jerk profiles by the sine series for feed-rate planning of parametric interpolator. The coefficients of the sine series are determined by selecting the geometric sequence. To reduce the time spent by the smoothing and planning process, Li et al. (2019) developed a real-time and look-ahead interpolation algorithm with axial jerk-smooth profiles. In one step, the algorithm finishes the trajectory synthesis and velocity planning by using the trigonometric velocity planning method. From these methods mentioned above, it can be seen that the vibration reduction effect is not obvious any more along with the increase of flexibility further, since the frequency distribution of synthesized kinematic profiles is not considered. The sine series method constructed jerk profiles with sinusoidal functions with an appropriate fundamental frequency and all harmonics, which contained considerable high-harmonic content. Although other methods did motion planning by using one sinusoidal function with a specified fundamental frequency, their velocity or/and displacement functions exist as polynomial items, which also results in significant high-harmonic components. Biagiotti and Melchiorri (2012) and Tajima et al. (2018) utilized finite impulse response filters to remove high-harmonic content of synthesized trajectories. However, filtering introduces unavoidable delay and induces large contouring errors in multi-axis motion that must be compensated since the filtered components are needed to achieve the prescribed motion.
Rastegar and Fardanesh (1990) introduced the concept of trajectory patterns that are constructed with sinusoidal functions with an appropriate fundamental frequency. Rastegar and Feng (2011) applied it to synthesis of trajectories with low-harmonic content such that the harmonic content of the required actuation forces/torques is controlled and does not contain significant high-harmonic content. The synthesized trajectory is a unique combination of a fundamental frequency harmonic and its second harmonic, which results in the minimum number of harmonics in the required actuation forces/torques and minimizes excitation of the system modes of vibrations. But this method is only used for point-to-point motions with zero end point velocity, acceleration, and jerk. To improve motion efficiency and precision, this paper, therefore, extends the trajectory pattern method (TPM) to construct trajectories with continuous velocity, acceleration, jerk, and jounce at mid-points. The fundamental frequency of the synthesized trajectories can be selected such that together with all its harmonics that appear in the trajectory and the required actuating forces/torques would not excite the natural modes of vibration of the system. The actuating forces/torques can then be readily optimized and used in a model-based control scheme to achieve high-speed and high-precision operation of the system.
In this paper, a path planning algorithm is presented that uses harmonic-based trajectory patterns for high-speed machinery. In Sect. 2, a global interpolation method using the TPM with a specified fundamental frequency, motion periods, and chord error is introduced. Minimal curvature variation energy and Lagrange multiplier method are used to synthesize the trajectories. The synthesized trajectories and axis kinematic profiles are smooth and only contain the fundamental frequency and its first three harmonics, which are designed to minimize vibration of the high-speed machinery. In Sect. 3, the effectiveness of the proposed algorithm is illustrated through computer simulations studies. Conclusions of the present study are presented in Sect. 4.
In this section, a trajectory pattern method (TPM)-based global interpolation algorithm, which achieves smooth axis motion profiles with chord error constraint, is presented. In these profiles, trajectory patterns that are synthesized with a fundamental frequency and its first three harmonics are used to achieve minimum trajectory harmonic content (Rastegar and Feng, 2011).
The class of trajectory patterns used in the present study is harmonic based
and is formed by a fundamental sinusoidal function and (
In the present study, the selected trajectory pattern used for trajectory
synthesis consists of a fundamental frequency sinusoidal function and its
first three harmonics. The displacement function is then expressed as
Figure 1 shows the flow diagram of the developed global interpolation algorithm. The trajectory synthesis includes five modules: an initialization module; a boundary conditions definition module; a jerk energy function definition module; a trajectory parameters calculation module; and a contour error control module. A Lagrange multiplier method is used to calculate the trajectory parameters with the indicated objective function and equality constraints. The above modules are described in more detail in the following sections.
Flowchart of the low-harmonic trajectory synthesis.
Figure 2 presents point-to-point motion from the point
The user is to provide the required contour error
To simplify the construction process and obtain continuous smooth axis
motion profiles, the cycle time
For the trajectory segments, motion periods and corresponding fundamental
frequencies
In Fig. 2, the trajectory segment curves are drawn in red and are shown to
pass through the path segment ends
Path and synthesized trajectories.
To achieve continuous smooth axis motion profiles, boundary conditions are
necessary. In addition, since the motion is point to point, the velocities,
accelerations, jerks, and jounces at the start point
The internal energy of curve segments can affect its shape and smoothness.
The well-known examples of internal energy functions (Zhang et al., 2001)
are the stretch energy, strain energy, and jerk energy. The stretch energy
measures the length of a curve. The strain energy measures how much a curve
is bent. And the jerk energy (Meier and Nowacki, 1987) measures the
curvature variation of a curve. In this paper, we use the jerk energy to
obtain continuous smooth axis kinematic profiles with low-harmonic content.
The jerk energy is defined as
As can be seen in Fig. 2, we have the following (
After segment trajectories are synthesized using the above steps, the following process is used in this study for bounding the contour error. In the present example, the path segments are presented as lines as shown in Fig. 2, and since the segment trajectories are synthesized with a fundamental frequency time function and its three harmonics, by checking contour error at a limited number of intervals in each segment the maximum contour error is accurately estimated. In addition, since the harmonic structure of each segment trajectory and the harmonic amplitudes and phases are known, a more exact analytic formulation is possible and will be presented in future publications.
In general, the path segments may not be lines and the maximum contour error
must then be determined, for example, numerically by calculating the error
at appropriate time or distance intervals or by various search or
approximation methods. In the present example, the contour error is
calculated at three equal intervals in each segment of the path and used for
maximum contour error determination. Then if the contour error is larger
than the prescribed threshold
Contour error of the
In this section, simulations demonstrating the effectiveness and performance of the proposed low-harmonic trajectory synthesis algorithm are presented. The results are also compared with those obtained with one of the commonly used polynomial algorithms for synthesizing robot trajectories. Visual Studio 2013 was used to implement both algorithms, and results are plotted in MATLAB 2015.
To evaluate the proposed algorithm, a quintic polynomial algorithm (Perumalsamy et al., 2019), which interpolates data points using quintic polynomials with continuous displacement, velocity, acceleration, and jerk values, is used as the comparison algorithm.
As shown in Fig. 4, a letter Z-shaped pattern is selected as the path, which
contains five data points,
Letter Z-shaped path and synthesized trajectories.
Figure 5 shows that both algorithms can obtain smooth axis displacement, velocity, and acceleration profiles, and the jerk of the proposed algorithm is also smooth because of satisfying continuous jounce conditions, while that of the comparison algorithm is not smooth.
Comparison of kinematic profiles:
To evaluate the proposed algorithm further, frequency spectrum distribution of the synthesized kinematic profiles is studied using Fourier integration. In the plots of Fig. 6, the axial displacements, velocities, accelerations, and jerks of the trajectory synthesized using the quintic polynomial algorithm are shown to contain a considerable number of high-harmonic components. As a result, the related actuators are required to produce high-frequency components, which for high-speed motions would in general be beyond their dynamic response and could excite natural modes of vibration of the system. As expected, the velocity, acceleration, and jerk profiles of the synthesized trajectory with the proposed algorithm are seen in Fig. 6 to only contain a finite number of low-harmonic components.
Comparison of the Fourier analysis:
To explain how trajectories with high-harmonic components affect vibration
of machinery, an undamped, 1-degree-of-freedom linear spring–mass system
of Fig. 7 is used to model the vibration behavior of a machine. Let the
spring have a spring rate and free length of
Spring–mass system.
Now, take the
As can be seen in Fig. 8, the displacement
Vibrations of the mass–spring system of Fig. 6:
Table 1 shows that the motion times of both algorithms are almost same and that the computing time cost by the proposed algorithm (0.5051 s) is shorter than the quintic polynomial algorithm (0.7763 s). The contour errors with both algorithms are presented in Fig. 9. As can be seen, the maximum contour error of the quintic polynomial algorithm is also significantly larger than that of the proposed algorithm.
Comparison of computing and motion times.
Contour errors.
A trajectory pattern method (TPM)-based method and related algorithm has been developed for synthesis of low-harmonic trajectories for high-speed and high-precision machinery. The trajectory synthesis with the TPM is performed with a prescribed fundamental frequency and continuous jounce boundary condition, which would minimize the number of high-harmonic components in the required actuation forces/torques and avoid excitation of the system modes of vibration.
The developed TPM-based algorithm is shown to yield smooth axial kinematic profiles with low-harmonic content and thereby reduces demand on the dynamic response of the drive actuators. As a result, and with the capability of selecting the frequency of the fundamental harmonic of the synthesized trajectory and its harmonics present in the actuating forces/torques, a machine can operate at high speed and high precision.
In comparison with the previously published algorithms, the developed
algorithm has the following advantages:
The trajectories are constructed
with a sinusoidal function with a selected fundamental frequency, which can
avoid excitation of the natural modes of vibration of the machinery system. All segment displacement, velocity, acceleration, and jerk profiles are
expressed by a sinusoidal time function consisting of a selected frequency
fundamental harmonic and at least its first three harmonics, and the overall
synthesized trajectories only contain a finite number of low harmonics,
which minimizes the number of high-frequency harmonics of the required
actuation forces/torques with the aforementioned operational advantages. The developed algorithm can realize smooth axial kinematic control
action with specified contour error limitation.
In the provided example, since the trajectory synthesis with the TPM is performed with a prescribed fundamental frequency and continuous jounce boundary condition, the trajectory pattern must include at least three harmonics of the fundamental frequency. More harmonics may, however, be used to provide more trajectory parameters to achieve, for example, higher precision, usually at the expense of operating speed.
In the provided example, a point-to-point trajectory was shown to be synthesized. The method and algorithm may readily be used to synthesize general trajectories with or without defined intermediate precision points or with more loosely defined precision points to, for example, minimize contour errors.
All the data used in this paper can be obtained from the corresponding author upon request.
JR proposed the conceptualization of the trajectory pattern method. HL designed the algorithm. BW implemented the comparison and proposed algorithms. HL and BW did the performance analysis. HL wrote the original draft. JR reviewed and edited it.
The authors declare that they have no conflict of interest.
Publisher’s note: Copernicus Publications remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
The authors thank the reviewers for their critical and constructive review of the article.
This research was funded by the Scientific Research Startup Foundation for High-level Talents of Nanjing Institute of Technology (grant no. YKJ2019112) and the Shuang Chuang Doctoral Project of Jiangsu Province.
This paper was edited by Dario Richiedei and reviewed by two anonymous referees.