プログラムの思い出しも含めて、再度考え直した。
順番としては
・カルマンフィルタで本体の角度と角速度の取得
・モータの角度と角速度の取得
↓
・タイマー割り込みで正確な時間ごとにデータを取得
↓
・swith文でデータを保存と出力を分ける
の流れでプログラムを作ったので後で見返すときのメモを残しておく。
プログラムの思い出しも含めて、再度考え直した。
順番としては
・カルマンフィルタで本体の角度と角速度の取得
・モータの角度と角速度の取得
↓
・タイマー割り込みで正確な時間ごとにデータを取得
↓
・swith文でデータを保存と出力を分ける
の流れでプログラムを作ったので後で見返すときのメモを残しておく。