ドローンの物理学
要約
この記事は、ドローンの物理学について解説しています。読者は入門レベルの線形代数、微積分、古典力学に精通していることが想定されています。ドローンの座標系、状態変数、作用する力とトルク、運動方程式、そしてモーターとプロペラがどのように推力とトルクを生成し、制御システムがプロペラ速度を決定するかについて説明しています。
全文翻訳
ドローンの物理学
[画像: 空力学的に驚異的な偉業を達成できる、親しみやすいドローン。]
A friendly drone capable of awesome feats of aerodynamics.
この記事はドローンの物理学について解説します。読者は、入門レベルの線形代数、入門レベルの微積分、および入門レベルの古典力学に精通していることを想定しています。この作業は、私の適応制御に関する研究と、ドローンのPythonシミュレーションフレームワークであるmultirotorに関するAIAA DASC 2023での発表から改変したものです。ここでの表記は、Charles Tytlerによる素晴らしい作品から多くを借用しています。
X、Reddit、HackerNewsで議論に参加しましょう。
よりインタラクティブな解説については、Poor Man’s Autograd および Surprise! A Derivation of Entropy を参照してください。
以下のトピックを順にカバーします:
- 車両を記述するために使用される座標系。
- 車両を記述するために使用される状態変数。
- 機体に作用する力とトルク。
- 運動方程式(線形および角運動)。
- モーターとプロペラがどのように力とトルクを生成するか。
- 制御システムがプロペラ速度をどのように決定するか。
車両の記述
多旋回UAVは、6自由度でモデル化されます。線形運動のための3つの線形軸:$x, y, z$、および回転運動のための3つの角軸:$\phi, \theta, \psi$です。座標を使用するには、座標系に合意する必要があります。通常、North-East-Down (NED) システムが使用されます。正のx軸の方向は「前方」/北向きと見なされます。正のy軸は「右」/東、正のz軸は「下」です。これは右手座標系です。親指の方向への軸周りの正の回転は、指を丸めた方向です。たとえば、正のz回転は+xから+yへ向かいます。
[画像]
機体の状態を表すために、2つの参照フレームが使用されます:
- 名目上の慣性参照フレーム $n$ は、軸が任意のグローバルな方向と整列している静的な参照フレームです。これらは列ベクトル $\hat{n} = [\hat{x}^n, \hat{y}^n, \hat{z}^n]^T$ で表されます。
- 機体固定の非慣性参照フレーム $b$ は、運動中の剛体の重心に対して軸が整列しています。これらは列ベクトル $\hat{b} = [\hat{x}^b, \hat{y}^b, \hat{z}^b]^T$ で表されます。機体フレームは、車両とともに移動および回転します。機体フレームの原点をドローンの重心に取り付けることを検討してください。
線形表現
機体固定参照フレーム $b$ は、車両の重心に固定されています。つまり、機体フレームからの車両の変位は常に0です。車両の位置は、機体フレームから慣性フレームへの変位 $\hat{r}^n$ で表されます。
車両の速度は、機体フレームから慣性フレームへの相対速度です。ここでは、速度を機体フレームの座標で表すことを選択します。
角表現
慣性参照フレームにおける機体の向きは、Tait-Bryan角の規約に従います。つまり、向きは3つの連続した回転で記述できます。ヨー($\psi$)、ピッチ($\theta$)、ロール($\phi$)です。この順序で。回転の順序は重要です。慣性フレーム $\hat{n}$ から開始して、ヨー $\psi$ は慣性z軸周りの機体フレームの回転 $R(\psi)$ です。このヨーが回転したフレーム $\hat{n}_\psi$ から開始して、ピッチ $\theta$ は新しいy軸周りの回転 $R(\theta)$ です。そして、このヨーとピッチが回転したフレーム $\hat{n}_{\psi,\theta}$ から開始して、ロール $\phi$ は最後の回転で、新しいx軸周りの回転 $R(\phi)$ です。最終的な積 $\hat{n}_{\psi,\theta,\phi}$ が機体参照フレームです。
[画像]
車両の角速度 $\hat{w}^T=[\omega_x,\omega_y,\omega_z]$ は、機体フレーム自体の周りの瞬間的な回転率です。一方、各向きの角度は、慣性軸から機体フレームへの順序付けられた回転(ヨー、次にピッチ、次にロール)中に、それぞれの参照フレーム($\hat{n}, \hat{n}_\psi, \hat{n}_{\psi,\theta}=\hat{b}$)で定義されます。
ロール回転は最後に行われ、結果が機体フレームになります。したがって、x軸周りのレートである $\omega_x$ はロールレート $\dot{\phi}$ に等しくなります。ピッチは初期ヨーの後に行われますが、ロールの前です。したがって、y軸周りのレートである $\omega_y$ は、機体フレームを取得するためにロール $\phi$ で回転されたフレーム $\hat{n}_\psi$ におけるピッチレートです。最後に、ヨー回転は慣性フレームで最初に行われます。したがって、機体フレームのz軸周りのレートである $\omega_z$ は、ピッチ $\theta$ とロール $\phi$ で回転された慣性フレームにおけるヨーレートです。これは行列方程式として表現できます。
$$ \begin{bmatrix} \omega_x \ \omega_y \ \omega_z \end{bmatrix} = R(\phi)\cdot R(\theta) \begin{bmatrix} 0 \ 0 \ \dot{\psi} \end{bmatrix} + R(\phi) \begin{bmatrix} 0 \ \dot{\theta} \ 0 \end{bmatrix} + \begin{bmatrix} \dot{\phi} \ 0 \ 0 \end{bmatrix} $$
$$ \begin{bmatrix} \omega_x \ \omega_y \ \omega_z \end{bmatrix} = \begin{bmatrix} \dot{\phi} + \dot{\psi} \sin{\theta}\ - \dot{\psi} \sin{\phi} \cos{\theta} + \dot{\theta}\ \dot{\psi} \cos{\phi} \cos{\theta} \end{bmatrix} $$
慣性フレームと機体フレームの調和
機体フレームは、(1) 変位と (2) 回転により、慣性フレームと異なる場合があります。機体フレームの原点はUAVの原点に固定されています。したがって、機体フレームから慣性フレームへの変位は、UAVの慣性位置です: $\hat{r}^n=[x,y,z]^T$。
機体フレームの原点に関するベクトルは、慣性フレームの原点に配置されると回転して見える場合があります。慣性フレームのベクトル $\hat{\mathcal{V}}^n=[x^n,y^n,z^n]^T$ と、機体フレームの原点での同じベクトル $\hat{\mathcal{V}}^b=[x^b,y^b,z^b]^T$ が与えられた場合、機体から慣性参照フレームへの回転行列 $R_b^n$ は次のように定義されます。各回転行列は次のとおりです。
$$ \begin{align} R(\phi) = \begin{bmatrix} 1 & 0 & 0 \ 0 & c\phi & -s\phi \ 0 & s\phi & c\phi \end{bmatrix} \end{align} $$
$$ \begin{align} R(\theta) = \begin{bmatrix} c\theta & 0 & s\theta \ 0 & 1 & 0 \ -s\theta & 0 & c\theta \end{bmatrix} \end{align} $$
$$ \begin{align} R(\psi) = \begin{bmatrix} c\psi & -s\psi & 0 \ s\psi & c\psi & 0 \ 0 & 0 & 1 \end{bmatrix} \end{align} $$
$$ \begin{align} \hat{\mathcal{V}}^b &= R(\phi)\cdot R(\theta) \cdot R(\psi) \cdot \hat{\mathcal{V}}^n \ \hat{\mathcal{V}}^b &= R_n^b \hat{\mathcal{V}}^n \ \begin{bmatrix} x^b \ y^b \ z^b \end{bmatrix} &= \begin{bmatrix} c\psi c\theta & - s\psi c\theta & s\theta\ s\phi s\theta c\psi + s\psi c\phi & - s\phi s\psi s\theta + c\phi c\psi & - s\phi c\theta\ s\phi s\psi - s\theta c\phi c\psi & s\phi c\psi + s\psi s\theta c\phi & c\phi c\theta \end{bmatrix} \begin{bmatrix} x^n \ y^n \ z^n \end{bmatrix} \end{align} $$
ここで、$c | s$ は $\phi | \theta | \psi$ のコサインとサインをそれぞれ表します。この回転は、慣性視点から機体フレームで作用する力を調べるときに役立ちます。上記は、回転する参照フレーム間をベクトルが瞬間的に変換します。
回転フレームでの微分の調和
ただし、ベクトルが回転している参照フレーム中に変化している場合、変化率はそれほど単純ではありません。ベクトルの変化率は、(1) 機体フレームでのベクトル量自体の変化と、(2) フレーム座標の変化によるものです。
[画像]
瞬間的な角速度 $\hat{\omega}=[\omega_x,\omega_y,\omega_z]$ で回転する機体フレームにおいて、機体フレームのベクトル $\hat{\mathcal{V}}^b = \hat{b} \cdot \hat{\mathcal{V}}$ の時間微分(近接する慣性フレームで測定)は、Transport theoremによって与えられます。
$$ \begin{align} \frac{d \hat{\mathcal{V}}^b}{d t} &= \hat{b} \cdot \frac{d \hat{\mathcal{V}}}{d t} + \frac{d \hat{b}}{d t} \cdot \hat{\mathcal{V}} \ &= \hat{b} \cdot \frac{d \hat{\mathcal{V}}}{d t} + \hat{\omega} \times \hat{\mathcal{V}}^b \ &= \hat{b} \cdot \frac{d \hat{\mathcal{V}}}{d t} + \begin{bmatrix} 0 & -\omega_z & \omega_y \ \omega_z & 0 & -\omega_x \ -\omega_y & \omega_x & 0 \end{bmatrix} \hat{\mathcal{V}} \end{align} $$
Transport theorem と外積
機体フレームが各軸周りに瞬間的な角速度 $\hat{\omega}$ を持つと仮定します。各基底ベクトルは、時間間隔 $dt$ で回転を観測します。 $dt$ が小さい場合、角変位は小さく $\hat{\omega} dt$、単位ベクトルの先端が描く弧は、長さが $1 \cdot \hat{\omega} dt$ の直線として近似できます(弧長は半径×ラジアン単位の角度)。
[画像]
$$ \hat{x}^b \rightarrow \hat{x}^b + 0\hat{x}^b + \omega_z dt \hat{y}^b - \omega_y dt \hat{z}^b \ \hat{y}^b \rightarrow \hat{y}^b - \omega_z dt \hat{x}^b + 0 \hat{y}^b + \omega_x dt \hat{z}^b \ \hat{z}^b \rightarrow \hat{z}^b + \omega_y dt \hat{x}^b - \omega_x dt \hat{y}^b + 0 \hat{z}^b $$
行列形式では、各列ベクトルは基底ベクトルの変化を表します:$$ \hat{b}\_t+dt = \hat{b}\_t + \begin{bmatrix} 0 & -\omega_z & \omega_y \ \omega_z & 0 & -\omega_x \ -\omega_y & \omega_x & 0 \end{bmatrix} dt $$
参照フレームの基底ベクトルの変化率は次のようになります。
$$ \frac{d \hat{b}}{dt} = \begin{bmatrix} 0 & -\omega_z & \omega_y \ \omega_z & 0 & -\omega_x \ -\omega_y & \omega_x & 0 \end{bmatrix} $$
この行列乗算は、ベクトル $[\omega_x, \omega_y, \omega_z]^T$ とのクロス積に相当します。
この加算項は、非慣性フレームを考慮する見かけ上の力です。それが考慮されると、ダイナミクスは慣性フレームと同様に解くことができます。これは、機体フレームでの加速度を積分して機体フレーム速度を見つけるために使用できます。
車両の状態
車両のダイナミクスは、12の状態変数によって完全に表されます。各次元での線形および角変位、およびそれらの時間微分です。
- $\hat{r}^n=[x,y,z]^T$ は、慣性フレームでのナビゲーション座標です。これは、機体フレームから慣性フレームへの線形変位です。
- $\hat{v^b}=[v^b_x, v^b_y, v^b_z]^T$ は、機体フレーム軸に沿った車両の速度です。
- $\hat{\Phi}=[\phi, \theta, \psi]^T $ は、慣性参照フレームに対するオイラー角(ロール、ピッチ、ヨー)での機体参照フレーム $b$ の向きです。
- $\hat{\omega}=[\omega_x, \omega_y, \omega_z]^T$ は、機体フレーム軸に沿った瞬間的な角速度です。
多旋回UAVのダイナミクス
前のセクションでは車両を記述する変数を列挙しました。このセクションでは、変数が時間とともにどのように変化するかを説明します。状態は線形変数と角運動変数に分割されているため、ダイナミクス方程式も線形方程式と回転方程式に分割されます。ここでは、力とモーメントを機体フレーム座標で表すことを選択します。
- $\hat{F}^b=[F_x^b,F_y^b,F_z^b]^T$ は、3つの機体フレーム軸に沿った正味の力です。ここで $\hat{F}^b=R_n^b \hat{F}^n$ です。
- $\hat{\tau}^b=[\tau_x^b,\tau_y^b,\tau_z^b]^T$ は、3つの機体軸に沿ったモーメントです。ここで $\hat{\tau}^b=R_n^b \hat{\tau}^n$ です。
車両に作用する力は、推力と重力です。モーメントは、重心から離れた位置に力が作用するときに生成されます。(抗力を組み込むこともできますが、ここでは無視できると仮定します。)重力は、慣性参照フレームでは $\hat{F_g}^n=[0,0,mg]$ です。機体フレームでは $\hat{F_g}^b=R^b_n \hat{F_g}^n$ となります。機体フレームでの $p$ 個のプロペラの正味の力(推力)は $\hat{T}=[0,0,\sum_i^p T_i]^T$ であり、$T_i$ は $i$ 番目のプロペラの推力です。したがって、重心に作用する合計の力は $\hat{F}^b=\hat{T} + \hat{F_g}^b$ です。
多旋回機は剛体としてモデル化されます。剛体は、重心に対して一定の質量分布を持っています。
線形運動方程式
ダイナミクスの基本はニュートンの運動の第二法則です。力は運動量の変化率です。ここでは、機体フレーム変数で記述します。
$$ \hat{F}^b = \frac{d}{dt}(m\hat{v}^b) $$
上記の関係は、Transport Theorem によって提供される抽象化を使用して書き換えることができます。これにより、慣性フレームに従って機体に作用する力が得られます。質量は両方のフレームで一定と見なされます。したがって、残るのは次のようになります。
$$ \begin{align} \hat{F}^b &= m(\hat{\dot{v}}^b + \hat{\omega} \times \hat{v}^b) \end{align} $$
線形状態変数($\hat{r}^n$, $\hat{v}^b$)は、主に車両に作用する力によって決定されます。したがって、加速度 $\hat{\dot{v}}^b$ を解き、機体フレームに作用する加速度 $\hat{F}^b / m$ と等しくすると、機体フレームでの速度 $\hat{v}^b$ の変化率が得られます。
$$ \begin{align} \hat{T} + R_n^b \hat{F_g}^n &= m(\hat{\dot{v}}^b + \hat{\omega} \times \hat{v}^b)\ \hat{\dot{v}}^b &= \frac{\hat{T} + R_n^b \hat{F_g}^n}{m} - \hat{\omega} \times \hat{v}^b\ \begin{bmatrix} \dot{v}_x \ \dot{v}_y \ \dot{v}_z \end{bmatrix} &= \begin{bmatrix} - \omega_y v_z + \omega_z v_y + g \sin{\theta}\ \omega_x v_z - \omega_z v_x - g \sin{\phi} \cos{\theta}\ -\frac{T}{m} - \omega_x v_y + \omega_y v_x + g\cos{\phi} \cos{\theta} \end{bmatrix} \end{align} $$
$R_b^n$ と現在の機体フレーム速度 $\hat{v}^b$ を使用すると、慣性フレームでの位置 $r^n$ の変化率が得られます。
$$ \begin{bmatrix} \dot{r}^n_x \ \dot{r}^n_y \ \dot{r}^n_z \end{bmatrix} = R_b^n \begin{bmatrix} v_x \ v_y \ v_z \end{bmatrix} $$
角運動方程式
ニュートンの第二法則は、角運動学にも適用できます。モーメントは角運動量の変化率です。
$$ \hat{\tau} = \frac{d}{dt}(I\hat{\omega}) $$
ここで $I$ は慣性モーメント行列であり、角質量とも呼ばれます。
線形運動から角運動への移行
点質量 $m$ にある距離 $\hat{r}$ で力が作用し、回転軸周りの回転を引き起こすと仮定します。位置ベクトルに垂直な力の成分のみが回転を引き起こします。これはクロス積によって得られます。位置ベクトルに平行な成分は線形加速度を引き起こすことに注意してください。
[画像]
無限小変位 $d\hat{r}$ は、原点から始まる円の無限小弧長として近似できます。したがって、$d\hat{r}=\hat{\omega} \times \hat{r}$ です。
右手座標系が与えられている場合、角回転の方向ベクトルは、反時計回りの回転に対して正の回転軸に沿って指します。これは、後続の計算を単純化するために使用できます。
両辺にクロス積を適用し、弧長近似を代入します。
$$ \begin{align} \hat{r} \times F &= \hat{r} \times (m \cdot \frac{d^2}{dt^2}\\hat{r}) \ \hat{r} \times F &= \hat{r} \times (m \cdot \frac{d}{dt}(\hat{\omega} \times \hat{r})) \ \hat{r} \times F &= m \cdot \hat{r} \times (\frac{d}{dt}\\hat{\omega} \times \hat{r} + \hat{\omega} \times \frac{d}{dt}\\hat{r}) \ \hat{r} \times F &= m (\hat{r} \times \frac{d}{dt}\\hat{\omega} \times \hat{r} + \hat{r}\\times \hat{\omega} \times \frac{d}{dt}\\hat{r})\ \hat{r} \times F &= m (\frac{d}{dt}\\hat{\omega}(\hat{r}\\cdot\hat{r}) - \underbrace{\hat{r}(\hat{r}\\cdot\frac{d}{dt}\\hat{\omega}) + \hat{\omega}(\hat{r}\\cdot\frac{d}{dt}\\hat{r}) - \frac{d}{dt}\\hat{r}(\hat{r}\\cdot\hat{\omega})}_{=0 \text{since all vectors are perpendicular}}) \ \hat{\tau} &= m |\hat{r}|^2 \cdot \frac{d}{dt}\\hat{\omega} = I \frac{d}{dt}\\hat{\omega} \end{align} $$
これは、質量と回転軸への位置ベクトルについて積分することで、点質量でない場合にも拡張できます。$\int \int (\hat{r}\\cdot\hat{r}) d\hat{r} dm$。任意の原点の周りの3つの回転軸があるため、各軸への位置ベクトルは異なります。したがって、$I$ は各軸周りの角質量の対角行列 $\text{diag}(I_x_x, I_y_y, I_z_z)$ として書くことができ、これは3つの軸すべて周りの回転を含む角速度ベクトル $\hat{\omega}$ に対応します。
(3つの軸周りの非対称な質量分布の場合、$I$ の対角外要素はゼロになりません。これらは慣性積と呼ばれます。)
ドローンの慣性モーメント
ドローンを球としてモデル化し、モーターを表す端点質量に接続された円筒形のスポークとすることができます。
様々な形状の慣性モーメントは次のとおりです。ドローン部品はこれらの形状で近似できます。
- 質量 $m$、半径 $R$ の中実球、重心周り: $\frac{2}{5} m R^2$
- 質量 $m$、半径 $R$、長さ $L$ の中実円筒、重心を通過する対称軸周り: $\frac{1}{2} m R^2$
- 質量 $m$、半径 $R$、長さ $L$ の中実円筒、対称軸に垂直で重心を通過する軸周り: $\frac{1}{4} m R^2 + \frac{1}{12} m L^2$
- 質量 $m$ の点質量、回転軸からの距離 $r$: $m r^2$
平行軸の定理を使用して、各軸の合計慣性モーメントは次のようになります。
$$ I_\text{axis} = \sum_\text{parts}I_\text{part} + m r_\text{part}^2 $$
ここで、$I_\text{part}$ は部品の重心周りの慣性モーメント、$r_\text{part}$ は部品の重心から回転軸までの距離です。
[画像]
慣性モーメント行列は次のようになります(軸対称性を仮定)。
$$ I = \begin{bmatrix} I_x_x & 0 & 0 \ 0 & I_y_y & 0 \ 0 & 0 & I_z_z \end{bmatrix} $$
回転変数についても、Transport theorem を使用して見かけ上のモーメントの影響を「慣性化」できます。質量が一定で運動量の微分から因数分解できた線形の場合とは異なり、ここでは角運動量は時間変化するベクトルです。慣性モーメントと角速度の両方です。回転する機体フレームのモーメント $\hat{\tau}^b$ と、慣性フレームに対する機体フレームの角速度 $\hat{\omega}$ が与えられた場合:
$$ \begin{align} \hat{\tau}^b &= \frac{d}{dt}(I\hat{\omega}) \ \hat{\tau}^b &= \frac{d}{dt}(I\hat{\omega}) \hat{b} + \hat{\omega} \times I\hat{\omega} \ \hat{\tau}^b &= \underbrace{I\frac{d}{dt}\\hat{\omega}} _{\text{I is constant in the body frame}} + \hat{\omega} \times I\hat{\omega} \end{align} $$
角運動状態変数($\hat{\omega}$, $\hat{\Phi}$)は、機体に作用するモーメントによって支配されます。モーメントには2種類あります。
- 推力モーメント、$\hat{\tau}\_T^b=\sum_i^p r_i \times T_i$。ここで $r_i$ は $i$ 番目のプロペラの位置ベクトル、$T_i$ は $i$ 番目のプロペラの推力です。これらはピッチングとローリングを引き起こし、プロペラの推力によるものです。
- ヨーモーメント、$\hat{\tau}\_\tau^b=\sum_i^p \tau_i$。ここで $\tau_i$ は $i$ 番目のモーターのトルクです。これらはヨーイングを引き起こし、モーターのトルクによるものです。
機体周りの合計モーメントは $\hat{\tau}^b=\hat{\tau}\T^b+\hat{\tau}\\tau^b$ です。トルク方程式を $\hat{\omega}$ について解き、これらのモーメントを代入すると、機体フレームでの角速度 $\hat{\omega}$ の変化率が得られます。
$$ \dot{\hat{\omega}} = I^{-1} (\hat{\tau}^b - \hat{\omega} \times I\hat{\omega}) $$
向き $\hat{\Phi} = [\dot{\phi}, \dot{\theta}, \dot{\psi}]$ の変化率は、前述のように角速度 $\hat{\omega}$ と関連付けられています。方程式を解くと、次のようになります。
$$ \begin{bmatrix} \dot{\phi}\\ \dot{\theta}\\ \dot{\psi} \end{bmatrix} = \begin{bmatrix} \omega_x - \frac{\omega_z \sin{\theta}}{\cos{\phi} \cos{\theta}}\\ \omega_y + \frac{\omega_z \sin{\phi}}{\cos{\phi}}\\ \frac{\omega_z}{\cos{\phi} \cos{\theta}} \end{bmatrix} $$
12個の(線形および角運動の)状態変数の変化率は積分して、車両の状態を追跡できます。
$$ \begin{align} \begin{bmatrix} \\ \dot{\hat{r}^n} \\ \\ \\ \dot{\hat{v^b}} \\ \\ \dot{\phi} \ \dot{\theta}\ \dot{\psi} \\ \\ \dot{\hat{\omega}} \end{bmatrix} = \begin{bmatrix} R_b^n \begin{bmatrix} v_x \ v_y \ v_z \end{bmatrix}\ \\ \frac{\hat{T}^b + R_n^b \hat{F_g}^n}{m} - \hat{\omega} \times \hat{v}^b\ \\ \omega_x - \frac{\omega_z \sin{\theta}}{\cos{\phi} \cos{\theta}}\ \omega_y + \frac{\omega_z \sin{\phi}}{\cos{\phi}}\ \frac{\omega_z}{\cos{\phi} \cos{\theta}}\ \\ \ I^{-1} (\hat{\tau}^b - \hat{\omega} \times I\hat{\omega}) \end{bmatrix} \end{align} $$
展開
上記の式を代入すると、次のようになります。
$$ \begin{bmatrix} \dot{r^n}_1 \ \dot{r^n}_2 \ \dot{r^n}_3 \\ \dot{v^b}_x \ \dot{v^b}_y \ \dot{v^b}_z \\ \dot{\phi} \ \dot{\theta}\ \dot{\psi} \\ \dot{\hat{\omega}} \end{bmatrix} = \begin{bmatrix} v_x c\psi c\theta + v_y (s\phi s\theta c\psi + s\psi c\phi) + v_z (s\phi s\psi - s\theta c\phi c\psi)\ -v_x s\psi c\theta + v_y (- s\phi s\psi s\theta + c\phi c\psi) + v_z (s\phi c\psi + s\psi s\theta c\phi)\ v_x s\theta - v_y s\phi c\theta + v_z c\phi c\theta\ \ -\omega_y v_z + \omega_z v_y + g s\theta\ \omega_x v_z - \omega_z v_x - g s\phi c\theta\ -\frac{T}{m} - \omega_x v_y + \omega_y v_x + g c\phi c\theta\ \ \omega_x - \frac{\omega_z s\theta}{c\phi c\theta}\ \omega_y + \frac{\omega_z s\phi}{c\phi}\ \frac{\omega_z}{c\phi c\theta}\ \ \ I^{-1} (\hat{\tau}^b - \hat{\omega} \times I\hat{\omega}) \end{bmatrix} $$
力とトルクの生成
前のセクションでは、ダイナミクスが状態にどのように影響するかを説明しました。このセクションでは、これらの変化をどのように引き起こすかを説明します。
プロペラ
プロペラが回転すると、回転軸に平行な空気を下に押し、回転軸に垂直な横方向に空気を押します。
[画像]
下向きの押し込みは反作用として推力を生成します。プロペラの幾何学的パラメータが与えられている場合、推力は推力とプロペラ誘導速度の式の数値解を解くことによってモデル化できます。経験的に決定された推力定数とプロペラ速度を関連付ける代替アプローチがここで使用されます。
$$ \begin{align} T = k_T \cdot \Omega^2 \end{align} $$
横方向の押し込みは、回転軸に垂直な空気力学的抗力による反作用としてトルクを生成します。抗力係数 $k_d$ が与えられている場合、
$$ \begin{align} \tau = k_d \cdot \Omega^2 \end{align} $$
モーター
プロペラはモーターによって回転されます。ここでは、ブラシレスDC(BLDC)モーターを検討します。各モーターは、逆起電力定数 $k_e$ と内部抵抗 $R_\text{BLDC}$ によってパラメータ化されます。トルク定数 $k_\tau$ は、理想的な矩形波BLDCの場合、$k_e$ と等しくなります。$k_\tau$ はモーターの駆動モーメントを決定します。散逸モーメントは、動摩擦定数 $k_\text{DF}$ と空気力学的抗力定数 $k_d$ によって支配されます。最後に、正味のモーメント $\tau$ とモーターの慣性 $J$ がローターの回転速度 $\Omega$ を決定します。各モーターの状態は、その角速度 $\Omega$、印加電圧 $v_\text{BLDC}$、および引き込み電流 $i_\text{BLDC}$ です。ダイナミクスは次の式で与えられます。
$$ \begin{align} i_\text{BLDC} &= (v_\text{BLDC} - k_e \cdot \Omega ) / R_\text{BLDC}\ \tau_\text{BLDC} &= k_\tau \cdot i_\text{BLDC} \ \tau &= \tau_\text{BLDC} - k ext{_DF}\cdot\Omega - k_d\cdot\Omega^2 \ \frac{d \Omega}{dt} &= \tau / J \end{align} $$
したがって、モーターへの電流は総トルクを生成し、それは機械的摩擦と空気力学的抗力によって散逸します。正味のトルクがモーターを加速させます。
制御
前のセクションでは、ダイナミクスが状態にどのように影響するかを詳細に説明しました。このセクションでは、望ましい状態を達成するためにダイナミクスを見つける方法を説明します。
制御割り当て
最初の制御問題は、望ましいダイナミクスを生成するためにモーターをどれだけ回転させるかということです。速度とダイナミクスの関係は既知です。これらの式を逆算して、望ましいダイナミクスから必要な速度へのマッピングを行います。
制御ミキシングは、車両機体 $D$ 周りの正味のダイナミクス(力とトルク)とプロペラの回転速度 $\hat{\Omega}$ を関連付ける手順です。幾何学的理由により、プロペラからの機体への正味の横方向の力はゼロであるため、$F^b_x=F^b_y=0$ です。$\hat{x}^b$ と $\hat{y}^b$ 周りのモーメントは、モーメントアーム $r_\text{arm}$ と推力 $r_\text{arm} \times T$ によって決定されます。$\hat{z}^b$ 周りのヨーモーメントは、空気力学的抗力によって誘発されるトルクによって決定されます。これらの関係を組み合わせると、制御割り当て行列と、$\Omega^2$ に関して線形な方程式系が得られます。したがって、コントローラーからの所定のダイナミクス $D$ は、各モーターに必要なプロペラ速度 $\Omega$ に変換できます。
$$ \begin{align} \begin{bmatrix} F_x^b \ F_y^b \ F_z^b \ \tau_x^b \ \tau_y^b \ \tau_z^b \end{bmatrix} &= \underset{6 \times 1}{D} = \underset{6 \times p}{A} \cdot \underset{p \times 1}{\hat{\Omega}^2} \ \hat{\Omega} &= \sqrt{A^{-1} \cdot D} \end{align} $$
推力係数 $k_T_p$、抗力係数 $k_d_p$ を持つプロペラ $p$ が、機体フレームの基準前方方向から角度 $\theta_p$ で重心からの半径 $r_p$ にあり、プロペラが交互に時計回りおよび反時計回りに回転する場合、
$$ \begin{align} A = \begin{bmatrix} \cdots & 0 & \cdots \ \cdots & 0 & \cdots \ \cdots & -k_T_p & \cdots \ \cdots & -k_T_p \cdot r_p \sin(\theta_p) & \cdots \ \cdots & k_T_p \cdot r_p \cos(\theta_p) & \cdots \ \cdots & (-1)^p \cdot k_d_p & \cdots \end{bmatrix} \end{align} $$
非正方行列の逆
擬似逆行列を使用して、$A \Omega^2 = D$ の最小二乗解を得ることができます。
$$ \begin{align} A^+ = A^T (A A^T)^{-1}\ \hat{\Omega}^2 = A^+ D \end{align} $$
しかし、行列の逆は数値的不安定性を引き起こす可能性があります。別の方法は、特異値分解(SVD)を使用し、乗算の順序を逆にし、対角行列を転置/逆数にすることです。
参照追従
次の上位レベルは、ウェイポイント $\hat{r}^n_\text{wp}$ をたどることです。座標が与えられたら、この参照を追跡するために望ましいダイナミクスを設定します。
PIDコントローラーは、参照を追跡するための標準的な方法です。これは、望ましい状態と実際の状態との間の誤差信号に作用します。
$$ \begin{align} u_\text{PID} = k_P e + k_I \int_0^t e \partial t + k_D \nabla_t e \end{align} $$
短い時間間隔で計算される誤差は、微分操作と見なすことができます。横方向の運動の場合:
- x/y位置の誤差 → 望ましい速度
- 速度の誤差 → 望ましい迎え角
- 迎え角の誤差 → 望ましい角速度
垂直方向の運動の場合:
- z位置の誤差 → 望ましい垂直速度
カスケードPIDコントローラーを使用して、高レベルのウェイポイント誤差を制御信号に伝播させることができます。監視位置PIDコントローラーは、測定された横方向速度を追跡し、指定されたウェイポイントに到達するために必要なピッチとロールを出力します。低レベルの姿勢コントローラーは、ピッチ、ロール、ヨー速度を追跡し、必要なトルクを出力します。並列に、PIDコントローラーは垂直速度を追跡し、必要な推力を出力します。カスケードPIDセットアップの最終的な出力は、所定の推力とロール、ピッチ、ヨーのトルクです。これらの所定のダイナミクスは、制御ミキシングを介してモーターに割り当てられます。
UAVの標準的な制御ロジックフローを次の図に示します。この標準的なエンドツーエンドのアプローチでは、位置参照はプロペラ速度信号に変換されます。
[画像]
パスプランニングと監視制御
次の上位レベルは、どのウェイポイントを訪問するかを決定することです。飛行エンベロープが与えられている場合、一部のウェイポイントは実行不可能である可能性があります。S-CurvesとB-Splinesを使用して、車両の制約(例:最小/最大速度、加速度など)を尊重する軌道を構築できます。
これは、監視最適制御(モデル予測制御、強化学習などを使用)とともに、この記事の範囲外です。
次のステップ
UAVシミュレーションと制御についてさらに学習したい場合は、ArduPilotは、制御とシミュレーションのための優れたオープンソースのコミュニティ駆動型フレームワークです。
人間輸送用(eVTOL)の多旋回機に興味がある場合は、「Advanced Air Mobility」および「Urban Air Mobility」を検索すると、関連文献が見つかります。