Introduction to robotics a systems approach - Rehg, James A (Prentice-Hall, New Jersey, 1985)