@@ -692,7 +692,7 @@ void Kalman3D_Wave<T, with_gyro_bias, with_accel_bias>::measurement_update_parti
692
692
{
693
693
// Jacobian touches only attitude error
694
694
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);
696
696
697
697
// Innovation
698
698
Vector3 inno = meas - vhat;
@@ -714,10 +714,10 @@ void Kalman3D_Wave<T, with_gyro_bias, with_accel_bias>::measurement_update_acc_o
714
714
715
715
// Build Jacobian
716
716
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
719
719
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
721
721
722
722
// Innovation
723
723
Vector3 inno = acc_meas - v1hat;
@@ -750,7 +750,7 @@ void Kalman3D_Wave<T, with_gyro_bias, with_accel_bias>::measurement_update_mag_o
750
750
const Vector3 meas_fixed = (dotp >= T (0 )) ? mag_meas_body : -mag_meas_body;
751
751
752
752
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);
754
754
755
755
Vector3 inno = meas_fixed - v2hat;
756
756
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
775
775
Vector3 r = Hb * (mag_meas_body - v2hat);
776
776
777
777
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));
779
779
780
780
Matrix3 Rproj = Hb * Rmag * Hb.transpose ();
781
781
0 commit comments