ドローンのシステム基礎を学ぶ（５）

ドローンを操作をすると、その指示は制御速度の指示となり、それをモーターのトルクに反映します。今回は、制御速度からトルクに変換する制御について学びます。

ドローンのシステム基礎を学ぶ（３）で、ドローンの動きとモーターのトルクの関係について学びました。今回は、プロポからの指示がどのようにモーター制御につながるか見てみたいと思います。

まずはスロットルから。上昇を操作すると"THROTTLE UP"が指示されます。このときの上昇速度とモーターのトルクの関係式は下記のようになります。





次は回転。右回転を操作すると"YAW R"が指示されます。この時の回転速度とモーターのトルクの関係式は下記のようになります。





次は左右。右移動を操作すると”ROLL R”が指示されます。この時の姿勢制御速度とモーターのトルクの関係式は下記のようになります。





最後は前後。前進を操作すると”PITCH DOWN”が指示されます。ちょっと分かりにくいですが、図を見て理解してください。この時の姿勢制御速度とモーターのトルクの関係式は下記のようになります。





これらを行列にまとめてみました。左辺が指示制御速度で、右辺がトルクの関係式になります。





分かりやすくするために行列を K で表しました。





姿勢制御からトルクを割り出すには、指示制御速度にKの逆行列をかけてやればよさそうです。





大変でしたが、逆行列を求めてみました。（合ってるかな・・・）





これで、プロポからの指示をトルクに反映する魔法陣を手に入れることができました。しかーし、現実はそんなに甘くはないのであった。まだまだ続きます！
（＾_＾）／～

---

Building Your Own Drones: A Beginners' Guide to Drones, UAVs, and ROVs

• 作者: John Baichtal
• 出版社/メーカー: Que Publishing
• 発売日: 2015/09/14
• メディア: ペーパーバック

Introduction to Quadcopter: A Pocket Guide (English Edition)

• 出版社/メーカー:
• 発売日: 2016/02/12
• メディア: Kindle版

HPHELI Batfly 250 Quad Racer Drone DIY Kit [並行輸入品]

• 出版社/メーカー: HPHELI
• メディア:

---

タグ：Drone ArduPilot ArduCoptor QuadCoptor