The control and design of Dual - wheel upright self-balance Robot

Abstract

The structure and mathematical modeling of a Dual - wheel upright self-balance Robot are studied. The simulation and the real experiment of robot are done. The system is made up of a mobile mechanism, sensor for posture observation and the controller. The right and left wheels are driven separately by two high percision Direct Current (DC) servo motors with photoelectric encoder. Direct current servo control system of Pulse Width Modulation (PWM) based on application of pulse width modulation DC-DC converters. Gyro scope and angle sensors are used for posture observation. On the basis of building up the system structure model, the system mathematical model is built up using dynamics mechanics theory and method. The state2feed back controller (LQR) with good robust is designed on Matlab. The stability of system is proved by simulation results. The real robot as human being can realize all kinds of walking control. Validity and rationality of the system modeling and the designed controller are verified through the performance experiments of the prototype.