加速度計の読み取り値を使用して、初期位置に関する脚の角度を瞬時に計算しようとしています。
これに近づくにつれて、平均化された重力ベクトルを記録し、現在の読み取り値とそれの間の角度を計算する必要があると判断しました。
理論的にはもっともらしく思われます: 重力の読み取り値は脚の位置ごとに異なるため、静止位置では、開始時の読み取り値に関して、脚の角変位を見つけるために使用できるベクトルに読み取り値が収束するはずです。
ただし、いくつかの組み合わせを試しました。Z 成分と Y 成分のみを使用した両方のベクトル間の角度 ( thisを使用)。重力と電流の差ベクトルを計算し、atan2(dY,SQRT(dX^2+dZ^2)); を実行します。atan2(dY,dz)... を計算します (ここで、dY と dZ は、それぞれ Y 成分と Z 成分の現在のベクトルと重力ベクトルの減算です)
これらの解決策はどれも機能していないように見えるので、これができるかどうか疑問に思っています。
誰かがこれに対する解決策を持っていますか?