Periodic motion planning and control for double rotary pendulum via virtual holonomic constraints

摘要

Periodic motion planning for an under-actuated system is rather difficult due to differential dynamic constraints imposed by passive dynamics, and it becomes more difficult for a system with higher underactuation degree, that is with a higher difference between the number of degrees of freedom and the number of independent control inputs. However, from another point of view, these constraints also mean some relation between state variables and could be used in the motion planning. We consider a double rotary pendulum, which has an underactuation degree 2. A novel periodic motion planning is presented based on an optimization search. A necessary condition for existence of the whole periodic trajectory is given because of the higher underactuation degree of the system. Moreover this condition is given to make virtual holonomic constraint VHC based control design feasible. Therefore, an initial guess for the optimization of planning a feasible periodic motion is based on this necessary condition. Then, VHCs are used for the system transformation and transverse linearization is used to design a static state feedback controller with periodic matrix function gain. The controller gain is found through another optimization procedure. The effectiveness of initial guess and performance of the closed-loop system are illustrated through numerical simulations.