| void | warpos::convertImuInertialCg (const clockwerk::CartesianVector< 3 > &accel_meas_imu_I__imu, const clockwerk::CartesianVector< 3 > &ang_vel_meas_imu_I__imu, const clockwerk::CartesianVector< 3 > &ang_accel_meas_imu_I__imu, const clockwerk::CartesianVector< 3 > &lever_arm_imu_body__body, const clockwerk::Quaternion &quat_imu_body, const clockwerk::CartesianVector< 3 > &accel_bias__imu, const clockwerk::CartesianVector< 3 > &ang_vel_bias__imu, clockwerk::CartesianVector< 3 > &accel_body_I__body, clockwerk::CartesianVector< 3 > &ang_vel_body_I__body) |