Distributed Geometric Optimization and Control of Rigid Differential-Drive Formations from Relative-Position Measurements
Organizations: Department of Mechanical and Mechatronics Engineering, University of Waterloo, Waterloo, ON, Canada · Department of Electrical and Electronics Engineering, Ege University, Izmir, Trkiye
Abstract
Distance based formation control fixes the shape of a robot team but leaves its position and orientation unconstrained. We regulate all three for differential drive robots that have only one absolute position anchor, absolute headings, body frame relative position measurements, and communication with their neighbors. We derive a two layer estimation control scheme directly from optimization. The first half of the result is a set of graph-proximal estimators that reconstruct the centroid, the anchor vector, and the centered coordinates. Exact proximal updates reach consensus in finitely many steps, and a finite number of primal dual iterations leaves a bounded reconstruction error. The controller combines proximal centroid and orientation steps with distance gradient shape regulation, and a finite rotation removes the orientation drift caused by the shape step. A discrete Lyapunov analysis gives local exponential convergence once the estimators have converged. We validate the method in ROS 2 Gazebo and in experiments with five physical robots.
Figures & tables
| Metric | Gazebo | Physical |
|---|---|---|
| Max edge error [mm] | 4.5 (2.1) | 32.1 (9.7) |
| Centroid tracking [mm] | 14.6 (6.8) | 10.4 (4.8) |
| Orientation [mrad] | 14.8 (5.3) | 18.1 (5.0) |
| Centroid estimation [mm] | 9.3 (2.5) | 0.23 (0.07) |
| Anchor-vector estimation [mm] | 8.5 (2.3) | 0.67 (0.24) |
| Centered-coord. estimation [mm] | 8.7 (2.4) | 0.04 (0.01) |
Multi-Robot Formation Control
Multi-robot formation control coordinates robots to maintain, change, or navigate in groups while meeting task and safety constraints.
See all 62 papers