Controlled Lagrangians and the stabilization of mechanical systems. I. The first matching theorem

We develop a method for the stabilization of mechanical systems with symmetry based on the technique of controlled Lagrangians. The procedure involves making structured modifications to the Lagrangian for the uncontrolled system, thereby constructing the controlled Lagrangian. The Euler-Lagrange equations derived from the controlled Lagrangian describe the closed-loop system, where new terms in these equations are identified with control forces. Since the controlled system is Lagrangian by construction, energy methods can be used to find control gains that yield closed-loop stability. We use kinetic shaping to preserve symmetry and only stabilize systems module the symmetry group. The procedure is demonstrated for several underactuated balance problems, including the stabilization of an inverted planar pendulum on a cart moving on a line and an inverted spherical pendulum on a cart moving in the plane.