Trajectory Tracking Control of the Wheeled Inverse Pendulum Type Self - Contained Mobile Robot in Two Dimensional Plane

역진자형 자주로보트의 2차원 평면에서 궤도주행제어에 관한 연구

In this paper, we discuss on the control algorithm to make the wheeled inverse pendulum type mobile robot move in two dimensional plane. The robot considered in this paper has two independently driven wheels in same axel which suport and move it-self, and is assumed to have the fyro type sensor to know the inclination algle of the body and rotary encoders to know wheel's rotation angular velocity. The control algorithm is divided into three parts. The first part is for the posture and velocity control for forward-backward direction, the second is the steering control, and the last part is for the control of total system to track the given trajectory. We handle the running velocity control of the robot as part of the posture control to keep the balance because the posture relates deeply with the velocity and can be controlled by the velocities of the wheels. The control problem is analyzed as the tracking control, and the controller is realized with the state feedback and feed-forward of the reference velocity. Constructing the control system which contained one intergrator in forward path, we also realized the control system without observer for the estimation of the accumulated errors in the inclination angle of the body. To prevent the robot from being unstable state by sudden variation of the reference velocity when it starts and stops, or changes velocity, the reference velocity of which acceleration is slowly changing, is ordered to the robot. To control its steering, we give the different reference velocities for both wheels which are calculated from the desired angular velocity of the body. Finally, we presents the experimental results of the experimental robot Yamabico Kurara in which the proposed control algorithm had been implemented.