Fixing bug in ToF offsets