20 const std::vector<double>& local_x_data,
21 const std::vector<double>& local_x_prev_data,
22 std::vector<double>& local_b_data, std::vector<double>& local_Jac_data)
24 std::vector<double> local_M_data(local_Jac_data.size());
25 std::vector<double> local_K_data(local_Jac_data.size());
28 static_cast<Eigen::MatrixXd::Index
>(local_x_data.size());
34 Eigen::VectorXd
const local_xdot = (x - x_prev) / dt;
41 auto const num_dofs_per_component =
46 local_assembler.
assemble(t, dt, local_x_data, local_x_prev_data,
47 local_M_data, local_K_data, local_b_data);
62 auto const num_purterbated_colums = num_r_c - nved;
64 for (Eigen::MatrixXd::Index i = 0; i < num_purterbated_colums; ++i)
67 auto const component = i / num_dofs_per_component;
68 auto const eps = perturbations[component];
80 auto const local_M_0 =
82 auto const local_M_p =
84 local_Jac.col(i).noalias() +=
86 (local_M_p - local_M_0) * local_xdot / eps;
91 auto const local_K_0 =
93 auto const local_K_p =
96 local_Jac.col(i).noalias() +=
98 (local_K_p - local_K_0) * x / eps;
103 auto const local_b_0 =
105 auto const local_b_p =
107 local_Jac.col(i).noalias() -= (local_b_p - local_b_0) / eps;
115 if (!local_M_data.empty())
118 local_Jac.noalias() += local_M / dt;
120 if (!local_K_data.empty())
123 local_Jac.noalias() += local_K;
131 if (!local_b_data.empty())
139 if (!local_M_data.empty())
142 b -= M * (x - x_prev) / dt;
143 local_M_data.clear();
145 if (!local_K_data.empty())
154 auto const dm_start_index = num_purterbated_colums;
155 auto const dm_size = nved;
156 K.block(dm_start_index, dm_start_index, dm_size, dm_size).setZero();
160 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)