Skip to content

Commit 9cd9a56

Browse files
authored
Update Kalman3D_Wave.h
1 parent e7d9cbd commit 9cd9a56

File tree

1 file changed

+6
-6
lines changed

1 file changed

+6
-6
lines changed

bbn_wave_freq_m5atomS3/Kalman3D_Wave.h

Lines changed: 6 additions & 6 deletions
Original file line numberDiff line numberDiff line change
@@ -692,7 +692,7 @@ void Kalman3D_Wave<T, with_gyro_bias, with_accel_bias>::measurement_update_parti
692692
{
693693
// Jacobian touches only attitude error
694694
Matrix<T,3,NX> C = Matrix<T,3,NX>::Zero();
695-
C.block<3,3>(0,0) = -skew_symmetric_matrix(vhat);
695+
C.template block<3,3>(0,0) = -skew_symmetric_matrix(vhat);
696696

697697
// Innovation
698698
Vector3 inno = meas - vhat;
@@ -714,10 +714,10 @@ void Kalman3D_Wave<T, with_gyro_bias, with_accel_bias>::measurement_update_acc_o
714714

715715
// Build Jacobian
716716
Matrix<T,3,NX> C = Matrix<T,3,NX>::Zero();
717-
C.block<3,3>(0,0) = -skew_symmetric_matrix(v1hat); // attitude
718-
C.block<3,3>(0,OFF_AW) = R_wb(); // a_w
717+
C.template block<3,3>(0,0) = -skew_symmetric_matrix(v1hat); // attitude
718+
C.template block<3,3>(0,OFF_AW) = R_wb(); // a_w
719719
if constexpr (with_accel_bias)
720-
C.block<3,3>(0,OFF_BA) = Matrix3::Identity(); // bias
720+
C.template block<3,3>(0,OFF_BA) = Matrix3::Identity(); // bias
721721

722722
// Innovation
723723
Vector3 inno = acc_meas - v1hat;
@@ -750,7 +750,7 @@ void Kalman3D_Wave<T, with_gyro_bias, with_accel_bias>::measurement_update_mag_o
750750
const Vector3 meas_fixed = (dotp >= T(0)) ? mag_meas_body : -mag_meas_body;
751751

752752
Matrix<T,3,NX> C = Matrix<T,3,NX>::Zero();
753-
C.block<3,3>(0,0) = -skew_symmetric_matrix(v2hat);
753+
C.template block<3,3>(0,0) = -skew_symmetric_matrix(v2hat);
754754

755755
Vector3 inno = meas_fixed - v2hat;
756756
joseph_update_rank3(xext, Pext, C, inno, Rmag);
@@ -775,7 +775,7 @@ void Kalman3D_Wave<T, with_gyro_bias, with_accel_bias>::measurement_update_mag_o
775775
Vector3 r = Hb * (mag_meas_body - v2hat);
776776

777777
Matrix<T,3,NX> C = Matrix<T,3,NX>::Zero();
778-
C.block<3,3>(0,0) = Hb * (-skew_symmetric_matrix(v2hat));
778+
C.template block<3,3>(0,0) = Hb * (-skew_symmetric_matrix(v2hat));
779779

780780
Matrix3 Rproj = Hb * Rmag * Hb.transpose();
781781

0 commit comments

Comments
 (0)