Compelted Basic Robot Calibration Routine