Optimization for Robot Modelling with MATLAB