#include <memory>
#include <vector>
#include <Eigen/Core>
#include "SurgSim/Physics/PhysicsManagerState.h"
#include "SurgSim/Physics/SolveMlcp.h"
#include "SurgSim/Math/MlcpGaussSeidelSolver.h"