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