Rest-to-Rest Motion for Planar Multi-Link Flexible Manipulator Through Backward Recursion

In this work is considered the problem of rest-to-rest motion in a desired pre-fixed time for planar flexible manipulators. We introduce a simple idea permitting the minimization of end-effector residual vibration when reaching a desired angular equilibrium position, in a pre-fixed desired travelling time. The results hold without considering internal elastic damping effect, using a classical controller with feedforward plus joint feedback terms. The new approach concerns the computation of the feedforward control, which is based on backward integration of the elastic dynamics, starting from a rest position of the flexible arms. This backward integration yields basically elastic trajectories permitting to reach the final desired end-effector position without oscillation. The feedback controller is then used to stabilize locally the actual states along these desired trajectories. However, for fast rest to rest motion, the feedback compensator fails to drive the system states along the desired trajectories, this being due to the relatively large initial elastic error. To overcome this limitation, proper joint motion is planned between the desired initial and final positions through optimization techniques, the goal being the minimization of the initial elastic error associated to these joint trajectories. The optimal planning technique is formulated as a Pontryagin optimal control problem. This scheme is validated via numerical tests as well as experiments on a flexible two-link planar manipulator