This paper proposes a novel multi-sensor-based indoor global localization system integrating visual localization aided by CNN-based image retrieval with a probabilistic localization approach. The global localization system consists of three parts: coarse place recognition, fine localization and re-localization from kidnapping. Coarse place recognition exploits a monocular camera to realize the initial localization based on image retrieval, in which off-the-shelf features extracted from a pre-trained Convolutional Neural Network (CNN) are adopted to determine the candidate locations of the robot. In the fine localization, a laser range finder is equipped to estimate the accurate pose of a mobile robot by means of an adaptive Monte Carlo localization, in which the candidate locations obtained by image retrieval are considered as seeds for initial random sampling. Additionally, to address the problem of robot kidnapping, we present a closed-loop localization mechanism to monitor the state of the robot in real time and make adaptive adjustments when the robot is kidnapped. The closed-loop mechanism effectively exploits the correlation of image sequences to realize the re-localization based on Long-Short Term Memory (LSTM) network. Extensive experiments were conducted and the results indicate that the proposed method not only exhibits great improvement on accuracy and speed, but also can recover from localization failures compared to two conventional localization methods.
In this paper, an output-feedback fuzzy adaptive dynamic surface controller (FADSC) based on fuzzy adaptive extended state observer (FAESO) is proposed for autonomous underwater vehicle (AUV) systems in the presence of external disturbances, parameter uncertainties, measurement noises and actuator faults. The fuzzy logic system is incorporated into both the observers and controllers to improve the adaptability of the entire system. The dynamics of the AUV system is established first, considering the external disturbances and parameter uncertainties. Based on the dynamic models, the ESO, combined with a fuzzy logic system tuning the observer bandwidth, is developed to not only adaptively estimate both system states and the lumped disturbances for the controller, but also reduce the impact of measurement noises. Then, the DSC, together with fuzzy logic system tuning the time constant of the low-pass filter, is designed using estimations from the FAESO for the AUV system. The asymptotic stability of the entire system is analyzed through Lyapunov’s direct method in the time domain. Comparative simulations are implemented to verify the effectiveness and advantages of the proposed method compared with other observers and controllers considering external disturbances, parameter uncertainties and measurement noises and even the actuator faults that are not considered in the design process. The results show that the proposed method outperforms others in terms of tracking accuracy, robustness and energy consumption.
Aerial operation with unmanned aerial vehicle (UAV) manipulator is a promising field for future applications. However, the quadrotor UAV manipulator usually suffers from several disturbances, such as external wind and model uncertainties, when conducting aerial tasks, which will seriously influence the stability of the whole system. In this paper, we address the problem of high-precision attitude control for quadrotor manipulator which is equipped with a 2-degree-of-freedom (DOF) robotic arm under disturbances. We propose a new sliding-mode extended state observer (SMESO) to estimate the lumped disturbance and build a backstepping attitude controller to attenuate its influence. First, we use the saturation function to replace discontinuous sign function of traditional SMESO to alleviate the estimation chattering problem. Second, by innovatively introducing super-twisting algorithm and fuzzy logic rules used for adaptively updating the observer switching gains, the fuzzy adaptive saturation super-twisting extended state observer (FASTESO) is constructed. Finally, in order to further reduce the impact of sensor noise, we invite a tracking differentiator (TD) incorporated into FASTESO. The proposed control approach is validated with effectiveness in several simulations and experiments in which we try to fly UAV under varied external disturbances.
This paper proposes an autonomous algorithm to determine the relative pose between the chaser spacecraft and the uncooperative space target, which is essential in advanced space applications, e.g., on-orbit serving missions. The proposed method, named Congruent Tetrahedron Align (CTA) algorithm, uses the very sparse unorganized 3D point cloud acquired by a LIDAR sensor, and does not require any prior pose information. The core of the method is to determine the relative pose by looking for the congruent tetrahedron in scanning point cloud and model point cloud on the basis of its known model. The two-level index hash table is built for speeding up the search speed. In addition, the Iterative Closest Point (ICP) algorithm is used for pose tracking after CTA. In order to evaluate the method in arbitrary initial attitude, a simulated system is presented. Specifically, the performance of the proposed method to provide the initial pose needed for the tracking algorithm is demonstrated, as well as their robustness against noise. Finally, a field experiment is conducted and the results demonstrated the effectiveness of the proposed method.
This article addresses the problem of high precision attitude control for quadrotor unmanned aerial vehicle in presence of wind gust and actuator faults. We consider the effect of those factors as lumped disturbances, and in order to realize the quickly and accurately estimation of the disturbances, we propose a control strategy based on the online disturbance uncertainty estimation and attenuation method. Firstly, an enhanced extended state observer (ESO) is constructed based on the super-twisting (ST) algorithm to estimate and attenuate the impact of wind gust and actuator faults in finite time. And the convergence analysis and parameter selection rule of STESO are given following. Secondly, in order to guarantee the asymptotic convergence of desired attitude timely, a sliding mode control law is derived based on the super-twisting algorithm. And a comprehensive stability analysis for the entire system is presented based on the Lyapunov stability theory. Finally, to demonstrate the efficiency of the proposed solution, numerical simulations and real time experiments are carried out in presences of wind disturbance and actuator faults.
During the flight of the quadrotor, the existence of a slung load will exert a swing effect on the system and the motion of which will significantly change the dynamics of the quadrotor. The external torque caused by the slung load can be considered as a kind of disturbance and it is a threat to the attitude control stability of the system. In order to solve this problem, a high precision disturbance compensation method is presented in this paper, based on the harmonic extended state observer (HESO). Firstly, a generic mathematical model for the quadrotor-slung load system is obtained via the Lagrangian mechanics, and according to the analysis of the slung load motion, we obtain the disturbance as a form of periodic equation. Secondly, based on the dynamic model of the disturbance, we propose a HESO to achieve high precision disturbance estimation and its stability is proved by Lyapunov theory. Thirdly, we designed an attitude tracking controller based on backstepping method, and discussed the stability of the entire system. Finally, numerical simulations and real time experiments are carried out to evaluate the performance of the proposed method. Our results show that the robustness of the quadrotor subject to slung load has been improved.