ztd

Results 1 issues of ztd

imu.cpp第136行后面的欧拉法中,由k的测量值计算k+1时刻的位姿,137行 “MotionData imupose = imudata[i];” 应该是 “MotionData imupose = imudata[i-1];” 吧?不然从1开始的话(比如时间戳0.005),就是用该时刻的角速度和加速度计算该时刻的位姿了,和定义不符,从保存的数据也可以看出来。(后面保存的时间戳也要改)