From 87ec0ced4031633e9084ee2f60d47c4cd57f7f7b Mon Sep 17 00:00:00 2001 From: Sébastien Crozet Date: Sat, 8 Jan 2022 21:09:11 +0100 Subject: Address issues with the genral-case for multibody joints --- src/dynamics/solver/island_solver.rs | 4 ++-- 1 file changed, 2 insertions(+), 2 deletions(-) (limited to 'src/dynamics/solver/island_solver.rs') diff --git a/src/dynamics/solver/island_solver.rs b/src/dynamics/solver/island_solver.rs index a862480..aeb2698 100644 --- a/src/dynamics/solver/island_solver.rs +++ b/src/dynamics/solver/island_solver.rs @@ -132,8 +132,8 @@ impl IslandSolver { if link.id == 0 || link.id == 1 && !multibody.root_is_dynamic { let accels = &multibody.accelerations; multibody.velocities.axpy(params.dt, accels, 1.0); - multibody.integrate_next(params.dt); - multibody.forward_kinematics_next(bodies, false); + multibody.integrate(params.dt); + multibody.forward_kinematics(bodies, false); } } else { // Since we didn't run the velocity solver we need to integrate the accelerations here -- cgit