各軸(x、y、z)で加速および回転した生データがいくつかあります。しかし、どの軸が重力方向なのかわかりません。各オブジェクトによって、IMU がどの方向に取り付けられているかわかりません。x 軸が重力の方向である場合もあれば、y 軸である場合もあれば、z 軸である場合もあり、すべてではない場合もあります。
オブジェクト (IMU が取り付けられている) が 1m/s^2 の速度でヘディング方向に移動しているときを調べる必要があります。Z軸が重力方向、X軸が運動方向の場合、IMUはAx値が1m/s^2以上の値を求める必要があります(IMUが下の画像のような向きで設置されている場合)。 .
-img1
しかし、どの方向が運動の方向で、どちらが重力の方向なのかはわかりません。そこで、3つの加速度信号と3つのジャイロ信号からどちらの方向が進行方向なのかを知りたいのです。
図2のようにセンサーを斜めに設置しても、センサーが進行方向に1m/s^2の加速度で動いていることを知るにはどうすればよいでしょうか? C でコーディングする必要があります。組み込み環境には十分な計算マージンがないため、実装はできるだけ単純にする必要があります。良い解決策はありますか?