ドローンのシステム基礎を学ぶ（１０）：息子と一緒に Makers：So-netブログ

	ブログをはじめるログイン

ドローンのシステム基礎を学ぶ（９）｜スマホサイズのドローン登場！？ブログトップ

ドローンのシステム基礎を学ぶ（１０）　[ロボット] [編集]

前回、比例制御（Ｐ制御）について学び、そこでＰ制御だけでは、マイコンの計算能力に限界によりターゲット値に正しく収束しないという問題に直面しました。

誤差が出てしまうのは誤差の値が小さすぎるためです。小さければ積み上げればよいということで、誤差を累積させてフィードバックをかける方法が考えられました。これが積分制御（Ｉ制御）です。

収束領域近傍では、ターゲット値と測定値の差はほんの僅かなので値としてはほぼ無視できます。その領域では積分値がそのまま補正値となり、正負の面積の差がほぼゼロとなるまで値を収束させます。

では実際にプログラムで確認をしてみましょう。シミュレーションのプログラムを作ってみました。質量は1g、測定間隔は0.1秒、比例係数は1.0、積分項係数も 1.0 にしてみました。

#include <stdio.h>

#define MASS 1
#define TIME_INTERVAL 0.1
#define Kp 1.0
#define Ki 1.0

void main()
{
    float Vt = 80.0;  // Target Velocity
    float Vm = 60.0;  // Measured Velocity
    float Time = 0.0;
    float err_integ = 0.0;

    printf("%f, %f\n", Time, Vm);
    for (int i = 0; i < 500; i++) {
	
	float err = Vt - Vm;
	err_integ += err * TIME_INTERVAL;
	
	float force = Kp * err + Ki * err_integ;
        float dAcc = force / MASS;

        Vm += dAcc * TIME_INTERVAL;
        Time += TIME_INTERVAL;

        printf("%f, %f\n", Time, Vm);
    }
}

これをグラフにすると下記のようになります。最初は差が大きいので非常に大きな振れ幅となりますが、次第に収束していきます。