Stability Analysis and Variational Integrator for Real-Time Formation Based on Potential Field

Figure 6

The obstacle force is used as the Lagrange force in computation of variational integrator. The variables of vehicles are solved together. Once, one of the vehicles steps in a safe bound of obstacle. The obstacle force will result in control forces on all the vehicles.