Introduction to robotics : a systems approach - Rehg, James A. (Englewood Cliffs : Prentice-Hall, 1985)