Deformation Control in Rest-to-Rest Motion of Mechanisms with Flexible Links

This paper develops and validates experimentally a feedback strategy for the reduction of the link deformations in rest-to-rest motion of mechanisms with flexible links, named Delayed Reference Control (DRC).The technique takes advantage of the inertial coupling between rigid-body motion and elastic motion to control the undesired link deformations by shifting in time the position reference through an action reference parameter. The action reference parameter is computed on the fly based on the sensed strains by solving analytically an optimization problem. An outer control loop is closed to compute the references for the position controllers of each actuator, which can be thought of as the inner control loop. The resulting multiloop architecture of the DRC is a relevant advantage over several traditional feedback controllers: DRC can be implemented by just adding an outer control loop to standard position controllers. A validation of the proposed control strategy is provided by applying the DRC to the real-time control of a four-bar linkage.


Introduction
The increasing effort towards improving dynamic performances and energy efficiency in machines and manufacturing systems is leading to the reduction of the moving masses.However, decreasing link masses also reduces their stiffness and causes elastic vibrations and deformations, which reduce system accuracy and precision [1] and cause large residual vibrations.Hence, motion planning and control of lightweight mechanisms and manipulators are two challenging issues.Traditional control schemes, such as standard PID (proportional-integral-derivative) regulators widely used in industrial controllers, have been demonstrated to be unsatisfactory to ensure effective compensation of unwanted elastic deformations.Therefore, attention should be paid to the synthesis of either optimal command generation techniques [2][3][4] or active vibration control schemes [5][6][7][8][9][10][11].
Optimal command generation techniques are feedforward approaches aimed at preplanning the control input on the basis of the system model, in such a way that the link elastic deformations are prevented.Their main advantage is the ease of implementation, since they just rely on the system model and no additional sensors are required.On the other hand, open-loop approaches usually have poor disturbance rejection and high sensitivity to model uncertainty and unknown initial conditions.Designing closedloop active control systems is therefore an effective way to cope with disturbances and model uncertainty.Several different techniques have been presented over the years.Most of these approaches take advantage of additional actuators, such as smart actuators embedded into flexible links [5,6], or impose the modification of the torque, speed, or position control loops of the servo axes driving the systems [7][8][9].However, these modifications are hard to implement in industrial controllers that are usually based on proprietary and closed architectures that cannot be modified.Among the few control techniques that do not impose modification of servo axis controllers, wave-based control [10,11] and Delayed Reference Control [12] (DRC) should be mentioned.They both rely on the feedback-based modification of the position reference.
The DRC idea has been first proposed in [12] for vibrating linear systems with a single resonant mode and then extended in [13] to multi-DOF (Degree of Freedom) linear systems.
The basic idea of DRC is to shape the desired position reference on the fly based on the measured values of the variables to be controlled, namely, the elastic deformations or oscillations.Vibration control is obtained by delaying or anticipating the original preplanned position reference if it causes elastic deformation.The preplanned desired input reference is not therefore defined explicitly as a function of time but rather as a function of a scalar time-varying "action reference parameter," which is in practice an environmentsensitive parameter computed on the basis of the measured deformations.DRC schemes can be adopted in those applications, where the major goal is performing a prescribed displacement accurately, with negligible elastic deformations, rather than a trajectory in a given time, since the motion time can be modified in a variable way.For the same reason, DRC schemes are sometimes referred to as "nontime-based" controllers, since the position reference is not explicitly defined as a function of the time.The concept of non-time-based control for dynamic systems, also referred to as "event-based" control, has been introduced in the 90s, and several successful controllers have been proposed thereafter, for instance, in neurosurgery [14], manufacturing processes [15], coordinated motion control [16], and robot control [17].
A peculiar feature of DRC schemes is that the trajectory planner assumes a primary role in the feedback closed loop, since it shapes the position references on the fly.Consequently, a multiloop control scheme is obtained, consisting of an inner position control loop and an outer loop.The former can be any standard position controller and is fed with the position reference computed by the outer loop.The latter includes the trajectory planner and is introduced to compute the action reference parameter for generating the suitable delayed position reference accomplishing the control goal.This architecture allows for the straightforward implementation of DRC schemes by simply adding an outer loop to standard position controllers, such as standard servo regulators employed in industrial automatic machines and manipulators.This is a relevant strength of the proposed method compared to most of the control techniques proposed in literature for deformation and vibration control, which impose the modification of the inner loop to perform vibration control.
In the numerical study [18], the DRC theory has been applied to the control of flexible link mechanisms in repetitive motion through numerical simulations.Starting from such a preliminary work, this paper proposes the first extension of the DRC to deformation control in rest-to-rest motion of flexible link mechanisms.The aim of the controller is to reduce the elastic deformations of the links, and therefore the method is suitable for those applications where this is a major requirement.The method is here developed with reference to an arbitrary flexible link mechanism in the presence of small deformations and then experimentally validated through a four-bar planar linkage with all the links being flexible.In particular, the crank and the follower deformations are controlled simultaneously by computing a scalar value of the action reference parameter, optimally trading between different control specifications.
Starting from a linearized model briefly described in Section 2, which provides a simplified but adequately accurate representation of the system dynamics, the method for synthesizing DRC schemes for curvature control is explained in Section 3. The experimental results validating the proposed approach, as well as the description of the test-bed and of the method implementation, are discussed in Section 4. Finally, concluding remarks are stated in Section 5.

System Modelling
Although the dynamics of flexible link mechanisms and manipulators is nonlinear and needs large dimensional models, the design of motion and vibration control schemes often relies on simplified, reduced-order, and linearized models.Indeed, it is widely recognized that, in the case of small deformations, the accuracy of linearized models about operating points is usually satisfactory enough to make their use successful in the synthesis of effective and stable control schemes.The neglected nonlinear and high-frequency dynamics can be treated, for example, as model uncertainty, which can be effectively tackled by paying attention to the controller robustness.All these considerations justify the use of a linearized model in the synthesis of the DRC scheme, which also makes the controller implementation easier by drastically reducing its computational effort and allowing for hard real-time control.
The model adopted is obtained by linearizing a nonlinear model accounting for the mutual coupling between large rigid-body motion and small elastic displacements.The model is valid for an arbitrary flexible link mechanism with holonomic and scleronomous constraints in the presence of small elastic displacements.The reader should refer to [9] and to the references therein for a more detailed description of such a model.
Independent coordinates have been adopted to represent the rigid-body motion, and the model is directly formulated through ordinary differential equations (ODE).As a matter of fact, this formulation allows for a more straightforward use of the control theory, which usually assumes this kind of model formulation.
The total motion of each flexible link is separated into the large motion of an equivalent rigid-link system (ERLS) behaving as a rigid moving reference mechanism whose number of DOFs is denoted as r and the small elastic deflections of the links with respect to the ERLS named u whose size is denoted by .Among the possible definitions of the rigid moving reference, the ERLS is defined in this work by imposing the fact that its generalized coordinates q coincide with the joint variables, which are also those measured and actuated to drive the mechanism.In this way, the actuators set the motion of the ERLS directly.The sum of u and the vector of the rigid positions of the node of the ERLS, denoted as r, describes the motion of each node of the finite element model.By linearizing the nonlinear equations of motion obtained through the application of the Principle of Virtual Work, the following linear model is obtained by linearizing the nonlinear model about an equilibrium configuration set by the equilibrium values of the rigid displacement vectors and of the external force vector v (resp, q e , v e ): ]q=q e ⋅ { u () In ( 1), the following definitions have been adopted: (i) M e and K e are the matrices obtained by assembling the mass and stiffness matrices of the finite elements.(ii) S is the ERLS sensitivity coefficient matrix for all the nodes, relating the velocities of the ERLS generalized coordinates, q , to the velocities of all the nodes of the ERLS, ṙ : ṙ = S(q) q .(iii) I and 0 are the identity and the null matrices.Admittedly, the linearized model holds only in a finite neighborhood of the working point; however, when large displacements are tackled, piecewise-linear models can be successfully employed to approximate the nonlinear system's dynamics better, as it has been proven in [9].

Synthesis of the Delayed Reference Regulator
3.1.Controller Specifications.The equations of motion in (1) are partitioned and expressed in the following more convenient form: The subsystem of (2) comprising the first  equations can be rewritten as the equations of motion of an e-DOF elastic system excited by the external nodal forces, collected in vector v, and by the inertial coupling with the rigid-body motion, M ER q (): The right-hand side term of (3) can be therefore thought of as an equivalent force vector, henceforth referred to as f(): If the most critical vibrational modes are controllable, then f() can excite and control the link elastic displacements.In order to control the deformation, it is here suggested to make f() behave as a damping force.Hence, f() is required to be a function of the first derivatives of the measured strains of the link, Ċ() (C() denotes the vector of the measured strains): In (5), g() represents both the DRC gains and the filters adopted to remove undesired signal components.Besides low-pass filters, adopted to remove noise, high-pass filters are employed to remove static components of strains.The DRC idea is to make f() assume the desired values, defined in (5), by shaping q () (i.e., the time history of the rigid-body motion) rather than k().Hence, no active deformation control is explicitly introduced in the force vector k().This is similar to the approach followed by optimal planning techniques, where rigid-body motion is properly shaped to reduce oscillations.Compared with such methods, however, DRC is a feedback scheme and the optimal motion law is computed on the fly based on sensor measurements.The control problem is therefore stated as shaping the time history of the rigid-body motion q() in order to exert the desired active damping force defined through (5): Besides exerting an equivalent damping force, it is also required that the controller ensure correct tracking of the desired displacement (which sets the path in the case of systems with more rigid DOFs), defined regardless of the time of execution, rather than a trajectory in time as it happens in classical control schemes.To satisfy this second specification, the position reference of the rigid-body control loop q ref is not made an explicit function of just the time but of a real scalar time-varying parameter () named "action reference parameter" [12].The position reference will be henceforth referred to as q ref ().The action reference parameter is computed on the basis of the measured strains to exert the desired damping force f().The following definition of  is chosen: The real and scalar () is named "time delay," although it can assume also negative values (in other words, it can anticipate the execution of trajectory whenever necessary).The l-domain value of the position reference q ref () should be known explicitly, since it describes the ideal desired path to be tracked in the case of rigid bodies.In contrast, the time history of the position reference, referred to as q * ref (), is not known a priori, since it depends on the time history of l, which in turn is computed on the fly through the measured strains.
The control problem is therefore stated as finding () such that the desired equivalent damping force in ( 5) is exerted and the actuator motion (which can be seen as the rigid-body motion) does not drift away from the desired displacement:

Problem Solution.
The control problem in (8) has no exact solution in the general case.However, some reasonable problem simplifications lead to an analytical solution.First of all, by assuming that the mechanism position controller ensures precise dynamic responses, in (6), the actual ERLS acceleration q () can be approximated by its reference value in time q * ref ().This assumption is common in most of the literature on optimal motion planning and therefore should not be considered restrictive.Secondly, the position reference may be linearized over a finite interval: where the rigid-body reference velocity vector  is assumed to be finite and constant over such an interval.Because of this assumption on , step inputs as position references cannot be employed if a DRC is used.Again, this assumption is not a severe drawback of the DRC, since step position references are not of interest in practice: indeed, only continuous position references, such as polynomials, are adopted in industrial applications.Hence, by replacing (9) and its first and second derivatives in (8), it holds that The boundary conditions in (10) are set to ensure that if Ċ() ≡ 0, then f() ≡ 0 and () ≡ 0 (i.e., τ () = 0, τ () = 0 ∀); this implies that if no undesired oscillations arise, no control force is exerted and therefore no delay is applied.Hence, if Ċ() ≡ 0, then k() − M ER q ref () = 0.These boundary conditions lead to an overdetermined system made by  independent differential equations in the scalar unknown τ (): Equation ( 11) can be written in the frequency domain through the Laplace transforms of (), g(), and C() (denoted as (), G(), and C(), resp.): A unique, scalar time delay satisfying simultaneously all these equations does not exist in general.The controller synthesis is therefore formulated as a least-square problem by looking for the scalar  minimizing the norm of the residual in (12): Such a problem can be modified by weighing each equation of the system in ( 13) through a scalar-product matrix Ω to reflect different levels of concern about each control requirement.Additionally, an extra term ‖ 2 ()‖ 2 2 is included in the minimization problem to avoid large and fast varying delays by penalizing its magnitude in the cost function: The scalar  ≥ 0 trades off between the cost of missing the control specification and the cost of using large control effort.Since Ω is defined as a positive-definite matrix, {M ER }  Ω{M ER } ≥ 0 ∀.Hence, the scalar ({M ER }  Ω{M ER } + ) −1 exists for any M ER and  and for any  > 0. The solution is therefore The extra term included in ( 14) is often denoted as "regularization term" [19].The regularization problem significantly improves the numerical conditioning of the problem solution and increases its robustness with respect to the model variability and uncertainty [19].Finally, the poles and zeros in G() due to the highpass filters adopted to get rid of the steady-state values of the strains are separated and made explicit through G 0 () to obtain a more convenient form.In order to keep the controller implementation as simple as possible, it is here suggested to employ a first-order high-pass filter, that is, G() fl (/( +  cut ))G 0 (), whose pole lies in  = − cut .The final formulation of the optimal time delay is therefore 3.3.The DRC Multiloop Architecture.The DRC architecture is schematically described by the block diagram in Figure 1.
The DRC scheme is based on a multiloop architecture made by an inner position loop (gray lines in Figure 1) and an outer loop (black lines) which run simultaneously.The "inner loop position controller" that can have any arbitrary architecture (such as those usually adopted in industrial controllers, as shown in Section 4.1) regulates the actuator to make q() track q * ref () as computed at each time step by the "position planner."The latter belongs to the outer loop, which implements the DRC equations.Hence, the outer loop is aimed at performing active control of the link deformation by computing suitable values of  (which is calculated in the so-called action reference block) and therefore q * ref ().q Ｌ？＠ (l) q * Ｌ？＠ (t) (t) The real-time computation of  at each time step is undemanding, since it just involves a first-order, singleinput-single-output linear filtering and some simple algebraic operations.In addition, the model linearization allows for the offline computation of matrices M and S. All these operations can be efficiently performed by real-time controllers without incurring considerable computational costs.

Experimental Application
4.1.Implementation.A four-bar planar linkage with flexible steel bars has been developed (see Figure 2 and Table 1).The model adopted has 15  The motion control of the crank is performed by a standard position-velocity-current multiloop controller, as it is represented in Figure 3.The current (torque) and the speed control loops are performed by standard PI (proportionalintegral) regulators implemented in the Indramat controller (in Figure 3,  V and  V denote the proportional gain and the integral action time of the speed controller, resp.).Velocity feedforward is also adopted to reduce the transient error by means of a filtered derivative of the position reference.A standard proportional controller, whose gain is   , is also implemented in the position control loop to compute the speed reference for the motor drive on the basis of the crank angle tracking error.The speed and current loops are implemented in the proprietary Indramat controller, while the position control loop and the DRC outer loop  are implemented in a Matlab-Simulink5 code and run in an external target PC with xPC Target hard real-time operative system.The outer loop sample rate is 1 kHz and a fourthorder explicit Runge-Kutta integrator is employed to solve (16).The ability of DRC schemes to deal with any arbitrary inner control loop is a strength of the DRC formulation and allows for DRC in industrial devices.
The DRC specification is to reduce the deformation of both the crank and the follower.Resistive strain gauges are therefore adopted (link 1, C 1 , and link 3, C 3 ) to measure strains in the plane of motion.
An effective and simple choice for f() consists in an equivalent control torque computed through two constant gains ] (/( +  cut )).Such gains have been tuned to equally weigh the requirements on the two links.In order to clarify the DRC impact on the system dynamics, three different sets of DRC gains are tested (denoted as (a), (b), and (c)).The same inner loop is instead employed in all the tests.The results are also compared with the ones obtained through the sole inner loop.All the controllers share the same values of  cut = 0.15 rad/s, Ω = I (to equally weigh the requirements on the two links), and  = 1 − 4, while they have different gains  V 1 =  V 3 (resp., 160 for the controller "a," 125 for the controller "b," and 100 for the controller "c").Higher gains result in more effective suppression of the link oscillations at the cost of larger delays.
The linearized model matrices in ( 16) have been computed by setting   = 0.35 rad and are assumed to be constant over the entire range of motion to reduce the computational effort and memory allocation in the external target PC.These matrices provide accurate representation of the system dynamics in the range of interest for the test case proposed [18].No switching between linear models has been adopted, but it could be done effectively in case it is necessary at the cost of an increase of the memory allocation and computational effort [20].
Finally, Table 2 lists the eighteen eigenvalues of the dynamics matrix of the augmented state closed-loop system, computed at the equilibrium through the method proposed in [18] and in the presence of the DRC controller "b."Similar results are obtained for the two other DRC controllers.The numerical pole analysis clearly proves that stability is assured with the proposed DRC, as confirmed by the experimental results shown in Section 4.2.

Experimental Results.
The motion reference is a motion law with piecewise constant acceleration (trapezoidal speed profile), aimed at moving the crank from the horizontal configuration  ref 1 = 0 to the final one  ref 1 = 0.7 rad (an ideal motion time of 0.6 s has been assumed for the displacement with no delay in the case of rigid behaviour).Such a motion law is widely employed in industries for motion planning of rigid systems and is the most severe among the profiles used in practice.Therefore, it is not suitable for flexible mechanisms, since acceleration discontinuities (i.e., infinite jerk) cause relevant link deformations.Nonetheless, effective smoothing of such a trajectory in time is expected when DRC schemes are adopted.Indeed, the aim of the DRC is to shape the time history of the motion reference through  to minimize the unwanted elastic deformation on the basis of the sensed strains.Figure 4 shows the time history of the reference (black lines) and actual (grey lines) values of the crank angle obtained through the four controllers.These results highlight how the DRC outer loop shapes the crank reference by smoothing it through  to minimize the elastic deformations.The higher the gains  V 1 and  V 3 (i.e., the more it is required to damp the link deformations), the larger the delay in the execution of the total displacement, as it is evident in the result provided by controller "a," which is the one with the highest gains.Smaller delays are obtained if smaller gains are employed.In particular, controller "c" ensures the smallest rise time among the three DRC controllers evaluated.Figure 4 also reveals that all the controllers are asymptotically stable and hence confirms the theoretical expectations stated in Section 4.1 and in Table 2, based on the analysis of the closedloop system eigenvalues.
Figure 5 shows the time histories of  and .The peak values of the delay are 0.19 s, 0.42 s, and 1.1 s for, respectively, controllers "a," "b," and "c."However, the modifications caused by  have positive effects on the motion of the crank,  as revealed by the analysis of the rise time (i.e., the time required for moving from 10 to 90 percent of the final value of the crank displacement).Indeed, rise times of controllers "a" and "b" are 0.452 s and 0.565 s, respectively, while the rise time if no DRC is employed is 0.298 s.That means that the actual delays of the crank are smaller than those represented through , and they are just 0.154 s and 0.268 s, respectively.As a matter of fact, the elastic motion perturbs the "rigidbody motion" of the crank because of the dynamic mutual coupling already discussed in the model synthesis (see ( 1) and ( 2)).The deformation control exerted by the DRC controllers reduces these disturbances, thus allowing for better tracking of the references for the crank "rigid-body motion."16) ensures that  does not increase before the motion starts or after reaching the final target position.Conversely,  increases after the motion begins (t = 0.5 s) with a variable rate, making  rise at a rate that is lower than the one of time.
The measured strains are finally shown in Figure 6 (crank) and in Figure 7 (follower).It is noticeable that a very effective reduction in the link deformation is obtained through the DRC scheme: both the maximum value of the strains and their slopes are significantly reduced.In particular, the controller referred to as "b" provides an excellent trade-off in reducing deformation while keeping the actual maximum delay acceptable.Only a minor overshoot on the strains of the follower (which is the link not directly actuated) and a small amplitude oscillation caused by the motor ripple torque (which cannot be controlled) remain uncompensated.
As for the steady values of the link strains, they are due to the static deformations induced by gravity and therefore they just depend on the mechanism configuration (and on the presence of small disturbances that justify the negligible differences).Therefore, they cannot be eliminated through the DRC, as well as through any other controller.The presence of the aforementioned high-pass filter prevents from uncontrolled growth of the time delay due to such steadystate values.

Conclusions
A control strategy for reducing elastic deformation in rest-torest motion has been proposed and experimentally validated in this paper.The technique, named Delayed Reference Control (DRC), takes advantage of the dynamic coupling between rigid-body motion and elastic motion to reduce the link deformation by suitably shaping the time history of the position reference on the basis of the sensed link strains.Being based on the measured strains, the proposed feedback scheme allows overcoming one of the main limitations of the open-loop optimal planning techniques, whose performances are affected by the presence of model uncertainty, unknown external forces, or unknown initial conditions.
Basically, the proposed DRC scheme reduces the elastic deformations by delaying or speeding up the planned reference input through an action reference parameter, which is computed in a feedback loop devoted to deformation control and closed outside a standard position control loop.The outer loop also includes the trajectory planner, which calculates the time history of the actuator position reference to be tracked by the inner position loop.Overall, this strategy allows ensuring the correct tracking of the desired spatial path while reducing the unwanted elastic deformations that usually downgrade precision and accuracy of machines.Additionally, the multiloop architecture makes the DRC implementation straightforward and suitable to be applied to manufacturing systems with proprietary controllers.Indeed, the proposed scheme can be achieved by simply adding a new loop outside proprietary position controllers.
The experimental results obtained by applying the DRC to a four-bar linkage with flexible links demonstrate the effectiveness of the approach and its stability over a wide range of gains.In particular, a significant reduction in the link unwanted elastic deformation has been achieved with a small time delay.Additionally, the results prove the correctness of some minor simplifications assumed in the formulation of the optimization problem leading to the analytical and straightforward computation of the suitable time delays.Finally, the low computational effort of the analytical solution proposed makes the DRC suitable for hard real-time implementation.
elastic DOFs ( = 15), and consequently  +  = 16.The mechanism is actuated by an Indramat brushless servomotor directly driving the rotation of the crank  1 (which coincides with the ERLS generalized coordinate ) to track the delayed reference  ref 1 () =  ref 1 ( − ), computed by the outer loop.The crank rotation is measured through an optical encoder with 20000 radial lines.

Figure 2 :
Figure 2: Picture of the mechanism.

Figure 4 :Figure 5 :
Figure 4: Reference and actual values of the crank angle versus time.

Figure 6 :
Figure 6: Comparison of the crank strains.

Figure 7 :
Figure 7: Comparison of the follower strains.

Figure 5
Figure 5  also shows that the presence of the high-pass filter in(16) ensures that  does not increase before the motion starts or after reaching the final target position.Conversely,  increases after the motion begins (t = 0.5 s) with a variable rate, making  rise at a rate that is lower than the one of time.The measured strains are finally shown in Figure6(crank) and in Figure7(follower).It is noticeable that a very effective reduction in the link deformation is obtained through the DRC scheme: both the maximum value of the strains and their slopes are significantly reduced.In particular, the controller referred to as "b" provides an excellent trade-off in reducing deformation while keeping the actual maximum delay acceptable.Only a minor overshoot on the strains of the follower (which is the link not directly actuated) and a

Table 1 :
Inertial and geometrical parameters of the four-bar linkage.