计算C++中位姿之间的相对变换矩阵

输入是两帧的位姿放入qw,qc,tw,tc中，记住qw，qc里的第一个参数是TUM GroundTruth里位姿的最后一项，输出是两帧的变换矩阵T，下载就能用。