World ObserverのKalman Filterの出力が不安定

[spiralray]

お世話になっております。

World Observerの動作について質問させてください。
以下はGrSim(ホワイトノイズ無し)にて1m/sの等速直線運動をした際の出力です。

上図のように、推定値が1 〜 1.2m/sあたりを行き来しますが、こちらはバグでしょうか。
私の使用方法が何かしら誤っているのでしょうか。

また、現在はフレームレート60fps決め打ちでの実装となっていますが、フレーム間隔を都度計算してpredictしたほうがより良いと思います。

よろしくおねがいします。

[tilt-silvie]

使用方法は間違っておらず、これは現在のバグ（というか仕様？）です。ただ、修正するまでは少し時間をください…。

ご推察のとおり、原因は60FPSの決め打ちで推定していることと考えています。 grSimとvision_receiverに含まれるジッタの影響によって、指摘いただいたような速度推定の乱れが発生しています。
対応としては、visionのパケットに含まれる t_captureの値の差分を毎度取り、それをpredict時のdtにすれば改善するかなと考えています。
ただ、少し考慮が必要です。grsimだと複数のカメラの t_capture が同じ値で届きますが、SSL-Vision では各カメラ別々の t_capture になると記憶しています（完全に各カメラが独立して動いている感じ）。正直なところ、これを考慮した実装が地味に面倒だなと思ってなかなか手を付けられていませんでした…。

また、今回のissueとは直接関係ありませんが、現在のconsai2は各種遅れ（観測遅れ、ネットワーク遅延など）を全く考慮していないソフトになっています。
今回のissueの対策も含め、ジッタ・遅れの両方を考慮にいれた対策を実装したいと思っています。が、ちょっと骨が折れるのでしばらく時間をください。