Updated Harts implementation in integrator.hpp