4d_ObstacleRadarDroneCAN/math/axis_angle.h

#pragma once

#ifdef __cplusplus
extern "C" {
#endif

/**
 * @brief 使用四元数构造轴角向量
 *
 * @param Q 四元数
 * @param axisAngle 轴角向量, 向量方向为转轴方向, 向量模值为转角大小 rad, 右手定则
 */
void AxisAngle_ByQuaternion(const float Q[4], float axisAngle[3]);

#ifdef __cplusplus
}
#endif