Modeling and Optimal Controller Based on Disturbance Detector for the Stabilization of a Three-link Inverted Pendulum Mobile Robot

摘要

This work presents the realization of a complicated stabilization problem for a three inverted pendulum links-based mobile robot. The actuators of the mobile robot are direct current motors that have tachometer couplings to measure both the position and speed of the wheels and links. Using direct measurements under load and analyzing the deceleration curve, the motor parameters are determined experimentally. A mathematical model of the robot is obtained via the Euler–Lagrange equations. Next, the nonlinear model is linearized and discretized. Based on this discrete LTI model, an optimal controller is designed. The states and disturbances are estimated using a robust detector. Both the controller and detector are implemented in the robot processor. Numerical simulations and experimental tests show a good performance of the controller despite the presence of disturbances.