Fixed: tof-calibration calculated wrong