A Robust Incremental Algorithm for Predicting the Motion of Rigid Body in a Time-Varying Environment


A configuration point consists of the position and orientation of a rigid body which are fully described by the position of the frame’s origin and the orientation of its axes, relative to the reference frame. We describe an algorithm to robustly predict futuristic configurations of a moving target in a time-varying environment. We use the Kalman filter for tracking and motion prediction purposes because it is a very effective and useful estimator. It implements a predictor-corrector type estimator that is optimal in the sense that it minimizes the estimated error covariance. The target motion is unconstrained. The proposed algorithm may be viewed as a seed for a range of applications, one of which is robot motion planning in a time-changing environment. A significant feature of the proposed algorithm (when compared to similar ones) is its ability to embark the prediction process from the first time step; no need to wait for few time steps as in the autoregressive-based systems. Simulation results supports our claims and demonstrate the superiority of the proposed model.

Share and Cite:

A. Elnagar, "A Robust Incremental Algorithm for Predicting the Motion of Rigid Body in a Time-Varying Environment," International Journal of Intelligence Science, Vol. 2 No. 3, 2012, pp. 49-55. doi: 10.4236/ijis.2012.23007.

Conflicts of Interest

The authors declare no conflicts of interest.


[1] A. Basu and A. Elnagar, “Safety Optimizing Strategies for Local Path Planning in Dynamic Environments,”International Journal on Robotics Automation, Vol. 10, 1995, pp. 130-142.
[2] R. Azuma and G. Bishop, “Improving Static and Dynamic Registration in an Optical See-Through HMD,” SIGGRAPH 94 Conference Proceedings, ACM Press, Addison-Wesley, Orlando, 1994, pp. 197-204.
[3] S. Bozic, “Digital and Kalman Filtering,” Edward Arnold Publishers, London, 1994.
[4] A. Chakravarthy and D. Ghose, “Obstacle Avoidance in a Dynamic Environment: A Collision Cone Approach,” IEEE Transactions on SMC-Part A: Systems and Humans, Vol. 28, No. 5, 1998, pp. 562-574.doi:10.1109/3468.709600
[5] C. Chang and K. Song, “Environment Prediction for a Mobile Robot in a Dynamic Environment,” IEEE Transactions on Robotics and Automation, Vol. 13, No. 6, 1997, pp. 862-872. doi:10.1109/70.650165
[6] A. Elnagar, “Prediction of Future Configurations of a Moving Target in a Time-Varying Environment Using an Autoregressive Model,” Journal of Intelligent Control and Automation, Vol. 2, No. 4, 2011, pp. 284 -292. doi:10.4236/ica.2011.24033
[7] A. Elnagar and K. Gupta, “Motion Prediction of Moving Objects Based on Autoregressive Model,” IEEE Transactions on SMC-Part 1: Systems and Humans, Vol. 28, No. 6, 1998, pp. 803-810. doi:10.1109/3468.725351
[8] P. Fiorini and Z. Shiller, “Time Optimal Trajectory Planning in Dynamic Environments,” IEEE International Conference on Robotics and Automation, Vol. 2, 1996, pp. 1553-1558.
[9] E. Foxlin, M. Harrington and G. Pfeifer, “ConstellationTM: A Wide-Range Wireless Motion-Tracking System for Augmented Reality and Virtual Set Applications,” In: M. F. Cohen, Ed., Computer Graphics (SIGGRAPH 98 Conference Proceedings,), Orlando, ACM Press, Addi-son-Wesley, 1998, pp. 371-378.
[10] T. Fraichard and C. Laugier, “Path-Velocity Decomposition Revisited and Applied to Dynamic Trajectory Planning,” Proceedings of the IEEE International Conference on Robotics and Automation, Atlanta, 2-6 May 1993, pp. 40-45.
[11] K. Fujimura and H. Samet, “Motion Planning in a Dynamic Environment,” Proceedings of the IEEE International Conference on Robotics and Automation, Scottsdale, 14-19 May 1989, pp. 324-330.
[12] Y. Hwang and N. Ahuja, “Gross Motion Planning—A Survey,” ACM Computing Surveys, Vol. 24, No. 3, 1992, pp. 219-291. doi:10.1145/136035.136037
[13] K. Intersense, “IS-900,” 2000. http://www.isense.com
[14] K. Kant and S. W. Zucker, “Towards Efficient Trajectory Planning: The Path-Velocity Decomposition,” The International Journal of Robotics Research, Vol. 5, No. 3, 1986, pp. 72-89. doi:10.1177/027836498600500304
[15] N. Kehtarnavaz and N. Griswold, “Establishing Collision Zones for Obstacles Moving with Uncertainty,” Computer Vision, Graphics and Image Processing, Vol. 49, No. 1, 1990, pp. 95-103. doi:10.1016/0734-189X(90)90165-R
[16] J.-C. Latombe, “Robot Motion Planning,” Kluwer Academic Publishers, London, 1991.
[17] K. Pratihar, D. Deb and A. Ghosh, “A Genetic-Fuzzy Approach for Mobile Robot Navigation among Moving Obstacles,” International Journal of Approximate Reasoning, Vol. 20, No. 2, 1999, pp. 145-172. doi:10.1016/S0888-613X(98)10026-9
[18] R. Spense and S. Hutchinson, “An Integrated Architecture for Robot Motion Planning and Control in the Presence of Moving Obstacles with Unknown Trajectories,” IEEE Transactions on SMC, Vol. 25, No. 1, 1995, pp. 100-110.
[19] T. Tsubouchi, K. Hiraoka, T. Naniwa and S. Arimoto, “A Mobile Robot Navigation Scheme for an Environment with Multiple Moving Obstacles,” Proceedings of the IEEE/RSJ International Conference on Intelligent Robots, Raleigh, 7-10 July 1992, pp. 1791-1798.
[20] G. Welch, G. Bishop, L. Vicci, S. Brumback, K. Keller and D. Colucci, “High-Performance Wide-Area Optical Tracking—The HiBall Tracking System,” Presence: Teleoperators and Virtual Environments, Vol. 10, No. 1, 2001.

Copyright © 2023 by authors and Scientific Research Publishing Inc.

Creative Commons License

This work and the related PDF file are licensed under a Creative Commons Attribution 4.0 International License.