Nonuniform Dual-Rate Extended Kalman-Filter-Based Sensor Fusion for Path-Following Control of a Holonomic Mobile Robot with Four Mecanum Wheels

Abstract

This paper presents an extended Kalman-filter-based sensor fusion approach, which enables path-following control of a holonomic mobile robot with four mecanum wheels. Output measurements of the mobile platform may be sensed at different rates: odometry and orientation data can be obtained at a fast rate, whereas position information may be generated at a slower rate. In addition, as a consequence of possible sensor failures or the use of lossy wireless sensor networks, the presence of the measurements may be nonuniform. These issues may degrade the path-following control performance. The consideration of a nonuniform dual-rate extended Kalman filter (NUDREKF) enables us to estimate fast-rate robot states from nonuniform, slow-rate measurements. Providing these estimations to the motion controller, a fast-rate control signal can be generated, reaching a satisfactory path-following behavior. The proposed NUDREKF is stated to represent any possible sampling pattern by means of a diagonal matrix, which is updated at a fast rate from the current, existing measurements. This fact results in a flexible formulation and a straightforward algorithmic implementation. A modified Pure Pursuit path-tracking algorithm is used, where the reference linear velocity is decomposed into Cartesian components, which are parameterized by a variable gain that depends on the distance to the target point. The proposed solution was evaluated using a realistic simulation model, developed with Simscape Multibody (Matlab/Simulink), of the four-mecanum-wheeled mobile platform. This model includes some of the nonlinearities present in a real vehicle, such as dead-zone, saturation, encoder resolution, and wheel sliding, and was validated by comparing real and simulated behavior. Comparison results reveal the superiority of the sensor fusion proposal under the presence of nonuniform, slow-rate measurements.