Robotics, Vision and Control Fundamental Algorithms in Matlab - Springer 2013 - 570