From Trajectory Tracking Control to Leader–Follower Formation Control

摘要

This work investigates the leader–follower formation control of multiple nonholonomic mobile robots. First, the formation control problem is converted into a trajectory tracking problem and a tracking controller based on the dynamic feedback linearization technique drives each follower robot toward its corresponding reference trajectory in order to achieve the formation. The desired orientation for each follower is selected such that the nonholonomic constraint of the robot is respected, and thus the tracking of the reference trajectory for each follower is feasible. An adaptive dynamic controller that considers the actuators dynamics in the design procedure is proposed. The dynamic model of the robots includes the actuators dynamics in order to obtain the velocities as control inputs instead of torques or voltages. Using Lyapunov control theory, the tracking errors are proven to be asymptotically stable and the formation is achieved despite the uncertainty of the dynamic model parameters. In order to assess the proposed control laws, a ROS-framework is developed to conduct real experiments using four ROS-enabled mobile robots TURTLEBOTs. Moreover, the leader fault problem, which is considered as the main drawback of the leader–follower approach, is solved under ROS. An experiment is conducted where in order to overcome this problem, the desired formation and the leader role are modified dynamically during the experiment.