diff --git a/test/gtest_solve_problem_force_torque_inertial_dynamics.cpp b/test/gtest_solve_problem_force_torque_inertial_dynamics.cpp index 20e26c06fdee4f8fd03e49b74c201107b1583e36..cc97b1c52db99beb3495c61311a48976c171352e 100644 --- a/test/gtest_solve_problem_force_torque_inertial_dynamics.cpp +++ b/test/gtest_solve_problem_force_torque_inertial_dynamics.cpp @@ -102,7 +102,7 @@ TEST_F(Test_SolveProblemForceTorqueInertialDynamics_yaml, mass_only_hovering) S->getStateBlock('C')->fix(); S->getStateBlock('i')->fix(); S->getStateBlock('m')->unfix(); - S->setStateBlockDynamic('I'); + // S->setStateBlockDynamic('I'); CaptureMotionPtr C0_0 = std::make_shared<CaptureForceTorqueInertial>(0.0, S, data, data_cov, nullptr); CaptureMotionPtr C1_0 = std::make_shared<CaptureForceTorqueInertial>(0.2, S, data, data_cov, nullptr); @@ -171,6 +171,7 @@ TEST_F(Test_SolveProblemForceTorqueInertialDynamics_yaml, cdm_only_hovering) S->getStateBlock('C')->unfix(); S->getStateBlock('i')->fix(); S->getStateBlock('m')->fix(); + // S->setStateBlockDynamic('I'); CaptureMotionPtr C0_0 = std::make_shared<CaptureForceTorqueInertial>( 0.0, S, data, data_cov, nullptr); CaptureMotionPtr C1_0 = std::make_shared<CaptureForceTorqueInertial>( 0.2, S, data, data_cov, nullptr); @@ -239,7 +240,7 @@ TEST_F(Test_SolveProblemForceTorqueInertialDynamics_yaml, mass_and_cdm_hovering) S->getStateBlock('C')->unfix(); S->getStateBlock('i')->fix(); S->getStateBlock('m')->unfix(); - S->setStateBlockDynamic('I'); + // S->setStateBlockDynamic('I'); CaptureMotionPtr C0_0 = std::make_shared<CaptureForceTorqueInertial>(0.0, S, data, data_cov, nullptr); CaptureMotionPtr C1_0 = std::make_shared<CaptureForceTorqueInertial>(0.2, S, data, data_cov, nullptr);