calibrate_tracking_kinect_extrinsic tool, first working version, still inaccurate and might be buggy.