mirror of
https://github.com/sunnypilot/sunnypilot.git
synced 2026-02-19 08:53:54 +08:00
639a634f7c
* add pytest-asyncio
* switch common
* switch selfdrive
* switch system
* switch tools
* small fixes
* fix setUp and valgrind pytest
* switch to setup
* fix random
* switch mock
* switch test_lateral_limits
* revert test_ui
* fix poetry.lock
* add unittest to banned-api
* add inline ignores to remaining unittest imports
* revert test_models
* revert check_can_parser_performance
* one more skip
---------
Co-authored-by: Adeeb Shihadeh <adeebshihadeh@gmail.com>
old-commit-hash: dd9d5d4528
30 lines
638 B
Python
30 lines
638 B
Python
from openpilot.common.simple_kalman import KF1D
|
|
|
|
|
|
class TestSimpleKalman:
|
|
def setup_method(self):
|
|
dt = 0.01
|
|
x0_0 = 0.0
|
|
x1_0 = 0.0
|
|
A0_0 = 1.0
|
|
A0_1 = dt
|
|
A1_0 = 0.0
|
|
A1_1 = 1.0
|
|
C0_0 = 1.0
|
|
C0_1 = 0.0
|
|
K0_0 = 0.12287673
|
|
K1_0 = 0.29666309
|
|
|
|
self.kf = KF1D(x0=[[x0_0], [x1_0]],
|
|
A=[[A0_0, A0_1], [A1_0, A1_1]],
|
|
C=[C0_0, C0_1],
|
|
K=[[K0_0], [K1_0]])
|
|
|
|
def test_getter_setter(self):
|
|
self.kf.set_x([[1.0], [1.0]])
|
|
assert self.kf.x == [[1.0], [1.0]]
|
|
|
|
def update_returns_state(self):
|
|
x = self.kf.update(100)
|
|
assert x == self.kf.x
|