Skip to content

Commit 95900d8

Browse files
remove obsolete rot m,atrix attribute
1 parent f9dbdc6 commit 95900d8

1 file changed

Lines changed: 5 additions & 2 deletions

File tree

src/smsfusion/_ins_v2.py

Lines changed: 5 additions & 2 deletions
Original file line numberDiff line numberDiff line change
@@ -506,14 +506,17 @@ def __init__(
506506
# State and covariance estimates
507507
self._v_n = np.asarray_chkfinite(v).reshape(3).copy()
508508
self._q_nb = np.asarray_chkfinite(q).reshape(4).copy()
509-
self._R_nb = _rot_matrix_from_quaternion(self._q_nb)
510509
self._bg_b = np.asarray_chkfinite(bg).reshape(3).copy()
511510
self._P = np.asarray_chkfinite(P).reshape(9, 9).copy()
512511
self._dx = np.zeros(9)
513512

514513
# Discrete state-space model
515514
self._phi = _state_transition_matrix(
516-
self._dt, np.zeros(3), np.zeros(3), self._R_nb, self._gbc
515+
self._dt,
516+
np.zeros(3),
517+
np.zeros(3),
518+
_rot_matrix_from_quaternion(self._q_nb),
519+
self._gbc,
517520
)
518521
self._Q = _process_noise_covariance_matrix(
519522
self._dt, self._vrw, self._arw, self._gbs, self._gbc

0 commit comments

Comments
 (0)