Algorithm for dynamics evaluation