Hand-eye calibration finished
Several fixes