Fundamentals of robotics linking perception to action - Xie, M. (Min) (Series in machine perception and artificial intelligence, 2003)