1. はじめに 本記事では、PX4/Firmwareのマルチコプター姿勢制御モジュール(mc_att_control)に実装されているアルゴリズムをコードベースで解説しています。以下の予備知識があると理解が捗ると思います。 PID制御 ブロック線図 対象ソースコード Tag: 1.6.0 Release RC1 src/modules/mc_att_control/mc_att_control_main.cpp 2. 全体像 void MulticopterAttitudeControl::control_attitude(float dt)の内容は、Simlink風のブロック図で表すと次のようになります。ここでは姿勢制御(P制御)を行います。 void MulticopterAttitudeControl::control_attitude_rates(float dt)については次のよ