【連載第18回】倒立振子(ICM‑42688) 「自然落下」時の角度と角速度をロギングした
この連載の全体まとめはこちら:P制御から始まる倒立振子の探究録(まとめ)|イモやん
前回までで、ICM42688から角度を安定して読み取り、メモリにロギングするところまでたどり着きました。
今回は、角度と角速度を約10ms毎にロギングするスケッチを作成し、「自然落下のログ」を取ってみます。
今回も制御は一切かけず、ただセンサーで観察するだけの実験です。
📋 今回のゴール
今回のゴールはとてもシンプルです。
倒立振子をほぼ直立の状態から手を離し、自然に倒れる様子を
10msごとに
角度 angle_x[deg]
LPF後の角速度 gx_dps_f[deg/s]
として log.txt に記録する
「まだ制御はしないけれど、ちゃんと物理っぽいデータが取れているか」を確かめる回になります。
💻 ログ取得用スケッチのポイント
スケッチ全体は前回のものをベースにし、角度・角速度をロギングする機能のみとしています。
ICM42688の初期化とオフセットキャリブレーション
コンプリメンタリフィルタによる角度推定 angle_x
LPFをかけた角速度 gx_dps_f
10ms周期で log.txt に CSV 形式で書き出し
ロギング中はオンボードLEDを約0.5秒ごとにトグルして「生きているサイン」を表示
■ スケッチ全体(0508_angle_10ms_log.py)
ログのヘッダは、シンプルにしています。
textt_ms,angle_x,gx_dps_f各行は
t_ms: 計測開始からの経過時間[ms]
angle_x: 倒立振子の角度[deg]
gx_dps_f: LPFをかけた角速度[deg/s]
を表します。
📈 実際に取れた「自然落下」のログ
実験条件は次のようにしました。
倒立振子をほぼ直立に立てる
数百ミリ秒ほど手で軽く支え、静止させる
その後そっと手を離し、完全に自由落下させる
床に倒れるまでロギングする
■ ロギングデータ(例)
ログの一部抜粋です。(便宜上ファイル名を変更しています。)
最初はほぼ直立からスタートし、途中で本格的に倒れ始め、最後は90度近くまで寝ていく様子がデータに現れています。
グラフ化してみました。
(参考として、本文末尾にログ解析をしています。興味ある方はどうぞ)


🔍 波形から読み取れること
角速度 gx_dps_f が徐々に大きくなり、次第に「倒れる向きに加速している」様子がはっきりしてきます。
角度が増えるにつれて角速度もどんどん増えていることが分かります。
このログは、授業や勉強会等でいろいろな切り口に使えそうです。
角度 angle_x と角速度 gx_dps_f のグラフでは
「角速度が大きくなると角度のカーブが急になる」
「角速度は角度の時間微分になっている」
という関係を直感的に説明できる
初期の小さな角度域だけを拡大して
「最初はほぼ直線的に増えて見える」
でも本質的には指数関数的に離れていく
という不安定平衡のイメージを掴むのに使える
「いきなり制御」ではなく、「まずは何もせずに倒れる様子をきちんと観察する」というステップは、センサーやフィルタの理解にも良いなと感じました。
🔧 次回予告
次回は、倒立振子をブランコに見立てて、ゆらゆらさせたときのログを取得する予定です。スケッチは今回のものを使います。数学的には角度が正弦波(sinカーブ)でゆれると、その微分成分(角速度)も正弦波(cosカーブ)になりますが、実際はどうなのか確認する予定です。
📎 補足:数値で見る倒れ方の変化
この記事の内容にもう少し踏み込みたい方向けに、今回のログから「どこで何が起きているか」を数字で眺めてみます。
今回使ったログはおおよそ 0 ミリ秒から 1260 ミリ秒までで、angle_x が角度、gx_dps_f が角速度です。
これを時間順に追いかけると、倒れ方の「きっかけ」と「加速」の様子が見えてきます。
まず、時刻 0〜200 ミリ秒あたりの角速度 gx_dps_f を見ると
0 ミリ秒で angle_x ≒ 0.77 、角速度 ≒ 0.51 deg/s
194 ミリ秒でも angle_x ≒ 0.89 、角速度 ≒ 0.17 deg/s
と、角速度は 1 deg/s 未満のままで、とてもゆっくりしか増えていません。
このあたりが本文で書いた「最初はほぼ直立で、ほんの少しだけ傾き始めている」領域です。
そのあと、t = 270 ミリ秒付近から少し様子が変わってきます。
269 ミリ秒で angle_x ≒ 0.92 、角速度 ≒ 0.31 deg/s
359 ミリ秒で angle_x ≒ 1.06 、角速度 ≒ 1.17 deg/s
約 90 ミリ秒の間に角速度が 3 倍以上になっていて、グラフ上でも角度カーブがじわっと急になり始める部分に対応します。
ここが「まだゆっくりだけれど、安定を保てなくなり始めた」あたりだと解釈できます。
さらに、t = 430〜500 ミリ秒くらいになると、角速度の増え方が一気に加速します。
429 ミリ秒で angle_x ≒ 1.23 、角速度 ≒ 2.90 deg/s
469 ミリ秒で angle_x ≒ 1.57 、角速度 ≒ 8.66 deg/s
499 ミリ秒で angle_x ≒ 1.99 、角速度 ≒ 11.97 deg/s
たった 70 ミリ秒の間に角速度が 4 倍近くになっていて、角度も 1.2 から 2.0 付近まで一気に増えています。
グラフ上では、このあたりから角度カーブが「ぐいっ」と立ち上がるように見えるはずで、本文で書いた「途中で本格的に倒れ始める」区間がここにあたります。
その後も角速度は増え続けて、t = 800 ミリ秒を超えたあたりでは
809 ミリ秒で angle_x ≒ 9.96 、角速度 ≒ 55.34 deg/s
889 ミリ秒で angle_x ≒ 16.21 、角速度 ≒ 84.72 deg/s
929 ミリ秒で angle_x ≒ 20.31 、角速度 ≒ 103.91 deg/s
というように、角度も角速度もどんどん大きくなっていきます。
この辺りのグラフを見ると、角度カーブがほぼ「指数関数的」に立ち上がっていく様子がよく分かります。
さらに時間が進んで t = 1100 ミリ秒以降では、角度はほとんど倒れきった状態に近づきます。
1109 ミリ秒で angle_x ≒ 48.99 、角速度 ≒ 193.66 deg/s
1140 ミリ秒で angle_x ≒ 56.98 、角速度 ≒ 200.56 deg/s
1260 ミリ秒で angle_x ≒ 84.61 、角速度 ≒ 151.83 deg/s
このあたりになると、角度はほぼ 90 度近くまで到達し、角速度も一度ピークを過ぎて少しずつ下がり始めています。
グラフ上では角度カーブがだんだん水平に近づいていく「倒れきった」領域で、本文で書いた「最後は 90 度近くまで倒れ込んでいく」部分に対応します。
このように、時間 t と angle_x、gx_dps_f の具体的な値をいくつか指さして眺めてみると、
「最初はほとんど動いていないように見えるのに、あるタイミングから一気に倒れ始め、その後は指数関数的に倒れ込んでいく」
という、不安定平衡らしい振る舞いがよりはっきり見えてくると思います。
補足終わり。