Robotics, vision and control : fundamental algorithms in Matlab - Corke, Peter (Star (Springer), 2011)