![]() |
OpenCV 4.12.0
開源計算機視覺
|
#include <opencv2/core/quaternion.hpp>
公共成員函式 | |
| Quat () | |
| Quat (_Tp w, _Tp x, _Tp y, _Tp z) | |
| 從四個數字建立。 | |
| Quat (const Vec< _Tp, 4 > &coeff) | |
| 從 Vec4d 或 Vec4f 建立。 | |
| Quat< _Tp > | acos () const |
| 返回此四元數的反餘弦值,反餘弦可以計算為 | |
| Quat< _Tp > | acosh () const |
| 返回此四元數的反雙曲餘弦值,反雙曲餘弦可以計算為 | |
| Quat< _Tp > | asin () const |
| 返回此四元數的反正弦值,反正弦可以計算為 | |
| Quat< _Tp > | asinh () const |
| 返回此四元數的反雙曲正弦值,反雙曲正弦可以計算為 | |
| void | assertNormal (_Tp eps=CV_QUAT_EPS) const |
| 如果此四元數不是單位四元數,則丟擲錯誤。 | |
| _Tp | at (size_t index) const |
| 獲取元素的方法。 | |
| Quat< _Tp > | atan () const |
| 返回此四元數的反正切值,反正切可以計算為 | |
| Quat< _Tp > | atanh () const |
| 返回此四元數的反雙曲正切值,反雙曲正切可以計算為 | |
| Quat< _Tp > | conjugate () const |
| 返回此四元數的共軛。 | |
| Quat< _Tp > | cos () const |
| 返回此四元數的餘弦值,餘弦可以計算為 | |
| Quat< _Tp > | cosh () const |
| 返回此四元數的雙曲餘弦值,雙曲餘弦可以計算為 | |
| Quat< _Tp > | crossProduct (const Quat< _Tp > &q) const |
| 返回 \(p = (a, b, c, d) = (a, \boldsymbol{u})\) 和 \(q = (w, x, y, z) = (w, \boldsymbol{v})\) 之間的叉積。 | |
| _Tp | dot (Quat< _Tp > q) const |
| 返回四元數 \(q\) 與此四元數之間的點積。 | |
| Quat< _Tp > | exp () const |
| 返回指數值。 | |
| _Tp | getAngle (QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT) const |
| 獲取四元數的角度,它返回旋轉角度。 | |
| Vec< _Tp, 3 > | getAxis (QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT) const |
| 獲取四元數的軸,它返回一個長度為3的向量。 | |
| Quat< _Tp > | inv (QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT) const |
| 返回 \(q^{-1}\),它是 \(q\) 的逆,滿足 \(q * q^{-1} = 1\)。 | |
| bool | isNormal (_Tp eps=CV_QUAT_EPS) const |
| 如果此四元數是單位四元數,則返回 true。 | |
| Quat< _Tp > | log (QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT) const |
| 返回對數函式的值。 | |
| _Tp | norm () const |
| 返回四元數的範數。 | |
| Quat< _Tp > | normalize () const |
| 返回歸一化的 \(p\)。 | |
| Quat< _Tp > | operator* (const Quat< _Tp > &) const |
| 兩個四元數 q 和 p 的乘法運算子。將運算子兩側的值相乘。 | |
| Quat< _Tp > & | operator*= (const _Tp s) |
| 四元數與標量的乘法賦值運算子。它將右運算元與左運算元相乘並將結果賦給左運算元。 | |
| Quat< _Tp > & | operator*= (const Quat< _Tp > &) |
| 兩個四元數 q 和 p 的乘法賦值運算子。它將右運算元與左運算元相乘並將結果賦給左運算元。 | |
| Quat< _Tp > | operator+ (const Quat< _Tp > &) const |
| 兩個四元數 p 和 q 的加法運算子。它返回一個新的四元數,其中每個值是 \(p_i\) 和 \(q_i\) 的和。 | |
| Quat< _Tp > & | operator+= (const Quat< _Tp > &) |
| 兩個四元數 p 和 q 的加法賦值運算子。它將右運算元加到左運算元上並將結果賦給左運算元。 | |
| Quat< _Tp > | operator- () const |
| 返回相反四元數 \(-p\),滿足 \(p + (-p) = 0.\)。 | |
| Quat< _Tp > | operator- (const Quat< _Tp > &) const |
| 兩個四元數 p 和 q 的減法運算子。它返回一個新的四元數,其中每個值是 \(p_i\) 和 \(-q_i\) 的和。 | |
| Quat< _Tp > & | operator-= (const Quat< _Tp > &) |
| 兩個四元數 p 和 q 的減法賦值運算子。它將右運算元從左運算元中減去並將結果賦給左運算元。 | |
| Quat< _Tp > | operator/ (const _Tp s) const |
| 四元數與標量的除法運算子。它將左運算元除以右運算元並將結果賦給左運算元。 | |
| Quat< _Tp > | operator/ (const Quat< _Tp > &) const |
| 兩個四元數 p 和 q 的除法運算子。將左運算元除以右運算元。 | |
| Quat< _Tp > & | operator/= (const _Tp s) |
| 四元數與標量的除法賦值運算子。它將左運算元除以右運算元並將結果賦給左運算元。 | |
| Quat< _Tp > & | operator/= (const Quat< _Tp > &) |
| 兩個四元數 p 和 q 的除法賦值運算子;它將左運算元除以右運算元並將結果賦給左運算元。 | |
| bool | operator== (const Quat< _Tp > &) const |
| 如果兩個四元數 p 和 q 幾乎相等,即當每個 \(p_i\) 和 \(q_i\) 的絕對值小於 CV_QUAT_EPS 時,則返回 true。 | |
| _Tp & | operator[] (std::size_t n) |
| const _Tp & | operator[] (std::size_t n) const |
| Quat< _Tp > | power (const _Tp x, QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT) const |
| 返回指數為 \(x\) 的冪函式值。 | |
| Quat< _Tp > | Quat< _Tp > |
| 返回以四元數 \(q\) 為指數的冪函式值。 | |
| Quat< _Tp > | sin () const |
| 返回此四元數的正弦值,正弦可以計算為 | |
| Quat< _Tp > | sinh () const |
| 返回此四元數的雙曲正弦值,雙曲正弦可以計算為:\(\sinh(p) = \sin(w)\cos(||\boldsymbol{v}||) + \cosh(w)\frac{v}{||\boldsymbol{v}||}\sin||\boldsymbol{v}||\),其中 \(\boldsymbol{v} = [x, y, z].\) | |
| Quat< _Tp > | sqrt (QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT) const |
| 返回 \(\sqrt{q}\)。 | |
| Quat< _Tp > | tan () const |
| 返回此四元數的正切值,正切可以計算為 | |
| Quat< _Tp > | tanh () const |
| 返回此四元數的雙曲正切值,雙曲正切可以計算為 | |
| Vec< _Tp, 3 > | QuatEnum::EulerAnglesType toEulerAngles (QuatEnum::EulerAnglesType eulerAnglesType) |
| 將四元數 q 轉換為尤拉角。 | |
| Matx< _Tp, 3, 3 > | toRotMat3x3 (QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT) const |
| 將四元數轉換為 3x3 旋轉矩陣。 | |
| Matx< _Tp, 4, 4 > | toRotMat4x4 (QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT) const |
| 將四元數轉換為 4x4 旋轉矩陣。 | |
| Vec< _Tp, 3 > | toRotVec (QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT) const |
| 將此四元數轉換為旋轉向量。 | |
| Vec< _Tp, 4 > | toVec () const |
| 將此四元數轉換為 Vec<T, 4>。 | |
靜態公共成員函式 | |
| static Quat< _Tp > | createFromAngleAxis (const _Tp angle, const Vec< _Tp, 3 > &axis) |
| 從角度、軸建立。軸在此函式中將被歸一化。並且它生成 | |
| static Quat< _Tp > | createFromEulerAngles (const Vec< _Tp, 3 > &angles, QuatEnum::EulerAnglesType eulerAnglesType) |
| 從尤拉角建立 | |
| static Quat< _Tp > | createFromRotMat (InputArray R) |
| 從 3x3 旋轉矩陣建立。 | |
| static Quat< _Tp > | createFromRvec (InputArray rvec) |
| 從旋轉向量 \(r\) 建立,其形式為 \(\theta \cdot \boldsymbol{u}\),其中 \(\theta\) 表示旋轉角度,\(\boldsymbol{u}\) 表示歸一化旋轉軸。 | |
| static Quat< _Tp > | createFromXRot (const _Tp theta) |
| 透過繞 X 軸旋轉 \(\theta\) 獲取一個四元數。 | |
| static Quat< _Tp > | createFromYRot (const _Tp theta) |
| 透過繞 Y 軸旋轉 \(\theta\) 獲取一個四元數。 | |
| static Quat< _Tp > | createFromZRot (const _Tp theta) |
| 透過繞 Z 軸旋轉 \(\theta\) 獲取一個四元數。 | |
| static Quat< _Tp > | interPoint (const Quat< _Tp > &q0, const Quat< _Tp > &q1, const Quat< _Tp > &q2, QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT) |
| 這是 squad 的部分計算。用於計算每三個四元數之間的中間四元數 \(s_i\)。 | |
| static Quat< _Tp > | lerp (const Quat< _Tp > &q0, const Quat &q1, const _Tp t) |
| 透過線性插值(Lerp)計算從 \(q_0\) 到 \(q_1\) 的插值。對於兩個四元數,此插值曲線可以顯示為 | |
| static Quat< _Tp > | nlerp (const Quat< _Tp > &q0, const Quat &q1, const _Tp t, QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT) |
| 透過歸一化線性插值(Nlerp)計算從 \(q_0\) 到 \(q_1\) 的插值。它返回線性插值(Lerp)的歸一化四元數。 | |
| static Quat< _Tp > | slerp (const Quat< _Tp > &q0, const Quat &q1, const _Tp t, QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT, bool directChange=true) |
| 透過球面線性插值(Slerp)計算 \(q_0\) 和 \(q_1\) 之間的插值,Slerp 可以定義為 | |
| static Quat< _Tp > | spline (const Quat< _Tp > &q0, const Quat< _Tp > &q1, const Quat< _Tp > &q2, const Quat< _Tp > &q3, const _Tp t, QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT) |
| 計算透過 squad 構造的 \(C^1\) 連續樣條曲線在比率 t 處的四元數結果。這裡,插值在 \(q_1\) 和 \(q_2\) 之間。\(q_0\) 和 \(q_2\) 用於確保 \(C^1\) 連續性。如果 t = 0,它返回 \(q_1\);如果 t = 1,它返回 \(q_2\)。 | |
| static Quat< _Tp > | squad (const Quat< _Tp > &q0, const Quat< _Tp > &s0, const Quat< _Tp > &s1, const Quat< _Tp > &q1, const _Tp t, QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT, bool directChange=true) |
| 透過球面和四邊形(Squad)計算 \(q_0\), \(q_1\), \(q_2\), \(q_3\) 之間的插值。這可以定義為 | |
公共屬性 | |
| _Tp | w |
| _Tp | x |
| _Tp | y |
| _Tp | z |
靜態公共屬性 | |
| static constexpr _Tp | CV_QUAT_CONVERT_THRESHOLD = (_Tp)1.e-6 |
| static constexpr _Tp | CV_QUAT_EPS = (_Tp)1.e-6 |
友元 | |
| template<typename T > | |
| Quat< T > | acos (const Quat< T > &q) |
| 返回四元數 q 的反餘弦值,反餘弦可以計算為 | |
| template<typename T > | |
| Quat< T > | acosh (const Quat< T > &q) |
| 返回四元數 q 的反雙曲餘弦值,反雙曲餘弦可以計算為 | |
| template<typename T > | |
| Quat< T > | asin (const Quat< T > &q) |
| 返回四元數 q 的反正弦值,反正弦可以計算為 | |
| template<typename T > | |
| Quat< T > | asinh (const Quat< T > &q) |
| 返回四元數 q 的反雙曲正弦值,反雙曲正弦可以計算為 | |
| template<typename T > | |
| Quat< T > | atan (const Quat< T > &q) |
| 返回四元數 q 的反正切值,反正切可以計算為 | |
| template<typename T > | |
| Quat< T > | atanh (const Quat< T > &q) |
| 返回四元數 q 的反雙曲正切值,反雙曲正切可以計算為 | |
| template<typename T > | |
| Quat< T > | cos (const Quat< T > &q) |
| 返回四元數 q 的餘弦值,餘弦可以計算為 | |
| template<typename T > | |
| Quat< T > | cosh (const Quat< T > &q) |
| 返回四元數 q 的雙曲餘弦值,雙曲餘弦可以計算為 | |
| template<typename T > | |
| Quat< T > | crossProduct (const Quat< T > &p, const Quat< T > &q) |
| 返回 \(p = (a, b, c, d) = (a, \boldsymbol{u})\) 和 \(q = (w, x, y, z) = (w, \boldsymbol{v})\) 之間的叉積。 | |
| template<typename T > | |
| Quat< T > | cv::operator* (const Quat< T > &, const T s) |
| 四元數與標量的乘法運算子。它將右運算元與左運算元相乘並將結果賦給左運算元。 | |
| template<typename T > | |
| Quat< T > | cv::operator* (const T s, const Quat< T > &) |
| 標量與四元數的乘法運算子。它將右運算元與左運算元相乘並將結果賦給左運算元。 | |
| template<typename T > | |
| Quat< T > | cv::operator+ (const Quat< T > &, const T s) |
| 四元數與標量的加法運算子。將右運算元加到左運算元上。 | |
| template<typename T > | |
| Quat< T > | cv::operator+ (const T s, const Quat< T > &) |
| 四元數與標量的加法運算子。將右運算元加到左運算元上。 | |
| template<typename T > | |
| Quat< T > | cv::operator- (const Quat< T > &, const T s) |
| 四元數與標量的減法運算子。將右運算元從左運算元中減去。 | |
| template<typename T > | |
| Quat< T > | cv::operator- (const T s, const Quat< T > &) |
| 標量與四元數的減法運算子。將右運算元從左運算元中減去。 | |
| template<typename S > | |
| std::ostream & | cv::operator<< (std::ostream &, const Quat< S > &) |
| template<typename T > | |
| Quat< T > | exp (const Quat< T > &q) |
| 返回指數值。 | |
| template<typename T > | |
| Quat< T > | inv (const Quat< T > &q, QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT) |
| 返回 \(q^{-1}\),它是 \(q\) 的逆,滿足 \(q * q^{-1} = 1\)。 | |
| template<typename T > | |
| Quat< T > | log (const Quat< T > &q, QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT) |
| 返回對數函式的值。 | |
| template<typename T > | |
| Quat< T > | power (const Quat< T > &p, const Quat< T > &q, QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT) |
| 返回以四元數 \(q\) 為指數的冪函式值。 | |
| template<typename T > | |
| Quat< T > | power (const Quat< T > &q, const T x, QuatAssumeType assumeUnit=QUAT_ASSUME_NOT_UNIT) |
| 返回指數為 \(x\) 的冪函式值。 | |
| template<typename T > | |
| Quat< T > | sin (const Quat< T > &q) |
| 返回四元數 q 的正弦值,正弦可以計算為 | |
| template<typename T > | |
| Quat< T > | sinh (const Quat< T > &q) |
| 返回四元數 q 的雙曲正弦值,雙曲正弦可以計算為 | |
| template<typename T > | |
| Quat< T > | sqrt (const Quat< T > &q, QuatAssumeType assumeUnit) |
| 返回 \(\sqrt{q}\)。 | |
| template<typename T > | |
| Quat< T > | tan (const Quat< T > &q) |
| 返回四元數 q 的正切值,正切可以計算為 | |
| template<typename T > | |
| Quat< T > | tanh (const Quat< T > &q) |
| 返回四元數 q 的雙曲正切值,雙曲正切可以計算為 | |
四元數是擴充套件複數的一個數系。它可以表示三維空間中的旋轉。一個四元數通常表示為以下形式:
\[q = w + x\boldsymbol{i} + y\boldsymbol{j} + z\boldsymbol{k}\]
\[q = [w, x, y, z]\]
\[q = [w, \boldsymbol{v}] \]
\[q = ||q||[\cos\psi, u_x\sin\psi,u_y\sin\psi, u_z\sin\psi].\]
\[q = ||q||[\cos\psi, \boldsymbol{u}\sin\psi]\]
其中 \(\psi = \frac{\theta}{2}\),\(\theta\) 表示旋轉角度,\(\boldsymbol{u} = [u_x, u_y, u_z]\) 表示歸一化旋轉軸,\(||q||\) 表示 \(q\) 的範數。
單位四元數通常表示旋轉,其形式為
\[q = [\cos\psi, u_x\sin\psi,u_y\sin\psi, u_z\sin\psi].\]
要建立一個表示繞軸 \(\boldsymbol{u}\) 旋轉 \(\theta\) 角度的四元數,您可以使用:
您可以簡單地使用四個相同型別的數字來建立一個四元數:
或者使用 Vec4d 或 Vec4f 向量。
如果您已經有一個 3x3 旋轉矩陣 R,則可以使用:
如果您已經有一個旋轉向量 rvec,其形式為 angle * axis,則可以使用:
要從四元數中提取旋轉矩陣,請參閱 toRotMat3x3()
要提取 Vec4d 或 Vec4f,請參閱 toVec()
要提取旋轉向量,請參閱 toRotVec()
如果需要插值兩個四元數 \(q_0, q_1\),您可以使用 nlerp()、slerp() 或 spline()
樣條曲線可以平滑地連線多個四元數的旋轉
獲取四元數元素的三種方式
| cv::Quat< _Tp >::Quat | ( | 包裝自定義型別的輔助函式。 | w, |
| 包裝自定義型別的輔助函式。 | x, | ||
| 包裝自定義型別的輔助函式。 | y, | ||
| 包裝自定義型別的輔助函式。 | z ) |
從四個數字建立。
返回此四元數的反餘弦值,反餘弦可以計算為
\[\arccos(q) = -\frac{\boldsymbol{v}}{||\boldsymbol{v}||}arccosh(q)\]
其中 \(\boldsymbol{v} = [x, y, z].\)
例如
返回此四元數的反正弦值,反正弦可以計算為
\[\arcsin(q) = -\frac{\boldsymbol{v}}{||\boldsymbol{v}||}arcsinh(q\frac{\boldsymbol{v}}{||\boldsymbol{v}||})\]
其中 \(\boldsymbol{v} = [x, y, z].\)
例如
| void cv::Quat< _Tp >::assertNormal | ( | 包裝自定義型別的輔助函式。 | eps = CV_QUAT_EPS | ) | const |
獲取元素的方法。
| index | 在 [0, 3] 範圍內。 |
一個四元數 q
q.at(0) 等同於 q.w,
q.at(1) 等同於 q.x,
q.at(2) 等同於 q.y,
q.at(3) 等同於 q.z。
返回此四元數的反正切值,反正切可以計算為
\[\arctan(q) = -\frac{\boldsymbol{v}}{||\boldsymbol{v}||}arctanh(q\frac{\boldsymbol{v}}{||\boldsymbol{v}||})\]
其中 \(\boldsymbol{v} = [x, y, z].\)
例如
返回此四元數的反雙曲正切值,反雙曲正切可以計算為
\[arcsinh(q) = \frac{\ln(q + 1) - \ln(1 - q)}{2}\]
.
例如
返回此四元數的共軛。
\[q.conjugate() = (w, -x, -y, -z).\]
返回此四元數的餘弦值,餘弦可以計算為
\[\cos(p) = \cos(w) * \cosh(||\boldsymbol{v}||) - \sin(w)\frac{\boldsymbol{v}}{||\boldsymbol{v}||}\sinh(||\boldsymbol{v}||)\]
其中 \(\boldsymbol{v} = [x, y, z].\)
例如
返回此四元數的雙曲餘弦值,雙曲餘弦可以計算為
\[\cosh(p) = \cosh(w) * \cos(||\boldsymbol{v}||) + \sinh(w)\frac{\boldsymbol{v}}{||\boldsymbol{v}||}sin(||\boldsymbol{v}||)\]
其中 \(\boldsymbol{v} = [x, y, z].\)
例如
|
static |
從角度、軸建立。軸在此函式中將被歸一化。並且它生成
\[q = [\cos\psi, u_x\sin\psi,u_y\sin\psi, u_z\sin\psi].\]
其中 \(\psi = \frac{\theta}{2}\),\(\theta\) 是旋轉角度。
|
static |
從尤拉角建立
四元數可以透過組合尤拉旋轉的四元數表示從尤拉角生成。
例如,如果我們按 X-Y-Z 的順序使用內旋,\(\theta_1 \) 是繞 X 軸的旋轉,\(\theta_2 \) 是繞 Y 軸的旋轉,\(\theta_3 \) 是繞 Z 軸的旋轉。最終的四元數 q 可以透過以下方式計算:
\[ {q} = q_{X, \theta_1} q_{Y, \theta_2} q_{Z, \theta_3}\]
其中 \( q_{X, \theta_1} \) 由 createFromXRot 建立,\( q_{Y, \theta_2} \) 由 createFromYRot 建立,\( q_{Z, \theta_3} \) 由 createFromZRot 建立。
| angles | 長度為 3 的尤拉角向量 |
| 尤拉角型別 | 轉換的尤拉角型別 |
從 3x3 旋轉矩陣建立。
|
static |
從旋轉向量 \(r\) 建立,其形式為 \(\theta \cdot \boldsymbol{u}\),其中 \(\theta\) 表示旋轉角度,\(\boldsymbol{u}\) 表示歸一化旋轉軸。
角度和軸可以很容易地推導為:
\[ \begin{equation} \begin{split} \psi &= ||r||\\ \boldsymbol{u} &= \frac{r}{\theta} \end{split} \end{equation} \]
然後四元數可以計算為
\[q = [\cos\psi, \boldsymbol{u}\sin\psi]\]
其中 \(\psi = \theta / 2 \)
|
static |
透過繞 X 軸旋轉 \(\theta\) 獲取一個四元數。
\[q = \cos(\theta/2)+sin(\theta/2) i +0 j +0 k \]
|
static |
透過繞 Y 軸旋轉 \(\theta\) 獲取一個四元數。
\[q = \cos(\theta/2)+0 i+ sin(\theta/2) j +0k \]
|
static |
透過繞 Z 軸旋轉 \(\theta\) 獲取一個四元數。
\[q = \cos(\theta/2)+0 i +0 j +sin(\theta/2) k \]
返回 \(p = (a, b, c, d) = (a, \boldsymbol{u})\) 和 \(q = (w, x, y, z) = (w, \boldsymbol{v})\) 之間的叉積。
\[p \times q = \frac{pq- qp}{2}.\]
\[p \times q = \boldsymbol{u} \times \boldsymbol{v}.\]
\[p \times q = (cz-dy)i + (dx-bz)j + (by-xc)k. \]
例如
返回四元數 \(q\) 與此四元數之間的點積。
dot(p, q) 是衡量四元數接近程度的一個很好的指標。實際上,考慮單位四元數差 \(p^{-1} * q\),其實部是 dot(p, q)。同時,其實部等於 \(\cos(\beta/2)\),其中 \(\beta\) 是 p 和 q 之間的旋轉角度。因此,dot(p, q) 越接近 1,它們之間的旋轉就越小。
\[p \cdot q = p.w \cdot q.w + p.x \cdot q.x + p.y \cdot q.y + p.z \cdot q.z\]
| q | 另一個四元數。 |
例如
| _Tp cv::Quat< _Tp >::getAngle | ( | QuatAssumeType | assumeUnit = QUAT_ASSUME_NOT_UNIT | ) | const |
獲取四元數的角度,它返回旋轉角度。
| assumeUnit | 如果 QUAT_ASSUME_UNIT 為真,則假定此四元數為單位四元數,此函式將節省一些計算。 \[\psi = 2 *arccos(\frac{w}{||q||})\] |
例如
| Vec< _Tp, 3 > cv::Quat< _Tp >::getAxis | ( | QuatAssumeType | assumeUnit = QUAT_ASSUME_NOT_UNIT | ) | const |
獲取四元數的軸,它返回一個長度為3的向量。
| assumeUnit | 如果 QUAT_ASSUME_UNIT 為真,則假定此四元數為單位四元數,此函式將節省一些計算。 |
單位軸 \(\boldsymbol{u}\) 定義為
\[\begin{equation} \begin{split} \boldsymbol{v} &= \boldsymbol{u} ||\boldsymbol{v}||\\ &= \boldsymbol{u}||q||sin(\frac{\theta}{2}) \end{split} \end{equation}\]
其中 \(v=[x, y ,z]\) 且 \(\theta\) 表示旋轉角度。
例如
|
static |
這是 squad 的部分計算。用於計算每三個四元數之間的中間四元數 \(s_i\)。
\[s_i = q_i\exp(-\frac{\log(q^*_iq_{i+1}) + \log(q^*_iq_{i-1})}{4}).\]
| q0 | 第一個四元數。 |
| q1 | 第二個四元數。 |
| q2 | 第三個四元數。 |
| assumeUnit | 如果 QUAT_ASSUME_UNIT 為真,則假定所有輸入四元數為單位四元數。否則,所有輸入四元數將在函式內部歸一化。 |
| Quat< _Tp > cv::Quat< _Tp >::inv | ( | QuatAssumeType | assumeUnit = QUAT_ASSUME_NOT_UNIT | ) | const |
返回 \(q^{-1}\),它是 \(q\) 的逆,滿足 \(q * q^{-1} = 1\)。
| assumeUnit | 如果 QUAT_ASSUME_UNIT 為真,則假定四元數 q 為單位四元數,此函式將節省一些計算。 |
例如
| bool cv::Quat< _Tp >::isNormal | ( | 包裝自定義型別的輔助函式。 | eps = CV_QUAT_EPS | ) | const |
如果此四元數是單位四元數,則返回 true。
| eps | 歸一化的容差範圍。eps 可以定義為 |
\[eps = |1 - dotValue|\]
其中
\[dotValue = (this.w^2 + this.x^2 + this,y^2 + this.z^2).\]
當 dotValue 在 \([1-eps, 1+eps]\) 範圍內時,此函式將認為它已歸一化。
|
static |
透過線性插值(Lerp)計算從 \(q_0\) 到 \(q_1\) 的插值。對於兩個四元數,此插值曲線可以顯示為
\[Lerp(q_0, q_1, t) = (1 - t)q_0 + tq_1.\]
顯然,如果我們將 \(q_0\) 和 \(q_1\) 視為二維空間中的向量,lerp 將沿直線插值。當 \(t = 0\) 時,它返回 \(q_0\);當 \(t= 1\) 時,它返回 \(q_1\)。\(t\) 通常應在 \([0, 1]\) 範圍內。
| q0 | 用於線性插值的四元數。 |
| q1 | 用於線性插值的四元數。 |
| t | 向量 \(\overrightarrow{q_0q_1}\) 的百分比,範圍在 [0, 1] 內。 |
| Quat< _Tp > cv::Quat< _Tp >::log | ( | QuatAssumeType | assumeUnit = QUAT_ASSUME_NOT_UNIT | ) | const |
返回對數函式的值。
\[\ln(q) = \ln||q|| + \frac{\boldsymbol{v}}{||\boldsymbol{v}||}\arccos\frac{w}{||q||}\]
。其中 \(\boldsymbol{v} = [x, y, z].\)
| assumeUnit | 如果 QUAT_ASSUME_UNIT 為真,則假定此四元數為單位四元數,此函式將節省一些計算。 |
例如
|
static |
透過歸一化線性插值(Nlerp)計算從 \(q_0\) 到 \(q_1\) 的插值。它返回線性插值(Lerp)的歸一化四元數。
\[ Nlerp(q_0, q_1, t) = \frac{(1 - t)q_0 + tq_1}{||(1 - t)q_0 + tq_1||}.\]
插值將始終選擇最短路徑,但不能保證恆定速度。
| q0 | 用於歸一化線性插值的四元數。 |
| q1 | 用於歸一化線性插值的四元數。 |
| t | 向量 \(\overrightarrow{q_0q_1}\) 的百分比,範圍在 [0, 1] 內。 |
| assumeUnit | 如果 QUAT_ASSUME_UNIT 為真,則假定所有輸入四元數為單位四元數。否則,所有輸入四元數將在函式內部歸一化。 |
返回四元數的範數。
\[||q|| = \sqrt{w^2 + x^2 + y^2 + z^2}.\]
返回歸一化的 \(p\)。
\[p = \frac{q}{||q||}\]
其中 \(p\) 滿足 \((p.x)^2 + (p.y)^2 + (p.z)^2 + (p.w)^2 = 1.\)
兩個四元數 q 和 p 的乘法運算子。將運算子兩側的值相乘。
四元數乘法規則
\[ \begin{equation} \begin{split} p * q &= [p_0, \boldsymbol{u}]*[q_0, \boldsymbol{v}]\\ &=[p_0q_0 - \boldsymbol{u}\cdot \boldsymbol{v}, p_0\boldsymbol{v} + q_0\boldsymbol{u}+ \boldsymbol{u}\times \boldsymbol{v}]. \end{split} \end{equation} \]
其中 \(\cdot\) 表示點積,\(\times \) 表示叉積。
例如
四元數與標量的乘法賦值運算子。它將右運算元與左運算元相乘並將結果賦給左運算元。
四元數與標量相乘的規則
\[ \begin{equation} \begin{split} p * s &= [w, x, y, z] * s\\ &=[w * s, x * s, y * s, z * s]. \end{split} \end{equation} \]
例如
兩個四元數 q 和 p 的乘法賦值運算子。它將右運算元與左運算元相乘並將結果賦給左運算元。
四元數乘法規則
\[ \begin{equation} \begin{split} p * q &= [p_0, \boldsymbol{u}]*[q_0, \boldsymbol{v}]\\ &=[p_0q_0 - \boldsymbol{u}\cdot \boldsymbol{v}, p_0\boldsymbol{v} + q_0\boldsymbol{u}+ \boldsymbol{u}\times \boldsymbol{v}]. \end{split} \end{equation} \]
其中 \(\cdot\) 表示點積,\(\times \) 表示叉積。
例如
返回相反四元數 \(-p\),滿足 \(p + (-p) = 0.\)。
例如
四元數與標量的除法運算子。它將左運算元除以右運算元並將結果賦給左運算元。
四元數與標量相除的規則
\[ \begin{equation} \begin{split} p / s &= [w, x, y, z] / s\\ &=[w/s, x/s, y/s, z/s]. \end{split} \end{equation} \]
例如
四元數與標量的除法賦值運算子。它將左運算元除以右運算元並將結果賦給左運算元。
四元數與標量相除的規則
\[ \begin{equation} \begin{split} p / s &= [w, x, y, z] / s\\ &=[w / s, x / s, y / s, z / s]. \end{split} \end{equation} \]
例如
如果兩個四元數 p 和 q 幾乎相等,即當每個 \(p_i\) 和 \(q_i\) 的絕對值小於 CV_QUAT_EPS 時,則返回 true。
| Quat< _Tp > cv::Quat< _Tp >::power | ( | const _Tp | x, |
| QuatAssumeType | assumeUnit = QUAT_ASSUME_NOT_UNIT ) const |
返回指數為 \(x\) 的冪函式值。
\[q^x = ||q||(\cos(x\theta) + \boldsymbol{u}\sin(x\theta))).\]
| x | 指數。 |
| assumeUnit | 如果 QUAT_ASSUME_UNIT 為真,則假定此四元數為單位四元數,此函式將節省一些計算。 |
例如
| Quat< _Tp > cv::Quat< _Tp >::power | ( | const Quat< _Tp > & | q, |
| QuatAssumeType | assumeUnit = QUAT_ASSUME_NOT_UNIT ) const |
返回以四元數 \(q\) 為指數的冪函式值。
\[p^q = e^{q\ln(p)}.\]
| q | 冪函式的指數四元數。 |
| assumeUnit | 如果 QUAT_ASSUME_UNIT 為真,則假定此四元數為單位四元數,此函式將節省一些計算。 |
例如
返回此四元數的正弦值,正弦可以計算為
\[\sin(p) = \sin(w) * \cosh(||\boldsymbol{v}||) + \cos(w)\frac{\boldsymbol{v}}{||\boldsymbol{v}||}\sinh(||\boldsymbol{v}||)\]
其中 \(\boldsymbol{v} = [x, y, z].\)
例如
返回此四元數的雙曲正弦值,雙曲正弦可以計算為:\(\sinh(p) = \sin(w)\cos(||\boldsymbol{v}||) + \cosh(w)\frac{v}{||\boldsymbol{v}||}\sin||\boldsymbol{v}||\),其中 \(\boldsymbol{v} = [x, y, z].\)
例如
|
static |
透過球面線性插值(Slerp)計算 \(q_0\) 和 \(q_1\) 之間的插值,Slerp 可以定義為
\[ Slerp(q_0, q_1, t) = \frac{\sin((1-t)\theta)}{\sin(\theta)}q_0 + \frac{\sin(t\theta)}{\sin(\theta)}q_1\]
其中 \(\theta\) 可以計算為
\[\theta=cos^{-1}(q_0\cdot q_1)\]
因為它們的範數都是單位。
| q0 | 用於球面線性插值的四元數。 |
| q1 | 用於球面線性插值的四元數。 |
| t | 在 [0, 1] 範圍內,\(q_0\) 和 \(q_1\) 之間角度的百分比。 |
| assumeUnit | 如果 QUAT_ASSUME_UNIT 為真,則假定所有輸入四元數為單位四元數。否則,所有輸入四元數將在函式內部歸一化。 |
| directChange | 如果 QUAT_ASSUME_UNIT 為真,則插值將選擇最近的路徑。 |
|
static |
計算透過 squad 構造的 \(C^1\) 連續樣條曲線在比率 t 處的四元數結果。這裡,插值在 \(q_1\) 和 \(q_2\) 之間。\(q_0\) 和 \(q_2\) 用於確保 \(C^1\) 連續性。如果 t = 0,它返回 \(q_1\);如果 t = 1,它返回 \(q_2\)。
| q0 | 第一個輸入四元數,用於確保 \(C^1\) 連續性。 |
| q1 | 第二個輸入四元數。 |
| q2 | 第三個輸入四元數。 |
| q3 | 第四個輸入四元數,與 \(q1\) 的用法相同。 |
| t | 在 [0, 1] 範圍內的比率。 |
| assumeUnit | 如果 QUAT_ASSUME_UNIT 為真,則假定 \(q_0, q_1, q_2, q_3\) 為單位四元數。否則,所有輸入四元數將在函式內部歸一化。 |
例如
如果存在三個雙精度四元數 \(v_0, v_1, v_2\) 等待插值。
使用比率 \(t_0\) 在 \(v_0\) 和 \(v_1\) 之間進行插值可以計算為:
使用比率 \(t_0\) 在 \(v_1\) 和 \(v_2\) 之間進行插值可以計算為:
| Quat< _Tp > cv::Quat< _Tp >::sqrt | ( | QuatAssumeType | assumeUnit = QUAT_ASSUME_NOT_UNIT | ) | const |
返回 \(\sqrt{q}\)。
| assumeUnit | 如果 QUAT_ASSUME_UNIT 為真,則假定此四元數為單位四元數,此函式將節省一些計算。 |
例如
|
static |
透過球面和四邊形(Squad)計算 \(q_0\), \(q_1\), \(q_2\), \(q_3\) 之間的插值。這可以定義為
\[Squad(q_i, s_i, s_{i+1}, q_{i+1}, t) = Slerp(Slerp(q_i, q_{i+1}, t), Slerp(s_i, s_{i+1}, t), 2t(1-t))\]
其中
\[s_i = q_i\exp(-\frac{\log(q^*_iq_{i+1}) + \log(q^*_iq_{i-1})}{4})\]
Squad 表示式類似於 \(B\acute{e}zier\) 曲線,但涉及球面線性插值而非簡單線性插值。每個 \(s_i\) 需要由三個四元數計算。
| q0 | 第一個四元數。 |
| s0 | 第二個四元數。 |
| s1 | 第三個四元數。 |
| q1 | 第四個四元數。 |
| t | 二次和線性插值的插值引數,範圍在 \([0, 1]\) 內。 |
| assumeUnit | 如果 QUAT_ASSUME_UNIT 為真,則假定所有輸入四元數為單位四元數。否則,所有輸入四元數將在函式內部歸一化。 |
| directChange | 如果 QUAT_ASSUME_UNIT 為真,squad 將找到最近的路徑進行插值。 |
| Vec< _Tp, 3 > cv::Quat< _Tp >::toEulerAngles | ( | QuatEnum::EulerAnglesType | 尤拉角型別 | ) |
將四元數 q 轉換為尤拉角。
將四元數 \(q = w + x\boldsymbol{i} + y\boldsymbol{j} + z\boldsymbol{k}\) 轉換為尤拉角時,旋轉矩陣 M 可以透過以下方式計算:
\[ \begin{aligned} {M} &={\begin{bmatrix}1-2(y^{2}+z^{2})&2(xy-zx)&2(xz+yw)\\2(xy+zw)&1-2(x^{2}+z^{2})&2(yz-xw)\\2(xz-yw)&2(yz+xw)&1-2(x^{2}+y^{2})\end{bmatrix}}\end{aligned}.\]
另一方面,旋轉矩陣可以從尤拉角獲得。以尤拉角型別 XYZ 的內旋為例,\(\theta_1 \)、\(\theta_2 \)、\(\theta_3 \) 是尤拉角的三個角度,旋轉矩陣 R 可以透過以下方式計算:
\[R =X(\theta_1)Y(\theta_2)Z(\theta_3) ={\begin{bmatrix}\cos\theta_{2}\cos\theta_{3}&-\cos\theta_{2}\sin\theta_{3}&\sin\theta_{2}\\\cos\theta_{1}\sin\theta_{3}+\cos\theta_{3}\sin\theta_{1}\sin\theta_{2}&\cos\theta_{1}\cos\theta_{3}-\sin\theta_{1}\sin\theta_{2}\sin\theta_{3}&-\cos\theta_{2}\sin\theta_{1}\\\sin\theta_{1}\sin\theta_{3}-\cos\theta_{1}\cos\theta_{3}\sin\theta_{2}&\cos\theta_{3}\sin\theta_{1}+\cos\theta_{1}\sin\theta_{2}\sin\theta_{3}&\cos\theta_{1}\cos_{2}\end{bmatrix}}\]
旋轉矩陣 M 和 R 相等。只要 \( s_{2} \neq 1 \),透過比較兩個矩陣的每個元素,解為 \(\begin{cases} \theta_1 = \arctan2(-m_{23},m_{33})\\\theta_2 = arcsin(m_{13}) \\\theta_3 = \arctan2(-m_{12},m_{11}) \end{cases}\)。
當 \( s_{2}=1\) 或 \( s_{2}=-1\) 時,會發生萬向節死鎖。函式將提示“WARNING: Gimbal Lock will occur. Euler angles is non-unique. For intrinsic rotations, we set the third angle to 0, and for external rotation, we set the first angle to 0.”。
當 \( s_{2}=1\) 時,旋轉矩陣 R 是 \(R = {\begin{bmatrix}0&0&1\\\sin(\theta_1+\theta_3)&\cos(\theta_1+\theta_3)&0\\-\cos(\theta_1+\theta_3)&\sin(\theta_1+\theta_3)&0\end{bmatrix}}\)。
在條件 \(\begin{cases} \theta_1+\theta_3 = \arctan2(m_{21},m_{22})\\ \theta_2=\pi/2 \end{cases}\ \) 下,解的數量是無限的。
我們設定 \( \theta_3 = 0\),解為 \(\begin{cases} \theta_1=\arctan2(m_{21},m_{22})\\ \theta_2=\pi/2\\ \theta_3=0 \end{cases}\)。
當 \( s_{2}=-1\) 時,旋轉矩陣 R 是 \(X_{1}Y_{2}Z_{3}={\begin{bmatrix}0&0&-1\\-\sin(\theta_1-\theta_3)&\cos(\theta_1-\theta_3)&0\\\cos(\theta_1-\theta_3)&\sin(\theta_1-\theta_3)&0\end{bmatrix}}\)。
在條件 \(\begin{cases} \theta_1+\theta_3 = \arctan2(m_{32},m_{22})\\ \theta_2=\pi/2 \end{cases}\ \) 下,解的數量是無限的。
我們設定 \( \theta_3 = 0\),解為 \( \begin{cases}\theta_1=\arctan2(m_{32},m_{22}) \\ \theta_2=-\pi/2\\ \theta_3=0\end{cases}\)。
由於 \( sin \theta\in [-1,1] \) 和 \( cos \theta \in [-1,1] \),未歸一化的四元數會導致計算問題。因此,此函式會首先歸一化四元數,且不需要 QuatAssumeType。
當發生萬向節死鎖時,對於內旋,我們將 \(\theta_3 = 0\);對於外旋,我們將 \(\theta_1 = 0\)。
因此,對於每種尤拉角型別,我們都可以得到如下表所示的解。
| EulerAnglesType(尤拉角型別) | 普通情況 | \(\theta_2 = π/2\) | \(\theta_2 = -π/2\) |
|---|---|---|---|
| INT_XYZ | \( \theta_1 = \arctan2(-m_{23},m_{33})\\\theta_2 = \arcsin(m_{13}) \\\theta_3= \arctan2(-m_{12},m_{11}) \) | \( \theta_1=\arctan2(m_{21},m_{22})\\ \theta_2=\pi/2\\ \theta_3=0 \) | \( \theta_1=\arctan2(m_{32},m_{22})\\ \theta_2=-\pi/2\\ \theta_3=0 \) |
| INT_XZY | \( \theta_1 = \arctan2(m_{32},m_{22})\\\theta_2 = -\arcsin(m_{12}) \\\theta_3= \arctan2(m_{13},m_{11}) \) | \( \theta_1=\arctan2(m_{31},m_{33})\\ \theta_2=\pi/2\\ \theta_3=0 \) | \( \theta_1=\arctan2(-m_{23},m_{33})\\ \theta_2=-\pi/2\\ \theta_3=0 \) |
| INT_YXZ | \( \theta_1 = \arctan2(m_{13},m_{33})\\\theta_2 = -\arcsin(m_{23}) \\\theta_3= \arctan2(m_{21},m_{22}) \) | \( \theta_1=\arctan2(m_{12},m_{11})\\ \theta_2=\pi/2\\ \theta_3=0 \) | \( \theta_1=\arctan2(-m_{12},m_{11})\\ \theta_2=-\pi/2\\ \theta_3=0 \) |
| INT_YZX | \( \theta_1 = \arctan2(-m_{31},m_{11})\\\theta_2 = \arcsin(m_{21}) \\\theta_3= \arctan2(-m_{23},m_{22}) \) | \( \theta_1=\arctan2(m_{13},m_{33})\\ \theta_2=\pi/2\\ \theta_3=0 \) | \( \theta_1=\arctan2(m_{13},m_{12})\\ \theta_2=-\pi/2\\ \theta_3=0 \) |
| INT_ZXY | \( \theta_1 = \arctan2(-m_{12},m_{22})\\\theta_2 = \arcsin(m_{32}) \\\theta_3= \arctan2(-m_{31},m_{33}) \) | \( \theta_1=\arctan2(m_{21},m_{11})\\ \theta_2=\pi/2\\ \theta_3=0 \) | \( \theta_1=\arctan2(m_{21},m_{11})\\ \theta_2=-\pi/2\\ \theta_3=0 \) |
| INT_ZYX | \( \theta_1 = \arctan2(m_{21},m_{11})\\\theta_2 = \arcsin(-m_{31}) \\\theta_3= \arctan2(m_{32},m_{33}) \) | \( \theta_1=\arctan2(m_{23},m_{22})\\ \theta_2=\pi/2\\ \theta_3=0 \) | \( \theta_1=\arctan2(-m_{12},m_{22})\\ \theta_2=-\pi/2\\ \theta_3=0 \) |
| EXT_XYZ | \( \theta_1 = \arctan2(m_{32},m_{33})\\\theta_2 = \arcsin(-m_{31}) \\\ \theta_3 = \arctan2(m_{21},m_{11})\) | \( \theta_1= 0\\ \theta_2=\pi/2\\ \theta_3=\arctan2(m_{23},m_{22}) \) | \( \theta_1=0\\ \theta_2=-\pi/2\\ \theta_3=\arctan2(-m_{12},m_{22}) \) |
| EXT_XZY | \( \theta_1 = \arctan2(-m_{23},m_{22})\\\theta_2 = \arcsin(m_{21}) \\\theta_3= \arctan2(-m_{31},m_{11})\) | \( \theta_1= 0\\ \theta_2=\pi/2\\ \theta_3=\arctan2(m_{13},m_{33}) \) | \( \theta_1=0\\ \theta_2=-\pi/2\\ \theta_3=\arctan2(m_{13},m_{12}) \) |
| EXT_YXZ | \( \theta_1 = \arctan2(-m_{31},m_{33}) \\\theta_2 = \arcsin(m_{32}) \\\theta_3= \arctan2(-m_{12},m_{22})\) | \( \theta_1= 0\\ \theta_2=\pi/2\\ \theta_3=\arctan2(m_{21},m_{11}) \) | \( \theta_1=0\\ \theta_2=-\pi/2\\ \theta_3=\arctan2(m_{21},m_{11}) \) |
| EXT_YZX | \( \theta_1 = \arctan2(m_{13},m_{11})\\\theta_2 = -\arcsin(m_{12}) \\\theta_3= \arctan2(m_{32},m_{22})\) | \( \theta_1= 0\\ \theta_2=\pi/2\\ \theta_3=\arctan2(m_{31},m_{33}) \) | \( \theta_1=0\\ \theta_2=-\pi/2\\ \theta_3=\arctan2(-m_{23},m_{33}) \) |
| EXT_ZXY | \( \theta_1 = \arctan2(m_{21},m_{22})\\\theta_2 = -\arcsin(m_{23}) \\\theta_3= \arctan2(m_{13},m_{33})\) | \( \theta_1= 0\\ \theta_2=\pi/2\\ \theta_3=\arctan2(m_{12},m_{11}) \) | \( \theta_1= 0\\ \theta_2=-\pi/2\\ \theta_3=\arctan2(-m_{12},m_{11}) \) |
| EXT_ZYX | \( \theta_1 = \arctan2(-m_{12},m_{11})\\\theta_2 = \arcsin(m_{13}) \\\theta_3= \arctan2(-m_{23},m_{33})\) | \( \theta_1=0\\ \theta_2=\pi/2\\ \theta_3=\arctan2(m_{21},m_{22}) \) | \( \theta_1=0\\ \theta_2=-\pi/2\\ \theta_3=\arctan2(m_{32},m_{22}) \) |
| EulerAnglesType(尤拉角型別) | 普通情況 | \(\theta_2 = 0\) | \(\theta_2 = π\) |
|---|---|---|---|
| INT_XYX | \( \theta_1 = \arctan2(m_{21},-m_{31})\\\theta_2 =\arccos(m_{11}) \\\theta_3 = \arctan2(m_{12},m_{13}) \) | \( \theta_1=\arctan2(m_{32},m_{33})\\ \theta_2=0\\ \theta_3=0 \) | \( \theta_1=\arctan2(m_{23},m_{22})\\ \theta_2=\pi\\ \theta_3=0 \) |
| INT_XZX | \( \theta_1 = \arctan2(m_{31},m_{21})\\\theta_2 = \arccos(m_{11}) \\\theta_3 = \arctan2(m_{13},-m_{12}) \) | \( \theta_1=\arctan2(m_{32},m_{33})\\ \theta_2=0\\ \theta_3=0 \) | \( \theta_1=\arctan2(-m_{32},m_{33})\\ \theta_2=\pi\\ \theta_3=0 \) |
| INT_YXY | \( \theta_1 = \arctan2(m_{12},m_{32})\\\theta_2 = \arccos(m_{22}) \\\theta_3 = \arctan2(m_{21},-m_{23}) \) | \( \theta_1=\arctan2(m_{13},m_{11})\\ \theta_2=0\\ \theta_3=0 \) | \( \theta_1=\arctan2(-m_{31},m_{11})\\ \theta_2=\pi\\ \theta_3=0 \) |
| INT_YZY | \( \theta_1 = \arctan2(m_{32},-m_{12})\\\theta_2 = \arccos(m_{22}) \\\theta_3 =\arctan2(m_{23},m_{21}) \) | \( \theta_1=\arctan2(m_{13},m_{11})\\ \theta_2=0\\ \theta_3=0 \) | \( \theta_1=\arctan2(m_{13},-m_{11})\\ \theta_2=\pi\\ \theta_3=0 \) |
| INT_ZXZ | \( \theta_1 = \arctan2(-m_{13},m_{23})\\\theta_2 = \arccos(m_{33}) \\\theta_3 =\arctan2(m_{31},m_{32}) \) | \( \theta_1=\arctan2(m_{21},m_{22})\\ \theta_2=0\\ \theta_3=0 \) | \( \theta_1=\arctan2(m_{21},m_{11})\\ \theta_2=\pi\\ \theta_3=0 \) |
| INT_ZYZ | \( \theta_1 = \arctan2(m_{23},m_{13})\\\theta_2 = \arccos(m_{33}) \\\theta_3 = \arctan2(m_{32},-m_{31}) \) | \( \theta_1=\arctan2(m_{21},m_{11})\\ \theta_2=0\\ \theta_3=0 \) | \( \theta_1=\arctan2(m_{21},m_{11})\\ \theta_2=\pi\\ \theta_3=0 \) |
| EXT_XYX | \( \theta_1 = \arctan2(m_{12},m_{13}) \\\theta_2 = \arccos(m_{11}) \\\theta_3 = \arctan2(m_{21},-m_{31})\) | \( \theta_1=0\\ \theta_2=0\\ \theta_3=\arctan2(m_{32},m_{33}) \) | \( \theta_1= 0\\ \theta_2=\pi\\ \theta_3= \arctan2(m_{23},m_{22}) \) |
| EXT_XZX | \( \theta_1 = \arctan2(m_{13},-m_{12})\\\theta_2 = \arccos(m_{11}) \\\theta_3 = \arctan2(m_{31},m_{21})\) | \( \theta_1= 0\\ \theta_2=0\\ \theta_3=\arctan2(m_{32},m_{33}) \) | \( \theta_1= 0\\ \theta_2=\pi\\ \theta_3=\arctan2(-m_{32},m_{33}) \) |
| EXT_YXY | \( \theta_1 = \arctan2(m_{21},-m_{23})\\\theta_2 = \arccos(m_{22}) \\\theta_3 = \arctan2(m_{12},m_{32}) \) | \( \theta_1= 0\\ \theta_2=0\\ \theta_3=\arctan2(m_{13},m_{11}) \) | \( \theta_1= 0\\ \theta_2=\pi\\ \theta_3=\arctan2(-m_{31},m_{11}) \) |
| EXT_YZY | \( \theta_1 = \arctan2(m_{23},m_{21}) \\\theta_2 = \arccos(m_{22}) \\\theta_3 = \arctan2(m_{32},-m_{12}) \) | \( \theta_1= 0\\ \theta_2=0\\ \theta_3=\arctan2(m_{13},m_{11}) \) | \( \theta_1=0\\ \theta_2=\pi\\ \theta_3=\arctan2(m_{13},-m_{11}) \) |
| EXT_ZXZ | \( \theta_1 = \arctan2(m_{31},m_{32}) \\\theta_2 = \arccos(m_{33}) \\\theta_3 = \arctan2(-m_{13},m_{23})\) | \( \theta_1=0\\ \theta_2=0\\ \theta_3=\arctan2(m_{21},m_{22}) \) | \( \theta_1= 0\\ \theta_2=\pi\\ \theta_3=\arctan2(m_{21},m_{11}) \) |
| EXT_ZYZ | \( \theta_1 = \arctan2(m_{32},-m_{31})\\\theta_2 = \arccos(m_{33}) \\\theta_3 = \arctan2(m_{23},m_{13}) \) | \( \theta_1=0\\ \theta_2=0\\ \theta_3=\arctan2(m_{21},m_{11}) \) | \( \theta_1= 0\\ \theta_2=\pi\\ \theta_3=\arctan2(m_{21},m_{11}) \) |
| 尤拉角型別 | 轉換的尤拉角型別 |
| Matx< _Tp, 3, 3 > cv::Quat< _Tp >::toRotMat3x3 | ( | QuatAssumeType | assumeUnit = QUAT_ASSUME_NOT_UNIT | ) | const |
將四元數轉換為 3x3 旋轉矩陣。
| assumeUnit | 如果 QUAT_ASSUME_UNIT,則此四元數假定為單位四元數,此函式將節省一些計算。否則,此函式將首先歸一化此四元數,然後進行轉換。 |
\[\begin{bmatrix} x_0& x_1& x_2&...&x_n\\ y_0& y_1& y_2&...&y_n\\ z_0& z_1& z_2&...&z_n \end{bmatrix}\]
其中相同的下標代表一個點。A 的形狀假定為 [3, n]。點矩陣 A 可以透過 toRotMat3x3() * A 進行旋轉。結果也具有 3 行 n 列。例如
| Matx< _Tp, 4, 4 > cv::Quat< _Tp >::toRotMat4x4 | ( | QuatAssumeType | assumeUnit = QUAT_ASSUME_NOT_UNIT | ) | const |
將四元數轉換為 4x4 旋轉矩陣。
| assumeUnit | 如果 QUAT_ASSUME_UNIT,則此四元數假定為單位四元數,此函式將節省一些計算。否則,此函式將首先歸一化此四元數,然後進行轉換。 |
操作與 toRotMat3x3 類似,不同之處在於點矩陣應具有以下形式
\[\begin{bmatrix} x_0& x_1& x_2&...&x_n\\ y_0& y_1& y_2&...&y_n\\ z_0& z_1& z_2&...&z_n\\ 0&0&0&...&0 \end{bmatrix}\]
| Vec< _Tp, 3 > cv::Quat< _Tp >::toRotVec | ( | QuatAssumeType | assumeUnit = QUAT_ASSUME_NOT_UNIT | ) | const |
將此四元數轉換為旋轉向量。
| assumeUnit | 如果 QUAT_ASSUME_UNIT,則此四元數假定為單位四元數,此函式將節省一些計算。旋轉向量 rVec 定義為 \[ rVec = [\theta v_x, \theta v_y, \theta v_z]\] 其中 \(\theta\) 表示旋轉角度,\(\boldsymbol{v}\) 表示歸一化的旋轉軸。 |
例如
返回四元數 q 的餘弦值,餘弦可以計算為
\[\cos(p) = \cos(w) * \cosh(||\boldsymbol{v}||) - \sin(w)\frac{\boldsymbol{v}}{||\boldsymbol{v}||}\sinh(||\boldsymbol{v}||)\]
其中 \(\boldsymbol{v} = [x, y, z].\)
| q | 一個四元數。 |
例如
|
friend |
返回 \(p = (a, b, c, d) = (a, \boldsymbol{u})\) 和 \(q = (w, x, y, z) = (w, \boldsymbol{v})\) 之間的叉積。
\[p \times q = \frac{pq- qp}{2}\]
\[p \times q = \boldsymbol{u} \times \boldsymbol{v}\]
\[p \times q = (cz-dy)i + (dx-bz)j + (by-xc)k \]
例如
|
friend |
四元數與標量的乘法運算子。它將右運算元與左運算元相乘並將結果賦給左運算元。
四元數與標量相乘的規則
\[ \begin{equation} \begin{split} p * s &= [w, x, y, z] * s\\ &=[w * s, x * s, y * s, z * s]. \end{split} \end{equation} \]
例如
|
friend |
標量與四元數的乘法運算子。它將右運算元與左運算元相乘並將結果賦給左運算元。
四元數與標量相乘的規則
\[ \begin{equation} \begin{split} p * s &= [w, x, y, z] * s\\ &=[w * s, x * s, y * s, z * s]. \end{split} \end{equation} \]
例如
|
friend |
四元數與標量的加法運算子。將右運算元加到左運算元上。
例如
|
friend |
四元數與標量的加法運算子。將右運算元加到左運算元上。
例如
|
friend |
四元數與標量的減法運算子。將右運算元從左運算元中減去。
例如
|
friend |
標量與四元數的減法運算子。將右運算元從左運算元中減去。
例如
|
friend |
|
friend |
返回 \(q^{-1}\),它是 \(q\) 的逆,滿足 \(q * q^{-1} = 1\)。
| q | 一個四元數。 |
| assumeUnit | 如果 QUAT_ASSUME_UNIT 為真,則假定四元數 q 為單位四元數,此函式將節省一些計算。 |
例如
|
friend |
|
friend |
返回以四元數 \(q\) 為指數的冪函式值。
\[p^q = e^{q\ln(p)}.\]
| p | 冪函式的基本四元數。 |
| q | 冪函式的指數四元數。 |
| assumeUnit | 如果 QUAT_ASSUME_UNIT,則四元數 \(p\) 假定為單位四元數,此函式將節省一些計算。 |
例如
|
friend |
返回指數為 \(x\) 的冪函式值。
\[q^x = ||q||(cos(x\theta) + \boldsymbol{u}sin(x\theta))).\]
| q | 一個四元數。 |
| x | 指數。 |
| assumeUnit | 如果 QUAT_ASSUME_UNIT 為真,則假定四元數 q 為單位四元數,此函式將節省一些計算。 |
例如
返回四元數 q 的正弦值,正弦可以計算為
\[\sin(p) = \sin(w) * \cosh(||\boldsymbol{v}||) + \cos(w)\frac{\boldsymbol{v}}{||\boldsymbol{v}||}\sinh(||\boldsymbol{v}||)\]
其中 \(\boldsymbol{v} = [x, y, z].\)
| q | 一個四元數。 |
例如
|
friend |
返回 \(\sqrt{q}\)。
| q | 一個四元數。 |
| assumeUnit | 如果 QUAT_ASSUME_UNIT 為真,則假定四元數 q 為單位四元數,此函式將節省一些計算。 |
例如
返回四元數 q 的正切值,正切可以計算為
\[\tan(q) = \frac{\sin(q)}{\cos(q)}.\]
| q | 一個四元數。 |
例如