KalmanFilterをライブラリ化。
X方向のGPS補正が弱い不具合あり。