State estimation based on kinematic models considering characteristics of sensors

The major benefit of the state estimation based on kinematic model such as the kinematic Kalman filter (KKF) is that it is immune to parameter variations and unknown disturbances and thus can provide an accurate and robust state estimation regardless of the operating condition. Since it suggests to use a combination of low cost sensors rather than a single costly sensor, the specific characteristics of each sensor may have a major effect on the performance of the state estimator. As an illustrative example, this paper considers the simplest form of the KKF, i.e., the velocity estimation combining the encoder with the accelerometer and addresses two major issues that arise in its implementation: the limited bandwidth of the accelerometer and the deterministic feature (non-whiteness) of the quantization noise of the encoder at slow speeds. It has been shown that each of these characteristics can degrade the performance of the state estimation at different regimes of the operation range. A simple method to use the variable Kalman filter gain has been suggested to alleviate these problems using the simplified parameterization of the Kalman filter gain matrix. Experimental results are presented to illustrate the main issues and also to validate the effectiveness of the proposed scheme.

[1]  B. Friedland Optimum Steady-State Position and Velocity Estimation Using Noisy Sampled Position Data , 1973, IEEE Transactions on Aerospace and Electronic Systems.

[2]  M. Tomizuka,et al.  Benefits of acceleration measurement in velocity estimation and motion control , 2004 .

[3]  Huosheng Hu,et al.  Integration of Vision and Inertial Sensors for 3D Arm Motion Tracking in Home-based Rehabilitation , 2007, Int. J. Robotics Res..

[4]  Lihua Xie,et al.  Quantized Kalman Filtering , 2007, 2007 IEEE 22nd International Symposium on Intelligent Control.

[5]  Emil Levi,et al.  A speed estimator for high performance sensorless control of induction motors in the field weakening region , 2002 .

[6]  John Weston,et al.  Strapdown Inertial Navigation Technology , 1997 .

[7]  Paolo Rocco,et al.  Velocity Estimation: Assessing the Performance of Non-Model-Based Techniques , 2009, IEEE Transactions on Control Systems Technology.

[8]  J. Painter,et al.  Reconciling steady-state Kalman and alpha-beta filter design , 1990 .

[9]  Markus Vincze,et al.  Fast Ego-motion Estimation with Multi-rate Fusion of Inertial and Vision , 2007, Int. J. Robotics Res..

[10]  Soo Jeon,et al.  Kinematic Kalman Filter (KKF) for Robot End-Effector Sensing , 2009 .

[11]  Stergios I. Roumeliotis,et al.  SOI-KF: Distributed Kalman Filtering With Low-Cost Communications Using The Sign Of Innovations , 2006, 2006 IEEE International Conference on Acoustics Speech and Signal Processing Proceedings.

[12]  Seung-Ki Sul,et al.  A new motor speed estimator using Kalman filter in low-speed range , 1996, IEEE Trans. Ind. Electron..

[13]  Peter C. Müller,et al.  A simple improved velocity estimation for low-speed regions based on position measurements only , 2006, IEEE Transactions on Control Systems Technology.

[14]  John C. Doyle,et al.  Guaranteed margins for LQG regulators , 1978 .

[15]  P. R. Bélanger,et al.  Estimation of Angular Velocity and Acceleration from Shaft-Encoder Measurements , 1992, Proceedings 1992 IEEE International Conference on Robotics and Automation.

[16]  Wan Kyun Chung,et al.  A combined observer for robust state estimation and Kalman filtering , 2003, Proceedings of the 2003 American Control Conference, 2003..

[17]  Stergios I. Roumeliotis,et al.  SOI-KF: Distributed Kalman Filtering With Low-Cost Communications Using the Sign of Innovations , 2006, IEEE Trans. Signal Process..

[18]  G. Stein,et al.  Robustness with observers , 1978, 1978 IEEE Conference on Decision and Control including the 17th Symposium on Adaptive Processes.

[19]  B. Widrow Statistical analysis of amplitude-quantized sampled-data systems , 1961, Transactions of the American Institute of Electrical Engineers, Part II: Applications and Industry.

[20]  M. Tomizuka,et al.  Sensing rich drive trains for modern mechatronic systems: first year progress report , 2007, SPIE Smart Structures and Materials + Nondestructive Evaluation and Health Monitoring.