Derivative-Free Nonlinear Kalman Filtering for MIMO Dynamical Systems: Application to Multi-DOF Robotic Manipulators

The paper proposes derivative-free nonlinear Kalman Filtering for MIMO nonlinear dynamical systems. The considered nonlinear filtering scheme which is based on differential flatness theory extends the class of systems to which Kalman Filtering can be applied without the need for calculation of Jacobian matrices. To deduce if a dynamical system is differentially flat, the following should be examined: (i) the existence of the flat output, which is a variable that can be written as a function of the system's state variables (ii) the system's state variables and the input can be written as functions of the flat output and its derivatives. Nonlinear systems satisfying the differential flatness property can be written in the Brunovsky form via a transformation of their state variables and control inputs. After transforming the nonlinear system to the canonical form it is straightforward to apply the standard Kalman Filter recursion. The performance of the proposed derivative-free nonlinear filtering scheme is tested through simulation experiments on benchmark nonlinear multi-input multi-output dynamical systems, such as robotic manipulators