Algorithm optimized. Calibration for robot required.