输入是两帧的位姿放入qw,qc,tw,tc中,记住qw,qc里的第一个参数是TUM GroundTruth里位姿的最后一项,输出是两帧的变换矩阵T,下载就能用。
2021-07-22 13:01:42 1KB 机器人学 位姿变换 C语言
1