... double dz = imu_msg->linear_acceleration.z; double rx = imu_msg->angular_velocity.x; ... Vector3d acc(dx, dy, dz); Vector3d gyr(rx, ry, rz); estimator.
確定! 回上一頁