Abstract:To solve the problem of unmanned ground vehicle leader-follower formation transportation in unstructured environment, we propose a novel target detection and tracking method based on multi-sensor fusion perception. Combined with 3D-Lidar, millimeter wave Radar and GPS/IMU, the proposed method can achieve stable target detection and continuous tracking of both static and dynamic vehicles. First, 3D-Lidar is used to detect the geometric model of the leader vehicle to complete the initialization of tracking target and it can also be assisted for target tracking. Then during the movement, the dynamic leader is mainly tracked through millimeter wave Radar as this sensor can keep tracking the same target with a constant index and effectively distinguish dynamic vehicle from other static obstacles according to relative speed estimation. In addition, by using GPS/IMU based integrated navigation, the movement trend of the leader can be derived according to the echo vehicle pose information and the relative position relationship. This is helpful to reduce the region of interest for target tracking and improve the real-time performance. In different unstructured environments, we perform the leader-follower formation transportation experiments for hundreds of kilometers. In rough terrain, the maximum tracking speed can still reach 40km/h and the maximum tracking distance can be up to 100 meters. Experiments show that the proposed method is suitable for vehicle target detection and tracking in unstructured environment. It has good robustness and high real-time performance with an average processing frame rate of 20Hz. The proposed method can be used for the formation transportation of unmanned ground vehicles to reduce labor costs.

A communication-free leader-follower formation method for UGVs via sensors fusion

Leader-Follower Safe Formation Guidance for Multiple Unmanned Surface Vehicles Based on Local Sensing Information

Real-time 3D-Lidar, MMW Radar and GPS/IMU Fusion Based Vehicle Detection and Tracking in Unstructured Environment

A Leader-path-following Formation System for AGVs with Multi-Sensor Data Fusion Based Vehicle Tracking

UGV autonomous driving system design for unstructed environment

Vision-Based Formation Control Of A Heterogeneous Unmanned System

MSFVT: A Multi-Sensor Fusion System for Vehicle Position Tracking in Unstructured Environments

Image-Based Formation Control of Unmanned Surface Vehicles with Field-of-View Constraints

Formation control of unmanned surface vehicles with vision sensor constraints

Leader-Follower Formation Control of Autonomous Underwater Vehicles

Adaptive leader-follower formation control for autonomous mobile robots

Three-dimensional Leader-Follower Formation Control of Multiple Autonomous Underwater Vehicles Based on Line-of-sight Measurements Using the Backstepping Method

Virtual-leader Based Spatial Formation Method for UUV

Virtual Leader Based Robust Adaptive Formation Control of Multi-Unmanned Ground Vehicles (Ugvs)

Formation Control of Unmanned Underwater Vehicles Using Local Sensing Means in Absence of Follower Position Information

Leader-Follower Formation Tracking Control and Stabilization of Underactuated Unmanned Surface Vessels via Event-Triggered Mechanism

Virtual Leader Based Formation Control of Multiple Unmanned Ground Vehicles (UGVs): Control Design, Simulation and Real-Time Experiment

Leader-follower Formation Control of Underactuated AUVs with Leader Position Measurement

A unified leader-follower scheme for mobile robots with uncalibrated on-board camera

Leader–follower Formation Control of Underactuated Autonomous Underwater Vehicles

Multi-UAVs Formation Flight Control Based on Leader-Follower Pattern