Now calculates all forces in dynamics. Force/coordinate output. Energy output.