This paper presents a perception-aware path planner for active SLAM in dynamic environments using micro-aerial vehicles (MAV). The “Next-Best-View” planner (NBVP planner) is combined with an active loop closing, which is called the Active Loop Closing Planner (ALCP planner). The planner is proposed to avoid both static and dynamic obstacles in unknown environments while reducing the uncertainty of the SLAM system and further improving the accuracy of localization. First, the receding horizon strategy is adopted to find the next waypoint. The cost function that combines the exploration gain and the loop closing gain is designed. The former can reduce the mapping uncertainty, while the latter takes the loop closing possibility into consideration. Second, a key waypoint selection strategy is designed. The selected key waypoints, instead of all waypoints, are treated as potential loop-closing points to make the algorithm more efficient. Moreover, a fuzzy RRT-based dynamic obstacle avoidance algorithm is adopted to realize obstacle avoidance in dynamic environments. Simulations in different challenging scenarios are conducted to verify the effectiveness of the proposed algorithm.
25 February 2019 in Archives of Electrical Engineering
The study of the subdivision driving technology of a stepper motor and two types of typical acceleration and deceleration curves aims at optimizing the open-loop control performance of the stepper motor. The simulation model of a two-phase hybrid stepper motor open-loop control system is set up based on the mathematical model of the stepper motor, in order to let the stepper motor have the smaller stepper angle, two types of typical acceleration and a deceleration curve algorithm are designed for the real- time online calculation based on the subdivision driving technology. It respectively carries out the simulation analysis for their control effects. The simulation results show that the parabolic acceleration and deceleration curves have a larger maximum in-step rotation angle and the faster dynamic response ability in the same control period, and at the same time, the position tracking error of an intermediate process is smaller.
The traditional parafoil system localization methods rely highly on GNSS. However, GNSS cannot provide the control system real-time, high-bandwidth parafoil pose. Additionally, GNSS signals could be attenuated or rejected in complex environments such as mountains or canyons. In order to improve the localization precision of the parafoil system considering GNSS-challenged environments, a multistate constraint Kalman filter-based Vision/IMU/GNSS integration algorithm is explored. In contrast to traditional integration methods defining motion state in a single Cartesian coordinate, our approach jointly defines and constructs the motion state based on multiple coordinates, offering the control system the required high-bandwidth pose input directly. Furthermore, the covariance matrix transformation method is introduced to realize the smooth transition of error state between different coordinates, providing a novel solution for absolute and relative measurement fusion problems. Airsim-based simulation and real-world experiments are carried out to validate the performance of the designed integration algorithm. Experiment results indicate that the proposed algorithm can effectively integrate visual and GNSS measurements, addressing the continuous accurate and effective localization requirement for precise control of autonomous guided parafoil systems in GNSS-challenged environments.
This paper presents a visual active SLAM method considering measurement and state uncertainty for space exploration in urban search and rescue environments. An uncertainty evaluation method based on the Fisher Information Matrix (FIM) is studied from the perspective of evaluating the localization uncertainty of SLAM systems. With the aid of the Fisher Information Matrix, the Cramér–Rao Lower Bound (CRLB) of the pose uncertainty in the stereo visual SLAM system is derived to describe the boundary of the pose uncertainty. Optimality criteria are introduced to quantitatively evaluate the localization uncertainty. The odometry information selection method and the local bundle adjustment information selection method based on Fisher Information are proposed to find out the measurements with low uncertainty for localization and mapping in the search and rescue process. By adopting the method above, the computing efficiency of the system is improved while the localization accuracy is equivalent to the classical ORB-SLAM2. Moreover, by the quantified uncertainty of local poses and map points, the generalized unary node and generalized unary edge are defined to improve the computational efficiency in computing local state uncertainty. In addition, an active loop closing planner considering local state uncertainty is proposed to make use of uncertainty in assisting the space exploration and decision-making of MAV, which is beneficial to the improvement of MAV localization performance in search and rescue environments. Simulations and field tests in different challenging scenarios are conducted to verify the effectiveness of the proposed method.
Accurate and robust localization is critical for autonomous unmanned systems, particularly in challenging environments where conventional Global Navigation Satellite System (GNSS) integrated navigation can be highly susceptible to degeneration. This paper presents a trajectory cross-verification method for loosely coupled Visual-Inertial Navigation System (VINS)-GNSS integration system in GNSS degeneration environments. Our method does not depend on GNSS covariance or single-point measurements. Instead, it performs VINS and GNSS trajectory alignment and further cross-verification through a dual sliding window filtering algorithm. Our method decouples horizontal and vertical data, minimizing the adverse effects of invalid vertical data on the alignment and verification results. Furthermore, we propose a gravity-aware vertical verification strategy to ensure robust vertical trajectory alignment and outlier filtering. We evaluated our method both public and our real-world datasets, and compared it against both classic and state-of-the-art (SOTA) approaches. The experimental results demonstrate that our trajectory cross-verification algorithm exhibits accurate and robust localization performance in GNSS degeneration scenarios, outperforming SOTA algorithms in most datasets.