An Approach to Robust INS/UWB Integrated Positioning for Autonomous Indoor Mobile Robots

Consensus-Based Information Filtering in Distributed LiDAR Sensor Network for Tracking Mobile Robots

A distributed state observer is designed for state estimation and tracking of mobile robots amidst dynamic environments and occlusions within distributed LiDAR sensor networks. The proposed novel framework enhances three-dimensional bounding box detection and tracking utilizing a consensus-based information filter and a region of interest for state estimation of mobile robots. The framework enables the identification of the input to the dynamic process using remote sensing, enhancing the state prediction accuracy for low-visibility and occlusion scenarios in dynamic scenes. Experimental evaluations in indoor settings confirm the effectiveness of the framework in terms of accuracy and computational efficiency. These results highlight the benefit of integrating stationary LiDAR sensors' state estimates into a switching consensus information filter to enhance the reliability of tracking and to reduce estimation error in the sense of mean square and covariance.

Ad Hoc Mesh Network Localization Using Ultra-Wideband for Mobile Robotics

This article explores the implementation of high-accuracy GPS-denied ad hoc localization. Little research exists on ad hoc ultra-wideband-enabled localization systems with mobile and stationary nodes. This work aims to demonstrate the localization of bicycle-modeled robots in a non-static environment through a mesh network of mobile, stationary robots, and ultra-wideband sensors. The non-static environment adds a layer of complexity when actors can enter and exit the node's field of view. The method starts with an initial localization step where each unmanned ground vehicle (UGV) uses the surrounding, available anchors to derive an initial local or, if possible, global position estimate. The initial localization uses a simplified implementation of the iterative multi-iteration ad hoc localization system (AHLos). This estimate was refined using an unscented Kalman filter (UKF) following a constant turn rate and velocity magnitude model (CTRV). The UKF then fuses the robot's odometry and the range measurements from the Decawave ultra-wideband receivers stationed on the network nodes. Through this position estimation stage, the robot broadcasts its estimated position to its neighbors to help the others further improve their localization estimates and localize themselves. This wave-like cycle of nodes helping to localize each other allows the network to act as a mobile ad hoc localization network.

A Fusion Strategy for Vehicle Positioning at Intersections Utilizing UWB and Onboard Sensors

For vehicle positioning applications in Intelligent Transportation Systems (ITS), lane-level or even more precise localization is desired in some typical urban scenarios. With the rapid development of wireless positioning technologies, ultrawide bandwidth (UWB) has stood out and become a prominent approach for high-precision positioning. However, in traffic scenarios, the UWB-based positioning method may deteriorate because of not-line-of-sight (NLOS) propagation, multipath effect and other external interference. To overcome these problems, in this paper, a fusion strategy utilizing UWB and onboard sensors is developed to achieve reliable and precise vehicle positioning. It is a two-step approach, which includes the preprocessing of UWB raw measurements and the global estimation of vehicle position. Firstly, an ARIMA-GARCH model to address the NLOS problem of UWB at vehicular traffic scenarios is developed, and then the NLOS of UWB can be detected and corrected efficiently. Further, an adaptive IMM algorithm is developed to realize global fusion. Compared with traditional IMM, the proposed AIMM is capable of adjusting the model probabilities to make them better matching for current driving conditions, then positioning accuracy can be improved. Finally, the method is validated through experiments. Field test results verify the effectiveness and feasibility of the proposed strategy.

Examination of the Accuracy of Movement Tracking Systems for Monitoring Exercise for Musculoskeletal Rehabilitation

When patients perform musculoskeletal rehabilitation exercises, it is of great importance to observe the correctness of their performance. The aim of this study is to increase the accuracy of recognizing human movements during exercise. The process of monitoring and evaluating musculoskeletal rehabilitation exercises was modeled using various tracking systems, and the necessary algorithms for processing information for each of the tracking systems were formalized. An approach to classifying exercises using machine learning methods is presented. Experimental studies were conducted to identify the most accurate tracking systems (virtual reality trackers, motion capture, and computer vision). A comparison of machine learning models is carried out to solve the problem of classifying musculoskeletal rehabilitation exercises, and 96% accuracy is obtained when using multilayer dense neural networks. With the use of computer vision technologies and the processing of a full set of body points, the accuracy of classification achieved is 100%. The hypotheses on the ranking of tracking systems based on the accuracy of positioning of human target points, the presence of restrictions on application in the field of musculoskeletal rehabilitation, and the potential to classify exercises are fully confirmed.

A Survey of Robot Swarms' Relative Localization Method

For robot swarm applications, accurate positioning is one of the most important requirements for avoiding collisions and keeping formations and cooperation between individuals. However, in some worst cases, the GNSS (Global Navigation Satellite System) signals are weak due to the crowd being in a swarm or blocked by a forest, mountains, and high buildings in the environment. Thus, relative localization is an indispensable way to provide position information for the swarm. In this paper, we review the status and development of relative localization. It is first assessed that relative localization to obtain spatio-temporal relationships between individuals is necessary to achieve the stable operation of the group. After analyzing typical relative localization systems and algorithms from the perspective of functionality and practicality, this paper concludes that the UWB-based (ultra wideband) system is suitable for the relative localization of robots in large-scale applications. Finally, after analyzing the current challenges in the field of fully distributed localization for robotic swarms, a complete mechanism encompassing the relative localization process and the relationship between local and global localization that can be a possible direction for future research is proposed.

Analysis and Improvement of Indoor Positioning Accuracy for UWB Sensors

Ultra-wideband (UWB) sensors have been widely applied to indoor positioning. The indoor positioning of UWB sensors usually refers to the positioning of the mobile node that interacts with the anchors through radio for calculating the distance between the mobile node and each of the surrounding anchors. The positioning accuracy of the mobile node is affected by the installation positions of surrounding anchors. A mathematical model was proposed in this paper to respectively analyze the mobile node’s 2-dimensional (2D) and 3-dimensional (3D) positioning errors. The factors influencing the mobile node’s positioning errors were explored through the mathematical models. The best installation positions of surrounding anchors were obtained based on the mathematical models. The mobile node’s 2D and 3D positioning errors were reduced based on the anchor positions derived from the mathematical model. Both computer simulations and practical experiments were implemented to justify the results obtained in the mathematical models.

Ultra-Wideband Positioning Sensor with Application to an Autonomous Ultraviolet-C Disinfection Vehicle

Due to the COVID-19 virus being highly transmittable, frequently cleaning and disinfecting facilities is common guidance in public places. However, the more often the environment is cleaned, the higher the risk of cleaning staff getting infected. Therefore, strong demand for sanitizing areas in automatic modes is undoubtedly expected. In this paper, an autonomous disinfection vehicle with an Ultraviolet-C (UVC) lamp is designed and implemented using an ultra-wideband (UWB) positioning sensor. The UVC dose for 90% inactivation of the reproductive ability of COVID-19 is 41.7 J/m², which a 40 W UVC lamp can achieve within a 1.6 m distance for an exposure time of 30 s. With this UVC lamp, the disinfection vehicle can effectively sterilize in various scenarios. In addition, the high-accuracy UWB positioning system, with the time difference of arrival (TDOA) algorithm, is also studied for autonomous vehicle navigation in indoor environments. The number of UWB tags that use a synchronization protocol between UWB anchors can be unlimited. Moreover, this proposed Gradient Descent (GD), which uses Taylor method, is a high-efficient algorithm for finding the optimal position for real-time computation due to its low error and short calculating time. The generalized traversal path planning procedure, with the edge searching method, is presented to improve the efficiency of autonomous navigation. The average error of the practical navigation demonstrated in the meeting room is 0.10 m. The scalability of the designed system to different application scenarios is also discussed and experimentally demonstrated. Hence, the usefulness of the proposed UWB sensor applied to UVC disinfection vehicles to prevent COVID-19 infection is verified by employing it to sterilize indoor environments without human operation.

The robust residual-based adaptive estimation Kalman filter method for strap-down inertial and geomagnetic tightly integrated navigation system

When noise statistical characteristics of the system are unknown and there are outliers in the measurement information, the filtering accuracy of the strap-down inertial navigation system/geomagnetic navigation system (SINS/GNS) tightly integrated navigation system would decrease, and the filtering may diverge in severe cases. To solve this problem, a robust residual-based adaptive estimation Kalman filter (RRAEKF) method is proposed. In the RRAEKF method, the covariance matching technique is employed to detect whether the system is abnormal or not. When the system is judged to be abnormal, a weighted factor is constructed to identify and weight the wild value in the measurement information, eliminating the influence of the outliers on the filtering accuracy. To further improve the filtering accuracy of the integrated navigation system, a contraction factor is introduced to adaptively adjust the gain matrix of the filter algorithm, obtaining the optimal estimate of the state vector and covariance matrix. Simulation results demonstrate that compared with the standard extended Kalman filter method and residual-based adaptive estimation method, the space position errors of the SINS/GNS tightly integrated navigation system based on the proposed method are improved by 63.37% and 56.93%, respectively, in the case of time-varying noise and the presence of outliers.

Precise Positioning of Autonomous Vehicles Combining UWB Ranging Estimations with On-Board Sensors

In this paper, we analyze the performance of a positioning system based on the fusion of Ultra-Wideband (UWB) ranging estimates together with odometry and inertial data from the vehicle. For carrying out this data fusion, an Extended Kalman Filter (EKF) has been used. Furthermore, a post-processing algorithm has been designed to remove the Non Line-Of-Sight (NLOS) UWB ranging estimates to further improve the accuracy of the proposed solution. This solution has been tested using both a simulated environment and a real environment. This research work is in the scope of the PRoPART European Project. The different real tests have been performed on the AstaZero proving ground using a Radio Control car (RC car) developed by RISE (Research Institutes of Sweden) as testing platform. Thus, a real time positioning solution has been achieved complying with the accuracy requirements for the PRoPART use case.

In-Field Calibration of Triaxial Accelerometer Basedon Beetle Swarm Antenna Search Algorithm

Traditional calibration method is usually performed with expensive equipments such as three-axis turntable in a laboratory environment. However in practice, in order to ensure the accuracy and stability of the inertial navigation system (INS), it is usually necessary to recalibrate the inertial measurement unit (IMU) without external equipment in the field. In this paper, a new in-field recalibration method for triaxial accelerometer based on beetle swarm antenna search (BSAS) algorithm is proposed. Firstly, as a new intelligent optimization algorithm, BSAS algorithm and its improvements based on basic beetle antennae search (BAS) algorithm are introduced in detail. Secondly, the nonlinear mathematical model of triaxial accelerometer is established for higher calibration accuracy, and then 24 optimal measurement positions are designed by theoretical analysis. In addition, the calibration procedures are improved according to the characteristics of BSAS algorithm, then 15 calibration parameters in the nonlinear method are optimized by BSAS algorithm. Besides, the results of BSAS algorithm and basic BAS algorithm are compared by simulation, which shows the priority of BSAS algorithm in calibration field. Finally, two experiments demonstrate that the proposed method can achieve high precision in-field calibration without any external equipment, and meet the accuracy requirements of the INS.

A Novel Cooperative Localization Method Based on IMU and UWB

In this paper, a range-based cooperative localization method is proposed for multiple platforms of various structures. The localization system of an independent platform might degrade or fail due to various reasons such as GPS signal-loss, inertial measurement unit (IMU) accumulative errors, or emergency reboot. It is a promising approach to solve this problem by using information from neighboring platforms, thus forming a cooperative localization network that can improve the navigational robustness of each platform. Typical ranging-based ultra-wideband (UWB) cooperative localization systems require at least three auxiliary nodes to estimate the pose of the target node, which is often hard to meet especially in outdoor environment. In this work, we propose a novel IMU/UWB-based cooperative localization solution, which requires a minimum number of auxiliary nodes that is down to 1. An Adaptive Ant Colony Optimization Particle Filter (AACOPF) algorithm is customized to integrate the dead reckoning (DR) system and auxiliary nodes information with no prior information required, resulting in accurate pose estimation, while to our knowledge the azimuth have not been estimated in cooperative localization for the insufficient observation of the system. We have given the condition when azimuth and localization are solvable by analysis and by experiment. The feasibility of the proposed approach is evaluated through two filed experiments: car-to-trolley and car-to-pedestrian cooperative localization. The comparison results also demonstrate that ACOPF-based integration is better than other filter-based methods such as Extended Kalman Filter (EKF) and traditional Particle Filter (PF).

A Meta-Review of Indoor Positioning Systems

An accurate and reliable Indoor Positioning System (IPS) applicable to most indoor scenarios has been sought for many years. The number of technologies, techniques, and approaches in general used in IPS proposals is remarkable. Such diversity, coupled with the lack of strict and verifiable evaluations, leads to difficulties for appreciating the true value of most proposals. This paper provides a meta-review that performed a comprehensive compilation of 62 survey papers in the area of indoor positioning. The paper provides the reader with an introduction to IPS and the different technologies, techniques, and some methods commonly employed. The introduction is supported by consensus found in the selected surveys and referenced using them. Thus, the meta-review allows the reader to inspect the IPS current state at a glance and serve as a guide for the reader to easily find further details on each technology used in IPS. The analyses of the meta-review contributed with insights on the abundance and academic significance of published IPS proposals using the criterion of the number of citations. Moreover, 75 works are identified as relevant works in the research topic from a selection of about 4000 works cited in the analyzed surveys.

An Extensible Positioning System for Locating Mobile Robots in Unfamiliar Environments

In this paper, an extensible positioning system for mobile robots is proposed. The system includes a stereo camera module, inertial measurement unit (IMU) and an ultra-wideband (UWB) network which includes five anchors, one of which is with the unknown position. The anchors in the positioning system are without requirements of communication between UWB anchors and without requirements of clock synchronization of the anchors. By locating the mobile robot using the original system, and then estimating the position of a new anchor using the ranging between the mobile robot and the new anchor, the system can be extended after adding the new anchor into the original system. In an unfamiliar environment (such as fire and other rescue sites), it is able to locate the mobile robot after extending itself. To add the new anchor into the positioning system, a recursive least squares (RLS) approach is used to estimate the position of the new anchor. A maximum correntropy Kalman filter (MCKF) which is based on the maximum correntropy criterion (MCC) is used to fuse data from the UWB network and IMU. The initial attitude of the mobile robot relative to the navigation frame is calculated though comparing position vectors given by a visual simultaneous localization and mapping (SLAM) system and the UWB system respectively. As shown in the experiment section, the root mean square error (RMSE) of the positioning result given by the proposed positioning system with all anchors is 0.130 m. In the unfamiliar environment, the RMSE is 0.131 m which is close to the RMSE (0.137 m) given by the original system with a difference of 0.006 m. Besides, the RMSE based on Euler distance of the new anchor is 0.061 m.

Modelling and Control of Mechatronics Lines Served by Complex Autonomous Systems

The aim of this paper is to reverse an assembly line, to be able to perform disassembly, using two complex autonomous systems (CASs). The disassembly is functioning only in case of quality default identified in the final product. The CASs are wheeled mobile robots (WMRs) equipped with robotic manipulators (RMs), working in parallel or collaboratively. The reversible assembly/disassembly mechatronics line (A/DML) assisted by CASs has a specific typology and is modelled by specialized hybrid instruments belonging to the Petri nets class, precisely synchronized hybrid Petri nets (SHPN). The need of this type of models is justified by the necessity of collaboration between the A/DML and CASs, both having characteristics and physical constraints that should be considered and to make all systems compatible. Firstly, the paper proposes the planning and scheduling of tasks necessary in modelling stage as well as in real time control. Secondly, two different approaches are proposed, related to CASs collaboration: a parallel approach with two CASs have simultaneous actions: one is equipped with robotic manipulator, used for manipulation, and the other is used for transporting. This approach is correlated with industrial A/D manufacturing lines where have to transport and handle weights in a wide range of variation. The other is a collaborative approach, A/DML is served by two CASs used for manipulation and transporting, both having simultaneous movements, following their own trajectories. One will assist the disassembly in even, while the other in odd workstations. The added value of this second approach consists in the optimization of a complete disassembly cycle. Thirdly, it is proposed in the paper the real time control of mechatronics line served by CASs working in parallel, based on the SHPN model. The novelty of the control procedure consists in the use of the synchronization signals, in absence of the visual servoing systems, for a precise positioning of the CASs serving the reversible mechatronics line.