The robotics review 2 - Craig, John J.; Khatib, Oussama; Lozano-Perez, Tomas (MIT Press, 1989)