Moveable robot movement high-precision control method

Abstract

The invention relates to a motion control method of high precision for a mobile robot. The prior control method can not control the motion precisely when wheels of the mobile robot generate instant fluctuation. The invention adopts a high speed digital processor TMS320LF2407A as a multi-axis servo motion controller. The detailed realization method is that initializing the processor; completing a control closed loop specific to the position and the speed of a single servo motor inside the processor; conducting kinematics modeling for the mobile robot and obtain the coordination relation between two wheels of the robot; using cross-coupling technology and fuzzy logic technology to obtain tuning control volume to modify speed control command and control line speed nu and angular speed omega. The invention does not need accurate control object model, compared with the previous single closed loop control, has practical characteristics and obvious progress, and based on the original system equipment, is easy to improve and realize.

Description

technical field [0001] The invention belongs to the field of automatic control, in particular to a high-precision control method for the motion of a mobile robot. Background technique [0002] In order to obtain multi-axis coordinated control, the traditional motion control method of wheeled mobile robots uses distributed control, and each control axis uses an independent high-performance servo controller, and the interaction between them is controlled by the upper-level motion planner through sensor feedback signals. to coordinate. However, good tracking control performance of a single axis cannot guarantee the accuracy of the path generated by multi-axis coordinated control. Although most controllers are designed under optimal conditions, when applied to actual systems, it is difficult to achieve the desired response due to model errors and disturbances. For a wheeled mobile robot with two-wheel differential drive, the traditional motion controller sets its reference spe...

AI Technical Summary

Problems solved by technology

However, due to external load interference and slipping, the wheel speed will fluctuate transiently. In this way, the wheel will not be able to maintain the set speed all the time, so the trajectory of the robot will be inconsistent with the tracking path planned by the upper layer.

Especially when the motor is accelerating or decelerating, the above control phenomenon will be further deteriorated due to the friction between the gears and the dynamic change of the load.

Images