Given that the internal states of a system, such as position, velocity, acceleration, and other important factors, naturally obey the integral processes of a physical system in kinematics, this paper presents an adaptive noise filtering system that can reconstruct these system states at the kinematic level. This is done without using any prior knowledge of the statistical properties of measurement noises. In the proposed filtering system here, each noise-contaminated estimated state is filtered by an average filter to compensate for phase delay and amplitude distortion. Unlike existing model-based estimation methods, the dynamic equation is not explicitly used in the proposed method, and the uncertainties in the nonlinear dynamic equation can be isolated. Furthermore, this application is much more straightforward as there are no gains to be processed. To verify our proposed adaptive filtering system, it has been applied to a variable speed path-following control task for unmanned surface vehicles (USVs), where accurate system states must be known. In particular, this paper also proposes a state-constrained finite-time control framework to realize the path-following control objectives. The proposed controller here mainly consists of two parts, i.e., an online state-constrained polynomial planning function and an execution of an algebraic control law. Simulations and experiments have been conducted to validate the effectiveness and reliability of the proposed filtering system and the finite-time controller. The results show that the proposed filtering system considerably outperformed several of conventional observers such as the extended Kalman filter (EKF), the passive observer, as well as the high-order differentiator.
Read full abstract