Robust algorithm for calibration of robotic manipulator model