Optimal Trajectory Planning and Linear Velocity Feedback Control of a Flexible Piezoelectric Manipulator for Vibration Suppression

Trajectory planning is an effective feed-forward control technology for vibration suppression of flexible manipulators. However, the inherent drawback makes this strategy inefficient when dealing with modeling errors and disturbances. An optimal trajectory planning approach is proposed and applied to a flexible piezoelectric manipulator system in this paper, which is a combination of feed-forward trajectory planning method and feedback control of piezoelectric actuators. Specifically, the joint controller is responsible for the trajectory tracking and gross vibration suppression of the link during motion, while the active controller of actuators is expected to deal with the link vibrations after jointmotion. In the procedure of trajectory planning, the joint angle of the link is expressed as a quintic polynomial function. And the sumof the link vibration energy is chosen as the objective function.Then, genetic algorithm is used to determine the optimal trajectory. The effectiveness of the proposed method is validated by simulation and experiments. Both the settling time and peak value of the link vibrations along the optimal trajectory reduce significantly, with the active control of the piezoelectric actuators.


Introduction
Flexible manipulators have been used in various applications including field inspection, space exploration, medical application, and hazardous environment.Compared with their rigid counterparts, flexible manipulators exhibit many advantages such as higher manipulation speed, greater payload to weight ratio, and lower energy consumption.Moreover, they can be quickly adapted to changing situations and product design variations [1].However, the conflicting requirements between high speed and high positioning accuracy have made the control of flexible manipulators a real challenging problem.Structural flexibility leads to the appearance of undesirable vibrations during motion.So flexible manipulator system exhibits combined behaviors of rigid body motions and vibrations [2].These oscillations lead to deterioration of positioning accuracy and efficiency, making the control of such system extremely difficult.
To address these problems, quite a lot of researches have been conducted on the vibration control of flexible manipulators.The existing vibration control techniques can be broadly classified into two categories, namely, feedback control and feed-forward control.The advantage of feed-forward control is that it does not require any additional sensors or actuators.Hence, the control system can be manufactured at low costs, thus being more economical.One special feed-forward control strategy, known as input command shaping, has been studied widely since its first appearance [3].Mohamed et al. [4] presented investigations into vibration control of a flexible manipulator using input shaping techniques with positive and negative input shapers.Alam and Tokhi [5] developed the design of a command shaping controller for vibration suppression of a flexible manipulator, using multiobjective genetic optimization process.More recently, Cole and Wongratanaphisan [6] described an adaptive FIR input command shaping methodology to achieve zero residual vibration control of a rigid-flexible manipulator system.The input command shaping method is effective to ensure that the input does not excite vibrations of the manipulator.But it usually costs a large amount of computation when dealing with multiple vibration modes.And it cannot suppress the induced and existing vibrations.
An alternative feed-forward control strategy to achieve vibration control of flexible manipulators is the trajectory planning approach.Wu et al. [7] proposed an optimal trajectory planning method for vibration reduction of a dual arm space robot with front flexible links, in which the trajectory was described using a fourth-order quasiuniform B-spline.Heidari et al. [8] considered the problem on the rest-to-rest motion of a flexible manipulator and formulated the trajectory planning problem as a Pontryagin optimal problem.Springer et al. [9] focused on timeoptimal trajectory planning for robots with flexible links and determined the minimum time trajectory for avoiding elastic vibration of the link.Choi et al. [10] described a new trajectory planning method for output tracking of linear flexible system using exact equilibrium manifolds.However, the trajectory planning technique is a feed-forward control strategy; vibration modes of the flexible manipulator are still controlled in open loop [11].When dealing with various disturbances and parameters variations, there would still be large residual vibrations that need to be controlled [12].
To overcome the drawbacks of feed-forward control schemes, many researchers have tried to solve the problems of link vibration suppression using feedback control techniques.Among them, some researchers concentrated on reducing the link vibrations using joint motor [13].However, the existence of nonminimum phase dynamics between the tip position and the input torque applied at the joint motor makes the system difficult to stabilize [14].A rather different approach for feedback control of link vibrations has been developed in recent years, relying on the use of smart materials [15].Among those smart materials, piezoelectric (PZT) materials have been found extensive applications in structure vibration control, due to their lightweight, fast response, large bandwidth, and so on [16].Sun et al. [17] realized the rigid motion control and vibration damping of a flexible manipulator, using a combined scheme of a PD controller for the joint motor and a linear velocity feedback (L-type) controller for the piezoelectric actuators.Gurses et al. [18] extended the previous work studied and introduced a serial array of fiber optic sensors to the control of flexible manipulators which allowed simultaneous linear (L-type) and angular (A-type) velocity feedback.Li et al. [19] presented a study on vibration suppression of a flexible piezoelectric manipulator using adaptive fuzzy sliding mode control.Choi et al. [20] studied the position control of a single-link flexible manipulator and designed a hysteresis compensator for the piezoelectric actuators.
However, in most studies on active control of flexible manipulator, attention seems to be focused on how to improve the performance of the piezoelectric controller.The contributions of the feed-forward torque or the required trajectory planning are rarely considered.A more reasonable and efficient approach seems to emerge if a combined strategy is considered.Specifically, the joint motor is responsible for the gross vibrationless motion of the structure through trajectory planning approach, while the PZT actuators are used to deal with vibrations that may arise from modeling errors and external disturbances after joint motion, by means of active control.The remainder of this paper is organized as follows.In Section 2, the flexible piezoelectric manipulator system is introduced and the governing equations of the system are derived.Section 3 proposes the optimal trajectory planning approach.The joint angle of the link is expressed as a quintic polynomial function.The constraint conditions, the initial and final conditions of the joint angle, angular velocity, and angular acceleration are applied.The sum of the link vibration energy is chosen as the objective function.Then, the optimal trajectory planning algorithm is constructed by the use of genetic algorithm.In Section 4, numerical analysis and simulations are conducted.The optimal trajectory of the flexible piezoelectric manipulator in a point-to-point motion is obtained.Section 5 describes an experimental apparatus of the flexible manipulator system, together with the experimental results, before concluding in Section 6.

Dynamic Modeling
The schematic diagram of the flexible piezoelectric manipulator system is shown in Figure 1.It is composed of a rotary joint, a single-link flexible manipulator with a rectangular cross section and a pair of collocated piezoelectric (PZT) actuators.The manipulator is attached to the hub in such a way that it rotates in the horizontal plane only.The effect of gravity can be ignored, so the link can be modeled as an Euler-Bernoulli beam.The axis   is the inertial reference line.The axis  is the tangential line to the neutral axis of the beam at the hub.For the sake of simplicity, the same assumptions are made as [17].
It is assumed that the dynamic behavior of the flexible manipulator during a point-to-point motion is dominated by the first several vibration modes, so the contributions of the higher vibration modes are negligible.Using assumed mode method, the deflection (, ) of the link can be represented as where   () and   () devote the th mode shape function and corresponding generalized coordinate, respectively.Φ() = [ 1 ⋅ ⋅ ⋅   ⋅ ⋅ ⋅   ] and q() = [ 1 ⋅ ⋅ ⋅   ⋅ ⋅ ⋅   ] represent the mode shape function and generalized coordinate index, respectively. is the mode number.Extended Hamilton's principle is used to derive the system equation.The derivation process and parameter expressions are explicitly presented in Appendix.The governing equations of the system can be derived as It should be noticed that (2) represents the rigid motion of the piezoelectric manipulator, while (3) describes the dynamic behavior of the flexible link with the control of PZT actuators.If the desired trajectory can be realized by means of tracking control, for example, trajectory control can be realized when the servo motor works in the speed control mode.In the case that tracking control is possible, only ( 3) is used for planning a trajectory where the elastic vibration of the link is eliminated or minimum.Augmenting the proportional damping, the dynamic equation of the flexible manipulator system can be expressed as It is known that it is feasible to use linear velocity feedback in the controller formulation.Thus, the linear velocity feedback (L-type) approach is readily implementable.Furthermore, the stability of the close-loop system including the L-type controller has been confirmed by Sun et al. in [17], as well as the effectiveness of the controller.Therefore, the linear velocity feedback (L-type) approach is employed to design the applied voltage of the PZT actuators in this study.In the L-type control strategy, the control voltage of the actuators is defined as where   is a positive control gain.Then, substituting (5) into (4) leads to It can be observed from ( 6) that the rigid motion of the joint, elastic vibration of the link, and active control of the PZT actuators are all considered in the procedure of trajectory planning.However, it is known that the piezoelectric parameters are very small numbers, which means that the contribution assured by the PZT control is relatively less than that of the feed-forward trajectory planning during joint motion.Therefore, the essence of the optimal trajectory planning approach is that the feed-forward trajectory planning is responsible for the gross vibrationless motion of the structure during joint motion, while the PZT actuators are used to deal with vibrations after joint motion, by means of L-type control strategy.

Optimal Trajectory Planning
This study focuses on the problem related to a point-to-point (PTP) motion of the flexible manipulator system rotating from the initial joint angle  0 to the final joint angle   over a fixed traveling time   [21].In practice, elastic vibrations of the flexible link are unavoidable due to the flexible-rigid coupled dynamics.Considering the presence of parameter uncertainties and external disturbances, the residual vibrations of the link are still exciting at the end of PTP motion, in spite of active control of PZT actuators.For a given PTP maneuver in joint space, the objective is to find an optimal joint trajectory that minimizes link vibrations during and after joint motion.The total vibration energy of a trajectory is adopted as the performance index, which is defined as q  () q () , (7) where   is the settling time of the link vibrations with piezoelectric control.The first part in (7) represents vibration energy of the link during joint motion, while the second part represents residual vibration energy after joint motion. 1 and  2 are the weighting indexes of the two parts, respectively.
To realize a smooth motion, smooth and continuous functions are typically adopted to plan the joint trajectory.Moreover, the first and second derivatives of the trajectory are also expected to be smooth and continuous.Among those common trajectory functions, the quintic polynomial function has the advantages of being accurate, precise, and easy to design and control.Moreover, it has the extra advantage of controlling the acceleration at the initial point and goal [22].So the quintic polynomial function is selected to interpolate the optimal trajectory curves, which can be written as where  0 ,  1 ,  2 ,  3 ,  4 , and  5 are the coefficients to be determined from the initial and final boundary conditions.
To get a smooth motion, the initial angle, angular velocity, and angular acceleration are set to be zero.Meanwhile, the final angular velocity and angular acceleration are also set to be zero.
To get the optimal trajectory that minimizes the performance index in (7), the travelling time   is divided into  divisions, each of which has an equal time interval.If the times at divided knots can be denoted by  0 (= 0),  1 , . . .,   , . . .,  −1 ,   , the joint angle at   is denoted by θ .
To construct the optimal trajectory, the quintic polynomial function is employed to interpolate the discrete angles.The angular velocity and angular acceleration are obtained by differentiating the quintic polynomial curves with respect to time.Finally, the discrete angels of the link are defined by introducing parameters Δ θ as where Ψ() represents the quintic polynomial motion with the above boundary conditions.Consequently, the parameter Δ θ denotes the deviation from the trajectory for the quintic polynomial motion.The discrete joint angles of the flexible link are shown in Figure 2.
Genetic algorithm (GA) approach is gaining popularity for solving complex problems in robotics.It is a populationbased stochastic and global search method.Its performance is superior to that revealed by classical optimization techniques and has been successfully used in robot trajectory planning technique [23].As the procedure discussed above, it is possible to express the optimal trajectory θ by using the parameter Δ θ , whose number is −1 for the  divisions of   .The trajectory planning procedures of the link using GA are carried out as follows.The parameters Δ θ ( = 1, 2, . . ., −1) are considered to be optimized.First, the angular velocity θ () and angular acceleration θ () are obtained from the quintic polynomial interpolation of the discrete joint angles θ .Then, the dynamic response of the flexible piezoelectric manipulator is calculated through numerical integration of (6).Finally, the optimal trajectory can be derived through minimizing the performance index in (7), using genetic algorithm.The main steps are summarized as below.
Step 2. The initial population for the first generation is generated through a random generator.Every individual includes −1 genes corresponding to the interior points to be selected, which is defined as x  = [ 1 ,  2 , . . .,   , . . .,  (−1) ].The gene of the individual   represents the optimized parameter Δ θ , and the dimension of the search space is  − 1.
Step 3. The trajectory of the link is generated through the quintic polynomial interpolation, and the vibration response of the link is derived through numerical simulations.The fitness values PI() of all the individuals in (7) are evaluated.
Step 4. A set of genetic operators, which are selection, crossover, and mutation, are used in succession to create a new population of chromosomes for the next generation.
Step 5.The process of evaluation and creation of new successive generations is repeated until the termination condition is satisfied.And the optimal trajectory for vibration suppression is finally decided where the fitness value PI() is minimum.

Simulation Studies
Numerical simulations are carried out to evaluate the performance of the proposed trajectory planning approach using MATLAB.The parameters of the proposed flexible manipulator system are shown in Table 1.In simulation, the actuator pairs are chosen to lie near the root of the link, where the strain energy of the structure is the highest [24].For simplicity, only the first vibration mode is taken into account, which is found to be at  1 = 24.5 rad/s (3.9 Hz), with modal damping  1 = 0.02.And the parameters of the GA are given in Table 2.The weighting indexes of the vibration energy during and after joint motion are set to  1 = 0.25,  2 = 0.75.A fast motion case is considered, here.The traveling time   is set to be 0.5 seconds.The initial and final angles of the joint are set to be 0 rad and /2 rad, respectively.And the number of trajectory partitions  is set to be 10.Meanwhile, to speed up the convergence of GA search, the search space of the optimized parameters Δ θ is taken to be For a real flexible manipulator system, the joint acceleration, the torque of the motor, and control voltage of the PZT actuator should have constraint values [25].The constraint conditions of the flexible manipulator system are defined as 0 < θ <   ( = 1, 2, . . .,  − 1) , θ ≤ θ max ,  ≤  max , (11) where the parameter  max is set to be 150 V and the maximum of the joint acceleration θ max is assumed to be 80 rad/s 2 .The evolution history of the GA search is shown in Figure 3.It can be seen that the fitness reduces with an increasing value of the generation number.And the optimal trajectory can be approximately obtained at the 40th generation.The results of numerical calculations and simulations are presented in Figure 4.The angular displacement, velocity, and acceleration of the obtained optimal trajectory are depicted in Figures 4(a)-4(c), respectively.The tip vibration response of the flexible link along the optimal trajectory is illustrated in Figure 4(d).For comparison, the simulation results along the quintic polynomial trajectory are also presented, correspondingly.
As seen in Figure 4(d), dynamic response of the link along the optimal trajectory shows nearly no trace of oscillations after joint motion.That is to say, there is nearly no residual vibration in the flexible link (i.e., the modal displacement after 0.5 s), while the dynamic response of the link along the quintic polynomial trajectory owns large oscillations all through the simulation interval.The presence of residual vibrations after joint motion is clearly visible, even after a period of 3-fold traveling time   .

Experimental Results
A photograph of the experimental setup is shown in Figure 5.The flexible piezoelectric manipulator is driven by an AC servo motor (Yaskawa SGMAH01A1A2S) with a reduction gear (Harmonic Drive CSF-17-50-2A) 50:1.A built-in 16-bit incremental encoder is installed within the motor to measure the rotation angle.The link is clamped at the shaft of the reduction gear through a coupling and is limited to rotate only in the horizontal plane.Meanwhile, a pair of strain gauges assembled in half-bridge configuration (resistance 120 Ω, sensitivity 2.08) are placed at the base of the link to measure the vibrations.A pair of piezoelectric patches (PZT-5A) are attached to the link for the vibration suppression, located close to the strain sensor to get the best control effect.
The control system is realized with an industrial computer.A DAQ device (Advantech PCI-1742U) is used, providing multichannel D/A, A/D, and counter modules for data acquisition and control output.For joint motion control, the AC servomotor is operated in the speed control mode.The output signal of the encoder is fed back to the industrial computer through the counter module of the DAQ.And the input torque determined from the PD controller is applied to the motor through the D/A converter and servo driver (Yaskawa SGDH01AE).Meanwhile, the vibration signal of the flexible manipulator is low-pass filtered and amplified through a strain amplifier, which can amplify the signal to a voltage range of −10 V to 10 V, and then fed into the industrial computer through an A/D converter.To suppress the link vibrations actively, the input voltage determined from the controller, amplified 15 times with a power amplifier, is supplied to the PZT actuators through a D/A converter.The schematic diagram of the experimental setup is shown in Figure 6.
The first experiment was conducted to rotate the link from 0 rad to /2 rad in 0.5 seconds along the quintic polynomial trajectory.But the active control of PZT actuators was not applied.Experimental results are presented in Figure 7.The angular displacement, velocity, and acceleration of the quintic polynomial trajectory are depicted in Figures 7(a)-7(c), respectively.The measured vibration response of the link by the strain gauges is shown in Figure 7(d).
As seen in Figures 7(a) and 7(b), the experimental results of joint angle and angular velocity are in perfect agreement with the reference curves.Thus, it can be inferred that the joint reference trajectory of the quintic polynomial was  closely followed.However, unwanted oscillations with large amplitude both during and after the joint motion were clearly observed.As shown in Figure 7(d), the peak value of the measured vibration response exceeds the range of the A/D converter, even after the joint motor has stopped for a period of 1 s.Furthermore, the settling time of the uncontrolled link vibrations, which is defined as the damping period when the peak value of the sensor voltage does not exceed 0.1 V, is found to be nearly 20 times longer than that of the motor motion (0.5 s), reaching 9.5 s.Thus, vibration suppression of the link is necessary to attain a high positioning accuracy and efficiency.The following experiment was the implementation of the optimal trajectory approach.But vibration control of the PZT actuators was still not applied.Figures 8(a)-8(d) show the angular displacement, velocity, acceleration, and measured vibration response of the link along the optimal trajectory, respectively.The link vibrations obtained from the quintic polynomial trajectory are compared with those obtained from the optimal trajectory strategy, as depicted in Figure 8(d).It can be observed from Figures 8(a) and 8(b) that experimental results of the angular displacement and velocity fairly coincide with the desired curves.Therefore, it can be confirmed that the trajectory tracking control of the flexible manipulator system is realized.Although the peak value of the link vibrations still exceeds the range of the A/D converter during the joint motion, residual vibrations corresponding to the optimal trajectory are significantly less than those caused by the quintic polynomial trajectory.The settling time of the link vibrations reduces to 4.3 s, as shown in Figure 8(d).However, residual vibrations of the link are not perfectly suppressed as the simulation results plotted in Figure 4(d).Unwanted residual vibrations occur after joint motion.This is because the joint motor is not capable of absolutely tracking the given reference trajectory as assumed and tracking error is unavoidable.In addition, modeling error also exists in simulation.
The last experiment was the combination of optimal trajectory and feedback control of the PZT actuators.Those experimental results are presented in Figure 9.As the joint trajectory, velocity, and acceleration were not significantly changed, these results were not given.The vibration response of the link is presented in Figure 9(a).It can be seen that the peak value of the link vibrations still exceeds the range of the A/D converter during joint motion, but the residual vibrations, which can be explained by the tracking error and unmodelled high frequency characteristics of the link, are significantly suppressed by the combined effect of the optimal trajectory and active control of PZT actuators.Moreover, the results obtained from the last experiment are compared with those obtained from the above two experiments.Both the peak value and settling time of the measured vibration response after joint motion are given in Table 3.As shown in Table 3, it can be observed that residual vibration of the link obtained from the proposed approach is only 0.72 V, less than 10 percent of those obtained by assuming that the trajectory corresponds to the quintic polynomial motion.Meanwhile, compared with the results along the quintic polynomial trajectory, the settling time of the residual vibrations along the optimal trajectory descends approximately 75 percent with the active control of the PZT actuators, reducing to 2.3 s from 9 s.As a conclusion, the proposed optimal trajectory planning approach is effective for vibration suppression of the flexible manipulator system.

Conclusions
The above sections have presented an optimal trajectory planning approach for vibration suppression of a flexible piezoelectric manipulator system with bonded PZT actuators.The proposed approach is a combination of the feedforward trajectory planning method and L-type velocity feedback control of piezoelectric actuators based on the Lyapunov approach.The dynamic equations of the link are derived using Hamilton's principle and assumed mode method.In the procedure of trajectory planning, the flexible piezoelectric manipulator system is taken as a whole; rigid motion of the joint, elastic vibration of the link, and active control of the PZT actuators are all considered.Specifically, the joint controller is responsible for trajectory tracking and gross vibration suppression of the link during motion, while the active controller of actuators is expected to deal with residual vibrations after joint motion.The joint angle of the link is expressed as a quintic polynomial function.And the sum of the link vibration energy is chosen as the objective function.Then, the optimal trajectory planning approach is constructed using genetic algorithm.Simulation and experimental results validate the effectiveness of the proposed method.Both the settling time and peak value of the link vibrations along the optimal trajectory descend significantly, with the active control of the PZT actuators.As a conclusion, the proposed optimal trajectory planning approach is effective for vibration suppression of the flexible piezoelectric manipulator system.where  is the radius of the rigid hub, () is the joint angle, and (, ) is the elastic deflection of the link.
The kinetic energy and the potential energy of the flexible manipulator system can be written as

Figure 1 :
Figure 1: Schematic diagram of the flexible manipulator system.

Figure 3 :
Figure 3: Evolution history of the genetic algorithm.

Figure 4 :
Figure 4: Comparison of simulation results between the optimal trajectory and quintic polynomial trajectory.

Figure 5 :
Figure 5: Photograph of the experimental setup.

Table 1 :
Parameters of the flexible manipulator system.

Table 2 :
Parameters of genetic algorithm.

Table 3 :
Comparison of the experimental results.