欧拉法代码实现是不是有问题？ #16
Description
imu.cpp第136行后面的欧拉法中，由k的测量值计算k+1时刻的位姿，137行 “MotionData imupose = imudata[i];” 应该是 “MotionData imupose = imudata[i-1];” 吧？不然从1开始的话（比如时间戳0.005），就是用该时刻的角速度和加速度计算该时刻的位姿了，和定义不符，从保存的数据也可以看出来。（后面保存的时间戳也要改）
{{ message }}
imu.cpp第136行后面的欧拉法中，由k的测量值计算k+1时刻的位姿，137行 “MotionData imupose = imudata[i];” 应该是 “MotionData imupose = imudata[i-1];” 吧？不然从1开始的话（比如时间戳0.005），就是用该时刻的角速度和加速度计算该时刻的位姿了，和定义不符，从保存的数据也可以看出来。（后面保存的时间戳也要改）