21 const std::vector<double>& local_x_data,
22 const std::vector<double>& local_x_prev_data,
23 std::vector<double>& local_b_data, std::vector<double>& local_Jac_data)
25 std::vector<double> local_M_data(local_Jac_data.size());
26 std::vector<double> local_K_data(local_Jac_data.size());
29 static_cast<Eigen::MatrixXd::Index
>(local_x_data.size());
33 auto const local_x_prev =
35 Eigen::VectorXd
const local_xdot = (local_x - local_x_prev) / dt;
42 auto const num_dofs_per_component =
58 auto const num_purterbated_colums = num_r_c - nved;
60 for (Eigen::MatrixXd::Index i = 0; i < num_purterbated_colums; ++i)
63 auto const component = i / num_dofs_per_component;
64 auto const eps = perturbations[component];
68 local_x_prev_data, local_M_data, local_K_data,
78 if (!local_M_data.empty())
80 auto const local_M_p =
82 auto const local_M_m =
84 local_Jac.col(i).noalias() +=
86 (local_M_p - local_M_m) * local_xdot / (2.0 * eps);
90 if (!local_K_data.empty())
92 auto const local_K_p =
94 auto const local_K_m =
96 local_Jac.col(i).noalias() +=
98 (local_K_p - local_K_m) * local_x / (2.0 * eps);
102 if (!local_b_data.empty())
104 auto const local_b_p =
106 auto const local_b_m =
108 local_Jac.col(i).noalias() -=
110 (local_b_p - local_b_m) / (2.0 * eps);
111 local_b_data.clear();
118 local_assembler.
assemble(t, dt, local_x_data, local_x_prev_data,
119 local_M_data, local_K_data, local_b_data);
122 if (!local_M_data.empty())
125 local_Jac.noalias() += local_M / dt;
127 if (!local_K_data.empty())
130 local_Jac.noalias() += local_K;
138 if (!local_b_data.empty())
146 if (!local_M_data.empty())
150 local_M_data.clear();
152 if (!local_K_data.empty())
161 auto const dm_start_index = num_purterbated_colums;
162 auto const dm_size = nved;
163 K.block(dm_start_index, dm_start_index, dm_size, dm_size).setZero();
167 local_K_data.clear();
void assembleWithJacobian(LocalAssemblerInterface &local_assembler, double const t, double const dt, std::vector< double > const &local_x_data, std::vector< double > const &local_x_prev_data, std::vector< double > &local_b_data, std::vector< double > &local_Jac_data) override
virtual void assemble(double const t, double const dt, std::vector< double > const &local_x, std::vector< double > const &local_x_prev, std::vector< double > &local_M_data, std::vector< double > &local_K_data, std::vector< double > &local_b_data)