Fix wrong energy calcuation in ArapSolver.