상부 시변 부하를 갖는 2축 도립진자의 위치 제어

Position Control of the Two Links Inverted Pendulum with a Time Varying Load on the Top

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 disturbing link; a triple inverted pendulum with two motors. 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 like 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 the proposed inverted pendulum which is regarded as a virtual double inverted pendulum with a periodic disturbance, is consisted of a state feedback control and a fuzzy logic controller connected in parallel. 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. Simulations with a mathematical model and experiments are conducted to show the validity of the proposed controller.