Discrete time stability of augmented Lagrangian formalism based underactuated inverse dynamics control method

Stability problems of robotic systems arise sometimes suddenly, seemingly for no reason. The digital time sampling is often the main cause of these instabilities. Discrete models, which are capable of the prediction of stability, are available for low-degree-of-freedom template models of linear position and force control. However, for the inverse dynamics control of underactuated systems, the literature has a lack of generally applicable results related to the effect of time discretization. Several control approaches are available in the literature out of which a widely used one, the augmented Lagrangian formalism and its stability properties are analysed in this work. Theoretical stability properties are obtained for a generally usable, linear, underactuated, two-degree-of-freedom constrained template model. The actuator dynamics, the finite difference approximation of the feedback velocity and the filtering of the feedback data are considered in the model. These phenomena strongly affects the stability properties. The theoretically obtained stability maps are experimentally validated on an underactuated crane-like indoor robot. The position and orientation accuracy of the robot were assessed: the absolute position error was below 30 mm and the orientation error was below 3 degrees.