Efficient computation of inverse dynamics and feedback linearization for VSA-based robots

We develop a recursive numerical algorithm to compute the inverse dynamics of robot manipulators with an arbitrary number of joints, driven by variable stiffness actuation (VSA) of the antagonistic type. The algorithm is based on Newton-Euler dynamic equations, generalized up to the fourth differential order to account for the compliant transmissions, combined with the decentralized nonlinear dynamics of the variable stiffness actuators at each joint. A variant of the algorithm can be used also for implementing a feedback linearization control law for the accurate tracking of desired link and stiffness trajectories. As in its simpler versions, the algorithm does not require dynamicmodeling in symbolic form, does not use numerical approximations, grows linearly in complexity with the number of joints, and is suitable for online feedforward and real-time feedback control. A Matlab/C code is made available.