To tackle the poor localization accuracy of multimobile robots caused by non-line-of-sight (NLOS) errors in a complex indoor environment and to meet the real-time requirement, this article proposes a multimobile robot cooperative localization system using ultrawideband (UWB) sensor and GPU hardware acceleration. First, a UWB multinode ranging network is established to obtain the relative distance information between robots and anchors. Then, the line-of-sight (LOS) and NLOS errors in distance information are effectively mitigated by using the proposed UWB ranging error mitigation algorithm based on the Bayesian filter. A cooperative particle filter (PF) localization algorithm based on the Gibbs sampling is designed to estimate the position information of each robot at any time. Finally, in order to improve the real-time performance of the collaborative localization system, a parallel Gibbs collaborative localization algorithm that can be accelerated by GPU is proposed considering the characteristics of GPU hardware and CUDA programming model. The experimental results of three TurtleBot2 mobile robots in real scene show that the proposed multimobile robot cooperative localization system using UWB technology can estimate the position information of each robot robustly and accurately, and the localization accuracy is superior to that of the popular extended Kalman filter (EKF) and PF algorithms. It is shown through further evaluations that the proposed parallel algorithm achieves about 3.2 times acceleration effect in the scenarios of three mobile robots. The speed gain is found more significant with more robots, which substantially improves the real-time performance of the cooperative localization system. In the test with seven mobile robots, the speedup is as high as 11.9, that is, the execution time of the algorithm is only 8.39% of that of the original algorithm. Note to Practitioners—The purpose of this article is to improve the accuracy and real-time indoor multimobile robot cooperative localization, but the method proposed in this article is also applicable to outdoor multimobile robot cooperative localization. The existing methods for indoor cooperative localization of mobile robots usually use Bluetooth, infrared, RFID, and other technologies to establish a wireless sensor network (WSN) and then combine Karman filter or particle filter (PF) to achieve cooperative localization, which is difficult to achieve low-cost and high-precision real-time localization. In this article, a new method of cooperative localization is proposed, which uses ultrawideband (UWB) ranging network with high penetration and high precision to obtain accurate distance information, then weakens NLOS error by the Bayesian filtering to further improve the accuracy of distance information, and, finally, uses a novel cooperative localization approach to realize fast and high-precision indoor multimobile robot localization. In addition, by redesigning the collaborative localization algorithm in parallel, the real-time performance of the algorithm is improved while ensuring high accuracy. The collaborative localization experiment of three mobile robots in the real scene shows that the proposed algorithm can effectively improve the localization accuracy, and the real-time performance of collaborative localization is significantly improved. However, the algorithm still has some limitations when mitigating UWB ranging errors in highly obstructed environments, and the algorithm parallelization framework can be further improved for higher real-time performance. In the future, we will further improve the robustness of cooperative localization and apply this algorithm to cooperative control of multiple mobile robots, such as formation control and cooperative search.
Read full abstract