This paper proposes the distance-and velocity-based simultaneous obstacle avoidance and target tracking (DV-SOATT) method for the trajectory tracking problem of multiple wheeled mobile robots (MWMRs) operating in a shared workspace based on the relative positions and velocities of the wheeled mobile robots (WMRs) and their encountered obstacles. Compared to the previous arts considered only their relative positions, the DV-SOATT method that adds an auxiliary velocity vector lessens needless activation of the collision avoidance maneuvers, where the DV-SOATT introduces radial bounds for forecasting a collision. We provide two decision criteria for the addition of the auxiliary velocity term and compare the DV-SOATT method with the original method proposed by Li et al. (2021). The problem of the WMRs pause from the path conflict is addressed. Bound constraints on MWMRs’ velocities are considered to restrict the movement speed of the robot so as to ensure smoothness. The control law is built on Lagrange multipliers on basis of constructing a quadratic programming problem. Slack variables are discarded. Bound constraints on optimization variables are included in the piecewise-linear projection function. The stability of the control law, together with the efficiency of the DV-SOATT method, is discussed based on the Lyapunov function. The efficiency is tested on multiple omnidirectional Mecanum-wheeled mobile robots and validated through physical experiments and simulation.
Summary: Estimating the robot state within a known map is an essential problem for mobile robot; it is also referred to “localization”. Even LiDAR-based localization is practical in many applications, it is difficult to achieve global localization with LiDAR only for its low-dimension feedback, especially in environments with repetitive geometric features. A sensor-fusion-based localization system is introduced in this paper, which has the capability of addressing the global localization problem. Both LiDAR and vision sensors are integrated, making use of the rich information introduced by vision sensor and the robustness from LiDAR. A hybrid grid-map is built for global localization, and a visual global descriptor is applied to speed up the localization convergence, combined with a pose refining pipeline for improving the localization accuracy. Also, a trigger mechanism is introduced to solve kidnapped problem and verify the relocalization result. The experiments under different conditions are designed to evaluate the performance of the proposed approach, as well as a comparison with the existing localization systems. According to the experimental results, our system is able to solve the global localization problem, and the sensor-fusion mechanism in our system has an improved performance.