Peter Corke's MATLAB robotics toolbox