趣味で二輪バランシングロボットを作ろうとしています。私はすべてのハードウェアを構築して組み立てており、コーディングも行っていると思います。ジャイロと加速度計を備えた IMU を使用して、信号を平滑化するための補助フィルターで傾斜角を見つけています。IMU からの入力信号は、0.7 未満の分散 + または - 実際の傾斜角度のように、非常に滑らかに見えます。
私の IMU サンプリング レートは 50 Hz で、PID計算も 50 Hz で行っていますが、これは十分に速いと思います。
基本的に、PID Libraryにある PID ライブラリを使用しています。
P 値を低い値に設定すると、車輪は正しい方向に進みます。
P 値を大きな値に設定すると、グラフのような出力が得られます。