The Attitude Control of The Double Inverted Pendulum with Periodic Upper Disturbance

주기적인 상부 외란이 인가되는 2축 도립 진자의 자세 제어

The attitude control of a double inverted pendulum with a periodical disturbance at link top is dealt in this paper. The proposed system is consisted of the double inverted pendulum and a disturbance link. The lower link is hinged on the plate to free for rotation in the vertical plane. The upper link is connected to the lower link through a DC motor. The DC motor is used to control the posture of the pendulum by adjusting the position of the upper link. The periodical disturbance can be generated by the additional link attached at the end of link 2 through another DC motor, which is the modeling of a posture for a biped supporting with one leg. The motor for the joint simulates the knee joint(or hip joint) and the disturbance for the legs moving in air. The algorithm for controlling a proposed inverted pendulum is consisted of a state feedback control and a fuzzy logic controller. The fuzzy controller keeps the center of gravity of the biped within the specified range through the nonlinear feedback compensator. The state feedback control takes over the role to maintain a desired posture regardless the disturbance at the link top. In these case, the change of the angle and COG of an upper link is compensated with on-line. Simulations with a mathematical model are conducted to show the validity of the proposed controller.